kopia lustrzana https://github.com/meshtastic/firmware
ublox is better but still not perfect
rodzic
acd5e5d29d
commit
3c1357b732
44
src/GPS.cpp
44
src/GPS.cpp
|
@ -27,6 +27,7 @@ void GPS::setup()
|
||||||
|
|
||||||
#ifdef GPS_RX_PIN
|
#ifdef GPS_RX_PIN
|
||||||
_serial_gps.begin(GPS_BAUDRATE, SERIAL_8N1, GPS_RX_PIN, GPS_TX_PIN);
|
_serial_gps.begin(GPS_BAUDRATE, SERIAL_8N1, GPS_RX_PIN, GPS_TX_PIN);
|
||||||
|
// _serial_gps.setRxBufferSize(1024); // the default is 256
|
||||||
// ublox.enableDebugging(Serial);
|
// ublox.enableDebugging(Serial);
|
||||||
|
|
||||||
// note: the lib's implementation has the wrong docs for what the return val is
|
// note: the lib's implementation has the wrong docs for what the return val is
|
||||||
|
@ -42,20 +43,23 @@ void GPS::setup()
|
||||||
|
|
||||||
bool factoryReset = false;
|
bool factoryReset = false;
|
||||||
bool ok;
|
bool ok;
|
||||||
if(factoryReset) {
|
if (factoryReset)
|
||||||
|
{
|
||||||
// It is useful to force back into factory defaults (9600baud, NEMA to test the behavior of boards that don't have GPS_TX connected)
|
// It is useful to force back into factory defaults (9600baud, NEMA to test the behavior of boards that don't have GPS_TX connected)
|
||||||
ublox.factoryReset();
|
ublox.factoryReset();
|
||||||
delay(2000);
|
delay(2000);
|
||||||
isConnected = ublox.begin(_serial_gps);
|
isConnected = ublox.begin(_serial_gps);
|
||||||
DEBUG_MSG("Factory reset success=%d\n", isConnected);
|
DEBUG_MSG("Factory reset success=%d\n", isConnected);
|
||||||
if(isConnected) {
|
if (isConnected)
|
||||||
|
{
|
||||||
ublox.assumeAutoPVT(true, true); // Just parse NEMA for now
|
ublox.assumeAutoPVT(true, true); // Just parse NEMA for now
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
else {
|
else
|
||||||
ok = ublox.setUART1Output(COM_TYPE_UBX); // Use native API
|
{
|
||||||
|
ok = ublox.setUART1Output(COM_TYPE_UBX, 500); // Use native API
|
||||||
assert(ok);
|
assert(ok);
|
||||||
ok = ublox.setNavigationFrequency(4); //Produce 4x/sec to keep the amount of time we stall in getPVT low
|
ok = ublox.setNavigationFrequency(1, 500); //Produce 4x/sec to keep the amount of time we stall in getPVT low
|
||||||
assert(ok);
|
assert(ok);
|
||||||
//ok = ublox.setAutoPVT(false); // Not implemented on NEO-6M
|
//ok = ublox.setAutoPVT(false); // Not implemented on NEO-6M
|
||||||
//assert(ok);
|
//assert(ok);
|
||||||
|
@ -147,7 +151,12 @@ void GPS::doTask()
|
||||||
// DEBUG_MSG("sec %d\n", ublox.getSecond());
|
// DEBUG_MSG("sec %d\n", ublox.getSecond());
|
||||||
// DEBUG_MSG("lat %d\n", ublox.getLatitude());
|
// DEBUG_MSG("lat %d\n", ublox.getLatitude());
|
||||||
|
|
||||||
if (!timeSetFromGPS && ublox.getT())
|
// If we don't have a fix (a quick check), don't try waiting for a solution)
|
||||||
|
uint8_t fixtype = ublox.getFixType();
|
||||||
|
DEBUG_MSG("fix type %d\n", fixtype);
|
||||||
|
|
||||||
|
// any fix that has time
|
||||||
|
if ((fixtype >= 2 && fixtype <= 5) && !timeSetFromGPS && ublox.getT())
|
||||||
{
|
{
|
||||||
struct timeval tv;
|
struct timeval tv;
|
||||||
|
|
||||||
|
@ -173,8 +182,8 @@ void GPS::doTask()
|
||||||
perhapsSetRTC(&tv);
|
perhapsSetRTC(&tv);
|
||||||
}
|
}
|
||||||
|
|
||||||
if (ublox.getP())
|
if ((fixtype >= 3 && fixtype <= 4) && ublox.getP()) // rd fixes only
|
||||||
{
|
{
|
||||||
// we only notify if position has changed
|
// we only notify if position has changed
|
||||||
isConnected = true; // We just received a packet, so we must have a GPS
|
isConnected = true; // We just received a packet, so we must have a GPS
|
||||||
|
|
||||||
|
@ -182,17 +191,22 @@ void GPS::doTask()
|
||||||
longitude = ublox.getLongitude() * 1e-7;
|
longitude = ublox.getLongitude() * 1e-7;
|
||||||
altitude = ublox.getAltitude() / 1000; // in mm convert to meters
|
altitude = ublox.getAltitude() / 1000; // in mm convert to meters
|
||||||
DEBUG_MSG("new gps pos lat=%f, lon=%f, alt=%d\n", latitude, longitude, altitude);
|
DEBUG_MSG("new gps pos lat=%f, lon=%f, alt=%d\n", latitude, longitude, altitude);
|
||||||
hasValidLocation = true;
|
|
||||||
wantNewLocation = false;
|
hasValidLocation = (latitude != 0) || (longitude != 0); // bogus lat lon is reported as 0,0
|
||||||
notifyObservers();
|
if (hasValidLocation)
|
||||||
//ublox.powerOff();
|
{
|
||||||
|
wantNewLocation = false;
|
||||||
|
notifyObservers();
|
||||||
|
//ublox.powerOff();
|
||||||
|
}
|
||||||
}
|
}
|
||||||
else // we didn't get a location update, go back to sleep and hope the characters show up
|
else // we didn't get a location update, go back to sleep and hope the characters show up
|
||||||
wantNewLocation = true;
|
wantNewLocation = true;
|
||||||
#endif
|
|
||||||
|
|
||||||
// Once we have sent a location once we only poll the GPS rarely, otherwise check back every 100ms until we have something over the serial
|
#endif
|
||||||
setPeriod(hasValidLocation && !wantNewLocation ? 30 * 1000 : 100);
|
|
||||||
|
// Once we have sent a location once we only poll the GPS rarely, otherwise check back every 1s until we have something over the serial
|
||||||
|
setPeriod(hasValidLocation && !wantNewLocation ? 30 * 1000 : 1000);
|
||||||
}
|
}
|
||||||
|
|
||||||
void GPS::startLock()
|
void GPS::startLock()
|
||||||
|
|
Ładowanie…
Reference in New Issue