summaryrefslogtreecommitdiffstats
path: root/door_lock/servo.c
diff options
context:
space:
mode:
Diffstat (limited to 'door_lock/servo.c')
-rw-r--r--door_lock/servo.c82
1 files changed, 0 insertions, 82 deletions
diff --git a/door_lock/servo.c b/door_lock/servo.c
deleted file mode 100644
index 28b669f..0000000
--- a/door_lock/servo.c
+++ /dev/null
@@ -1,82 +0,0 @@
-#include <avr/io.h>
-#include <avr/interrupt.h>
-#include <util/delay.h>
-
-#include "cmd.h"
-#include "serial.h"
-
-#define PWM_MIN 500
-#define PWM_MID 1500
-#define PWM_MAX 2500
-#define PWM_TOP 20000
-
-#define SERVO_PIN PB1
-#define LOCK_BTN PD6
-#define UNLOCK_BTN PD7
-
-static inline void lock(void)
-{
- OCR1A = PWM_MID;
- _delay_ms(100);
- OCR1A = PWM_TOP;
-}
-
-static inline void unlock(void)
-{
- OCR1A = PWM_MAX - 50;
- _delay_ms(100);
- OCR1A = PWM_TOP;
-}
-
-static inline int is_btn_pressed(unsigned char btn)
-{
- if (!((PIND >> btn) & 0x01)) {
- _delay_us(2000);
- return !((PIND >> btn) & 0x01);
- }
-
- return 0;
-}
-
-static inline void pcint2_init(void)
-{
- PCICR |= (1 << PCIE2);
- PCMSK2 |= ((1 << PCINT22) | (1 << PCINT23));
-}
-
-static inline void servo_init(void)
-{
- DDRB |= (1 << SERVO_PIN);
-
- TCCR1A |= (1 << WGM11) | (1 << COM1A1);
- TCCR1B |= (1 << WGM13) | (1 << CS11);
-
- ICR1 = PWM_TOP;
-
- DDRD &= ~((1 << LOCK_BTN) | (1 << UNLOCK_BTN));
- PORTD |= (1 << LOCK_BTN) | (1 << UNLOCK_BTN);
-}
-
-int main(void)
-{
- servo_init();
- pcint2_init();
- serial_init();
-
- sei();
-
- for(;;) {
- // todo: power down
- }
-
- return 0;
-}
-
-ISR(PCINT2_vect)
-{
- if (is_btn_pressed(LOCK_BTN))
- lock();
-
- if (is_btn_pressed(UNLOCK_BTN))
- unlock();
-}