From 42a943b37ea078d66c9b57ce21b14c266406eddf Mon Sep 17 00:00:00 2001 From: Paul Riseborough Date: Sun, 7 Feb 2016 21:49:50 +1100 Subject: [PATCH] EKF: Fix text errors introduced when editing optical flow fusion autocode fragment --- matlab/generated/Inertial Nav EKF/Optical Flow Fusion.txt | 6 +++--- 1 file changed, 3 insertions(+), 3 deletions(-) diff --git a/matlab/generated/Inertial Nav EKF/Optical Flow Fusion.txt b/matlab/generated/Inertial Nav EKF/Optical Flow Fusion.txt index 35ee9faef6..5320af7b77 100644 --- a/matlab/generated/Inertial Nav EKF/Optical Flow Fusion.txt +++ b/matlab/generated/Inertial Nav EKF/Optical Flow Fusion.txt @@ -7,11 +7,11 @@ float SH_LOS[7]; SH_LOS[0] = sq(q0) - sq(q1) - sq(q2) + sq(q3); SH_LOS[1] = vn*(sq(q0) + sq(q1) - sq(q2) - sq(q3)) - vd*(2.0f*q0*q2 - 2.0f*q1*q3) + ve*(2.0f*q0*q3 + 2.0f*q1*q2); -SH_LOS[2] = ve*(sq(q0) - sq(q1) + sq(q2) - sq(q3)) + vd*(2.0f*q0*q1 + 2.0f*q2.0f*q3) - vn*(2.0f*q0*q3 - 2.0f*q1*q2); +SH_LOS[2] = ve*(sq(q0) - sq(q1) + sq(q2) - sq(q3)) + vd*(2.0f*q0*q1 + 2.0f*q2*q3) - vn*(2.0f*q0*q3 - 2.0f*q1*q2); SH_LOS[3] = 1.0f/(pd - ptd); -SH_LOS[4] = vd*SH_LOS[0] - ve*(2.0f*q0*q1 - 2.0f*q2.0f*q3) + vn*(2.0f*q0*q2 + 2.0f*q1*q3); +SH_LOS[4] = vd*SH_LOS[0] - ve*(2.0f*q0*q1 - 2.0f*q2*q3) + vn*(2.0f*q0*q2 + 2.0f*q1*q3); SH_LOS[5] = 2.0f*q0*q2 - 2.0f*q1*q3; -SH_LOS[6] = 2.0f*q0*q1 + 2.0f*q2.0f*q3; +SH_LOS[6] = 2.0f*q0*q1 + 2.0f*q2*q3; // Calculate the observation jacobians for the LOS rate about the X body axis float H_LOS[24];