@@ -17,38 +17,41 @@
# include "chrg_roll_sou.h"
# include "chrg_rel.h"
# define SOURCE_VOLT_COMPENSATION_MV 200U
static int chrg_source_work_running ( eIDX_SOU_CH idx ,
struct chrg_switch_t * pSW ) ;
/*****************************************************************
函数名称: chrg_source_init_submit
函数描述: 将电源模式初始化参数批量提交到南向功率板命令队列
输入参数: idx:南向功率通道编号 pSW:当前通道控制结构体
输出参数: -
返回说明: 0:提交成功 <0:参数错误或队列提交失败
其它说明: 命令顺序为源载模式、CV/CC模式、继电器、初始电压、保护电流、启动
其它说明: INIT不写电压;电压统一由RUNING状态写入,避免多个入口重复控制
*****************************************************************/
int chrg_source_init_submit ( rt_uint8_t idx , struct chrg_switch_t * pSW )
{
/* Source启动参数一次入队,最后发送WORK_START使功率板开始输出。 */
rt_uint16_t regs [ 6 ] = {
rt_uint16_t regs [ 5 ] = {
REG_ELOAD ,
REG_MODE ,
0x01 ,
REG_VOLTAGE_OUT + 1 ,
REG_CURRENT_OUT + 1 ,
REG_WORK
} ;
rt_uint16_t vals [ 6 ] = {
rt_uint16_t vals [ 5 ] = {
ELOAD_SOURCE ,
pSW - > CV_mode ,
0x03 ,
0 ,
pSW - > source . vc . set_current ,
pSW - > source . set_curr ,
WORK_START
} ;
if ( ( idx > = TOTAL_SOU_CHS ) | | ( pSW = = RT_NULL ) ) {
return - 1 ;
}
return chrg_sou_com_batch_submit ( idx , regs , vals , 6 ) ;
return chrg_sou_com_batch_submit ( idx , regs , vals , 5 ) ;
}
/*****************************************************************
@@ -57,7 +60,8 @@ int chrg_source_init_submit(rt_uint8_t idx, struct chrg_switch_t *pSW)
输入参数: idx:南向功率通道编号 pSW:当前通道控制结构体
输出参数: 更新电源运行标志、通道使能、在线状态及work_mode
返回说明: 0:初始化命令提交成功 非0:初始化失败
其它说明: 成功后状态切换为SOURCE_WORK_WAIT,等待北向返回协商 电压
其它说明: 标准协议从pd_set准备目标并转入RUNING;快充协议清空旧 电压后
进入WAIT,等待北向协商结果,INIT本身不写功率板电压
*****************************************************************/
static int chrg_source_work_init ( eIDX_SOU_CH idx , struct chrg_switch_t * pSW )
{
@@ -65,7 +69,15 @@ static int chrg_source_work_init(eIDX_SOU_CH idx, struct chrg_switch_t *pSW)
struct chrg_north_t * pNOR = & chrgnorth ;
int ret ;
/* 只有整批命令成功入队后,才打开通道并进入等待状态 。 */
/* 最大电流是功率板启动保护值,快充回码到达后可再更新运行目标 。 */
pSW - > source . set_curr = pSW - > source . pd_set . mm . max_cur ;
if ( pSW - > source . protocol = = PRO_NONE ) {
pSW - > source . set_volt = pSW - > source . pd_set . mm . max_vol ;
} else {
/* 禁止快充重新启动时沿用上一次协商电压。 */
pSW - > source . set_volt = 0 ;
}
ret = chrg_source_init_submit ( idx , pSW ) ;
if ( ret ! = 0 ) {
return ret ;
@@ -75,6 +87,11 @@ static int chrg_source_work_init(eIDX_SOU_CH idx, struct chrg_switch_t *pSW)
pNOR - > enable [ idx ] = 1 ;
pSOU - > online [ idx ] = 1 ;
chrg_nor_sw_rel ( ( eIDX_NOR_CH ) idx , ID_SOURCE ) ;
if ( pSW - > source . protocol = = PRO_NONE ) {
/* 标准协议没有协商回码,INIT成功后立即由RUNING统一写入电压。 */
pSW - > source . work_mode = SOURCE_WORK_RUNING ;
return chrg_source_work_running ( idx , pSW ) ;
}
pSW - > source . work_mode = SOURCE_WORK_WAIT ;
return 0 ;
}
@@ -95,17 +112,18 @@ static int chrg_source_work_wait(eIDX_SOU_CH idx, struct chrg_switch_t *pSW)
/*****************************************************************
函数名称: chrg_source_work_running
函数描述: 执行电源RUNING状态,下发最新协商 目标电压
函数描述: 执行电源RUNING状态,下发补偿后的 最新目标电压
输入参数: idx:南向功率通道编号 pSW:当前通道控制结构体
输出参数: -
返回说明: 0:命令提交成功 非0:命令提交失败
其它说明: 本状态只写电压寄存器,不重复发送WORK_START
其它说明: 功率板设定值固定比目标高200mV,防止限压导致输出进入稳流模式;
目标最大值为48000mV,无需做uint16_t饱和处理
*****************************************************************/
static int chrg_source_work_running ( eIDX_SOU_CH idx , struct chrg_switch_t * pSW )
{
/* RUNING只下发协商后的目标电压,不重复发送启动命令 。 */
/* 只对本次下发值补偿,不修改set_volt,防止多次执行时累计增加 。 */
rt_uint16_t reg = REG_VOLTAGE_OUT + 1 ;
rt_uint16_t value = pSW - > source . vc . set_voltage ;
rt_uint16_t value = pSW - > source . set_volt ;
return chrg_sou_com_batch_submit ( idx , & reg , & value , 1 ) ;
}
@@ -114,9 +132,9 @@ static int chrg_source_work_running(eIDX_SOU_CH idx, struct chrg_switch_t *pSW)
函数名称: chrg_source_work_stop
函数描述: 执行电源主动关机流程
输入参数: idx:南向功率通道编号 pSW:当前通道控制结构体
输出参数: 清除运行、使能和在线标志,关闭北向继电器
输出参数: 清除目标电压、 运行、使能和在线标志,关闭北向继电器
返回说明: 0:停止成功 非0:停止命令提交失败
其它说明: 成功后状态恢复为SOURCE_WORK_WAIT,等待下一次启动命令
其它说明: 先写电压0再发送WORK_STOP;只有整批命令入队成功后才清零set_volt
*****************************************************************/
static int chrg_source_work_stop ( eIDX_SOU_CH idx , struct chrg_switch_t * pSW )
{
@@ -124,17 +142,18 @@ static int chrg_source_work_stop(eIDX_SOU_CH idx, struct chrg_switch_t *pSW)
struct chrg_north_t * pNOR = & chrgnorth ;
int ret ;
rt_uint16_t reg = REG_WORK ;
rt_uint16_t value = WORK_STOP ;
rt_uint16_t regs [ 2 ] = { REG_VOLTAGE_OUT + 1 , REG_WORK } ;
rt_uint16_t vals [ 2 ] = { 0 , WORK_STOP } ;
/* 停止命令入队成功后再关闭使能和北向继电器 。 */
ret = chrg_sou_com_batch_submit ( idx , & reg , & value , 1 ) ;
/* 电压清零与停止必须保持顺序,避免下次启动继承旧目标而产生过压 。 */
ret = chrg_sou_com_batch_submit ( idx , regs , vals , 2 ) ;
if ( ret ! = 0 ) {
return ret ;
}
pSW - > source . set_volt = 0 ;
pSW - > source . On_Flag = 0 ;
pNOR - > enable [ idx ] = 0 ;
pNOR - > enable [ idx ] = 0 ;
pSOU - > online [ idx ] = 0 ;
chrg_nor_sw_rel ( ( eIDX_NOR_CH ) idx , 0 ) ;
pSW - > source . work_mode = SOURCE_WORK_WAIT ;
@@ -152,17 +171,18 @@ static int chrg_source_work_stop(eIDX_SOU_CH idx, struct chrg_switch_t *pSW)
*****************************************************************/
static int chrg_source_work_switch ( eIDX_SOU_CH idx , struct chrg_switch_t * pSW )
{
rt_uint16_t regs [ 2 ] = { REG_REL_ON , REG_WORK } ;
rt_uint16_t vals [ 2 ] = { ALL_REL_OFF , WORK_STOP } ;
rt_uint16_t regs [ 3 ] = { REG_REL_ON , REG_VOLTAGE_OUT + 1 , REG_WORK } ;
rt_uint16_t vals [ 3 ] = { ALL_REL_OFF , 0 , WORK_STOP } ;
int ret ;
ret = chrg_sou_com_batch_submit ( idx , regs , vals , 2 ) ;
ret = chrg_sou_com_batch_submit ( idx , regs , vals , 3 ) ;
if ( ret ! = 0 ) {
return ret ;
}
/* 停止成功入队后,清除旧Sink运行标志。 */
pSW - > sink . On_work = 0 ;
pSW - > source . set_volt = 0 ;
/* 首次进入Source时必须从CC线配置开始,不能沿用Sink的sub状态。 */
pSW - > sub = IDX_SET_SOURCE_CC_SET ;
/* SWITCH只负责旧角色退出,后续启动统一交给Source INIT状态。 */
@@ -891,6 +911,8 @@ rt_uint8_t pd_fill_single_group_need_src_com(rt_uint8_t *data, rt_uint8_t start_
rt_uint8_t idx = start_idx ;
struct chrg_src_t * source = & psw - > source ;
const struct vc_pd_t * pd = & source - > pd_set ;
const struct vc_mm_t * mm = & pd - > mm ;
// 1. src + pps( 2字节)
data [ idx + + ] = 0x00 ;
data [ idx + + ] = 0x00 ;
@@ -901,23 +923,23 @@ rt_uint8_t pd_fill_single_group_need_src_com(rt_uint8_t *data, rt_uint8_t start_
data [ idx + + ] = 0x13 ;
data [ idx + + ] = 0x88 ;
// 4. 电流/功率(高+低,直接取已拆分好的值)
data [ idx + + ] = source - > vc . set_current > > 8 ;
data [ idx + + ] = source - > vc . set_current & 0xFF ;
data [ idx + + ] = mm - > max_cur > > 8 ;
data [ idx + + ] = mm - > max_cur & 0xFF ;
// 5. 保留位6字节(直接填0)
memset ( & data [ idx ] , 0x00 , 6 ) ;
idx + = 6 ;
data [ idx + + ] = source - > src ;
data [ idx + + ] = source - > pps ;
rt_kprintf ( " src = %d pps = %d \n " , source - > src , source - > pps ) ;
data [ idx + + ] = pd - > src_type ;
data [ idx + + ] = pd - > pps_type ;
//rt_kprintf(" src = %d pps = %d\n", pd->src_type, pd->pps_type);
// 2. 最小电压(高+低,直接取已拆分好的值)
data [ idx + + ] = source - > min_vol > > 8 ;
data [ idx + + ] = source - > min_vol & 0xFF ;
data [ idx + + ] = mm - > min_vol > > 8 ;
data [ idx + + ] = mm - > min_vol & 0xFF ;
// 3. 最大电压(高+低,直接取已拆分好的值)
data [ idx + + ] = source - > vc . set_voltage > > 8 ;
data [ idx + + ] = source - > vc . set_voltage & 0xFF ;
data [ idx + + ] = mm - > max_vol > > 8 ;
data [ idx + + ] = mm - > max_vol & 0xFF ;
// 4. 电流/功率(高+低,直接取已拆分好的值)
data [ idx + + ] = source - > vc . set_current > > 8 ;
data [ idx + + ] = source - > vc . set_current & 0xFF ;
data [ idx + + ] = mm - > max_cur > > 8 ;
data [ idx + + ] = mm - > max_cur & 0xFF ;
// 5. 保留位6字节(直接填0)
memset ( & data [ idx ] , 0x00 , 6 ) ;
idx + = 6 ;
@@ -928,28 +950,30 @@ rt_uint8_t pd_fill_single_group_no_src_com(rt_uint8_t *data, rt_uint8_t start_id
rt_uint8_t idx = start_idx ;
struct chrg_src_t * source = & psw - > source ;
const struct vc_mm_t * mm = & source - > pd_set . mm ;
// 1. src + pps( 2字节)
data [ idx + + ] = 0x00 ;
data [ idx + + ] = 0x00 ;
// 2. 最小电压(高+低,直接取已拆分好的值)
data [ idx + + ] = source - > min_vol > > 8 ;
data [ idx + + ] = source - > min_vol & 0xFF ;
data [ idx + + ] = mm - > min_vol > > 8 ;
data [ idx + + ] = mm - > min_vol & 0xFF ;
// 3. 最大电压(高+低,直接取已拆分好的值)
data [ idx + + ] = source - > vc . set_voltage > > 8 ;
data [ idx + + ] = source - > vc . set_voltage & 0xFF ;
data [ idx + + ] = mm - > max_vol > > 8 ;
data [ idx + + ] = mm - > max_vol & 0xFF ;
// 4. 电流/功率(高+低,直接取已拆分好的值)
data [ idx + + ] = source - > vc . set_current > > 8 ;
data [ idx + + ] = source - > vc . set_current & 0xFF ;
data [ idx + + ] = mm - > max_cur > > 8 ;
data [ idx + + ] = mm - > max_cur & 0xFF ;
// 5. 保留位6字节(直接填0)
memset ( & data [ idx ] , 0x00 , 6 ) ;
idx + = 6 ;
return idx - start_idx ; // 返回填充的总字节数
}
rt_uint8_t pd_fill_single_group_FCP_AFC ( rt_uint8_t * data , rt_uint8_t start_idx , struct chrg_switch_t * psw ) {
rt_uint8_t pd_fill_single_group_AFC ( rt_uint8_t * data , rt_uint8_t start_idx , struct chrg_switch_t * psw ) {
rt_uint8_t idx = start_idx ;
struct chrg_src_t * source = & psw - > source ;
const struct vc_mm_t * mm = & source - > pd_set . mm ;
// 1. src + pps( 2字节)
data [ idx + + ] = 0x00 ;
data [ idx + + ] = 0x00 ;
@@ -960,8 +984,8 @@ rt_uint8_t pd_fill_single_group_FCP_AFC(rt_uint8_t *data, rt_uint8_t start_idx,s
data [ idx + + ] = 0x13 ;
data [ idx + + ] = 0x88 ;
// 4. 电流/功率(高+低,直接取已拆分好的值)
data [ idx + + ] = source - > vc . set_current > > 8 ;
data [ idx + + ] = source - > vc . set_current & 0xFF ;
data [ idx + + ] = mm - > max_cur > > 8 ;
data [ idx + + ] = mm - > max_cur & 0xFF ;
// 5. 保留位6字节(直接填0)
memset ( & data [ idx ] , 0x00 , 6 ) ;
idx + = 6 ;
@@ -969,14 +993,14 @@ rt_uint8_t pd_fill_single_group_FCP_AFC(rt_uint8_t *data, rt_uint8_t start_idx,s
data [ idx + + ] = 0x00 ;
data [ idx + + ] = 0x00 ;
// 2. 最小电压(高+低,直接取已拆分好的值)
data [ idx + + ] = source - > vc . set_voltage > > 8 ;
data [ idx + + ] = source - > vc . set_voltage & 0xFF ;
data [ idx + + ] = mm - > max_vol > > 8 ;
data [ idx + + ] = mm - > max_vol & 0xFF ;
// 3. 最大电压(高+低,直接取已拆分好的值)
data [ idx + + ] = source - > vc . set_voltage > > 8 ;
data [ idx + + ] = source - > vc . set_voltage & 0xFF ;
data [ idx + + ] = mm - > max_vol > > 8 ;
data [ idx + + ] = mm - > max_vol & 0xFF ;
// 4. 电流/功率(高+低,直接取已拆分好的值)
data [ idx + + ] = source - > vc . set_current > > 8 ;
data [ idx + + ] = source - > vc . set_current & 0xFF ;
data [ idx + + ] = mm - > max_cur > > 8 ;
data [ idx + + ] = mm - > max_cur & 0xFF ;
// 5. 保留位6字节(直接填0)
memset ( & data [ idx ] , 0x00 , 6 ) ;
idx + = 6 ;
@@ -987,6 +1011,7 @@ rt_uint8_t pd_fill_single_group_UFCS(rt_uint8_t *data, rt_uint8_t start_idx,stru
rt_uint8_t idx = start_idx ;
struct chrg_src_t * source = & psw - > source ;
const struct vc_mm_t * mm = & source - > pd_set . mm ;
// 1. src + pps( 2字节)
data [ idx + + ] = 0x00 ;
data [ idx + + ] = 0x00 ;
@@ -997,8 +1022,8 @@ rt_uint8_t pd_fill_single_group_UFCS(rt_uint8_t *data, rt_uint8_t start_idx,stru
data [ idx + + ] = 0x13 ;
data [ idx + + ] = 0x88 ;
// 4. 电流/功率(高+低,直接取已拆分好的值)
data [ idx + + ] = source - > vc . set_current > > 8 ;
data [ idx + + ] = source - > vc . set_current & 0xFF ;
data [ idx + + ] = mm - > max_cur > > 8 ;
data [ idx + + ] = mm - > max_cur & 0xFF ;
// 5. 保留位6字节(直接填0)
memset ( & data [ idx ] , 0x00 , 6 ) ;
idx + = 6 ;
@@ -1006,20 +1031,45 @@ rt_uint8_t pd_fill_single_group_UFCS(rt_uint8_t *data, rt_uint8_t start_idx,stru
data [ idx + + ] = 0x00 ;
data [ idx + + ] = 0x00 ;
// 2. 最小电压(高+低,直接取已拆分好的值)
data [ idx + + ] = source - > min_vol > > 8 ;
data [ idx + + ] = source - > min_vol & 0xFF ;
data [ idx + + ] = mm - > min_vol > > 8 ;
data [ idx + + ] = mm - > min_vol & 0xFF ;
// 3. 最大电压(高+低,直接取已拆分好的值)
data [ idx + + ] = source - > vc . set_voltage > > 8 ;
data [ idx + + ] = source - > vc . set_voltage & 0xFF ;
data [ idx + + ] = mm - > max_vol > > 8 ;
data [ idx + + ] = mm - > max_vol & 0xFF ;
// 4. 电流/功率(高+低,直接取已拆分好的值)
data [ idx + + ] = source - > vc . set_current > > 8 ;
data [ idx + + ] = source - > vc . set_current & 0xFF ;
data [ idx + + ] = mm - > max_cur > > 8 ;
data [ idx + + ] = mm - > max_cur & 0xFF ;
// 5. 保留位6字节(直接填0)
memset ( & data [ idx ] , 0x00 , 6 ) ;
idx + = 6 ;
return idx - start_idx ; // 返回填充的总字节数
}
static rt_uint8_t chrg_source_fill_AFC_three_gears ( rt_uint8_t * data ,
rt_uint8_t start_idx , struct chrg_switch_t * psw )
{
static const rt_uint16_t fixed_voltages [ ] = { 5000U , 9000U , 12000U , 20000U } ;
const struct vc_mm_t * mm = & psw - > source . pd_set . mm ;
rt_uint8_t idx = start_idx ;
rt_uint8_t gear ;
for ( gear = 0 ; gear < ( sizeof ( fixed_voltages ) / sizeof ( fixed_voltages [ 0 ] ) ) ;
gear + + ) {
/* FCP固定电压档不使用PD源类型和PPS类型。 */
data [ idx + + ] = 0x00 ;
data [ idx + + ] = 0x00 ;
data [ idx + + ] = fixed_voltages [ gear ] > > 8 ;
data [ idx + + ] = fixed_voltages [ gear ] & 0xFF ;
data [ idx + + ] = fixed_voltages [ gear ] > > 8 ;
data [ idx + + ] = fixed_voltages [ gear ] & 0xFF ;
data [ idx + + ] = mm - > max_cur > > 8 ;
data [ idx + + ] = mm - > max_cur & 0xFF ;
memset ( & data [ idx ] , 0x00 , 6 ) ;
idx + = 6 ;
}
return idx - start_idx ;
}
int source_set_pro ( rt_uint8_t pro , struct chrg_switch_t * pSW )
{
@@ -1032,14 +1082,14 @@ int source_set_pro(rt_uint8_t pro, struct chrg_switch_t *pSW)
rt_uint8_t idx = 1 ; //从data[1]开始填充
rt_uint8_t fill_len = 0 ;
rt_uint8_t protocal = pSW - > source . protocol ;
if ( protocal = = 0x0A ) {
if ( protocal = = PRO_PD0PSS ) {
fill_len = pd_fill_single_group_need_src_com ( data , idx , pSW ) ;
} else if ( protocal = = 0x03 | | protocal = = 0x07 | | protocal = = 0x08 ) {
} else if ( protocal = = PRO_SCPB | | protocal = = PRO_QC30 | | protocal = = PRO_QC20 | | protocal = = PRO_FCP ) {
fill_len = pd_fill_single_group_no_src_com ( data , idx , pSW ) ;
} else if ( protocal = = 0x0C ) {
} else if ( protocal = = PRO_UFCS ) {
fill_len = pd_fill_single_group_UFCS ( data , idx , pSW ) ;
} else {
fill_len = pd_fill_single_group_FCP_AFC ( data , idx , pSW ) ;
fill_len = chrg_source_fill_AFC_three_gears ( data , idx , pSW ) ;
}
idx + = fill_len ;
send_len = idx ; // 总填充字节数