roll south mb
This commit is contained in:
@@ -3,6 +3,15 @@
|
||||
|
||||
#include <rtthread.h>
|
||||
|
||||
// 4路选通
|
||||
typedef enum {
|
||||
IDX_CH1 = 0, // 通路1
|
||||
IDX_CH2, // 通路2
|
||||
IDX_CH3, // 通路3
|
||||
IDX_CH4, // 通路4
|
||||
|
||||
TOTAL_CHS
|
||||
} eIDX_CH;
|
||||
|
||||
typedef enum {
|
||||
ID_SINK = 0x01, // SINK 的 ID 为 1, 波特率 200K
|
||||
@@ -44,6 +53,15 @@ struct mb_msg_t {
|
||||
rt_uint8_t *payload; // 数据区
|
||||
};
|
||||
|
||||
struct pickup_info_t {
|
||||
rt_tick_t last_tick; // 前次收数据时刻
|
||||
rt_uint16_t length; // 已提取数据字节数
|
||||
rt_uint8_t findhead; // 找到帧头
|
||||
rt_uint8_t head[8]; // 帧头填充区
|
||||
int len_msg; // 数据长度
|
||||
struct mb_msg_t *pMB; // 邮件
|
||||
};
|
||||
|
||||
#endif
|
||||
|
||||
|
||||
|
||||
@@ -0,0 +1,101 @@
|
||||
|
||||
#include <rtthread.h>
|
||||
|
||||
#include "chrg_south.h"
|
||||
#include "chrg_eload.h"
|
||||
#include "chrg_utils.h"
|
||||
|
||||
int chrg_eload_read_regs (rt_uint8_t addr, rt_uint16_t reg, rt_uint16_t len)
|
||||
{
|
||||
rt_uint8_t buf[8] = {0};
|
||||
rt_uint16_t crc = 0;
|
||||
|
||||
buf[0] = addr;
|
||||
buf[1] = MB_REGISTER_RD;
|
||||
u16_to_u8v(reg, &buf[2]);
|
||||
u16_to_u8v(len, &buf[4]);
|
||||
crc = mb_crc16(buf, 6);
|
||||
u16_to_u8v(crc, &buf[6]);
|
||||
|
||||
return chrg_south_send(buf, 8);
|
||||
}
|
||||
|
||||
int chrg_eload_write_reg (rt_uint8_t addr, rt_uint16_t reg, rt_uint16_t value)
|
||||
{
|
||||
rt_uint8_t buf[8] = {0};
|
||||
rt_uint16_t crc = 0;
|
||||
|
||||
buf[0] = addr;
|
||||
buf[1] = MB_REGISTER_WR;
|
||||
u16_to_u8v(reg, &buf[2]);
|
||||
u16_to_u8v(value, &buf[4]);
|
||||
crc = mb_crc16(buf, 6);
|
||||
u16_to_u8v(crc, &buf[6]);
|
||||
|
||||
return chrg_south_send(buf, 8);
|
||||
}
|
||||
|
||||
int chrg_eload_refresh (rt_uint8_t addr, rt_uint8_t part)
|
||||
{
|
||||
int ret = 0;
|
||||
|
||||
if (0 == part) {
|
||||
chrg_eload_read_regs(addr, REG_TEMPERATUE, SIZE_P1_RD); // reg 112~123
|
||||
} else if (1 == part) {
|
||||
chrg_eload_read_regs(addr, REG_STA1, SIZE_P2_RD); // reg 0~39
|
||||
} else if (2 == part) {
|
||||
chrg_eload_read_regs(addr, REG_LIMIT_VOL, SIZE_P3_RD); // reg 40~63
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
int chrg_eload_parse (rt_uint8_t idx, rt_uint8_t pt, rt_uint8_t *data, rt_uint16_t len)
|
||||
{
|
||||
if (idx >= TOTAL_SOU_CHS) {
|
||||
return -1;
|
||||
}
|
||||
|
||||
struct chrg_eload_t *pLOAD = &chrgsouth.eload[idx];
|
||||
|
||||
switch (pt) {
|
||||
case MB_R_PART1: {
|
||||
if ((SIZE_P1_RD*2+5) != len) {
|
||||
return -1;
|
||||
}
|
||||
|
||||
struct eload_p1_t *pP1 = (struct eload_p1_t *)&data[3];
|
||||
|
||||
}
|
||||
break;
|
||||
|
||||
case MB_R_PART2: {
|
||||
if ((SIZE_P2_RD*2+5) != len) {
|
||||
return -1;
|
||||
}
|
||||
|
||||
struct eload_p2_t *pP2 = (struct eload_p2_t *)&data[3];
|
||||
|
||||
}
|
||||
break;
|
||||
|
||||
case MB_R_PART3: {
|
||||
if ((SIZE_P3_RD*2+5) != len) {
|
||||
return -1;
|
||||
}
|
||||
|
||||
struct eload_p3_t *pP3 = (struct eload_p3_t *)&data[3];
|
||||
|
||||
}
|
||||
break;
|
||||
|
||||
default:
|
||||
break;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
@@ -0,0 +1,163 @@
|
||||
#ifndef __CHRG_ELOAD_H__
|
||||
#define __CHRG_ELOAD_H__
|
||||
|
||||
#include <rtthread.h>
|
||||
|
||||
#define MB_REGISTER_RD (0x03) // 读寄存器
|
||||
#define MB_REGISTER_WR (0x06) // 写寄存器
|
||||
|
||||
#define REG_STA1 (0x00) // R 16bit 工作状态1
|
||||
#define STA1_CHARGING (0x00) // 预充电中
|
||||
#define STA1_READY (0x01) // 就绪/停止
|
||||
#define STA1_RUNNING (0x02) // 运行
|
||||
#define STA1_FAULT (0x03) // 故障
|
||||
|
||||
#define REG_STA2 (0x01) // R 16bit 工作状态2
|
||||
#define STA2_PRE_REL_CLOSE (1<<0) // 预充继电器闭合
|
||||
#define STA2_MAIN_REL_CLOSE (1<<1) // 主继电器闭合
|
||||
|
||||
#define REG_FAULT1 (0x02) // R 16bit 故障状态1
|
||||
#define FAULT1_LOW_IN_VOL (1<<0) // 输入欠压
|
||||
#define FAULT1_OVER_IN_VOL (1<<1) // 输入过压
|
||||
#define FAULT1_OVER_IN_CUR (1<<2) // 输入过流
|
||||
#define FAULT1_OVER_OUT_VOL (1<<3) // 输出过压
|
||||
#define FAULT1_OVER_OUT_CUR (1<<4) // 输出过流
|
||||
|
||||
#define REG_FAULT2 (0x03) // R 16bit 故障状态2
|
||||
#define FALUT2_FLASH (1<<0) // 存储异常
|
||||
|
||||
#define REG_ELOAD (0x04) // RW 16bit 源载指令 默认负载
|
||||
#define ELOAD_SOURCE (0x01) // 电源
|
||||
#define ELOAD_LOAD (0x02) // 负载
|
||||
|
||||
#define REG_WORK (0x1E) // W 16bit 工作指令
|
||||
#define WORK_START (0x01) // 启动
|
||||
#define WORK_STOP (0x02) // 停止
|
||||
#define WORK_RESET (0x03) // 故障复位
|
||||
#define WORK_SAVE (0xAA) // 存储数据到FLASH
|
||||
#define WORK_RESTORE (0xBB) // 恢复默认参数
|
||||
|
||||
#define REG_MODE (0x1F) // RW 16bit 工作模式
|
||||
#define MODE_CONSTANT_VOLTAGE (0x01) // 恒压
|
||||
#define MODE_CONSTANT_CURRENT (0x02) // 恒流
|
||||
#define MODE_OPEN_LOOP (0x03) // 开环
|
||||
#define MODE_CONSTANT_POWER (0x04) // 恒功率
|
||||
#define MODE_CONSTANT_RESISTANCE (0x05) // 恒阻
|
||||
|
||||
#define REG_VOLTAGE (0x20) // RW 32bit 电压 0.001V (0~60V) 默认5V
|
||||
|
||||
#define REG_CURRENT (0x22) // RW 32bit 电流 0.001A (0~60A) 默认1A
|
||||
|
||||
#define REG_POWER (0x24) // RW 32bit 功率 0.01W (0~600W)
|
||||
|
||||
#define REG_RESISTANCE (0x26) // RW 16bit 电阻 0.001R
|
||||
|
||||
#define REG_LIMIT_VOL (0x28) // RW 32bit 电压限值 0.001V (0~60V) 默认48V
|
||||
|
||||
#define REG_LIMIT_VUR (0x2A) // RW 32bit 电流限值 0.001A (0~60A) 默认10A
|
||||
|
||||
#define REG_ADJUST_VOL_K (0x2C) // RWP 16bit 电压矫正K 0~65535 默认4096
|
||||
|
||||
#define REG_ADJUST_VOL_B (0x2D) // RWP 16bit 电压矫正B 0~65535 默认0
|
||||
|
||||
#define REG_ADJUST_CUR_K (0x2E) // RWP 16bit 电流矫正K 0~65535 默认4096
|
||||
|
||||
#define REG_ADJUST_CUR_B (0x2F) // RWP 16bit 电流矫正B 0~65535 默认0
|
||||
|
||||
#define REG_VOL_LOOP_KP (0x30) // RWP float 电压环KP 0.001~100 默认0.1
|
||||
|
||||
#define REG_VOL_LOOP_KI (0x32) // RWP float 电压环KI 0.001~100 默认0.01
|
||||
|
||||
#define REG_CUR_LOOP_KP (0x34) // RWP float 电流环KP 0.001~100 默认0.1
|
||||
|
||||
#define REG_CUR_LOOP_KI (0x36) // RWP float 电流环KI 0.001~100 默认0.01
|
||||
|
||||
#define REG_POWER_LOOP_KP (0x38) // RWP float 功率环KP 0.001~100 默认0.1
|
||||
|
||||
#define REG_POWER_LOOP_KI (0x3A) // RWP float 功率环KI 0.001~100 默认0.01
|
||||
|
||||
#define REG_RESIS_LOOP_KP (0x3C) // RWP float 恒阻环KP 0.001~100 默认0.1
|
||||
|
||||
#define REG_RESIS_LOOP_KI (0x3E) // RWP float 恒阻环KI 0.001~100 默认0.01
|
||||
|
||||
#define REG_TEMPERATUE (0x70) // RWP 16bit 读取温度 0.01C (0~100C)
|
||||
|
||||
#define REG_TEMP_PROTECT (0x71) // RWP 16bit 温度保护值 0.01C (60~100C) 默认90C
|
||||
|
||||
#define REG_ADDRESS (0x7A) // RWP 16bit 从机地址
|
||||
|
||||
#define REG_VERSION (0x7B) // R 16bit 版本号 0~0xFFFF
|
||||
|
||||
typedef enum {
|
||||
MB_R_PART1 = 0, // 寄存器分段1
|
||||
MB_R_PART2, // 寄存器分段2
|
||||
MB_R_PART3, // 寄存器分段3
|
||||
|
||||
TOTAL_MB_R
|
||||
} eIDX_MB_PART;
|
||||
|
||||
#define SIZE_P1_RD 12 // 读12个寄存器
|
||||
#define SIZE_P2_RD 40 // 读40个寄存器
|
||||
#define SIZE_P3_RD 24 // 读24个寄存器
|
||||
|
||||
struct eload_p1_t {
|
||||
rt_uint16_t temperature; // reg112
|
||||
rt_uint16_t temp_protect; // reg113
|
||||
rt_uint16_t reserv[8];
|
||||
rt_uint16_t addr; // reg122
|
||||
rt_uint16_t version; // reg123
|
||||
};
|
||||
|
||||
struct eload_p2_t {
|
||||
rt_uint16_t status1; // reg0
|
||||
rt_uint16_t status2; // reg1
|
||||
rt_uint16_t fault1; // reg2
|
||||
rt_uint16_t fault2; // reg3
|
||||
rt_uint16_t eload; // reg4
|
||||
rt_uint16_t reserv1[25];
|
||||
rt_uint16_t work_cmd; // reg30
|
||||
rt_uint16_t work_mode; // reg31
|
||||
rt_uint32_t voltage; // reg32-33
|
||||
rt_uint32_t current; // reg34-35
|
||||
rt_uint32_t power; // reg36-37
|
||||
rt_uint16_t resistance; // reg38
|
||||
rt_uint16_t reserv2;
|
||||
};
|
||||
|
||||
struct eload_p3_t {
|
||||
rt_uint32_t limit_vol; // reg40-41
|
||||
rt_uint32_t limit_cur; // reg42-43
|
||||
rt_uint16_t adj_vol_k; // reg44
|
||||
rt_uint16_t adj_vol_b; // reg45
|
||||
rt_uint16_t adj_cur_k; // reg46
|
||||
rt_uint16_t adj_cur_b; // reg47
|
||||
rt_uint32_t loop_vol_kp; // reg48-49 float
|
||||
rt_uint32_t loop_vol_ki; // reg50-51 float
|
||||
rt_uint32_t loop_cur_kp; // reg52-53 float
|
||||
rt_uint32_t loop_cur_ki; // reg54-55 float
|
||||
rt_uint32_t loop_pwr_kp; // reg56-57 float
|
||||
rt_uint32_t loop_pwr_ki; // reg58-59 float
|
||||
rt_uint32_t loop_resis_kp; // reg60-61 float
|
||||
rt_uint32_t loop_resis_ki; // reg62-63 float
|
||||
};
|
||||
|
||||
struct chrg_eload_t {
|
||||
rt_uint16_t status1; // 工作状态1
|
||||
rt_uint16_t status2; // 工作状态2
|
||||
rt_uint16_t falut1; // 故障状态1
|
||||
rt_uint16_t falut2; // 故障状态2
|
||||
|
||||
};
|
||||
|
||||
extern int chrg_eload_read_regs (rt_uint8_t addr, rt_uint16_t reg, rt_uint16_t len);
|
||||
|
||||
extern int chrg_eload_write_reg (rt_uint8_t addr, rt_uint16_t reg, rt_uint16_t value);
|
||||
|
||||
extern int chrg_eload_refresh (rt_uint8_t addr, rt_uint8_t part);
|
||||
|
||||
extern int chrg_eload_parse (rt_uint8_t idx, rt_uint8_t pt, rt_uint8_t *data, rt_uint16_t len);
|
||||
|
||||
|
||||
#endif
|
||||
|
||||
|
||||
+4
-26
@@ -3,11 +3,10 @@
|
||||
#include <rtthread.h>
|
||||
|
||||
#include "chrg_north.h"
|
||||
#include "chrg_south.h"
|
||||
#include "chrg_pkg.h"
|
||||
#include "chrg_north_pkg.h"
|
||||
#include "chrg_utils.h"
|
||||
|
||||
int chrg_pkg_encode (eIDX_ID id, rt_uint8_t cmd, rt_uint8_t *data_in,
|
||||
int chrg_north_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_out) {
|
||||
@@ -24,7 +23,7 @@ int chrg_pkg_encode (eIDX_ID id, rt_uint8_t cmd, rt_uint8_t *data_in,
|
||||
data_out[3] = cmd;
|
||||
|
||||
if (len_in > 0) {
|
||||
memcpy(&data_out[4], data_in, len_in);
|
||||
rt_memcpy(&data_out[4], data_in, len_in);
|
||||
}
|
||||
|
||||
data_out[len_in+4] = calc_crc8(data_out, len_in+4);
|
||||
@@ -35,7 +34,7 @@ int chrg_pkg_encode (eIDX_ID id, rt_uint8_t cmd, rt_uint8_t *data_in,
|
||||
}
|
||||
|
||||
|
||||
int chrg_pkg_decode (rt_uint8_t *data, rt_uint16_t length, struct chrg_switch_t *pSW)
|
||||
int chrg_north_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;
|
||||
@@ -120,27 +119,6 @@ int chrg_pkg_decode (rt_uint8_t *data, rt_uint16_t length, struct chrg_switch_t
|
||||
return 0;
|
||||
}
|
||||
|
||||
int chrg_pkg_send (eIDX_TTY idx, rt_uint8_t *data, rt_uint16_t len)
|
||||
{
|
||||
rt_ssize_t ret = -1;
|
||||
struct chrg_tty_t *pTTY = RT_NULL;
|
||||
|
||||
switch (idx) {
|
||||
case IDX_TTY_NORTH:
|
||||
pTTY = chrgnorth.tty;
|
||||
break;
|
||||
case IDX_TTY_SOUTH:
|
||||
pTTY = chrgsouth.tty;
|
||||
break;
|
||||
default:
|
||||
return -1;
|
||||
}
|
||||
|
||||
if ((RT_NULL != pTTY)&&(RT_NULL != pTTY->dev)) {
|
||||
ret = rt_device_write(pTTY->dev, 0, data, len);
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
||||
@@ -0,0 +1,19 @@
|
||||
#ifndef __CHRG_PKG_H__
|
||||
#define __CHRG_PKG_H__
|
||||
|
||||
#include <rtthread.h>
|
||||
|
||||
#include "chrg_tty.h"
|
||||
#include "chrg_def.h"
|
||||
#include "chrg_north.h"
|
||||
|
||||
extern int chrg_north_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_north_pkg_decode (rt_uint8_t *data, rt_uint16_t length, struct chrg_switch_t *pSW);
|
||||
|
||||
|
||||
|
||||
#endif
|
||||
|
||||
|
||||
@@ -1,19 +0,0 @@
|
||||
#ifndef __CHRG_PKG_H__
|
||||
#define __CHRG_PKG_H__
|
||||
|
||||
#include <rtthread.h>
|
||||
|
||||
#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 (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);
|
||||
|
||||
|
||||
#endif
|
||||
|
||||
@@ -3,7 +3,7 @@
|
||||
#include "chrg_source.h"
|
||||
|
||||
#include "chrg_north.h"
|
||||
#include "chrg_pkg.h"
|
||||
#include "chrg_north_pkg.h"
|
||||
#include "chrg_utils.h"
|
||||
|
||||
|
||||
@@ -19,7 +19,7 @@ int source_get_vc (rt_uint16_t vol, rt_uint16_t cur)
|
||||
data[4] = 0x00;
|
||||
data[5] = 0x00;
|
||||
|
||||
chrg_pkg_encode(ID_SOURCE, SRC_CMD_GET_VOLTAGE, data, 6, frame, &len);
|
||||
chrg_north_pkg_encode(ID_SOURCE, SRC_CMD_GET_VOLTAGE, data, 6, frame, &len);
|
||||
|
||||
return chrg_north_send(frame, len);
|
||||
}
|
||||
@@ -29,7 +29,7 @@ int source_get_pd (void)
|
||||
rt_uint16_t len = 0;
|
||||
rt_uint8_t frame[16] = {0};
|
||||
|
||||
chrg_pkg_encode(ID_SOURCE, SRC_CMD_GET_PROTOCOL, RT_NULL, 0, frame, &len);
|
||||
chrg_north_pkg_encode(ID_SOURCE, SRC_CMD_GET_PROTOCOL, RT_NULL, 0, frame, &len);
|
||||
|
||||
return chrg_north_send(frame, len);
|
||||
}
|
||||
@@ -42,7 +42,7 @@ int source_set_cc_lvl (rt_uint8_t lvl)
|
||||
|
||||
data[0] = lvl;
|
||||
|
||||
chrg_pkg_encode(ID_SOURCE, SRC_CMD_SET_CC_LEVEL, data, 1, frame, &len);
|
||||
chrg_north_pkg_encode(ID_SOURCE, SRC_CMD_SET_CC_LEVEL, data, 1, frame, &len);
|
||||
|
||||
return chrg_north_send(frame, len);
|
||||
}
|
||||
@@ -62,7 +62,7 @@ int source_set_pd (rt_uint8_t pro, rt_uint8_t src, rt_uint8_t pps,
|
||||
u16_to_u8v(vmin, &data[5]);
|
||||
u16_to_u8v(max_cur, &data[7]);
|
||||
|
||||
chrg_pkg_encode(ID_SOURCE, SRC_CMD_SET_CC_LEVEL, data, 9, frame, &len);
|
||||
chrg_north_pkg_encode(ID_SOURCE, SRC_CMD_SET_CC_LEVEL, data, 9, frame, &len);
|
||||
|
||||
return chrg_north_send(frame, len);
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user