control for robotic arm that can play chess using a granular gripper

Dependencies:   Encoder mbed HIDScope Servo MODSERIAL

Fork of chessRobot by a steenbeek

Revision:
60:20945383ad1b
Parent:
57:43f707648f2b
Child:
62:6c566e6f9664
--- a/debug.cpp	Mon Oct 12 12:16:58 2015 +0200
+++ b/debug.cpp	Mon Oct 12 11:46:05 2015 +0000
@@ -11,19 +11,19 @@
 HIDScope scope(5);
 
 void debugProcess(){
-    scope.set(0, Kp);
-	scope.set(1, Ki);
-	scope.set(2, Kd);
+    scope.set(0, motor2PID.getKp());
+	scope.set(1, motor2PID.getKi());
+	scope.set(2, motor2PID.getKd());
 	scope.set(3, motor2SetSpeed);
 	scope.set(4, motor2Speed);
     scope.send();
 }
 
-#elif
+#else
 HIDScope scope(4);
 
 void debugProcess(){
-    scope.set(0, pidOut);
+    scope.set(0, motor2Pos);
 	scope.set(1, motor2SetSpeed);
 	scope.set(2, motor2Speed);
 	scope.set(3, motor2PWM);