Browse Source

Replay: fixed velocity vector

mission-4.1.18
Andrew Tridgell 11 years ago
parent
commit
eaf746b7fd
  1. 8
      Tools/Replay/LogReader.cpp

8
Tools/Replay/LogReader.cpp

@ -379,8 +379,8 @@ bool LogReader::update(uint8_t &type) @@ -379,8 +379,8 @@ bool LogReader::update(uint8_t &type)
loc.alt = msg.altitude;
loc.options = 0;
Vector3f vel(msg.ground_speed*0.01f*cosf(msg.ground_course*0.01f),
msg.ground_speed*0.01f*sinf(msg.ground_course*0.01f),
Vector3f vel(msg.ground_speed*0.01f*cosf(radians(msg.ground_course*0.01f)),
msg.ground_speed*0.01f*sinf(radians(msg.ground_course*0.01f)),
msg.vel_z);
gps.setHIL(0, (AP_GPS::GPS_Status)msg.status,
msg.apm_time,
@ -410,8 +410,8 @@ bool LogReader::update(uint8_t &type) @@ -410,8 +410,8 @@ bool LogReader::update(uint8_t &type)
loc.alt = msg.altitude;
loc.options = 0;
Vector3f vel(msg.ground_speed*0.01f*cosf(msg.ground_course*0.01f),
msg.ground_speed*0.01f*sinf(msg.ground_course*0.01f),
Vector3f vel(msg.ground_speed*0.01f*cosf(radians(msg.ground_course*0.01f)),
msg.ground_speed*0.01f*sinf(radians(msg.ground_course*0.01f)),
msg.vel_z);
gps.setHIL(1, (AP_GPS::GPS_Status)msg.status,
msg.apm_time,

Loading…
Cancel
Save