2024-12-15 17:22:09 +08:00
|
|
|
|
/*
|
|
|
|
|
* @Author : stark1898y 1658608470@qq.com
|
|
|
|
|
* @Date : 2024-12-15 15:01:15
|
|
|
|
|
* @LastEditors : stark1898y 1658608470@qq.com
|
|
|
|
|
* @LastEditTime : 2024-12-15 16:31:46
|
|
|
|
|
* @FilePath : \BLE_TYQ_CH592F - 副本\BSP\src\bsp_valve.c
|
|
|
|
|
* @Description :
|
|
|
|
|
*
|
|
|
|
|
* Copyright (c) 2024 by yzy, All Rights Reserved.
|
|
|
|
|
*/
|
2024-12-12 19:38:57 +08:00
|
|
|
|
/*
|
|
|
|
|
* @Author: mbw
|
|
|
|
|
* @Date: 2024-12-09 11:40:10
|
|
|
|
|
* @LastEditors: mbw && 1600520629@qq.com
|
|
|
|
|
* @LastEditTime: 2024-12-11 15:43:47
|
|
|
|
|
* @FilePath: \ble_-tyq_-bjq_-ch584-m\bsp\src\bsp_valve.c
|
|
|
|
|
* @Description:
|
|
|
|
|
*
|
|
|
|
|
* Copyright (c) 2024 by ${git_name_email}, All Rights Reserved.
|
|
|
|
|
*/
|
|
|
|
|
#include "bsp_valve.h"
|
|
|
|
|
#include "bsp_flash.h"
|
|
|
|
|
|
|
|
|
|
#include "bsp_beep_led_emv.h"
|
|
|
|
|
// 0xAA CMD/DATA/ DATA_LEN (DATA) checksum 0x55
|
|
|
|
|
|
2024-12-13 18:14:02 +08:00
|
|
|
|
#include "bsp_uart.h"
|
2024-12-12 19:38:57 +08:00
|
|
|
|
#include "log.h"
|
|
|
|
|
|
2024-12-13 13:22:31 +08:00
|
|
|
|
#undef LOG_ENABLE
|
|
|
|
|
#define LOG_ENABLE 0
|
2024-12-12 19:38:57 +08:00
|
|
|
|
|
|
|
|
|
#undef LOG_TAG
|
|
|
|
|
#define LOG_TAG "BSP_VALVE"
|
|
|
|
|
|
2024-12-15 14:30:06 +08:00
|
|
|
|
//存储 当前task id 的全局变量
|
|
|
|
|
tmosTaskID vavle_task_id = INVALID_TASK_ID;
|
2024-12-12 19:38:57 +08:00
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* @description: 从帧起始符开始到校验码之前所有字节的和的模256,即各字节不计超过255的溢出值的二进制算术和。
|
|
|
|
|
* @param {uint8_t} *data
|
|
|
|
|
* @param {uint16_t} len
|
|
|
|
|
* @return {*}
|
|
|
|
|
*/
|
|
|
|
|
uint8_t CheckSum(const uint8_t *data, size_t len)
|
|
|
|
|
{
|
|
|
|
|
uint8_t sum = 0;
|
|
|
|
|
|
|
|
|
|
for (size_t i = 0; i < len; i++)
|
|
|
|
|
{
|
|
|
|
|
sum += data[i];
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return sum;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
#if 0
|
|
|
|
|
/**
|
|
|
|
|
* @description: 从接收缓冲区中获取一帧有效数据
|
|
|
|
|
* @param {TsFrameData} *pFrameData 主机帧
|
|
|
|
|
* @param {uint8_t} *p_src 接收缓冲区
|
|
|
|
|
* @param {uint16_t} src_len 接收缓冲区长度
|
|
|
|
|
* @return {*}
|
|
|
|
|
*/
|
|
|
|
|
TsFrameData *HR_GetFrameData(const uint8_t *p_src, const uint8_t src_len)
|
|
|
|
|
{
|
|
|
|
|
uint8_t data_field_len = 0;
|
|
|
|
|
uint8_t check_sum = 0;
|
|
|
|
|
|
|
|
|
|
TsFrameData *get_buffer = NULL;
|
|
|
|
|
|
|
|
|
|
for (uint8_t i = 0; i < src_len; i++)
|
|
|
|
|
{
|
|
|
|
|
// 找帧头
|
|
|
|
|
if (p_src[i] == FRAME_HEADER)
|
|
|
|
|
{
|
|
|
|
|
// 找数据长度
|
|
|
|
|
data_field_len = p_src[i + 2];
|
|
|
|
|
// 找帧尾
|
|
|
|
|
if (p_src[i + 2 + data_field_len + 2] == FRAME_TAIL)
|
|
|
|
|
{
|
|
|
|
|
check_sum = CheckSum(&p_src[i], (3 + data_field_len));
|
|
|
|
|
|
|
|
|
|
if (p_src[i + 2 + data_field_len + 1] == check_sum)
|
|
|
|
|
{
|
|
|
|
|
get_buffer = (TsFrameData *)tmos_msg_allocate(sizeof(TsFrameData) + sizeof(uint8_t) * data_field_len);
|
|
|
|
|
if (get_buffer == NULL)
|
|
|
|
|
{
|
|
|
|
|
logError("tmos_msg_allocate fail");
|
|
|
|
|
return NULL;
|
|
|
|
|
}
|
|
|
|
|
get_buffer->cmd = p_src[i + 1];
|
|
|
|
|
get_buffer->len = data_field_len;
|
|
|
|
|
|
|
|
|
|
if (data_field_len > 0)
|
|
|
|
|
{
|
|
|
|
|
tmos_memcmp(get_buffer->data, &p_src[i + 4], data_field_len);
|
|
|
|
|
}
|
|
|
|
|
logDebug("HR_GetDataFrame Success!");
|
|
|
|
|
|
|
|
|
|
return get_buffer;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
logError("HR_GetDataFrame Fail!");
|
|
|
|
|
|
|
|
|
|
return get_buffer;
|
|
|
|
|
}
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
TsFrameData* BSP_VAVLE_GetFrameData(uint8_t *data, uint16_t len)
|
|
|
|
|
{
|
|
|
|
|
int ret = 0;
|
|
|
|
|
uint16_t index = 0;
|
|
|
|
|
|
|
|
|
|
TsFrameData *get_buffer = NULL;
|
|
|
|
|
// 解析接收到的数据帧,先寻找AA开头,然后再找AA下一个字节,其代表了数据长度,然后找到代表长度的值的长度的下一位,其为校验码,校验码后为结束码0x55,
|
|
|
|
|
// 如果数据正确,则提取数据,不正确,则不处理
|
|
|
|
|
if (len < 4)
|
|
|
|
|
{ // 至少需要 4 个字节:起始码、长度、校验码、结束码
|
|
|
|
|
logError("数据帧长度不足");
|
2024-12-13 13:22:31 +08:00
|
|
|
|
// logHexDumpAll(data, len);
|
2024-12-12 19:38:57 +08:00
|
|
|
|
// return 1;
|
2024-12-13 13:22:31 +08:00
|
|
|
|
return NULL;
|
2024-12-12 19:38:57 +08:00
|
|
|
|
}
|
|
|
|
|
while (index < len && data[index] != FRAME_HEADER) // 寻找起始码 0xAA
|
|
|
|
|
{
|
|
|
|
|
index++;
|
|
|
|
|
}
|
|
|
|
|
if (index >= len - 3) // 不够空间容纳长度、校验码和结束码
|
|
|
|
|
{
|
|
|
|
|
logError("数据帧起始码错误");
|
2024-12-13 13:22:31 +08:00
|
|
|
|
// logHexDumpAll(data, len);
|
|
|
|
|
return NULL;
|
2024-12-12 19:38:57 +08:00
|
|
|
|
// return 2;
|
|
|
|
|
}
|
|
|
|
|
uint16_t data_len = data[index + 2]; // 读取数据长度
|
|
|
|
|
if (index + 3 + data_len + 1 >= len) // 检查数据长度是否合理 数据长度 + 校验码 + 结束码
|
|
|
|
|
{
|
|
|
|
|
logError("数据帧长度错误");
|
2024-12-13 13:22:31 +08:00
|
|
|
|
// logHexDumpAll(data, len);
|
|
|
|
|
return NULL;
|
2024-12-12 19:38:57 +08:00
|
|
|
|
// return 3;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
uint8_t check_sum = data[index + 3 + data_len]; // 读取校验码
|
|
|
|
|
uint8_t calculated_sum = CheckSum(&data[index], data_len + 3); // 计算校验码
|
|
|
|
|
if (check_sum != calculated_sum)
|
|
|
|
|
{
|
|
|
|
|
logError("数据帧校验码错误 check_sum = %02X, calculated_sum = %02X", check_sum, calculated_sum);
|
2024-12-13 13:22:31 +08:00
|
|
|
|
// logHexDumpAll(data, len);
|
|
|
|
|
return NULL;
|
2024-12-12 19:38:57 +08:00
|
|
|
|
// return 4;
|
|
|
|
|
}
|
|
|
|
|
if (data[index + 3 + data_len + 1] != FRAME_TAIL) // 检查结束码
|
|
|
|
|
{
|
|
|
|
|
logError("数据帧结束码错误");
|
2024-12-13 13:22:31 +08:00
|
|
|
|
// logHexDumpAll(data, len);
|
|
|
|
|
return NULL;
|
2024-12-12 19:38:57 +08:00
|
|
|
|
// return 5;
|
|
|
|
|
}
|
|
|
|
|
logDebug("数据帧校验通过");
|
|
|
|
|
|
|
|
|
|
get_buffer = (TsFrameData *)tmos_msg_allocate(sizeof(TsFrameData) + sizeof(uint8_t) * data_len);
|
|
|
|
|
if (get_buffer == NULL)
|
|
|
|
|
{
|
|
|
|
|
logError("tmos_msg_allocate fail");
|
|
|
|
|
return NULL;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
get_buffer->cmd = data[index + 1];
|
|
|
|
|
get_buffer->len = data_len;
|
|
|
|
|
// get_buffer->data = data;
|
|
|
|
|
|
|
|
|
|
if (data_len > 0)
|
|
|
|
|
{
|
|
|
|
|
tmos_memcpy(get_buffer->data, &data[index + 3], data_len);
|
|
|
|
|
return get_buffer;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
// //有效数据长度
|
|
|
|
|
// size_t data_len = (data_len + 5);
|
|
|
|
|
// //到这一步说明数据没问题,将接收到的数据通过中心任务发送出去
|
|
|
|
|
// uint8_t *p_data;
|
|
|
|
|
// p_data = tmos_msg_allocate(data_len);
|
|
|
|
|
// if (p_data)
|
|
|
|
|
// {
|
|
|
|
|
// tmos_memcpy(p_data, data, data_len);
|
|
|
|
|
// tmos_msg_send(BtRxTaskId, p_data);
|
|
|
|
|
// tmos_start_task(BtRxTaskId, SYS_EVENT_MSG, 0);
|
|
|
|
|
// }
|
|
|
|
|
}
|
|
|
|
|
|
2024-12-14 18:40:24 +08:00
|
|
|
|
uint8_t GenerateRawFrame(TsRawFrameData *pRawData, uint8_t cmd, const uint8_t *p_src, uint8_t src_len)
|
2024-12-12 19:38:57 +08:00
|
|
|
|
{
|
|
|
|
|
// 0xAA CMD/DATA/ DATA_LEN (DATA) checksum 0x55
|
|
|
|
|
pRawData->len = src_len + 5;
|
|
|
|
|
|
|
|
|
|
tmos_memset(pRawData->buf, 0, sizeof(pRawData->buf));
|
|
|
|
|
|
|
|
|
|
pRawData->buf[0] = FRAME_HEADER;
|
|
|
|
|
pRawData->buf[1] = cmd;
|
|
|
|
|
pRawData->buf[2] = src_len;
|
|
|
|
|
|
|
|
|
|
tmos_memcpy(&pRawData->buf[3], p_src, src_len);
|
|
|
|
|
|
|
|
|
|
// 从帧起始符开始到校验码之前所有字节的和的模256
|
|
|
|
|
// ,即各字节不计超过255的溢出值的二进制算术和。
|
|
|
|
|
pRawData->buf[pRawData->len - 2] = CheckSum(&pRawData->buf[0], pRawData->len - 2);
|
|
|
|
|
pRawData->buf[pRawData->len - 1] = FRAME_TAIL;
|
|
|
|
|
|
2024-12-13 13:22:31 +08:00
|
|
|
|
// logHexDumpAll(&pRawData->buf[0], pRawData->len);
|
2024-12-12 19:38:57 +08:00
|
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
|
2024-12-14 18:40:24 +08:00
|
|
|
|
void BSP_VALVE_Generate_Data(TsRawFrameData *pRawData, uint8_t switch_status, uint8_t bat, int8_t temp, uint8_t hum)
|
2024-12-12 19:38:57 +08:00
|
|
|
|
{
|
|
|
|
|
TsValveData ValveData;
|
|
|
|
|
|
2024-12-14 18:40:24 +08:00
|
|
|
|
ValveData.switch_status = 0;
|
|
|
|
|
ValveData.temp = temp; // 阀门温度 有符号整数 25 ℃
|
|
|
|
|
|
|
|
|
|
ValveData.in_pressure = 1.6 * 1000000;
|
|
|
|
|
ValveData.out_pressure = 3000;
|
|
|
|
|
ValveData.atm_pressure = 96000;
|
|
|
|
|
|
2024-12-12 19:38:57 +08:00
|
|
|
|
ValveData.type = kTyq; // 阀门类型
|
|
|
|
|
ValveData.bat = bat; // 电池电压 30=3V,18=1.8V
|
|
|
|
|
ValveData.hum = hum; // 阀门湿度 %RH
|
|
|
|
|
|
2024-12-14 18:40:24 +08:00
|
|
|
|
ValveData.rssi = 0;
|
|
|
|
|
|
|
|
|
|
GenerateRawFrame(pRawData, kCmdData, (uint8_t*)&ValveData, sizeof(ValveData));
|
2024-12-13 13:22:31 +08:00
|
|
|
|
// logHexDumpAll(&pRawData->buf[0], pRawData->len);
|
2024-12-12 19:38:57 +08:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void BSP_VALVE_Generate_ValveResponse(TsRawFrameData *pRawData, TeFrameCmd cmd, uint8_t status)
|
|
|
|
|
{
|
|
|
|
|
uint8_t data = 0;
|
|
|
|
|
data = status;
|
2024-12-14 18:40:24 +08:00
|
|
|
|
GenerateRawFrame(pRawData, cmd, &data, 1);
|
2024-12-13 13:22:31 +08:00
|
|
|
|
// logHexDumpAll(&pRawData->buf[0], pRawData->len);
|
2024-12-12 19:38:57 +08:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void BSP_CloseValve(void)
|
|
|
|
|
{
|
|
|
|
|
// EMV_CHARGE
|
|
|
|
|
EMV_CHARGE_EN;
|
|
|
|
|
logDebug("EMV_CHARGE_EN");
|
|
|
|
|
|
|
|
|
|
DelayMs(1000);
|
|
|
|
|
|
|
|
|
|
EMV_CHARGE_OFF_DEINIT;
|
|
|
|
|
logDebug("EMV_CHARGE_OFF_DEINIT 500 ms");
|
|
|
|
|
|
|
|
|
|
// EMV_CTRL
|
|
|
|
|
EMV_ON;
|
|
|
|
|
logDebug("EMV_ON\n");
|
|
|
|
|
DelayMs(100);
|
|
|
|
|
}
|
|
|
|
|
|
2024-12-15 14:30:06 +08:00
|
|
|
|
static void VAVLE_Task_ProcessTmosMsg(tmos_event_hdr_t *pMsg)
|
|
|
|
|
{
|
|
|
|
|
switch (pMsg->event)
|
|
|
|
|
{
|
|
|
|
|
default:
|
|
|
|
|
logDebug("pMsg->event %04x", pMsg->event);
|
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
//task的event处理回调函数,需要在注册task时候,传进去
|
|
|
|
|
static uint16_t VAVLE_Task_ProcessEvent( uint8_t task_id, uint16_t events )
|
|
|
|
|
{
|
|
|
|
|
if (events & SYS_EVENT_MSG)
|
|
|
|
|
{
|
|
|
|
|
uint8_t *pMsg;
|
|
|
|
|
if ((pMsg = tmos_msg_receive(vavle_task_id)) != NULL)
|
|
|
|
|
{
|
|
|
|
|
VAVLE_Task_ProcessTmosMsg((tmos_event_hdr_t *)pMsg);
|
|
|
|
|
// Release the TMOS message
|
|
|
|
|
tmos_msg_deallocate(pMsg);
|
|
|
|
|
}
|
|
|
|
|
// return unprocessed events
|
|
|
|
|
return (events ^ SYS_EVENT_MSG);
|
|
|
|
|
}
|
|
|
|
|
if (events & VAVLE_RX_DATA_EVT)
|
|
|
|
|
{
|
|
|
|
|
logDebug("VAVLE_RX_DATA_EVT");
|
|
|
|
|
|
|
|
|
|
return (events ^ VAVLE_RX_DATA_EVT);
|
|
|
|
|
}
|
|
|
|
|
if (events & VAVLE_TX_DATA_EVT)
|
|
|
|
|
{
|
|
|
|
|
logDebug("VAVLE_TX_DATA_EVT");
|
|
|
|
|
|
|
|
|
|
return (events ^ VAVLE_TX_DATA_EVT);
|
|
|
|
|
}
|
|
|
|
|
if (events & VAVLE_CLOSE_START_EVT)
|
|
|
|
|
{
|
|
|
|
|
logDebug("VAVLE_CLOSE_START_EVT");
|
|
|
|
|
|
|
|
|
|
//开始一个定时event,1s后产生,当前语句只会产生一次event
|
|
|
|
|
//可以在event产生后去开启event,可以是别的task的,也可以是当前task的event
|
|
|
|
|
tmos_start_task(vavle_task_id, VAVLE_CLOSE_END_EVT, MS1_TO_SYSTEM_TIME(CHARGE_TIME_MS));
|
|
|
|
|
|
|
|
|
|
return (events ^ VAVLE_CLOSE_START_EVT);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// Discard unknown events
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
|
2024-12-12 19:38:57 +08:00
|
|
|
|
void BSP_VAVLE_Init(void)
|
|
|
|
|
{
|
2024-12-15 14:30:06 +08:00
|
|
|
|
vavle_task_id = TMOS_ProcessEventRegister(VAVLE_Task_ProcessEvent);
|
|
|
|
|
|
|
|
|
|
// //立即开始一个event
|
|
|
|
|
// tmos_set_event(vavle_task_id, VAVLE_RX_DATA_EVT);
|
2024-12-12 19:38:57 +08:00
|
|
|
|
|
|
|
|
|
logInfo("BSP_Valve_Init");
|
|
|
|
|
}
|