一种自供能机械臂能量、运动以及驱动三层协同控制系统的制作方法

摘要: 本发明涉及机器人控制系统,具体是指一种自供能机械臂能量、运动以及驱动三层协同控制系统。背景技术:1、无缆自供能机械臂为摆脱线缆供电束缚,普遍采用关节分布式独立电...
一种自供能机械臂能量、运动以及驱动三层协同控制系统的制作方法

本发明涉及机器人控制系统,具体是指一种自供能机械臂能量、运动以及驱动三层协同控制系统。

背景技术:

1、无缆自供能机械臂为摆脱线缆供电束缚,普遍采用关节分布式独立电池包供电架构,每个驱动关节匹配独立储能单元,解决传统整机单电池难以支撑关节瞬时峰值功率输出、线缆拖拽限制作业空间的缺陷。当前行业主流机械臂控制架构仅包含运动规划层+电机驱动层两层控制结构:上位运动规划器基于作业任务、运动学约束生成关节位置、速度、力矩轨迹指令,下发至底层驱动器执行闭环力矩/位置控制。

2、现有两层架构核心缺陷如下:

3、运动规划模块仅依据机械臂运动学、动力学极限规划轨迹,未实时采集各关节电池soc、瞬时峰值功率、持续放电功率裕度。当机械臂执行重载、高速、大角度转向动作时,规划输出的力矩/速度指令超出局部电池放电能力,驱动器强行拉取超大放电电流,引发电池瞬时过流、电压骤降。

4、底层驱动器仅执行力矩闭环,仅本地触发过流保护停机,无法将实时功率超限、电池功率裕度不足的状态向上传递至运动规划层;运动层无法动态修正轨迹,仅能被动接收驱动器故障停机信号,作业中断、设备可靠性低。

5、现有方案无能量、运动、驱动三层联动协调逻辑,功率超限后仅单一硬保护停机,无梯度降载缓冲策略;无法区分轻微功率过载与深度电池亏电场景,轻微过载直接停机,大幅降低机械臂连续作业效率。

6、多关节机械臂各关节电池soc、放电裕度差异化明显,两层架构无法统筹全部关节储能状态分配功率预算;搭载球形三维力矩电机的多自由度关节,三轴耦合力矩功率消耗难以协同管控,易出现单关节电池提前过放、整机作业时长不均衡。

7、电池soc随放电持续下降,可用功率持续衰减,现有控制系统无法随电池剩余电量动态收缩运动允许极限;低电量阶段仍输出高速、重载轨迹,加速电池深度过放,损伤电池循环寿命,存在热失控安全隐患。

8、两层分离式控制架构割裂能量管理与运动控制逻辑,能量状态无法前置约束运动规划,功率异常无法反向修正运动指令,缺少梯度降载、三层闭环协调机制,存在电池过放、突发停机、能量利用率低、电池寿命衰减快、多自由度球形电机功率耦合失控等系列技术缺陷。因此,亟需构建集成能量管理、运动规划、电机驱动的三层递阶协同闭环控制系统,实现储能状态、运动轨迹、电机驱动的全局联合优化。

技术实现思路

1、本发明要解决的技术问题是提供一种自供能机械臂能量、运动以及驱动三层协同控制系统,增设独立能量管理层构建三层递阶控制架构,配套跨层通信总线与跨层协调模块,实现自上而下能量约束、自下而上功率反馈的双层闭环;设计分级梯度降载策略,适配常规伺服电机与球形三维力矩电机两类驱动单元,在保障机械臂作业运动性能的前提下,动态约束关节功率输出,杜绝电池过放,提升系统续航、作业稳定性与储能单元使用安全性。

2、为解决上述技术问题,本发明提供的技术方案为:一种自供能机械臂能量、运动以及驱动三层协同控制系统,包括能量管理层、运动规划层、电机驱动层、跨层通信总线、跨层协调模块;

3、所述能量管理层与运动规划层通过第一通信接口连接,所述运动规划层与电机驱动层通过第二通信接口连接;所述跨层通信总线分别电性连接能量管理层、运动规划层、电机驱动层;所述跨层协调模块同时与能量管理层、运动规划层、电机驱动层信号交互;

4、所述能量管理层用于实时采集各关节局部电池包soc与放电参数,计算电池可用功率裕度,并转化输出各关节运动许可边界作为运动约束;

5、所述运动规划层用于在能量管理层下发的运动许可边界约束下优化机械臂运动轨迹与各关节力矩分配,并接收驱动层功率超限信号执行分级降载;

6、所述电机驱动层包括力矩控制执行模块、功率实时监测模块、超限反馈模块,用于执行运动层下发的力矩指令驱动关节电机,实时采集电机实际功耗,功率超限时向上发送超限反馈信号;

7、所述跨层协调模块用于捕获电机驱动层上传的功率超限信号,逐级触发运动规划层分级降载,降载无效时驱动能量管理层收紧运动许可边界,形成三层闭环协同调节。

8、进一步地,所述能量管理层包括soc估算模块、功率裕度计算模块、运动许可边界输出模块;

9、所述soc估算模块融合安时积分、开路电压校正、卡尔曼滤波算法计算各关节电池实时荷电状态soc,同步采集电芯温度、内阻、单体压差;所述功率裕度计算模块内置电池动态放电特性模型,输入soc与温度参数求解电池持续放电功率、瞬时峰值放电功率,并引入温度修正系数动态衰减功率裕度;所述运动许可边界输出模块将功率裕度映射为各关节最大允许角速度、最大持续力矩、瞬时峰值力矩,随soc与温度变化动态更新边界并下发至运动规划层。

10、进一步地,所述运动规划层包括轨迹优化模块、力矩分配优化模块、降载策略模块;

11、所述轨迹优化模块以末端作业位姿为目标,以运动许可边界为不等式约束,采用多项式插值算法生成平滑低功耗轨迹;所述力矩分配优化模块区分常规单轴伺服电机、球形三维力矩电机两类驱动单元,单轴电机均衡多关节瞬时功率,球形电机构建三轴耦合动力学模型在三维力矩空间内求解最优力矩分配解;所述降载策略模块内置三级梯度降载单元,分级执行过载调节。

12、进一步地,所述三级梯度降载单元具体包括:

13、一级降载单元,仅缩放关节轨迹运行速度,维持力矩输出不变;

14、二级降载单元,一级降载后功率仍超限,则下调关节峰值力矩上限,重新优化力矩分配;

15、三级降载单元,前两级降载后功耗仍超出电池裕度,则向能量管理层发送边界收紧申请,由能量管理层重新计算收缩后的功率约束边界。

16、进一步地,所述电机驱动层包括力矩控制执行模块、功率实时监测模块、超限反馈模块;

17、所述力矩控制执行模块接收力矩指令输出pwm驱动信号,针对球形电机完成三维耦合力矩至绕组电流的解耦分配;所述功率实时监测模块逐毫秒采集电机母线电压、放电电流,区分稳态持续功率与瞬时峰值功率;所述超限反馈模块将实时功耗与电池功率裕度对比,功率超限后生成携带超限关节编号、超功率幅值的反馈报文,通过跨层通信总线上传至运动规划层。

18、进一步地,所述跨层协调模块的协调流程包括:

19、s1:电机驱动层功率实时监测模块采集实时功耗,超限反馈模块判定功率超出电池功率裕度;

20、s2:超限反馈模块通过跨层通信总线向运动规划层发送超限反馈信号;

21、s3:跨层协调模块捕获超限信号,触发运动规划层降载策略模块启动分级降载;

22、s4:降载单元更新轨迹与力矩指令下发至电机驱动层执行;

23、s5:驱动层持续监测降载后功耗,功耗回落至裕度内则稳定运行;

24、s6:两级降载后功率依旧超限,跨层协调模块向能量管理层发送边界收紧请求;

25、s7:能量管理层基于当前soc、温度重新计算紧缩功率裕度,更新运动许可边界下发至运动规划层;

26、s8:运动规划层基于新边界全局重规划轨迹与力矩分配,完成三层闭环调节。

27、进一步地,所述能量管理层统筹全部关节局部电池包功率预算,当各关节电池soc不均衡时,所述功率裕度计算模块构建整机功率分配矩阵,对高soc关节分配更高功率预算,所述力矩分配优化模块将重载动作优先分配至储能充足关节,均衡各电池包放电深度。

28、本发明与现有技术相比的优点在于:

29、(1)三层递阶控制架构将能量层纳入控制闭环,使运动规划始终在电池功率约束内进行,避免规划出不可执行的运动指令;

30、(2)跨层功率-力矩实时协调机制能够在驱动层功率超限时快速响应,通过运动层主动降载避免电池过放,提高系统安全性;

31、(3)自上而下的逐层约束和自下而上的逐层反馈形成闭环,使系统能够自适应电池状态变化,实现全局最优运行;

32、(4)分级降载策略提供从轻微到深度的多级保护,兼顾运动性能和电池安全。