Robot secondaire

Dependencies:   RoboClaw mbed StepperMotor

Fork of RoboClaw by Simon Emarre

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