From 1c7d9f43c1faae52d1bc8b9608db16284f78e3cc Mon Sep 17 00:00:00 2001 From: Jason Short Date: Sat, 2 Nov 2013 15:57:08 -0700 Subject: [PATCH] InertialNav: fix for get_velocity_xy forgot to sq --- libraries/AP_InertialNav/AP_InertialNav.cpp | 2 +- 1 file changed, 1 insertion(+), 1 deletion(-) diff --git a/libraries/AP_InertialNav/AP_InertialNav.cpp b/libraries/AP_InertialNav/AP_InertialNav.cpp index 4029113a9f..431dfa98fc 100644 --- a/libraries/AP_InertialNav/AP_InertialNav.cpp +++ b/libraries/AP_InertialNav/AP_InertialNav.cpp @@ -279,7 +279,7 @@ void AP_InertialNav::set_velocity_xy(float x, float y) // set_velocity_xy - set velocity in latitude & longitude directions (in cm/s) float AP_InertialNav::get_velocity_xy() { - return safe_sqrt(_velocity.x + _velocity.y); + return safe_sqrt(_velocity.x * _velocity.x + _velocity.y * _velocity.y); } //