Carte esclave gros robot

Dependencies:   mbed Herkulex_Library_2019 ident_crac actions_Pr

Capteurs/Capteur.cpp

Committer:
gein
Date:
2022-04-22
Revision:
54:529b24478996
Parent:
47:ced7758fb2ce

File content as of revision 54:529b24478996:

#include "Capteur.h"

/////////////////////////////////////Lecture Batterie////////////////////////////
AnalogIn Val_batterie(PC_2);
/////////////////////////////////////Capteurs monocouleur////////////////////////
DigitalIn monocouleur1(PC_15);
DigitalIn monocouleur2(PC_14);
DigitalIn monocouleur3(PB_10);
DigitalIn monocouleur4(PC_3);

short distance_moyenne;

short lecture_telemetre(char numero_telemetre)  // DEGUEUX MAIS FONCTIONNEL :')
{
    switch(numero_telemetre) {
        case 1:
            distance_moyenne=(short)DT1_trait_Ex;
            break;

        case 2:
            distance_moyenne=(short)DT2_trait_Ex;
            break;

        case 3:
            distance_moyenne=(short)DT3_trait_Ex;
            break;

        case 4:
            distance_moyenne=(short)DT4_trait_Ex;
            break;
    }
    return distance_moyenne;
}