motor test
Dependencies: omni_wheel PID jy901 solenoid aqm0802 camera beep kohiMD linesSnsor lpf RCJESC
Diff: main.cpp
- Revision:
- 0:072b6518ad9a
diff -r 000000000000 -r 072b6518ad9a main.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Thu Jan 30 15:45:14 2020 +0000 @@ -0,0 +1,48 @@ +#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(); + } + } +} \ No newline at end of file