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();
        }
    }
}