一种无人机剪枝终端精准对位作业方法与流程
本发明涉及输电线路树障清理与无人机机载作业控制,具体为一种无人机剪枝终端精准对位作业方法。
背景技术:
1、随着架空输电线路规模扩大,线路走廊内树木生长对输电线路安全运行造成持续影响。当树枝与导线之间的安全距离不足时,强风、雨雪、树枝摆动和外力扰动会引发线路跳闸、接地故障或停电事故。现有树障清理方式主要包括人工攀树修剪、斗臂车作业、地面绝缘杆修剪以及无人机挂载剪枝机构作业,其中人工攀树作业存在高空坠落和触电风险,斗臂车作业受地形、道路、停电窗口和作业空间限制,地面绝缘杆作业受高度和视距限制,无人机挂载剪枝机构虽能够进入山区、林区、河道边和道路受限区域,但在实际剪枝过程中仍存在精准对位困难。
2、现有无人机剪枝方式通常将链锯或剪切机构作为无人机外部载荷,通过视觉识别树枝位置后控制无人机靠近并启动剪枝装置完成切割。该类方式主要依赖切割前的静态定位,而输电线路走廊内的目标树枝并非固定刚性目标,树枝会受到自然风、无人机旋翼下洗气流、链锯导板接触力、链条切削阻力和断枝释放力的共同影响产生弯曲、回弹、摆动和扭转,导致切割前识别出的树枝位置在切割过程中发生变化。同时,链锯导板在树皮接触、切缝形成、木质部切入、残余截面断裂和导板退出过程中产生的反作用力会经连接机构传递至无人机,造成无人机姿态扰动和剪枝终端位置偏移。
3、输电线路附近作业的安全约束不仅涉及无人机机体与导线之间的距离,还涉及旋翼外缘、连接机构、链锯导板、链条运动区域以及断枝释放轨迹与导线之间的安全距离。现有方案多将无人机位置作为主要安全判断对象,难以对剪枝系统整体外轮廓进行统一安全约束。链锯导板进入树枝后,外部视觉传感器易受到枝叶、木屑和导板自身遮挡,难以继续准确判断导板是否处于切缝中心,容易造成导板偏刃、扩缝、卡滞和夹锯。树枝接近断离时,无人机和链锯导板仍按原有进给状态继续推进,则会出现断枝甩动、导板反冲和无人机姿态突变。
技术实现思路
1、针对现有技术的不足,本发明提供了一种无人机剪枝终端精准对位作业方法,面向输电线路无人机链锯剪枝作业的全链路动态控制与安全完整性技术,其核心在于突破传统静态、局部、孤立控制模式的局限,系统性地解决了以下技术难题:断枝瞬态易失控、安全边界不完整、切割过程视觉失锁且动态目标跟踪存在偏差的问题。
2、为实现以上目的,本发明通过以下技术方案予以实现:一种无人机剪枝终端精准对位作业方法,包括如下步骤:
3、采集输电线路作业区的导线空间点集、树枝空间点集、无人机位姿数据、连接机构状态数据和链锯切削状态数据,并根据导线空间点集建立导线安全管;
4、从树枝空间点集中提取目标树枝中心线、局部直径、分叉节点、自由端方向和摆动幅值,沿目标树枝中心线生成候选切割截面;
5、控制链锯导板沿候选切割截面的外侧入口执行两级低扰动触探,采集树枝局部位移、连接机构缓冲行程、链锯电机电流变化、导板振动方向和无人机角速度变化,并形成目标树枝在候选切割截面处的折算柔度和受力让位方向;
6、根据导线安全管、候选切割截面、折算柔度、受力让位方向、链锯导板几何包络、无人机姿态限制和连接机构缓冲余量生成候选受迫切割对位廊道;
7、计算候选受迫切割对位廊道的综合评价值,选取综合评价值最小的候选受迫切割对位廊道作为目标受迫切割对位廊道;
8、将目标受迫切割对位廊道分解为无人机低频悬停目标、连接机构中频缓冲目标和链锯导板高频姿态微调目标;
9、控制无人机进入预对位悬停位置,控制连接机构调整缓冲行程和重心补偿位置,控制链锯导板切削平面进入目标受迫切割对位廊道入口段;
10、控制链锯导板以低进给速度形成初始切缝,并根据切缝锁定误差调节链锯导板横向姿态;
11、在稳定切削阶段,根据链锯电机电流、无人机角速度、切缝锁定误差和导线安全管剩余安全距离更新链锯导板进给速度;
12、根据导板嵌入深度、电机负载积分和目标树枝自由端速度估算残余连接截面,并在残余连接截面低于设定阈值时执行断枝卸载和廊道退出控制。
13、优选的,所述导线安全管沿导线中心线集合建立,所述导线安全管的半径由带电安全距离、定位误差裕量、风扰摆动裕量、剪枝终端最大摆动裕量和控制延迟裕量叠加确定,所述导线安全管的剩余安全距离通过剪枝系统关键点集合到导线中心线集合的最短距离扣除导线安全管半径得到,所述剪枝系统关键点集合包括无人机旋翼外缘点、连接机构外缘点、链锯导板前端点、链锯导板侧缘点、链条运动区域点和预测断枝轨迹采样点。
14、优选的,候选切割截面的生成过程包括沿目标树枝中心线按设定轴向间距截取树枝局部点云,计算截取位置的局部直径、截面法向、截面曲率、截面至导线安全管的距离、导板入口空间、无人机悬停空间、连接机构剩余缓冲行程和断枝释放方向,并剔除局部直径大于80mm、导板入口空间小于链锯导板几何包络、无人机悬停空间与导线安全管相交、连接机构剩余缓冲行程小于设定行程阈值、断枝释放方向穿过导线安全管的截取位置。
15、优选的,两级低扰动触探包括第一触探位移和第二触探位移,第二触探位移大于第一触探位移,所述折算柔度根据第一触探位移下目标树枝局部位移向量、第二触探位移下目标树枝局部位移向量、第一触探位移下估算得到的接触力向量和第二触探位移下估算得到的接触力向量确定,所述受力让位方向根据第二触探位移下目标树枝局部位移向量与第一触探位移下目标树枝局部位移向量之间的差值方向确定。
16、优选的,所述候选受迫切割对位廊道包括导板进入段、初始切缝段、稳定切削段、断枝卸载段和安全退出段,所述导板进入段由无人机预对位悬停位置延伸至目标树枝外侧入口,所述初始切缝段由目标树枝外表面延伸至预设初始切缝深度,所述稳定切削段由预设初始切缝深度延伸至残余连接截面第一阈值对应的切削位置,所述断枝卸载段由残余连接截面第一阈值对应的切削位置延伸至残余连接截面第二阈值对应的切削位置,所述安全退出段由断枝释放位置沿远离导线安全管方向延伸至导板退出位置。
17、优选的,所述综合评价值由链锯导板有效切削点与目标切割截面中心之间的位置误差、链锯导板切削平面与目标切割截面之间的角度误差、候选受迫切割对位廊道与导线安全管之间的安全风险、链锯导板沿候选受迫切割对位廊道推进时的卡滞风险、沿候选受迫切割对位廊道切削时对无人机俯仰姿态、横滚姿态和偏航姿态形成的扰动风险、树枝断离时的释放风险以及候选受迫切割对位廊道对应的切削收益共同确定。
18、优选的,所述链锯导板的空间位姿根据世界坐标系、无人机机体坐标系、机载连接机构坐标系和链锯导板工具坐标系之间的齐次变换关系确定,所述世界坐标系以作业区导线中心线和地理定位信息为基准,所述无人机机体坐标系以无人机质心为原点,所述机载连接机构坐标系以连接机构承载中心为原点,所述链锯导板工具坐标系以导板有效切削段中心为原点。
19、优选的,所述链锯导板相对于目标受迫切割对位廊道中心线的总对位误差被分配为无人机机体运动的低频误差分量、连接机构缓冲和重心补偿的中频误差分量以及链锯导板姿态微调机构的高频误差分量,无人机根据低频误差分量调整预对位悬停位置,连接机构根据中频误差分量调整缓冲行程和重心补偿位置,链锯导板姿态微调机构根据高频误差分量调整导板横向姿态和切入角。
20、优选的,所述切缝锁定误差由链条正向切削侧负载电流与链条反向回程侧负载电流之间的差异、导板振动主方向与目标受迫切割对位廊道当前切削位置法向之间的差异、导板横向受力估计值共同确定,当切缝锁定误差低于切缝锁定阈值时,链锯导板进入稳定切削阶段,当切缝锁定误差达到姿态修正阈值时,降低链锯导板进给速度并输出导板横向姿态修正量,当切缝锁定误差达到卡滞保护阈值时,停止链锯导板进给并触发链条张力释放机构。
21、优选的,所述链锯导板进给速度根据链锯电机电流估算得到的链锯切削阻力、无人机机体角速度、切缝锁定误差和导线安全管剩余安全距离更新,所述残余连接截面根据目标树枝在切割截面处的初始截面积、目标树枝在切割截面处的直径、链锯导板嵌入树枝的深度、电机负载积分和目标树枝自由端速度估算,当残余连接截面低于第一阈值时,降低链锯导板进给速度并提高连接机构阻尼,当残余连接截面低于第二阈值时,控制无人机沿远离导线安全管方向退让并控制链锯导板沿目标受迫切割对位廊道的安全退出段撤出。
22、本发明提供了一种无人机剪枝终端精准对位作业方法,具备以下有益效果:
23、1、本发明通过导线安全管构建步骤,将无人机旋翼外缘、连接机构外缘、链锯导板前端、链锯导板侧缘、链条运动区域和预测断枝轨迹采样点统一纳入导线安全距离判断,不再仅以无人机机体位置作为安全判断依据,使输电线路附近机载剪枝作业的安全边界更加完整,降低链锯导板、连接机构或断枝轨迹侵入导线安全范围的风险。
24、2、本发明通过两级低扰动触探步骤,在正式切削前获得目标树枝的折算柔度和受力让位方向,使目标树枝由静态视觉目标转化为具有受力响应特性的柔性作业对象,在树枝受风扰、旋翼气流和链锯接触力影响发生位移时修正切割路径,降低剪枝终端与目标切割截面之间的对位偏差。
25、3、本发明通过受迫切割对位廊道生成步骤,将目标切割截面、链锯导板切入方向、树枝受力让位方向、导线安全管、无人机姿态限制和连接机构缓冲余量统一为连续三维切割通道,使无人机、连接机构和链锯导板围绕同一目标受迫切割对位廊道进行协同控制,提高剪枝终端接近、切入、切削和退出全过程中的轨迹一致性。
26、4、本发明通过无人机低频悬停、连接机构中频缓冲和链锯导板高频姿态微调的三级分频协同控制,使无人机承担大尺度空间位置保持,连接机构承担力矩缓冲和重心补偿,链锯导板姿态微调机构承担切入角和横向姿态修正,从控制频段上减少无人机直接跟随树枝高频摆动造成的姿态超调,同时降低链锯导板偏刃和弹跳风险。
27、5、本发明通过切缝锁定式内部对位步骤,在链锯导板进入树枝且外部视觉受到枝叶、木屑或导板遮挡后,仍能够根据链条两侧负载差异、导板振动方向和导板横向受力判断导板是否位于切缝中心,并对导板横向姿态和进给速度进行调整,从而降低扩缝、卡滞、夹锯和链条冲击的概率。
28、6、本发明通过残余连接截面估算和断枝卸载退出步骤,在目标树枝接近断离时降低链锯导板进给速度、提高连接机构阻尼并控制无人机沿远离导线安全管方向退让,使断枝释放过程中的甩动、反冲和导板夹持被提前抑制,提高输电线路树障清理作业的安全性和连续性。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com