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:
5:73bfad06b775
Parent:
3:47c76be6d402
Child:
6:b957d8809e7c
--- a/main.cpp	Mon Oct 05 16:15:25 2015 +0200
+++ b/main.cpp	Mon Oct 05 17:35:02 2015 +0200
@@ -1,33 +1,22 @@
 #include "PID.h"
-#include "QEI.h"
 #include "mbed.h"
 #include "encoder.h"
 #include "config.h"  // settings and pin configurations
 
-
-// #define DEBUG // send debug data to serial console
+#define DEBUG // send debug data to HIDScope
 
-#ifdef DEBUG
-    #include "HIDScope.h"
-    HIDScope scope(1);
-#endif
+int main(){
 
-enablePins();
-motorInit(); 
+    #ifdef DEBUG
+        dubugInit();
+    #endif
 
-int main()
-{
-    Timer time; // create timer object
-    time.start(); // start the timer
-    
+    enablePins();
+    motorInit(); 
     while (true) {
         // checkSwitches();
         // readEMG();
         motorControl();
         // servoControl();
-
-        #ifdef DEBUG
-            debugProcess();
-        #endif
     }
 }
\ No newline at end of file