CRAC Team / CRAC-Strat_2017_homologation_gros_rob_testAck

homologation gros robot et test avec les ack de la carte a tout faire

Fork of CRAC-Strat_2017_HOMOLOGATION_PETIT_ROBOT by CRAC Team

peripheriques/capteurs.cpp

Committer:
ClementBreteau
Date:
2017-05-25
Revision:
21:7c60d6dfcab5
Parent:
18:cc5fec34ed9c

File content as of revision 21:7c60d6dfcab5:

#include "peripheriques.h"

AnalogIn cptGauche(p20);
AnalogIn cptDroit(p19);

DigitalIn pressionGauche(p23);
DigitalIn pressionDroit(p24);

AnalogIn telemetre(p15);

//DigitalIn jack(p25);


bool dataCouleurGauche(void){
    bool couleurOK = false;
    if(cptGauche.read() < 0.3){
        couleurOK = true;
    }
    return couleurOK;    
}

bool dataCouleurDroit(void){
    bool couleurOK = false;
    if(cptDroit.read() < 0.3){
        couleurOK = true;
    }
    return couleurOK;    
}

unsigned short dataTelemetre(void){
    float distance = telemetre.read()*3.3*1159.6-687.5+98;
    return (unsigned short)distance;
}

bool dataPressionGauche(void){
    if(cptGauche.read())return true;
    else return false;
}

bool dataPressionDroit(void){
    if(cptDroit.read())return true;
    else return false;
}