![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
added gy80 dcm
Dependencies: mbed DCM_AHRS_GY80 PID MMA8451Q
Fork of quadCommand by
Diff: quadCommand/quadCommand.cpp
- Revision:
- 54:6fc1c3b14bc8
- Parent:
- 53:cce34958f952
--- a/quadCommand/quadCommand.cpp Tue Jun 11 02:36:12 2013 +0000 +++ b/quadCommand/quadCommand.cpp Wed Jun 12 17:01:00 2013 +0000 @@ -66,7 +66,7 @@ } /*************************** updateMotors() ******************************/ -/*Called in main by motorprocess */ +/*Interrupt function declared in constructor */ /*************************************************************************/ void quadCommand::updateMotors() @@ -74,7 +74,8 @@ updateCurrent(); float throttle, pitch, roll, yaw; - throttle = pidThrottle.correct(currentThrottle, targetThrottle, MOTOR_UPDATE); + throttle = pidThrottle.c + currentThrottle, targetThrottle, MOTOR_UPDATE); pitch = pidPitch.correct(currentPitch, targetPitch, MOTOR_UPDATE); roll = pidRoll.correct(currentRoll, targetRoll, MOTOR_UPDATE); yaw = 0.0; //pidYaw.correct(currentYaw, targetYaw, MOTOR_UPDATE);