Merge branch 'h21' of...

Merge branch 'h21' of https://git.step.polymtl.ca/polystar/robomaster/controle/robomaster_allrobots into h21

Inc/traitement.h

@@ -36,4 +36,7 @@ void chassis_consigne(double Vx, double Vy, double W);
 /*Effectue le suivi automatique des cibles */
 void auto_follow_target(void);
 
+/*Retourne true si le controller est a une position neutre*/
+bool isControllerNeutral(void);
+
 #endif

Src/main.c

@@ -113,11 +113,21 @@ int main(void)
 	extern motor_t motors[MAX_MOTORS];
 	extern pilote_t pilote;
 	extern jetson_t jetson;
+	extern uint32_t signOfLife_Receiver_RadioController_tick;
 	piloteInit(PILOTE_ANTONIN);
   /* USER CODE END 2 */
 
   /* Infinite loop */
   /* USER CODE BEGIN WHILE */
+	
+	while(1){
+		
+	if(signOfLife_Receiver_RadioController_tick !=0 ){
+		if(isControllerNeutral()){
+			break;
+		}
+	}
+	}
   while (1)
   {
 		signOfLife(); //LEDs BLINK

Src/traitement.c

@@ -30,6 +30,34 @@ void traitement_pids_compute(){
 	}
 }
 
+/*Returns true if controller is in neutral state*/
+bool isControllerNeutral(){
+	
+	if(receiver_RadioController.data.ch1_float != 0){
+		return false;
+	}
+	if(receiver_RadioController.data.ch2_float != 0){
+		return false;
+	}
+	if(receiver_RadioController.data.ch3_float != 0){
+		return false;
+	}
+	if(receiver_RadioController.data.ch4_float != 0){
+		return false;
+	}
+	if(receiver_RadioController.data.sw1 != 1){
+		return false;
+	}
+	if(receiver_RadioController.data.sw2 != 1){
+		return false;
+	}
+	/*if(receiver_RadioController.data.wheel != 0){
+		return false;
+	}*/
+	return true;
+}
+
+
 /* Fonctions qui fait les liens entre les entrées (capteurs, radio controller, CV, ...) et les sorties (consignes moteurs), on peut créer plusieurs traitements */
 void traitement_1(){