input.c 11 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366
  1. #include "at32f403a_407.h"
  2. #include "input.h"
  3. #include "settings_api.h"
  4. #include "FreeRTOS.h"
  5. #include "task.h"
  6. #include "mux.h"
  7. #include "output.h"
  8. #include <stdio.h>
  9. // *port; pin; mode; port_source; pin_source; deb_counter; p_flag; cnt;
  10. din_t inputs[DI_NUMBER] = {
  11. {GPIOB, GPIO_PINS_11, 0, 0, 0, false, false}, // 1
  12. {GPIOB, GPIO_PINS_10, 0, 0, 0, false, false}, // 2
  13. {GPIOE, GPIO_PINS_14, 0, 0, 0, false, false}, // 3 перенесли {GPIOB, GPIO_PINS_1, 1, GPIO_PORT_SOURCE_GPIOB, GPIO_PINS_SOURCE1, 0},
  14. {GPIOE, GPIO_PINS_15, 0, 0, 0, false, false}, // 4 перенесли {GPIOB, GPIO_PINS_0, 1, GPIO_PORT_SOURCE_GPIOB, GPIO_PINS_SOURCE0, 0},
  15. {GPIOA, GPIO_PINS_3, 0, 0, 0, false, false}, // 5
  16. {GPIOA, GPIO_PINS_2, 0, 0, 0, false, false}, // 6
  17. {GPIOA, GPIO_PINS_1, 0, 0, 0, false, false}, // 7
  18. {GPIOA, GPIO_PINS_0, 0, 0, 0, false, false} // 8
  19. };
  20. //
  21. void in_init(din_t *input)
  22. {
  23. gpio_init_type gpio_init_struct;
  24. gpio_default_para_init(&gpio_init_struct);
  25. gpio_init_struct.gpio_pull = GPIO_PULL_NONE;
  26. gpio_init_struct.gpio_mode = GPIO_MODE_INPUT;
  27. gpio_init_struct.gpio_drive_strength = GPIO_DRIVE_STRENGTH_STRONGER;
  28. gpio_init_struct.gpio_pins = input->pin;
  29. gpio_init(input->port, &gpio_init_struct);
  30. #if 0
  31. // Вход
  32. if (input->mode == 0)
  33. {
  34. gpio_default_para_init(&gpio_init_struct);
  35. gpio_init_struct.gpio_pull = GPIO_PULL_NONE;
  36. gpio_init_struct.gpio_mode = GPIO_MODE_INPUT;
  37. gpio_init_struct.gpio_drive_strength = GPIO_DRIVE_STRENGTH_STRONGER;
  38. gpio_init_struct.gpio_pins = input->pin;
  39. gpio_init(input->port, &gpio_init_struct);
  40. }
  41. // Счетный вход
  42. else if (input->mode == 1)
  43. {
  44. }
  45. #endif
  46. }
  47. //
  48. void in_exint_init(void)
  49. {
  50. exint_init_type exint_init_struct;
  51. gpio_exint_line_config(GPIO_PORT_SOURCE_GPIOB, GPIO_PINS_SOURCE11); // 11
  52. gpio_exint_line_config(GPIO_PORT_SOURCE_GPIOB, GPIO_PINS_SOURCE10); // 10
  53. gpio_exint_line_config(GPIO_PORT_SOURCE_GPIOE, GPIO_PINS_SOURCE14); // 14
  54. gpio_exint_line_config(GPIO_PORT_SOURCE_GPIOE, GPIO_PINS_SOURCE15); // 15
  55. gpio_exint_line_config(GPIO_PORT_SOURCE_GPIOA, GPIO_PINS_SOURCE3); // 3
  56. gpio_exint_line_config(GPIO_PORT_SOURCE_GPIOA, GPIO_PINS_SOURCE2); // 2
  57. gpio_exint_line_config(GPIO_PORT_SOURCE_GPIOA, GPIO_PINS_SOURCE1); // 1
  58. gpio_exint_line_config(GPIO_PORT_SOURCE_GPIOA, GPIO_PINS_SOURCE0); // 0
  59. exint_default_para_init(&exint_init_struct);
  60. exint_init_struct.line_enable = TRUE;
  61. exint_init_struct.line_mode = EXINT_LINE_INTERRUPUT;
  62. exint_init_struct.line_select = EXINT_LINE_0 | EXINT_LINE_1 | EXINT_LINE_2 |
  63. EXINT_LINE_3 | EXINT_LINE_10 |
  64. EXINT_LINE_11| EXINT_LINE_14 | EXINT_LINE_15;
  65. exint_init_struct.line_polarity = EXINT_TRIGGER_BOTH_EDGE;
  66. exint_init(&exint_init_struct);
  67. exint_flag_clear(EXINT_LINE_0);
  68. exint_flag_clear(EXINT_LINE_1);
  69. exint_flag_clear(EXINT_LINE_2);
  70. exint_flag_clear(EXINT_LINE_3);
  71. exint_flag_clear(EXINT_LINE_10);
  72. exint_flag_clear(EXINT_LINE_11);
  73. exint_flag_clear(EXINT_LINE_14);
  74. exint_flag_clear(EXINT_LINE_15);
  75. nvic_irq_enable(EXINT0_IRQn, 5, 0);
  76. nvic_irq_enable(EXINT1_IRQn, 5, 0);
  77. nvic_irq_enable(EXINT2_IRQn, 5, 0);
  78. nvic_irq_enable(EXINT3_IRQn, 5, 0);
  79. nvic_irq_enable(EXINT15_10_IRQn, 5, 0);
  80. }
  81. //
  82. void in_set(void)
  83. {
  84. for (int i = 0; i < DI_NUMBER; i++)
  85. {
  86. if ((settings.di_mode_bits & (1 << i)) != inputs[i].mode)
  87. {
  88. inputs[i].mode = settings.di_mode_bits & (1 << i);
  89. if (inputs[i].mode == 0)
  90. {
  91. inputs[i].cnt = 0;
  92. inputs[i].p_flag = false;
  93. input_cnt[i] = 0;
  94. }
  95. else
  96. {
  97. input_state_bit &= ~(1 << i);
  98. }
  99. }
  100. }
  101. }
  102. //
  103. uint8_t in_get(uint8_t channel)
  104. {
  105. uint8_t ret = 0;
  106. ret = (uint8_t)(input_state_bit >> channel & 1);
  107. return ret;
  108. }
  109. //
  110. void io_test(void)
  111. {
  112. #if 0
  113. printf("IN_1: %u IN_2: %u IN_3: %u IN_4: %u IN_5: %u IN_6: %u IN_7: %u IN_8: %u\r\n",
  114. gpio_input_data_bit_read(inputs[0].port, inputs[0].pin),
  115. gpio_input_data_bit_read(inputs[1].port, inputs[1].pin),
  116. gpio_input_data_bit_read(inputs[2].port, inputs[2].pin),
  117. gpio_input_data_bit_read(inputs[3].port, inputs[3].pin),
  118. gpio_input_data_bit_read(inputs[4].port, inputs[4].pin),
  119. gpio_input_data_bit_read(inputs[5].port, inputs[5].pin),
  120. gpio_input_data_bit_read(inputs[6].port, inputs[6].pin),
  121. gpio_input_data_bit_read(inputs[7].port, inputs[7].pin));
  122. #endif
  123. printf("IN_1: %u IN_2: %u IN_3: %u IN_4: %u IN_5: %u IN_6: %u IN_7: %u IN_8: %u\r\n",
  124. input_cnt[0], input_cnt[1], input_cnt[2], input_cnt[3],
  125. input_cnt[4], input_cnt[5], input_cnt[6], input_cnt[7]);
  126. }
  127. // Периодический опрос входов
  128. void input_task(void *params)
  129. {
  130. for (;;)
  131. {
  132. for (int i = 0; i < DI_NUMBER; i++)
  133. {
  134. // Режим обычного входа
  135. if (inputs[i].mode == 0)
  136. {
  137. input_state[i] = (uint16_t)gpio_input_data_bit_read(inputs[i].port, inputs[i].pin);
  138. if (!input_state[i]) {
  139. input_state_bit &= ~(1 << i); // снять бит
  140. leds[i].state = LED_OFF;
  141. }
  142. else {
  143. input_state_bit |= input_state[i] << i;
  144. leds[i].state = LED_ON;
  145. }
  146. }
  147. }
  148. for (int i = 0; i < DO_NUMBER; i++)
  149. {
  150. load_state[i] = (uint16_t)gpio_input_data_bit_read(load_sens[i].port, load_sens[i].pin);
  151. // Текущее состояние датчиков нагрузки.
  152. if (!load_state[i]) {
  153. load_state_bit &= ~(1 << i); // снять бит
  154. }
  155. else {
  156. load_state_bit |= 1 << i;
  157. }
  158. // Установка битов достоверности
  159. // Если 0 (выход разомкнут), то состояние достоверно и нужно
  160. // выставить соответствующий бит
  161. if (!(output_state_bit & (1 << i))) {
  162. credibility_state_bit |= 1 << i;
  163. }
  164. else {
  165. credibility_state_bit &= ~(1 << i);
  166. }
  167. }
  168. vTaskDelay(100);
  169. }
  170. }
  171. //
  172. void debounce(void)
  173. {
  174. for (int i = 0; i < DI_NUMBER; i++)
  175. {
  176. if ((inputs[i].p_flag) && (inputs[i].mode == 0)){
  177. if (++inputs[i].cnt == settings.di_debounce[i]) {
  178. inputs[i].cnt = 0;
  179. inputs[i].p_flag = false;
  180. input_state[i] = (uint16_t)gpio_input_data_bit_read(inputs[i].port, inputs[i].pin);
  181. if (!input_state[i]) {
  182. input_state_bit &= ~(1 << i); // снять бит
  183. leds[i].state = LED_OFF;
  184. }
  185. else {
  186. input_state_bit |= input_state[i] << i;
  187. leds[i].state = LED_ON;
  188. }
  189. }
  190. }
  191. }
  192. }
  193. // IN_8 GPIOA_0
  194. void EXINT0_IRQHandler(void)
  195. {
  196. if (exint_flag_get(EXINT_LINE_0) != RESET)
  197. {
  198. exint_flag_clear(EXINT_LINE_0);
  199. if (inputs[7].mode == 0)
  200. inputs[7].p_flag = true;
  201. else {
  202. if (inputs[7].cnt_flag) {
  203. input_cnt[7]++;
  204. inputs[7].cnt_flag = false;
  205. }
  206. else
  207. inputs[7].cnt_flag = true;
  208. }
  209. }
  210. }
  211. // IN_7 GPIOA_1
  212. void EXINT1_IRQHandler(void)
  213. {
  214. if(exint_flag_get(EXINT_LINE_1) != RESET)
  215. {
  216. exint_flag_clear(EXINT_LINE_1);
  217. if (inputs[6].mode == 0)
  218. inputs[6].p_flag = true;
  219. else {
  220. if (inputs[6].cnt_flag) {
  221. input_cnt[6]++;
  222. inputs[6].cnt_flag = false;
  223. }
  224. else
  225. inputs[6].cnt_flag = true;
  226. }
  227. }
  228. }
  229. // IN_6 GPIOA_2
  230. void EXINT2_IRQHandler(void)
  231. {
  232. if(exint_flag_get(EXINT_LINE_2) != RESET)
  233. {
  234. exint_flag_clear(EXINT_LINE_2);
  235. if (inputs[5].mode == 0)
  236. inputs[5].p_flag = true;
  237. else {
  238. if (inputs[5].cnt_flag) {
  239. input_cnt[5]++;
  240. inputs[5].cnt_flag = false;
  241. }
  242. else
  243. inputs[5].cnt_flag = true;
  244. }
  245. }
  246. }
  247. // IN_5 GPIOA_3
  248. void EXINT3_IRQHandler(void)
  249. {
  250. if(exint_flag_get(EXINT_LINE_3) != RESET)
  251. {
  252. exint_flag_clear(EXINT_LINE_3);
  253. if (inputs[4].mode == 0)
  254. inputs[4].p_flag = true;
  255. else {
  256. if (inputs[4].cnt_flag) {
  257. input_cnt[4]++;
  258. inputs[4].cnt_flag = false;
  259. }
  260. else
  261. inputs[4].cnt_flag = true;
  262. }
  263. }
  264. }
  265. // IN_1, IN_2, IN_3, IN_4
  266. void EXINT15_10_IRQHandler(void)
  267. {
  268. // IN_2 GPIOB_10
  269. if (exint_flag_get(EXINT_LINE_10) != RESET)
  270. {
  271. exint_flag_clear(EXINT_LINE_10);
  272. if (inputs[1].mode == 0)
  273. inputs[1].p_flag = true;
  274. else {
  275. if (inputs[1].cnt_flag) {
  276. input_cnt[1]++;
  277. inputs[1].cnt_flag = false;
  278. }
  279. else
  280. inputs[1].cnt_flag = true;
  281. }
  282. }
  283. // IN_1 GPIOB_11
  284. else if (exint_flag_get(EXINT_LINE_11) != RESET)
  285. {
  286. exint_flag_clear(EXINT_LINE_11);
  287. if (inputs[0].mode == 0)
  288. inputs[0].p_flag = true;
  289. else {
  290. if (inputs[0].cnt_flag) {
  291. input_cnt[0]++;
  292. inputs[0].cnt_flag = false;
  293. }
  294. else
  295. inputs[0].cnt_flag = true;
  296. }
  297. }
  298. // IN_3 GPIOE_14
  299. else if (exint_flag_get(EXINT_LINE_14) != RESET)
  300. {
  301. exint_flag_clear(EXINT_LINE_14);
  302. if (inputs[2].mode == 0)
  303. inputs[2].p_flag = true;
  304. else {
  305. if (inputs[2].cnt_flag) {
  306. input_cnt[2]++;
  307. inputs[2].cnt_flag = false;
  308. }
  309. else
  310. inputs[2].cnt_flag = true;
  311. }
  312. }
  313. // IN_4 GPIOE_15
  314. else if (exint_flag_get(EXINT_LINE_15) != RESET)
  315. {
  316. exint_flag_clear(EXINT_LINE_15);
  317. if (inputs[3].mode == 0)
  318. inputs[3].p_flag = true;
  319. else {
  320. if (inputs[3].cnt_flag) {
  321. input_cnt[3]++;
  322. inputs[3].cnt_flag = false;
  323. }
  324. else
  325. inputs[3].cnt_flag = true;
  326. }
  327. }
  328. }