From a9ce750c420813b1e7dab5eb4e0340d107a34b20 Mon Sep 17 00:00:00 2001 From: Sadeep Madurange Date: Tue, 29 Apr 2025 17:04:38 +0800 Subject: Delete the old door_lock directory. --- door_lock/servo.c | 82 ------------------------------------------------------- 1 file changed, 82 deletions(-) delete mode 100644 door_lock/servo.c (limited to 'door_lock/servo.c') 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 -#include -#include - -#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(); -} -- cgit v1.2.3