add parse threads
This commit is contained in:
@@ -38,6 +38,12 @@ struct vc_pd_t {
|
||||
struct vc_mm_t mm[2]; // 电压电流极值
|
||||
};
|
||||
|
||||
/* 邮件内容 */
|
||||
struct mb_msg_t {
|
||||
rt_uint16_t length; // 数据长度
|
||||
rt_uint8_t *payload; // 数据区
|
||||
};
|
||||
|
||||
#endif
|
||||
|
||||
|
||||
|
||||
@@ -10,7 +10,11 @@
|
||||
int chrg_pkg_encode (eIDX_ID id, rt_uint8_t cmd, rt_uint8_t *data_in,
|
||||
rt_uint8_t len_in, rt_uint8_t *data_out, rt_uint16_t *len_out)
|
||||
{
|
||||
if ((RT_NULL == data_in)||(RT_NULL == data_out)||(0 == len_in)) {
|
||||
if (RT_NULL == data_out) {
|
||||
return -1;
|
||||
}
|
||||
|
||||
if ((len_in > 0) && (RT_NULL == data_in)) {
|
||||
return -1;
|
||||
}
|
||||
|
||||
@@ -18,7 +22,11 @@ int chrg_pkg_encode (eIDX_ID id, rt_uint8_t cmd, rt_uint8_t *data_in,
|
||||
data_out[1] = 0x00;
|
||||
data_out[2] = id;
|
||||
data_out[3] = cmd;
|
||||
memcpy(&data_out[4], data_in, len_in);
|
||||
|
||||
if (len_in > 0) {
|
||||
memcpy(&data_out[4], data_in, len_in);
|
||||
}
|
||||
|
||||
data_out[len_in+4] = calc_crc8(data_out, len_in+4);
|
||||
|
||||
*len_out = 5+len_in;
|
||||
@@ -27,8 +35,87 @@ int chrg_pkg_encode (eIDX_ID id, rt_uint8_t cmd, rt_uint8_t *data_in,
|
||||
}
|
||||
|
||||
|
||||
int chrg_pkg_decode (eIDX_ID id, rt_uint8_t *data)
|
||||
int chrg_pkg_decode (rt_uint8_t *data, rt_uint16_t length, struct chrg_switch_t *pSW)
|
||||
{
|
||||
if ((RT_NULL == data)||(RT_NULL == pSW)||(length < 5)) {
|
||||
return -1;
|
||||
}
|
||||
|
||||
rt_uint8_t crc = calc_crc8(data, length - 1);
|
||||
if (crc != data[length - 1]) {
|
||||
return -2;
|
||||
}
|
||||
|
||||
struct pkg_head_t *pH = (struct pkg_head_t *)data;
|
||||
|
||||
if (ID_SOURCE == pSW->id) {
|
||||
struct chrg_src_t *pS = &pSW->source;
|
||||
|
||||
switch (pH->cmd) {
|
||||
case SRC_CMD_GET_VOLTAGE: {
|
||||
struct get_vol_ack_t *pAck = (struct get_vol_ack_t *)data;
|
||||
pS->vc.voltage = pAck->voltage;
|
||||
pS->vc.version = pAck->version;
|
||||
// ?
|
||||
}
|
||||
break;
|
||||
|
||||
case SRC_CMD_GET_PROTOCOL: {
|
||||
struct get_pd_pro_ack_t *pAck = (struct get_pd_pro_ack_t *)data;
|
||||
pS->pd_get[0].src_type = pAck->type;
|
||||
pS->pd_get[0].pps_type = pAck->pps;
|
||||
pS->pd_get[0].mm[0].max_vol = pAck->vmax;
|
||||
pS->pd_get[0].mm[0].min_vol = pAck->vmin;
|
||||
pS->pd_get[0].mm[0].max_cur = pAck->curpwr;
|
||||
}
|
||||
break;
|
||||
|
||||
case SRC_CMD_SET_CC_LEVEL: {
|
||||
|
||||
}
|
||||
break;
|
||||
|
||||
case SRC_CMD_SET_PROTOCOL: {
|
||||
|
||||
}
|
||||
break;
|
||||
|
||||
default:
|
||||
break;
|
||||
}
|
||||
} else if (ID_SINK == pSW->id) {
|
||||
struct chrg_sink_t *pS = &pSW->sink;
|
||||
|
||||
switch (pH->cmd) {
|
||||
case SINK_CMD_GET_VOLTAGE: {
|
||||
|
||||
}
|
||||
break;
|
||||
|
||||
case SINK_CMD_GET_PD: {
|
||||
|
||||
}
|
||||
break;
|
||||
|
||||
case SINK_CMD_SET_CC: {
|
||||
|
||||
}
|
||||
break;
|
||||
|
||||
case SINK_CMD_SET_LEVEL: {
|
||||
|
||||
}
|
||||
break;
|
||||
|
||||
case SINK_CMD_SET_QC20: {
|
||||
|
||||
}
|
||||
break;
|
||||
|
||||
|
||||
|
||||
}
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
@@ -5,11 +5,12 @@
|
||||
|
||||
#include "chrg_tty.h"
|
||||
#include "chrg_def.h"
|
||||
#include "chrg_switch.h"
|
||||
|
||||
extern int chrg_pkg_encode (eIDX_ID id, rt_uint8_t cmd, rt_uint8_t *data_in,
|
||||
rt_uint8_t len_in, rt_uint8_t *data_out, rt_uint16_t *len_out);
|
||||
|
||||
extern int chrg_pkg_decode (eIDX_ID id, rt_uint8_t *data);
|
||||
extern int chrg_pkg_decode (rt_uint8_t *data, rt_uint16_t length, struct chrg_switch_t *pSW);
|
||||
|
||||
extern int chrg_pkg_send (eIDX_TTY idx, rt_uint8_t *data, rt_uint16_t len);
|
||||
|
||||
|
||||
@@ -6,6 +6,8 @@
|
||||
#include "chrg_pkg.h"
|
||||
#include "chrg_utils.h"
|
||||
|
||||
|
||||
|
||||
int source_get_vc (rt_uint16_t vol, rt_uint16_t cur)
|
||||
{
|
||||
rt_uint16_t len = 0;
|
||||
@@ -19,65 +21,50 @@ int source_get_vc (rt_uint16_t vol, rt_uint16_t cur)
|
||||
|
||||
chrg_pkg_encode(ID_SOURCE, SRC_CMD_GET_VOLTAGE, data, 6, frame, &len);
|
||||
|
||||
return chrg_pkg_send(IDX_TTY_SOUTH, frame, len);
|
||||
return chrg_north_send(frame, len);
|
||||
}
|
||||
|
||||
void source_get_pd (void)
|
||||
int source_get_pd (void)
|
||||
{
|
||||
rt_size_t len = 0;
|
||||
rt_uint8_t data[8] = {0};
|
||||
rt_uint16_t len = 0;
|
||||
rt_uint8_t frame[16] = {0};
|
||||
|
||||
data[0] = 0x05;
|
||||
data[1] = 0x00;
|
||||
data[2] = ID_SOURCE;
|
||||
data[3] = SRC_CMD_GET_PROTOCOL;
|
||||
data[4] = calc_crc8(data, 4);
|
||||
chrg_pkg_encode(ID_SOURCE, SRC_CMD_GET_PROTOCOL, RT_NULL, 0, frame, &len);
|
||||
|
||||
len = 0x05;
|
||||
|
||||
chrg_north_send(data, len);
|
||||
return chrg_north_send(frame, len);
|
||||
}
|
||||
|
||||
void source_set_cc_lvl (rt_uint8_t lvl)
|
||||
int source_set_cc_lvl (rt_uint8_t lvl)
|
||||
{
|
||||
rt_size_t len = 0;
|
||||
rt_uint16_t len = 0;
|
||||
rt_uint8_t data[8] = {0};
|
||||
rt_uint8_t frame[16] = {0};
|
||||
|
||||
data[0] = 0x06;
|
||||
data[1] = 0x00;
|
||||
data[2] = ID_SOURCE;
|
||||
data[3] = SRC_CMD_SET_CC_LEVEL;
|
||||
data[4] = lvl;
|
||||
data[5] = calc_crc8(data, 5);
|
||||
data[0] = lvl;
|
||||
|
||||
len = 0x06;
|
||||
chrg_pkg_encode(ID_SOURCE, SRC_CMD_SET_CC_LEVEL, data, 1, frame, &len);
|
||||
|
||||
chrg_north_send(data, len);
|
||||
return chrg_north_send(frame, len);
|
||||
}
|
||||
|
||||
void source_set_pd (rt_uint8_t pro, rt_uint8_t src, rt_uint8_t pps,
|
||||
int source_set_pd (rt_uint8_t pro, rt_uint8_t src, rt_uint8_t pps,
|
||||
rt_uint16_t vmax, rt_uint16_t vmin, rt_int16_t max_cur)
|
||||
{
|
||||
rt_size_t len = 0;
|
||||
rt_uint8_t data[16] = {0};
|
||||
rt_uint16_t len = 0;
|
||||
rt_uint8_t data[8] = {0};
|
||||
rt_uint8_t frame[16] = {0};
|
||||
|
||||
data[0] = 0x0B;
|
||||
data[1] = 0x00;
|
||||
data[2] = ID_SOURCE;
|
||||
data[3] = SRC_CMD_SET_PROTOCOL;
|
||||
data[4] = pro;
|
||||
data[5] = src;
|
||||
data[6] = pps;
|
||||
data[0] = pro;
|
||||
data[1] = src;
|
||||
data[2] = pps;
|
||||
|
||||
u16_to_u8v(vmax, &data[7]);
|
||||
u16_to_u8v(vmin, &data[9]);
|
||||
u16_to_u8v(max_cur, &data[11]);
|
||||
u16_to_u8v(vmax, &data[3]);
|
||||
u16_to_u8v(vmin, &data[5]);
|
||||
u16_to_u8v(max_cur, &data[7]);
|
||||
|
||||
data[13] = calc_crc8(data, 13);
|
||||
chrg_pkg_encode(ID_SOURCE, SRC_CMD_SET_CC_LEVEL, data, 9, frame, &len);
|
||||
|
||||
len = 0x0E;
|
||||
|
||||
chrg_north_send(data, len);
|
||||
return chrg_north_send(frame, len);
|
||||
}
|
||||
|
||||
|
||||
|
||||
@@ -62,6 +62,49 @@ typedef enum {
|
||||
TOTAL_PROS
|
||||
} eSRC_PRO;
|
||||
|
||||
// 应答帧头
|
||||
struct pkg_head_t {
|
||||
rt_uint8_t length; // 帧长度
|
||||
rt_uint8_t blank; // 固定 0x00
|
||||
rt_uint8_t id; // ID 号
|
||||
rt_uint8_t cmd; // 指令
|
||||
};
|
||||
|
||||
// 读取变电压板电压 应答
|
||||
struct get_vol_ack_t {
|
||||
struct pkg_head_t head;
|
||||
rt_uint16_t voltage; // 0.01V
|
||||
rt_uint8_t qc_data[6]; // 快充指令
|
||||
rt_uint16_t version; // 版本
|
||||
rt_uint8_t reserve[6]; // 保留
|
||||
rt_uint8_t crc8;
|
||||
};
|
||||
|
||||
// 读取源端的PD协议数据 应答
|
||||
struct get_pd_pro_ack_t {
|
||||
struct pkg_head_t head;
|
||||
rt_uint8_t type; // 源类型 0:PD0 3:APD0
|
||||
rt_uint8_t pps; // PPS类型 0:SPR PPS 1:EPR AVS 2:SPR AVS
|
||||
rt_uint16_t vmin; // 最小电压 mV
|
||||
rt_uint16_t vmax; // 最大电压 mV
|
||||
rt_uint16_t curpwr; // 最大电流/功率 mA/W
|
||||
rt_uint8_t reserve[6]; // 保留 当pps=2时,vmin,vmax,curpwr
|
||||
rt_uint8_t crc8;
|
||||
};
|
||||
|
||||
// 设置CC线 应答
|
||||
struct set_cc_ack_t {
|
||||
struct pkg_head_t head;
|
||||
rt_uint8_t crc8;
|
||||
};
|
||||
|
||||
// 设置快充协议 应答
|
||||
struct set_qc_ack_t {
|
||||
struct pkg_head_t head;
|
||||
rt_uint8_t crc8;
|
||||
};
|
||||
|
||||
|
||||
struct src_vc_t {
|
||||
rt_uint16_t voltage; // 读取 0.01V
|
||||
rt_uint16_t set_voltage; // 设置电压 mV
|
||||
@@ -87,6 +130,13 @@ struct chrg_src_t {
|
||||
|
||||
extern int source_get_vc (rt_uint16_t vol, rt_uint16_t cur);
|
||||
|
||||
extern int source_get_pd (void);
|
||||
|
||||
extern int source_set_cc_lvl (rt_uint8_t lvl);
|
||||
|
||||
extern int source_set_pd (rt_uint8_t pro, rt_uint8_t src, rt_uint8_t pps,
|
||||
rt_uint16_t vmax, rt_uint16_t vmin, rt_int16_t max_cur);
|
||||
|
||||
|
||||
#endif
|
||||
|
||||
|
||||
Reference in New Issue
Block a user