added gy80 dcm
Dependencies: mbed DCM_AHRS_GY80 PID MMA8451Q
Fork of quadCommand by
Diff: quadCommand/quadCommand.cpp
- Revision:
- 41:40e432c5cbe6
- Parent:
- 34:d6696dc977a2
- Child:
- 42:9b5d58070e92
diff -r e57a5effd05e -r 40e432c5cbe6 quadCommand/quadCommand.cpp --- a/quadCommand/quadCommand.cpp Mon Jun 10 01:17:58 2013 +0000 +++ b/quadCommand/quadCommand.cpp Mon Jun 10 01:37:36 2013 +0000 @@ -70,14 +70,14 @@ roll = pidRoll.correct(currentRoll, targetRoll, MOTOR_UPDATE); yaw = 0.0; //pidYaw.correct(currentYaw, targetYaw, MOTOR_UPDATE); - DEBUG(pc.printf("att : { t : %f, p : %f, r : %f, y : %f }", throttle, pitch, roll, yaw);) + DEBUG(pc.printf("att : { t : %f, p : %f, r : %f, y : %f }\r\n", throttle, pitch, roll, yaw);) int speed0 = throttle + pitch - roll - yaw; int speed1 = throttle + pitch + roll + yaw; int speed2 = throttle - pitch + roll - yaw; int speed3 = throttle - pitch - roll + yaw; - DEBUG(pc.printf("motor : [ %f , %f , %f , %f ]", speed0, speed1, speed2, speed3);) + DEBUG(pc.printf("motor : [ %f , %f , %f , %f ]\r\n", speed0, speed1, speed2, speed3);) myMotors[ 0 ]->setSpeed(speed0); // Motor 1 myMotors[ 1 ]->setSpeed(speed1); // Motor 2