roll south mb

This commit is contained in:
wmano
2025-10-26 22:05:19 +08:00
parent 604fe4688c
commit 8b6f231b28
23 changed files with 1053 additions and 550 deletions
+18
View File
@@ -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
+101
View File
@@ -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;
}
+163
View File
@@ -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
@@ -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
-19
View File
@@ -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
+5 -5
View File
@@ -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);
}