|
|
@ -108,14 +108,18 @@ def gps_callback(gps, vehicle_state): |
|
|
|
] |
|
|
|
] |
|
|
|
|
|
|
|
|
|
|
|
dat.gpsLocationExternal = { |
|
|
|
dat.gpsLocationExternal = { |
|
|
|
|
|
|
|
"timestamp": int(time.time() * 1000), |
|
|
|
"flags": 1, # valid fix |
|
|
|
"flags": 1, # valid fix |
|
|
|
|
|
|
|
"accuracy": 1.0, |
|
|
|
"verticalAccuracy": 1.0, |
|
|
|
"verticalAccuracy": 1.0, |
|
|
|
"speedAccuracy": 0.1, |
|
|
|
"speedAccuracy": 0.1, |
|
|
|
|
|
|
|
"bearingAccuracyDeg": 0.1, |
|
|
|
"vNED": velNED, |
|
|
|
"vNED": velNED, |
|
|
|
"bearingDeg": vehicle_state.bearing_deg, |
|
|
|
"bearingDeg": vehicle_state.bearing_deg, |
|
|
|
"latitude": gps.latitude, |
|
|
|
"latitude": gps.latitude, |
|
|
|
"longitude": gps.longitude, |
|
|
|
"longitude": gps.longitude, |
|
|
|
"altitude": gps.altitude, |
|
|
|
"altitude": gps.altitude, |
|
|
|
|
|
|
|
"speed": vehicle_state.speed, |
|
|
|
"source": log.GpsLocationData.SensorSource.ublox, |
|
|
|
"source": log.GpsLocationData.SensorSource.ublox, |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|