TVZ2021 / libVrata

Pokretna vrata library

Fork of libVrata by Zoran Kratofil

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

libVrata.cpp@0:bcdd86b76a57, 2021-11-30 (annotated)

Committer:
styropore
Date:
Tue Nov 30 22:15:03 2021 +0000
Revision:
0:bcdd86b76a57
Pokretna vrata

Who changed what in which revision?

UserRevisionLine numberNew contents of line
styropore 0:bcdd86b76a57 1 #include "libVrata.h"
styropore 0:bcdd86b76a57 2 #include "mbed.h"
styropore 0:bcdd86b76a57 3
styropore 0:bcdd86b76a57 4 Vrata::Vrata(PinName pinServo): servo(pinServo)
styropore 0:bcdd86b76a57 5 {
styropore 0:bcdd86b76a57 6 pulsOtvorena = 0.112; //0.11
styropore 0:bcdd86b76a57 7 pulsZatvorena = 0.069; //0.07
styropore 0:bcdd86b76a57 8 polozaj = 0.09; // pocetni polozaj vrata - sredina
styropore 0:bcdd86b76a57 9 brzina = 0.0007; // brzina kretanja vrata (0.0007)
styropore 0:bcdd86b76a57 10 rucno = true;
styropore 0:bcdd86b76a57 11 servo.period(0.020); // 50Hz
styropore 0:bcdd86b76a57 12 }
styropore 0:bcdd86b76a57 13
styropore 0:bcdd86b76a57 14 void Vrata::otvori()
styropore 0:bcdd86b76a57 15 {
styropore 0:bcdd86b76a57 16 rad = 1;
styropore 0:bcdd86b76a57 17 while(polozaj < pulsOtvorena) {
styropore 0:bcdd86b76a57 18 polozaj = polozaj + brzina;
styropore 0:bcdd86b76a57 19 servo = polozaj;
styropore 0:bcdd86b76a57 20 wait_ms(5);
styropore 0:bcdd86b76a57 21 }
styropore 0:bcdd86b76a57 22 rad = 2;
styropore 0:bcdd86b76a57 23 }
styropore 0:bcdd86b76a57 24 void Vrata::zatvori()
styropore 0:bcdd86b76a57 25 {
styropore 0:bcdd86b76a57 26 rad = -1;
styropore 0:bcdd86b76a57 27 while(polozaj > pulsZatvorena) {
styropore 0:bcdd86b76a57 28 polozaj = polozaj - brzina;
styropore 0:bcdd86b76a57 29 servo = polozaj;
styropore 0:bcdd86b76a57 30 wait_ms(5);
styropore 0:bcdd86b76a57 31 }
styropore 0:bcdd86b76a57 32 rad = -2;
styropore 0:bcdd86b76a57 33 }
styropore 0:bcdd86b76a57 34
styropore 0:bcdd86b76a57 35
styropore 0:bcdd86b76a57 36
styropore 0:bcdd86b76a57 37
styropore 0:bcdd86b76a57 38