m

Revision:
2:e0402d1e9ed5
Parent:
1:785b37686185
Child:
3:4810f8316e38
--- a/Strategie.cpp	Fri May 24 21:45:02 2019 +0000
+++ b/Strategie.cpp	Sun May 26 14:50:37 2019 +0000
@@ -70,6 +70,9 @@
     pompe.desactiver();
 }
 
+/*---------Debut Strategie homologation violet ------------------------------------------------------*/
+
+
 void strategieHomologationViolet(deplacement robot, Pompe pompe, Demarreur demarreur, Bras brasGauche, Bras brasDroit, BrasPousser brasPousserGauche,  BrasPousser brasPousserDroit)
 {
     write(bufferScore);
@@ -173,6 +176,33 @@
     while(1);
 }
 
+/*-------Fin Stratégie homologation violet------------------------------------------------------------*/
+
+
+/*-------Debut Strategie homologation jaune-----------------------------------------------------------*/
+
+void strategieHomologationJaune(deplacement robot, Pompe pompe, Demarreur demarreur, Bras brasGauche, Bras brasDroit, BrasPousser brasPousserGauche,  BrasPousser brasPousserDroit)
+{
+    write(bufferScore);
+    Timer tempsMatch; // timer en seconde
+    int etapeMatch = 0;
+    while(demarreur.getState() == false)
+    {
+        //on attend
+        //pc.printf("On attend le depart du Robot Thanos\n\r");
+    }
+    tempsArretMvt.attach(&arretSystem, TEMPSMATCH);
+    lancerTimerEcran();
+    tempsMatch.start();
+    typeEvitement = ARRET;
+}
+
+/*Fin Strategie homologation jaune -------------------------------------------------------------------*/
+
+
+/*Debut Strategie classique violet -------------------------------------------------------------------*/
+
+
 void strategieClassiqueViolet(deplacement robot, Pompe pompe, Demarreur demarreur, Bras brasGauche, Bras brasDroit, BrasPousser brasPousserGauche,  BrasPousser brasPousserDroit)
 {
     write(bufferScore);
@@ -193,7 +223,7 @@
             case 0 : /* On active l'expérience */ 
             {
                 typeMovement = DEPLACEMENT_AVANT;
-                robot.ligne_droite_basique(25000);
+                robot.ligne_droite_basique(26500);
                 robot.poussette(300);
                 updateAndWriteScore('0', '4', '0');
                 etapeMatch++;
@@ -205,10 +235,11 @@
                 typeMovement = DEPLACEMENT_ARRIERE;
                 robot.marche_arriere(-11200);
                 typeMovement = DEPLACEMENT_AVANT;
-                robot.rotation_rel(90);
-                robot.ligne_droite_basique(130000);
+                /*robot.rotation_rel(90);
+                robot.ligne_droite_basique(130000);*/
+                robot.va_au_point(160000,24300,0);
                 brasDroit.activerBras();
-                robot.ligne_droite_basique(16000);
+                robot.ligne_droite_basique(14000);
                 brasDroit.desactiverBras();
                 updateAndWriteScore('0', '5', '0');
                 etapeMatch++;
@@ -217,10 +248,11 @@
             }
             case 2 : /* On récupère le goldenium */ 
             {
-                robot.ligne_droite_basique(54500);
-                robot.rotation_rel(-90);
+                robot.va_au_point(223000,30000,-90);
+                //robot.ligne_droite_basique(54500);
+                //robot.rotation_rel(-90);
                 pompe.activer();
-                robot.poussette(1000);
+                robot.poussette(1500);
                 typeMovement = DEPLACEMENT_ARRIERE;
                 robot.marche_arriere(-10000);
                 typeMovement = DEPLACEMENT_AVANT;
@@ -231,12 +263,14 @@
             }
             case 3 : /* On met le goldenium dans la balance */ 
             {
-                
+                typeEvitement = ARRET;
+                robot.va_au_point(130700,115000,90);
+                robot.ligne_droite_basique(15000);
+                /*robot.rotation_rel(-90);
+                robot.ligne_droite_basique(93000);
                 robot.rotation_rel(-90);
-                robot.ligne_droite_basique(97000);
-                robot.rotation_rel(-90);
-                robot.ligne_droite_basique(104000);
-                robot.poussette(1000);
+                robot.ligne_droite_basique(104000);*/
+                robot.poussette(1500);
                 pompe.desactiver();
                 wait(2);
                 updateAndWriteScore('1', '0', '4');
@@ -249,10 +283,10 @@
                 typeMovement = DEPLACEMENT_ARRIERE;
                 robot.marche_arriere(-8000);
                 typeMovement = DEPLACEMENT_AVANT;
-                robot.rotation_rel(135);
+                robot.rotation_rel(130);
                 brasPousserGauche.activerBras();
                 brasPousserDroit.activerBras();
-                robot.ligne_droite_basique(112500);
+                robot.ligne_droite_basique(117500);
                 updateAndWriteScore('1', '2', '4');
                 etapeMatch++;
             
@@ -265,18 +299,21 @@
                 typeMovement = DEPLACEMENT_ARRIERE;
                 robot.marche_arriere(-8000);
                 typeMovement = DEPLACEMENT_AVANT;
-                robot.rotation_rel(-90);
+                /*robot.rotation_rel(-90);
                 robot.ligne_droite_basique(45000);
                 robot.rotation_rel(-42);
                 robot.ligne_droite_basique(86000);
-                robot.rotation_rel(-90);
+                robot.rotation_rel(-90);*/
+                robot.va_au_point(18000,179500,0);
+                robot.ligne_droite_basique(5000);
                 brasPousserGauche.activerBras();
                 brasPousserDroit.activerBras();
                 //mettre la fonction pente 
-                robot.commande_vitesse(30,30);
+                
+                /*robot.commande_vitesse(30,30);
                 wait(7);
                 robot.commande_vitesse(150,150);
-                wait(3);
+                wait(3);*/
                 updateAndWriteScore('1', '3', '4');
                 etapeMatch++;
             
@@ -284,12 +321,14 @@
             }
             case 6 : /* On redescant de la pente */ 
             {
-                robot.commande_vitesse(-30,-30);
+                pompe.activer();
+                robot.pente_combo(brasPousserGauche,brasPousserDroit,pompe);
+                /*robot.commande_vitesse(-30,-30);
                 wait(2);
                 brasPousserGauche.desactiverBras();
                 brasPousserDroit.desactiverBras();
                 robot.commande_vitesse(-50,-50);
-                wait_ms(10000);
+                 wait_ms(10000);*/
                 robot.vitesse_nulle_D(0);
                 robot.vitesse_nulle_G(0);
                 etapeMatch++;
@@ -315,15 +354,17 @@
 }
 
 
+/*-------- Fin Strategie classique violet -----------------------------------------------*/
 
 
+/*------- Debut Strategie classique Jaune -----------------------------------------------*/
 
 
 void strategieClassiqueJaune(deplacement robot, Pompe pompe, Demarreur demarreur, Bras brasGauche, Bras brasDroit, BrasPousser brasPousserGauche,  BrasPousser brasPousserDroit)
 {
     write(bufferScore);
     Timer tempsMatch; // timer en seconde
-    int etapeMatch = 5;
+    int etapeMatch = 0;
     while(demarreur.getState() == false)
     {
         //on attend
@@ -447,4 +488,98 @@
     robot.vitesse_nulle_G(0);
     motors_stop();
     while(1);
-}
\ No newline at end of file
+}
+
+/*--------- Fin Strategie classique jaune --------------------------------------------*/
+
+
+/*--------- Debut Strategie RCVA violet ----------------------------------------------*/
+
+
+void strategieRCVAViolet(deplacement robot, Pompe pompe, Demarreur demarreur, Bras brasGauche, Bras brasDroit, BrasPousser brasPousserGauche,  BrasPousser brasPousserDroit)
+{
+    write(bufferScore);
+    Timer tempsMatch; // timer en seconde
+    int etapeMatch = 0;
+    while(demarreur.getState() == false)
+    {
+        //on attend
+        //pc.printf("On attend le depart du Robot Thanos\n\r");
+    }
+    tempsArretMvt.attach(&arretSystem, TEMPSMATCH);
+    lancerTimerEcran();
+    tempsMatch.start();
+    typeEvitement = ARRET;
+}
+
+
+/*-------- Fin Strategie  RCVA violet -----------------------------------------------*/
+
+
+/*-------- Debut Strategie RCVA jaune -----------------------------------------------*/
+
+void strategieRCVAJaune(deplacement robot, Pompe pompe, Demarreur demarreur, Bras brasGauche, Bras brasDroit, BrasPousser brasPousserGauche,  BrasPousser brasPousserDroit)
+{
+    write(bufferScore);
+    Timer tempsMatch; // timer en seconde
+    int etapeMatch = 0;
+    while(demarreur.getState() == false)
+    {
+        //on attend
+        //pc.printf("On attend le depart du Robot Thanos\n\r");
+    }
+    tempsArretMvt.attach(&arretSystem, TEMPSMATCH);
+    lancerTimerEcran();
+    tempsMatch.start();
+    typeEvitement = ARRET;
+}
+
+
+/*-------- Fin Strategie RCVA jaune --------------------------------------------------*/
+
+/*-------- Debut Strategie humiliation  violet ---------------------------------------*/
+
+void strategieHumiliationViolet(deplacement robot, Pompe pompe, Demarreur demarreur, Bras brasGauche, Bras brasDroit, BrasPousser brasPousserGauche,  BrasPousser brasPousserDroit)
+{
+    write(bufferScore);
+    Timer tempsMatch; // timer en seconde
+    int etapeMatch = 0;
+    while(demarreur.getState() == false)
+    {
+        //on attend
+        //pc.printf("On attend le depart du Robot Thanos\n\r");
+    }
+    tempsArretMvt.attach(&arretSystem, TEMPSMATCH);
+    lancerTimerEcran();
+    tempsMatch.start();
+    typeEvitement = ARRET;
+}
+
+
+/*--------- Fin Strategie humiliation violet ----------------------------------------*/
+
+
+/*-------- Debut Strategie humiliation jaune ----------------------------------------*/
+
+void strategieHumiliationJaune(deplacement robot, Pompe pompe, Demarreur demarreur, Bras brasGauche, Bras brasDroit, BrasPousser brasPousserGauche,  BrasPousser brasPousserDroit)
+{
+    write(bufferScore);
+    Timer tempsMatch; // timer en seconde
+    int etapeMatch = 0;
+    while(demarreur.getState() == false)
+    {
+        //on attend
+        //pc.printf("On attend le depart du Robot Thanos\n\r");
+    }
+    tempsArretMvt.attach(&arretSystem, TEMPSMATCH);
+    lancerTimerEcran();
+    tempsMatch.start();
+    typeEvitement = ARRET;
+}
+
+
+/*--------- Fin Strategie humiliation jaune -----------------------------------------*/
+
+
+
+