@@ -18,6 +18,64 @@
# include "chrg_def.h"
# include "chrg_rel.h"
# include "chrg_comm.h"
# include "chrg_eload.h"
# define SINK_UNLOAD_QUERY_INTERVAL_MS 20U // 卸载期间两次优先量测请求的最小间隔
# define SINK_UNLOAD_CURRENT_MAX_MA 100U // 判定负载已安全卸载的最大实际电流
# define SINK_UNLOAD_CONFIRM_COUNT 2U // 连续满足低电流条件的量测帧数
/* 卸载确认只接受停止批次成功后产生的新P1量测。 */
static rt_uint32_t g_sink_unload_sample_seq [ TOTAL_SOU_CHS ] = { 0 } ;
static rt_bool_t g_sink_unload_batch_confirmed [ TOTAL_SOU_CHS ] = { RT_FALSE } ;
static rt_tick_t g_sink_unload_query_tick [ TOTAL_SOU_CHS ] = { 0 } ;
static rt_uint8_t g_sink_unload_confirm_count [ TOTAL_SOU_CHS ] = { 0 } ;
/*****************************************************************
函数名称: chrg_sink_unload_confirm_reset
函数描述: 清除指定通道的卸载批次和低电流确认上下文
输入参数: idx:南向功率板通道
输出参数: 清零量测序号、批次确认标志、查询tick和连续确认次数
返回说明: -
其它说明: 每次开始软卸载或完整重握手前调用,禁止沿用旧量测结果
*****************************************************************/
static void chrg_sink_unload_confirm_reset ( eIDX_SOU_CH idx )
{
if ( idx > = TOTAL_SOU_CHS ) {
return ;
}
g_sink_unload_sample_seq [ idx ] = 0U ;
g_sink_unload_batch_confirmed [ idx ] = RT_FALSE ;
g_sink_unload_query_tick [ idx ] = 0U ;
g_sink_unload_confirm_count [ idx ] = 0U ;
}
/*****************************************************************
函数名称: chrg_sink_unload_query_submit
函数描述: 按最小间隔提交当前通道的一次性P1量测请求
输入参数: idx:南向功率板通道 force:RT_TRUE立即提交 RT_FALSE按间隔提交
输出参数: 更新本通道最近一次查询tick
返回说明: 0:请求成功、已存在或尚未到查询时间 <0:请求提交失败
其它说明: 电流长期不归零时保留普通轮询窗口,避免持续优先查询阻塞其它通道
*****************************************************************/
static int chrg_sink_unload_query_submit ( eIDX_SOU_CH idx , rt_bool_t force )
{
rt_tick_t now ;
if ( idx > = TOTAL_SOU_CHS ) {
return - 1 ;
}
now = rt_tick_get ( ) ;
if ( ! force & &
( ( rt_tick_t ) ( now - g_sink_unload_query_tick [ idx ] ) <
rt_tick_from_millisecond ( SINK_UNLOAD_QUERY_INTERVAL_MS ) ) ) {
return 0 ;
}
if ( chrg_sou_measure_once_submit ( idx ) ! = 0 ) {
return - 1 ;
}
g_sink_unload_query_tick [ idx ] = now ;
return 0 ;
}
/*****************************************************************
函数名称: sink_get_vc
函数描述: sink电压电流查询请求
@@ -130,45 +188,85 @@ int sink_set_pd (rt_uint8_t pd, rt_uint8_t *buf)
/*****************************************************************
函数名称: chrg_sink_work_init
函数描述: 执行负载INIT状态,复位测试配置并初始化功率板
函数描述: 执行负载INIT入口,第一条南向命令只打开副继电器
输入参数: idx:南向功率通道编号 pSW:当前通道控制结构体
输出参数: 设置运行、使能、在线标志并更新work_mode
返回说明: 0:初始化 成功 <0:命令提交失败
其它说明: 成功后打开负载北向继电器并进入SINK_WORK_WAIT
输出参数: 禁止北向请求并进入SINK_WORK_INIT_AUX_WAIT
返回说明: 0:副继电器命令提交 成功 <0:参数或 命令提交失败
其它说明: FU_REL_ON同时保证主继电器关闭;收到有效回码前不得启动北向握手
*****************************************************************/
static int chrg_sink_work_init ( eIDX_SOU_CH idx , struct chrg_switch_t * pSW )
{
struct chrg_north_t * pNOR = & chrgnorth ;
rt_uint16_t reg = REG_REL_ON ;
rt_uint16_t value = FU_REL_ON ;
if ( ( idx > = TOTAL_SOU_CHS ) | | ( pSW = = RT_NULL ) ) {
return - 1 ;
}
if ( chrg_sou_com_batch_submit ( idx , & reg , & value , 1U ) ! = 0 ) {
return - 1 ;
}
/* 北向软件使能在副继电器回码后恢复,避免协议命令先于电压通路。 */
pSW - > sink . On_work = 1 ;
pNOR - > enable [ idx ] = 0 ;
pSW - > sink . work_mode = SINK_WORK_INIT_AUX_WAIT ;
return 0 ;
}
/*****************************************************************
函数名称: chrg_sink_work_init_aux_wait
函数描述: 等待启动副继电器回码,并异步提交其余功率板初始化命令
输入参数: idx:南向功率通道编号 pSW:当前通道控制结构体
输出参数: 打开北向Sink继电器、恢复北向使能并进入SINK_WORK_WAIT
返回说明: 0:继续等待或初始化命令已入队 <0:参数或命令提交失败
其它说明: 其余初始化命令只要求成功入队,不等待执行完成;北向握手和
南向初始化可并行,后续RUNING命令追加到同一队列并保持顺序
*****************************************************************/
static int chrg_sink_work_init_aux_wait ( eIDX_SOU_CH idx ,
struct chrg_switch_t * pSW )
{
struct chrg_south_t * pSOU = & chrgsouth ;
struct chrg_north_t * pNOR = & chrgnorth ;
rt_uint16_t regs [ 5 ] = { REG_CURRENT_OUT + 1 , REG_MODE ,
Eload_Start_V_ON , 0 , 0 } ;
rt_uint16_t vals [ 5 ] = { 0 , pSW - > CV_mode , pSW - > sink . volt_on ,
0 , 0 } ;
rt_uint8_t count = 3 ;
rt_uint16_t regs [ 4 ] = { REG_CURRENT_OUT + 1 , REG_MODE ,
Eload_Start_V_ON , 0 } ;
rt_uint16_t vals [ 4 ] = { 0 } ;
rt_uint8_t count = 3U ;
int batch_result ;
if ( ( idx > = TOTAL_SOU_CHS ) | | ( pSW = = RT_NULL ) ) {
return - 1 ;
}
vals [ 1 ] = pSW - > CV_mode ;
vals [ 2 ] = pSW - > sink . volt_on ;
if ( chrg_sou_com_batch_is_pending ( idx ) ) {
return 0 ;
}
batch_result = chrg_sou_com_batch_get_result ( idx ) ;
if ( batch_result < = 0 ) {
/* 副继电器无有效回码时重新执行INIT,北向继续保持禁止。 */
return chrg_sink_work_init ( idx , pSW ) ;
}
if ( pSW - > sink . test . test_mode_old = = SINK_TEST_SHORT ) {
regs [ count ] = ModbusRTU_ShortTest_CMD_MODE_FLAG ;
vals [ count + + ] = ModbusRTU_DYNA_CMD_MODE_STOP ;
} else if ( pSW - > sink . test . test_mode_old = = SINK_TEST_OCP ) {
/* 从OCP测试返回普通负载时,先停止功率板的OCP测试状态机。 */
regs [ count ] = ModbusRTU_OCPTest_CMD_MODE_FLAG ;
vals [ count + + ] = ModbusRTU_DYNA_CMD_MODE_STOP ;
} else if ( pSW - > sink . test . test_mode_old = = SINK_TEST_DYNA ) {
regs [ count ] = ModbusRTU_DYNA_CMD_MODE_FLAG ;
vals [ count + + ] = ModbusRTU_DYNA_CMD_MODE_STOP ;
}
/* Close both power-board relays before starting sink init. */
regs [ count ] = REG_REL_ON ;
vals [ count + + ] = ALL_REL_OFF ;
if ( chrg_sou_com_batch_submit ( idx , regs , vals , count ) ! = 0 ) {
return - 1 ;
}
pSW - > sink . On_work = 1 ;
/* 初始化命令已按顺序入队,此时即可给协议板接通北向Sink路径。 */
pSOU - > online [ idx ] = 1 ;
pNOR - > enable [ idx ] = 1 ;
chrg_nor_sw_rel ( ( eIDX_NOR_CH ) idx , ID_SINK ) ; //打开北向继电器
chrg_nor_sw_rel ( ( eIDX_NOR_CH ) idx , ID_SINK ) ;
pSW - > sub = IDX_SET_SINK_PD ;
pSW - > sink . test . test_mode_old = 0 ;
pSW - > sink . work_mode = SINK_WORK_WAIT ;
return 0 ;
@@ -180,7 +278,8 @@ static int chrg_sink_work_init(eIDX_SOU_CH idx, struct chrg_switch_t *pSW)
输入参数: idx:南向功率通道编号 pSW:当前通道控制结构体
输出参数: -
返回说明: 0:命令提交成功 非0:命令提交失败
其它说明: CV模式下写负载电压,其他模式下写负载电流
其它说明: CV模式下写负载电压,其他模式下写负载电流;副继电器0x02
收到有效回码后直接发送全部继电器0x03,当前不增加固定延时
*****************************************************************/
static int chrg_sink_work_volt_runing ( eIDX_SOU_CH idx , struct chrg_switch_t * pSW )
{
@@ -197,20 +296,93 @@ static int chrg_sink_work_volt_runing(eIDX_SOU_CH idx, struct chrg_switch_t *pSW
return chrg_sou_com_batch_submit ( idx , regs , vals , 4 ) ;
}
/*****************************************************************
函数名称: chrg_sink_work_soft_resume
函数描述: 仅协议电压变化完成后恢复负载,不操作南向主副继电器
输入参数: idx:南向功率通道编号 pSW:当前通道控制结构体
输出参数: 命令入队成功后将工作状态切换为SINK_WORK_SOFT_RUNNING
返回说明: 0:命令提交成功 <0:参数或命令提交失败
其它说明: 命令顺序为目标电流/电压、WORK_START,保证软卸载期间继电器
始终保持原状态,避免恢复阶段因FU_REL_ON造成主继电器短暂断开
*****************************************************************/
static int chrg_sink_work_soft_resume ( eIDX_SOU_CH idx ,
struct chrg_switch_t * pSW )
{
rt_uint16_t regs [ 2 ] = { 0 , REG_WORK } ;
rt_uint16_t vals [ 2 ] = { 0 , WORK_START } ;
if ( ( idx > = TOTAL_SOU_CHS ) | | ( pSW = = RT_NULL ) ) {
return - 1 ;
}
if ( pSW - > CV_mode = = MODE_CONSTANT_VOLTAGE ) {
regs [ 0 ] = REG_VOLTAGE_OUT + 1 ;
vals [ 0 ] = pSW - > sink . loadv ;
} else {
regs [ 0 ] = REG_CURRENT_OUT + 1 ;
vals [ 0 ] = pSW - > sink . loadc ;
}
if ( chrg_sou_com_batch_submit ( idx , regs , vals , 2U ) ! = 0 ) {
return - 1 ;
}
pSW - > sink . work_mode = SINK_WORK_SOFT_RUNNING ;
return 0 ;
}
/*****************************************************************
函数名称: chrg_sink_nor_work_low
函数描述: 执行负载低电压状态,断开功率继电器并停止负载
函数描述: 执行负载掉电处理,卸载后关闭主副继电器并重新打开副继电器
输入参数: idx:南向功率通道编号 pSW:当前通道控制结构体
输出参数: -
返回说明: 0:命令提交成功 非0:命令提交失败
其它说明: 由北向负载解析连续检测到低电压后触发
其它说明: 命令顺序为WORK_STOP、CURRENT=0、ALL_REL_OFF、FU_REL_ON;
ALL_REL_OFF后立即恢复副继电器,为协议板重新得电保留通路
*****************************************************************/
static int chrg_sink_nor_work_low ( eIDX_SOU_CH idx , struct chrg_switch_t * pSW )
{
rt_uint16_t regs [ 2 ] = { 0x01 , REG_WORK } ;
rt_uint16_t vals [ 2 ] = { 0x00 , WORK_STOP } ;
rt_uint16_t regs [ 4 ] = {
REG_WORK , REG_CURRENT_OUT + 1 , REG_REL_ON , REG_REL_ON
} ;
rt_uint16_t vals [ 4 ] = {
WORK_STOP , 0 , ALL_REL_OFF , FU_REL_ON
} ;
return chrg_sou_com_batch_submit ( idx , regs , vals , 2 ) ;
if ( ( idx > = TOTAL_SOU_CHS ) | | ( pSW = = RT_NULL ) ) {
return - 1 ;
}
if ( chrg_sou_com_batch_submit ( idx , regs , vals , 4U ) ! = 0 ) {
return - 1 ;
}
pSW - > sink . work_mode = SINK_WORK_LOW_AUX_WAIT ;
return 0 ;
}
/*****************************************************************
函数名称: chrg_sink_work_low_aux_wait
函数描述: 等待掉电安全批次和副继电器恢复命令全部收到有效回码
输入参数: idx:南向功率通道编号 pSW:当前通道控制结构体
输出参数: 成功后进入SINK_WORK_LOW_MONITOR并恢复北向电压查询入口
返回说明: 0:继续等待或状态转换成功 <0:参数错误
其它说明: 批次失败时重新执行完整掉电处理,不允许跳过副继电器确认
*****************************************************************/
static int chrg_sink_work_low_aux_wait ( eIDX_SOU_CH idx ,
struct chrg_switch_t * pSW )
{
int batch_result ;
if ( ( idx > = TOTAL_SOU_CHS ) | | ( pSW = = RT_NULL ) ) {
return - 1 ;
}
if ( chrg_sou_com_batch_is_pending ( idx ) ) {
return 0 ;
}
batch_result = chrg_sou_com_batch_get_result ( idx ) ;
if ( batch_result < = 0 ) {
return chrg_sink_nor_work_low ( idx , pSW ) ;
}
pSW - > sub = IDX_GET_SINK_VC ;
pSW - > sink . work_mode = SINK_WORK_LOW_MONITOR ;
return 0 ;
}
/*****************************************************************
@@ -270,8 +442,8 @@ static int chrg_sink_work_switch(eIDX_SOU_CH idx, struct chrg_switch_t *pSW)
/* 停止成功入队后,清除旧Source运行标志。 */
pSW - > source . On_Flag = 0 ;
/* 首次进入Sink时必须从CC线配置开始,不能沿用Source的sub状态 。 */
pSW - > sub = IDX_SET_SINK_CCLINE ;
/* 首次进入Sink时从协议配置开始,协议应答后再设置目标CC线 。 */
pSW - > sub = IDX_SET_SINK_PD ;
/* SWITCH只负责旧角色退出,后续启动统一交给Sink INIT状态。 */
pSW - > sink . work_mode = SINK_WORK_INIT ;
return 0 ;
@@ -279,26 +451,125 @@ static int chrg_sink_work_switch(eIDX_SOU_CH idx, struct chrg_switch_t *pSW)
/*****************************************************************
函数名称: chrg_sink_work_protocol_unload
函数描述: 协议或CC线 变化前的卸载状态 :停止负载、电流归零、断开功率继电器
函数描述: 仅 协议电压 变化前的软 卸载:停止负载并将设定电流归零
输入参数: idx:南向功率通道编号 pSW:当前通道控制结构体
输出参数: -
返回说明: 0:命令提交成功 <0:命令提交失败
其它说明: 不操作北向继电器,仅卸载功率板侧;后续由WAIT→北向线程重配
CC/协议,再由RUNING状态闭合继电器并恢复目标负载电流
其它说明: 不操作北向和南向功率继电器;两条写命令完成后进入UNLOAD_WAIT,
连续确认两帧实际电流不大于100mA,才允许北向重配协议并使用软恢复流程
*****************************************************************/
static int chrg_sink_work_protocol_unload ( eIDX_SOU_CH idx , struct chrg_switch_t * pSW )
{
rt_uint16_t regs [ 3 ] = { REG_WORK , REG_CURRENT_OUT + 1 , REG_REL_ON } ;
rt_uint16_t vals [ 3 ] = { WORK_STOP , 0 , ALL_REL_OFF } ;
rt_uint16_t regs [ 2 ] = { REG_WORK , REG_CURRENT_OUT + 1 } ;
rt_uint16_t vals [ 2 ] = { WORK_STOP , 0 } ;
if ( chrg_sou_com_batch_submit ( idx , regs , vals , 3 ) ! = 0 ) {
if ( chrg_sou_com_batch_submit ( idx , regs , vals , 2 ) ! = 0 ) {
return - 1 ;
}
pSW - > sink . work_mode = SINK_WORK_WAIT ;
/* 写回码只确认命令接收;批次完成后还需连续读取两帧合格的实际电流。 */
chrg_sink_unload_confirm_reset ( idx ) ;
pSW - > sink . work_mode = SINK_WORK_UNLOAD_WAIT ;
return 0 ;
}
/*****************************************************************
函数名称: chrg_sink_work_handshake_prepare
函数描述: 执行协议或CC完整重握手前的南向安全断开和副继电器恢复
输入参数: idx:南向功率板通道 pSW:当前通道控制结构体
输出参数: 命令提交成功后进入SINK_WORK_HANDSHAKE_WAIT
返回说明: 0:四条命令提交成功 <0:参数或命令提交失败
其它说明: 命令顺序固定为WORK_STOP、CURRENT=0、ALL_REL_OFF、FU_REL_ON;
主副继电器全部断开并确认回码后再单独打开副继电器;
北向Sink继电器保持接通,低电流确认完成后才允许重新握手
*****************************************************************/
static int chrg_sink_work_handshake_prepare ( eIDX_SOU_CH idx ,
struct chrg_switch_t * pSW )
{
rt_uint16_t regs [ 4 ] = {
REG_WORK , REG_CURRENT_OUT + 1 , REG_REL_ON , REG_REL_ON
} ;
rt_uint16_t vals [ 4 ] = {
WORK_STOP , 0 , ALL_REL_OFF , FU_REL_ON
} ;
if ( ( idx > = TOTAL_SOU_CHS ) | | ( pSW = = RT_NULL ) ) {
return - 1 ;
}
if ( chrg_sou_com_batch_submit ( idx , regs , vals , 4 ) ! = 0 ) {
return - 1 ;
}
/* 四条写回码完成后,还必须连续确认两帧实际电流不大于100mA。 */
chrg_sink_unload_confirm_reset ( idx ) ;
pSW - > sink . work_mode = SINK_WORK_HANDSHAKE_WAIT ;
return 0 ;
}
/*****************************************************************
函数名称: chrg_sink_work_current_wait
函数描述: 等待负载安全断开批次完成,并连续确认两帧实际电流不大于100mA
输入参数: idx:南向功率板通道 pSW:当前通道控制结构体
full_handshake:RT_TRUE为完整重握手 RT_FALSE为仅协议电压软卸载
输出参数: 确认成功后将sink.work_mode切换为SINK_WORK_WAIT
返回说明: 0:继续等待或确认成功 <0:状态查询或优先量测请求失败
其它说明: 只有WORK_STOP和CURRENT=0均收到匹配回码后才建立量测基线;
完整重握手还要求ALL_REL_OFF和FU_REL_ON回码成功,但保持北向Sink继电器接通
*****************************************************************/
static int chrg_sink_work_current_wait ( eIDX_SOU_CH idx ,
struct chrg_switch_t * pSW , rt_bool_t full_handshake )
{
rt_uint32_t sample_seq ;
int batch_result ;
if ( ( idx > = TOTAL_SOU_CHS ) | | ( pSW = = RT_NULL ) ) {
return - 1 ;
}
if ( chrg_sou_com_batch_is_pending ( idx ) ) {
return 0 ;
}
batch_result = chrg_sou_com_batch_get_result ( idx ) ;
if ( batch_result < 0 ) {
/* 写命令失败时重新执行完整卸载批次,禁止使用量测值提前放行。 */
return full_handshake ? chrg_sink_work_handshake_prepare ( idx , pSW ) :
chrg_sink_work_protocol_unload ( idx , pSW ) ;
}
if ( batch_result = = 0 ) {
/* 无有效批次结果时保持阻塞,并重新提交完整卸载动作。 */
return full_handshake ? chrg_sink_work_handshake_prepare ( idx , pSW ) :
chrg_sink_work_protocol_unload ( idx , pSW ) ;
}
if ( ! g_sink_unload_batch_confirmed [ idx ] ) {
/* 从最后一条写回码之后建立基线,排除RUN_COM之前残留的旧量测。 */
g_sink_unload_sample_seq [ idx ] = chrg_eload_get_sample_seq ( idx ) ;
g_sink_unload_batch_confirmed [ idx ] = RT_TRUE ;
return chrg_sink_unload_query_submit ( idx , RT_TRUE ) ;
}
sample_seq = chrg_eload_get_sample_seq ( idx ) ;
if ( sample_seq ! = g_sink_unload_sample_seq [ idx ] ) {
g_sink_unload_sample_seq [ idx ] = sample_seq ;
if ( pSW - > Now_current < = SINK_UNLOAD_CURRENT_MAX_MA ) {
g_sink_unload_confirm_count [ idx ] + + ;
if ( g_sink_unload_confirm_count [ idx ] > = SINK_UNLOAD_CONFIRM_COUNT ) {
g_sink_unload_batch_confirmed [ idx ] = RT_FALSE ;
g_sink_unload_confirm_count [ idx ] = 0U ;
pSW - > sink . work_mode = full_handshake ?
SINK_WORK_WAIT : SINK_WORK_SOFT_RESUME_WAIT ;
return 0 ;
}
} else {
/* 必须是连续两帧合格量测;中间出现带载电流时重新计数。 */
g_sink_unload_confirm_count [ idx ] = 0U ;
}
}
/* 当前帧仍有电流或查询未返回时,请求下一帧;接口按位登记,不会重复排队。 */
return chrg_sink_unload_query_submit ( idx , RT_FALSE ) ;
}
/*****************************************************************
函数名称: chrg_sink_TEST_DYNA_ON
函数描述: 配置并启动动态负载测试
@@ -399,14 +670,21 @@ int chrg_sink_work(eIDX_SOU_CH idx, struct chrg_switch_t *pSW)
return - 1 ;
}
work_mode = pSW - > sink . work_mode ;
// 本次状态和上次一致,直接跳过,不重复下发寄存器
if ( work_mode = = last_state [ idx ] ) {
/* 异步等待状态需要持续检查批次或新量测,其余相同状态保持去重。 */
if ( ( work_mode = = last_state [ idx ] ) & &
( work_mode ! = SINK_WORK_INIT_AUX_WAIT ) & &
( work_mode ! = SINK_WORK_UNLOAD_WAIT ) & &
( work_mode ! = SINK_WORK_LOW_AUX_WAIT ) & &
( work_mode ! = SINK_WORK_HANDSHAKE_WAIT ) ) {
return 0 ;
}
switch ( work_mode ) {
case SINK_WORK_INIT :
ret = chrg_sink_work_init ( idx , pSW ) ;
break ;
case SINK_WORK_INIT_AUX_WAIT :
ret = chrg_sink_work_init_aux_wait ( idx , pSW ) ;
break ;
case SINK_WORK_WAIT :
ret = 0 ;
break ;
@@ -425,6 +703,12 @@ int chrg_sink_work(eIDX_SOU_CH idx, struct chrg_switch_t *pSW)
case SINK_WORK_LOW :
ret = chrg_sink_nor_work_low ( idx , pSW ) ;
break ;
case SINK_WORK_LOW_AUX_WAIT :
ret = chrg_sink_work_low_aux_wait ( idx , pSW ) ;
break ;
case SINK_WORK_LOW_MONITOR :
ret = 0 ;
break ;
case SINK_WORK_STOP :
ret = chrg_sink_nor_work_off ( idx , pSW ) ;
break ;
@@ -434,6 +718,24 @@ int chrg_sink_work(eIDX_SOU_CH idx, struct chrg_switch_t *pSW)
case SINK_WORK_PROTOCOL_UNLOAD :
ret = chrg_sink_work_protocol_unload ( idx , pSW ) ;
break ;
case SINK_WORK_UNLOAD_WAIT :
ret = chrg_sink_work_current_wait ( idx , pSW , RT_FALSE ) ;
break ;
case SINK_WORK_SOFT_RESUME_WAIT :
ret = 0 ;
break ;
case SINK_WORK_SOFT_RESUME :
ret = chrg_sink_work_soft_resume ( idx , pSW ) ;
break ;
case SINK_WORK_SOFT_RUNNING :
ret = 0 ;
break ;
case SINK_WORK_HANDSHAKE_PREPARE :
ret = chrg_sink_work_handshake_prepare ( idx , pSW ) ;
break ;
case SINK_WORK_HANDSHAKE_WAIT :
ret = chrg_sink_work_current_wait ( idx , pSW , RT_TRUE ) ;
break ;
default :
break ;
}