diff --git a/Balise_VL53L1X.c b/Balise_VL53L1X.c index d7ed7bc..f2e6b74 100644 --- a/Balise_VL53L1X.c +++ b/Balise_VL53L1X.c @@ -20,6 +20,7 @@ struct capteur_VL53L1X_t{ double angle_ref_terrain_min; // Cone de détection du capteur (min) double angle_ref_terrain_max; // Cone de détection du capteur (max) uint donnee_valide; + uint donnee_ignore; // Le capteur est ignoré car derrière le robot. }capteurs_VL53L1X[NB_CAPTEURS]; void actualise_VL53L1X(struct capteur_VL53L1X_t * capteur_VL53L1X, uint8_t distance_capteur_cm); @@ -45,6 +46,7 @@ void actualise_VL53L1X(struct capteur_VL53L1X_t * capteur_VL53L1X, uint8_t dista capteur_VL53L1X->angle_ref_terrain += 2* M_PI; } + capteur_VL53L1X->distance_lue_cm = distance_capteur_cm; capteur_VL53L1X->distance_obstacle_robot_mm = 10 * (distance_capteur_cm + DISTANCE_CAPTEUR_CENTRE_ROBOT_CM); capteur_VL53L1X->angle_ref_terrain_min = capteur_VL53L1X->angle_ref_terrain - DEMI_CONE_CAPTEUR_RADIAN; capteur_VL53L1X->angle_ref_terrain_max = capteur_VL53L1X->angle_ref_terrain + DEMI_CONE_CAPTEUR_RADIAN; @@ -133,6 +135,7 @@ double Balise_VL53L1X_get_distance_obstacle_mm(double angle_avancement_radiant){ double distance_minimale = DISTANCE_OBSTACLE_IGNORE_MM; for(uint8_t capteur=0; capteur> 8) & 0xFF; + donnees_emission[ADRESSE_MASQUE_LED_2 - ADRESSE_DEBUT_W] = masque_led & 0xFF; + donnees_a_envoyer=1; +} + void i2c_annexe_active_turbine(void){ donnees_emission[ADRESSE_TURBINE_PORTE - ADRESSE_DEBUT_W] |= 0x01; donnees_a_envoyer=1; diff --git a/i2c_annexe.h b/i2c_annexe.h index e71a42d..b8af1dd 100644 --- a/i2c_annexe.h +++ b/i2c_annexe.h @@ -19,4 +19,5 @@ uint8_t i2c_annexe_get_contacteur_butee_C(void); uint8_t i2c_annexe_get_contacteur_longer_A(void); uint8_t i2c_annexe_get_contacteur_longer_C(void); -void i2c_annexe_get_distances(uint8_t *distance_capteur_cm); \ No newline at end of file +void i2c_annexe_get_distances(uint8_t *distance_capteur_cm); +void i2c_annexe_couleur_balise(uint8_t couleur, uint16_t masque_led); \ No newline at end of file