LoRa_APRS_iGate/src/lora_utils.cpp

238 lines
7.5 KiB
C++
Raw Normal View History

2023-12-26 20:37:54 +01:00
#include <RadioLib.h>
2023-06-04 16:10:39 +02:00
#include <LoRa.h>
2023-11-26 18:30:57 +01:00
#include <WiFi.h>
2023-06-06 17:21:59 +02:00
#include "configuration.h"
2023-10-08 14:39:44 +02:00
#include "aprs_is_utils.h"
#include "syslog_utils.h"
2023-10-08 14:39:44 +02:00
#include "pins_config.h"
2023-06-04 16:10:39 +02:00
#include "display.h"
2024-03-17 12:21:11 +01:00
#include "utils.h"
2023-06-04 16:10:39 +02:00
2023-06-08 23:09:05 +02:00
extern Configuration Config;
2023-06-04 16:10:39 +02:00
2024-03-09 13:43:51 +01:00
#if defined(HELTEC_V3) || defined(HELTEC_WS) || defined(TTGO_T_Beam_V1_2_SX1262)
2023-12-26 20:37:54 +01:00
SX1262 radio = new Module(RADIO_CS_PIN, RADIO_DIO1_PIN, RADIO_RST_PIN, RADIO_BUSY_PIN);
bool transmissionFlag = true;
bool enableInterrupt = true;
#endif
2024-03-18 13:40:05 +01:00
#if defined(ESP32_DIY_1W_LoRa) || defined(TTGO_T_Beam_V1_0_SX1268) || defined(OE5HWN_MeshCom)
2024-01-03 02:41:54 +01:00
SX1268 radio = new Module(RADIO_CS_PIN, RADIO_DIO1_PIN, RADIO_RST_PIN, RADIO_BUSY_PIN);
bool transmissionFlag = true;
bool enableInterrupt = true;
#endif
2023-12-26 20:37:54 +01:00
2023-06-20 01:44:55 +02:00
int rssi, freqError;
float snr;
2024-02-25 16:00:44 +01:00
2023-06-07 23:25:50 +02:00
namespace LoRa_Utils {
2023-06-04 16:10:39 +02:00
2024-02-24 14:09:05 +01:00
void setFlag(void) {
2024-03-17 12:21:11 +01:00
#ifdef HAS_SX126X
2024-02-24 14:09:05 +01:00
transmissionFlag = true;
2024-03-17 12:21:11 +01:00
#endif
2023-12-27 00:47:59 +01:00
}
2023-06-04 16:10:39 +02:00
2024-02-24 14:09:05 +01:00
void setup() {
2024-03-17 12:21:11 +01:00
#ifdef HAS_SX127X
2024-02-24 14:09:05 +01:00
SPI.begin(LORA_SCK, LORA_MISO, LORA_MOSI, LORA_CS);
LoRa.setPins(LORA_CS, LORA_RST, LORA_IRQ);
2024-03-07 17:46:38 +01:00
long freq = Config.loramodule.rxFreq;
2024-02-24 14:09:05 +01:00
if (!LoRa.begin(freq)) {
Serial.println("Starting LoRa failed!");
show_display("ERROR", "Starting LoRa failed!");
while (true) {
delay(1000);
}
}
LoRa.setSpreadingFactor(Config.loramodule.spreadingFactor);
LoRa.setSignalBandwidth(Config.loramodule.signalBandwidth);
LoRa.setCodingRate4(Config.loramodule.codingRate4);
LoRa.enableCrc();
LoRa.setTxPower(Config.loramodule.power);
Serial.print("init : LoRa Module ... done!");
2024-03-17 12:21:11 +01:00
#endif
#ifdef HAS_SX126X
2024-02-24 14:09:05 +01:00
SPI.begin(RADIO_SCLK_PIN, RADIO_MISO_PIN, RADIO_MOSI_PIN);
2024-03-17 12:21:11 +01:00
float freq = (float)Config.loramodule.rxFreq / 1000000;
2024-02-24 14:09:05 +01:00
int state = radio.begin(freq);
if (state == RADIOLIB_ERR_NONE) {
Serial.print("Initializing SX126X LoRa Module");
2024-03-17 12:21:11 +01:00
}
else {
2024-02-24 14:09:05 +01:00
Serial.println("Starting LoRa failed!");
2024-03-17 12:21:11 +01:00
while (true);
2024-02-24 14:09:05 +01:00
}
radio.setDio1Action(setFlag);
radio.setSpreadingFactor(Config.loramodule.spreadingFactor);
2024-03-20 02:41:07 +01:00
float signalBandwidth = Config.loramodule.signalBandwidth/1000;
radio.setBandwidth(signalBandwidth);
2024-02-24 14:09:05 +01:00
radio.setCodingRate(Config.loramodule.codingRate4);
2024-02-25 16:55:38 +01:00
radio.setCRC(true);
2024-03-17 12:21:11 +01:00
#if defined(ESP32_DIY_1W_LoRa)
2024-02-24 14:09:05 +01:00
radio.setRfSwitchPins(RADIO_RXEN, RADIO_TXEN);
2024-03-17 12:21:11 +01:00
#endif
#if defined(HELTEC_V3) || defined(HELTEC_WS) || defined(TTGO_T_Beam_V1_0_SX1268) || defined(TTGO_T_Beam_V1_2_SX1262)
2024-02-24 14:09:05 +01:00
state = radio.setOutputPower(Config.loramodule.power + 2); // values available: 10, 17, 22 --> if 20 in tracker_conf.json it will be updated to 22.
2024-03-17 12:21:11 +01:00
#endif
#ifdef ESP32_DIY_1W_LoRa_GPS
2024-02-24 14:09:05 +01:00
state = radio.setOutputPower(Config.loramodule.power); // max value 20 (when 20dB in setup 30dB in output as 400M30S has Low Noise Amp)
2024-03-17 12:21:11 +01:00
#endif
2024-02-24 14:09:05 +01:00
if (state == RADIOLIB_ERR_NONE) {
Serial.println("init : LoRa Module ... done!");
2024-03-17 12:21:11 +01:00
}
else {
2024-02-24 14:09:05 +01:00
Serial.println("Starting LoRa failed!");
while (true);
}
2024-03-17 12:21:11 +01:00
#endif
2023-12-27 00:47:59 +01:00
}
2023-06-06 20:37:47 +02:00
2024-03-07 17:46:38 +01:00
void changeFreqTx() {
delay(500);
2024-03-17 12:21:11 +01:00
#ifdef HAS_SX127X
2024-03-07 17:46:38 +01:00
LoRa.setFrequency(Config.loramodule.txFreq);
2024-03-17 12:21:11 +01:00
#endif
#ifdef HAS_SX126X
float freq = (float)Config.loramodule.txFreq / 1000000;
2024-03-07 17:46:38 +01:00
radio.setFrequency(freq);
2024-03-17 12:21:11 +01:00
#endif
2024-03-07 17:46:38 +01:00
}
void changeFreqRx() {
delay(500);
2024-03-17 12:21:11 +01:00
#ifdef HAS_SX127X
2024-03-07 17:46:38 +01:00
LoRa.setFrequency(Config.loramodule.rxFreq);
2024-03-17 12:21:11 +01:00
#endif
#ifdef HAS_SX126X
float freq = (float)Config.loramodule.rxFreq / 1000000;
2024-03-07 17:46:38 +01:00
radio.setFrequency(freq);
2024-03-17 12:21:11 +01:00
#endif
2024-03-07 17:46:38 +01:00
}
2024-03-17 12:21:11 +01:00
void sendNewPacket(const String& typeOfMessage, const String& newPacket) {
2024-03-07 17:46:38 +01:00
if (!Config.loramodule.txActive) return;
if (Config.loramodule.txFreq != Config.loramodule.rxFreq) {
2024-03-17 12:21:11 +01:00
changeFreqTx();
2024-03-07 17:46:38 +01:00
}
2024-03-17 12:21:11 +01:00
#ifdef HAS_INTERNAL_LED
digitalWrite(internalLedPin, HIGH);
#endif
#ifdef HAS_SX127X
2024-02-24 14:09:05 +01:00
LoRa.beginPacket();
LoRa.write('<');
2024-03-17 12:21:11 +01:00
if (typeOfMessage == "APRS") {
2024-02-24 14:09:05 +01:00
LoRa.write(0xFF);
2024-03-17 12:21:11 +01:00
}
else if (typeOfMessage == "LoRa") {
2024-02-24 14:09:05 +01:00
LoRa.write(0xF8);
}
LoRa.write(0x01);
2024-03-17 12:21:11 +01:00
LoRa.write((const uint8_t*)newPacket.c_str(), newPacket.length());
2024-02-24 14:09:05 +01:00
LoRa.endPacket();
2024-03-17 12:21:11 +01:00
#endif
#ifdef HAS_SX126X
2024-02-24 14:09:05 +01:00
int state = radio.transmit("\x3c\xff\x01" + newPacket);
if (state == RADIOLIB_ERR_NONE) {
//Serial.println(F("success!"));
2024-03-17 12:21:11 +01:00
}
else if (state == RADIOLIB_ERR_PACKET_TOO_LONG) {
2024-02-24 14:09:05 +01:00
Serial.println(F("too long!"));
2024-03-17 12:21:11 +01:00
}
else if (state == RADIOLIB_ERR_TX_TIMEOUT) {
2024-02-24 14:09:05 +01:00
Serial.println(F("timeout!"));
2024-03-17 12:21:11 +01:00
}
else {
2024-02-24 14:09:05 +01:00
Serial.print(F("failed, code "));
Serial.println(state);
}
2024-03-17 12:21:11 +01:00
#endif
#ifdef HAS_INTERNAL_LED
digitalWrite(internalLedPin, LOW);
#endif
SYSLOG_Utils::log("Tx", newPacket, 0, 0, 0);
Utils::print("---> LoRa Packet Tx : ");
Utils::println(newPacket);
2024-03-07 17:46:38 +01:00
if (Config.loramodule.txFreq != Config.loramodule.rxFreq) {
changeFreqRx();
}
2024-01-26 02:35:15 +01:00
}
2024-02-24 14:09:05 +01:00
String generatePacket(String aprsisPacket) {
String firstPart, messagePart;
aprsisPacket.trim();
firstPart = aprsisPacket.substring(0, aprsisPacket.indexOf(","));
2024-03-17 12:21:11 +01:00
messagePart = aprsisPacket.substring(aprsisPacket.indexOf("::") + 2);
2024-02-24 14:09:05 +01:00
return firstPart + ",TCPIP,WIDE1-1," + Config.callsign + "::" + messagePart;
2023-12-26 20:37:54 +01:00
}
2024-02-24 14:09:05 +01:00
String packetSanitization(String packet) {
2024-03-17 12:21:11 +01:00
if (packet.indexOf("\0") > 0) {
packet.replace("\0", "");
2024-02-24 14:09:05 +01:00
}
2024-03-17 12:21:11 +01:00
if (packet.indexOf("\r") > 0) {
packet.replace("\r", "");
2024-02-24 14:09:05 +01:00
}
2024-03-17 12:21:11 +01:00
if (packet.indexOf("\n") > 0) {
packet.replace("\n", "");
2024-02-24 14:09:05 +01:00
}
return packet;
2024-01-03 03:05:07 +01:00
}
2024-02-24 14:09:05 +01:00
String receivePacket() {
String loraPacket = "";
2024-03-17 12:21:11 +01:00
#ifdef HAS_SX127X
2024-02-24 14:09:05 +01:00
int packetSize = LoRa.parsePacket();
if (packetSize) {
while (LoRa.available()) {
int inChar = LoRa.read();
loraPacket += (char)inChar;
}
2024-03-17 12:21:11 +01:00
rssi = LoRa.packetRssi();
snr = LoRa.packetSnr();
2024-02-24 14:09:05 +01:00
freqError = LoRa.packetFrequencyError();
}
2024-03-17 12:21:11 +01:00
#endif
#ifdef HAS_SX126X
2024-02-24 14:09:05 +01:00
if (transmissionFlag) {
transmissionFlag = false;
radio.startReceive();
int state = radio.readData(loraPacket);
if (state == RADIOLIB_ERR_NONE) {
2024-03-17 12:21:11 +01:00
rssi = radio.getRSSI();
snr = radio.getSNR();
2024-02-24 14:09:05 +01:00
freqError = radio.getFrequencyError();
2024-03-17 12:21:11 +01:00
}
else if (state == RADIOLIB_ERR_RX_TIMEOUT) {
2024-02-24 14:09:05 +01:00
// timeout occurred while waiting for a packet
2024-03-17 12:21:11 +01:00
}
else if (state == RADIOLIB_ERR_CRC_MISMATCH) {
2024-02-24 14:09:05 +01:00
Serial.println(F("CRC error!"));
2024-03-17 12:21:11 +01:00
}
else {
2024-02-24 14:09:05 +01:00
Serial.print(F("failed, code "));
Serial.println(state);
}
}
2024-03-17 12:21:11 +01:00
#endif
2024-02-25 16:00:44 +01:00
2024-03-17 12:21:11 +01:00
if ((loraPacket.indexOf("\0") != -1) || (loraPacket.indexOf("\r") != -1) || (loraPacket.indexOf("\n") != -1)) {
2024-02-24 14:09:05 +01:00
loraPacket = packetSanitization(loraPacket);
}
2024-02-25 16:00:44 +01:00
2024-03-17 12:21:11 +01:00
if (loraPacket != "") {
Utils::println("<--- LoRa Packet Rx : " + loraPacket);
Utils::println("(RSSI:" + String(rssi) + " / SNR:" + String(snr) + " / FreqErr:" + String(freqError) + ")");
2024-02-24 14:09:05 +01:00
}
2024-03-17 12:21:11 +01:00
2024-03-07 17:46:38 +01:00
if (Config.syslog.active && WiFi.status() == WL_CONNECTED && loraPacket != "") {
2024-02-24 14:09:05 +01:00
SYSLOG_Utils::log("Rx", loraPacket, rssi, snr, freqError);
}
return loraPacket;
2023-12-27 00:47:59 +01:00
}
2023-06-04 16:10:39 +02:00
}