Dataflash: Clamp GPS accuracy values

This commit is contained in:
Michael du Breuil 2017-04-16 15:56:55 -07:00 committed by Francisco Ferreira
parent fd866d3e20
commit 994790be0b

View File

@ -682,9 +682,9 @@ void DataFlash_Class::Log_Write_GPS(const AP_GPS &gps, uint8_t i, uint64_t time_
LOG_PACKET_HEADER_INIT((uint8_t)(LOG_GPA_MSG+i)),
time_us : time_us,
vdop : gps.get_vdop(i),
hacc : (uint16_t)(hacc*100),
vacc : (uint16_t)(vacc*100),
sacc : (uint16_t)(sacc*100),
hacc : (uint16_t)MIN((hacc*100), UINT16_MAX),
vacc : (uint16_t)MIN((vacc*100), UINT16_MAX),
sacc : (uint16_t)MIN((sacc*100), UINT16_MAX),
have_vv : (uint8_t)gps.have_vertical_velocity(i),
sample_ms : gps.last_message_time_ms(i)
};