carte esclave pompe 2020 V1

Dependencies:   mbed ident_crac

class_ventouse.cpp

Committer:
marwanesaich
Date:
2019-05-06
Revision:
0:84a8c24e29ae
Child:
2:4cc8fa2f64be

File content as of revision 0:84a8c24e29ae:

#include "class_ventouse.h"

#define SEUIL 0.3



Ventouse::Ventouse(PinName pinPompe, PinName pinElectrovanne, PinName pinCapteurPression) : m_pinPompe(pinPompe),
m_pinElectrovanne(pinElectrovanne), m_pinCapteurPression(pinCapteurPression)
{
    m_pompe = new PwmOut(m_pinPompe);
    m_electrovanne = new PwmOut(m_pinElectrovanne);
    m_pression = new AnalogIn(m_pinCapteurPression);
    
    m_pompe->period_us(50);
    m_electrovanne->period_us(50);
    
    m_pompe->write(0);
    m_electrovanne->write(0);
}

void Ventouse::attraper()
{
    m_pompe->write(0.5);
    m_electrovanne->write(0.0);

}

void Ventouse::relacher()
{
    m_pompe->write(0.0);
    m_electrovanne->write(1.0);

}

int Ventouse::getPression()
{
    if(m_pression->read() > SEUIL){
        return 1;
    }
    else{
        return 0;
    }
 
}

int Ventouse::getPompe()
{
    if(m_pompe->read() > 0){
        return 1;
    }
    else{
        return 0;
    }
}

void Ventouse::setPompe(float val)
{
    m_pompe->write(val);
}

void Ventouse::setElectrovanne(float val)
{
    m_electrovanne->write(val);
}