From eaf746b7fd64dd97dd44cb622a3c2b7fe03013d8 Mon Sep 17 00:00:00 2001 From: Andrew Tridgell Date: Wed, 2 Apr 2014 19:08:35 +1100 Subject: [PATCH] Replay: fixed velocity vector --- Tools/Replay/LogReader.cpp | 8 ++++---- 1 file changed, 4 insertions(+), 4 deletions(-) diff --git a/Tools/Replay/LogReader.cpp b/Tools/Replay/LogReader.cpp index fe07cc9517..083e262de4 100644 --- a/Tools/Replay/LogReader.cpp +++ b/Tools/Replay/LogReader.cpp @@ -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) 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,