diff options
Diffstat (limited to 'Year_3/LSM')
| -rw-r--r-- | Year_3/LSM/ex_20211110.c | 241 |
1 files changed, 241 insertions, 0 deletions
diff --git a/Year_3/LSM/ex_20211110.c b/Year_3/LSM/ex_20211110.c new file mode 100644 index 0000000..bba8665 --- /dev/null +++ b/Year_3/LSM/ex_20211110.c @@ -0,0 +1,241 @@ +#include "stm32_unict_lib.h" +#include <stdio.h> +#include <string.h> + +/* LED RED = PB0, + * LED YELLOW = PC2, + * LED GREEN = PC3, + * X = PB10, + * Y = PB4, + * Z = PB5, + * T = PB6 + */ + +#define TA_MIN 10 +#define TA_MAX 30 +#define CYCLE_50MS 12 + +int config_state = 0; +int config_ta = 0; +int ta_time = TA_MIN; + +typedef enum { + AUTO, + HAND +} modes_t; + +typedef enum { + CLOSED, + OPENING, + OPEN, + CLOSING +} status_t; + +modes_t mode = AUTO; +status_t status = CLOSED; + +char gate[4] = "----"; + +int counter_open = 0; +int counter_ta = 0; + +void +dash(int n) +{ + int i; + for (i = 0; i < n; ++i) + *(gate + i) = '-'; + + for (i = n; i < 4; ++i) + *(gate + i) = ' '; +} + +int +main() +{ + GPIO_init(GPIOB); + GPIO_init(GPIOC); + + GPIO_config_output(GPIOB, 0); + GPIO_config_output(GPIOC, 2); + GPIO_config_output(GPIOC, 3); + + GPIO_config_input(GPIOB, 6); + GPIO_config_input(GPIOB, 10); + GPIO_config_input(GPIOB, 4); + GPIO_config_input(GPIOB, 5); + + GPIO_config_EXTI(GPIOB, EXTI6); + EXTI_enable(EXTI6, FALLING_EDGE); + + 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); + + DISPLAY_init(); + ADC_init(ADC1, ADC_RES_8, ADC_ALIGN_RIGHT); + ADC_channel_config(ADC1, GPIOC, 1, 11); + ADC_on(ADC1); + ADC_sample_channel(ADC1, 11); + + /* Use one timer for: + * OPENING time: 50 * 12 = 600ms + * + */ + TIM_init(TIM2); + TIM_set(TIM2, 0); + TIM_on(TIM2); + TIM_enable_irq(TIM2, IRQ_UPDATE); + TIM_config_timebase(TIM2, 8400, 500); /* 50 ms */ + + int adc_read; + char buffer[4]; + + if (mode == HAND) { + GPIO_write(GPIOC, 2, 1); + } + + for (;;) { + ADC_start(ADC1); + if (config_state) { + if (config_ta) { + while (!ADC_completed(ADC1)) { } + adc_read = ADC_read(ADC1); + ta_time = adc_read * (TA_MAX - TA_MIN) / 255 + TA_MIN; + sprintf(buffer, " %2d", ta_time); + } else { + if (mode == AUTO) { + sprintf(buffer, "AUTO"); + } else { + sprintf(buffer, "HAND"); + } + } + } else { + strcpy(buffer, gate); + } + DISPLAY_puts(0, buffer); + } + + return 0; +} + +void +EXTI9_5_IRQHandler(void) +{ + if (EXTI_isset(EXTI6)) { + config_state = !config_state; + if (!config_state) { + + config_ta = 0; + } + + GPIO_toggle(GPIOB, 0); + EXTI_clear(EXTI6); + } + + if (EXTI_isset(EXTI5)) { + if (mode == HAND) { + if (status == CLOSED) { + status = OPENING; + } else if (status == OPEN) { + status = CLOSING; + } + } + EXTI_clear(EXTI5); + } +} + +void +EXTI15_10_IRQHandler(void) +{ + if (EXTI_isset(EXTI10)) { + if (config_state) { + config_ta = 1; + } else { + if (status == CLOSED) { + status = OPENING; + } + } + EXTI_clear(EXTI10); + } +} + +void +EXTI4_IRQHandler(void) +{ + if (EXTI_isset(EXTI4)) { + if (config_state) { + config_ta = 0; + + if (mode == AUTO) { + mode = HAND; + } else { + mode = AUTO; + } + + GPIO_toggle(GPIOC, 2); + } + EXTI_clear(EXTI4); + } +} + +void +TIM2_IRQHandler(void) +{ + if (status == CLOSED) { + GPIO_write(GPIOC, 3, 0); + } else if (status == OPEN) { + GPIO_write(GPIOC, 3, 1); + } else { + GPIO_toggle(GPIOC, 3); + } + + if (status == OPEN) { + counter_ta++; + if (counter_ta >= ta_time * 10) { + counter_ta = 0; + status = CLOSING; + } + } + + if (status == OPENING || status == CLOSING) { + counter_open++; + if (counter_open == CYCLE_50MS) { + if (status == OPENING) { + status = OPEN; + } else if (status == CLOSING) { + status = CLOSED; + } + counter_open = 0; + } + + if (status == OPENING) { + if (counter_open <= CYCLE_50MS / 4) { + dash(3); + } else if (counter_open <= CYCLE_50MS / 3) { + dash(2); + } else if (counter_open <= CYCLE_50MS / 2) { + dash(1); + } else { + dash(0); + } + } else if (status == CLOSING) { + if (counter_open <= CYCLE_50MS / 4) { + dash(1); + } else if (counter_open <= CYCLE_50MS / 3) { + dash(2); + } else if (counter_open <= CYCLE_50MS / 2) { + dash(3); + } else { + dash(4); + } + } + } + + TIM_update_clear(TIM2); +} |