gohome ok

Dependencies:   mbed HCSR04

Revision:
7:459f81b0b6c6
Parent:
6:68cb6e3d9623
Child:
8:dd676df43fe7
--- a/main.cpp	Mon Dec 20 23:24:35 2021 +0000
+++ b/main.cpp	Mon Dec 20 23:43:11 2021 +0000
@@ -19,7 +19,7 @@
 #define DEC_CLEAN 1000
 
 #define KICK 2000
-#define CLEAN_OFFSET 6000
+#define CLEAN_OFFSET 2000
 
 #define WALL 45
 #define WALL_MIN 25
@@ -199,7 +199,8 @@
     while(1){
                 
         Time = t.read();
-        pc.printf("state_1:%d  state_2:%d\r\n",state_1,state_2);         
+        //pc.printf("state_1:%d  state_2:%d\r\n",state_1,state_2);
+        pc.printf("state_1:%d state_2:%d ACT:%d TMP:%d \r\n",state_1,state_2,ActPos,X_POS_TMP);
         readActPos(1);
         ActPos=canmsgRx.data[4]+canmsgRx.data[5]*256+canmsgRx.data[6]*65536;
         if(ActPos > 8388608){