[发明专利]一种基于电流控制的移动式机器人能量控制方法

权利要求书

1、一种基于电流控制的移动式机器人能量控制方法，其硬件主要包括直流电机、超级电容器组、镍氢电池组、锂离子电池组和双向DC/DC直流变换器，它们并联于母线之上，完成功率供求转换关系，从而满足移动式机器人作业需求，其特征在于，该方法包括以下步骤：

(1)信号采集：由CAN总线总线采集蓄电池端口电压作为母线电压信号V_DC/DC；由CAN总线采集电机转速信号r_motor；由CAN总线采集机器人运动速度v_robot均传送给机器人的整机控制器；

(2)在整机控制器中，利用已知的电机转速信号r_motor和机器人运动速度v_robot，采取查表方式，计算出电机的目标转矩T_motor，公式表达式为

T_motor＝f(r_motor，v_robot)，

其中，输出量T_motor为电机的目标扭矩，输入量r_motor为电机当前转速，v_robot为机器人运动速度，f(.)表示查表用的非线性函数；

(3)在整机控制器中，计算电机需求总功率P_motor：

P_motor＝(T_motor×r_motor)/(η_{motor_ctr}×η_motor)

其中输出量P_motor为电机需求总功率，η_{motor_ctr}为电机控制效率，η_motor为电机效率

(4)在整机控制器中，计算其它辅助装置功率需求P_AUX，可以获得额外功率量值：

P_mix＝P_motor+P_AUX

其中P_mix表示包括电机需求和包括其他辅助装置功率在内功率消耗部件的总功率；

(5)在整机控制器中，计算蓄电池充放电功率，蓄电池包括镍氢电池和锂离子电池：

P_bat＝P_{max_bat}×(SOC_{lim_bat}-SOC_bat)

其中输出量P_bat为蓄电池充放电功率，P_{max_bat}为蓄电池最大充放电功率；

(6)在整机控制器中，计算超级电容器充放电功率：

P_cap＝P_{max_cap}×(SOC_{lim_cap}-SOC_cap)

其中输出量P_cap为蓄电池充放电功率，P_{max_cap}为蓄电池最大充放电功率；

(7)在整车控制器中，计算DC/DC输出功率P_DC/DC为：

P_DC/DC＝P_mix+P_bat+P_cap＝P_motor+P_AUX+P_bat+P_cap

(8)在整机控制器中，计算DC/DC输出电流I_DC/DC为：

I_DC/DC＝P_DC/DC/V_DC/DC

(9)此I_DC/DC经过一阶滤波，满足DC/DC变换器动态调节相应过程后，由整机控制器通过CAN总线通信发送给双向DC/DC控制器，实现双向DC/DC电流控制。