diff --git a/cereal/log.capnp b/cereal/log.capnp index 7b6076311f..593399f832 100644 --- a/cereal/log.capnp +++ b/cereal/log.capnp @@ -1586,6 +1586,10 @@ struct UbloxGnss { svId @0 :UInt8; gnssId @1 :UInt8; flagsBitfield @2 :UInt32; + cno @3 :UInt8; + elevationDeg @4 :Int8; + azimuthDeg @5 :Int16; + pseudorangeResidual @6 :Float32; } } diff --git a/system/ubloxd/ublox_msg.cc b/system/ubloxd/ublox_msg.cc index 22c99501f3..728f3b15fa 100644 --- a/system/ubloxd/ublox_msg.cc +++ b/system/ubloxd/ublox_msg.cc @@ -476,6 +476,10 @@ kj::Array UbloxMsgParser::gen_nav_sat(ubx_t::nav_sat_t *msg) { svs[i].setSvId(svs_data[i]->sv_id()); svs[i].setGnssId(svs_data[i]->gnss_id()); svs[i].setFlagsBitfield(svs_data[i]->flags()); + svs[i].setCno(svs_data[i]->cno()); + svs[i].setElevationDeg(svs_data[i]->elev()); + svs[i].setAzimuthDeg(svs_data[i]->azim()); + svs[i].setPseudorangeResidual(svs_data[i]->pr_res() * 0.1); } return capnp::messageToFlatArray(msg_builder);