aboutsummaryrefslogtreecommitdiffstats
path: root/tracker-stm32/src/main.ino
diff options
context:
space:
mode:
Diffstat (limited to 'tracker-stm32/src/main.ino')
-rw-r--r--tracker-stm32/src/main.ino317
1 files changed, 0 insertions, 317 deletions
diff --git a/tracker-stm32/src/main.ino b/tracker-stm32/src/main.ino
deleted file mode 100644
index 6a98cf9..0000000
--- a/tracker-stm32/src/main.ino
+++ /dev/null
@@ -1,317 +0,0 @@
-// Licence: MIT
-#include <Arduino.h>
-#include <RadioLib.h>
-#include <Wire.h>
-#include <SparkFun_u-blox_GNSS_Arduino_Library.h>
-#include <SD.h>
-
-// TODO: read these settings from the SD Card
-constexpr char CALLSIGN[] = "HB9EGM";
-constexpr int SSID = 12;
-constexpr int DATE_TYPE_CODE = 0; // compressed geolocation
-constexpr int PATH_CODE = 2; // metropolitan mobile
-constexpr char SYMBOL_TABLE_IDENTIFIER = '/';
-constexpr char SYMBOL_CODE_BICYCLE = 'b';
-constexpr long TX_INTERVAL = 15000;
-
-#if 0
-File myFile;
-constexpr int SD_CS = 17;
-#endif
-
-// SX1278 has the following connections:
-// NSS pin: PD14 (Arduino 10)
-// DIO0 pin: PF3 (Arduino 8)
-// RESET pin: PF15 (Arduino 9)
-RFM96 radio = new Module(10, 8, 9);
-HardwareSerial SerialGNSS(PD6, PD5);
-SFE_UBLOX_GNSS gnss;
-
-long lastGnssPoll = 0;
-long lastPositionReport = 0;
-
-constexpr size_t MAX_REPORT_LEN = 32;
-size_t report_len = 0;
-uint8_t report[MAX_REPORT_LEN];
-
-const char* digits = " 0123456789ABCDEFGHIJKLMNOPQRSTUVWXYZ-./?@";
-
-#define callsign_int_t uint32_t
-// This function is from aprs434.github.io,
-// MIT License, Copyright (c) 2022 Serge Y. Stroobandt, ON4AA
-callsign_int_t encodeCallsign(const char *callsign) {
- // Encode CCCC according to aprs434.github.io/code/codec.cpp
- const int b = 37;
-
- callsign_int_t result;
- callsign_int_t weight;
- int i, j, k, ch;
-
- result = 0, weight = 1;
- for (i = j = strlen(callsign); i > 0; i--) { // iterate over input string
- ch = toupper(callsign[i-1]);
- for (k = 0; k < strlen(digits); k++) { // lookup char index
- if (digits[k] == ch) {
- break;
- }
- }
- if (k == strlen(digits)) // ignore if ch not found in digits
- continue;
- result = result + ((k) * weight);
- weight = weight * b;
- }
-
- return result; // result can be pow(42,51)!
-}
-
-// This function is from ESP32 lora.tracker,
-// MIT License, Copyright (c) 2020 Peter Buchegger
-static void ax25_base91enc(char *s, uint8_t n, uint32_t v) {
- /* Creates a Base-91 representation of the value in v in the string
- * pointed to by s, n-characters long. String length should be n+1.
- */
-
- for (s += n, *s = '\0'; n; n--) {
- *(--s) = v % 91 + 33;
- v /= 91;
- }
-}
-
-
-static char letterize(int x) {
- return (char) x + 65;
-}
-static char* get_mh(double lat, double lon, int size) {
- static char locator[11];
- double LON_F[]={20,2.0,0.083333,0.008333,0.0003472083333333333};
- double LAT_F[]={10,1.0,0.0416665,0.004166,0.0001735833333333333};
- int i;
- lon += 180;
- lat += 90;
-
- if (size <= 0 || size > 10) size = 6;
- size/=2; size*=2;
-
- for (i = 0; i < size/2; i++){
- if (i % 2 == 1) {
- locator[i*2] = (char) (lon/LON_F[i] + '0');
- locator[i*2+1] = (char) (lat/LAT_F[i] + '0');
- } else {
- locator[i*2] = letterize((int) (lon/LON_F[i]));
- locator[i*2+1] = letterize((int) (lat/LAT_F[i]));
- }
- lon = fmod(lon, LON_F[i]);
- lat = fmod(lat, LAT_F[i]);
- }
- locator[i*2]=0;
- return locator;
-}
-
-void setup() {
- Serial.begin(9600);
- pinMode(LED_BUILTIN, OUTPUT);
-
-#if 0
- pinMode(SD_CS, OUTPUT);
-
- if (!SD.begin(SD_CS)) {
- Serial.println("SD init failed!");
- return;
- }
-#endif
-
- Wire.begin();
-
- SerialGNSS.begin(9600);
- if (!gnss.begin(SerialGNSS)) {
- while (true) {
- Serial.println(F("Check GNSS"));
- delay(4000);
- }
- }
-
- //gnss.enableDebugging(); // Uncomment this line to enable helpful debug messages on Serial
-
- Serial.print(F("Version: "));
- byte versionHigh = gnss.getProtocolVersionHigh();
- Serial.print(versionHigh);
- Serial.print(".");
- byte versionLow = gnss.getProtocolVersionLow();
- Serial.println(versionLow);
-
- Serial.print(F("[RFM] Init "));
- int state = radio.begin(433.900);
- if (state == RADIOLIB_ERR_NONE) {
- Serial.println(F("success!"));
- } else {
- Serial.print(F("failed, code "));
- Serial.println(state);
- while (true);
- }
-
- if (radio.setBandwidth(125.0) == RADIOLIB_ERR_INVALID_BANDWIDTH) {
- Serial.println(F("Selected bandwidth is invalid for this module!"));
- while (true);
- }
-
- if (radio.setSpreadingFactor(12) == RADIOLIB_ERR_INVALID_SPREADING_FACTOR) {
- Serial.println(F("Selected spreading factor is invalid for this module!"));
- while (true);
- }
-
- if (radio.setCodingRate(5) == RADIOLIB_ERR_INVALID_CODING_RATE) {
- Serial.println(F("Selected coding rate is invalid for this module!"));
- while (true);
- }
-
- // NOTE: value 0x34 is reserved for LoRaWAN networks and should not be used
- if (radio.setSyncWord(0x14) != RADIOLIB_ERR_NONE) {
- Serial.println(F("Unable to set sync word!"));
- while (true);
- }
-
- if (radio.setOutputPower(16) == RADIOLIB_ERR_INVALID_OUTPUT_POWER) {
- Serial.println(F("Selected output power is invalid for this module!"));
- while (true);
- }
-
- if (radio.setPreambleLength(8) == RADIOLIB_ERR_INVALID_PREAMBLE_LENGTH) {
- Serial.println(F("Selected preamble length is invalid for this module!"));
- while (true);
- }
-
- // radio.setRfSwitchPins(4, 5);
-}
-
-void loop()
-{
- const auto now = millis();
- if (now - lastGnssPoll > 1000) {
- lastGnssPoll = now;
-
- // longitude and latitude are in degrees*1e7
- const long latitude = gnss.getLatitude();
- Serial.print(F("Lat: "));
- Serial.print(latitude);
-
- const long longitude = gnss.getLongitude();
- Serial.print(F(" Long: "));
- Serial.print(longitude);
-
- char *locator = get_mh((double)latitude/1e7, (double)longitude/1e7, 10);
- Serial.print(F(" Loc: "));
- Serial.print(locator);
-
- const long altitude = gnss.getAltitude();
- Serial.print(F(" Alt: "));
- Serial.print(altitude);
- Serial.print(F(" (mm)"));
-
- const long speed = gnss.getGroundSpeed();
- Serial.print(F(" Speed: "));
- Serial.print(speed);
- Serial.print(F(" (mm/s)"));
- // 1m/s = 900/463 knots
- const double speed_kn = speed / 1000.0 * 900.0 / 463.0;
-
- const long heading = gnss.getHeading();
- Serial.print(F(" Heading: "));
- Serial.print(heading);
- Serial.print(F(" (degrees * 10^-5)"));
-
- const byte SIV = gnss.getSIV();
- Serial.print(F(" SIV: "));
- Serial.print(SIV);
-
- Serial.print(F(" TX in: "));
- Serial.print(TX_INTERVAL - (now - lastPositionReport));
-
- Serial.println();
-
- if (now - lastPositionReport > TX_INTERVAL) {
- lastPositionReport = now;
-
- digitalWrite(LED_BUILTIN, HIGH);
-
- // Encode LoRa message according to aprs434.github.io
- const uint32_t callsign_EEEE = encodeCallsign(CALLSIGN);
-
- report_len = 0;
- // Callsign encoded as CCCC
- report[report_len++] = (callsign_EEEE >> 24) & 0xFF;
- report[report_len++] = (callsign_EEEE >> 16) & 0xFF;
- report[report_len++] = (callsign_EEEE >> 8) & 0xFF;
- report[report_len++] = callsign_EEEE & 0xFF;
-
- // D SSID Path Code and Data Type Code
- report[report_len++] = SSID * 16 + PATH_CODE * 4 + DATE_TYPE_CODE;
-
- // / Symbol Table Identifier
- report[report_len++] = SYMBOL_TABLE_IDENTIFIER;
-
- // XXXX Base91 Longitude
- // YYYY Base91 Latitude
- uint32_t aprs_lat = 900000000 - latitude;
- aprs_lat = aprs_lat / 26 - aprs_lat / 2710 + aprs_lat / 15384615;
- uint32_t aprs_lon = 900000000 + longitude / 2;
- aprs_lon = aprs_lon / 26 - aprs_lon / 2710 + aprs_lon / 15384615;
-
- char tmp_base91[5];
- ax25_base91enc(tmp_base91, 4, aprs_lat);
- for (int i=0; i<4; i++) {
- report[report_len++] = tmp_base91[i];
- }
- ax25_base91enc(tmp_base91, 4, aprs_lon);
- for (int i=0; i<4; i++) {
- report[report_len++] = tmp_base91[i];
- }
-
- // $ Symbol Code
- report[report_len++] = SYMBOL_CODE_BICYCLE;
-
- // cs Course and Speed
- ax25_base91enc(tmp_base91, 1, heading * 10000 / 4);
- report[report_len++] = tmp_base91[0];
-
- ax25_base91enc(tmp_base91, 1, (uint32_t)(log1p(speed_kn) / 0.07696));
- report[report_len++] = tmp_base91[0];
-
- Serial.print(F("TX: "));
- // This is the old custom report I used before adopting aprs434.github.io,
- // it is just callsign SPACE locator sent as ASCII
- Serial.print(CALLSIGN);
- Serial.print(F(" "));
- Serial.println(locator);
-
- // Debug print
- Serial.println(F("Bytes: "));
- for (int i = 0; i < report_len; i++) {
- Serial.print((uint32_t)report[i]);
- }
- Serial.println(F(""));
-
- int state = radio.transmit(report, report_len);
-
- if (state == RADIOLIB_ERR_NONE) {
- Serial.print(F(" RFM OK Datarate: "));
- Serial.print(radio.getDataRate());
- Serial.println(F(" bps"));
-
- }
- else if (state == RADIOLIB_ERR_PACKET_TOO_LONG) {
- Serial.println(F(" too long!"));
-
- }
- else if (state == RADIOLIB_ERR_TX_TIMEOUT) {
- Serial.println(F(" timeout!"));
-
- }
- else {
- Serial.print(F(" failed, code "));
- Serial.println(state);
- }
-
- digitalWrite(LED_BUILTIN, LOW);
- }
- }
-}