本发明专利技术涉及基于电流控制的移动式机器人能量控制方法，属于自动控制系统领域，其特征在于，包括ＣＡＮ总线采集母线电压信号Ｖ↓［ＤＣ／ＤＣ］、电机转速信号ｒ↓［ｍｏｔｏｒ］、机器人运动速度ｖ↓［ｒｏｂｏｔ］均传送给机器人整机控制器；在整机控制器中查取电机的目标转矩Ｔ↓［ｍｏｔｏｒ］，计算电机需求总功率Ｐ↓［ｍｏｔｏｒ］、其它辅助装置功率需求Ｐ↓［ＡＵＸ］、蓄电池充放电功率Ｐ↓［ｂａｔ］、超级电容器充放电功率Ｐ↓［ｃａｐ］；计算出双向ＤＣ／ＤＣ输出电流Ｉ↓［ＤＣ／ＤＣ］；Ｉ↓［ＤＣ／ＤＣ］经过一阶滤波，满足双向ＤＣ／ＤＣ变换器动态调节相应过程后，由整机控制器通过ＣＡＮ总线通信发送给双向ＤＣ／ＤＣ控制器，实现双向ＤＣ／ＤＣ电流控制。本发明专利技术能实现负载功率的精确控制，使移动式机器人的整机能量控制处于最佳状态，可提高动力系统的整体效率，延长机器人的工作时间。
【技术实现步骤摘要】
本专利技术提供,它适用于利用直流变换 装置进行实时能量管理的控制方法，属于自动控制
技术介绍
在国防、医疗、工业、海洋探测、航空航天、交通等诸多方面，移动机器人显示出越 来越广阔的应用前景，它己经引起了世界各国的极大关注。随着世界人口的增长，社会发 展对能源的需求也不断增加。世界能源的短缺问题，机器人的能源消耗及其能量管理成为 机器人应用领域亟待解决的问题之一。一般地，机器人的能量控制算法常使用DC/DC电压控制，其原理如下当机器人电机的输出功率小于Pmax时，DC-DC变换器输出始终恒定在某一预设电压U0;当DC-DC变换器输出功率达到对应于蓄电池最大功率点时，DC-DC变换器输出电压和电流成反比关 系，输出功率保持恒定；当功率需求继续增加，由于DC-DC变换器的电流I皿限制，输 出功率下降快速。该方法控制简单，能量在电机和蓄电池之间进行自动分配，母线恒定值限制了蓄电池的过放。此方法也包含很大的缺陷在其中动态响应时，只控制母线电压无法精确控制各部件的能量分配；由于缺乏对蓄电池内压、内阻和SOC (state of charge:电 荷容量)实时准确估计，只依靠母线电压一个量无法做到对蓄电池功率的精确控制，蓄电 池在实际运行中经常会出现过放现象，对蓄电池使用寿命造成影响。另外，目前机器人的 使用中还存在以下的问题 一是机器人的频繁启制动中，短短的几秒钟内完成启动与制动， 需要很大的功率，而蓄电池不能提供这样大的瞬时功率，而且频繁地启动对蓄电池的寿命 而言也是很大的威胁；二是机器人频繁的制动过程中，制动反馈的再生能量只能通过能耗 电阻消耗掉，没有达到能源的再生利用，电阻发热消耗再生能量既浪费了能源又增加了整 个机器人的热污染。因此，在机器人的动力系统中需要在蓄电池的基础上加入超级电容器，新的机器人整 机能量控制方法需要解决蓄电池、电机和超级电容器三者之间的能量明确分配的问题，而 本专利技术提出的直流变换器电流控制可以很好的解决这个问题。
技术实现思路
为了实现机器人内部各个模块之间实时通讯，本专利技术的目的在于针对移动式机器人， 结合能量回馈，釆用工业标准的CAN总线连接各个工作模块，给出一种基于电流控制的能4量控制方法,以实现各模块之间的实时通讯。本专利技术的能量控制方法原理如下直流电机、蓄电池和超级电容器三个能量单元，并 联在同一母线上，其中，蓄电池包括镍氢电池和锂离子电池。因此，只要确定了三个之中 的两个能量单元输入输出功率，那么整个动力系统能量流动就会确定。直流电机功率反映 机器人作业要求，可以根据机器人运动速度与电机转速通过标定MAP图得出；母线直接 接在蓄电池两端口上，其电压直接反映了蓄电池内部电压大小，因为蓄电池输出功率由蓄 电池的放电电流决定；超级电容器的输入、输出功率由超级电容器的充、放电电流决定。 综上，可以考虑在蓄电池和直流电机之间并联一个直流电力变换装置(双向DC/DC变换 器)，由它来控制母线上蓄电池侧输出电压或电流大小。电机功率Pm。t。r、双向直流变换器DC/DC功率PDC/DC和蓄电池功率Pbat之间供求关系如下Pmotor=PDC/DC+Pbat其中电机功率Pm。t。r可通过査表方法确定，只有确定PDC/DC量值，那么根据此关系式，即 可确定蓄电池输入输出功率Pbat，同时由于这三者并联于母线上，电压相等，则功率关系 可以转换为电流供求关系-Imotor=lDC/DC+Ibat因此，本方法的核心是确定双向DC/DC的输出电流bc/Dc目标值，即可确定整个机器人动 力系统的功率分配问题。也就是说，本专利技术能让整机控制器在限定的釆样间隔(50ms) 内，根据CAN总线传递的各部件状态信号，求解出明确的能量控制数值，并最终发送给 执行部件DC/DC变换器实现能量控制。本专利技术的技术方案如下 本专利技术提供，其硬件主要包括直流电 机、超级电容器、镍氢电池、锂离子电池和双向DC/DC直流变换器，它们并联于母线之 上，完成功率供求转换关系，从而满足移动式机器人作业需求，其特征在于，该方法包括以下步骤(1) 信号采集由CAN总线总线采集蓄电池端口电压作为母线电压信号VDC/DC;由CAN 总线采集电机转速信号rm。t。r;由CAN总线釆集机器人运动速度Vr。b。t均传送给机器人的整机 控制器；(2) 在整机控制器中，利用已知的电机转速信号rm。t。r和机器人运动速度Vr。b。t，釆取查表方式，计算出电机的目标转矩Tm。t。r，公式表达式为Tmoto厂f(i"motor， vrobot),其中，输出量T咖t。r为电机的目标扭矩，输入量r咖t。r为电机当前转速，Vr。b。t为机器人运动速 度，f(.)表示査表用的非线性函数；(3)在整机控制器中，计算电机需求总功率Pm。to:其中输出量Pm。t。r为电机需求总功率，为电机控制效率，7自。,为电机效率(4) 在整机控制器中,计算其它辅助装置功率需求PAUX,可以获得额外功率量值Pmix=Pmotor+PAUX其中Pmix表示包括电机需求和包括其他辅助装置功率在内功率消耗部件的总功率；(5) 在整机控制器中,计算蓄电池充放电功率，蓄电池包括镍氢电池和锂离子电池Pba尸Pmax一bat X (SOCim_barSOCbat) 其中输出量Pbat为蓄电池充放电功率,PmaxJnrt为蓄电池最大充放电功率；(6) 在整机控制器中，计算超级电容器充放电功率Pcap—Pmax一cap X (SOCiim_cap-SOCCap) 其中输出量Pcap为蓄电池充放电功率,Pmax^p为蓄电池最大充放电功率；:(7)在整车控制器中,计算DC/DC输出功率PDc/Dc为(8) 在整机控制器中,计算DC/DC输出电流lDc/Dc为 Idc/dc=Pdc/dc/Vdc/dc(9) 此Idc/dc经过一阶滤波,满足DC/DC变换器动态调节相应过程后，由整机控制器通 过CAN总线通信发送给双向DC/DC控制器,实现双向DC/DC电流控制。本专利技术控制原理如下1. 动力系统总线电压由蓄电池决定；2. 电机驱动为电流源，即动力系统的负载表现为电流模式；3. 通过控制DC/DC输出端的电流来控制蓄电池的输出功率；4. 蓄电池的充电放电电流为DC/DC输出端的电流和电机驱动器电流之和，其功率控 制是明确的；5. 因此动力系统中总线电压和各支路电流是完全可控的。; 本方法考虑超级电容器SOC状态和电机功率需求，实现能量反馈环节当直流电机处 于耗能状态时，直流电机消耗电能，引起总线电压下降，双向DC/DC变换器端电压下降，超级电容器组放电，实现超级电容器与蓄电池的联合启动直流电机。现在考虑直流电机制 动或者减速时的能量回馈问题。再生能量的储存和利用主要是通过储能装置，即超级电容 器组和双向DC/DC变换器组成，当直流电机转速下降或者制动时，处于能量再生状态， 工作电机反转将再生能量转换成电能引起总线电压升高，总线电压升高引起双向DC/DC 变换器端电压上升，从而对超级电容器组充电，达到能量的回馈。那么总的来说，直流电 机启动过程中，超级电容器组也为直流电机放电，可以有效地减小直流电机启动过程中加 速给蓄电池造成的大电流的冲击，在能量回馈的过程中，又可以有效地将直流电机减少的 动能回馈到本文档来自技高网...
【技术保护点】
一种基于电流控制的移动式机器人能量控制方法，其硬件主要包括直流电机、超级电容器组、镍氢电池组、锂离子电池组和双向ＤＣ／ＤＣ直流变换器，它们并联于母线之上，完成功率供求转换关系，从而满足移动式机器人作业需求，其特征在于，该方法包括以下步骤： （１）信号采集：由ＣＡＮ总线总线采集蓄电池端口电压作为母线电压信号Ｖ↓［ＤＣ／ＤＣ］；由ＣＡＮ总线采集电机转速信号ｒ↓［ｍｏｔｏｒ］；由ＣＡＮ总线采集机器人运动速度ｖ↓［ｒｏｂｏｔ］均传送给机器人的整机控制器； （２）在整机控制 器中，利用已知的电机转速信号ｒ↓［ｍｏｔｏｒ］和机器人运动速度ｖ↓［ｒｏｂｏｔ］，采取查表方式，计算出电机的目标转矩Ｔ↓［ｍｏｔｏｒ］，公式表达式为 Ｔ↓［ｍｏｔｏｒ］＝ｆ（ｒ↓［ｍｏｔｏｒ］，ｖ↓［ｒｏｂｏｔ］）， 其中，输出 量Ｔ↓［ｍｏｔｏｒ］为电机的目标扭矩，输入量ｒ↓［ｍｏｔｏｒ］为电机当前转速，ｖ↓［ｒｏｂｏｔ］为机器人运动速度，ｆ（．）表示查表用的非线性函数； （３）在整机控制器中，计算电机需求总功率Ｐ↓［ｍｏｔｏｒ］： Ｐ↓［ｍｏｔｏｒ］ ＝（Ｔ↓［ｍｏｔｏｒ］×ｒ↓［ｍｏｔｏｒ］）／（η↓［ｍｏｔｏｒ＿ｃｔｒ］×↓［ηｍｏｔｏｒ］） 其中输出量Ｐ↓［ｍｏｔｏｒ］为电机需求总功率，η↓［ｍｏｔｏｒ＿ｃｔｒ］为电机控制效率，η↓［ｍｏｔｏｒ］为电机效率 （４）在整机 控制器中，计算其它辅助装置功率需求Ｐ↓［ＡＵＸ］，可以获得额外功率量值： Ｐ↓［ｍｉｘ］＝Ｐ↓［ｍｏｔｏｒ］＋Ｐ↓［ＡＵＸ］ 其中Ｐｍｉｘ表示包括电机需求和包括其他辅助装置功率在内功率消耗部件的总功率； （５）在整机控制器 中，计算蓄电池充放电功率，蓄电池包括镍氢电池和锂离子电池： Ｐ↓［ｂａｔ］＝Ｐ↓［ｍａｘ＿ｂａｔ］×（ＳＯＣ↓［ｌｉｍ＿ｂａｔ］－ＳＯＣ↓［ｂａｔ］） 其中输出量Ｐ↓［ｂａｔ］为蓄电池充放电功率，Ｐ↓［ｍａｘ＿ｂａｔ］为蓄电池最 大充放电功率； （６）在整机控制器中，计算超级电容器充放电功率： Ｐ↓［ｃａｐ］＝Ｐ↓［ｍａｘ＿ｃａｐ］×（ＳＯＣ↓［ｌｉｍ＿ｃａｐ］－ＳＯＣ↓［ｃａｐ］） 其中输出量Ｐ↓［ｃａｐ］为蓄电池充放电功率，Ｐ↓［ｍａｘ＿ｃａｐ ］为蓄电池最大充放电功率； （７）在整车控制器中，计算ＤＣ／ＤＣ输出功率Ｐ↓［ＤＣ／ＤＣ］为： Ｐ↓［ＤＣ／ＤＣ］＝Ｐ↓［ｍｉ...
【技术特征摘要】
【专利技术属性】
技术研发人员：黄姣英，袁海文，王秋生，崔勇，
申请(专利权)人：北京航空航天大学，
类型：发明
国别省市：11[中国|北京]
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。