Browse Source

AP_GPS: fixed vertical velocity in Replay

fixed NavEKF use of velocity velocity
master
Andrew Tridgell 10 years ago
parent
commit
3354cb37d0
  1. 1
      libraries/AP_GPS/AP_GPS.cpp

1
libraries/AP_GPS/AP_GPS.cpp

@ -411,6 +411,7 @@ AP_GPS::setHIL(uint8_t instance, GPS_Status _status, uint64_t time_epoch_ms, @@ -411,6 +411,7 @@ AP_GPS::setHIL(uint8_t instance, GPS_Status _status, uint64_t time_epoch_ms,
istate.location = _location;
istate.location.options = 0;
istate.velocity = _velocity;
istate.have_vertical_velocity = true;
istate.ground_speed = pythagorous2(istate.velocity.x, istate.velocity.y);
istate.ground_course_cd = degrees(atan2f(istate.velocity.y, istate.velocity.x)) * 100UL;
istate.hdop = hdop;

Loading…
Cancel
Save