462 lines
15 KiB
C
462 lines
15 KiB
C
#include "bsp_history.h"
|
||
#include "bsp_flash.h"
|
||
#include "bsp_rtc.h"
|
||
#include "drv_uart.h"
|
||
#include "lwrb.h"
|
||
#include "serial.h"
|
||
#include "rtdef.h"
|
||
#include "user_rtt.h"
|
||
#define LOG_TAG "bsp_hr" // 该模块对应的标签。不定义时，默认：NO_TAG
|
||
#define LOG_LVL LOG_LVL_DBG // 该模块对应的日志输出级别。不定义时，默认：调试级别
|
||
#include <ulog.h> // 必须在 LOG_TAG 与 LOG_LVL 下面
|
||
|
||
ALIGN(RT_ALIGN_SIZE)
|
||
static char hr_thread_stack[HR_THREAD_STACK_SIZE];
|
||
static struct rt_thread hr_thread;
|
||
|
||
/* 用于接收消息的信号量 */
|
||
rt_sem_t hr_rx_sem = RT_NULL;
|
||
|
||
/**
|
||
* @description: 从帧起始符开始到校验码之前所有字节的和的模256，即各字节不计超过255的溢出值的二进制算术和。
|
||
* @param {uint8_t} *data
|
||
* @param {uint16_t} len
|
||
* @return {*}
|
||
*/
|
||
static rt_uint8_t HR_CheckSum(const rt_uint8_t *data, rt_size_t len)
|
||
{
|
||
rt_uint8_t sum = 0;
|
||
|
||
for (rt_size_t i = 0; i < len; i++)
|
||
{
|
||
sum += data[i];
|
||
}
|
||
return sum;
|
||
}
|
||
|
||
/**
|
||
* @description: 从接收缓冲区中获取一帧有效数据
|
||
* @param {TsFrameData} *pFrameData 主机帧
|
||
* @param {uint8_t} *p_src 接收缓冲区
|
||
* @param {uint16_t} src_len 接收缓冲区长度
|
||
* @return {*}
|
||
*/
|
||
TsFrameData *HR_GetFrameData(const rt_uint8_t *p_src, const rt_uint8_t src_len)
|
||
{
|
||
rt_uint8_t data_field_len = 0;
|
||
rt_uint8_t check_sum = 0;
|
||
|
||
TsFrameData *get_buffer = RT_NULL;
|
||
|
||
for (rt_size_t i = 0; i < src_len; i++)
|
||
{
|
||
if (p_src[i] == FRAME_HEADER)
|
||
{
|
||
data_field_len = p_src[i + 3];
|
||
|
||
if (p_src[i + 3 + data_field_len + 2] == FRAME_TAIL)
|
||
{
|
||
check_sum = HR_CheckSum(&p_src[i], (4 + data_field_len));
|
||
|
||
if (p_src[i + 3 + data_field_len + 1] == check_sum)
|
||
{
|
||
get_buffer = (TsFrameData *)rt_malloc(sizeof(TsFrameData) + sizeof(rt_uint8_t) * data_field_len);
|
||
if (get_buffer == RT_NULL)
|
||
{
|
||
LOG_E("get space fail\r\n");
|
||
|
||
return RT_NULL;
|
||
}
|
||
get_buffer->c1 = p_src[i + 1];
|
||
get_buffer->c2 = (TeFrameC2)p_src[i + 2];
|
||
get_buffer->len = data_field_len;
|
||
|
||
if (data_field_len > 0)
|
||
{
|
||
rt_memmove(get_buffer->data, &p_src[i + 4], data_field_len);
|
||
}
|
||
LOG_D("HR_GetDataFrame Success!");
|
||
|
||
return get_buffer;
|
||
}
|
||
}
|
||
}
|
||
}
|
||
LOG_E("HR_GetDataFrame Fail!");
|
||
|
||
return get_buffer;
|
||
}
|
||
|
||
#if 1
|
||
rt_uint8_t HR_GenerateRawFrame(TsRawFrameData *pRawData, rt_uint8_t c1, TeFrameC2 c2, const rt_uint8_t *p_src, rt_uint8_t src_len)
|
||
{
|
||
pRawData->len = src_len + 6;
|
||
|
||
rt_memset(pRawData->buf, 0, sizeof(pRawData->buf));
|
||
|
||
pRawData->buf[0] = FRAME_HEADER;
|
||
pRawData->buf[1] = c1;
|
||
pRawData->buf[2] = c2;
|
||
pRawData->buf[3] = src_len;
|
||
|
||
rt_memmove(&pRawData->buf[4], p_src, src_len);
|
||
|
||
// 从帧起始符开始到校验码之前所有字节的和的模256
|
||
// ，即各字节不计超过255的溢出值的二进制算术和。
|
||
pRawData->buf[pRawData->len - 2] = HR_CheckSum(&pRawData->buf[0], pRawData->len - 2);
|
||
pRawData->buf[pRawData->len - 1] = FRAME_TAIL;
|
||
|
||
// LOG_HEX("HrRawData", 16, &pRawData->buf[0], pRawData->len);
|
||
|
||
return RT_EOK;
|
||
}
|
||
#endif
|
||
|
||
#if 1
|
||
ErrorStatus HR_ProcessData(const TsFrameData *pHostFrameData)
|
||
{
|
||
TsRawFrameData RawData;
|
||
|
||
rt_uint8_t data_field[64] = {0};
|
||
rt_uint8_t c1, c2, data_len = 0;
|
||
|
||
c1 = pHostFrameData->c1;
|
||
c2 = pHostFrameData->c2;
|
||
|
||
switch (c2)
|
||
{
|
||
case kNumOfRecords: // 查询各类记录的总数 AA 00 00 00 AA 55
|
||
{
|
||
LOG_D("kNumOfRecords");
|
||
c1 = 0;
|
||
data_len = FRAME_DATA_LEN;
|
||
if (Flash_GetTotalRecord((TsTotalRecords *)&data_field[0]) != SUCCESS)
|
||
{
|
||
goto send;
|
||
}
|
||
break;
|
||
}
|
||
case kAlarmRecord: // 查询第n条探测器报警记录AA 01 01 00 AC 55
|
||
{
|
||
LOG_D("kAlarmRecord(%d)", c1);
|
||
data_len = FRAME_DATA_LEN;
|
||
if (Flash_GetRecord(kAlarmRecord, c1, (TsRecordsTime *)data_field) != SUCCESS)
|
||
{
|
||
if (data_field[0] == 0)
|
||
{
|
||
rt_memset(data_field, 0, data_len);
|
||
}
|
||
goto send;
|
||
}
|
||
break;
|
||
}
|
||
case kAlarmRcyRecord: // 查询第n条探测器报警恢复记录 AA 01 02 00 AD 55
|
||
{
|
||
LOG_D("kAlarmRcyRecord(%d)", c1);
|
||
data_len = 7;
|
||
if (Flash_GetRecord(kAlarmRcyRecord, c1, (TsRecordsTime *)data_field) != SUCCESS)
|
||
{
|
||
goto send;
|
||
}
|
||
break;
|
||
}
|
||
case kFaultRecord: // 查询第n条探测器故障记录 AA 01 03 00 AE 55
|
||
{
|
||
LOG_D("kFaultRecord(%d)", c1);
|
||
data_len = FRAME_DATA_LEN;
|
||
if (Flash_GetRecord(kFaultRecord, c1, (TsRecordsTime *)&data_field) != SUCCESS)
|
||
{
|
||
goto send;
|
||
}
|
||
break;
|
||
}
|
||
case kFaultRcyRecord: // 查询第n条探测器故障恢复记录 AA 01 04 00 AF 55 AA 66 04 00 14 55
|
||
{
|
||
LOG_D("kFaultRcyRecord(%d)", c1);
|
||
data_len = FRAME_DATA_LEN;
|
||
if (Flash_GetRecord(kFaultRcyRecord, c1, (TsRecordsTime *)data_field) != SUCCESS)
|
||
{
|
||
goto send;
|
||
}
|
||
break;
|
||
}
|
||
case kPowerFailureRecord: // 查询第n条探测器掉电记录 AA 01 05 00 B0 55
|
||
{
|
||
LOG_D("kPowerFailureRecord(%d)", c1);
|
||
data_len = FRAME_DATA_LEN;
|
||
if (Flash_GetRecord(kPowerFailureRecord, c1, (TsRecordsTime *)data_field) != SUCCESS)
|
||
{
|
||
goto send;
|
||
}
|
||
|
||
break;
|
||
}
|
||
case kPowerOnRecord: // 查询第n条探测器上电记录 AA 01 06 00 B1 55
|
||
{
|
||
LOG_D("kPowerOnRecord(%d)", c1);
|
||
data_len = FRAME_DATA_LEN;
|
||
if (Flash_GetRecord(kPowerOnRecord, c1, (TsRecordsTime *)data_field) == SUCCESS)
|
||
{
|
||
goto send;
|
||
}
|
||
break;
|
||
}
|
||
case kSensorFailureRecord: // 查询气体传感器失效记录 AA 00 07 00 B1 55
|
||
{
|
||
LOG_D("kSensorFailureRecord(%d)", c1);
|
||
|
||
data_len = FRAME_DATA_LEN;
|
||
if (Flash_GetRecord(kSensorFailureRecord, 1, (TsRecordsTime *)&data_field[0]) != SUCCESS)
|
||
{
|
||
|
||
if (c1 != 0) // 接收到的数据不对，直接返回0
|
||
{
|
||
rt_memset(data_field, 0, data_len);
|
||
}
|
||
else
|
||
{
|
||
if (data_field[1] == 0) // 未失效
|
||
{
|
||
rt_memset(data_field, 0, data_len);
|
||
}
|
||
else // 失效
|
||
{
|
||
data_field[0] = 1;
|
||
}
|
||
}
|
||
goto send;
|
||
}
|
||
break;
|
||
}
|
||
case kGetCurrentTime: // AA 00 08 00 B2 55
|
||
{
|
||
uint8_t rtctime[3] = {0}, rtcdate[3] = {0};
|
||
|
||
RTT_LOG_D("kGetCurrentTime");
|
||
|
||
data_len = FRAME_DATA_LEN;
|
||
|
||
BSP_Rtc_Get_Calendar(rtcdate, rtctime);
|
||
|
||
data_field[0] = 0x14;
|
||
data_field[1] = std_rtc_convert_bcd2bin(rtcdate[0]);
|
||
data_field[2] = std_rtc_convert_bcd2bin(rtcdate[1]);
|
||
data_field[3] = std_rtc_convert_bcd2bin(rtcdate[2]);
|
||
data_field[4] = std_rtc_convert_bcd2bin(rtctime[0]);
|
||
data_field[5] = std_rtc_convert_bcd2bin(rtctime[1]);
|
||
data_field[5] = std_rtc_convert_bcd2bin(rtctime[2]);
|
||
|
||
goto send;
|
||
}
|
||
/*扩展命令*/
|
||
#if 0
|
||
case kGetCurrentTimeSecond: // AA 00 09 00 B3 55
|
||
{
|
||
LOG_D("kGetCurrentTimeSecond");
|
||
|
||
data_len = 7;
|
||
|
||
BSP_Rtc_Get_Calendar(rtcdate, rtctime);
|
||
|
||
data_field[0] = 0x14;
|
||
data_field[1] = std_rtc_convert_bcd2bin(rtcdate[0]);
|
||
data_field[2] = std_rtc_convert_bcd2bin(rtcdate[1]);
|
||
data_field[3] = std_rtc_convert_bcd2bin(rtcdate[2]);
|
||
data_field[4] = std_rtc_convert_bcd2bin(rtctime[0]);
|
||
data_field[5] = std_rtc_convert_bcd2bin(rtctime[1]);
|
||
data_field[5] = std_rtc_convert_bcd2bin(rtctime[2]);
|
||
|
||
goto send;
|
||
|
||
break;
|
||
}
|
||
case kSetCurrentTime: /*2024-03-25 17:34:56 AA 00 0A 07 07 E8 03 19 11 22 38 31 55*/
|
||
{
|
||
LOG_D("kSetCurrentTime");
|
||
|
||
data_len = 7;
|
||
|
||
RtcDateTime.hour = pHostFrameData->data[4];
|
||
RtcDateTime.minute = pHostFrameData->data[5];
|
||
RtcDateTime.second = pHostFrameData->data[6];
|
||
RtcDateTime.day = pHostFrameData->data[3];
|
||
RtcDateTime.month = pHostFrameData->data[2];
|
||
RtcDateTime.year = (rt_uint16_t)(pHostFrameData->data[0] << 8 | pHostFrameData->data[1]);
|
||
|
||
// BSP_Rtc_DateTime_Cfg();
|
||
// RTC_Set(RtcDateTime.year, RtcDateTime.month, RtcDateTime.day,
|
||
// RtcDateTime.hour, RtcDateTime.minute, RtcDateTime.second);
|
||
|
||
// BSP_Rtc_Get_Calendar(rtcdate, rtctime);
|
||
|
||
data_field[0] = 0x14;
|
||
data_field[1] = std_rtc_convert_bcd2bin(rtcdate[0]);
|
||
data_field[2] = std_rtc_convert_bcd2bin(rtcdate[1]);
|
||
data_field[3] = std_rtc_convert_bcd2bin(rtcdate[2]);
|
||
data_field[4] = std_rtc_convert_bcd2bin(rtctime[0]);
|
||
data_field[5] = std_rtc_convert_bcd2bin(rtctime[1]);
|
||
data_field[5] = std_rtc_convert_bcd2bin(rtctime[2]);
|
||
|
||
goto send;
|
||
|
||
break;
|
||
}
|
||
case kSetFactoryTime: /*2024-03-26 9:30:00 AA 00 0B 07 07 E8 03 1A 09 1E 00 EF 55*/
|
||
{
|
||
LOG_D("kSetFactoryTime\r\n");
|
||
data_len = 7;
|
||
Flash_SetProductTimeLimit((rt_uint16_t)(pHostFrameData->data[0] << 8 | pHostFrameData->data[1]), pHostFrameData->data[2],
|
||
pHostFrameData->data[3], pHostFrameData->data[4], pHostFrameData->data[5], kFactoryTimeId);
|
||
// Flash_GetProductTimeLimit(&ReadLimitTime, kFactoryTimeId);
|
||
|
||
data_field[0] = (uint8_t)(ReadLimitTime.time.year >> 8);
|
||
data_field[1] = (uint8_t)(ReadLimitTime.Struct.year);
|
||
data_field[2] = ReadLimitTime.Struct.month;
|
||
data_field[3] = ReadLimitTime.Struct.day;
|
||
data_field[4] = ReadLimitTime.Struct.hour;
|
||
data_field[5] = ReadLimitTime.Struct.minute;
|
||
data_field[6] = ReadLimitTime.Struct.second;
|
||
|
||
goto send;
|
||
|
||
break;
|
||
}
|
||
case kSetExpirationTime: /*2028-3-26 9:30:00 AA 00 0C 07 07 EC 03 1A 09 1E 00 F4 55*/
|
||
{
|
||
LOG_D("kSetExpirationTime");
|
||
|
||
data_len = 7;
|
||
|
||
// Flash_SetProductTimeLimit((uint16_t)(pHostFrameData->data[0] << 8 | pHostFrameData->data[1]), pHostFrameData->data[2], pHostFrameData->data[3], pHostFrameData->data[4], pHostFrameData->data[5], pHostFrameData->data[6], kExpirationTimeId);
|
||
// Flash_GetProductTimeLimit(&ReadLimitTime, kExpirationTimeId);
|
||
|
||
// data_field[0] = (uint8_t)(ReadLimitTime.Struct.year >> 8);
|
||
// data_field[1] = (uint8_t)(ReadLimitTime.Struct.year);
|
||
// data_field[2] = ReadLimitTime.Struct.month;
|
||
// data_field[3] = ReadLimitTime.Struct.day;
|
||
// data_field[4] = ReadLimitTime.Struct.hour;
|
||
// data_field[5] = ReadLimitTime.Struct.minute;
|
||
// data_field[6] = ReadLimitTime.Struct.second;
|
||
|
||
goto send;
|
||
|
||
break;
|
||
}
|
||
case kSetAlarmValue: /* 3000 AA 00 0D 02 0B B8 7C 55 */
|
||
{
|
||
// logDebug("设置传感器标定的报警阈值");
|
||
data_len = 2;
|
||
value = (uint16_t)(pHostFrameData->data[0] << 8) | pHostFrameData->data[1];
|
||
// Flash_Set_AlarmLel(value);
|
||
// LOG_D("kSetAlarmLelValue: %d\r\n", Flash_Get_AlarmLel());
|
||
data_field[0] = (uint8_t)(value >> 8);
|
||
data_field[1] = (uint8_t)(value);
|
||
|
||
goto send;
|
||
|
||
break;
|
||
}
|
||
case kGetAlarmValue: //*AA 00 0F 00 B9 55*/
|
||
{
|
||
data_len = 2;
|
||
// value = Flash_Get_AlarmLel();
|
||
LOG_D("kGetAlarmValue: %d\r\n", value);
|
||
data_field[0] = (uint8_t)(value >> 8);
|
||
data_field[1] = (uint8_t)(value);
|
||
|
||
goto send;
|
||
break;
|
||
}
|
||
#endif
|
||
default:
|
||
break;
|
||
}
|
||
|
||
send:
|
||
{
|
||
if ((c1 == 0) && ((0 < c2) & (c2 < kSensorFailureRecord)))
|
||
{
|
||
rt_memset(data_field, 0, data_len);
|
||
}
|
||
HR_GenerateRawFrame(&RawData, c1, (TeFrameC2)c2, data_field, data_len);
|
||
LPUART1_Write(&RawData.buf[0], RawData.len);
|
||
}
|
||
return SUCCESS;
|
||
}
|
||
#endif
|
||
|
||
#if 0
|
||
//用于处理主动发送数据
|
||
static void hr_send_thread_entry(void *param)
|
||
{
|
||
rt_uint8_t info[3] = {0};
|
||
TsRawFrameData RawData = {0};
|
||
|
||
while (1)
|
||
{
|
||
// LOG_D("Get_VIN_VoltageInt1000x() = %d\r\n", Get_VIN_VoltageInt1000x());
|
||
info[0] = ((Get_VIN_VoltageInt1000x() >> 8) & 0xFF);
|
||
info[1] = (Get_VIN_VoltageInt1000x() & 0xFF);
|
||
info[2] = event_index.current_event;
|
||
// LOG_D("info[0] = %#X,info[1] = %#X,info[2]= %#X\n", info[0],info[1],info[2]);
|
||
HR_GenerateRawFrame(&RawData, 0x00, 0x0E, info, 3);
|
||
|
||
rt_device_write(rt_hr_device, 0, &RawData.buf[0], RawData.len);
|
||
rt_thread_mdelay(10000);
|
||
}
|
||
}
|
||
#endif
|
||
|
||
// 用于处理上位机下发的指令
|
||
static void Hr_Thread_Entry(void *param)
|
||
{
|
||
rt_uint8_t buf[32] = {0};
|
||
while (1)
|
||
{
|
||
rt_sem_take(hr_rx_sem, RT_WAITING_FOREVER); // 等待信号量
|
||
LOG_D("hr_rx_sem");
|
||
|
||
rt_uint8_t buf_len = lwrb_get_full(&lpuart1_rx_rb);
|
||
LOG_D("buf_len = %d\n", buf_len);
|
||
lwrb_read(&lpuart1_rx_rb, buf, buf_len);
|
||
LOG_HEX("lpuart1_rx_rb", 16, &buf[0], buf_len);
|
||
|
||
if (buf_len >= HOST_FRAME_MIN_LEN)
|
||
{
|
||
TsFrameData *HostFrameData = HR_GetFrameData(buf, buf_len);
|
||
if (HostFrameData != RT_NULL)
|
||
{
|
||
LOG_HEX("HostFrameData", 16, &HostFrameData->data[0], HostFrameData->len); // 数据段
|
||
HR_ProcessData(HostFrameData);
|
||
}
|
||
rt_free(HostFrameData);
|
||
HostFrameData = RT_NULL;
|
||
}
|
||
}
|
||
}
|
||
|
||
int BSP_HR_Init(void)
|
||
{
|
||
hr_rx_sem = rt_sem_create("hr_rx_sem", 0, RT_IPC_FLAG_FIFO);
|
||
if (hr_rx_sem == RT_NULL)
|
||
{
|
||
LOG_E("hr_rx_sem create failed");
|
||
}
|
||
|
||
rt_thread_init(&hr_thread,
|
||
"hr_thread",
|
||
Hr_Thread_Entry,
|
||
RT_NULL,
|
||
&hr_thread_stack[0],
|
||
sizeof(hr_thread_stack),
|
||
HR_THREAD_PRIORITY, HR_THREAD_TIMESLICE);
|
||
rt_thread_startup(&hr_thread);
|
||
|
||
LOG_I("BSP_HR_Init");
|
||
|
||
return RT_EOK;
|
||
}
|
||
#ifdef RT_USING_COMPONENTS_INIT
|
||
INIT_APP_EXPORT(BSP_HR_Init);
|
||
#endif
|