can出来ない~

Dependencies:   mbed move4wheel2 EC CruizCore_R1370P

Revision:
10:6d60c0927770
Parent:
9:337fe0747940
--- a/main.cpp	Wed Mar 06 03:51:08 2019 +0000
+++ b/main.cpp	Wed Mar 06 06:19:53 2019 +0000
@@ -46,6 +46,7 @@
 
         //スタート位置からみかんの木まで移動
         printf("T1 = 0\n\r");
+        wait(0.5);
         T1++;
         //printf("t = %d\n\r",T1);
     }
@@ -54,7 +55,7 @@
         while(1) {
             printf("T1 = 1\n\r");
             wait(0.5);
-            if(T1 == 2) {
+            if(T1 > 1) {
                 break;
             }
         }
@@ -70,7 +71,8 @@
     if(T1 == 3) {
         while(1) {
             printf("T1 = 3\n\r");
-            if(T1 == 4) {
+            wait(0.5);
+            if(T1 > 3) {
                 
                 break;
             }
@@ -80,13 +82,16 @@
     if(T1 == 4) {
 
         //三宝置き場からりんごの木まで移動
-        printf("t = 4");
+        printf("T1 = 4\n\r");
+        wait(0.5);
         T1++;
     }
 
     if(T1 == 5) {
         while(1) {
-            if(T1 == 6) {
+            printf("T1 = 5\n\r");
+            wait(0.5);
+            if(T1 > 5) {
                 break;
             }
         }
@@ -95,7 +100,8 @@
     if(T1 == 6) {
 
         //りんごの木からお供え台まで移動
-        printf("t = 6");
+        printf("T1 = 6\n\r");
+        wait(0.5);
         T1++;
     }
 #endif