megatec.c 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896
  1. /*
  2. * megatec.c
  3. *
  4. * Created on: 22.05.2017
  5. * Author: balbekova
  6. */
  7. #include "FreeRTOS.h"
  8. #include "task.h"
  9. #include "usart.h"
  10. #include "megatec.h"
  11. #include "ups_monitor.h"
  12. #include "log.h"
  13. #include "snmp_api.h"
  14. #include "settings_api.h"
  15. #ifdef PRINTF_STDLIB
  16. #include <stdio.h>
  17. #endif
  18. #ifdef PRINTF_CUSTOM
  19. #include "tinystdio.h"
  20. #endif
  21. #include <string.h>
  22. #include <math.h>
  23. #define DBG if (0)
  24. /**
  25. * @brief Общая структура настроек
  26. */
  27. extern SETTINGS_t sSettings;
  28. #define UPS_PDU_MAX_LEN 50
  29. float TimeParamFloat = 0;
  30. uint16_t TimeParam = 0;
  31. uint16_t TimeParam2 = 0;
  32. bool megatec_send = true;
  33. UPS_value_t UPS;
  34. static bool flag_buzzer_on = false;
  35. enum {
  36. NORMAL = 0x00,
  37. VER_ERROR = 0x01,
  38. CHKSUM_ERROR = 0x02,
  39. LCHKSUM_ERROR = 0x03,
  40. CID2_INVALID = 0x04,
  41. CMD_FMT_ERROR = 0x05,
  42. INVALID_DATA = 0x06,
  43. };
  44. static struct {
  45. uint8_t data[UPS_PDU_MAX_LEN];
  46. uint16_t len;
  47. } ups_pdu;
  48. const char *MegaTecCMD[] = {
  49. "Q1\r",
  50. "T\r",
  51. "TL\r",
  52. "T",
  53. "Q\r",
  54. "S",
  55. "R",
  56. "C\r",
  57. "CT\r",
  58. "I\r",
  59. "F\r",
  60. "Q2\r",
  61. "QGS\r",
  62. "QBV\r",
  63. "QMD\r",
  64. "QVFW\r",
  65. "QVFW2\r",
  66. "QID\r",
  67. "QPI\r",
  68. "QS\r",
  69. "M\r",
  70. "PDA\r",
  71. };
  72. extern bool flUpdateLog;
  73. void init_UPS_value(void)
  74. {
  75. UPS.Freq_in = 0;
  76. UPS.VAC_in = 0;
  77. UPS.VAC_out = 0;
  78. UPS.Temp = 0;
  79. UPS.Load = 0;
  80. UPS.SOC = 0;
  81. UPS.SOC_test = 0;
  82. UPS.work_time = 0;
  83. UPS.akb_work_time = 0;
  84. UPS.Status = 0;
  85. UPS.Alarm = 0;
  86. UPS.cnt_err_ups = 0;
  87. UPS.Flag_Present = false;
  88. UPS.Present = false;
  89. memset(UPS.model, 0, sizeof(UPS.model));
  90. memset(UPS.vertion, 0, sizeof(UPS.vertion));
  91. memset(UPS.serial, 0, sizeof(UPS.serial));
  92. }
  93. void send_MegaTec_cmd(cmdMegaTecEnums_t command)
  94. {
  95. DBG printf("MegaTecCMD: %s\r\n", MegaTecCMD[command]);
  96. if (command == ups_test_time) {
  97. uint8_t req[10];
  98. memset(req, 0, 10);
  99. if (TimeParam < 10) {
  100. sprintf(req, "%s0%d\r", MegaTecCMD[command], TimeParam);
  101. } else {
  102. sprintf(req, "%s%d\r", MegaTecCMD[command], TimeParam);
  103. }
  104. ups_send_block(req, strlen(req));
  105. } else if (command == ups_shutdown) {
  106. uint8_t req[10];
  107. memset(req, 0, 10);
  108. if (TimeParamFloat >= 1 && TimeParamFloat < 10) {
  109. sprintf(req, "%s0%d\r", MegaTecCMD[command], (uint16_t)TimeParamFloat);
  110. } else if (TimeParamFloat < 1) {
  111. sprintf(req, "%s.%d\r", MegaTecCMD[command], (uint16_t)(10 * TimeParamFloat));
  112. } else {
  113. sprintf(req, "%s%d\r", MegaTecCMD[command], (uint16_t)TimeParamFloat);
  114. }
  115. ups_send_block(req, strlen(req));
  116. } else if (command == ups_shutdown_restore) {
  117. uint8_t req[10];
  118. memset(req, 0, 10);
  119. if (TimeParamFloat >= 1 && TimeParamFloat < 10) {
  120. sprintf(req, "%s0%d%s000%d\r", MegaTecCMD[command - 1], (uint16_t)TimeParamFloat, MegaTecCMD[command], TimeParam2);
  121. } else if (TimeParamFloat < 1) {
  122. sprintf(req, "%s.%d%s000%d\r", MegaTecCMD[command - 1], (uint16_t)(10 * TimeParamFloat), MegaTecCMD[command], TimeParam2);
  123. } else {
  124. sprintf(req, "%s%d%s000%d\r", MegaTecCMD[command - 1], (uint16_t)TimeParamFloat, MegaTecCMD[command], TimeParam2);
  125. }
  126. ups_send_block(req, strlen(req));
  127. } else {
  128. // TODO ����������� ���������
  129. //ups_send_block(MegaTecCMD[command], strlen(MegaTecCMD[command]));
  130. ups_send_block((void *)MegaTecCMD[command], strlen(MegaTecCMD[command]));
  131. }
  132. }
  133. bool ups_megatec_rx_pdu(void)
  134. {
  135. int c = 0;
  136. uint8_t cnt_answer = 0;
  137. ups_pdu.len = 0;
  138. while (c >= 0) {
  139. c = ups_getchar(200);//portMAX_DELAY200
  140. if (c >= 0) {
  141. ups_pdu.len = 0;
  142. memset(ups_pdu.data, 0, UPS_PDU_MAX_LEN);
  143. ups_pdu.data[ups_pdu.len++] = c;
  144. while ((ups_pdu.len < UPS_PDU_MAX_LEN) && (c != 0x0d)) {
  145. c = ups_getchar(100);//portMAX_DELAY200
  146. if (c < 0) {
  147. ups_pdu.len = 0;
  148. return false;
  149. }
  150. ups_pdu.data[ups_pdu.len++] = c;
  151. }
  152. DBG printf("UPS raw data: %s\r\n", ups_pdu.data);
  153. cnt_answer ++;
  154. } else {
  155. if (ups_pdu.len == 0) {
  156. return false;
  157. }
  158. }
  159. }
  160. if (cnt_answer > 1) {
  161. DBG printf("MegaTecCMD: false\r\n");
  162. return false;
  163. }
  164. DBG printf("UPS raw data: %s\r\n", ups_pdu.data);
  165. DBG printf("UPS raw data len: %d\r\n", ups_pdu.len);
  166. return true;
  167. }
  168. int8_t get_ups_param(char *buf, char *param, char *val)
  169. {
  170. char *endValue;
  171. int8_t param_len;
  172. memset(val, 0, 20);
  173. endValue = strpbrk(buf, param);
  174. if (endValue != NULL) {
  175. param_len = endValue - buf;
  176. if (param_len < 20) {
  177. strncpy(val, buf, param_len);
  178. } else {
  179. param_len = 0;
  180. }
  181. } else {
  182. param_len = 0;
  183. }
  184. DBG printf("UPS parameter: %s\r\n", val);
  185. return param_len;
  186. }
  187. void ups_status_response(char *data)
  188. {
  189. uint8_t i;
  190. char value[20];
  191. float tmp;
  192. uint8_t len = 0;
  193. DBG printf("ups_status_response: %s\r\n", data);
  194. if (data[0] != '(') {
  195. return;
  196. }
  197. DBG printf("ups_status_parser_start\r\n");
  198. UPS.Present = true;
  199. UPS.Flag_Present = true;
  200. UPS.cnt_err_ups = 0;
  201. #ifdef UPS_BUZZER_OFF
  202. if (flag_buzzer_on) {
  203. data[45] = '0';
  204. }
  205. #endif
  206. if (flUpdateLog) {
  207. flUpdateLog = false;
  208. log_add(data);
  209. }
  210. data++;
  211. DBG printf("UPS ups_status_parser_startr: %s\r\n", data);
  212. len = get_ups_param(data, " ", value);
  213. data += (len + 1);
  214. if (len > 0) {
  215. tmp = atof(value);
  216. if (tmp > 20) {
  217. UPS.VAC_in = tmp;
  218. } else {
  219. UPS.VAC_in = 0;
  220. }
  221. }
  222. //TODO
  223. len = get_ups_param(data, " ", value);
  224. data += (len + 1);
  225. len = get_ups_param(data, " ", value);
  226. data += (len + 1);
  227. if (len > 0) {
  228. UPS.VAC_out = atof(value);
  229. }
  230. len = get_ups_param(data, " ", value);
  231. data += (len + 1);
  232. if (len > 0) {
  233. UPS.Load = atoi(value);
  234. }
  235. len = get_ups_param(data, " ", value);
  236. data += (len + 1);
  237. if (len > 0) {
  238. UPS.Freq_in = atof(value);
  239. }
  240. //TODO
  241. len = get_ups_param(data, " ", value);
  242. data += (len + 1);
  243. if (len > 0) {
  244. UPS.Vakb_curr = atof(value);
  245. }
  246. if (sSettings.UPS_Setting.type_ups == ups_kestar || sSettings.UPS_Setting.type_ups == ups_offline) {
  247. if (UPS.Vakb_curr < 7) {
  248. UPS.SOC = round(100 * (UPS.Vakb_curr - sSettings.UPS_Setting.Ucellmin) / (sSettings.UPS_Setting.Ucellmax -
  249. sSettings.UPS_Setting.Ucellmin));
  250. } else {
  251. UPS.SOC = round(100 * (UPS.Vakb_curr / AKB_NUM_CELL - sSettings.UPS_Setting.Ucellmin) /
  252. (sSettings.UPS_Setting.Ucellmax - sSettings.UPS_Setting.Ucellmin));
  253. }
  254. }
  255. len = get_ups_param(data, " ", value);
  256. data += (len + 1);
  257. if (len > 0) {
  258. UPS.Temp = atof(value);
  259. }
  260. len = get_ups_param(data, "\r", value);
  261. data += (len + 1);
  262. if (len > 0) {
  263. uint8_t stat = 0;
  264. for (i = 0; i < len; i ++) {
  265. stat |= (value[i] - 0x30) << (7 - i);
  266. }
  267. UPS.Status = stat;
  268. }
  269. #ifdef RELAY_ALARM_AKB
  270. if (sSettings.UPS_Setting.type_ups == ups_kestar || sSettings.UPS_Setting.type_ups == ups_offline) {
  271. UPS_TestSOCMonitor();
  272. }
  273. #endif
  274. }
  275. void ups_general_status_response(char *data)
  276. {
  277. uint8_t i;
  278. char value[20];
  279. float tmp;
  280. uint8_t len = 0;
  281. DBG printf("ups_status_response: %s\r\n", data);
  282. if (data[0] != '(') {
  283. return;
  284. }
  285. DBG printf("ups_status_parser_start\r\n");
  286. UPS.Present = true;
  287. UPS.Flag_Present = true;
  288. UPS.cnt_err_ups = 0;
  289. if (flUpdateLog) {
  290. flUpdateLog = false;
  291. log_add(data);
  292. }
  293. data++;
  294. DBG printf("UPS ups_status_parser_startr: %s\r\n", data);
  295. len = get_ups_param(data, " ", value);
  296. data += (len + 1);
  297. if (len > 0) {
  298. tmp = atof(value);
  299. if (tmp > 20) {
  300. UPS.VAC_in = tmp;
  301. } else {
  302. UPS.VAC_in = 0;
  303. }
  304. }
  305. len = get_ups_param(data, " ", value);
  306. data += (len + 1);
  307. if (len > 0) {
  308. UPS.Freq_in = atof(value);
  309. }
  310. len = get_ups_param(data, " ", value);
  311. data += (len + 1);
  312. if (len > 0) {
  313. UPS.VAC_out = atof(value);
  314. }
  315. //TODO
  316. len = get_ups_param(data, " ", value);
  317. data += (len + 1);
  318. //TODO
  319. len = get_ups_param(data, " ", value);
  320. data += (len + 1);
  321. len = get_ups_param(data, " ", value);
  322. data += (len + 1);
  323. if (len > 0) {
  324. UPS.Load = atoi(value);
  325. }
  326. //TODO
  327. len = get_ups_param(data, " ", value);
  328. data += (len + 1);
  329. //TODO
  330. len = get_ups_param(data, " ", value);
  331. data += (len + 1);
  332. //TODO
  333. len = get_ups_param(data, " ", value);
  334. data += (len + 1);
  335. //TODO
  336. len = get_ups_param(data, " ", value);
  337. data += (len + 1);
  338. len = get_ups_param(data, " ", value);
  339. data += (len + 1);
  340. if (len > 0) {
  341. UPS.Temp = atof(value);
  342. }
  343. len = get_ups_param(data, "\r", value);
  344. data += (len + 1);
  345. if (len > 0) {
  346. uint8_t stat = 0;
  347. for (i = 2; i < (len - 2); i ++) {
  348. stat |= (value[i] - 0x30) << (7 - i);
  349. }
  350. UPS.Status = stat;
  351. }
  352. }
  353. void ups_info_response(char *data)
  354. {
  355. uint8_t i = 0, j = 0;
  356. char value[20];
  357. DBG printf("ups_info_response: %s\r\n", data);
  358. if (data[0] != '#') {
  359. return;
  360. }
  361. DBG printf("ups_info_response_startr: %s\r\n", data);
  362. UPS.Present = true;
  363. UPS.Flag_Present = true;
  364. UPS.cnt_err_ups = 0;
  365. data++;
  366. data += 16; //пропускаем поле название компании
  367. memset(value, 0, sizeof(value));
  368. for (uint8_t i = 0; i < KSTAR_MODEL_LENGTH; i ++) {
  369. if (data[i] != ' ') {
  370. value[j] = data[i];
  371. j ++;
  372. }
  373. }
  374. if (j != 0) {
  375. if (UPS.model[0] == 0) {
  376. strncpy(UPS.model, value, strlen(value));
  377. SNMP_SetObjDescr();
  378. } else {
  379. strncpy(UPS.model, data, strlen(value));
  380. }
  381. } else {
  382. if (UPS.model[0] == 0) {
  383. strcpy(UPS.model, "RTMP-II");
  384. SNMP_SetObjDescr();
  385. } else {
  386. strcpy(UPS.model, "RTMP-II");
  387. }
  388. }
  389. data += (KSTAR_MODEL_LENGTH + 1);
  390. strncpy(UPS.serial, data, 8);
  391. data += 8;
  392. strncpy(UPS.vertion, data, 2);
  393. SNMP_SetObjDescr();
  394. }
  395. void ups_remain_time_response(char *data)
  396. {
  397. char value[20];
  398. if (data[0] != '(') {
  399. return;
  400. }
  401. DBG printf("ups_remain_time_response: %s\r\n", data);
  402. UPS.Present = true;
  403. UPS.Flag_Present = true;
  404. UPS.cnt_err_ups = 0;
  405. data++;
  406. if (strlen(data) > 5) {
  407. return;
  408. }
  409. memset(value, 0, 10);
  410. strcpy(value, data);
  411. //if((UPS.Status >> 7) & 0x01)
  412. UPS.work_time = atoi(value);
  413. //else
  414. // UPS.work_time = 0;
  415. }
  416. void ups_akb_info_response(char *data)
  417. {
  418. char value[20];
  419. uint8_t len = 0;
  420. DBG printf("ups_akb_info_response: %s\r\n", data);
  421. if (data[0] != '(') {
  422. return;
  423. }
  424. DBG printf("ups_akb_info_parser_start\r\n");
  425. UPS.Present = true;
  426. UPS.Flag_Present = true;
  427. UPS.cnt_err_ups = 0;
  428. data++;
  429. DBG printf("UPS ups_akb_info_parser_start: %s\r\n", data);
  430. //TODO
  431. len = get_ups_param(data, " ", value);
  432. data += (len + 1);
  433. //TODO
  434. len = get_ups_param(data, " ", value);
  435. data += (len + 1);
  436. //TODO
  437. len = get_ups_param(data, " ", value);
  438. data += (len + 1);
  439. len = get_ups_param(data, " ", value);
  440. data += (len + 1);
  441. if (len > 0) {
  442. UPS.SOC = atoi(value);
  443. }
  444. #ifdef RELAY_ALARM_AKB
  445. UPS_TestSOCMonitor();
  446. #endif
  447. len = get_ups_param(data, "\r", value);
  448. data += (len + 1);
  449. if (len > 0) {
  450. UPS.work_time = atoi(value);
  451. }
  452. }
  453. void ups_model_response(char *data)
  454. {
  455. uint8_t j = 0;
  456. char value[20];
  457. uint8_t len = 0;
  458. DBG printf("ups_akb_info_response: %s\r\n", data);
  459. if (data[0] != '(') {
  460. return;
  461. }
  462. DBG printf("ups_akb_info_parser_start\r\n");
  463. UPS.Present = true;
  464. UPS.Flag_Present = true;
  465. UPS.cnt_err_ups = 0;
  466. data++;
  467. DBG printf("UPS ups_akb_info_parser_start: %s\r\n", data);
  468. memset(value, 0, 20);
  469. if (UPS.model[0] == 0) {
  470. for (uint8_t i = 0; i < VOLTRONIC_MODEL_LENGTH; i ++) {
  471. if (data[i] != '#') {
  472. value[j] = data[i];
  473. j ++;
  474. }
  475. }
  476. if(strncmp(value, "WPHV", 4) == 0 || value[0] == 0) {
  477. strcpy(UPS.model, "RTMP II");
  478. } else {
  479. len = strlen(value);
  480. strncpy(UPS.model, value, len);
  481. }
  482. SNMP_SetObjDescr();
  483. } else {
  484. return;
  485. }
  486. }
  487. void ups_version_response(char *data)
  488. {
  489. char value[20];
  490. uint8_t len = 0;
  491. DBG printf("ups_akb_info_response: %s\r\n", data);
  492. if (data[0] != '(') {
  493. return;
  494. }
  495. DBG printf("ups_akb_info_parser_start\r\n");
  496. UPS.Present = true;
  497. UPS.Flag_Present = true;
  498. UPS.cnt_err_ups = 0;
  499. data++;
  500. if (UPS.vertion[0] != 0) {
  501. if(strncmp(data, UPS.vertion, strlen(UPS.vertion)) == 0){
  502. return;
  503. }
  504. }
  505. memset(UPS.vertion, 0, sizeof(UPS.vertion));
  506. len = get_ups_param(data, ":", value);
  507. data += (len + 1);
  508. DBG printf("UPS ups_akb_info_parser_start: %s\r\n", data);
  509. len = get_ups_param(data, "\r", value);
  510. if (len > VOLTRONIC_VERSION_LENGTH) {
  511. len = VOLTRONIC_VERSION_LENGTH;
  512. }
  513. strncpy(UPS.vertion, value, len);
  514. }
  515. void ups_version_part2_response(char *data)
  516. {
  517. char value[20];
  518. uint8_t len = 0;
  519. DBG printf("ups_akb_info_response: %s\r\n", data);
  520. if (data[0] != '(') {
  521. return;
  522. }
  523. DBG printf("ups_akb_info_parser_start\r\n");
  524. UPS.Present = true;
  525. UPS.Flag_Present = true;
  526. UPS.cnt_err_ups = 0;
  527. if (strncmp(ups_pdu.data, "(NAK", 4) == 0) {
  528. return;
  529. }
  530. data++;
  531. if (UPS.vertion[VOLTRONIC_VERSION_LENGTH] != 0) {
  532. return;
  533. }
  534. DBG printf("UPS ups_akb_info_parser_start: %s\r\n", data);
  535. len = get_ups_param(data, ":", value);
  536. data += (len + 1);
  537. len = get_ups_param(data, "\r", value);
  538. if (len > VOLTRONIC_VERSION_LENGTH) {
  539. len = VOLTRONIC_VERSION_LENGTH;
  540. }
  541. strncat(UPS.vertion, "/", 1);
  542. strncat(UPS.vertion, value, len);
  543. }
  544. void ups_serial_response(char *data)
  545. {
  546. char value[20];
  547. uint8_t len = 0;
  548. DBG printf("ups_serialresponse: %s\r\n", data);
  549. if (data[0] != '(') {
  550. return;
  551. }
  552. DBG printf("ups_serial_parser_start\r\n");
  553. UPS.Present = true;
  554. UPS.Flag_Present = true;
  555. UPS.cnt_err_ups = 0;
  556. data++;
  557. DBG printf("UPS ups_serial_parser_start: %s\r\n", data);
  558. len = get_ups_param(data, "\r", value);
  559. strncpy(UPS.serial, value, VOLTRONIC_SN_LENGTH);
  560. }
  561. void ups_protocol_id_response(char *data)
  562. {
  563. DBG printf("ups_protocol_id_response: %s\r\n", data);
  564. UPS.Present = true;
  565. UPS.Flag_Present = true;
  566. UPS.cnt_err_ups = 0;
  567. if (data[0] != '(') {
  568. if (strncmp(data, "NAK", 3) == 0 || strncmp(data, " \r", 2) == 0) {
  569. sSettings.UPS_Setting.type_ups = ups_kestar;
  570. }
  571. else if(strncmp(data, "QPI", 3) == 0) {
  572. sSettings.UPS_Setting.type_ups = ups_offline;
  573. }
  574. return;
  575. }
  576. data++;
  577. sSettings.UPS_Setting.type_ups = ups_voltronic;
  578. DBG printf("UPS ups_protocol_id_parser_start: %s\r\n", data);
  579. }
  580. void ups_buzzer_cntrl_response(char *data)
  581. {
  582. UPS.Present = true;
  583. UPS.Flag_Present = true;
  584. UPS.cnt_err_ups = 0;
  585. if (strlen(data) != 0) {
  586. if (strncmp(data, "(ACK", 4) == 0) {
  587. flag_buzzer_on = true;
  588. }
  589. }
  590. DBG printf("UPS ups_buzzer_cntrl_parser_start: %s\r\n", data);
  591. }
  592. void ups_megatec_process_pdu(cmdMegaTecEnums_t command)
  593. {
  594. switch (command) {
  595. case ups_status_req:
  596. case ups_offline_status_req:
  597. ups_status_response(ups_pdu.data);
  598. break;
  599. case ups_info:
  600. ups_info_response(ups_pdu.data);
  601. break;
  602. case ups_rating_info:
  603. break;
  604. case ups_remain_time_reg:
  605. ups_remain_time_response(ups_pdu.data);
  606. break;
  607. case ups_general_status_req:
  608. ups_general_status_response(ups_pdu.data);
  609. break;
  610. case ups_akb_info:
  611. ups_akb_info_response(ups_pdu.data);
  612. break;
  613. case ups_model_req:
  614. ups_model_response(ups_pdu.data);
  615. break;
  616. case ups_version_req:
  617. ups_version_response(ups_pdu.data);
  618. break;
  619. case ups_version2_req:
  620. ups_version_part2_response(ups_pdu.data);
  621. break;
  622. case ups_serial_req:
  623. ups_serial_response(ups_pdu.data);
  624. break;
  625. case ups_protocol_id_req:
  626. ups_protocol_id_response(ups_pdu.data);
  627. break;
  628. case ups_buzzer_cntrl:
  629. ups_buzzer_cntrl_response(ups_pdu.data);
  630. break;
  631. default:
  632. break;
  633. }
  634. }
  635. int ups_metac_service_pdu(cmdMegaTecEnums_t command)
  636. {
  637. if (UPS.Present) {
  638. while (!megatec_send) {
  639. vTaskDelay(50);
  640. }
  641. memset(ups_pdu.data, 0, UPS_PDU_MAX_LEN);
  642. megatec_send = false;
  643. if (sSettings.UPS_Setting.type_ups == ups_offline && command == ups_shutdown) {
  644. TimeParam2 = 1;
  645. send_MegaTec_cmd(ups_shutdown_restore);
  646. } else {
  647. UPS.SOC_test = UPS.SOC;
  648. send_MegaTec_cmd(command);
  649. }
  650. if (ups_megatec_rx_pdu()) {
  651. megatec_send = true;
  652. if (strncmp(ups_pdu.data, "ACK", 3) == 0 || strncmp(ups_pdu.data, "(ACK", 4) == 0) {
  653. return 1;
  654. } else if (strncmp(ups_pdu.data, "NAK", 3) == 0 || strncmp(ups_pdu.data, "(NAK", 4) == 0) {
  655. return 0;
  656. }
  657. }
  658. megatec_send = true;
  659. }
  660. return -1;
  661. }
  662. // TODO ����������� ���������
  663. //void request_task(void)
  664. void request_task(void *params)
  665. {
  666. uint8_t kestar_req[3] = { ups_status_req, ups_remain_time_reg, ups_info};
  667. uint8_t voltronic_req[6] = {ups_status_req, ups_akb_info, ups_model_req, ups_version_req, ups_version2_req, ups_serial_req};//
  668. uint8_t num_req = 0;
  669. uint8_t *req;
  670. ups_megatec_rx_pdu();
  671. for (;;) {
  672. if (UPS.Present == true) {
  673. if (UPS.Flag_Present == false) {
  674. if (UPS.cnt_err_ups != 2) {
  675. UPS.cnt_err_ups++;
  676. } else {
  677. UPS.Freq_in = 0;
  678. UPS.VAC_in = 0;
  679. UPS.VAC_out = 0;
  680. UPS.Temp = 0;
  681. UPS.Load = 0;
  682. UPS.SOC = 0;
  683. UPS.work_time = 0;
  684. UPS.Status = 0;
  685. UPS.Alarm = 0;
  686. UPS.Present = false;
  687. //memset(UPS.model, 0, 11);
  688. memset(UPS.vertion, 0, sizeof(UPS.vertion));
  689. init_ups_rbuf();
  690. }
  691. }
  692. }
  693. if (megatec_send) {
  694. memset(ups_pdu.data, 0, UPS_PDU_MAX_LEN);
  695. megatec_send = false;
  696. UPS.Flag_Present = false;
  697. send_MegaTec_cmd(ups_protocol_id_req);
  698. if (ups_megatec_rx_pdu()) {
  699. ups_megatec_process_pdu(ups_protocol_id_req);
  700. }
  701. megatec_send = true;
  702. }
  703. switch (sSettings.UPS_Setting.type_ups) {
  704. case ups_kestar:
  705. case ups_offline:
  706. num_req = sizeof(kestar_req);
  707. req = kestar_req;
  708. break;
  709. case ups_voltronic:
  710. num_req = sizeof(voltronic_req);
  711. req = voltronic_req;
  712. #ifdef UPS_BUZZER_OFF
  713. if (!flag_buzzer_on) {
  714. if (megatec_send) {
  715. memset(ups_pdu.data, 0, UPS_PDU_MAX_LEN);
  716. megatec_send = false;
  717. UPS.Flag_Present = false;
  718. send_MegaTec_cmd(ups_buzzer_cntrl);
  719. if (ups_megatec_rx_pdu()) {
  720. ups_megatec_process_pdu(ups_buzzer_cntrl);
  721. }
  722. megatec_send = true;
  723. }
  724. }
  725. #endif
  726. break;
  727. default:
  728. num_req = sizeof(kestar_req);
  729. req = kestar_req;
  730. break;
  731. }
  732. vTaskDelay(1000);
  733. for (uint8_t i = 0; i < num_req; i++) {
  734. if (megatec_send) {
  735. memset(ups_pdu.data, 0, UPS_PDU_MAX_LEN);
  736. megatec_send = false;
  737. UPS.Flag_Present = false;
  738. send_MegaTec_cmd(req[i]);
  739. if (ups_megatec_rx_pdu()) {
  740. ups_megatec_process_pdu(req[i]);
  741. }
  742. megatec_send = true;
  743. }
  744. }
  745. }
  746. }
  747. void akb_time_work_task(void *params)
  748. {
  749. static uint32_t tick_prev = 0;
  750. for (;;) {
  751. if (UPS.Present && ((UPS.Status >> 7) & 0x01)) {
  752. if (tick_prev == 0) {
  753. tick_prev = xTaskGetTickCount();
  754. }
  755. UPS.akb_work_time += (xTaskGetTickCount() - tick_prev) / 1000;
  756. tick_prev = xTaskGetTickCount();
  757. } else {
  758. tick_prev = 0;
  759. UPS.akb_work_time = 0;
  760. }
  761. vTaskDelay(1000);
  762. }
  763. }
  764. void ups_megatec_init(void)
  765. {
  766. init_UPS_value();
  767. UPS.Present = true;
  768. xTaskCreate(request_task, ( char * ) "request_task", configMINIMAL_STACK_SIZE * 2, NULL, tskIDLE_PRIORITY, NULL);
  769. xTaskCreate(akb_time_work_task, ( char * ) "akb_time_work_task", configMINIMAL_STACK_SIZE, NULL, tskIDLE_PRIORITY,
  770. NULL);
  771. }