一种单侧电机失效后的容错控制方法及轮式机器人与流程
本发明属于机器人、智能控制、智能制造装备产业工业机器人、特殊作业机器人、服务消费机器人领域、高端装备制造产业生产领域人工智能系统、智能家居系统等信息系统集成服务领域,特别涉及轮式机器人的单侧电机失效后的容错控制方法。
背景技术:
1、轮式机器人属于过驱动系统(执行器数>控制自由度),天然具备硬件冗余基础,在正常情况,电机可以具有“自由态”(指的是电机驱动电路关断、绕组悬空,无驱动电流也无短路制动,转子可在外力作用下自由旋转的状态,可实现差速转向、惯性滑行与随动)和“制动抱死态”(指的是电机抱闸或驻车制动器锁死时,车轮被机械强制固定,完全不能转动)。
2、当出现单侧电机断电故障时,有可能存在以下两种失效状态:
3、“自由态失效”,表示电机接收驱动控制指令后,无法输出有效驱动扭矩,动力传递链路中断;负载端脱离电机力矩约束,不再被电机转速强制同步控制,可在惯性、路面外力作用下自由转动,电机仅处于近乎空载运转状态,丧失驱动承载能力。
4、电机制动抱死态失效:电机及配套传动、车轮机构发生机械卡滞、卡死堵转,控制系统下发运转指令,但电机轴 / 车轮完全无法正常转动,处于锁死静止 / 近乎静止状态,电机通电后强行憋力堵转,属于机械卡死类驱动失效。
5、单侧电机(左/右某一轮或同侧多轮)失效会导致:驱动力/力矩不平衡、横摆不稳定、跑偏、侧滑、轨迹跟踪失效等问题;因此,单侧电机失效容错控制是提升机器人安全性、连续作业能力的关键技术。
6、现有的容错控制技术中,存在以下缺陷:
7、第一、依赖预设故障模型或阈值判断,对单侧电机突发失效的响应速度慢,易出现误判或漏判,无法满足实时控制需求,且控制处理方式单一;
8、第二、控制策略适配性不足,未充分考虑单侧电机失效后系统动力学特性的非线性变化,难以兼顾轨迹跟踪精度和运动稳定性;
9、第三、现有基于模型的容错控制方法需要已知机器人完整动力学参数(如质量、转动惯量、轮距等),但实际应用中参数易受负载变化、环境干扰影响,导致控制效果下降;
10、第四、没有执行反馈机制,缺少闭环;
11、为了解决以上问题,申请人提出了本发明的单侧电机失效后的容错控制方法及轮式机器人方案。
技术实现思路
1、本发明的目的是针对上述现有技术的不足,提供单侧电机失效后的容错控制方法及轮式机器人,用于在轮式机器人出现单侧故障时,先识别失效类型,根据不同的失效类型选择不同的容错控制策略,从而实现快速识别与区分,既满足实时控制以及差异化控制的需求,又能通过不同策略提升跟踪精度。
2、为解决上述技术问题,本发明实施例提供的一种单侧电机失效后的容错控制方法,包括:通过多源传感器实时采集行驶数据;根据所述行驶数据诊断单侧电机的失效类型;根据所述失效类型,进行容错控制策略的重构;执行所述重构后的容错控制策略对应的控制指令。
3、进一步的,在本发明一个优选的实施例下,所述采集的行驶数据包括左右轮的转速,所述根据行驶数据诊断单侧电机的失效类型具体包括:计算左右轮转速差绝对值,同时获取左右电机的电流值;如果所述转速差绝对值大于或等于第一阈值,且左电机电流值小于或等于第二阈值,则诊断失效类型为左电机自由态失效;如果所述转速差绝对值大于或等于第一阈值,且右电机电流值小于或等于第二阈值,则诊断失效类型为右电机自由态失效;如果所述左轮速度小于或等于第三阈值,且左电机电流值大于或等于第四阈值,则诊断失效类型为左电机制动抱死态失效;如果所述右轮速度小于或等于第三阈值,且右电机电流值大于或等于第四阈值,则诊断失效类型为右电机制动抱死态失效;以上均不符合,则诊断为无失效。
4、进一步,在本发明一个优选的实施例下,所述采集的行驶数据还包括车身的偏航角,所述根据所述失效类型,进行容错控制策略的重构具体包括:如果所述失效类型为左电机自由态失效或者右电机自由态失效,采用动力补偿与跑偏抑制算法,计算为克服该失效状态,未失效一侧电机需要的转矩值;如果所述失效类型为左电机制动抱死态失效或者右电机制动抱死态失效,采用负载均衡与阻力适配算法,计算为克服该失效状态,未失效一侧电机需要的转矩值;根据所述车身的偏航角,通过轨迹补偿算法,计算为克服该偏航状态,偏航反向侧的电机需要的转速值;
5、任选地,所述动力补偿与跑偏抑制算法包括:若右电机自由态失效,则左侧电机需要输出的转矩是:;若左电机自由态失效,则右侧电机需要输出的转矩是:;
6、其中,为右电机自由态失效时,为克服该失效状态,左侧电机需要输出的转矩;为左电机自由态失效时,为克服该失效状态,右侧电机需要输出的转矩;为跑偏修正系数,选自0.5~1之间的任意有理数;为轮式驱动需求总转矩;为正常情况左侧电机的转矩;为正常情况右侧电机的转矩;
7、任选地,所述负载均衡与阻力适配算法包括:
8、若右电机制动抱死态失效,则左侧电机需要输出的扭矩为:;若左电机制动抱死态失效,则右侧电机需要输出的扭矩为:;以及,,;
9、其中,为右电机抱死失效时,为克服该失效状态,左侧电机需要输出的转矩;为左电机抱死失效时,为克服该失效状态,右侧电机需要输出的转矩;为轮式驱动需求总转矩,为正常情况左侧电机的转矩,为正常情况右侧电机的转矩;β为阻力适配补偿系数,为单侧电机抱死产生的恒定拖拽阻力矩,为抱死侧车轮整体拖拽阻力,r为驱动轮有效滚动半径,g为单侧车轮承载垂直载荷,f为路面滚动阻力系数,为制动异常抱死产生的附加卡滞阻力;
10、任选地,所述轨迹补偿算法的计算公式包括:
11、;
12、;
13、其中,是为克服该偏航状态,偏航反向侧的电机所需要的转速值;是偏航反向侧的电机原始期望转速;是为克服该偏航状态,偏航反向侧的电机转速所需要的提升值;是根据实验经验值预置的转换系数,是所述车身的偏航角。
14、进一步,在本发明一个优选的实施例下,所述诊断结果为无失效,所述方法还包括,按照以下常规控制逻辑输出无失效控制指令:直行时左右轮转速均为目标转速,左右电机均分驱动需求转矩;转向时根据目标转向角计算转速差绝对值;执行所述无失效控制指令。
15、进一步,在本发明一个优选的实施例下,所述容错控制方法还包括:计算实际位置与目标位置之间的偏差绝对值;当所述偏差绝对值达到0.08m时,计算补偿参数;根据补偿参数调整有效侧电机转速,以便将所述偏差控制在预设范围内;任选地,所述补偿参数的计算公式为:;其中,是实时采集得到的实际位置,是预设规划路径上的目标位置;是位置偏差-转速转换修正系数,为预置的实验经验值;是位置偏差对应的电机转速补偿参数。
16、本发明还提供一种轮式机器人,包括:多源传感器,用于实时采集机器人的行驶数据;故障诊断模块,用于根据所述行驶数据诊断单侧电机的失效类型;控制重构模块,用于根据所述失效类型,进行容错控制策略的重构;指令执行模块,用于执行所述重构后的容错控制策略对应的控制指令。
17、进一步,在本发明一个优选的实施例下,所述多源传感器采集的行驶数据包括左右轮的转速;所述故障诊断模块包括:计算单元,电流获取单元,诊断单元;所述计算单元,用于计算左右轮转速差绝对值;所述电流获取单元,用于获取左右电机的电流值;所述诊断单元,用于获取所述左右轮转速差绝对值及左右电机的电流值,如果所述转速差绝对值大于或等于第一阈值,且左电机电流值小于或等于第二阈值,则诊断失效类型为左电机自由态失效;如果所述转速差绝对值大于或等于第一阈值,且右电机电流值小于或等于第二阈值,则诊断失效类型为右电机自由态失效;如果所述左轮速度小于或等于第三阈值,且左电机电流值大于或等于第四阈值,则诊断失效类型为左电机制动抱死态失效;如果所述右轮速度小于或等于第三阈值,且右电机电流值大于或等于第四阈值,则诊断失效类型为右电机制动抱死态失效;以上均不符合,则诊断为无失效。
18、进一步,在本发明一个优选的实施例下,所述多源传感器采集的行驶数据还包括车身的偏航角;所述控制重构模块包括电机转矩补偿计算单元,电机转速补偿计算单元;所述电机转矩补偿计算单元,用于当所述失效类型为左电机自由态失效或者右电机自由态失效时,采用动力补偿与跑偏抑制算法,计算未失效一侧电机需要的转矩值;所述电机转速补偿计算单元,用于当所述失效类型为左电机制动抱死态失效或者右电机制动抱死态失效,采用负载均衡与阻力适配算法,计算未失效一侧电机需要的转矩值;所述电机转速补偿计算单元,还用于根据所述车身的偏航角,通过轨迹补偿算法,计算偏航方向侧电机转速值;任选地,所述动力补偿与跑偏抑制算法包括:若右电机自由态失效,则左侧电机需要输出的转矩是:;若左电机自由态失效,则右侧电机需要输出的转矩是:;
19、其中,
20、为右电机自由态失效时,左侧电机需要输出的转矩;
21、为左电机自由态失效时,右侧电机需要输出的转矩;
22、为跑偏修正系数,选自0.5~1之间的任意有理数;
23、为轮式驱动需求总转矩;
24、为正常情况左侧电机的转矩;
25、为正常情况右侧电机的转矩;
26、任选地,所述负载均衡与阻力适配算法包括:
27、若右电机制动抱死态失效,则左侧电机需要输出的扭矩为:若左电机制动抱死态失效,则右侧电机需要输出的扭矩为:;以及,,;
28、其中,
29、为右电机抱死失效时,为克服该失效状态,左侧电机需要输出的转矩;为左电机抱死失效时,为克服该失效状态,右侧电机需要输出的转矩;为轮式驱动需求总转矩,为正常情况左侧电机的转矩,为正常情况右侧电机的转矩;β为阻力适配补偿系数,为单侧电机抱死产生的恒定拖拽阻力矩,为抱死侧车轮整体拖拽阻力,r为驱动轮有效滚动半径,g为单侧车轮承载垂直载荷,f为路面滚动阻力系数,为制动异常抱死产生的附加卡滞阻力;
30、任选地,所述轨迹补偿算法的计算公式包括:
31、;
32、;
33、其中,是为克服该偏航状态,偏航反向侧的电机所需要的转速值;是偏航反向侧的电机原始期望转速;是为克服该偏航状态,偏航反向侧的电机转速所需要的提升值;是根据实验经验值预置的转换系数,是所述车身的偏航角。
34、进一步,在本发明一个优选的实施例下,所述轮式机器人还包括无失效控制指令生成单元,用于所述诊断单元的诊断结果是无失效时,按照以下常规控制逻辑输出无失效控制指令:直行时左右轮转速均为目标转速,转向时根据目标转向角计算转速差绝对值;所述指令执行模块还用于执行所述无失效控制指令。
35、进一步,在本发明一个优选的实施例下,所述轮式机器人还包括反馈校正模块,用于:计算实际位置与目标位置之间的偏差绝对值;当所述偏差绝对值达到0.08m时,计算补偿参数;根据补偿参数调整有效侧电机转速,以便将所述偏差控制在预设范围内;任选地,所述补偿参数的计算公式为:;
36、其中,是实时采集得到的实际位置,是预设规划路径上的目标位置;是位置偏差-转速转换修正系数,为预置的实验经验值;是位置偏差对应的电机转速补偿参数。
37、与现有技术相比,本发明实施例提供的单侧电机失效后的容错控制方法及轮式机器人,由于先通过传感器采集行驶数据,根据行驶数据诊断出单侧电机的失效类型,根据不同的失效类型选择不同的容错控制策略,具有以下有益效果:
38、1)、对不同的失效状态(即失效类型)快速精准的诊断,解决故障误判、漏判及响应滞后痛点。
39、2)、针对“自由态失效”和“制动抱死态失效”设计了不同的容错控制策略,满足了差异化控制的需求。
40、3)、针对“自由态失效”采用动力补偿与跑偏抑制算法,针对“制动抱死态失效”采用负载均衡与阻力适配算法,适配不同工况下的系统特性变化,兼顾精度与稳定性。
41、4)引入了反馈矫正模块这种低成本闭环集成系统设计,构建 “诊断 - 重构 - 反馈” 一体化闭环系统,简化结构、降低成本,同时减少故障点,提升系统可靠性与工程化部署能力。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com