Pokretna vrata library
Fork of libVrata by
shema sklopa
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?
User | Revision | Line number | New 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 |