motor test

Dependencies:   omni_wheel PID jy901 solenoid aqm0802 camera beep kohiMD linesSnsor lpf RCJESC

Revision:
0:072b6518ad9a
--- /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