|
|
@ -810,11 +810,13 @@ AP_GPS_UBLOX::_parse_gps(void) |
|
|
|
break; |
|
|
|
break; |
|
|
|
case MSG_MON_VER: |
|
|
|
case MSG_MON_VER: |
|
|
|
_have_version = true; |
|
|
|
_have_version = true; |
|
|
|
|
|
|
|
strncpy(_version.hwVersion, _buffer.mon_ver.hwVersion, sizeof(_version.hwVersion)); |
|
|
|
|
|
|
|
strncpy(_version.swVersion, _buffer.mon_ver.swVersion, sizeof(_version.swVersion)); |
|
|
|
GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_INFO,
|
|
|
|
GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_INFO,
|
|
|
|
"u-blox %d HW: %s SW: %s", |
|
|
|
"u-blox %d HW: %s SW: %s", |
|
|
|
state.instance + 1, |
|
|
|
state.instance + 1, |
|
|
|
_buffer.mon_ver.hwVersion, |
|
|
|
_version.hwVersion, |
|
|
|
_buffer.mon_ver.swVersion); |
|
|
|
_version.swVersion); |
|
|
|
break; |
|
|
|
break; |
|
|
|
default: |
|
|
|
default: |
|
|
|
unexpected_message(); |
|
|
|
unexpected_message(); |
|
|
@ -1319,3 +1321,15 @@ float AP_GPS_UBLOX::get_lag(void) const |
|
|
|
break; |
|
|
|
break; |
|
|
|
}; |
|
|
|
}; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void AP_GPS_UBLOX::Write_DataFlash_Log_Startup_messages() const |
|
|
|
|
|
|
|
{ |
|
|
|
|
|
|
|
AP_GPS_Backend::Write_DataFlash_Log_Startup_messages(); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if (_have_version) { |
|
|
|
|
|
|
|
gps._DataFlash->Log_Write_MessageF("u-blox %d HW: %s SW: %s", |
|
|
|
|
|
|
|
state.instance+1, |
|
|
|
|
|
|
|
_version.hwVersion, |
|
|
|
|
|
|
|
_version.swVersion); |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
} |
|
|
|