SITL: fixed airspeed in last_letter

This commit is contained in:
Andrew Tridgell 2015-05-23 11:37:21 +10:00
parent ae6ac1b82d
commit 2d53a1ff9a

View File

@ -107,8 +107,7 @@ void last_letter::recv_fdm(const struct sitl_input &input)
location.alt = pkt.altitude*1.0e2;
dcm.from_euler(pkt.roll, pkt.pitch, pkt.yaw);
// assume zero wind for now
airspeed = velocity_ef.length();
airspeed = pkt.airspeed;
// auto-adjust to last_letter frame rate
uint64_t deltat_us = pkt.timestamp_us - last_timestamp_us;