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:
110:a6439e13be8b
Parent:
100:222c27f55b85
Child:
121:6d8f1bdcda05
diff -r 026abd708dce -r a6439e13be8b debug.cpp
--- a/debug.cpp	Mon Oct 26 12:45:41 2015 +0000
+++ b/debug.cpp	Tue Oct 27 14:45:15 2015 +0000
@@ -7,8 +7,8 @@
 // all the debugging functions
 
 // #define TUNEPID  // set to switch between normal opperation or tuning PID
- #define TUNEEMG // set hdiscope for EMG
-//#define TUNEPWM // set hidscope for rest
+// #define TUNEEMG // set hdiscope for EMG
+#define TUNEPWM // set hidscope for rest
 
 #ifdef TUNEPID
 HIDScope scope(5);
@@ -25,13 +25,14 @@
 
 #endif
 #ifdef TUNEPWM
-HIDScope scope(4);
+HIDScope scope(5);
 
 void debugProcess(){
     scope.set(0, motor2Pos);
 	scope.set(1, motor2SetSpeed);
 	scope.set(2, motor2Speed);
 	scope.set(3, motor2PWM);
+	scope.set(4, 1300 + 700*servoSpeed);
     scope.send();
 }