mon.c 13 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430
  1. /*
  2. * Copyright (c) 2006-2021, RT-Thread Development Team
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. *
  6. * Change Logs:
  7. * Date Author Notes
  8. * 2022-06-29 19813 the first version
  9. */
  10. #include "mon.h"
  11. #define DBG_TAG "MON"
  12. #define DBG_LVL DBG_LOG
  13. #include <rtdbg.h>
  14. #include <string.h>
  15. #include <stdlib.h>
  16. #include <stdio.h>
  17. #include "loar.h"
  18. #include "Host.h"
  19. uint8_t start_monitor = Zero;
  20. #ifdef USING_MON
  21. #define pagename "monitor."
  22. extern uint8_t All_finsh;
  23. extern uint16_t GPRSReadCnt; //串口3接收到的数据个数
  24. extern uint8_t GPRSReadFlag; //串口3接收数据完成标记位
  25. extern uint8_t GPRS_ReadBuff[1024]; //串口3接收数据缓存
  26. extern void format_uartbuf(uint8_t uart);
  27. QNode *q_data; //用于保存收到的数据 的 双向链式队列的指针
  28. QNode *q_txt; //保存准备发送的内容
  29. // uint8_t txt_size[6] = {0}; //存放对应的刷新内容的大小
  30. // uint8_t txt_sbuf[6][128] = {0}; //存放刷新用的内容
  31. QNode *initQueue()
  32. {
  33. QNode *queue = (QNode *)rt_malloc(sizeof(QNode));
  34. queue->next = NULL; //上一个是NULL
  35. queue->last = NULL; //下一个也是NULL
  36. LOG_I("initQueue succ . Addr %08X", queue);
  37. return queue;
  38. }
  39. uint8_t Queue_in(QNode *qnode, char *buf, uint8_t data_l)
  40. {
  41. QNode *q_in = qnode->next;
  42. q_in = (QNode *)rt_malloc(sizeof(QNode));
  43. if (q_in == RT_NULL)
  44. {
  45. LOG_W("Queue_in failed no enough mem");
  46. }
  47. memset(q_in->data, 0, sizeof(q_in->data));
  48. for (uint8_t a = 0; a < data_l % MAX_MON_CACHE_BUF_SIZE; a++)
  49. {
  50. q_in->data[a] = *(buf + a);
  51. }
  52. q_in->data_lenght = data_l;
  53. q_in->last = qnode;
  54. q_in->next = qnode->next;
  55. q_in->next->last = q_in;
  56. qnode->next = q_in;
  57. return 1;
  58. }
  59. uint8_t Queue_out(QNode *qnode, char *buf)
  60. {
  61. QNode *q_out = qnode->next;
  62. if (qnode->next == NULL)
  63. {
  64. LOG_W("\n队列为空\n");
  65. return 0;
  66. }
  67. while (q_out->next != NULL)
  68. {
  69. q_out = q_out->next;
  70. }
  71. for (uint8_t a = 0; a < q_out->data_lenght % MAX_MON_CACHE_BUF_SIZE; a++)
  72. {
  73. *(buf + a) = q_out->data[a];
  74. }
  75. q_out->last->next = NULL;
  76. rt_free(q_out);
  77. return q_out->data_lenght;
  78. }
  79. void delete_queue(QNode *qnode) //删除队列里所有内容 尚未验证
  80. {
  81. QNode *q_de = qnode;
  82. while (q_de->next != NULL)
  83. {
  84. q_de = q_de->next;
  85. }
  86. while (q_de->last != qnode)
  87. {
  88. q_de = q_de->last;
  89. rt_free(q_de->next);
  90. }
  91. rt_free(q_de);
  92. }
  93. uint8_t get_queue_len(QNode *qnode)
  94. {
  95. QNode *q_in = qnode;
  96. uint8_t cnt = 0;
  97. while (q_in->next != NULL)
  98. {
  99. q_in = q_in->next;
  100. cnt++;
  101. }
  102. return cnt;
  103. }
  104. void sendbuf_to_hmi(char *buf, uint8_t lenght)
  105. {
  106. *(buf + lenght + 0) = 0xFF;
  107. *(buf + lenght + 1) = 0xFF;
  108. *(buf + lenght + 2) = 0xFF;
  109. *(buf + lenght + 3) = '\0';
  110. rt_kprintf("%s", buf);
  111. }
  112. void send_all_txt(void)
  113. {
  114. QNode *q = q_txt->next;
  115. uint8_t q_txt_num = get_queue_len(q_txt);
  116. uint8_t txt_buf[MAX_MON_CACHE_BUF_SIZE + 20] = {0};
  117. uint8_t txt_size = 0;
  118. for (uint8_t a = 0; a < q_txt_num; a++)
  119. {
  120. txt_size = rt_sprintf((char *)txt_buf, "t%d.txt=\"%s\"", a, q->data);
  121. sendbuf_to_hmi((char *)txt_buf, txt_size);
  122. // rt_kprintf("%s\n\n",q->data);
  123. q = q->next;
  124. }
  125. rt_free(q);
  126. }
  127. extern uint16_t CRC16_Modbus(uint8_t *_pBuf, uint16_t _usLen);
  128. uint8_t CRC_Check(uint8_t datas_size, uint8_t *data_buf)
  129. {
  130. uint16_t crc1 = 0;
  131. uint8_t result = 0;
  132. crc1 = CRC16_Modbus((uint8_t *)data_buf, datas_size - 2);
  133. if (((uint8_t)crc1 != data_buf[datas_size - 1]) || (((uint8_t)(crc1 >> 8) != data_buf[datas_size - 2]))) // CRC计算校验和失败
  134. {
  135. LOG_W("CRC_Check FAILED\r\n");
  136. }
  137. else
  138. {
  139. result = 1;
  140. }
  141. return result;
  142. }
  143. extern uint8_t RTC_SetTime(uint8_t hour, uint8_t minute, uint8_t second);
  144. uint8_t monitor_data_process(uint8_t datas_size, uint8_t *data_buf)
  145. {
  146. uint8_t result = 0;
  147. uint8_t txt_buf[MAX_MON_CACHE_BUF_SIZE] = {0};
  148. uint8_t txt_size = 0;
  149. uint8_t data_fill = 0;
  150. if (CRC_Check(datas_size, (uint8_t *)data_buf) == 1)
  151. {
  152. if (data_buf[0] == 0x5A)
  153. {
  154. if (data_buf[1] == 0x05 && data_buf[2] == 0xFF && datas_size == 9) //这是主机发送对时包
  155. {
  156. txt_size = rt_sprintf((char *)txt_buf, "向从机%d对时 %02d:%02d:%02d", data_buf[3], data_buf[4], data_buf[5], data_buf[6]);
  157. data_fill = 1;
  158. }
  159. // 5A 04 FE 03 C8 00 6B 09
  160. if (data_buf[1] == 0x04 && data_buf[2] == 0xFE && datas_size == 8) //这是主机发送时间修正包
  161. {
  162. if (data_buf[4] == Zero && data_buf[5] == 0)
  163. {
  164. txt_size = rt_sprintf((char *)txt_buf, "从机%d上报时刻校验正确", data_buf[3]);
  165. data_fill = 1;
  166. }
  167. else if (data_buf[4] == One)
  168. {
  169. txt_size = rt_sprintf((char *)txt_buf, "将从机%d上报时刻延后%d秒", data_buf[3], data_buf[5]);
  170. data_fill = 1;
  171. }
  172. else if (data_buf[4] == Zero)
  173. {
  174. txt_size = rt_sprintf((char *)txt_buf, "将从机%d上报时刻提前%d秒", data_buf[3], data_buf[5]);
  175. data_fill = 1;
  176. }
  177. }
  178. // 5A 0C 03 12 11 44 05 01 7F 05 43 1D D7 AE A4 46
  179. if (data_buf[2] > 0 && data_buf[2] <= 16 && datas_size >= 13 && data_buf[1] >= 10) //这是从机在这上报数据呢
  180. {
  181. txt_size = rt_sprintf((char *)txt_buf, "从机%d上报数据", data_buf[2]);
  182. data_fill = 1;
  183. }
  184. if (data_buf[1] == 0x05 && data_buf[2] <= 16 && datas_size == 9) //这是从机发来配对包
  185. {
  186. }
  187. }
  188. if (data_buf[0] == 0x5B)
  189. {
  190. if (data_buf[2] > 0 && data_buf[2] <= 16 && datas_size >= 13) //这也是从机在这上报数据呢 但是同时请求对时
  191. {
  192. if (data_buf[2] > 0 && data_buf[2] <= 16 && datas_size >= 13) //这是从机在这上报数据呢
  193. {
  194. txt_size = rt_sprintf((char *)txt_buf, "从机%d上报数据且请求对时", data_buf[2]);
  195. data_fill = 1;
  196. }
  197. }
  198. }
  199. if (data_fill == 1)
  200. {
  201. Queue_in(q_txt, (char *)txt_buf, txt_size);
  202. while (get_queue_len(q_txt) > MAX_TXT_ROW)
  203. {
  204. Queue_out(q_txt, (char *)txt_buf);
  205. }
  206. data_fill = 0;
  207. }
  208. }
  209. return result;
  210. }
  211. static void monitor_lora_thread_Task(void *param)
  212. {
  213. if (Node_Type == Monitor)
  214. {
  215. q_data = initQueue();
  216. while (1)
  217. {
  218. while (start_monitor != One)
  219. {
  220. rt_thread_mdelay(100);
  221. }
  222. rt_thread_mdelay(10);
  223. if (GPRSReadFlag == 1)
  224. {
  225. Queue_in(q_data, (char *)GPRS_ReadBuff, GPRSReadCnt);
  226. get_queue_len(q_data);
  227. format_uartbuf(3);
  228. }
  229. }
  230. }
  231. }
  232. extern uint8_t ReFlash_RTC(void);
  233. extern RTC_TimeTypeDef GetTime;
  234. extern RTC_DateTypeDef GetDate;
  235. static void Reflash_Time_thread_Task(void *param)
  236. {
  237. if (Node_Type == Monitor)
  238. {
  239. char send_time_buf[100] = {0};
  240. uint8_t buf_size = 0;
  241. while (1)
  242. {
  243. rt_thread_mdelay(1000);
  244. memset(send_time_buf, 0, 100);
  245. buf_size = 0;
  246. ReFlash_RTC();
  247. buf_size = rt_sprintf(send_time_buf, "%st13.txt=\"%02d/%02d/%02d\\r%02d:%02d:%02d\"",
  248. pagename, GetDate.Year % 100, GetDate.Month,
  249. GetDate.Date, GetTime.Hours, GetTime.Minutes, GetTime.Seconds);
  250. sendbuf_to_hmi((char *)send_time_buf, buf_size);
  251. memset(send_time_buf, 0, 100);
  252. buf_size = 0;
  253. buf_size = rt_sprintf(send_time_buf, "main.mon_flg.val=100");
  254. sendbuf_to_hmi((char *)send_time_buf, buf_size);
  255. }
  256. }
  257. }
  258. static void Reflash_data_thread_Task(void *param)
  259. {
  260. if (Node_Type == Monitor)
  261. {
  262. uint8_t data_out_buf[MAX_MON_CACHE_BUF_SIZE] = {0};
  263. uint8_t out_size = 0;
  264. uint32_t cnt = 0;
  265. rt_thread_mdelay(100);
  266. q_txt = initQueue();
  267. while (1)
  268. {
  269. rt_thread_mdelay(10);
  270. if (q_data->next != NULL)
  271. {
  272. out_size = Queue_out(q_data, (char *)data_out_buf);
  273. monitor_data_process(out_size, (uint8_t *)data_out_buf);
  274. send_all_txt();
  275. cnt = 0;
  276. }
  277. cnt++;
  278. if (cnt > 120000)
  279. {
  280. delete_queue(q_txt);
  281. }
  282. }
  283. }
  284. }
  285. int monitor_lora_thread(void)
  286. {
  287. rt_thread_t tid1 = RT_NULL;
  288. tid1 = rt_thread_create("monitor_lora_thread_Task",
  289. monitor_lora_thread_Task, RT_NULL,
  290. 2048,
  291. 9, 5);
  292. if (tid1 != RT_NULL)
  293. {
  294. rt_thread_startup(tid1);
  295. }
  296. else
  297. LOG_E("Reflash_Time_thread start failed");
  298. return 0;
  299. }
  300. int Reflash_Time_thread(void)
  301. {
  302. rt_thread_t tid1 = RT_NULL;
  303. tid1 = rt_thread_create("Reflash_Time_thread_Task",
  304. Reflash_Time_thread_Task, RT_NULL,
  305. 512,
  306. 9, 5);
  307. if (tid1 != RT_NULL)
  308. {
  309. rt_thread_startup(tid1);
  310. }
  311. else
  312. LOG_E("Reflash_Time_thread start failed");
  313. return 0;
  314. }
  315. int Reflash_data_thread(void)
  316. {
  317. rt_thread_t tid1 = RT_NULL;
  318. tid1 = rt_thread_create("Reflash_data_thread_Task",
  319. Reflash_data_thread_Task, RT_NULL,
  320. 2048,
  321. 9, 5);
  322. if (tid1 != RT_NULL)
  323. {
  324. rt_thread_startup(tid1);
  325. }
  326. else
  327. LOG_E("Reflash_Time_thread start failed");
  328. return 0;
  329. }
  330. INIT_APP_EXPORT(monitor_lora_thread); //监听lora数据包
  331. INIT_APP_EXPORT(Reflash_Time_thread); //向屏幕刷新时间
  332. INIT_APP_EXPORT(Reflash_data_thread); //向屏幕刷新数据
  333. #endif
  334. //
  335. // 队列操作的详解备份
  336. // QNode *Queue_in(QNode *qnode, char *buf , uint8_t data_l)
  337. //{
  338. // QNode *enElem = (QNode *)rt_malloc(sizeof(QNode)); //在队首插入一个元素 首先先申请个新节点
  339. // if(enElem == RT_NULL)
  340. // {
  341. // LOG_W("Queue_in failed no enough mem");
  342. // }
  343. // memset(enElem->data , 0 , sizeof(enElem->data));
  344. // for (uint8_t a = 0; a < data_l; a++) //外部buf要保存的值写给这个节点里的buf
  345. // {
  346. // enElem->data[a] = *(buf + a);
  347. // rt_kprintf("%02X ", enElem->data[a]);
  348. // if (a % 16 == 0 && a != 0)
  349. // {
  350. // rt_kprintf("\n");
  351. // }
  352. // }
  353. // enElem->data_lenght = data_l;
  354. // enElem->last = qnode; //新节点的上个节点指向头节点
  355. // enElem->next = qnode->next; //新节点的下个节点指向之前头节点的下个节点
  356. // enElem->next->last = enElem;//更新下个节点的上个节点信息
  357. // qnode->next = enElem; //头节点的下个节点指向新节点
  358. // LOG_I("\nadd qnode succ . addr %08X",enElem);
  359. // return qnode;
  360. //}
  361. // uint8_t Queue_out(QNode *qnode, char *buf)
  362. //{
  363. // LOG_I("ready to out qnode");
  364. // uint8_t cnt = 1;
  365. // QNode *p = qnode->next; //要出来一个节点 首先给把头节点的下个节点给一个缓存节点
  366. //
  367. // if (qnode->next == NULL) //判断是不是已经空了
  368. // {
  369. // rt_kprintf("\n队列为空");
  370. // return 0;
  371. // }
  372. // while (p->next != NULL) //顺着头节点往下走 一直走到队列里的最后一个节点
  373. // {
  374. // LOG_I("第 %d 个节点不是最后一个元素 addr %08X",cnt ,p);
  375. // p = p->next;
  376. // LOG_I("准备检索下一个 addr %08X 此时p的last为 %08X",p,p->last);
  377. // cnt++;
  378. // }
  379. // LOG_I("\nfind end of qnode . addr %08X",p);
  380. // LOG_I("正在拿出的数据 %d byte",p->data_lenght);
  381. // for (uint8_t a = 0; a < p->data_lenght ; a++) //把要拿出来的数据赋给外部buf
  382. // {
  383. // *(buf + a) = p->data[a];
  384. // rt_kprintf("%02X ", p->data[a]);
  385. // if (a % 16 == 0 && a != 0)
  386. // {
  387. // rt_kprintf("\n");
  388. // }
  389. // }
  390. // LOG_I("拿出数据完毕 \n");
  391. // p->last->next = NULL; //这个节点的数据已经拿出来了 将上一个节点指向NULL 释放掉该节点
  392. // LOG_I("更新队尾节点的位置由 %08X 改为 %08X",p , p->last);
  393. // rt_free(p);
  394. // return p->data_lenght;
  395. //}