bio robot

Dependencies:   MPU6050-DMP QEI_hw mbed-rpc mbed

Fork of MPU6050_Example by Shundo Kishi

Revision:
6:12b6be801ad8
Parent:
5:c3d671959ef3
Child:
7:7efcd3bf3302
--- a/main.cpp	Thu Dec 03 04:52:45 2015 +0000
+++ b/main.cpp	Thu Dec 03 05:52:55 2015 +0000
@@ -14,6 +14,17 @@
 
 Comm comm(&gains, &target, &myMPU6050_1);
 
+int main() {
+    
+    while(1) {
+        myMPU6050_1.loop();
+        comm.check();
+        comm.printPosition();
+    }
+}
+
+
+//wrappers for comm stack
 void openGripper1Wrapper(Arguments * input, Reply * output){
     comm.openGripper1(input, output);
 };
@@ -42,16 +53,4 @@
 
 
 
-int main() {
-    
-    while(1) {
-        myMPU6050_1.loop();
-        
-        comm.check();
-        comm.printPosition();
-    }
-}
 
-
-
-