面向多障碍物场景的保洁机器人避障路径优化方法与流程
本发明涉及机器人路径规划,具体为面向多障碍物场景的保洁机器人避障路径优化方法。
背景技术:
1、随着室内自动清洁设备发展,保洁机器人通常通过传感器获取障碍物轮廓,规划避障路径并同步进行供液、擦洗和吸水作业,现有规划主要依据障碍物几何边界、机器人尺寸和行驶距离,并按地面材质预设作业参数,较少考虑清洁液沉积变化对路径通行安全的影响。
2、现有方法依据障碍物轮廓生成可通行路径,再按固定速度和清洁参数执行作业,清洁液输出后,地面形成沉积区域,当吸水回收不足或机器人重复经过同一位置时,残留液量增加,湿润度升高,轮迹区域实际摩擦系数降低,现有路径未结合沉积时刻、地面材质和作业参数动态计算摩擦系数,在多个障碍物共同限定的瓶颈区域内,机器人进入或返回时可能出现驱动力或制动力超过轮地附着能力,导致驱动轮打滑、行驶路径偏离、碰撞障碍物或无法返回。
技术实现思路
1、本发明的目的在于提供面向多障碍物场景的保洁机器人避障路径优化方法,以解决上述背景技术中提出的现有避障路径规划未考虑清洁液沉积造成的地面湿润度和摩擦系数变化,导致保洁机器人在多个障碍物形成的瓶颈区域内驱动轮易打滑、制动不充分或无法返回的技术问题。
2、为实现上述目的,本发明提供如下技术方案:面向多障碍物场景的保洁机器人避障路径优化方法,包括:
3、s1、采集障碍物轮廓、地面材质和保洁机器人位姿,基于最小转弯半径扫描保洁机器人得到最小转弯包络区域,根据障碍物轮廓确定可通行区域,将多个障碍物共同限定且不能容纳最小转弯包络区域的可通行区域识别为瓶颈区域;
4、s2、根据保洁机器人位姿生成经过瓶颈区域的候选避障路径,为每条候选避障路径配置由行进速度、清洁液输出量、吸水功率和清洁压力构成的作业控制参数,根据候选避障路径和作业控制参数确定轮迹区域、清洁液沉积区域和路径到达时序;
5、s3、通过路径到达时序、地面材质和作业控制参数计算清洁液沉积区域的时序湿润度,通过时序湿润度从预先建立的湿润度-摩擦系数映射关系中获取轮迹区域的摩擦系数下界;
6、s4、基于摩擦系数下界计算保洁机器人沿候选避障路径进入瓶颈区域和返回瓶颈区域入口分别对应的驱动力余量和制动力余量,筛除任一力学余量不满足运动约束的候选避障路径;
7、s5、从保留的候选避障路径中选取通行耗时最短的目标避障路径,控制保洁机器人按照目标避障路径及对应的作业控制参数执行清洁作业。
8、优选的,所述得到最小转弯包络区域的具体过程为:
9、获取保洁机器人在地面坐标系中的初始投影包络,根据最小转弯半径建立从初始航向转至反向航向的回转轨迹,沿回转轨迹依次变换初始投影包络的中心坐标和航向角,对变换后的全部投影包络取并集,得到最小转弯包络区域。
10、优选的,所述识别瓶颈区域的具体过程为:
11、将障碍物轮廓映射至地面坐标系,从工作区域中剔除障碍物轮廓围成的区域,得到可通行区域,在可通行区域内移动保洁机器人的投影包络,将投影包络与障碍物轮廓不相交的位置组成直行可通行位置集,在直行可通行位置集中移动最小转弯包络区域,将最小转弯包络区域与障碍物轮廓相交的位置组成回转受限位置集,将回转受限位置集中由多个障碍物共同限定的连续位置区域确定为瓶颈区域。
12、优选的,所述生成经过瓶颈区域的候选避障路径的具体过程为:
13、提取瓶颈区域两端的边界截面,将邻近保洁机器人位姿的边界截面中心确定为瓶颈入口,将另一边界截面中心确定为瓶颈出口,根据瓶颈入口与瓶颈出口之间各横截面的中点生成瓶颈中心线,在瓶颈中心线两侧生成满足投影包络通行约束的偏移路径,根据保洁机器人位姿的位置坐标和航向角生成连接瓶颈入口的进场路径,将进场路径分别与瓶颈中心线和偏移路径拼接,得到候选避障路径。
14、优选的,所述确定轮迹区域、清洁液沉积区域和路径到达时序的具体过程为:
15、保洁机器人包括驱动轮和清洁组件,按照地面材质将候选避障路径划分为多个路径段,为每个路径段配置行进速度、清洁液输出量、吸水功率和清洁压力,形成作业控制参数序列,沿每个路径段扫描驱动轮的接地轮廓得到轮迹区域,沿每个路径段扫描清洁组件的接地轮廓得到清洁液沉积区域,根据每个路径段的长度和行进速度计算路径段行进时间,依照路径段的连接顺序累加路径段行进时间,得到路径到达时序。
16、优选的,所述计算清洁液沉积区域的时序湿润度的具体过程为:
17、根据清洁液输出量、行进速度和清洁组件接地宽度计算单位面积供液量,根据吸水功率确定单位面积回收液量,将单位面积供液量与单位面积回收液量的差值确定为单位面积残留液量,根据清洁压力和地面材质对应的液体吸收参数将单位面积残留液量转换为初始湿润度,根据路径到达时序确定每次清洁液沉积后的持续时间,利用地面材质对应的湿润衰减参数对每次初始湿润度进行衰减,将重复经过位置的衰减结果相加,得到时序湿润度。
18、优选的,所述预先建立湿润度-摩擦系数映射关系的具体过程为:
19、针对每种地面材质设置多个湿润度采样状态,在恒定法向载荷下逐级增加驱动轮输出转矩,记录驱动轮达到滑移阈值时的临界牵引力,计算临界牵引力与恒定法向载荷的比值得到摩擦系数,将湿润度采样状态和摩擦系数组成标定样本,按照湿润度递增方向对标定样本进行单调拟合,根据拟合误差生成摩擦系数置信区间,将摩擦系数置信区间下边界确定为地面材质对应的湿润度-摩擦系数映射关系。
20、优选的,所述计算驱动力余量和制动力余量的具体过程为:
21、根据摩擦系数下界和驱动轮的法向载荷计算附着力上限,根据行进速度变化、滚动阻力和清洁压力产生的清洁阻力计算需求驱动力,将附着力上限减去需求驱动力得到驱动力余量,根据行进速度和瓶颈区域剩余制动距离计算需求制动力,将附着力上限减去需求制动力得到制动力余量,按照候选避障路径的正向路径段顺序和反向路径段顺序分别进行计算,得到进入瓶颈区域和返回瓶颈区域入口对应的驱动力余量和制动力余量。
22、优选的,所述目标避障路径的筛选过程为:
23、将驱动力余量和制动力余量分别与各自预设的安全余量阈值进行比对,保留全部力学余量均不小于安全余量阈值的候选避障路径,计算保留的每条候选避障路径的路径段行进时间和作业控制参数切换时间,将路径段行进时间与作业控制参数切换时间之和确定为通行耗时,选取通行耗时最小的候选避障路径作为目标避障路径。
24、优选的,所述目标避障路径的各路径段分别对应相应的作业控制参数,将对应的作业控制参数确定为目标作业控制参数,根据保洁机器人位姿确定当前所在的路径段,从目标作业控制参数中读取当前所在的路径段对应的行进速度、清洁液输出量、吸水功率和清洁压力,控制保洁机器人执行清洁作业。
25、与现有技术相比,本发明的有益效果是:
26、1.本发明通过采集障碍物轮廓并依据保洁机器人的最小转弯半径构建最小转弯包络区域,将多个障碍物共同限定且不能容纳该包络区域的连续可通行区域识别为瓶颈区域,再对候选避障路径进行进入和返回方向的驱动力余量和制动力余量筛选,实现了对瓶颈通行能力和运动安全的综合判断,解决了仅按障碍物间距规划路径,无法识别狭窄区域内驱动轮打滑及制动不足的问题,有利于降低碰撞和无法返回的风险;
27、2.本发明通过为候选避障路径配置行进速度、清洁液输出量、吸水功率和清洁压力,确定轮迹区域、清洁液沉积区域及路径到达时序,并根据地面材质和沉积持续时间计算时序湿润度,再由湿润度-摩擦系数映射关系获得摩擦系数下界,实现了对清洁作业引起的轮地附着变化进行动态评估,解决了未考虑残留液体累积而导致附着能力估计偏高和安全筛选失真的问题,有利于提高打滑风险判断的准确性;
28、3.本发明通过将保留候选避障路径的各路径段行进时间与作业控制参数切换时间相加,选取通行耗时最短的目标避障路径,并根据保洁机器人实时位姿读取所在路径段对应的行进速度、清洁液输出量、吸水功率和清洁压力,实现了路径选择结果与清洁作业控制参数的同步执行,解决了多条路径均满足附着安全条件时难以兼顾通行效率、参数切换延误和现场执行一致性的问题,有利于缩短作业时间并保持清洁质量稳定。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com