涼太郎 中村 / Mbed 2 deprecated 6th33222_copy

a

Dependencies:   Locate Move Servo button mbed

Fork of 4thcomp by 涼太郎 中村

Diff: main.cpp

Revision:
19:e3383efa483b
Parent:
18:aa8c08f6f474
Child:
20:4b8ce61a00b2
diff -r aa8c08f6f474 -r e3383efa483b main.cpp
--- a/main.cpp	Sun Sep 11 11:40:17 2016 +0000
+++ b/main.cpp	Sun Sep 11 12:05:39 2016 +0000
@@ -146,23 +146,19 @@
     
     
     if(phase==1){
-        
+        open_arm();
+        open_hand();
      pmove(targetx[7],targety[7]);
-     back300();
-     pmove2(goalx,goaly);
+     close_arm();
+     close_hand();
+     nxback300();
+     pmove2(150,900+slidedist);
      turnrad_ccw(PI,team);
      open_arm();
      open_hand();
      back300();
      
-     pmove2(900,600+slidedist);
-     
-        pmove(targetx[5],targety[5]);
-        pmove2(goalx,goaly);
-        turnrad_ccw(2*PI,team);
-        open_arm();
-        open_hand();
-        back300();
+    pmove2(2100,1200);
         
     }