Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-03 14:38:30 -04:00
Code Issues Packages Projects Releases Wiki Activity

Replay: set last sample time for GPS

Browse Source
This commit is contained in:
Andrew Tridgell 2016-05-05 16:04:28 +10:00
parent 5ddb872b79
commit dbe9091d58
1 changed files with 5 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
Tools/Replay/LR_MsgHandler.cpp
View File

@ -204,8 +204,12 @@ void LR_MsgHandler_GPA_Base::update_from_msg_gpa(uint8_t gps_offset, uint8_t *ms
if (! field_value(msg, "VV", have_vertical_velocity)) { if (! field_value(msg, "VV", have_vertical_velocity)) {
have_vertical_velocity = !is_zero(gps.velocity(gps_offset).z); have_vertical_velocity = !is_zero(gps.velocity(gps_offset).z);
} }
uint32_t sample_ms;
if (! field_value(msg, "SMS", sample_ms)) {
sample_ms = 0;
}
gps.setHIL_Accuracy(gps_offset, vdop*0.01f, hacc*0.01f, vacc*0.01f, sacc*0.01f, have_vertical_velocity); gps.setHIL_Accuracy(gps_offset, vdop*0.01f, hacc*0.01f, vacc*0.01f, sacc*0.01f, have_vertical_velocity, sample_ms);
} }
void LR_MsgHandler_GPA::process_message(uint8_t *msg) void LR_MsgHandler_GPA::process_message(uint8_t *msg)