1
0
Fork 0

sixhts: Warn when GPS altitude does not match baro.

master
Pavel Machek 2024-08-14 22:01:13 +02:00
parent 6c04da4c01
commit 543e51846b
1 changed files with 6 additions and 4 deletions

View File

@ -294,7 +294,7 @@ function gpsHandleFix(fix) {
debug2 = "te "+(n2-n1)+"s"; debug2 = "te "+(n2-n1)+"s";
} }
loggps(fix); loggps(fix);
let d = calcDistance(fix, state.prev_fix); let d = fmt.distance(fix, state.prev_fix);
if (d > 30) { if (d > 30) {
state.prev_fix = fix; state.prev_fix = fix;
state.gps_dist += d/1000; state.gps_dist += d/1000;
@ -316,11 +316,13 @@ function gpsHandle() {
gpsRestart(); gpsRestart();
} }
} else { } else {
let fix = Bangle.getGPSFix(); let fix = gps.getGPSFix();
if (fix && fix.fix && fix.lat) { if (fix && fix.fix && fix.lat) {
gpsHandleFix(fix); gpsHandleFix(fix);
msg = fmt.fmtSpeed(fix.speed); msg = "";
print("GPS FIX", msg); if (Math.abs(fix.alt - cur_altitude) > 20)
msg += "!";
msg += fmt.fmtSpeed(fix.speed);
if (!last_fstart) if (!last_fstart)
last_fstart = getTime(); last_fstart = getTime();