[Qcom GPS] BearingAccuracyDeg should not be 0 when inaccurate (#28989)

change bearingAccuracyDeg from 0 to 180 deg, when invalid
old-commit-hash: f7471f9108
beeps
Vivek Aithal 2 years ago committed by GitHub
parent 495d345e0b
commit cb60085777
  1. 2
      system/sensord/rawgps/rawgpsd.py

@ -359,7 +359,7 @@ def main() -> NoReturn:
gps.source = log.GpsLocationData.SensorSource.qcomdiag
gps.vNED = vNED
gps.verticalAccuracy = report["q_FltVdop"]
gps.bearingAccuracyDeg = report["q_FltHeadingUncRad"] * 180/math.pi
gps.bearingAccuracyDeg = report["q_FltHeadingUncRad"] * 180/math.pi if (report["q_FltHeadingUncRad"] != 0) else 180
gps.speedAccuracy = math.sqrt(sum([x**2 for x in vNEDsigma]))
# quectel gps verticalAccuracy is clipped to 500, set invalid if so
gps.flags = 1 if gps.verticalAccuracy != 500 else 0

Loading…
Cancel
Save