lib_capteurs

Dependencies:   mbed

lib_cap.cpp

Committer:
jiahaozhang
Date:
2017-03-07
Revision:
0:5e7710677334

File content as of revision 0:5e7710677334:

#include "lib_cap.h"
#include "mbed.h"

//     définie le capteur
CAP::CAP(PinName in_A, int mode): _cap(in_A){
    _mode = mode;
}
    
//**********************************************
//     choisir le mode et la donnée renvoie
//**********************************************
int CAP::valeur(){
    switch (_mode){
        case COULEUR:
            return color();  // renvoi '1' ou '0'
            
        case OBJET:
            return objet();  // renvoi '1' ou '0'
            
        case DISTANCE:
            return distance();  // renvoi '0' - '3000'
        }
}

//**********************************************
//   donnée retournée de cap_couleur
//      '1' Non détecter     
//      '0' détecter le bon coleur   
//**********************************************
int CAP::color(){
    unsigned short in_valeur = _cap.read_u16();
    int cap_color;  
        if (cap_color != 1){
            if ( in_valeur > 0xe8b9 ) cap_color = 1;
        }
        else{
            if ( in_valeur < 0x41f0 ) cap_color = 0;
        }  
    return cap_color;
}

//**********************************************
//   donnée retournée de cap_objet
//      '1' Non détecter     
//      '0' détecter l'bojet 
//**********************************************     
int CAP::objet(){
    unsigned short in_valeur = _cap.read_u16();
    int cap_objet;  
        if (cap_objet != 1){
            if ( in_valeur > 0xe8b9 ) cap_objet = 1;
        }
        else{
            if ( in_valeur < 0x41f0 ) cap_objet = 0;
        }  
    return cap_objet;
}


//***********************************************
//      donnée retournée de cap_distance
//          definie par 'mm'
//         range de détection 0 - 3m
//***********************************************
int CAP::distance(){
    unsigned short in_valeur = _cap.read_u16();
    double cap_distance;
    unsigned int l_min = 0x2ded;
    //  quand la distance est 0, le valeur de la sortie 0x2ded  (11757)
    //  quand la distance est 3000mm, le valeur de la sortie 0xffff (65535)
    double d = 0.0558;
    //  d répresente la distance de 0x0001
    
    cap_distance = ((double)in_valeur - (double)l_min) * d;
    
    return (int)cap_distance;
}