io.c 3.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133
  1. #include "at32f403a_407.h"
  2. #include "io.h"
  3. #include "FreeRTOS.h"
  4. #include "task.h"
  5. #include "input.h"
  6. #include "output.h"
  7. #include "settings_api.h"
  8. #include "io_utils.h"
  9. #include <stdio.h>
  10. uint16_t input_state[DI_NUMBER]; // состояние входов
  11. uint16_t input_state_bit;
  12. uint16_t load_state[DO_NUMBER]; // состояние датчиков нагрузки
  13. uint16_t load_state_bit;
  14. uint16_t credibility_state[DO_NUMBER]; // достоверность состояния датчиков нагрузки
  15. uint16_t credibility_state_bit; // достоверность состояния датчиков нагрузки
  16. uint16_t output_state_bit;
  17. uint16_t output_mode_bit;
  18. uint16_t output_pwm[DO_NUMBER];
  19. uint16_t output_pwm_save[DO_NUMBER];
  20. uint16_t output_pwm_period[DO_NUMBER];
  21. uint16_t output_pwm_period_save[DO_NUMBER];
  22. // -------------------------------------------------------------------------- //
  23. // Текущие параметры
  24. //uint16_t input_state[DI_NUMBER]; // состояние входа
  25. uint32_t input_cnt[DI_NUMBER]; // счетчики входов
  26. //
  27. void io_port_init(void)
  28. {
  29. crm_periph_clock_enable(CRM_GPIOA_PERIPH_CLOCK, TRUE);
  30. crm_periph_clock_enable(CRM_GPIOB_PERIPH_CLOCK, TRUE);
  31. crm_periph_clock_enable(CRM_GPIOC_PERIPH_CLOCK, TRUE);
  32. crm_periph_clock_enable(CRM_GPIOD_PERIPH_CLOCK, TRUE);
  33. crm_periph_clock_enable(CRM_GPIOE_PERIPH_CLOCK, TRUE);
  34. crm_periph_clock_enable(CRM_IOMUX_PERIPH_CLOCK, TRUE);
  35. crm_periph_clock_enable(CRM_PWC_PERIPH_CLOCK, TRUE);
  36. crm_periph_clock_enable(CRM_BPR_PERIPH_CLOCK, TRUE);
  37. pwc_battery_powered_domain_access(TRUE);
  38. io_tim_init();
  39. }
  40. //
  41. void io_init(void)
  42. {
  43. for (int i = 0; i < DI_NUMBER; i++)
  44. {
  45. in_init(&inputs[i]);
  46. }
  47. output_state_bit = settings.do_bits;
  48. output_mode_bit = settings.do_mode_bits;
  49. // Таймер для выходов в режиме PWM
  50. out_pwm_tim_init();
  51. for (int i = 0; i < DO_NUMBER; i++)
  52. {
  53. output_pwm[i] = settings.do_pwm[i];
  54. output_pwm_save[i] = settings.do_pwm_save[i];
  55. output_pwm_period[i] = settings.do_pwm_period[i];
  56. output_pwm_period_save[i] = settings.do_pwm_period_save[i];
  57. if (save_mode_get()) {
  58. outputs[i].pwm_duty = settings.do_pwm_save[i];
  59. outputs[i].pwm_period = settings.do_pwm_period_save[i];
  60. }
  61. else {
  62. outputs[i].pwm_duty = settings.do_pwm[i];
  63. outputs[i].pwm_period = settings.do_pwm_period[i];
  64. }
  65. out_gpio_init(&outputs[i], i);
  66. load_sens_init(&load_sens[i]);
  67. }
  68. }
  69. // Таймер для антидребезга
  70. void io_tim_init(void)
  71. {
  72. crm_clocks_freq_type crm_clocks_freq_struct = {0};
  73. crm_clocks_freq_get(&crm_clocks_freq_struct);
  74. nvic_irq_disable(TMR8_BRK_TMR12_IRQn);
  75. crm_periph_clock_enable(CRM_TMR12_PERIPH_CLOCK, TRUE);
  76. // 1 Hz
  77. tmr_base_init(TMR12, 9, (crm_clocks_freq_struct.ahb_freq / 10000) - 1);
  78. tmr_cnt_dir_set(TMR12, TMR_COUNT_UP);
  79. NVIC_ClearPendingIRQ(TMR8_BRK_TMR12_IRQn);
  80. nvic_irq_enable(TMR8_BRK_TMR12_IRQn, 5, 0);
  81. tmr_flag_clear(TMR12, TMR_OVF_FLAG);
  82. tmr_interrupt_enable(TMR12, TMR_OVF_INT, TRUE);
  83. tmr_counter_value_set(TMR12, 0);
  84. tmr_counter_enable(TMR12, TRUE);
  85. }
  86. void TMR8_BRK_TMR12_IRQHandler(void)
  87. {
  88. //static int i = 0;
  89. //static int cnt = 0;
  90. if(tmr_flag_get(TMR12, TMR_OVF_FLAG) != RESET)
  91. {
  92. tmr_flag_clear(TMR12, TMR_OVF_FLAG);
  93. debounce();
  94. #if 0
  95. if (i++ == 1000) {
  96. i = 0;
  97. cnt++;
  98. printf("CNT: %u\r\n");
  99. }
  100. #endif
  101. }
  102. }