一种基于多源感知融合的带电作业机器人动态路径规划方法与流程
本发明涉及动态路径规划,尤其涉及一种基于多源感知融合的带电作业机器人动态路径规划方法。
背景技术:
1、带电作业是指在不停电状态下对电力设备进行检修、维护的作业方式,是保障电网供电可靠性的重要手段。传统带电作业由作业人员穿戴绝缘防护装备,借助绝缘斗臂车或绝缘杆接近高压带电设备,直接以人工方式完成绝缘子更换、断接引线、异物清除等操作。由于作业环境具有高空、高压、强电磁场等特点,人工带电作业存在劳动强度大、安全风险高的问题。
2、为降低人身安全风险,现有技术发展了带电作业机器人,其主要实现方式包括以下两类:
3、第一类为遥操作方式。作业人员在地面或绝缘斗内,通过摄像头回传的视频画面观察作业现场,操作主手控制器或操纵杆,经主从控制映射远程驱动机械臂完成作业。该方式本质上仍依赖人工实时操控,一方面,视频回传存在传输延迟与视角盲区,操作精度受限于操作人员的经验与状态;另一方面,操作人员长时间处于高度紧张状态易疲劳,误操作风险高,作业效率和一致性难以保证。
4、第二类为基于离线建模的自主/半自主方式。作业前,由建模无人机搭载激光雷达与视觉传感器对作业区域进行三维扫描建模;后台规划单元基于三维模型一次性离线生成包含空间位姿序列的全局作业路径;机器人按照预先生成的路径序列执行臂架调姿与末端就位;在末端接近目标后,再由视觉伺服进行精确位姿校正,完成作业操作。
5、然而,上述第二类方式中,全局路径在作业前一次性离线生成,属于静态规划结果,无法适应作业执行过程中的环境变化。实际作业现场为开放式户外环境,作业过程中可能出现飞鸟、飘挂异物、未建模的临时障碍物等动态或未知障碍。现有技术对上述情况的处理方式为:机载传感器检测到障碍物侵入安全边界后,立即停止或暂停机器人动作,等待人工远程确认或重新规划。该处理方式存在如下问题:其一,作业频繁中断,每次中断均需人工介入才能恢复,作业连续性差,实质上削弱了自主作业的意义;其二,暂停后系统无法自主判断局部空间内是否存在可行的替代路径,若障碍物未消失,则作业只能中止;其三,若改为对整个任务重新进行全局规划,则计算量大、耗时长,且完全抛弃已离线验证的原路径,在线实时性难以满足。
6、此外,现有技术中,部分带电作业机器人虽已配置机载激光雷达和视觉传感器,但两者通常仅作为独立的信息采集通道,以视觉定位为主、激光雷达为辅,或两者各自输出定位结果后由后台分别处理,缺乏对两类传感器定位结果进行量化比较与融合评估的机制。由此导致系统无法定量判断当前多传感器定位结果的可信程度,当某一传感器在强电磁干扰、光照变化等条件下发生性能退化时,系统难以自主感知退化程度,关键决策仍依赖固定阈值或人工经验判断,存在安全隐患。
7、在其他机器人领域,已有的局部避障方法如人工势场法、动态窗口法、快速随机扩展树等,在通用场景下已有较多应用,但上述方法均未针对带电作业场景下的特殊约束进行专门设计:其一,机械臂末端与带电导线之间必须保持足够的安全距离,该距离取决于带电体形态、电压等级、环境湿度与海拔等多因素共同决定的电场强度分布,而非简单的固定阈值;其二,局部避障路径需要与全局作业路径实现平滑衔接,且要求机械臂在避障过程中姿态平稳,不允许出现急停、急转等引起末端抖动的运动;其三,带电作业机械臂在避障过程中仍需保持末端工具的可操作度,以确保避障后能顺利继续作业。若将上述通用避障算法未经针对性改进直接移植至带电作业场景,难以同时满足路径衔接平滑性、末端姿态稳定性与电场安全性的综合要求。
8、针对上述的现有技术存在问题设计一种基于多源感知融合的带电作业机器人动态路径规划方法。
技术实现思路
1、本发明提供一种基于多源感知融合的带电作业机器人动态路径规划方法,包括:
2、s1由建模无人机对作业区域进行飞行扫描,采集激光雷达点云、可见光影像及rtk定位坐标数据,经三维重建和关键作业位姿点提取,规划生成全局作业路径;
3、s2带电作业机器人根据全局作业路径进行作业时,通过机载激光雷达和视觉传感器对障碍物进行定位和分类,计算二者对同一障碍物定位结果的空间一致性评分;
4、s3根据空间一致性评分与障碍物距离进行分级判定,当判定需重规划时,以当前位姿为起点、全局路径最近关键位姿为终点,结合带电作业安全约束生成局部避障路径;
5、s4将局部避障路径与全局作业路径平滑重接并计算重接偏差,重接偏差超其偏差阈值或连续重规划失败次数超过次数阈值时,安全停止并请求人工介入。
6、本发明的有益效果:
7、一是通过对带电作业环境中的障碍物进行感知并分类,至少区分带电危险源与几何障碍物,使带电体按电场安全逻辑防护、普通障碍物按几何避碰逻辑防护,避免了不分类时防护失效或过度保守的问题;同时输出空间一致性评分,将感知可信度量化为可计算的标量,为后续安全包络面构建、安全距离确定和分级判定提供数据基础,使系统能够识别定位不可信场景并自适应调整安全裕度,从源头降低误判安全的概率,提升了带电作业机器人的感知针对性和安全决策能力。
8、二是通过计算空间一致性评分,将多源感知或多次定位结果的空间一致程度量化为标量指标,解决了复杂工况下定位结果存在不确定性却缺乏定量评价手段的问题;该评分使感知置信度从模糊概念变为明确数值,为后续安全裕度的动态调整提供客观依据,评分较低时自动扩大安全裕度、较高时适度收紧,实现安全性与作业效率的自适应平衡;同时通过低评分持续时间的判定识别并阻断定位持续不可信的危险状态,及时触发安全停止,提高了带电作业机器人在复杂真实工况下的鲁棒性和安全性。
9、三是根据空间一致性评分和障碍物距离进行分级判定,使响应与危险程度相匹配,避免了过度停机或响应不足;通过构建随电压等级、湿度、海拔及一致性评分动态变化的电场安全包络面,将看不见的电场危险转化为可计算的空间边界,突破了常规几何避障的局限;在触发局部重规划时,以当前位姿为起点、全局路径最近关键位姿为终点,在几何避碰和电场安全约束下对路径长度、可操作度和最小安全距离联合寻优,使局部路径安全、短且机械臂灵活,并将关节限位和运动学约束一并纳入,保证路径实际可执行,从而在保证安全的前提下提升了绕障效率和作业质量。
10、四是实现了局部避障路径与全局作业路径的平滑重接及安全兜底,以局部路径终点为基准确定最近重接点,在两端接头处插入等距插值点并对各关节角度序列做三次样条平滑,使拼接处角速度和角加速度连续,消除了位姿突变、冲击和振动,保证机械臂回归过程的平稳性和作业精度;同时通过计算位置偏差和姿态偏差并分别与阈值比较,实现了对重接质量的客观、定量评估,消除主观判断误差;当偏差超阈值时先返回 s3 重新规划以保留自主恢复机会,而连续失败次数超过阈值时执行安全停止并保持当前位姿请求人工介入,避免无效循环和停机二次危险,实现了自主作业连续性与带电作业安全性的平衡。
1.一种基于多源感知融合的带电作业机器人动态路径规划方法,其特征在于,包括:
2.根据权利要求1所述的一种基于多源感知融合的带电作业机器人动态路径规划方法,其特征在于,所述s1包括:
3.根据权利要求1所述的一种基于多源感知融合的带电作业机器人动态路径规划方法,其特征在于,所述s2包括:
4.根据权利要求3所述的一种基于多源感知融合的带电作业机器人动态路径规划方法,其特征在于,所述s203包括:
5.根据权利要求1所述的一种基于多源感知融合的带电作业机器人动态路径规划方法,其特征在于,所述s3包括:
6.根据权利要求5所述的一种基于多源感知融合的带电作业机器人动态路径规划方法,其特征在于,所述s301包括:
7.根据权利要求5所述的一种基于多源感知融合的带电作业机器人动态路径规划方法,其特征在于,所述s304包括:
8.根据权利要求5所述的一种基于多源感知融合的带电作业机器人动态路径规划方法,其特征在于,所述s305包括:
9.根据权利要求1所述的一种基于多源感知融合的带电作业机器人动态路径规划方法,其特征在于,所述s4包括:
10.根据权利要求9所述的一种基于多源感知融合的带电作业机器人动态路径规划方法,其特征在于,所述s402包括:
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com