| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430 |
- /*
- * Copyright (c) 2006-2021, RT-Thread Development Team
- *
- * SPDX-License-Identifier: Apache-2.0
- *
- * Change Logs:
- * Date Author Notes
- * 2022-06-29 19813 the first version
- */
- #include "mon.h"
- #define DBG_TAG "MON"
- #define DBG_LVL DBG_LOG
- #include <rtdbg.h>
- #include <string.h>
- #include <stdlib.h>
- #include <stdio.h>
- #include "loar.h"
- #include "Host.h"
- uint8_t start_monitor = Zero;
- #ifdef USING_MON
- #define pagename "monitor."
- extern uint8_t All_finsh;
- extern uint16_t GPRSReadCnt; //串口3接收到的数据个数
- extern uint8_t GPRSReadFlag; //串口3接收数据完成标记位
- extern uint8_t GPRS_ReadBuff[1024]; //串口3接收数据缓存
- extern void format_uartbuf(uint8_t uart);
- QNode *q_data; //用于保存收到的数据 的 双向链式队列的指针
- QNode *q_txt; //保存准备发送的内容
- // uint8_t txt_size[6] = {0}; //存放对应的刷新内容的大小
- // uint8_t txt_sbuf[6][128] = {0}; //存放刷新用的内容
- QNode *initQueue()
- {
- QNode *queue = (QNode *)rt_malloc(sizeof(QNode));
- queue->next = NULL; //上一个是NULL
- queue->last = NULL; //下一个也是NULL
- LOG_I("initQueue succ . Addr %08X", queue);
- return queue;
- }
- uint8_t Queue_in(QNode *qnode, char *buf, uint8_t data_l)
- {
- QNode *q_in = qnode->next;
- q_in = (QNode *)rt_malloc(sizeof(QNode));
- if (q_in == RT_NULL)
- {
- LOG_W("Queue_in failed no enough mem");
- }
- memset(q_in->data, 0, sizeof(q_in->data));
- for (uint8_t a = 0; a < data_l % MAX_MON_CACHE_BUF_SIZE; a++)
- {
- q_in->data[a] = *(buf + a);
- }
- q_in->data_lenght = data_l;
- q_in->last = qnode;
- q_in->next = qnode->next;
- q_in->next->last = q_in;
- qnode->next = q_in;
- return 1;
- }
- uint8_t Queue_out(QNode *qnode, char *buf)
- {
- QNode *q_out = qnode->next;
- if (qnode->next == NULL)
- {
- LOG_W("\n队列为空\n");
- return 0;
- }
- while (q_out->next != NULL)
- {
- q_out = q_out->next;
- }
- for (uint8_t a = 0; a < q_out->data_lenght % MAX_MON_CACHE_BUF_SIZE; a++)
- {
- *(buf + a) = q_out->data[a];
- }
- q_out->last->next = NULL;
- rt_free(q_out);
- return q_out->data_lenght;
- }
- void delete_queue(QNode *qnode) //删除队列里所有内容 尚未验证
- {
- QNode *q_de = qnode;
- while (q_de->next != NULL)
- {
- q_de = q_de->next;
- }
- while (q_de->last != qnode)
- {
- q_de = q_de->last;
- rt_free(q_de->next);
- }
- rt_free(q_de);
- }
- uint8_t get_queue_len(QNode *qnode)
- {
- QNode *q_in = qnode;
- uint8_t cnt = 0;
- while (q_in->next != NULL)
- {
- q_in = q_in->next;
- cnt++;
- }
- return cnt;
- }
- void sendbuf_to_hmi(char *buf, uint8_t lenght)
- {
- *(buf + lenght + 0) = 0xFF;
- *(buf + lenght + 1) = 0xFF;
- *(buf + lenght + 2) = 0xFF;
- *(buf + lenght + 3) = '\0';
- rt_kprintf("%s", buf);
- }
- void send_all_txt(void)
- {
- QNode *q = q_txt->next;
- uint8_t q_txt_num = get_queue_len(q_txt);
- uint8_t txt_buf[MAX_MON_CACHE_BUF_SIZE + 20] = {0};
- uint8_t txt_size = 0;
- for (uint8_t a = 0; a < q_txt_num; a++)
- {
- txt_size = rt_sprintf((char *)txt_buf, "t%d.txt=\"%s\"", a, q->data);
- sendbuf_to_hmi((char *)txt_buf, txt_size);
- // rt_kprintf("%s\n\n",q->data);
- q = q->next;
- }
- rt_free(q);
- }
- extern uint16_t CRC16_Modbus(uint8_t *_pBuf, uint16_t _usLen);
- uint8_t CRC_Check(uint8_t datas_size, uint8_t *data_buf)
- {
- uint16_t crc1 = 0;
- uint8_t result = 0;
- crc1 = CRC16_Modbus((uint8_t *)data_buf, datas_size - 2);
- if (((uint8_t)crc1 != data_buf[datas_size - 1]) || (((uint8_t)(crc1 >> 8) != data_buf[datas_size - 2]))) // CRC计算校验和失败
- {
- LOG_W("CRC_Check FAILED\r\n");
- }
- else
- {
- result = 1;
- }
- return result;
- }
- extern uint8_t RTC_SetTime(uint8_t hour, uint8_t minute, uint8_t second);
- uint8_t monitor_data_process(uint8_t datas_size, uint8_t *data_buf)
- {
- uint8_t result = 0;
- uint8_t txt_buf[MAX_MON_CACHE_BUF_SIZE] = {0};
- uint8_t txt_size = 0;
- uint8_t data_fill = 0;
- if (CRC_Check(datas_size, (uint8_t *)data_buf) == 1)
- {
- if (data_buf[0] == 0x5A)
- {
- if (data_buf[1] == 0x05 && data_buf[2] == 0xFF && datas_size == 9) //这是主机发送对时包
- {
- txt_size = rt_sprintf((char *)txt_buf, "向从机%d对时 %02d:%02d:%02d", data_buf[3], data_buf[4], data_buf[5], data_buf[6]);
- data_fill = 1;
- }
- // 5A 04 FE 03 C8 00 6B 09
- if (data_buf[1] == 0x04 && data_buf[2] == 0xFE && datas_size == 8) //这是主机发送时间修正包
- {
- if (data_buf[4] == Zero && data_buf[5] == 0)
- {
- txt_size = rt_sprintf((char *)txt_buf, "从机%d上报时刻校验正确", data_buf[3]);
- data_fill = 1;
- }
- else if (data_buf[4] == One)
- {
- txt_size = rt_sprintf((char *)txt_buf, "将从机%d上报时刻延后%d秒", data_buf[3], data_buf[5]);
- data_fill = 1;
- }
- else if (data_buf[4] == Zero)
- {
- txt_size = rt_sprintf((char *)txt_buf, "将从机%d上报时刻提前%d秒", data_buf[3], data_buf[5]);
- data_fill = 1;
- }
- }
- // 5A 0C 03 12 11 44 05 01 7F 05 43 1D D7 AE A4 46
- if (data_buf[2] > 0 && data_buf[2] <= 16 && datas_size >= 13 && data_buf[1] >= 10) //这是从机在这上报数据呢
- {
- txt_size = rt_sprintf((char *)txt_buf, "从机%d上报数据", data_buf[2]);
- data_fill = 1;
- }
- if (data_buf[1] == 0x05 && data_buf[2] <= 16 && datas_size == 9) //这是从机发来配对包
- {
- }
- }
- if (data_buf[0] == 0x5B)
- {
- if (data_buf[2] > 0 && data_buf[2] <= 16 && datas_size >= 13) //这也是从机在这上报数据呢 但是同时请求对时
- {
- if (data_buf[2] > 0 && data_buf[2] <= 16 && datas_size >= 13) //这是从机在这上报数据呢
- {
- txt_size = rt_sprintf((char *)txt_buf, "从机%d上报数据且请求对时", data_buf[2]);
- data_fill = 1;
- }
- }
- }
- if (data_fill == 1)
- {
- Queue_in(q_txt, (char *)txt_buf, txt_size);
- while (get_queue_len(q_txt) > MAX_TXT_ROW)
- {
- Queue_out(q_txt, (char *)txt_buf);
- }
- data_fill = 0;
- }
- }
- return result;
- }
- static void monitor_lora_thread_Task(void *param)
- {
- if (Node_Type == Monitor)
- {
- q_data = initQueue();
- while (1)
- {
- while (start_monitor != One)
- {
- rt_thread_mdelay(100);
- }
- rt_thread_mdelay(10);
- if (GPRSReadFlag == 1)
- {
- Queue_in(q_data, (char *)GPRS_ReadBuff, GPRSReadCnt);
- get_queue_len(q_data);
- format_uartbuf(3);
- }
- }
- }
- }
- extern uint8_t ReFlash_RTC(void);
- extern RTC_TimeTypeDef GetTime;
- extern RTC_DateTypeDef GetDate;
- static void Reflash_Time_thread_Task(void *param)
- {
- if (Node_Type == Monitor)
- {
- char send_time_buf[100] = {0};
- uint8_t buf_size = 0;
- while (1)
- {
- rt_thread_mdelay(1000);
- memset(send_time_buf, 0, 100);
- buf_size = 0;
- ReFlash_RTC();
- buf_size = rt_sprintf(send_time_buf, "%st13.txt=\"%02d/%02d/%02d\\r%02d:%02d:%02d\"",
- pagename, GetDate.Year % 100, GetDate.Month,
- GetDate.Date, GetTime.Hours, GetTime.Minutes, GetTime.Seconds);
- sendbuf_to_hmi((char *)send_time_buf, buf_size);
- memset(send_time_buf, 0, 100);
- buf_size = 0;
- buf_size = rt_sprintf(send_time_buf, "main.mon_flg.val=100");
- sendbuf_to_hmi((char *)send_time_buf, buf_size);
- }
- }
- }
- static void Reflash_data_thread_Task(void *param)
- {
- if (Node_Type == Monitor)
- {
- uint8_t data_out_buf[MAX_MON_CACHE_BUF_SIZE] = {0};
- uint8_t out_size = 0;
- uint32_t cnt = 0;
- rt_thread_mdelay(100);
- q_txt = initQueue();
- while (1)
- {
- rt_thread_mdelay(10);
- if (q_data->next != NULL)
- {
- out_size = Queue_out(q_data, (char *)data_out_buf);
- monitor_data_process(out_size, (uint8_t *)data_out_buf);
- send_all_txt();
- cnt = 0;
- }
- cnt++;
- if (cnt > 120000)
- {
- delete_queue(q_txt);
- }
- }
- }
- }
- int monitor_lora_thread(void)
- {
- rt_thread_t tid1 = RT_NULL;
- tid1 = rt_thread_create("monitor_lora_thread_Task",
- monitor_lora_thread_Task, RT_NULL,
- 2048,
- 9, 5);
- if (tid1 != RT_NULL)
- {
- rt_thread_startup(tid1);
- }
- else
- LOG_E("Reflash_Time_thread start failed");
- return 0;
- }
- int Reflash_Time_thread(void)
- {
- rt_thread_t tid1 = RT_NULL;
- tid1 = rt_thread_create("Reflash_Time_thread_Task",
- Reflash_Time_thread_Task, RT_NULL,
- 512,
- 9, 5);
- if (tid1 != RT_NULL)
- {
- rt_thread_startup(tid1);
- }
- else
- LOG_E("Reflash_Time_thread start failed");
- return 0;
- }
- int Reflash_data_thread(void)
- {
- rt_thread_t tid1 = RT_NULL;
- tid1 = rt_thread_create("Reflash_data_thread_Task",
- Reflash_data_thread_Task, RT_NULL,
- 2048,
- 9, 5);
- if (tid1 != RT_NULL)
- {
- rt_thread_startup(tid1);
- }
- else
- LOG_E("Reflash_Time_thread start failed");
- return 0;
- }
- INIT_APP_EXPORT(monitor_lora_thread); //监听lora数据包
- INIT_APP_EXPORT(Reflash_Time_thread); //向屏幕刷新时间
- INIT_APP_EXPORT(Reflash_data_thread); //向屏幕刷新数据
- #endif
- //
- // 队列操作的详解备份
- // QNode *Queue_in(QNode *qnode, char *buf , uint8_t data_l)
- //{
- // QNode *enElem = (QNode *)rt_malloc(sizeof(QNode)); //在队首插入一个元素 首先先申请个新节点
- // if(enElem == RT_NULL)
- // {
- // LOG_W("Queue_in failed no enough mem");
- // }
- // memset(enElem->data , 0 , sizeof(enElem->data));
- // for (uint8_t a = 0; a < data_l; a++) //外部buf要保存的值写给这个节点里的buf
- // {
- // enElem->data[a] = *(buf + a);
- // rt_kprintf("%02X ", enElem->data[a]);
- // if (a % 16 == 0 && a != 0)
- // {
- // rt_kprintf("\n");
- // }
- // }
- // enElem->data_lenght = data_l;
- // enElem->last = qnode; //新节点的上个节点指向头节点
- // enElem->next = qnode->next; //新节点的下个节点指向之前头节点的下个节点
- // enElem->next->last = enElem;//更新下个节点的上个节点信息
- // qnode->next = enElem; //头节点的下个节点指向新节点
- // LOG_I("\nadd qnode succ . addr %08X",enElem);
- // return qnode;
- //}
- // uint8_t Queue_out(QNode *qnode, char *buf)
- //{
- // LOG_I("ready to out qnode");
- // uint8_t cnt = 1;
- // QNode *p = qnode->next; //要出来一个节点 首先给把头节点的下个节点给一个缓存节点
- //
- // if (qnode->next == NULL) //判断是不是已经空了
- // {
- // rt_kprintf("\n队列为空");
- // return 0;
- // }
- // while (p->next != NULL) //顺着头节点往下走 一直走到队列里的最后一个节点
- // {
- // LOG_I("第 %d 个节点不是最后一个元素 addr %08X",cnt ,p);
- // p = p->next;
- // LOG_I("准备检索下一个 addr %08X 此时p的last为 %08X",p,p->last);
- // cnt++;
- // }
- // LOG_I("\nfind end of qnode . addr %08X",p);
- // LOG_I("正在拿出的数据 %d byte",p->data_lenght);
- // for (uint8_t a = 0; a < p->data_lenght ; a++) //把要拿出来的数据赋给外部buf
- // {
- // *(buf + a) = p->data[a];
- // rt_kprintf("%02X ", p->data[a]);
- // if (a % 16 == 0 && a != 0)
- // {
- // rt_kprintf("\n");
- // }
- // }
- // LOG_I("拿出数据完毕 \n");
- // p->last->next = NULL; //这个节点的数据已经拿出来了 将上一个节点指向NULL 释放掉该节点
- // LOG_I("更新队尾节点的位置由 %08X 改为 %08X",p , p->last);
- // rt_free(p);
- // return p->data_lenght;
- //}
|