input.c 11 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374
  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. #if 0
  149. uint16_t load_state[DO_NUMBER]; // состояние датчиков нагрузки
  150. //uint16_t load_state_bit;
  151. uint16_t credibility_state[DO_NUMBER]; // достоверность состояния датчиков нагрузки
  152. uint16_t credibility_state_bit; // достоверность состояния датчиков нагрузки
  153. #endif
  154. for (int i = 0; i < DO_NUMBER; i++)
  155. {
  156. load_state[i] = (uint16_t)gpio_input_data_bit_read(load_sens[i].port, load_sens[i].pin);
  157. // Текущее состояние датчиков нагрузки.
  158. if (!load_state[i]) {
  159. load_state_bit &= ~(1 << i); // снять бит
  160. }
  161. else {
  162. load_state_bit |= 1 << i;
  163. }
  164. // Установка битов достоверности
  165. // Если 0 (выход разомкнут), то состояние достоверно и нужно
  166. // выставить соответствующий бит
  167. if (!(output_state_bit & (1 << i))) {
  168. credibility_state_bit |= 1 << i;
  169. }
  170. else {
  171. credibility_state_bit &= ~(1 << i);
  172. }
  173. }
  174. vTaskDelay(100);
  175. }
  176. }
  177. //
  178. void debounce(void)
  179. {
  180. for (int i = 0; i < DI_NUMBER; i++)
  181. {
  182. if ((inputs[i].p_flag) && (inputs[i].mode == 0)){
  183. if (++inputs[i].cnt == settings.di_debounce[i]) {
  184. inputs[i].cnt = 0;
  185. inputs[i].p_flag = false;
  186. input_state[i] = (uint16_t)gpio_input_data_bit_read(inputs[i].port, inputs[i].pin);
  187. if (!input_state[i]) {
  188. input_state_bit &= ~(1 << i); // снять бит
  189. leds[i].state = LED_OFF;
  190. }
  191. else {
  192. input_state_bit |= input_state[i] << i;
  193. leds[i].state = LED_ON;
  194. }
  195. }
  196. }
  197. }
  198. }
  199. // IN_8 GPIOA_0
  200. void EXINT0_IRQHandler(void)
  201. {
  202. if (exint_flag_get(EXINT_LINE_0) != RESET)
  203. {
  204. exint_flag_clear(EXINT_LINE_0);
  205. if (inputs[7].mode == 0)
  206. inputs[7].p_flag = true;
  207. else {
  208. if (inputs[7].cnt_flag) {
  209. input_cnt[7]++;
  210. inputs[7].cnt_flag = false;
  211. }
  212. else
  213. inputs[7].cnt_flag = true;
  214. }
  215. }
  216. }
  217. // IN_7 GPIOA_1
  218. void EXINT1_IRQHandler(void)
  219. {
  220. if(exint_flag_get(EXINT_LINE_1) != RESET)
  221. {
  222. exint_flag_clear(EXINT_LINE_1);
  223. if (inputs[6].mode == 0)
  224. inputs[6].p_flag = true;
  225. else {
  226. if (inputs[6].cnt_flag) {
  227. input_cnt[6]++;
  228. inputs[6].cnt_flag = false;
  229. }
  230. else
  231. inputs[6].cnt_flag = true;
  232. }
  233. }
  234. }
  235. // IN_6 GPIOA_2
  236. void EXINT2_IRQHandler(void)
  237. {
  238. if(exint_flag_get(EXINT_LINE_2) != RESET)
  239. {
  240. exint_flag_clear(EXINT_LINE_2);
  241. if (inputs[5].mode == 0)
  242. inputs[5].p_flag = true;
  243. else {
  244. if (inputs[5].cnt_flag) {
  245. input_cnt[5]++;
  246. inputs[5].cnt_flag = false;
  247. }
  248. else
  249. inputs[5].cnt_flag = true;
  250. }
  251. }
  252. }
  253. // IN_5 GPIOA_3
  254. void EXINT3_IRQHandler(void)
  255. {
  256. if(exint_flag_get(EXINT_LINE_3) != RESET)
  257. {
  258. exint_flag_clear(EXINT_LINE_3);
  259. if (inputs[4].mode == 0)
  260. inputs[4].p_flag = true;
  261. else {
  262. if (inputs[4].cnt_flag) {
  263. input_cnt[4]++;
  264. inputs[4].cnt_flag = false;
  265. }
  266. else
  267. inputs[4].cnt_flag = true;
  268. }
  269. }
  270. }
  271. // IN_1, IN_2, IN_3, IN_4
  272. void EXINT15_10_IRQHandler(void)
  273. {
  274. // IN_2 GPIOB_10
  275. if (exint_flag_get(EXINT_LINE_10) != RESET)
  276. {
  277. exint_flag_clear(EXINT_LINE_10);
  278. if (inputs[1].mode == 0)
  279. inputs[1].p_flag = true;
  280. else {
  281. if (inputs[1].cnt_flag) {
  282. input_cnt[1]++;
  283. inputs[1].cnt_flag = false;
  284. }
  285. else
  286. inputs[1].cnt_flag = true;
  287. }
  288. }
  289. // IN_1 GPIOB_11
  290. else if (exint_flag_get(EXINT_LINE_11) != RESET)
  291. {
  292. exint_flag_clear(EXINT_LINE_11);
  293. if (inputs[0].mode == 0)
  294. inputs[0].p_flag = true;
  295. else {
  296. if (inputs[0].cnt_flag) {
  297. input_cnt[0]++;
  298. inputs[0].cnt_flag = false;
  299. }
  300. else
  301. inputs[0].cnt_flag = true;
  302. }
  303. }
  304. // IN_3 GPIOE_14
  305. else if (exint_flag_get(EXINT_LINE_14) != RESET)
  306. {
  307. exint_flag_clear(EXINT_LINE_14);
  308. if (inputs[2].mode == 0)
  309. inputs[2].p_flag = true;
  310. else {
  311. if (inputs[2].cnt_flag) {
  312. input_cnt[2]++;
  313. inputs[2].cnt_flag = false;
  314. }
  315. else
  316. inputs[2].cnt_flag = true;
  317. }
  318. }
  319. // IN_4 GPIOE_15
  320. else if (exint_flag_get(EXINT_LINE_15) != RESET)
  321. {
  322. exint_flag_clear(EXINT_LINE_15);
  323. if (inputs[3].mode == 0)
  324. inputs[3].p_flag = true;
  325. else {
  326. if (inputs[3].cnt_flag) {
  327. input_cnt[3]++;
  328. inputs[3].cnt_flag = false;
  329. }
  330. else
  331. inputs[3].cnt_flag = true;
  332. }
  333. }
  334. }