mawei/onepilot
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

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

Browse Source 
change bearingAccuracyDeg from 0 to 180 deg, when invalid
old-commit-hash: f7471f9108472cc53ea88052df32927d16c68289
This commit is contained in:
Vivek Aithal
2023-07-18 11:21:11 -07:00
committed by GitHub
parent 495d345e0b
commit cb60085777
1 changed files with 1 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files

2
system/sensord/rawgps/rawgpsd.py
View File

@@ -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