motor test
Dependencies: omni_wheel PID jy901 solenoid aqm0802 camera beep kohiMD linesSnsor lpf RCJESC
main.cpp
- Committer:
- piroro4560
- Date:
- 2020-01-30
- Revision:
- 0:072b6518ad9a
File content as of revision 0:072b6518ad9a:
#include "mbed.h" #include "robot.h" #include "sensorGen.h" #include "aqm0802.h" #include "beep.h" sensor sensor; robot robo; int main() { const bool test = true; while(1) { if (!test) //test { if () //白線踏んでない { if () //ボール持ってない { if () //ボール見えてる -> chaseBall { robo.chaseBall( , ); } else //ボールみえてない -> searchBall { robo.searchBall(); } } else //ボール持ってる { if () //ゴール見える -> moveGoal { robo.moveGoal(); } else //ゴール見えない -> detour { robo.detour(); } } } else //踏んだ { } } else { test(); } } }