Kanta Takasu
/
YUKA_FIN
gohome ok
Diff: main.cpp
- 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){