diff options
Diffstat (limited to 'src')
-rw-r--r-- | src/main.ino | 153 |
1 files changed, 153 insertions, 0 deletions
diff --git a/src/main.ino b/src/main.ino new file mode 100644 index 0000000..fe4ef95 --- /dev/null +++ b/src/main.ino @@ -0,0 +1,153 @@ +#include <Arduino.h> +#include <RadioLib.h> +#include <Wire.h> +#include <SparkFun_u-blox_GNSS_Arduino_Library.h> + +// SX1278 has the following connections: +// NSS pin: 10 +// DIO0 pin: 2 +// RESET pin: 9 +// DIO1 pin: 3 +RFM96 radio = new Module(10, 2, 9, 3); + +HardwareSerial SerialGNSS(PD6, PD5); +SFE_UBLOX_GNSS gnss; +long lastGnssPoll = 0; + +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); + + 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); + +#if 0 + Serial.print(F("[RFM] Init ")); + int state = radio.begin(); + if (state == RADIOLIB_ERR_NONE) { + Serial.println(F("success!")); + } else { + Serial.print(F("failed, code ")); + Serial.println(state); + while (true); + } + + // radio.setRfSwitchPins(4, 5); +#endif +} + +void loop() +{ + const auto now = millis(); + if (now - lastGnssPoll > 1000) { + lastGnssPoll = now; + + long latitude = gnss.getLatitude(); + Serial.print(F("Lat: ")); + Serial.print(latitude); + + long longitude = gnss.getLongitude(); + Serial.print(F(" Long: ")); + Serial.print(longitude); + + char* locator = get_mh((double)latitude/1e7, (double)longitude/1e7, 6); + Serial.print(F(" Loc: ")); + Serial.print(locator); + + long altitude = gnss.getAltitude(); + Serial.print(F(" Alt: ")); + Serial.print(altitude); + Serial.print(F(" (mm)")); + + long speed = gnss.getGroundSpeed(); + Serial.print(F(" Speed: ")); + Serial.print(speed); + Serial.print(F(" (mm/s)")); + + long heading = gnss.getHeading(); + Serial.print(F(" Heading: ")); + Serial.print(heading); + Serial.print(F(" (degrees * 10^-5)")); + + byte SIV = gnss.getSIV(); + Serial.print(F(" SIV: ")); + Serial.print(SIV); + + Serial.println(); + } +} + +void loop2() +{ + digitalWrite(LED_BUILTIN, HIGH); + delay(1000); + + Serial.print(F("[RFM] Transmitting packet ... ")); + + int state = radio.transmit("Hello World!"); + + if (state == RADIOLIB_ERR_NONE) { + Serial.println(F(" success!")); + Serial.print(F("[RFM] Datarate:\t")); + 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); + delay(1000); +} |