Merge pull request #342 from jquatier/thinknode-m1-gps
ThinkNode m1 GPS support
This commit is contained in:
@@ -25,6 +25,9 @@ build_src_filter = ${nrf52840_thinknode_m1.build_src_filter}
|
|||||||
+<helpers/*.cpp>
|
+<helpers/*.cpp>
|
||||||
+<helpers/nrf52/ThinkNodeM1Board.cpp>
|
+<helpers/nrf52/ThinkNodeM1Board.cpp>
|
||||||
+<../variants/thinknode_m1>
|
+<../variants/thinknode_m1>
|
||||||
|
lib_deps =
|
||||||
|
${nrf52840_thinknode_m1.lib_deps}
|
||||||
|
stevemarple/MicroNMEA @ ^2.0.6
|
||||||
debug_tool = jlink
|
debug_tool = jlink
|
||||||
upload_protocol = nrfutil
|
upload_protocol = nrfutil
|
||||||
|
|
||||||
|
|||||||
@@ -1,6 +1,7 @@
|
|||||||
#include <Arduino.h>
|
#include <Arduino.h>
|
||||||
#include "target.h"
|
#include "target.h"
|
||||||
#include <helpers/ArduinoHelpers.h>
|
#include <helpers/ArduinoHelpers.h>
|
||||||
|
#include <helpers/sensors/MicroNMEALocationProvider.h>
|
||||||
|
|
||||||
ThinkNodeM1Board board;
|
ThinkNodeM1Board board;
|
||||||
|
|
||||||
@@ -10,7 +11,8 @@ WRAPPER_CLASS radio_driver(radio, board);
|
|||||||
|
|
||||||
VolatileRTCClock fallback_clock;
|
VolatileRTCClock fallback_clock;
|
||||||
AutoDiscoverRTCClock rtc_clock(fallback_clock);
|
AutoDiscoverRTCClock rtc_clock(fallback_clock);
|
||||||
SensorManager sensors;
|
MicroNMEALocationProvider nmea = MicroNMEALocationProvider(Serial1);
|
||||||
|
ThinkNodeM1SensorManager sensors = ThinkNodeM1SensorManager(nmea);
|
||||||
|
|
||||||
#ifdef DISPLAY_CLASS
|
#ifdef DISPLAY_CLASS
|
||||||
DISPLAY_CLASS display;
|
DISPLAY_CLASS display;
|
||||||
@@ -72,3 +74,110 @@ mesh::LocalIdentity radio_new_identity() {
|
|||||||
RadioNoiseListener rng(radio);
|
RadioNoiseListener rng(radio);
|
||||||
return mesh::LocalIdentity(&rng); // create new random identity
|
return mesh::LocalIdentity(&rng); // create new random identity
|
||||||
}
|
}
|
||||||
|
|
||||||
|
void ThinkNodeM1SensorManager::start_gps() {
|
||||||
|
if (!gps_active) {
|
||||||
|
gps_active = true;
|
||||||
|
_location->begin();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void ThinkNodeM1SensorManager::stop_gps() {
|
||||||
|
if (gps_active) {
|
||||||
|
gps_active = false;
|
||||||
|
_location->stop();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
bool ThinkNodeM1SensorManager::begin() {
|
||||||
|
Serial1.begin(9600);
|
||||||
|
|
||||||
|
// Initialize GPS switch pin
|
||||||
|
pinMode(PIN_GPS_SWITCH, INPUT);
|
||||||
|
last_gps_switch_state = digitalRead(PIN_GPS_SWITCH);
|
||||||
|
|
||||||
|
// Initialize GPS power pin
|
||||||
|
pinMode(GPS_EN, OUTPUT);
|
||||||
|
|
||||||
|
// Check initial switch state to determine if GPS should be active
|
||||||
|
if (last_gps_switch_state == HIGH) { // Switch is HIGH when ON
|
||||||
|
start_gps();
|
||||||
|
}
|
||||||
|
|
||||||
|
return true;
|
||||||
|
}
|
||||||
|
|
||||||
|
bool ThinkNodeM1SensorManager::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 ThinkNodeM1SensorManager::loop() {
|
||||||
|
static long next_gps_update = 0;
|
||||||
|
static long last_switch_check = 0;
|
||||||
|
|
||||||
|
// Check GPS switch state every second
|
||||||
|
if (millis() - last_switch_check > 1000) {
|
||||||
|
bool current_switch_state = digitalRead(PIN_GPS_SWITCH);
|
||||||
|
|
||||||
|
// Detect switch state change
|
||||||
|
if (current_switch_state != last_gps_switch_state) {
|
||||||
|
last_gps_switch_state = current_switch_state;
|
||||||
|
|
||||||
|
if (current_switch_state == HIGH) { // Switch is ON
|
||||||
|
MESH_DEBUG_PRINTLN("GPS switch ON");
|
||||||
|
start_gps();
|
||||||
|
} else { // Switch is OFF
|
||||||
|
MESH_DEBUG_PRINTLN("GPS switch OFF");
|
||||||
|
stop_gps();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
last_switch_check = millis();
|
||||||
|
}
|
||||||
|
|
||||||
|
if (!gps_active) {
|
||||||
|
return; // GPS is not active, skip further processing
|
||||||
|
}
|
||||||
|
|
||||||
|
_location->loop();
|
||||||
|
|
||||||
|
if (millis() > next_gps_update) {
|
||||||
|
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;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
int ThinkNodeM1SensorManager::getNumSettings() const {
|
||||||
|
return 1; // always show GPS setting
|
||||||
|
}
|
||||||
|
|
||||||
|
const char* ThinkNodeM1SensorManager::getSettingName(int i) const {
|
||||||
|
return (i == 0) ? "gps" : NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
const char* ThinkNodeM1SensorManager::getSettingValue(int i) const {
|
||||||
|
if (i == 0) {
|
||||||
|
return gps_active ? "1" : "0";
|
||||||
|
}
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
bool ThinkNodeM1SensorManager::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
|
||||||
|
}
|
||||||
|
|||||||
@@ -7,14 +7,33 @@
|
|||||||
#include <helpers/CustomSX1262Wrapper.h>
|
#include <helpers/CustomSX1262Wrapper.h>
|
||||||
#include <helpers/AutoDiscoverRTCClock.h>
|
#include <helpers/AutoDiscoverRTCClock.h>
|
||||||
#include <helpers/SensorManager.h>
|
#include <helpers/SensorManager.h>
|
||||||
|
#include <helpers/sensors/LocationProvider.h>
|
||||||
#ifdef DISPLAY_CLASS
|
#ifdef DISPLAY_CLASS
|
||||||
#include <helpers/ui/GxEPDDisplay.h>
|
#include <helpers/ui/GxEPDDisplay.h>
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
class ThinkNodeM1SensorManager : public SensorManager {
|
||||||
|
bool gps_active = false;
|
||||||
|
bool last_gps_switch_state = false;
|
||||||
|
LocationProvider* _location;
|
||||||
|
|
||||||
|
void start_gps();
|
||||||
|
void stop_gps();
|
||||||
|
public:
|
||||||
|
ThinkNodeM1SensorManager(LocationProvider &location): _location(&location) { }
|
||||||
|
bool begin() override;
|
||||||
|
bool querySensors(uint8_t requester_permissions, CayenneLPP& telemetry) override;
|
||||||
|
void loop() override;
|
||||||
|
int getNumSettings() const override;
|
||||||
|
const char* getSettingName(int i) const override;
|
||||||
|
const char* getSettingValue(int i) const override;
|
||||||
|
bool setSettingValue(const char* name, const char* value) override;
|
||||||
|
};
|
||||||
|
|
||||||
extern ThinkNodeM1Board board;
|
extern ThinkNodeM1Board board;
|
||||||
extern WRAPPER_CLASS radio_driver;
|
extern WRAPPER_CLASS radio_driver;
|
||||||
extern AutoDiscoverRTCClock rtc_clock;
|
extern AutoDiscoverRTCClock rtc_clock;
|
||||||
extern SensorManager sensors;
|
extern ThinkNodeM1SensorManager sensors;
|
||||||
|
|
||||||
#ifdef DISPLAY_CLASS
|
#ifdef DISPLAY_CLASS
|
||||||
extern DISPLAY_CLASS display;
|
extern DISPLAY_CLASS display;
|
||||||
|
|||||||
@@ -40,8 +40,8 @@
|
|||||||
////////////////////////////////////////////////////////////////////////////////
|
////////////////////////////////////////////////////////////////////////////////
|
||||||
// UART pin definition
|
// UART pin definition
|
||||||
|
|
||||||
#define PIN_SERIAL1_RX (41) // GPS TX
|
#define PIN_SERIAL1_RX PIN_GPS_TX
|
||||||
#define PIN_SERIAL1_TX (40) // GPS RX
|
#define PIN_SERIAL1_TX PIN_GPS_RX
|
||||||
////////////////////////////////////////////////////////////////////////////////
|
////////////////////////////////////////////////////////////////////////////////
|
||||||
// I2C pin definition
|
// I2C pin definition
|
||||||
|
|
||||||
@@ -125,9 +125,10 @@ extern const int SCK;
|
|||||||
////////////////////////////////////////////////////////////////////////////////
|
////////////////////////////////////////////////////////////////////////////////
|
||||||
// GPS
|
// GPS
|
||||||
|
|
||||||
#define PIN_GPS_RX (41)
|
#define PIN_GPS_RX (40)
|
||||||
#define PIN_GPS_TX (40)
|
#define PIN_GPS_TX (41)
|
||||||
#define PIN_GPS_WAKEUP (34)
|
#define GPS_EN (34)
|
||||||
#define PIN_GPS_RESET (37)
|
#define PIN_GPS_RESET (37)
|
||||||
#define PIN_GPS_PPS (36)
|
#define PIN_GPS_PPS (36)
|
||||||
#define PIN_GPS_STANDBY (34)
|
#define PIN_GPS_STANDBY (34)
|
||||||
|
#define PIN_GPS_SWITCH (33)
|
||||||
|
|||||||
Reference in New Issue
Block a user