diff options
| -rw-r--r-- | Year_3/LSM/ex_20181017.c | 204 |
1 files changed, 204 insertions, 0 deletions
diff --git a/Year_3/LSM/ex_20181017.c b/Year_3/LSM/ex_20181017.c new file mode 100644 index 0000000..147c138 --- /dev/null +++ b/Year_3/LSM/ex_20181017.c @@ -0,0 +1,204 @@ +#include "stm32_unict_lib.h" +#include <stdio.h> +#include <string.h> + +#define OPEN_T 20 +#define CLOSE_T 8 + +typedef enum { + CLOSED, + OPENING, + OPENED, + CLOSING +} status_t; + +status_t status = CLOSED; + +/* + * X = PB10 + * Y = PB4 + * Z = PB5 + * output: + * red = PB0 + */ + +char str[5] = "----\0"; +int ms_to_open = OPEN_T; /* 500ms x 10s */ +int ms_to_close = CLOSE_T; /* 500ms x 4s */ + +int level = 4; + +void +print_dash(int n, int opt) +{ + int i; + + if (opt && level < n) + return; + else if (!opt && level > n) + return; + + memset(str, ' ', 5); + for (i = 0; i < n; ++i) + *(str + i) = '-'; + + for (; i < 5; ++i) + *(str + i) = ' '; + + level = n; +} + +int +main() +{ + GPIO_init(GPIOB); + GPIO_init(GPIOC); + + GPIO_config_input(GPIOB, 10); /* X, change status to OPENING */ + GPIO_config_input(GPIOB, 4); /* Y */ + GPIO_config_input(GPIOB, 5); /* Z */ + + GPIO_config_output(GPIOB, 0); /* led */ + + DISPLAY_init(); + + GPIO_config_EXTI(GPIOB, EXTI10); + EXTI_enable(EXTI10, FALLING_EDGE); + GPIO_config_EXTI(GPIOB, EXTI4); + EXTI_enable(EXTI4, FALLING_EDGE); + GPIO_config_EXTI(GPIOB, EXTI5); + EXTI_enable(EXTI5, FALLING_EDGE); + + /* Timer for red LED */ + TIM_init(TIM2); + TIM_set(TIM2, 0); + TIM_on(TIM2); + TIM_enable_irq(TIM2, IRQ_UPDATE); + TIM_config_timebase(TIM2, 8400, 5000); + + for (;;) { + DISPLAY_puts(0, str); + } + + return 0; +} + +void +EXTI9_5_IRQHandler(void) +{ + if (EXTI_isset(EXTI5)) { + int mul; + if (status == OPENED) { + switch (level) { + case 1: + mul = 25; + break; + case 2: + mul = 50; + break; + default: + mul = 70; + } + ms_to_close = CLOSE_T - (CLOSE_T * mul / 100); + } else if (status == CLOSING) { + switch (level) { + case 1: + mul = 25; + break; + case 2: + mul = 50; + break; + default: + mul = 70; + } + ms_to_open = OPEN_T - (OPEN_T * mul / 100); + status = OPENING; + } + EXTI_clear(EXTI5); + } +} + +void +EXTI15_10_IRQHandler(void) +{ + if (EXTI_isset(EXTI10)) { + status = OPENING; + int mul; + switch (level) { + case 1: + mul = 70; + break; + case 2: + mul = 50; + break; + default: + mul = 25; + } + ms_to_open = OPEN_T - (OPEN_T * mul / 100); + EXTI_clear(EXTI10); + } +} + +void +EXTI4_IRQHandler(void) +{ + if (EXTI_isset(EXTI4)) { + if (status == OPENED) { + status = CLOSING; + ms_to_close = OPEN_T; + } else if (status == OPENING) { + status = CLOSING; + ms_to_close = OPEN_T - ms_to_close; + } + EXTI_clear(EXTI4); + } +} + +void +TIM2_IRQHandler(void) +{ + if (status == OPENING) { + GPIO_toggle(GPIOB, 0); + ms_to_open--; + + if (ms_to_open <= OPEN_T - (OPEN_T * 70 / 100)) { + print_dash(1, 1); + } else if (ms_to_open <= OPEN_T - (OPEN_T * 50 / 100)) { + print_dash(2, 1); + } else if (ms_to_open <= OPEN_T - (OPEN_T * 25 / 100)) { + print_dash(3, 1); + } + + if (ms_to_open == 0) { + status = OPENED; + print_dash(0, 1); + GPIO_write(GPIOB, 0, 0); + ms_to_open = OPEN_T; /* Reset timer of 10s */ + } + } else if (status == OPENED) { + ms_to_close--; + if (ms_to_close == 0) { + status = CLOSING; + ms_to_close = OPEN_T; /* During the closing, ms_to_close has the same value of OPENING time */ + } + } else if (status == CLOSING) { + GPIO_toggle(GPIOB, 0); + ms_to_close--; + if (ms_to_close <= OPEN_T - (OPEN_T * 70 / 100)) { + print_dash(3, 0); + } else if (ms_to_close <= OPEN_T - (OPEN_T * 50 / 100)) { + print_dash(2, 0); + } else if (ms_to_close <= OPEN_T - (OPEN_T * 25 / 100)) { + print_dash(1, 0); + } + + if (ms_to_close == 0) { + status = CLOSED; + print_dash(4, 0); + GPIO_write(GPIOB, 0, 0); + ms_to_close = CLOSE_T; + } + } + + TIM_update_clear(TIM2); +} |