Classes et code de la partie pompe du Robot 2021

Dependencies:   mbed ident_crac

bloc_monopompe.cpp

Committer:
goldmas
Date:
2021-01-15
Revision:
0:253443d82cba
Child:
4:4bae30d48662

File content as of revision 0:253443d82cba:

#include "bloc_monopompe.h"

bloc_monopompe::bloc_monopompe (PinName pompe, PinName electrovanne, PinName capteur) 
 : _pompe(pompe), _electrovanne(electrovanne), _capteur(capteur) 
{
    _pompe.period_us(20) ;
}

bool bloc_monopompe::aspirer (void) 
{
    _pompe = PWM_POMPE ;
    _electrovanne = ELEC_OUVERTE ;
    wait_ms(100) ;
    
    if(_capteur.read() >= SEUIL_CPT)
    {
        _electrovanne = ELEC_FERME ;
        wait_ms(100) ;
        if(_capteur.read() >= SEUIL_CPT)
        {
            _pompe = 0 ;
            _gobelet_en_place = 1 ;
        }
        else
        {
            _electrovanne = ELEC_OUVERTE ;
            _gobelet_en_place = 0 ;
        }
        return _gobelet_en_place ;
    }
    
}

bool bloc_monopompe::relacher (void) 
{
    _electrovanne = ELEC_OUVERTE ;
    wait_ms(100) ;
    if(_capteur.read() >= SEUIL_CPT)
        _gobelet_en_place = 1 ;
    else 
       _gobelet_en_place = 0 ;
       
       return _gobelet_en_place ;
}

bool bloc_monopompe::possession (void) 
{
    if(_capteur.read() >= SEUIL_CPT)
        _gobelet_en_place = 1 ;
    else 
        _gobelet_en_place = 0 ;
        
        return _gobelet_en_place ;
}