mirror of
https://github.com/meshcore-dev/MeshCore.git
synced 2026-03-30 21:25:46 +00:00
165 lines
4.2 KiB
C++
165 lines
4.2 KiB
C++
#include <Arduino.h>
|
|
#include "target.h"
|
|
#include <helpers/ArduinoHelpers.h>
|
|
#include <helpers/sensors/MicroNMEALocationProvider.h>
|
|
|
|
ThinkNodeM1Board board;
|
|
|
|
RADIO_CLASS radio = new Module(P_LORA_NSS, P_LORA_DIO_1, P_LORA_RESET, P_LORA_BUSY, SPI);
|
|
|
|
WRAPPER_CLASS radio_driver(radio, board);
|
|
|
|
VolatileRTCClock fallback_clock;
|
|
AutoDiscoverRTCClock rtc_clock(fallback_clock);
|
|
MicroNMEALocationProvider nmea = MicroNMEALocationProvider(Serial1);
|
|
ThinkNodeM1SensorManager sensors = ThinkNodeM1SensorManager(nmea);
|
|
|
|
#ifdef DISPLAY_CLASS
|
|
DISPLAY_CLASS display;
|
|
#endif
|
|
|
|
#ifndef LORA_CR
|
|
#define LORA_CR 5
|
|
#endif
|
|
|
|
bool radio_init() {
|
|
rtc_clock.begin(Wire);
|
|
|
|
#ifdef SX126X_DIO3_TCXO_VOLTAGE
|
|
float tcxo = SX126X_DIO3_TCXO_VOLTAGE;
|
|
#else
|
|
float tcxo = 1.6f;
|
|
#endif
|
|
|
|
SPI.setPins(P_LORA_MISO, P_LORA_SCLK, P_LORA_MOSI);
|
|
SPI.begin();
|
|
int status = radio.begin(LORA_FREQ, LORA_BW, LORA_SF, LORA_CR, RADIOLIB_SX126X_SYNC_WORD_PRIVATE, LORA_TX_POWER, 8, tcxo);
|
|
if (status != RADIOLIB_ERR_NONE) {
|
|
Serial.print("ERROR: radio init failed: ");
|
|
Serial.println(status);
|
|
return false; // fail
|
|
}
|
|
|
|
radio.setCRC(1);
|
|
|
|
#ifdef SX126X_CURRENT_LIMIT
|
|
radio.setCurrentLimit(SX126X_CURRENT_LIMIT);
|
|
#endif
|
|
#ifdef SX126X_DIO2_AS_RF_SWITCH
|
|
radio.setDio2AsRfSwitch(SX126X_DIO2_AS_RF_SWITCH);
|
|
#endif
|
|
#ifdef SX126X_RX_BOOSTED_GAIN
|
|
radio.setRxBoostedGainMode(SX126X_RX_BOOSTED_GAIN);
|
|
#endif
|
|
|
|
return true; // success
|
|
}
|
|
|
|
uint32_t radio_get_rng_seed() {
|
|
return radio.random(0x7FFFFFFF);
|
|
}
|
|
|
|
void radio_set_params(float freq, float bw, uint8_t sf, uint8_t cr) {
|
|
radio.setFrequency(freq);
|
|
radio.setSpreadingFactor(sf);
|
|
radio.setBandwidth(bw);
|
|
radio.setCodingRate(cr);
|
|
}
|
|
|
|
void radio_set_tx_power(uint8_t dbm) {
|
|
radio.setOutputPower(dbm);
|
|
}
|
|
|
|
mesh::LocalIdentity radio_new_identity() {
|
|
RadioNoiseListener rng(radio);
|
|
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);
|
|
|
|
// Try to detect if GPS is physically connected to determine if we should expose the setting
|
|
pinMode(GPS_EN, OUTPUT);
|
|
digitalWrite(GPS_EN, HIGH); // Power on GPS
|
|
|
|
// Give GPS a moment to send data if it's physically connected and powered
|
|
delay(1500);
|
|
|
|
// We'll consider GPS detected if we see any data on Serial1
|
|
gps_detected = (Serial1.available() > 0);
|
|
|
|
if (gps_detected) {
|
|
MESH_DEBUG_PRINTLN("GPS detected");
|
|
digitalWrite(GPS_EN, LOW); // Power off GPS until the setting is changed
|
|
} else {
|
|
MESH_DEBUG_PRINTLN("No GPS detected");
|
|
digitalWrite(GPS_EN, LOW);
|
|
}
|
|
|
|
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;
|
|
|
|
_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 gps_detected ? 1 : 0; // only show GPS setting if GPS is detected
|
|
}
|
|
|
|
const char* ThinkNodeM1SensorManager::getSettingName(int i) const {
|
|
return (gps_detected && i == 0) ? "gps" : NULL;
|
|
}
|
|
|
|
const char* ThinkNodeM1SensorManager::getSettingValue(int i) const {
|
|
if (gps_detected && i == 0) {
|
|
return gps_active ? "1" : "0";
|
|
}
|
|
return NULL;
|
|
}
|
|
|
|
bool ThinkNodeM1SensorManager::setSettingValue(const char* name, const char* value) {
|
|
if (gps_detected && strcmp(name, "gps") == 0) {
|
|
if (strcmp(value, "0") == 0) {
|
|
stop_gps();
|
|
} else {
|
|
start_gps();
|
|
}
|
|
return true;
|
|
}
|
|
return false; // not supported
|
|
}
|