analog_output.c 4.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202
  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. // Зеленые LED сигнализируют (вкл/выкл) входов. Проверка на безопасный режим.
  44. if (save_mode_get())
  45. ao_led_update(settings.ao_save);
  46. else
  47. ao_led_update(settings.ao);
  48. // Сдвиговые регистры
  49. sh_init();
  50. // Внешний DAC
  51. dac_init();
  52. // Режир работы выходов.
  53. // При старте проверяется состояние безопасного режима в настройках
  54. if (save_mode_get()) {
  55. ao_mode = settings.ao_mode_save_bits;
  56. }
  57. else {
  58. ao_mode = settings.ao_mode_bits;
  59. }
  60. // Флаг - нужно обновить значения на выходах
  61. ao_set_value_flag();
  62. }
  63. // Вызывается при обновлении статуса безопасного режима работы
  64. void ao_save_update(bool state)
  65. {
  66. if (state) {
  67. ao_led_update(settings.ao_save);
  68. }
  69. else {
  70. ao_led_update(settings.ao);
  71. }
  72. ao_set_value_flag();
  73. }
  74. // Управление LED для выходов
  75. void ao_led_update(ao_t *ao)
  76. {
  77. for (int i = 0; i < AO_NUMBER; i++)
  78. {
  79. if (ao[i].state)
  80. leds[ao_output_led[i]].state = LED_ON;
  81. else
  82. leds[ao_output_led[i]].state = LED_OFF;
  83. }
  84. }
  85. // Включение/выключение каналов
  86. void ao_set(void)
  87. {
  88. for (int i = 0; i < AO_NUMBER; i++)
  89. {
  90. settings.ao[i].state = (uint8_t)((settings.ao_state_bits >> i) & 1);
  91. if (settings.ao[i].state == 0) {
  92. leds[ao_output_led[i]].state = LED_OFF;
  93. }
  94. else {
  95. leds[ao_output_led[i]].state = LED_ON;
  96. }
  97. }
  98. }
  99. // Включение/выключение каналов (безопасный режим)
  100. void ao_set_save(void)
  101. {
  102. for (int i = 0; i < AO_NUMBER; i++)
  103. {
  104. settings.ao_save[i].state = (uint8_t)((settings.ao_state_save_bits >> i) & 1);
  105. }
  106. }
  107. // Установить режим работы каналов
  108. void ao_set_mode(void)
  109. {
  110. for (int i = 0; i < AO_NUMBER; i++)
  111. {
  112. settings.ao[i].mode = (uint8_t)((settings.ao_mode_bits >> i) & 1);
  113. }
  114. }
  115. // Установить режим работы каналов (безопасный режим)
  116. void ao_set_mode_save(void)
  117. {
  118. for (int i = 0; i < AO_NUMBER; i++)
  119. {
  120. settings.ao_save[i].mode = (uint8_t)((settings.ao_mode_save_bits >> i) & 1);
  121. }
  122. }
  123. //
  124. void ao_set_value_flag(void)
  125. {
  126. set_value_flag = true;
  127. }
  128. //
  129. void ao_set_values(ao_t *ao)
  130. {
  131. for (int i = 0; i < AO_NUMBER; i++)
  132. {
  133. if (ao[i].state) {
  134. dac_test((DAC_CHANNEL)i, ao[i].value);
  135. }
  136. else {
  137. dac_test((DAC_CHANNEL)i, 0);
  138. }
  139. }
  140. }
  141. //
  142. void dac_task(void *params)
  143. {
  144. for (;;)
  145. {
  146. //
  147. ao_power = sh_ao_mode(ao_mode);
  148. // Обновить значения на выходах
  149. // Нужно проверять наличие безопасного режима работы
  150. if (set_value_flag)
  151. {
  152. set_value_flag = false;
  153. if (save_mode_get()) {
  154. ao_set_values(settings.ao_save);
  155. }
  156. else {
  157. ao_set_values(settings.ao);
  158. }
  159. }
  160. //ao_set_values(settings.ao_save);
  161. DBG printf("AO_Power: %u\r\n", ao_power);
  162. vTaskDelay(100);
  163. }
  164. }
  165. #endif