面向输电铁塔的类猿攀爬机器人感知规划控制方法及系统与流程

摘要: 本发明涉及电力特种机器人智能控制,具体涉及面向输电铁塔的类猿攀爬机器人感知规划控制方法及系统,尤其适用于一种在复杂、非连续、多杆件交汇的桁架式电力铁塔结构上进行...
面向输电铁塔的类猿攀爬机器人感知规划控制方法及系统与流程

本发明涉及电力特种机器人智能控制,具体涉及面向输电铁塔的类猿攀爬机器人感知规划控制方法及系统,尤其适用于一种在复杂、非连续、多杆件交汇的桁架式电力铁塔结构上进行自主攀爬巡检作业的类猿攀爬机器人感知规划控制方法及系统,通过深度融合环境感知、三维地图构建、动态路径规划、多模态步态控制与主动安全防护技术,以实现对电力铁塔钢结构的高适应性、高安全性自主越障攀爬。

背景技术:

1、随着新型智能电网工程持续规模化落地,高压桁架式输电铁塔的自动化巡检、缺陷检修、现场运维作业需求持续攀升。传统运维模式依靠作业人员登塔开展现场检测与处置工作,存在高空坠落、触电、高空坠物等重大人身安全隐患,同时具备作业效率低下、人力投入成本高、偏远跨江河/山区铁塔人员可达性差等现实缺陷。在此行业背景下,可替代人工在高空复杂角钢结构完成自主作业的攀爬机器人,成为电力特种机器人领域重点研发方向。

2、当前已公开的铁塔攀爬机器人技术方案主要分为机械夹持式、磁吸附式两大技术路线,两类方案均存在固有技术短板。

3、其中,以尺蠖往复爬行原理为基础的机械夹持类机器人(如cn113442146a),运动轨迹被刚性结构限制于单根角钢主材轴线,无肢体侧向展开运动自由度,难以在主材、斜材、横担交错构成的立体桁架结构内切换通行路径;同时夹持力依靠驱动电机持续输出力矩维持,一旦发生断电、控制链路失效工况,夹持作用力将快速消失,整机存在高空坠落隐患,设备本质安全水平较低。

4、以六足交替结构为代表的磁吸附类机器人(如cn116215687a)虽可实现断电保磁功能,但普遍采用单平面磁吸结构,适配角钢l型截面时有效吸附接触面积有限,抗扭转承载能力薄弱。更为关键的是现有该类设备未搭建完整三维环境感知体系,缺失依托数字化环境模型的全局路径规划模块,同时不具备基于多传感器实时受力反馈的动态稳定闭环控制逻辑。整机步态执行流程完全依靠预编程程序驱动,当现场出现节点板、螺栓簇、斜材交叉等未预先录入的障碍结构时,设备无法自主识别障碍物并重新规划通行路径与目标吸附点位,极易发生卡滞、攀爬中断故障。与此同时,现有方案未配置多肢体协同工况下的足端接触载荷优化分配逻辑,易出现局部吸附点位载荷超限脱附问题;安全防护体系仅设置单一阈值报警机制,未构建硬件底层自锁配合软件预判处置的多层级主动安全闭环。

5、综上,本领域亟需一套可实现三维环境深度感知、自主完成桁架空间路径规划、多肢体协同稳定运动、动态均衡足端接触载荷,同时兼具硬件本质自锁与多层级主动防护能力的仿生攀爬机器人控制系统及配套控制方法,用以克服现有设备场景适配性差、自主智能化水平不足、高空运行安全保障能力薄弱等核心技术缺陷。

技术实现思路

1、本发明的目的在于提供一种面向输电铁塔的类猿攀爬机器人感知规划控制方法及系统,以克服现有技术中桁架式电力铁塔复杂环境下机器人面临的‌环境适应性弱、自主越障能力差、动态稳定性不足以及本质安全欠缺‌等技术问题。

2、为实现上述目的,本发明提供的技术方案如下。

3、本发明的第一方面,提供了面向输电铁塔的类猿攀爬机器人感知规划控制方法,包括:采集环境点云并进行分割处理,基于平面正交匹配识别桁架杆件与障碍要素,构建包含杆件几何属性的拓扑图模型并实时更新,基于所述拓扑图模型筛选可行吸附点位;基于所述拓扑图模型进行分层路径求解,分层路径求解包含全局路径求解与局部轨迹生成,采用改进启发式搜索算法获取杆件通行序列,搜索过程纳入肢体可达约束与吸附适配约束,根据杆件通行序列生成肢体运动轨迹,环境感知数据偏离模型预设范围时,执行局部轨迹重规划;采用有限状态机管控肢体交替支撑动作,以零力矩点校验作为状态切换约束,周期性融合机体运动信息与足端接触信息求解零力矩点;零力矩点未落入支撑安全区域时执行载荷调节,单肢运动过程维持其余肢体支撑状态;多肢同步支撑工况下运行二次规划载荷分配算法,以各接触点受力偏差最小为优化目标,联立力学、摩擦、执行机构、吸附装置多类约束求解关节控制量,并将优化后的足端接触受力数据反馈至零力矩点求解流程;执行多维度防脱落控制逻辑,检测到异常工况时控制机器人切换至全支撑锁定状态,根据所述拓扑图模型输出的构件遮挡信息调整吸附装置工作模式。

4、进一步地,所述构建包含杆件几何属性的拓扑图模型并实时更新,包括:对采集得到的环境点云进行预处理,采用区域生长算法对环境点云进行平面分割得到若干平面片,基于随机抽样一致性算法对各平面片进行平面拟合,求解得到各平面片对应的平面法向量与中心点;依据平面法向量正交匹配规则对平面片进行配对,将法向量相互正交的一组平面片识别为单根角钢对应的两翼缘面,提取配对平面片的公共棱线作为角钢杆件棱线,根据翼缘面宽度识别角钢规格,求解得到角钢杆件的棱线空间位置与空间姿态参数;检测相邻角钢杆件棱线的交点作为桁架连接节点,依据交点区域对应的局部点云几何特征对节点类型进行区分,所述节点类型包括主材节点板、外包角钢或螺栓簇,并生成对应障碍物几何描述信息;构建无向图结构的塔架图,将每一段角钢杆件抽象为无向图的图节点,将杆件之间的桁架连接关系抽象为无向图的图边,图节点存储有杆件规格、轴线方向向量、杆件端点坐标、可吸附翼缘面方向集合、杆件长度、截面尺寸、空间位姿以及历史吸附成功率属性,图边存储有节点类型与障碍物几何描述属性;类猿攀爬机器人移动至新观测位置时,通过增量式点云配准方式对塔架图的图节点属性进行局部修正,实现拓扑图模型的实时更新。

5、进一步地,基于所述拓扑图模型筛选可行吸附点位,包括:沿输电铁塔角钢杆件的轴线方向网格化生成多组候选吸附点位,结合拓扑图模型对应的杆件结构与障碍分布特征对候选吸附点位进行筛选,剔除靠近螺栓孔区域以及杆件端部区域的无效点位,保留满足几何贴合条件与无障碍条件的可行吸附点位。

6、进一步地,所述改进启发式搜索算法为在a*算法基础上改进的路径搜索算法,基于所述拓扑图模型进行杆件通行序列求解;所述改进启发式搜索算法的代价函数同步融合运动距离代价、关节运动代价与杆件稳定代价三类分量,稳定代价随杆件倾斜状态自适应调整;扩展邻接杆件节点时执行双重约束校验,包括肢体可达性校验和吸附适配校验;所述肢体可达性校验根据肢体末端执行器工作空间边界求解肢体可达惩罚因子,判断杆件表面是否存在满足运动约束的可行吸附点位,未检出可行吸附点位则阻断对应拓扑连接支路;所述吸附适配校验根据杆件表面遮挡区域占比动态赋值吸附适配权重,剔除吸附工况不满足约束的无效路径节点;节点扩展过程中同步判别杆件连接支路的障碍通行能力,若支路空间范围存在障碍物,则抬升对应支路代价值以实现绕行导向;采用空间距离匹配预设系数构造启发项,保障全局最优路径收敛特性;全局路径求解完成后输出杆件通行序列,并基于杆件通行序列生成肢体局部运动轨迹。

7、进一步地,所述局部轨迹重规划配置多类触发工况,包含实测角钢翼缘面空间姿态与所述拓扑图模型预存对应姿态存在超出预设偏差区间的偏离、目标吸附点位被新增障碍物遮挡、肢体摆动行程内检出非预设刚性接触;触发局部轨迹重规划后,以类猿攀爬机器人当前本体位姿作为轨迹求解起始基准,根据实时采集环境点云重新进行可行吸附点位筛选、操作空间运动轨迹构造及关节空间角度映射;采用多项式插值生成足端笛卡尔空间连续运动轨迹,经由逆运动学映射得到各关节时序角度序列,并对关节角度时序序列执行低通平滑滤波以消除轨迹间断;若点云感知检出未录入所述拓扑图模型的新增障碍物,且新增障碍物与预设运动轨迹的空间间距不满足预设最小空间隔离安全约束,则通过人工势场法在局部作业空间内生成避让绕行轨迹,绕行轨迹终止端与原始全局通行路径上距离最近的有效吸附点位平滑连续对接。

8、进一步地,所述有限状态机配置多类工作状态,至少包含全吸附锁定态、目标点位选取态、单肢解吸附态、单肢摆动态、吸附锁定态、越障过渡态、负荷调整态,其中,在由所述单肢解吸附态向所述单肢摆动态转换前,需校验所述剩余肢体构成的支撑多边形的稳定裕度是否满足预设稳定裕度约束。

9、进一步地,所述多肢同步支撑工况下运行二次规划载荷分配算法,以各足端接触受力与目标受力的偏差程度最小作为优化目标;所述二次规划载荷分配算法联立多组边界约束求解最优关节控制量,所述边界约束包括力平衡约束、力矩平衡约束、接触摩擦锥约束、关节输出力矩幅值约束、吸附装置额定吸附力上限约束;求解阶段同步施加接触点法向受力非负限定,通过松弛策略适配全部不等式约束;求解得到各接触点位最优期望受力后输出对应各肢体的关节控制指令,并将优化后的足端接触受力数据反馈至零力矩点求解流程,用于机体动态稳定判据计算。

10、进一步地,所述多维度防脱落控制逻辑设置层级联动的三重安全防护机制,分别为断电永磁自锁防护机制、足端受力异常响应防护机制及机体姿态异常防护机制;所述断电永磁自锁防护机制基于吸附装置实现断电工况下状态自持,断电后可持续保持断电前的吸附或释放状态,无需持续励磁供电维持工作状态;实时采集足端力传感数据,当吸附力幅值、吸附力动态变化速率任一指标偏离预设正常区间时,判定为足端受力异常工况并启动所述足端受力异常响应防护机制;持续采集机体姿态数据,若机体姿态突变幅度、姿态动态变化速率同步超出预设约束区间,则判定为机体姿态异常工况并启动所述机体姿态异常防护机制;任意一类防护机制识别出异常工况后,立即截断全部运动控制输出指令,向所有支撑足端对应的所述吸附装置下发正向励磁控制信号,驱动各足端切换至满吸附锁定工作状态。

11、进一步地,所述吸附装置采用l型双稳态永磁吸附结构,设置两组相互垂直布置的翼缘吸附子单元,每组翼缘吸附子单元支持独立驱动控制;根据所述拓扑图模型输出的构件遮挡信息调节吸附装置的运行工况,当所述拓扑图模型识别出任意一侧翼缘吸附区域存在遮挡,则仅驱动无遮挡侧对应的翼缘吸附子单元工作,切换至单侧翼缘吸附运行模式。

12、本发明的第二方面,提供了面向输电铁塔的类猿攀爬机器人感知规划控制系统,包括:环境感知模块,用于采集环境点云并进行分割处理;拓扑建模模块,用于基于平面正交匹配识别桁架杆件与障碍要素,构建包含杆件几何属性的拓扑图模型并实时更新,基于所述拓扑图模型筛选可行吸附点位;路径规划模块,用于基于所述拓扑图模型进行分层路径求解,分层路径求解包含全局路径求解与局部轨迹生成,采用改进启发式搜索算法获取杆件通行序列,搜索过程纳入肢体可达约束与吸附适配约束,根据杆件通行序列生成肢体运动轨迹,环境感知数据偏离模型预设范围时,执行局部轨迹重规划;步态控制模块,用于采用有限状态机管控肢体交替支撑动作,以零力矩点校验作为状态切换约束,周期性融合机体运动信息与足端接触信息求解零力矩点;零力矩点未落入支撑安全区域时执行载荷调节,单肢运动过程维持其余肢体支撑状态;力分配优化模块,用于多肢同步支撑工况下运行二次规划载荷分配算法,以各接触点受力偏差最小为优化目标,联立力学、摩擦、执行机构、吸附装置多类约束求解关节控制量,并将优化后的足端接触受力数据反馈至零力矩点求解流程;安全保护模块,用于执行多维度防脱落控制逻辑,检测到异常工况时控制机器人切换至全支撑锁定状态,根据所述拓扑图模型输出的构件遮挡信息调整吸附装置工作模式。

13、与现有技术相比,本发明提供的面向输电铁塔的类猿攀爬机器人感知规划控制方法及系统,区别于现有技术的核心在于:其一,提出基于平面法向量正交匹配的角钢杆件专用识别与拓扑建模方法,将非结构化点云转化为携带杆件规格、位姿、可吸附翼缘方向及历史吸附成功率的可计算图模型,为上层规划提供了现有通用点云分割方案不具备的结构化先验;其二,将肢体运动学可达性与吸附适配性直接嵌入图搜索的支路通断判据,使路径规划结果天然满足本体运动学与吸附约束,避免了“先规划路径、后发现不可执行”的反复;其三,感知输出的构件遮挡信息与l型双稳态分区磁路联动,实现被遮挡侧自动降级为单翼缘吸附。上述三者相互耦合、缺一不可,共同构成“感知-建模-规划-吸附”的闭环,其协同技术效果无法由任一现有单项技术简单叠加得到,因而具备突出的实质性特点。具体地:

14、1、实现立体桁架多杆件跨空间自主通行,拓宽复杂塔架工况适配能力:本技术采用类猿攀爬机器人,结合点云正交匹配建模、分层路径规划技术,能够识别主材、斜材、横担、节点板构成的三维桁架结构,并通过改进启发式算法求解跨杆件最优通行序列。相较于现有机器人运动被轨道约束、无侧向展开自由度,仅能沿单根角钢一维移动的局限,本技术可在不同倾角角钢之间完成落足切换,适配斜材交叉、节点遮挡等复杂场景,有效解决现有设备路径单一、易发生卡滞的问题。

15、2、采用l型双稳态分区永磁吸附结构,同步提升吸附力学性能与底层本质安全性:本技术吸附装置设置两组相互独立的垂直翼缘磁路,可同时贴合角钢双侧翼缘,相较于单平面磁吸方案,有效吸附面积与抗扭转力矩均得到提升;设备采用双稳态磁路,仅切换状态时输出励磁脉冲,断电后可稳定维持吸附或释放状态。对比尺蠖夹持方案依赖电机持续力矩、断电即失稳坠落,以及通电消磁磁吸结构存在卡死、半空脱落双重隐患的缺陷,本技术从硬件磁路层面规避供电、通信失效带来的安全风险;两翼缘独立驱动设计可在单侧翼缘被遮挡时启用单翼缘吸附模式,在障碍区域仍可维持有效吸附承载力。

16、3、搭建完整感知-建模-规划闭环体系,具备未知障碍自主识别与在线重规划能力:本技术基于rgb-d点云完成杆件、障碍物自动识别并构建可计算拓扑图模型,全局路径综合多类代价求解杆件通行序列,局部采用多项式插值生成平滑足端轨迹;当感知数据与模型存在偏差或检出新增障碍物时,自动通过人工势场法生成绕行轨迹。现有设备仅配备限位开关或局部视觉,无统一数字化环境模型,运动轨迹完全预编程,无法自主应对现场未知障碍;本技术依靠实时感知反馈闭环,主动绕行节点板、螺栓簇等障碍物,降低机构撞击、攀爬中断故障发生率。

17、4、有限状态机搭配二次规划载荷分配,建立全流程动态稳定约束机制:本技术将零力矩点稳定裕度作为有限状态机状态切换前置判定条件,释放肢体前校验支撑多边形稳定性能,裕度不足时自动执行载荷均衡调节;多肢同步支撑工况下运行二次规划算法,联立力学、摩擦、关节、吸附多重约束均衡各足接触载荷。现有机器人步态规则固化,未设置动态稳定校验与多足载荷优化逻辑,在倾斜杆件、动态越障工况下易出现单点过载脱附或整机倾覆;本技术通过标准化状态管控与自适应力分配,整机运动全程保持多点支撑稳定冗余。

18、5、构建三层联动防脱落防护闭环,实现多故障场景主动预判与处置:本技术集成断电永磁自锁、足端受力异常响应、机体姿态突变预判三重层级防护,控制周期内持续监测吸附力、机体姿态两类核心指标,识别异常后立即切断全部运动指令,控制所有足端进入满吸附锁定状态。现有设备仅设置单一阈值告警,缺少硬件自锁与软件预判结合的多层防护链路;本技术覆盖断电、吸附失效、机体失衡等各类风险工况,依靠多重冗余防护提前阻断高空坠落隐患。