Robot secondaire
Dependencies: RoboClaw mbed StepperMotor
Fork of RoboClaw by
Diff: main.cpp
- Revision:
- 77:f19cc7f81f2a
- Parent:
- 51:1056dd73a748
--- a/main.cpp Wed May 04 16:15:13 2016 +0000 +++ b/main.cpp Thu May 05 08:46:08 2016 +0000 @@ -51,6 +51,7 @@ int SIMON_i = 0, SIMON_state = 0, SCouleur = VERT, SStart = 0, SSchema = 1; bool SIMON_EL = false, SIMON_EZ = false, SIMON_ER = false, SGauche = false, SDevant = false, SDroite = false; +bool Sharps_actives = true; bool SHomologation = false; void init(void); void update_main(void); @@ -58,8 +59,31 @@ /* Debut du programme */ int main(void) { - logger.printf("Depart homologation !\n\r"); - homologation(); + /*logger.printf("Depart homologation !\n\r"); + LEDV = 1; + LEDR = 0; + odo.setPos(110, 1000, 0); + roboclaw.ResetEnc(); + roboclaw.ForwardM1(0); + roboclaw.ForwardM2(0); + wait_ms(100); + while(START==0); + odo.GotoXY(1000, 1000);*/ + odo.setPos(110,850,0); + init_interrupt(); + while(START==0); + odo.GotoXY(450,850); + odo.GotoXY(1050,1100); + odo.GotoXY(700,1100); + SHomologation = true; + odo.GotoXY(250,850); + odo.GotoXY(250,400); + odo.GotoXY(800,400); + odo.GotoXY(800,800); + + LEDV = 1; + while(1); + //homologation(); /*drapeau = 0; init();