a

Dependencies:   Locate Move Servo button mbed

Fork of 2ndcomp by 涼太郎 中村

Revision:
6:931d51a70200
Parent:
5:97d9a34e5016
Child:
7:43692ae2d20a
--- a/main.cpp	Sat Sep 03 10:53:43 2016 +0000
+++ b/main.cpp	Mon Sep 05 10:39:03 2016 +0000
@@ -7,8 +7,16 @@
 {
     setup();
     initmotor();
-    
-    pmovex(900);
+
+    wait(1);
+
+    while(1) {
+        pmove_to_dir(X_PLUS, 600, 0);
+        pmove_to_dir(Y_PLUS, 600, 600);
+        pmove_to_dir(X_MINUS, 0, 600);
+        pmove_to_dir(Y_MINUS, 0, 0);
+    }
+    //turn_abs_rad(PI/2);
 
     while(1) {
         update();