TVZ2021 / libVrata

Pokretna vrata library

Fork of libVrata by Zoran Kratofil

shema sklopa https://os.mbed.com/media/uploads/styropore/shema.png

libVrata.cpp

Committer:
styropore
Date:
2021-11-30
Revision:
0:bcdd86b76a57

File content as of revision 0:bcdd86b76a57:

#include "libVrata.h"
#include "mbed.h"

Vrata::Vrata(PinName pinServo): servo(pinServo)
{
    pulsOtvorena = 0.112;     //0.11
    pulsZatvorena = 0.069;  //0.07
    polozaj = 0.09;         // pocetni polozaj vrata - sredina
    brzina = 0.0007;        // brzina kretanja vrata (0.0007)    
    rucno = true;
    servo.period(0.020);    // 50Hz
}

void Vrata::otvori()
{
    rad = 1;
    while(polozaj < pulsOtvorena) {
        polozaj = polozaj + brzina;
        servo = polozaj;
        wait_ms(5);
    }
    rad = 2;
}
void Vrata::zatvori()
{
    rad = -1;
    while(polozaj > pulsZatvorena) {
        polozaj = polozaj - brzina;
        servo = polozaj;
        wait_ms(5);
    }
    rad = -2;
}