summaryrefslogtreecommitdiff
diff options
context:
space:
mode:
-rw-r--r--Year_3/LSM/ex_20211110.c241
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);
+}