HAPSRG / Mbed 2 deprecated HAPStail

Dependencies:   mbed MatrixMath LPS25HB_I2C LSM9DS1 Matrix2 PIDcontroller LoopTicker SBUS_without_mainfile UsaPack solaESKF_wind Vector3 CalibrateMagneto FastPWM

Revision:
112:5a82800e1485
Parent:
111:00f991005d2d
Child:
114:ba221936d53a
diff -r 00f991005d2d -r 5a82800e1485 servo.cpp
--- a/servo.cpp	Thu Mar 17 01:30:08 2022 +0000
+++ b/servo.cpp	Fri Mar 18 10:21:45 2022 +0000
@@ -81,8 +81,8 @@
 
     scaledServoOut[0]=-de;
     scaledServoOut[1]=dr;
-    scaledMotorOut[0]=rc[2]+drobj*0.2f;
-    scaledMotorOut[1]=rc[2]-drobj*0.2f;
+    scaledMotorOut[0]=rc[2]+drobj*0.2f+updateValues.dT_command;
+    scaledMotorOut[1]=rc[2]-drobj*0.2f+updateValues.dT_command;
     
     float LP_servo = 0.2;
     for(int i = 0; i < sizeof(servoOut)/sizeof(servoOut[0]); i++)