Browse Source

AP_GPS: tidy mavlink message handling using switch statement

master
Peter Barker 8 years ago committed by Francisco Ferreira
parent
commit
e7ff5107fb
  1. 15
      libraries/AP_GPS/AP_GPS.cpp

15
libraries/AP_GPS/AP_GPS.cpp

@ -751,21 +751,24 @@ void AP_GPS::handle_gps_inject(const mavlink_message_t *msg) @@ -751,21 +751,24 @@ void AP_GPS::handle_gps_inject(const mavlink_message_t *msg)
*/
void AP_GPS::handle_msg(const mavlink_message_t *msg)
{
if (msg->msgid == MAVLINK_MSG_ID_GPS_RTCM_DATA) {
switch (msg->msgid) {
case MAVLINK_MSG_ID_GPS_RTCM_DATA:
// pass data to de-fragmenter
handle_gps_rtcm_data(msg);
return;
}
if (msg->msgid == MAVLINK_MSG_ID_GPS_INJECT_DATA) {
break;
case MAVLINK_MSG_ID_GPS_INJECT_DATA:
handle_gps_inject(msg);
return;
}
break;
default: {
uint8_t i;
for (i=0; i<num_instances; i++) {
if ((drivers[i] != nullptr) && (_type[i] != GPS_TYPE_NONE)) {
drivers[i]->handle_msg(msg);
}
}
break;
}
}
}
/*

Loading…
Cancel
Save