Support two RTCM links with the same corrections

Add selected_rtcm_instance to sensor_gps message to track loss of rtcm links

Publish _rate_rtcm_injection
This commit is contained in:
alexklimaj
2022-07-15 08:20:27 +02:00
committed by Beat Küng
parent 1e55b69fdb
commit f9b8ca1326
5 changed files with 35 additions and 3 deletions
+2
View File
@@ -2603,6 +2603,8 @@ MavlinkReceiver::handle_message_gps_rtcm_data(mavlink_message_t *msg)
gps_inject_data_s gps_inject_data_topic{};
gps_inject_data_topic.timestamp = hrt_absolute_time();
gps_inject_data_topic.len = math::min((int)sizeof(gps_rtcm_data_msg.data),
(int)sizeof(uint8_t) * gps_rtcm_data_msg.len);
gps_inject_data_topic.flags = gps_rtcm_data_msg.flags;