CRAC Team / CRAC-Strat_2017_avant_2ieme_match

code strat avant match 2, strat inversée OK normalement

Fork of CRAC-Strat_2017_fin_premier_match by CRAC Team

peripheriques/capteurs.cpp

Committer:
ClementBreteau
Date:
2017-05-25
Revision:
24:4a28a72781a6
Parent:
18:cc5fec34ed9c

File content as of revision 24:4a28a72781a6:

#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;
}