Ajout d'un capteur US sur PA1, PA5, PA8, PA12 -> Attention conflie de timer avec timer pour roue moteur droit. Chercher une solution + voir pour adapter le code pour le pinage définitif prévue soit sur D12, D13 pin arduino STM32

Code/Src/config.c

@@ -7,6 +7,12 @@
 #include <config.h>
 #include <stdint.h>
 
+uint32_t index_time = 0;
+uint32_t nbr_un = 0;
+uint32_t nbr_un_final = 0;
+volatile uint8_t finReception = 0;
+volatile uint32_t it_count = 0;
+
 void motor_init(void)
 {
 	// Init des clks sur portB et A
@@ -132,3 +138,122 @@ void init_Timer_RoueGauche(char sens, uint8_t vitesse)
     TIM1->CR1 |= TIM_CR1_CEN;
 }
 
+
+/*
+ * INIT US :
+ * PA1 : TIM2_CH2 : AF01
+ * PA5 : TIM2_CH1 / ETR : AF01
+ * PA8 : TIM1_CH1 : AF01
+ * PA12 : TIM1_ETR AF01
+ */
+
+void InitGPIOUS(void) {
+    // 1. Activer l'horloge GPIOA
+    RCC->AHB1ENR |= RCC_AHB1ENR_GPIOAEN;
+
+    // 2. Configuration des MODER
+    // Nettoyage complet des bits pour PA1, PA5, PA8, PA12
+    GPIOA->MODER &= ~(GPIO_MODER_MODER1 | GPIO_MODER_MODER5 | GPIO_MODER_MODER8 | GPIO_MODER_MODER12);
+
+    // PA1 en AF (0b10), PA5 en Output (0b01), PA12 en Output (0b01), PA8 en Input (0b00)
+    GPIOA->MODER |= (2 << GPIO_MODER_MODER1_Pos) | (1 << GPIO_MODER_MODER5_Pos) | (1 << GPIO_MODER_MODER12_Pos);
+    GPIOA->OSPEEDR &= ~(GPIO_OSPEEDR_OSPEED1_Msk |GPIO_OSPEEDR_OSPEED5_Msk | GPIO_OSPEEDR_OSPEED12_Msk);
+    GPIOA->OSPEEDR |= (2 << GPIO_OSPEEDR_OSPEED1_Pos | 2 << GPIO_OSPEEDR_OSPEED5_Pos | 2 << GPIO_OSPEEDR_OSPEED12_Pos);
+
+    GPIOA->PUPDR &= ~(GPIO_PUPDR_PUPD8_Msk);
+    GPIOA->PUPDR |= (2 << GPIO_PUPDR_PUPD8_Pos);
+
+    // 3. Configuration AF pour PA1 (TIM2_CH2 est AF01)
+    GPIOA->AFR[0] &= ~GPIO_AFRL_AFSEL1;
+    GPIOA->AFR[0] |= (1 << GPIO_AFRL_AFSEL1_Pos);
+
+}
+
+void InitTimerUS(void) {
+    // 1. Horloge TIM2
+    RCC->APB1ENR |= RCC_APB1ENR_TIM2EN;
+
+    // 2. Base de temps : Te = 100 µs @ 180 MHz
+    TIM2->PSC = 179;                    // 180 MHz / 180 = 1 MHz
+    TIM2->ARR = 99;                     // 1 MHz / 100 = 10 kHz
+    TIM2->CR1 |= TIM_CR1_ARPE;          // preload ARR
+
+    // 3. Canal 2 (PA1) en PWM mode 1 -> validation étape 1
+    TIM2->CCMR1 &= ~TIM_CCMR1_CC2S;     // CC2 en sortie
+    TIM2->CCMR1 &= ~TIM_CCMR1_OC2M;
+    TIM2->CCMR1 |= (6 << TIM_CCMR1_OC2M_Pos);  // PWM mode 1
+    TIM2->CCMR1 |= TIM_CCMR1_OC2PE;     // preload CCR2
+    TIM2->CCER  |= TIM_CCER_CC2E;       // activer sortie OC2
+    TIM2->CCR2   = 50;                  // 50 % de 100
+
+    // 4. Interruption de débordement
+    TIM2->DIER |= TIM_DIER_UIE;
+    NVIC_EnableIRQ(TIM2_IRQn);
+
+    // 6. Démarrage
+    TIM2->CR1 |= TIM_CR1_CEN;
+}
+
+void UltraSoundMgt(void) {
+    if (index_time < 500) { // 100*10⁽-6) * 500 = 0.05 soit 50ms (période de l'US)
+        if (index_time == 0) {
+            GPIOA->ODR |= GPIO_ODR_ODR_12;   // Trig = 1
+            nbr_un = 0;
+        } else if (index_time == 1) {
+            GPIOA->ODR &= ~GPIO_ODR_ODR_12;  // Trig = 0
+        } else {
+            if (GPIOA->IDR & GPIO_IDR_IDR_8) // lecture Echo
+                nbr_un++;
+        }
+        index_time++;
+    } else {
+        nbr_un_final = nbr_un;
+        finReception = 1;
+        index_time = 0;
+    }
+}
+
+void TIM2_IRQHandler(void) {
+    // On vérifie si c'est bien l'interruption de mise à jour (Update) du Timer 2
+    if (TIM2->SR & TIM_SR_UIF) {
+
+        // 1. Reset au niveau du périphérique (Timer 2)
+        TIM2->SR &= ~TIM_SR_UIF;
+
+        // 2. Reset au niveau du processeur (NVIC)
+        NVIC_ClearPendingIRQ(TIM2_IRQn);
+
+        // Exécution de ta machine d'état
+        UltraSoundMgt();
+    }
+}
+
+
+/**
+ * Pilote le sens et la vitesse du moteur gauche
+ * @param sens : 'A' pour AVANT (PB4 actif), 'R' pour RECULER (PA10 actif)
+ * @param vitesse : valeur de 0 à 99
+ */
+void set_RoueGauche_Sens(int sens, uint8_t vitesse)
+{
+    if (sens == AVANCE) // Marche avant
+    {
+        TIM3->CCR1 = vitesse; // PWM sur PB4
+        TIM1->CCR3 = 0;       // PA10 à 0
+    }
+    else if (sens == RECUL) // Marche arrière
+    {
+        TIM3->CCR1 = 0;       // PB4 à 0
+        TIM1->CCR3 = vitesse; // PWM sur PA10
+    }
+    else // Arrêt
+    {
+        TIM3->CCR1 = 0;
+        TIM1->CCR3 = 0;
+    }
+}
+
+uint32_t ComputeDistance(uint32_t nbrUnFinal) {
+    return (nbrUnFinal * 100u) / 59u;   // ≈ /58.8235
+}
+