mirror of
https://github.com/meshcore-dev/MeshCore.git
synced 2026-03-30 23:35:45 +00:00
150 lines
3.7 KiB
C++
150 lines
3.7 KiB
C++
#include <Arduino.h>
|
|
#include "target.h"
|
|
#include <helpers/ArduinoHelpers.h>
|
|
#include <helpers/sensors/MicroNMEALocationProvider.h>
|
|
|
|
WioTrackerL1Board 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);
|
|
WioTrackerL1SensorManager sensors = WioTrackerL1SensorManager(nmea);
|
|
|
|
#ifdef DISPLAY_CLASS
|
|
DISPLAY_CLASS display;
|
|
MomentaryButton user_btn(PIN_USER_BTN, 1000, true);
|
|
MomentaryButton joystick_left(JOYSTICK_LEFT, 1000, true);
|
|
MomentaryButton joystick_right(JOYSTICK_RIGHT, 1000, true);
|
|
#endif
|
|
|
|
bool radio_init() {
|
|
rtc_clock.begin(Wire);
|
|
|
|
return radio.std_init(&SPI);
|
|
}
|
|
|
|
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);
|
|
}
|
|
|
|
void WioTrackerL1SensorManager::start_gps()
|
|
{
|
|
if (!gps_active)
|
|
{
|
|
MESH_DEBUG_PRINTLN("starting GPS");
|
|
digitalWrite(PIN_GPS_STANDBY, HIGH);
|
|
gps_active = true;
|
|
}
|
|
}
|
|
|
|
void WioTrackerL1SensorManager::stop_gps()
|
|
{
|
|
if (gps_active)
|
|
{
|
|
MESH_DEBUG_PRINTLN("stopping GPS");
|
|
digitalWrite(PIN_GPS_STANDBY, LOW);
|
|
gps_active = false;
|
|
}
|
|
}
|
|
|
|
bool WioTrackerL1SensorManager::begin()
|
|
{
|
|
Serial1.setPins(PIN_GPS_TX, PIN_GPS_RX); // be sure to tx into rx and rx into tx
|
|
Serial1.begin(GPS_BAUDRATE);
|
|
|
|
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(PIN_GPS_STANDBY, LOW); // Put GPS back into standby mode
|
|
return true;
|
|
}
|
|
|
|
bool WioTrackerL1SensorManager::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 WioTrackerL1SensorManager::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 WioTrackerL1SensorManager::getNumSettings() const { return 1; } // just one supported: "gps" (power switch)
|
|
|
|
const char *WioTrackerL1SensorManager::getSettingName(int i) const
|
|
{
|
|
return i == 0 ? "gps" : NULL;
|
|
}
|
|
|
|
const char *WioTrackerL1SensorManager::getSettingValue(int i) const
|
|
{
|
|
if (i == 0)
|
|
{
|
|
return gps_active ? "1" : "0";
|
|
}
|
|
return NULL;
|
|
}
|
|
|
|
bool WioTrackerL1SensorManager::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);
|
|
return mesh::LocalIdentity(&rng); // create new random identity
|
|
}
|