Emaxx Navigation Group / Mbed 2 deprecated Emaxx_Navigation_Dynamic_HIL

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   BNO055_fusion Vehicle_Model MODSERIAL ServoIn ServoOut mbed

Fork of Emaxx_Navigation by Emaxx Navigation Group

Diff: main.cpp

Revision:
3:9b6db94aa2b3
Parent:
2:0c9c3c1f3b18
Child:
4:e27ca0c82814
diff -r 0c9c3c1f3b18 -r 9b6db94aa2b3 main.cpp
--- a/main.cpp	Thu Aug 25 15:47:50 2016 +0000
+++ b/main.cpp	Wed Sep 14 18:19:50 2016 +0000
@@ -250,7 +250,7 @@
                         psi_err = wrapToPi(des_psi-imu.euler.yaw);
                         spd_err = des_spd - ekf.getSpd();
                         spd_err_i += spd_err;
-                        str = -Kp_psi*psi_err;
+                        str = -Kp_psi*psi_err/ekf.getSpd();
 
                         thr =  Kp_spd*spd_err + Ki_spd*spd_err_i/LOOP_RATE;