回避行動用のプログラムです。 (モータードライバー+超音波センサー)

Dependencies:   ATP3012 mbed a HMC US015_2 getGPS

Revision:
1:1c4c7cd015e8
Parent:
0:99f4fe3e21c6
--- a/main.cpp	Wed Dec 01 08:14:01 2021 +0000
+++ b/main.cpp	Fri Dec 03 08:24:39 2021 +0000
@@ -6,14 +6,10 @@
     while(1) {
     Move('2', 0.3);
         while(FrontGet()) {
-        xbee.printf("front get\n\r");
         Move('1', 0);      //停止
-        xbee.printf("mortor mode:1 speed:0\n\r");
-        Move('4', 0.3);    //時計回り回転
-        xbee.printf("mortor mode:4 speed:0.5\n\r");
-        wait(1);
+        Move('4', 0.2);    //時計回り回転
+        wait(0.5);
         Move('1', 0);      //回転停止
-        xbee.printf("mortor mode:1 speed:0\n\r");
         }
     }
 }