analog_input.c 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647
  1. #include "at32f403a_407.h"
  2. #include "analog_input.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 "adc_transport.h"
  9. #include "ms5192t.h"
  10. #include "monitoring.h"
  11. #include "mux.h"
  12. #include "filter.h"
  13. #include <stdio.h>
  14. #undef DBG
  15. #define DBG if(0)
  16. #if defined (MAI_12)
  17. #define VOLTAGE_FACTOR 0.182382
  18. #define CURRENT_FACTOR 0.00091191
  19. #define VOLT_ALARM_LIMIT 10000.0
  20. //uint16_t ai_state_bit;
  21. uint8_t ai_mux; // выход сдвигового регистра U1010 (управляет MUX 301, 401)
  22. // мультиплексоры отвечат за коммутацию аналоговых входов и АЦП
  23. uint16_t ai_mode; // режим измерения аналоговых каналов (ток или напряжение)
  24. // 0000 0000 0000 0000
  25. // младшие 6 (с 1..6) бит - каналы с 1 по 6 соответственно
  26. // биты 9..14 - каналы с 7 по 12 соответственно
  27. uint16_t ai_alarm; // слово аварий входов
  28. uint16_t ai_gain[AI_COMMON_NUMBER]; // массив коэффициентов усиленя (modbus)
  29. uint16_t adc_com_raw_data[AI_COMMON_NUMBER]; // сырые данные
  30. float adc_com_data[AI_COMMON_NUMBER]; // пересчитанные, фильтрованные данные
  31. uint16_t adc_com_fil_data[AI_COMMON_NUMBER]; // Фильтрованные данные (только для отладки)
  32. uint16_t adc_add_raw_data[AI_ADD_NUMBER];
  33. led_t ai_alarm_led[12] = {IO_1_R, IO_2_R, IO_3_R, IO_4_R,
  34. IO_5_R, IO_6_R, IO_7_R, IO_8_R,
  35. IO_9_R, IO_10_R, IO_11_R, IO_12_R};
  36. led_t ai_input_led[12] = {IO_1_G, IO_2_G, IO_3_G, IO_4_G,
  37. IO_5_G, IO_6_G, IO_7_G, IO_8_G,
  38. IO_9_G, IO_10_G, IO_11_G, IO_12_G};
  39. uint16_t ai_state_bit; // состояние аналоговых входов (вкл/выкл) битовое поле
  40. // Авария датчика, значение ниже диапазона (не обрыв)
  41. // Авария, не обрыв линии (возможно неисправен датчик)
  42. // Авария датчика, значение выше диапазона (не обрыв)
  43. uint16_t ai_voltage_alarm; // аварии в режиме измерения напряжения
  44. // аварии в режиме измерения тока
  45. uint16_t ai_current_low; // значение ниже диапазона
  46. uint16_t ai_current_high; // значение выше диапазона
  47. uint16_t ai_current_fail; // авария (возможно неисправен датчик)
  48. //
  49. void ai_init(void)
  50. {
  51. // Фильтры (скользящее среднее) для 12-и основных каналов
  52. average_filter_init();
  53. // Зеленые LED сигнализируют (вкл/выкл) входов.
  54. ai_led_update();
  55. // Сдвиговые регистры
  56. sh_init();
  57. // Режим измерения
  58. ai_set_meas_mode();
  59. // Питание внешних датчиков
  60. ai_ext_sens_power(settings.ext_sens_power);
  61. // Внешинй ADC
  62. ai_adc_init();
  63. // Modbus параметры
  64. ai_init_modbus_params();
  65. }
  66. //
  67. void ai_init_modbus_params(void)
  68. {
  69. for (uint8_t i = 0; i < AI_COMMON_NUMBER; i++) {
  70. ai_gain[i] = settings.ai[i].gain_factor;
  71. }
  72. }
  73. // Управление LED для 12-и основных входов
  74. void ai_led_update(void)
  75. {
  76. for (int i = 0; i < AI_COMMON_NUMBER; i++)
  77. {
  78. if (settings.ai[i].state)
  79. leds[ai_input_led[i]].state = LED_ON;
  80. else
  81. leds[ai_input_led[i]].state = LED_OFF;
  82. }
  83. }
  84. // Установить режим измерения каналов с 1 по 12.
  85. void ai_set_meas_mode(void)
  86. {
  87. for (int i = 0; i < AI_COMMON_NUMBER; i++)
  88. {
  89. if (settings.ai[i].mode)
  90. ai_set_mode_word((MEAS_CHAN_MODE_t)1, i + 1);
  91. else
  92. ai_set_mode_word((MEAS_CHAN_MODE_t)0, i + 1);
  93. }
  94. }
  95. // Настройка внешнего ADC
  96. bool ai_adc_init(void)
  97. {
  98. uint8_t ret;
  99. unsigned long value;
  100. adc_gpio_init();
  101. for (uint32_t i = 0; i < 100; i++) {
  102. MS5192T_Reset();
  103. ret = MS5192T_Init();
  104. DBG printf("ADC init status: %s\r\n", ret == 1 ? "OK" : "FAILED");
  105. if (ret == 1)
  106. break;
  107. vTaskDelay(10);
  108. }
  109. if (!ret) {
  110. mon_set_err(ADC_ERR, true);
  111. return false;
  112. }
  113. // Запрос регистра конфигурации для (0x710 - значение по умолчанию)
  114. value = MS5192T_GetRegisterValue(MS5192T_REG_CONF, 2, 1);
  115. DBG printf("ADC cfg reg: 0x%X: ", value);
  116. DBG print_binary_half_word((uint16_t)value);
  117. // Коэф-т усиления: 1
  118. DBG printf("ADC. Set gain rate 1\r\n");
  119. MS5192T_SetGain(MS5192T_GAIN_1);
  120. value = MS5192T_GetRegisterValue(MS5192T_REG_CONF, 2, 1);
  121. DBG printf("ADC cfg reg: 0x%X: ", value);
  122. DBG print_binary_half_word((uint16_t)value);
  123. // Униполярный режим
  124. DBG printf("Set unipolar input mode...\r\n");
  125. MS5192T_SetPolar(MS5192T_CONF_UNIPOLAR);
  126. value = MS5192T_GetRegisterValue(MS5192T_REG_CONF, 2, 1);
  127. DBG printf("ADC cfg reg: 0x%X: ", value);
  128. DBG print_binary_half_word((uint16_t)value);
  129. // Регистр статуса
  130. value = MS5192T_GetRegisterValue(MS5192T_REG_STAT, 1, 1);
  131. DBG printf("ADC status reg: 0x%X: ", value);
  132. DBG print_binary_byte((uint8_t)value);
  133. // Установка внутреннего опорного напряжения
  134. MS5192T_SetIntReference(MS5192T_REFSEL_INT); // select internal 1.17V reference
  135. value = MS5192T_GetRegisterValue(MS5192T_REG_CONF, 2, 1);
  136. DBG printf("ADC cfg reg: 0x%X: ", value);
  137. DBG print_binary_half_word((uint16_t)value);
  138. // Регистр режима (MODE register)
  139. value = MS5192T_GetRegisterValue(MS5192T_REG_MODE, 2, 1);
  140. DBG printf("ADC mode reg: 0x%X: ", value);
  141. DBG print_binary_half_word((uint16_t)value);
  142. // Установить update rate
  143. DBG printf("Set update rate.\r\n");
  144. MS5192T_SetUpdateRate(MS5192T_UP_RATE_500);
  145. value = MS5192T_GetRegisterValue(MS5192T_REG_MODE, 2, 1);
  146. DBG printf("ADC mode reg: 0x%X: ", value);
  147. DBG print_binary_half_word((uint16_t)value);
  148. // Калибровка
  149. // 1 - ый канал
  150. MS5192T_Calibrate(MS5192T_MODE_CAL_INT_ZERO, MS5192T_CH_AIN1P_AIN1M);
  151. MS5192T_Calibrate(MS5192T_MODE_CAL_INT_FULL, MS5192T_CH_AIN1P_AIN1M);
  152. // 2 - ой канал
  153. MS5192T_Calibrate(MS5192T_MODE_CAL_INT_ZERO, MS5192T_CH_AIN2P_AIN2M);
  154. MS5192T_Calibrate(MS5192T_MODE_CAL_INT_FULL, MS5192T_CH_AIN2P_AIN2M);
  155. return true;
  156. }
  157. // Оцифровка всех 16-и каналов (входы + дополнительные каналы)
  158. void ai_processing(void)
  159. {
  160. float filter_factor;
  161. // 12 основных каналов
  162. for (uint8_t i = 0; i < AI_COMMON_NUMBER/2; i++)
  163. {
  164. adc_meas_two_channels(&settings.ai[i], &settings.ai[i + 6],
  165. &adc_com_raw_data[i], &adc_com_raw_data[i + 6]);
  166. // ---------------------------------------------------------------------
  167. // Фильтрованные данные
  168. filter_factor = settings.ai[i].mode == 0 ? VOLTAGE_FACTOR : CURRENT_FACTOR;
  169. adc_com_data[i] = (float)adc_com_raw_data[i]*filter_factor*
  170. settings.ai[i].k_factor + settings.ai[i].b_factor;
  171. filter_factor = settings.ai[i + 6].mode == 0 ? VOLTAGE_FACTOR : CURRENT_FACTOR;
  172. adc_com_data[i + 6] = (float)adc_com_raw_data[i + 6]*filter_factor*
  173. settings.ai[i + 6].k_factor + settings.ai[i + 6].b_factor;
  174. // ---------------------------------------------------------------------
  175. // Фильтрация. Скользящее среднее. Только для отладки.
  176. adc_com_fil_data[i] = average_int(&average_filter[i], adc_com_raw_data[i]);
  177. adc_com_fil_data[i + 6] = average_int(&average_filter[i + 6], adc_com_raw_data[i + 6]);
  178. }
  179. // 4 дополнительных канала
  180. for (uint8_t i = 0; i < AI_ADD_NUMBER/2; i++)
  181. {
  182. adc_meas_two_channels(&settings.ai_add[i], &settings.ai_add[i + 2],
  183. &adc_add_raw_data[i], &adc_add_raw_data[i + 2]);
  184. }
  185. #if 0
  186. printf("end\r\n");
  187. adc_print_data();
  188. //adc_print_data_extend();
  189. printf("end\r\n");
  190. #endif
  191. }
  192. //
  193. void adc_meas_two_channels(ai_t *one, ai_t *two, uint16_t *out_one, uint16_t *out_two)
  194. {
  195. uint8_t gain;
  196. // 1 - ый канал
  197. if (one->state == 0) {
  198. DBG printf("[one] channel name: %u off\r\n", one->name);
  199. }
  200. else {
  201. DBG printf("[one] channel name: %u on\r\n", one->name);
  202. gain = adc_get_gain(one->gain_factor);
  203. MS5192T_SetGain(gain);
  204. ai_connect_channel(one->name);
  205. vTaskDelay(1);
  206. MS5192T_SetChannel(MS5192T_CH_AIN1P_AIN1M);
  207. *out_one = MS5192T_SingleConversion();
  208. }
  209. // 2 - ой канал
  210. if (two->state == 0) {
  211. DBG printf("[two] channel name: %u off\r\n", two->name);
  212. }
  213. else {
  214. DBG printf("[two] channel name: %u on\r\n", two->name);
  215. gain = adc_get_gain(two->gain_factor);
  216. MS5192T_SetGain(gain);
  217. ai_connect_channel(two->name);
  218. vTaskDelay(1);
  219. MS5192T_SetChannel(MS5192T_CH_AIN2P_AIN2M);
  220. *out_two = MS5192T_SingleConversion();
  221. }
  222. }
  223. //
  224. uint8_t adc_get_gain(uint8_t tmp)
  225. {
  226. uint8_t ret;
  227. switch (tmp)
  228. {
  229. case 1 : ret = MS5192T_GAIN_1; break;
  230. case 2 : ret = MS5192T_GAIN_2; break;
  231. case 4 : ret = MS5192T_GAIN_4; break;
  232. case 8 : ret = MS5192T_GAIN_8; break;
  233. case 16 : ret = MS5192T_GAIN_16; break;
  234. case 32 : ret = MS5192T_GAIN_32; break;
  235. case 64 : ret = MS5192T_GAIN_64; break;
  236. case 128: ret = MS5192T_GAIN_128; break;
  237. default : ret = MS5192T_GAIN_1; break;
  238. }
  239. return ret;
  240. }
  241. //
  242. void adc_print_data(void)
  243. {
  244. printf("\033[2J");
  245. printf("\033[H");
  246. #if 1
  247. printf("AN_INP_1: 0x%X, %.3f\r\n", adc_com_raw_data[0], adc_com_data[0]);
  248. printf("AN_INP_2: 0x%X, %.3f\r\n", adc_com_raw_data[1], adc_com_data[1]);
  249. printf("AN_INP_3: 0x%X, %.3f\r\n", adc_com_raw_data[2], adc_com_data[2]);
  250. printf("AN_INP_4: 0x%X, %.3f\r\n", adc_com_raw_data[3], adc_com_data[3]);
  251. printf("AN_INP_5: 0x%X, %.3f\r\n", adc_com_raw_data[4], adc_com_data[4]);
  252. printf("AN_INP_6: 0x%X, %.3f\r\n", adc_com_raw_data[5], adc_com_data[5]);
  253. printf("AN_INP_7: 0x%X, %.3f\r\n", adc_com_raw_data[6], adc_com_data[6]);
  254. printf("AN_INP_8: 0x%X, %.3f\r\n", adc_com_raw_data[7], adc_com_data[7]);
  255. printf("AN_INP_9: 0x%X, %.3f\r\n", adc_com_raw_data[8], adc_com_data[8]);
  256. printf("AN_INP_10: 0x%X, %.3f\r\n", adc_com_raw_data[9], adc_com_data[9]);
  257. printf("AN_INP_11: 0x%X, %.3f\r\n", adc_com_raw_data[10],adc_com_data[10]);
  258. printf("AN_INP_12: 0x%X, %.3f\r\n", adc_com_raw_data[11],adc_com_data[11]);
  259. printf("V_ISO_CL: 0x%X, %f\r\n", adc_add_raw_data[0], (double)adc_add_raw_data[0]*VOLTAGE_FACTOR);
  260. printf("V_ISO : 0x%X, %f\r\n", adc_add_raw_data[1], (double)adc_add_raw_data[1]*VOLTAGE_FACTOR);
  261. printf("CRNT_LIM_U_BFR_R : 0x%X, %f\r\n", adc_add_raw_data[2],(double)adc_add_raw_data[2]*VOLTAGE_FACTOR);
  262. printf("CRNT_LIM_U_ABFR_R: 0x%X, %f\r\n", adc_add_raw_data[3],(double)adc_add_raw_data[3]*VOLTAGE_FACTOR);
  263. #endif
  264. }
  265. //
  266. void adc_print_data_extend(void)
  267. {
  268. printf("\033[2J");
  269. printf("\033[H");
  270. printf("AN_INP_1: 0x%X 0x%X %f %f\r\n", adc_com_raw_data[0], adc_com_fil_data[0], (double)adc_com_raw_data[0]*0.00001785305/0.0961538, (double)adc_com_fil_data[0]*0.00001785305/0.0961538);
  271. printf("AN_INP_2: 0x%X 0x%X %f %f\r\n", adc_com_raw_data[1], adc_com_fil_data[1], (double)adc_com_raw_data[1]*0.00001785305/0.0961538, (double)adc_com_fil_data[1]*0.00001785305/0.0961538);
  272. printf("AN_INP_3: 0x%X 0x%X %f %f\r\n", adc_com_raw_data[2], adc_com_fil_data[2], (double)adc_com_raw_data[2]*0.00001785305/0.0961538, (double)adc_com_fil_data[2]*0.00001785305/0.0961538);
  273. printf("AN_INP_4: 0x%X 0x%X %f %f\r\n", adc_com_raw_data[3], adc_com_fil_data[3], (double)adc_com_raw_data[3]*0.00001785305/0.0961538, (double)adc_com_fil_data[3]*0.00001785305/0.0961538);
  274. printf("AN_INP_5: 0x%X 0x%X %f %f\r\n", adc_com_raw_data[4], adc_com_fil_data[4], (double)adc_com_raw_data[4]*0.00001785305/0.0961538, (double)adc_com_fil_data[4]*0.00001785305/0.0961538);
  275. printf("AN_INP_6: 0x%X 0x%X %f %f\r\n", adc_com_raw_data[5], adc_com_fil_data[5], (double)adc_com_raw_data[5]*0.00001785305/0.0961538, (double)adc_com_fil_data[5]*0.00001785305/0.0961538);
  276. printf("AN_INP_7: 0x%X 0x%X %f %f\r\n", adc_com_raw_data[6], adc_com_fil_data[6], (double)adc_com_raw_data[6]*0.00001785305/0.0961538, (double)adc_com_fil_data[6]*0.00001785305/0.0961538);
  277. printf("AN_INP_8: 0x%X 0x%X %f %f\r\n", adc_com_raw_data[7], adc_com_fil_data[7], (double)adc_com_raw_data[7]*0.00001785305/0.0961538, (double)adc_com_fil_data[7]*0.00001785305/0.0961538);
  278. printf("AN_INP_9: 0x%X 0x%X %f %f\r\n", adc_com_raw_data[8], adc_com_fil_data[8], (double)adc_com_raw_data[8]*0.00001785305/0.0961538, (double)adc_com_fil_data[8]*0.00001785305/0.0961538);
  279. printf("AN_INP_10: 0x%X 0x%X %f %f\r\n", adc_com_raw_data[9], adc_com_fil_data[9],(double)adc_com_raw_data[9]*0.00001785305/0.0961538, (double)adc_com_fil_data[9]*0.00001785305/0.0961538);
  280. printf("AN_INP_11: 0x%X 0x%X %f %f\r\n", adc_com_raw_data[10], adc_com_fil_data[10], (double)adc_com_raw_data[10]*0.00001785305/0.0961538, (double)adc_com_fil_data[10]*0.00001785305/0.0961538);
  281. printf("AN_INP_12: 0x%X 0x%X %f %f\r\n", adc_com_raw_data[11], adc_com_fil_data[11], (double)adc_com_raw_data[11]*0.00001785305/0.0961538, (double)adc_com_fil_data[11]*0.00001785305/0.0961538);
  282. }
  283. //
  284. void adc_task(void *params)
  285. {
  286. for (;;)
  287. {
  288. ai_alarm = sh_ai_mode(ai_mode);
  289. ai_processing();
  290. ai_leds_processing();
  291. vTaskDelay(10);
  292. }
  293. }
  294. // -------------------------------------------------------------------------- //
  295. // Определение аварий
  296. //
  297. void adc_alarm_task(void *params)
  298. {
  299. for (;;)
  300. {
  301. #if 1
  302. //printf("Analog input mode: ");
  303. //print_binary_half_word(ai_mode);
  304. ai_voltage_alarm_detect();
  305. #endif
  306. vTaskDelay(1000);
  307. }
  308. }
  309. // Определение аварий в режиме измерения напряжения
  310. // ai_voltage_alarm
  311. void ai_voltage_alarm_detect(void)
  312. {
  313. for (int i = 0; i < AI_COMMON_NUMBER; i++)
  314. {
  315. // Вход включен и находится в режиме измерения напряжения
  316. if (settings.ai[i].state && (settings.ai[i].mode == 0))
  317. {
  318. if (adc_com_data[i] > VOLT_ALARM_LIMIT)
  319. ai_voltage_alarm |= 1 << i;
  320. else
  321. ai_voltage_alarm &= ~(1 << i);
  322. }
  323. }
  324. }
  325. // Опеределение аварий в режиме измерения тока
  326. // ai_current_low - авария датчика, значение ниже диапазона (не обрыв)
  327. // ai_current_high - авария, не обрыв линии (возможно неисправен датчик)
  328. // ai_current_fail - авария датчика, значение выше диапазона (не обрыв)
  329. // TODO Реализовать принудительное переключение в режим измерения напряжения на 5 минут
  330. void ai_current_alarm_detect(void)
  331. {
  332. for (int i = 0; i < AI_COMMON_NUMBER; i++)
  333. {
  334. // Вход включен и находится в режиме измерения тока
  335. if (settings.ai[i].state && (settings.ai[i].mode == 1))
  336. {
  337. if (adc_com_data[i] < 4.0)
  338. {
  339. // Вход в режиме измерения 4-20 mA
  340. if (settings.ai[i].current_mode == 1)
  341. {
  342. if (adc_com_data[i] > 1.0)
  343. {
  344. // Авария датчика, значение ниже диапазона (не обрыв)
  345. ai_current_low |= 1 << i;
  346. }
  347. else
  348. {
  349. // Авария, не обрыв линии (возможно неисправен датчик)
  350. ai_current_fail |= 1 << i;
  351. }
  352. }
  353. else
  354. {
  355. // Снять флаги с аварий
  356. // Авария датчика, значение ниже диапазона (не обрыв)
  357. // Авария, не обрыв линии (возможно неисправен датчик)
  358. ai_current_low &= ~(1 << i);
  359. ai_current_fail &= ~(1 << i);
  360. }
  361. }
  362. // Измеряемый ток больше 4 mA
  363. else
  364. {
  365. if (adc_com_data[i] > 20.0)
  366. {
  367. // Снять флаги аварий
  368. // Авария, не обрыв линии (возможно неисправен датчик)
  369. ai_current_high &= ~(1 << i);
  370. }
  371. else
  372. {
  373. // Авария датчика, значение выше диапазона (не обрыв)
  374. ai_current_high |= 1 << i;
  375. if (adc_com_data[i] > 22.0)
  376. {
  377. // Перевести вход в режим измерения напряжения
  378. // Ждать 5 минут (шунт должен остыть)
  379. }
  380. }
  381. }
  382. }
  383. }
  384. }
  385. // Подключить канал к АЦП
  386. // Одновременно могут быть подключены только 2 канала из наборов:
  387. // 1: AN_INP_1, AN_INP_2, AN_INP_3, AN_INP_4, AN_INP_5, AN_INP_6, V_ISO_CL,
  388. // V_ISO
  389. //
  390. // 2: AN_INP_7, AN_INP_8, AN_INP_9, AN_INP_10, AN_INP_11, AN_INP_12,
  391. // CRNT_LIM_U_BFR_R, CRNT_LIM_U_ABFR_R
  392. void ai_connect_channel(uint8_t channel)
  393. {
  394. if (channel < MUX_401_CH)
  395. {
  396. ai_mux &= 0xF0;
  397. switch (channel)
  398. {
  399. case AN_INP_1: ai_mux |= 0x03; break; // U301 Y3
  400. case AN_INP_2: ai_mux |= 0x00; break; // U301 Y0
  401. case AN_INP_3: ai_mux |= 0x05; break; // U301 Y5
  402. case AN_INP_4: ai_mux |= 0x07; break; // U301 Y7
  403. case AN_INP_5: ai_mux |= 0x06; break; // U301 Y6
  404. case AN_INP_6: ai_mux |= 0x04; break; // U301 Y4
  405. case V_ISO_CL: ai_mux |= 0x01; break; // U301 Y1
  406. case V_ISO : ai_mux |= 0x02; break; // U301 Y2
  407. default: break;
  408. }
  409. }
  410. else
  411. {
  412. ai_mux &= 0x87;
  413. switch (channel)
  414. {
  415. case AN_INP_7: ai_mux |= (0x04 << 4); break; // U401 Y4
  416. case AN_INP_8: ai_mux |= (0x06 << 4); break; // U401 Y6
  417. case AN_INP_9: ai_mux |= (0x07 << 4); break; // U401 Y7
  418. case AN_INP_10:ai_mux |= (0x05 << 4); break; // U401 Y5
  419. case AN_INP_11:ai_mux |= (0x02 << 4); break; // U401 Y2
  420. case AN_INP_12:ai_mux |= (0x01 << 4); break; // U401 Y1
  421. case CRNT_LIM_U_BFR_R: ai_mux |= (0x00 << 4); break; // U401 Y0
  422. case CRNT_LIM_U_ABFR_R: ai_mux |= (0x03 << 4); break; // U401 Y3
  423. default: break;
  424. }
  425. }
  426. sh_ai_connect(ai_mux);
  427. //printf("Analog input connect register: ");
  428. //print_binary_byte(ai_mux);
  429. }
  430. //
  431. void ai_set(void)
  432. {
  433. for (int i = 0; i < AI_COMMON_NUMBER; i++)
  434. {
  435. if (((settings.ai_state_bits >> i) & 1) != settings.ai[i].state)
  436. {
  437. settings.ai[i].state = ((settings.ai_state_bits >> i) & 1);
  438. if (settings.ai[i].state == 0) {
  439. leds[ai_input_led[i]].state = LED_OFF;
  440. adc_com_raw_data[i] = 0;
  441. adc_com_data[i] = 0;
  442. }
  443. else {
  444. leds[ai_input_led[i]].state = LED_ON;
  445. }
  446. }
  447. }
  448. }
  449. // Утсновить режим измерения канала (ток или напряжение)
  450. void ai_set_mode(MEAS_CHAN_MODE_t mode, uint8_t channel)
  451. {
  452. if (mode == MEAS_CURRENT)
  453. {
  454. if (channel < 7)
  455. ai_mode |= (1 << (channel - 1));
  456. else
  457. ai_mode |= (1 << (channel + 1));
  458. }
  459. else
  460. if (channel < 7)
  461. ai_mode &= ~(1 << (channel - 1));
  462. else
  463. ai_mode &= ~(1 << (channel + 1));
  464. sh_ai_mode(ai_mode);
  465. //printf("Analog input mode: ");
  466. print_binary_half_word(ai_mode);
  467. }
  468. // Формируем слово режима работы каналов (ai_mode)
  469. void ai_set_mode_word(MEAS_CHAN_MODE_t mode, uint8_t channel)
  470. {
  471. if (mode == MEAS_CURRENT)
  472. {
  473. if (channel < 7)
  474. ai_mode |= (1 << (channel - 1));
  475. else
  476. ai_mode |= (1 << (channel + 1));
  477. }
  478. else
  479. if (channel < 7)
  480. ai_mode &= ~(1 << (channel - 1));
  481. else
  482. ai_mode &= ~(1 << (channel + 1));
  483. }
  484. // Сигнал питания внешних датчиков
  485. void ai_ext_sens_power(uint16_t state)
  486. {
  487. if (state)
  488. ai_mux |= 0x80;
  489. else
  490. ai_mux &= ~(0x80);
  491. }
  492. // Управления LED
  493. void ai_leds_processing(void)
  494. {
  495. // Управление индикацией аварий (12 красных LED) (слово ai_alarm)
  496. for (uint8_t i = 0; i < AI_COMMON_NUMBER; i++) {
  497. if (ai_alarm & (1 << i)) {
  498. leds[ai_alarm_led[i]].state = LED_ON;
  499. }
  500. else {
  501. leds[ai_alarm_led[i]].state = LED_OFF;
  502. }
  503. }
  504. }
  505. //
  506. void adc_alarm_detect(void)
  507. {
  508. }
  509. // -------------------------------------------------------------------------- //
  510. // Тесты
  511. //
  512. void ai_connect_test(void)
  513. {
  514. ai_connect_channel(AN_INP_1);
  515. ai_connect_channel(AN_INP_2);
  516. ai_connect_channel(AN_INP_3);
  517. ai_connect_channel(AN_INP_4);
  518. ai_connect_channel(AN_INP_5);
  519. ai_connect_channel(AN_INP_6);
  520. ai_connect_channel(V_ISO_CL);
  521. ai_connect_channel(V_ISO);
  522. ai_connect_channel(AN_INP_7);
  523. ai_connect_channel(AN_INP_8);
  524. ai_connect_channel(AN_INP_9);
  525. ai_connect_channel(AN_INP_10);
  526. ai_connect_channel(AN_INP_11);
  527. ai_connect_channel(AN_INP_12);
  528. ai_connect_channel(CRNT_LIM_U_BFR_R);
  529. ai_connect_channel(CRNT_LIM_U_ABFR_R);
  530. }
  531. //
  532. void ai_mode_test(void)
  533. {
  534. for (uint8_t i = 1; i < 13; i++)
  535. {
  536. ai_set_mode(MEAS_VOLTAGE, i);
  537. }
  538. }
  539. #endif