FRC_equipe1 / Mbed 2 deprecated FRC_2019

Dependencies:   mbed

main.cpp

Committer:
Wael_H
Date:
2019-05-23
Revision:
9:2113adf37c66
Parent:
8:94ecfe411d02
Child:
10:efa507ba2b35

File content as of revision 9:2113adf37c66:

#include "mbed.h"
#include "CAN_asser.h"
#include "Deplacement.h"

void automate_test(Deplacement& R);

int main(void)
{
    Deplacement robot;
    
    while(1)
        automate_test(robot);
            
}

void automate_test(Deplacement& R)
{
    typedef enum {AVANCE, TOURNE} type_etat;
    static type_etat etat = AVANCE;
    
    switch(etat)
    {
        case AVANCE:
            if(R.avance(500))
                etat = TOURNE;
            break;
            
        case TOURNE:
            if(R.tourne(900))
                etat = AVANCE;
            break;
    }
}