Alarme de proximité

Instructions Moyen

Capteur LIDAR SEN0628 · Exercice 3

Programme une alarme qui :

Fait clignoter les LEDs en vert si tout est dégagé (> 500 mm)
Fait clignoter en orange si un obstacle est proche (200-500 mm)
Fait clignoter en rouge rapidement si danger (< 200 mm)

Solution :

#include <stdio.h>
#include <stdint.h>
#include <limits.h>

#define NUM_LEDS 4

/* Trouve la distance minimale valide (non nulle) dans la matrice */
uint16_t trouver_min(uint16_t matrix[64])
{
    uint16_t min = UINT16_MAX;
    for (int i = 0; i < 64; i++) {
        if (matrix[i] > 0 && matrix[i] < min) {
            min = matrix[i];
        }
    }
    return min;
}

/* Affiche la couleur d'alarme et le délai de clignotement simulé.
   Sur le robot, cette fonction allume les LEDs WS2812 et appelle
   k_msleep() pour cadencer le clignotement. */
void alarme_proximite(uint16_t distance_min)
{
    if (distance_min > 500) {
        printf("[LED] VERT   - Dégagé   (%d mm) — clignotement 500 ms\n",
               distance_min);
        /* attente 500 ms (simulée) */
    } else if (distance_min > 200) {
        printf("[LED] ORANGE - Proche   (%d mm) — clignotement 250 ms\n",
               distance_min);
        /* attente 250 ms (simulée) */
    } else {
        printf("[LED] ROUGE  - DANGER   (%d mm) — clignotement 100 ms\n",
               distance_min);
        /* attente 100 ms (simulée) */
    }
}

int main(void)
{
    uint16_t matrix[64];

    /* Cas 1 : tout dégagé (toutes les cellules à 600 mm) */
    printf("\n=== Cas 1 : tout dégagé ===\n");
    for (int i = 0; i < 64; i++) {
        matrix[i] = 600;
    }
    printf("Distance min : %d mm\n", trouver_min(matrix));
    alarme_proximite(trouver_min(matrix));

    /* Cas 2 : obstacle proche (une cellule à 350 mm) */
    printf("\n=== Cas 2 : obstacle proche ===\n");
    for (int i = 0; i < 64; i++) {
        matrix[i] = 800;
    }
    matrix[32] = 350;
    printf("Distance min : %d mm\n", trouver_min(matrix));
    alarme_proximite(trouver_min(matrix));

    /* Cas 3 : danger imminent (une cellule à 90 mm) */
    printf("\n=== Cas 3 : danger imminent ===\n");
    for (int i = 0; i < 64; i++) {
        matrix[i] = 800;
    }
    matrix[0] = 90;
    printf("Distance min : %d mm\n", trouver_min(matrix));
    alarme_proximite(trouver_min(matrix));

    return 0;
}

ÉDITEUR GCC 14.2 -Wall -Wextra -std=c17

Snippets :

SORTIE

Appuie sur Ctrl+Entrée pour compiler et exécuter.