Gather quectel GPS data (#25300)

* bump cereal

* Use old name

* back to default
pull/25293/head
HaraldSchafer 3 years ago committed by GitHub
parent 787232d762
commit 98146f5858
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23
  1. 2
      cereal
  2. 9
      selfdrive/sensord/rawgps/rawgpsd.py

@ -1 +1 @@
Subproject commit 9ae66d07129dcf1b5d6fc5167bbc89691a56d24c Subproject commit 5fce93da72fbd7cebd025ebdc58fa3ef3b4a3fd5

@ -81,10 +81,9 @@ def main() -> NoReturn:
LOG_GNSS_OEMDRE_MEASUREMENT_REPORT, LOG_GNSS_OEMDRE_MEASUREMENT_REPORT,
] ]
pub_types = ['qcomGnss'] pub_types = ['qcomGnss']
if int(os.getenv("PUBLISH_EXTERNAL", "0")) == 1:
unpack_position, _ = dict_unpacker(position_report) unpack_position, _ = dict_unpacker(position_report)
log_types.append(LOG_GNSS_POSITION_REPORT) log_types.append(LOG_GNSS_POSITION_REPORT)
pub_types.append("gpsLocationExternal") pub_types.append("gpsLocation")
# connect to modem # connect to modem
diag = ModemDiag() diag = ModemDiag()
@ -204,8 +203,8 @@ def main() -> NoReturn:
vNED = [report["q_FltVelEnuMps[1]"], report["q_FltVelEnuMps[0]"], -report["q_FltVelEnuMps[2]"]] vNED = [report["q_FltVelEnuMps[1]"], report["q_FltVelEnuMps[0]"], -report["q_FltVelEnuMps[2]"]]
vNEDsigma = [report["q_FltVelSigmaMps[1]"], report["q_FltVelSigmaMps[0]"], -report["q_FltVelSigmaMps[2]"]] vNEDsigma = [report["q_FltVelSigmaMps[1]"], report["q_FltVelSigmaMps[0]"], -report["q_FltVelSigmaMps[2]"]]
msg = messaging.new_message('gpsLocationExternal') msg = messaging.new_message('gpsLocation')
gps = msg.gpsLocationExternal gps = msg.gpsLocation
gps.flags = 1 gps.flags = 1
gps.latitude = report["t_DblFinalPosLatLon[0]"] * 180/math.pi gps.latitude = report["t_DblFinalPosLatLon[0]"] * 180/math.pi
gps.longitude = report["t_DblFinalPosLatLon[1]"] * 180/math.pi gps.longitude = report["t_DblFinalPosLatLon[1]"] * 180/math.pi
@ -220,7 +219,7 @@ def main() -> NoReturn:
gps.bearingAccuracyDeg = report["q_FltHeadingUncRad"] * 180/math.pi gps.bearingAccuracyDeg = report["q_FltHeadingUncRad"] * 180/math.pi
gps.speedAccuracy = math.sqrt(sum([x**2 for x in vNEDsigma])) gps.speedAccuracy = math.sqrt(sum([x**2 for x in vNEDsigma]))
pm.send('gpsLocationExternal', msg) pm.send('gpsLocation', msg)
if log_type in [LOG_GNSS_GPS_MEASUREMENT_REPORT, LOG_GNSS_GLONASS_MEASUREMENT_REPORT]: if log_type in [LOG_GNSS_GPS_MEASUREMENT_REPORT, LOG_GNSS_GLONASS_MEASUREMENT_REPORT]:
msg = messaging.new_message('qcomGnss') msg = messaging.new_message('qcomGnss')

Loading…
Cancel
Save