void strategie() { static uint8_t temporisation = 0; //Permet les tempo pour les temps d'attentes COULEUR = couleur_depart(); // Inits avant démarage du robot : allumer_LED_AX12(TOUS_LES_AX12); //Vérifie si les AX fonctionnent init_depart(); //Range tous les AX à leurs positions initiales init_position_robot(0., 0., 0.); delay_ms(500); while(!SYS_JACK); // Démarage du match TIMER_10ms = ACTIVE; TIMER_90s = ACTIVE; EVITEMENT_ADV_AVANT = OFF; EVITEMENT_ADV_ARRIERE = OFF; STRATEGIE_EVITEMENT = DELAI_ACTION; FLAG_ACTION = NE_RIEN_FAIRE; while(1) { switch(FLAG_ACTION) {//Mettre toutes les fonctions de déplacement du robot } fin_strategie_cause_evitement = 0; //Reset du Flag qui bloque les déplacement dut à la backup strat } }
void init_jack() { allumer_LED_AX12(TOUS_LES_AX12); }