right and left move at the same time

Dependencies:   mbed robot

Revision:
10:2973cea54efd
Parent:
9:ac95473a5d86
Child:
11:0522b336eb82
--- a/main.cpp	Wed May 08 02:56:21 2019 +0000
+++ b/main.cpp	Wed May 08 08:21:08 2019 +0000
@@ -59,6 +59,8 @@
     motor_ri.setDutyLimit(0.5);
 
     reset();
+    for(int i=0; i<5; ++i)
+        servo.set_degree(0,0);
     bus_out = 1;
     printf("start\n\r");
     int mode = -1;
@@ -72,6 +74,7 @@
         motor_ri.setDutyLimit(duty);
         if(hand_mode == GEREGE) {
             air_hand = 0;
+            
         } else if(hand_mode == GOAL) {
             for(int i=0; i<10; ++i)
                 servo.set_degree(0,(7200 - 3500) * 270.0/(11500 - 3500));