Project Paint / Mbed 2 deprecated arm_control

Dependencies:   mbed QEI biquadFilter

Revision:
3:1f47375270c5
Parent:
2:fc869e45e672
Child:
7:a80cb6b06320
--- a/robot_test.cpp	Wed Nov 02 08:51:12 2016 +0000
+++ b/robot_test.cpp	Wed Nov 02 09:10:43 2016 +0000
@@ -21,11 +21,12 @@
     float lower;
     readArmLengths(upper, lower);
     
-    pc.printf("Lower: %f, Upper: %f\n\r", lower, upper);
+    pc.printf("Reference: Lower: %f, Upper: %f\n\r", lower, upper);
+    pc.printf("Encoder:   Lower: %f, Upper: %f\n\r", robot.getLowerArmLength(), robot.getUpperArmLength());
     
 //    robot.setArms(upper, lower);
-//    robot.setLowerArmVelocity(2);
-//    robot.setUpperArmVelocity(1);
+    robot.setLowerArmVelocity(2);
+    robot.setUpperArmVelocity(1);
     
 }