一种基于导线动态识别的高空接线控制方法及设备与流程
本发明涉及一种基于导线动态识别的高空接线控制方法及设备,属于自动作业电力设备的现场辅助。
背景技术:
1、高空试验和接线作业在电力行业中是常见且至关重要的任务,广泛存在于变压器、互感器、开关设备、输电线路及其他高压电力设备的现场试验、调试与运维过程中。该类作业通常需要将试验导线、测量线或接地线准确连接至高空设备端子,其作业高度高、作业空间受限、作业对象结构复杂,对操作的稳定性和精度要求极高。
2、传统的作业方式主要依赖人员乘坐高空作业车进行人工操作。在强风扰动、复杂电磁干扰下,人工操作稳定性极差,不仅效率低下,且存在巨大的高空坠落与触电风险。为降低人员风险,近年来行业内尝试引入部分半自动化的辅助升降平台配合自动机械臂进行自动化高空接线作业。然而,现有的辅助平台本质上仍以简单遥控或静态预设轨迹为主,其在底层控制方法与动态感知反馈机制上存在以下显著缺陷:
3、(1)缺乏高精度的动态状态估计与位姿抗扰跟踪能力。现有高空平台多基于单一的视觉传感器进行静态目标定位,如公开号为cn119959581a的中国专利申请公开的一种用于高压试验接线的高空接线钳。当平台输送至数十米高空时,极易受到高空风偏载荷以及多节升降机构累积柔性形变的影响,产生不规则的剧烈摆动。传统的静态识别算法无法实时辨识并滤除这些高频、大波动的干扰位移,导致反馈给控制系统的目标相对位姿数据产生严重漂移,进而引发机械臂“对不准、抓不住”的失控情况。
4、(2)缺乏柔顺补偿的闭环伺服接线策略。在高空导线递送和最终与目标设备端子交接的瞬态过程中,毫米级的定位误差或突发的阵风都会导致机械执行末端与脆弱的高压设备端子发生剧烈的刚性碰撞。现有的纯位置反馈控制逻辑由于缺乏末端接触力觉约束,以及对空间阻尼振动的预测前馈补偿机制,难以实现恒力约束下的柔性对位。这种“硬碰硬”的控制方式轻则导致导线滑落,重则引发昂贵一次设备的机械损伤甚至导致严重的短路安全事故。
5、因此,针对上述问题,亟需研发一种针对高空复杂动态环境的接线自动控制方法,突破单一静态视觉的局限,构建多传感器融合的动态状态滤波与自适应柔性伺服闭环机制,以实现试验导线的自主识别、风偏抗扰估计与恒力柔性接线。
技术实现思路
1、本发明解决的技术问题是:针对现有高空接线设备依赖人工遥控、缺乏对风偏等高频扰动的动态位姿跟踪补偿,且在目标交接过程中极易发生刚性碰撞损伤的技术缺陷,提供过一种基于导线动态识别的高空接线控制方法及设备。
2、本发明采用如下技术方案实现:
3、本发明首先公开了一种基于导线动态识别的高空接线控制方法,采用高空作业单元实现,所述高空作业单元包括绝缘升降机构以及随绝缘升降机构上升和下降的受控机械臂,所述受控机械臂的末端连接实现接线操作的接线夹具,所述受控机械臂配置有包括激光雷达、深度相机及力传感器的多模态协同感知系统,所述方法包括如下步骤:
4、s1、多模态协同感知与预定位, 启动多模态协同感知系统,同步完成高空目标区域预定位、地面导线精准识别与抓取,根据解算的高空目标轴线矢量驱动受控机械臂完成递送前的姿态预置;
5、s2、动力学约束的自组顶升控制, 基于设定的动力学与几何阈值条件,控制绝缘升降机构顶升,带动受控机械臂及抓取的导线垂直上升,到达高空目标区域预设高度后锁定,完成高空作业单元的高空粗定位;
6、s3、基于多传感融合的动态位姿解算,进入高空强扰动作业阶段,利用 imu 数据进行受控机械臂及其抓取的导线运动状态的前推预测,以激光雷达点云数据为观测值,通过迭代误差状态卡尔曼滤波算法消除风摆扰动影响,实时解算滤除高频颤振后的高空作业单元真实精确位姿;
7、s4、基于前馈补偿的伺服微调与柔顺对位,将所述真实精确位姿作为反馈,规划受控机械臂的避障逼近轨迹;同时,提取导线摆动特征重构阻尼衰减预测模型,并将阻尼衰减预测模型作为前馈补偿量注入闭环控制回路中,驱动受控机械臂在接线夹具进行接线操作时执行主动反向微动;
8、s5、对接线状态进行状态复核与高空作业单元自主复位。
9、在本发明的一种基于导线动态识别的高空接线控制方法中,进一步的,在步骤s1中,首先进行多模态空间坐标配准,通过联合标定获取激光雷达与深度相机之间的外部参数相对转换矩阵,建立激光雷达的三维点云到深度相机对应的二维像素平面的跨模态映射关系,通过跨模态映射关系将无纹理的三维点云与二维图像精确对齐,划定出包含地面待接线的试验导线的多模态感兴趣区域;
10、在划定的多模态感兴趣区域内,基于随机采样一致性算法提取导线物理走向特征:设待拟合的导线中心轴线方向向量为,导线中心轴线上任意一点为,计算多模态感兴趣区域内部的候选点云集中任意一点 到导线中心轴线的空间垂直距离:
11、,
12、通过迭代剔除空间垂直距离大于设定容差阈值的背景噪声点云获得所述候选点云集内的有效导线点云, 拟合出表征导线绝对物理走向的中心轴线方程,将有效导线点云投影至中心轴线方程上以截取目标线段,并取该目标线段的中点作定位三维空间中的精确抓取中心点;
13、随后,在受控机械臂依据所述精确抓取中心点逼近并接触导线时,为避免刚性闭合损伤导线,力传感器实时反馈夹持接触阻力,通过自适应阻抗控制算法动态调节末端接线夹具夹爪开合度,其控制力矩输出公式为:
14、;
15、其中,为夹持力,为夹爪位移偏差,为刚度系数,为初始夹持力,以此构建恒力约束闭环实现柔顺抓取。
16、在本发明的一种基于导线动态识别的高空接线控制方法中,进一步的,步骤s2中,绝缘升降机构采用由摩擦轮驱动升降伸缩的多级标准节绝缘杆拼接结构,所述摩擦轮控制绝缘升降机构顶升时,建立升降过程中的几何与动力学双重安全约束逻辑:
17、设所述绝缘升降机构的递送高度h由n节升降的标准节绝缘杆拼接而成,第i节标准节绝缘杆的轴向位移为,则;第i节标准节绝缘杆的旋转锁紧角度需满足:,其中为螺纹导程;控制绝缘升降机构的升降驱动电机输出的扭矩需实时满足动力学防滑移阈值条件:
18、;
19、其中,为绝缘升降机构的总负载质量,为重力加速度,为风载扰动阻力,为驱动绝缘升降机构升降的摩擦轮半径,为传动效率。
20、在本发明的一种基于导线动态识别的高空接线控制方法中,进一步的,所述步骤s3 中,利用迭代误差状态卡尔曼滤波算法解算受控机械臂及其抓取导线的真实精确位姿的过程具体包括:
21、定义受控机械臂的状态向量,其中, 为三维位置向量,为三维姿态旋转矩阵,为速度向量,和 分别为加速度计和陀螺仪的传感器零偏,为重力向量,t为矩阵转置符号;利用机械臂 imu 数据进行状态前推预测,计算公式为:
22、
23、式中,为采样时间间隔,下标i和i+1分别表示i时刻和i+1时刻,和分别为 时刻 机械臂imu 测量的实际加速度和角速度,由此递推得到含有积分漂移的先验名义状态量,;
24、对所述先验名义状态量进行观测校正,提取受控机械臂及其抓取导线的激光雷达点云特征平面,建立特征点全局坐标 到高空作业目标区域的地图参考平面的距离残差模型,用以表征预测位姿与实际观测的偏差,其中为平面法向量;
25、结合先验预测观测值 ,解算卡尔曼增益矩阵并迭代求解最优误差状态量:
26、;
27、利用求得的误差状态量 在流形空间执行广义加法运算,以完成对所述先验名义状态量的后验修正:
28、;
29、为广义加法运算,通过上述预测与更新闭环,得到高空作业单元的真实精确位姿 并将其作为步骤s4 中闭环控制回路的绝对反馈量。
30、在本发明的一种基于导线动态识别的高空接线控制方法中,进一步的,所述受控机械臂末端与接线夹具之间耦合设有柔性连接件。
31、在本发明的一种基于导线动态识别的高空接线控制方法中,进一步的,步骤s4中,针对高空交接的防冲撞微调阶段,控制逻辑具体为:首先将高空作业单元的真实精确位姿输入 rrt* 算法进行避障路径规划,并在目标函数中加入如下平滑约束优化:
32、;
33、其中,为加加速度,为轨迹总时长;
34、同时,通过可控机械臂抓取导线的连续帧点云匹配获取导线动态位移序列,基于快速傅里叶变换将导线动态位移序列从时域转换至频域,以提取核心瞬态摆动特征:
35、;
36、其中,代表导线动态位移序列 的时域信号经过转换后在频域下的复数频谱函数,是傅里叶变换的复指数核函数或基函数;从复数频谱函数获取当前风况下导线主频的初始振幅与初相位,并结合受控机械臂末端柔性连接件的物理阻尼系数与阻尼振动角频率,重构出导线终端的阻尼衰减预测模型:
37、;
38、将高空作业单元的真实精确位姿 作为反馈,计算高空作业单元当前实时位姿与目标交接工位之间的空间偏差向量,以空间偏差向量为输入,阻尼衰减预测模型的输出作为前馈抑制补偿项注入受控机械臂的pid闭环控制回路中:
39、
40、其中,为pid控制输出,,,分别为受控机械臂的pid闭环控制回路的比例、积分、微分系数,为系统预设的前馈增益系数矩阵。
41、在本发明的一种基于导线动态识别的高空接线控制方法中,进一步的,所述步骤s5中,所述接线夹具完成导线的贴合指令后,通过所述多模态协同感知系统调用视觉图像比对及微电流导通数据执行状态进行导线接通的复核逻辑确认;
42、若视觉比对得出的空间位姿偏差或微电流检测反映的接触状态偏差超限,则重置位姿反馈循环,返回步骤s3 重新进行动态位姿解算;若复核通过,按序发送接线夹具松开约束、受控机械臂原路回撤及绝缘升降机构下降指令,完成高空接线控制方法的自动化闭环。
43、本发明还公开了一种计算机设备,包括:
44、一个或多个处理器; 存储器,用于存储一个或多个计算机程序; 其中,当所述一个或多个计算机程序被所述一个或多个处理器执行时,使得所述计算机设备实现本发明上述控制方法的步骤。
45、本发明还公开了一种计算机可读存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时实现本发明上述控制方法的步骤。
46、本发明采用上述技术方案具有如下有益效果:
47、本发明突破了传统高空作业静态视觉识别与纯位置控制的局限,构建了一套多约束自动化与闭环容错的高空接线控制链条。一方面,本发明创新性地将多模态感知数据与迭代误差状态卡尔曼滤波(ieskf)算法相融合,通过imu高频动力学预测与点云低频几何观测的紧耦合以及流形空间内的误差补偿,彻底剥离了高空接线过程中受控机械臂以及导线受到风偏与机械高频颤振引起的虚假位姿漂移,实现了强非结构化扰动环境下极高的动态定位精度与鲁棒性;另一方面,针对高空接线交接过程易发生刚性碰撞损伤的难题,本发明提出“阻抗-pid复合柔顺控制律”,将基于傅里叶变换提取的导线瞬态摆动特征重构为阻尼衰减方程并作为前馈补偿注入机械臂的pid控制环路,驱动机械臂提前执行主动反向微动以抵消残余风摆,同时深度耦合末端连接接线夹具的柔性连接件被动物理形变吸能,形成“主动前馈伺服+被动阻抗吸能”的双重柔性机制。最终,结合升降阶段的动力学/几何双重约束与交接后的微电流/视觉双重复核,本发明实现了导线免冲击“软着陆”式的恒力精准贴合,大幅提升了高危接线作业的安全自主性与对接一致性,从根本上消除了昂贵一次高压设备的刚性碰撞风险。
48、综上所述,本发明提供的一种基于导线动态识别的高空接线控制方法及设备,适用于非结构化、强扰动(如高空风偏、基座振动)环境下的电力系统高空导线精准定位与自动化接线任务,能够实现多模态环境感知、高空作业单元动态状态估计与滤波、以及恒力约束下的柔顺前馈伺服递送,以彻底解决高空非结构环境下目标难识别、抗扰能力差、交接易碰撞的工程难题,大幅提升电力系统高空接线作业的无人化水平与一次对接成功率,尤其适配高压输变电设备的自动化维护与检测试验需求。
49、以下结合附图和具体实施方式对本发明做进一步说明。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com