|
|
|
@ -1,6 +1,7 @@ |
|
|
|
#include <Arduino.h> |
|
|
|
#include "target.h" |
|
|
|
#include <helpers/ArduinoHelpers.h> |
|
|
|
#include <helpers/sensors/MicroNMEALocationProvider.h> |
|
|
|
|
|
|
|
NanoG2Ultra board; |
|
|
|
|
|
|
|
@ -10,10 +11,11 @@ WRAPPER_CLASS radio_driver(radio, board); |
|
|
|
|
|
|
|
VolatileRTCClock fallback_clock; |
|
|
|
AutoDiscoverRTCClock rtc_clock(fallback_clock); |
|
|
|
SensorManager sensors; |
|
|
|
MicroNMEALocationProvider nmea = MicroNMEALocationProvider(Serial1); |
|
|
|
NanoG2UltraSensorManager sensors = NanoG2UltraSensorManager(nmea); |
|
|
|
|
|
|
|
#ifdef DISPLAY_CLASS |
|
|
|
DISPLAY_CLASS display; |
|
|
|
DISPLAY_CLASS display; |
|
|
|
#endif |
|
|
|
|
|
|
|
#ifndef LORA_CR |
|
|
|
@ -73,6 +75,107 @@ void radio_set_tx_power(uint8_t dbm) |
|
|
|
radio.setOutputPower(dbm); |
|
|
|
} |
|
|
|
|
|
|
|
void NanoG2UltraSensorManager::start_gps() |
|
|
|
{ |
|
|
|
if (!gps_active) |
|
|
|
{ |
|
|
|
MESH_DEBUG_PRINTLN("starting GPS"); |
|
|
|
digitalWrite(PIN_GPS_STANDBY, HIGH); |
|
|
|
gps_active = true; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
void NanoG2UltraSensorManager::stop_gps() |
|
|
|
{ |
|
|
|
if (gps_active) |
|
|
|
{ |
|
|
|
MESH_DEBUG_PRINTLN("stopping GPS"); |
|
|
|
digitalWrite(PIN_GPS_STANDBY, LOW); |
|
|
|
gps_active = false; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
bool NanoG2UltraSensorManager::begin() |
|
|
|
{ |
|
|
|
Serial1.setPins(PIN_GPS_TX, PIN_GPS_RX); // be sure to tx into rx and rx into tx
|
|
|
|
Serial1.begin(115200); |
|
|
|
|
|
|
|
pinMode(PIN_GPS_STANDBY, OUTPUT); |
|
|
|
digitalWrite(PIN_GPS_STANDBY, HIGH); // Wake GPS from standby
|
|
|
|
delay(500); |
|
|
|
|
|
|
|
// We'll consider GPS detected if we see any data on Serial1
|
|
|
|
if (Serial1.available() > 0) |
|
|
|
{ |
|
|
|
MESH_DEBUG_PRINTLN("GPS detected"); |
|
|
|
} |
|
|
|
else |
|
|
|
{ |
|
|
|
MESH_DEBUG_PRINTLN("No GPS detected"); |
|
|
|
} |
|
|
|
digitalWrite(GPS_EN, LOW); // Put GPS back into standby mode
|
|
|
|
return true; |
|
|
|
} |
|
|
|
|
|
|
|
bool NanoG2UltraSensorManager::querySensors(uint8_t requester_permissions, CayenneLPP &telemetry) |
|
|
|
{ |
|
|
|
if (requester_permissions & TELEM_PERM_LOCATION) |
|
|
|
{ // does requester have permission?
|
|
|
|
telemetry.addGPS(TELEM_CHANNEL_SELF, node_lat, node_lon, node_altitude); |
|
|
|
} |
|
|
|
return true; |
|
|
|
} |
|
|
|
|
|
|
|
void NanoG2UltraSensorManager::loop() |
|
|
|
{ |
|
|
|
static long next_gps_update = 0; |
|
|
|
_location->loop(); |
|
|
|
if (millis() > next_gps_update && gps_active) // don't bother if gps position is not enabled
|
|
|
|
{ |
|
|
|
if (_location->isValid()) |
|
|
|
{ |
|
|
|
node_lat = ((double)_location->getLatitude()) / 1000000.; |
|
|
|
node_lon = ((double)_location->getLongitude()) / 1000000.; |
|
|
|
node_altitude = ((double)_location->getAltitude()) / 1000.0; |
|
|
|
MESH_DEBUG_PRINTLN("lat %f lon %f", node_lat, node_lon); |
|
|
|
} |
|
|
|
next_gps_update = millis() + (1000 * 60); // after initial update, only check every minute TODO: should be configurable
|
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
int NanoG2UltraSensorManager::getNumSettings() const { return 1; } // just one supported: "gps" (power switch)
|
|
|
|
|
|
|
|
const char *NanoG2UltraSensorManager::getSettingName(int i) const |
|
|
|
{ |
|
|
|
return i == 0 ? "gps" : NULL; |
|
|
|
} |
|
|
|
|
|
|
|
const char *NanoG2UltraSensorManager::getSettingValue(int i) const |
|
|
|
{ |
|
|
|
if (i == 0) |
|
|
|
{ |
|
|
|
return gps_active ? "1" : "0"; |
|
|
|
} |
|
|
|
return NULL; |
|
|
|
} |
|
|
|
|
|
|
|
bool NanoG2UltraSensorManager::setSettingValue(const char *name, const char *value) |
|
|
|
{ |
|
|
|
if (strcmp(name, "gps") == 0) |
|
|
|
{ |
|
|
|
if (strcmp(value, "0") == 0) |
|
|
|
{ |
|
|
|
stop_gps(); |
|
|
|
} |
|
|
|
else |
|
|
|
{ |
|
|
|
start_gps(); |
|
|
|
} |
|
|
|
return true; |
|
|
|
} |
|
|
|
return false; // not supported
|
|
|
|
} |
|
|
|
|
|
|
|
mesh::LocalIdentity radio_new_identity() |
|
|
|
{ |
|
|
|
RadioNoiseListener rng(radio); |
|
|
|
|