AP_GPS: Only inject RTCM data to the selected GPS device defined in GPS_INJECT_TO parameter

This commit is contained in:
Dr.-Ing. Amilcar Do Carmo Lucas
2017-05-01 13:06:18 +01:00
committed by Francisco Ferreira
parent 12f83ecf75
commit 5261654756
+2 -2
View File
@@ -963,7 +963,7 @@ void AP_GPS::handle_gps_rtcm_data(const mavlink_message_t *msg)
if ((packet.flags & 1) == 0) {
// it is not fragmented, pass direct
inject_data_all(packet.data, packet.len);
inject_data(packet.data, packet.len);
return;
}
@@ -1013,7 +1013,7 @@ void AP_GPS::handle_gps_rtcm_data(const mavlink_message_t *msg)
if (rtcm_buffer->fragment_count != 0 &&
rtcm_buffer->fragments_received == (1U << rtcm_buffer->fragment_count) - 1) {
// we have them all, inject
inject_data_all(rtcm_buffer->buffer, rtcm_buffer->total_length);
inject_data(rtcm_buffer->buffer, rtcm_buffer->total_length);
memset(rtcm_buffer, 0, sizeof(*rtcm_buffer));
}
}