一种爬壁机器人协同转向控制方法和系统
本发明涉及机器人,尤其涉及一种爬壁机器人协同转向控制方法和系统。
背景技术:
1、磁吸附爬壁机器人可依靠永磁吸附单元在船舶外板、储罐、桥梁钢结构等铁磁性壁面上行走,并搭载除锈、检测或清洗装置完成高空作业。常见机器人采用左、右驱动轮独立调速,并利用两侧轮速差实现转向。为了保证机器人不从壁面滑落,机器人底部通常设置较大的磁吸附力。在机器人转向过程中,吸附力会改变轮组法向载荷,并进一步影响轮胎滚动变形、侧向擦滑以及磁吸附单元相对壁面运动产生的等效阻力。若为降低阻力而统一减小全部磁吸附单元的吸附力,则会削弱转向外侧的贴壁保持能力,增加外侧翘起或横滚失稳风险。
2、当前的转向控制策略往往是根据气隙、载荷或姿态风险重新计算各分区吸附力,或只计算左右轮速度。两类控制相互独立,容易出现差速驱动已经启动而内侧吸附力尚未降低,或者转向完成后吸附状态恢复顺序不明确的问题,且存在转向横滚或外侧翘起的风险。
技术实现思路
1、有鉴于此,本发明提出了一种爬壁机器人协同转向控制方法和系统。
2、本发明的技术方案是这样实现的:本发明第一方面提供了一种爬壁机器人协同转向控制方法,包括:
3、在目标转向参数符合预设转向条件的情况下,获取待转向机器人两侧驱动轮的目标转向速度和满足吸附约束的内外侧吸附力转移量区间;所述目标转向参数包括目标转向方向、目标转向半径、几何中心速度和目标转向角度;所述吸附约束包括侧向吸附约束和稳定力矩约束;
4、基于所述内外侧吸附力转移区间和基准吸附力确定多组候选吸附力,以预设比例将所述目标转向速度进行缩放处理,得到试探转向速度,并在所述试探转向速度下,以多组所述候选吸附力进行转向试探模拟,结合电流约束、滑移率约束和横滚角约束,获取每次转向试探模拟对应的双侧电流评价量;所述基准吸附力为所述待转向机器人行走状态下的整机最低安全吸附力,所述双侧电流评价量与内外侧电机电流相关;
5、将最小的所述双侧电流评价量对应的候选吸附力确定为目标吸附力,并基于所述目标吸附力对应的内外侧吸附力转移量和转移方向控制所述待转向机器人完成转向。
6、在以上技术方案的基础上,优选的,所述获取待转向机器人两侧驱动轮的目标转向速度和满足吸附约束的内外侧吸附力转移量区间,包括:
7、基于所述待转向机器人的几何中心速度、目标转向半径和两侧驱动轮轮距,确定目标转向速度;
8、将同时满足转向内侧所有分区吸附力之和不低于内侧合计下限、转向外侧所有分区吸附力之和不低于外侧合计下限、吸附力产生的残余抗横滚回复力矩大于扰动倾覆力矩与安全系数的乘积的最大吸附力确定为内外侧吸附力转移量区间的区间上限。
9、在以上技术方案的基础上,优选的,所述基于所述内外侧吸附力转移区间和基准吸附力确定多组候选吸附力,包括:
10、从所述内外侧吸附力转移区间获取多组吸附力转移量,并将每组所述吸附力转移量的一半分配给内侧的基准吸附力,另一半分配给外侧的基准吸附力,得到多组候选吸附力;其中,内侧和外侧的基准吸附力对应的调整方向相反。
11、在以上技术方案的基础上,优选的,所述在所述试探转向速度下,分别以所述基准吸附力和多组所述候选吸附力进行转向试探模拟,结合电流约束、滑移率约束和横滚角约束,获取每次转向试探模拟对应的双侧电流评价量,包括:
12、在所述试探转向速度下,分别以所述基准吸附力和多组所述候选吸附力进行转向试探模拟,获取同时满足内外侧电机电流不能超过最大允许试探电流、整体滑移率小于第一停车阈值、外侧横滚角小于第二停车阈值的各组吸附力对应的双侧电流评价量。
13、在以上技术方案的基础上,优选的,所述获取每次转向试探模拟对应的双侧电流评价量,包括:
14、对所述内外侧电机电流进行归一化处理后,将内侧电机电流和外侧电机电流之和作为第一评价指标,将内侧电机电流和外侧电机电流之差作为第二评价指标;
15、对所述第一评价指标和所述第二评价指标进行自适应加权处理,得到双侧电流评价量。
16、在以上技术方案的基础上,优选的,所述将最小的所述双侧电流评价量对应的候选吸附力确定为目标吸附力,还包括:
17、在所述试探转向速度下,以所述基准吸附力进行转向试探模拟,结合电流约束、滑移率约束和横滚角约束,获取转向试探模拟对应的基准电流评价量;
18、若最小的所述双侧电流评价量与所述基准电流评价量的差值大于最小改善阈值,将最小的所述双侧电流评价量对应的候选吸附力确定为目标吸附力。
19、在以上技术方案的基础上,优选的,在基于所述目标吸附力对应的内外侧吸附力转移量和转移方向控制所述待转向机器人完成转向之后,还包括:
20、实时获取目标吸附力下的双侧电流评价量;
21、若所述双侧电流评价量在多个周期内持续大于预设评价阈值,将所述目标吸附力切换至基准吸附力。
22、更进一步优选的,本发明第二方面提供了一种爬壁机器人协同转向控制系统,包括:区间获取模块,评价获取模块和转向控制模块;其中,
23、所述区间获取模块,配置为在目标转向参数符合预设转向条件的情况下,获取待转向机器人两侧驱动轮的目标转向速度和满足吸附约束的内外侧吸附力转移量区间;所述目标转向参数包括目标转向方向、目标转向半径、几何中心速度和目标转向角度;所述吸附约束包括侧向吸附约束和稳定力矩约束;
24、所述评价获取模块,配置为基于所述内外侧吸附力转移区间和基准吸附力确定多组候选吸附力,以预设比例将所述目标转向速度进行缩放处理,得到试探转向速度,并在所述试探转向速度下,以多组所述候选吸附力进行转向试探模拟,结合电流约束、滑移率约束和横滚角约束,获取每次转向试探模拟对应的双侧电流评价量;所述基准吸附力为所述待转向机器人行走状态下的整机最低安全吸附力,所述双侧电流评价量与内外侧电机电流相关;
25、所述转向控制模块,配置为将最小的所述双侧电流评价量对应的候选吸附力确定为目标吸附力,并基于所述目标吸附力对应的内外侧吸附力转移量和转移方向控制所述待转向机器人完成转向。
26、更进一步优选的,本发明第三方面提供了一种电子设备,包括处理器和存储器;所述存储器存储有计算机程序,其中,所述计算机程序在被所述处理器执行时实现第一方面所述的爬壁机器人协同转向控制方法。
27、更进一步优选的,本发明第四方面提供了一种非暂态计算机可读存储介质,其上存储有计算机程序,其中,所述计算机程序被处理器执行时实现第一方面所述的爬壁机器人协同转向控制方法。
28、本发明的一种爬壁机器人协同转向控制方法和系统相对于现有技术具有以下有益效果:
29、1、通过基于目标转向参数同步求解驱动轮的目标转向速度、吸附力转移量区间,并叠加侧向吸附约束、稳定力矩约束的静态校核,再通过试探模拟的电流、滑移率、横滚角约束校验后,输出目标吸附力用于正式转向。建立先完成吸附力候选筛选校验,再执行正式转向驱动的隐含门控逻辑,避免差速驱动先行启动但吸附力尚未调节到位的缺陷,且侧向吸附约束保障转向内外侧整体吸附下限,稳定力矩约束保障抗倾覆裕度,从源头上降低了转向过程横滚、外侧翘起的失稳风险。
30、2、通过复用机器人行走状态确定的整机最低安全基准吸附力,结合内外侧吸附力转移量区间,确定多组候选吸附力,在满足侧向吸附、稳定力矩等安全约束前提下生成候选集合,兼顾了转向工况安全性与嵌入式控制器的计算效率,减少了算法部署的硬件算力依赖。
31、3、通过对多组候选吸附力采用同一缩放后的试探转向速度开展试探模拟,结合电流、滑移率、横滚角多重约束过滤不安全候选,以与内外侧电机电流强相关的双侧电流评价量作为择优依据,筛选得到综合驱动负载最优的目标吸附力,可适配实际工况、装配误差带来的转向阻力差异,避免仅依靠理论预设吸附转移量带来的负载不匹配问题,降低了电机过载、驱动轮滑移故障概率。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com