analog_output.c 4.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201
  1. #include "at32f403a_407.h"
  2. #include "analog_output.h"
  3. #include "shift_reg.h"
  4. #include "utility.h"
  5. #include "FreeRTOS.h"
  6. #include "task.h"
  7. #include "settings_api.h"
  8. #include "dac_transport.h"
  9. #include "monitoring.h"
  10. #include "mux.h"
  11. #include "io_utils.h"
  12. #include <stdio.h>
  13. #undef DBG
  14. #define DBG if(0)
  15. #if defined (MAO_4)
  16. uint16_t ao_mode; // режим работы аналоговый
  17. uint16_t ao_power; // слово состояния питания выходных каналов
  18. static bool set_value_flag = false; //
  19. led_t ao_output_led[4] = {OUT_1_G, OUT_2_G, OUT_3_G, OUT_4_G};
  20. //
  21. void ao_init(void)
  22. {
  23. #if 0
  24. // Для тестов
  25. settings.ao[0].state = 1;
  26. settings.ao[1].state = 1;
  27. settings.ao[2].state = 0;
  28. settings.ao[3].state = 0;
  29. settings.ao[0].value = 30000;
  30. settings.ao[1].value = 30000;
  31. settings.ao[2].value = 30000;
  32. settings.ao[3].value = 30000;
  33. settings.ao_save[0].state = 0;
  34. settings.ao_save[1].state = 0;
  35. settings.ao_save[2].state = 1;
  36. settings.ao_save[3].state = 1;
  37. settings.ao_save[0].value = 50000;
  38. settings.ao_save[1].value = 50000;
  39. settings.ao_save[2].value = 50000;
  40. settings.ao_save[3].value = 50000;
  41. #endif
  42. // Зеленые LED сигнализируют (вкл/выкл) входов. Проверка на безопасный режим.
  43. if (save_mode_get())
  44. ao_led_update(settings.ao_save);
  45. else
  46. ao_led_update(settings.ao);
  47. // Сдвиговые регистры
  48. sh_init();
  49. // Внешний DAC
  50. dac_init();
  51. // Режир работы выходов.
  52. // При старте проверяется состояние безопасного режима в настройках
  53. if (save_mode_get()) {
  54. ao_mode = settings.ao_mode_save_bits;
  55. }
  56. else {
  57. ao_mode = settings.ao_mode_bits;
  58. }
  59. // Флаг - нужно обновить значения на выходах
  60. ao_set_value_flag();
  61. }
  62. // Вызывается при обновлении статуса безопасного режима работы
  63. void ao_save_update(bool state)
  64. {
  65. if (state) {
  66. ao_led_update(settings.ao_save);
  67. }
  68. else {
  69. ao_led_update(settings.ao);
  70. }
  71. ao_set_value_flag();
  72. }
  73. // Управление LED для выходов
  74. void ao_led_update(ao_t *ao)
  75. {
  76. for (int i = 0; i < AO_NUMBER; i++)
  77. {
  78. if (ao[i].state)
  79. leds[ao_output_led[i]].state = LED_ON;
  80. else
  81. leds[ao_output_led[i]].state = LED_OFF;
  82. }
  83. }
  84. // Включение/выключение каналов
  85. void ao_set(void)
  86. {
  87. for (int i = 0; i < AO_NUMBER; i++)
  88. {
  89. settings.ao[i].state = (uint8_t)((settings.ao_state_bits >> i) & 1);
  90. if (settings.ao[i].state == 0) {
  91. leds[ao_output_led[i]].state = LED_OFF;
  92. }
  93. else {
  94. leds[ao_output_led[i]].state = LED_ON;
  95. }
  96. }
  97. }
  98. // Включение/выключение каналов (безопасный режим)
  99. void ao_set_save(void)
  100. {
  101. for (int i = 0; i < AO_NUMBER; i++)
  102. {
  103. settings.ao_save[i].state = (uint8_t)((settings.ao_state_save_bits >> i) & 1);
  104. }
  105. }
  106. // Установить режим работы каналов
  107. void ao_set_mode(void)
  108. {
  109. for (int i = 0; i < AO_NUMBER; i++)
  110. {
  111. settings.ao[i].mode = (uint8_t)((settings.ao_mode_bits >> i) & 1);
  112. }
  113. }
  114. // Установить режим работы каналов (безопасный режим)
  115. void ao_set_mode_save(void)
  116. {
  117. for (int i = 0; i < AO_NUMBER; i++)
  118. {
  119. settings.ao_save[i].mode = (uint8_t)((settings.ao_mode_save_bits >> i) & 1);
  120. }
  121. }
  122. //
  123. void ao_set_value_flag(void)
  124. {
  125. set_value_flag = true;
  126. }
  127. //
  128. void ao_set_values(ao_t *ao)
  129. {
  130. for (int i = 0; i < AO_NUMBER; i++)
  131. {
  132. if (ao[i].state) {
  133. dac_test((DAC_CHANNEL)i, ao[i].value);
  134. }
  135. else {
  136. dac_test((DAC_CHANNEL)i, 0);
  137. }
  138. }
  139. }
  140. //
  141. void dac_task(void *params)
  142. {
  143. for (;;)
  144. {
  145. //
  146. ao_power = sh_ao_mode(ao_mode);
  147. // Обновить значения на выходах
  148. // Нужно проверять наличие безопасного режима работы
  149. if (set_value_flag)
  150. {
  151. set_value_flag = false;
  152. if (save_mode_get()) {
  153. ao_set_values(settings.ao_save);
  154. }
  155. else {
  156. ao_set_values(settings.ao);
  157. }
  158. }
  159. //ao_set_values(settings.ao_save);
  160. DBG printf("AO_Power: %u\r\n", ao_power);
  161. vTaskDelay(100);
  162. }
  163. }
  164. #endif