一种基于运动学习的四旋翼无人机电塔巡检方法技术

本发明专利技术公开了一种基于运动学习的四旋翼无人机电塔巡检方法，首先对四旋翼无人机的三维运动引入学习框架，将一次电塔巡检飞行任务轨迹作为运动学习的样本，基于动力学方程提取出其运动基元；进而基于学习到的运动基元可推广到新的电塔巡检飞行任务，泛化出相应的运动轨迹；当规划的飞行轨迹上有障碍物时，在已有学习基础上通过设计耦合因子从而规划出三维避障轨迹；最终可将得到的可行巡检轨迹用于四旋翼无人的自主飞行。本发明专利技术所提出的方法将从四旋翼无人机运动学习的角度出发，基于学习得到的运动基元对新的电塔巡检飞行任务进行三维轨迹规划，完善了四旋翼无人机的自主轨迹规划的方法，有望提高电塔巡检效率。

An electric tower inspection method for four rotor UAVs based on motion learning

The invention discloses a UAV power tower inspection method based on motor learning four rotor, the first 3D motion of the four rotor UAV into the learning framework, a power tower inspection flight trajectory as motor learning samples are extracted from the dynamic equations of motion primitives based on motion primitives; then based on learning the power tower inspection can be extended to new missions, a generalization of corresponding motion track; when there is an obstacle on the flight trajectory planning, in the existing learning based on the design of coupling factors to plan three-dimensional obstacle avoidance trajectory; finally the feasible inspection trajectory is obtained for four rotor unmanned autonomous flight. This method from the four rotor UAV motion learning perspective, learning the motion primitives of power tower inspection mission of new three-dimensional trajectory planning method based on autonomous trajectory planning to improve the four rotor UAV, is expected to improve the efficiency of power tower inspection.

【技术实现步骤摘要】
一种基于运动学习的四旋翼无人机电塔巡检方法
本专利技术涉及一种基于运动学习的四旋翼无人机电塔巡检方法，属于无人机轨迹规划

技术介绍
近年来，四旋翼无人机以其简单的机械结构和独特的飞行方式而成为无人机研究领域中的热点。它是一种非共轴多旋翼式飞行器，由于其特殊的设计结构，使得其可以实现多种飞行姿态。通过调节对称分布的四个旋翼转速，实现对飞行姿态的控制。与常规直升机相比，四个旋翼提供升力比单旋翼更均匀，因而飞行更加平稳且机动性更强。四旋翼无人机体积小、隐蔽性好、飞行平稳，特别适合近侦查、监视等民用和军用领域。在民用领域，四旋翼无人机主要被应用于地面检测、抗灾救险、高空拍摄等；在军用领域，主要被用于军事侦查、战场监控、情报收集等。在电力系统中，电塔是电网输电的重要基础设施，电塔的维护及质量检测是现代电力系统运行与发展的重要保障。过去通过人工攀爬检查电塔，登塔难度高危险性较大。与人工攀爬检查方式不同，四旋翼无人机可轻松到达距离地面80多米高的塔顶，实现全方位高清拍摄，从而大大降低了巡检难度和危险性。所以四旋翼无人机被广泛应用于电塔电网巡检。但是，无人机技术密集及协同性强，使它的操纵越来越复杂；随着现代电塔巡检飞行任务的强度、难度的不断增加，飞行操作手在生理和心理上会受到影响，单纯依靠手控操作完成复杂的电塔巡检任务变得越来越困难；因此三维轨迹规划显得至关重要。然而现有的三维空间轨迹规划算法均在环境建模的基础上添加诸多的约束条件通过各种算法搜索飞行路径，搜索到路径的优越性依赖于环境模型的精确程度及算法的实时性和有效性，这样的规划方式不完全适合电塔巡检的无人机轨迹规划任务，搜索与规划路径的效率不高。
技术实现思路
针对上述现有技术问题，本专利技术要解决的技术问题是：提供一种基于运动学习的四旋翼无人机电塔巡检方法，使得四旋翼无人机具备自主巡检电塔的能力，将人从复杂和繁重遥控任务解脱出来，并提高四旋翼无人机电塔巡检的效率。为解决上述技术问题，本专利技术采用如下技术方案：一种基于运动学习的四旋翼无人机电塔巡检方法，其特征在于具体包括如下步骤：步骤S1：运动学习过程：通过遥控器示教四旋翼无人机完成一次具体的电塔巡检任务，收集该具体的电塔巡检任务三维轨迹序列作为运动学习样本，基于动力学方程和运动学习样本提取运动基元；所述三维轨迹序列即三个自由度的位移、速度、加速度信息；步骤S2：泛化过程：为新的电塔巡检任务设定起点终点，根据动力学方程和提取的运动基元泛化出新巡检任务的三维轨迹序列，将新的三维轨迹序列作为导航路径给四旋翼无人机完成电塔巡检任务，若新的电塔巡检任务中没有障碍物则步骤S2后规划结束；若新的电塔巡检任务的规划路径上有障碍物，则进入步骤S3；步骤S3：先确定障碍物大致的中心位置坐标，然后在已有学习基础上通过设计耦合因子重新规划出可行三维避障轨迹；最后将规划出的可行避障轨迹给四旋翼无人机完成自主电塔巡检任务。上述技术方案中，步骤S1提取运动基元时，引入带有恒定系数线性微分方程，将四旋翼无人机的点到点运动描述为一种带有非线性强制项的动力学系统模型；通过遥控器示教四旋翼无人机完成一次具体的电塔巡检任务，基于四旋翼无人机内部的位置估计模块，分别获取四旋翼无人机上升阶段和下降阶段起点到终点三个自由度各自位移、速度和加速度的序列，基于获得的学习样本和动力学系统模型分别提取四旋翼无人机上升和下降阶段的运动基元序列，提取到的基元序列作为后续步骤中自主规划路径的基础。上述技术方案中，步骤S2中，设定新的电塔巡检任务起点和终点，将学到的运动基元带入有非线性强制项的动力学系统模型，并使用同一正则系统，泛化出一条离散的运动轨迹点，即为所需的电塔巡检路径，若新的巡检任务无障碍物则步骤S2后规划结束，将规划的轨迹点给四旋翼无人机完成电塔巡检任务；上述技术方案中，步骤S3通过在动力学方程中设计耦合因子，在原有的运动基元和动力学方程基础上重新泛化出可行三维轨迹序列，将三维轨迹序列作为电塔巡检的导航路径给四旋翼无人机完成自主电塔巡检任务。上述技术方案中，步骤S3详细步骤如下：步骤S31：设定在上升阶段和下降阶段，在三维笛卡尔空间中从起点到目标点的运动过程中有障碍物，首先确定障碍物大致中心为o＝[o1o2o3]T，在带有非线性强制项的动力学系统模型中加入耦合因子Ct从而构建带避障功能的动力学系统；对于三个自由度的运动，各自带避障功能的动力学系统有其各自的耦合因子Ct＝[Ct,1Ct,2Ct,3]T，Ct,j(j＝1,2,3)；耦合因子中加入了一个垂直于当前速度方向的运动，是距离矢量与速度矢量的函数；其中其中μ为速度向量与障碍物中心坐标和当前位置坐标差向量(o-y)的夹角；R为旋转矩阵，决定运动轨迹绕障碍物的旋转方向，k和β为常量。步骤S32：在三个自由度各自的动力学方程中，均添加各自的耦合因子构建带避障功能的动力学系统；根据各个自由度在步骤S1中所提取的运动基元，设定好起点和终点，由带避障功能的动力学系统泛化出各自自由度的轨迹序列，从而三个自由度的序列组成四旋翼无人机三维的避障轨迹，进而无人机根据规划路径完成电塔巡检任务。综上所述，本专利技术公开了一种基于运动学习的四旋翼无人机电塔巡检方法，针对一次电塔巡检任务的运动进行学习，对四旋翼无人机的三维运动引入学习框架，将一次电塔巡检飞行任务轨迹作为运动学习的样本，基于动力学方程提取出其运动基元；进而基于学习到的运动基元可推广到新的电塔巡检飞行任务，对于新的电塔巡检任务，则可通过已学习的运动基元在设定起点和终点后泛化出可行的轨迹点；若新的电塔巡检路径上有障碍物，则可通过在原有的学习基础上设计耦合因子重新规划出可行的避障路径；最后将规划出的轨迹点提供给四旋翼无人机用于四旋翼无人的自主飞行完成电塔巡检。对比传统的无人机路径规划方法如蚁群算法、粒子群算法、A*算法等，本专利技术方法特有之处在于：(1)引入了运动学习机制，基于这样一种机制，四旋翼无人机不仅能够复制其学习到的运动，而且能够泛化出满足不同目标点的路径完成三维空间飞行任务，同时能够进行避障。(2)传统的无人机路径规划方法由于未引入学习机制，面对相同或相似的环境原先的规划结果并没有对现有的规划有任何帮助。从而本方法摆脱传统的三维路径规划对环境建模与搜索算法性能的依赖，完善了四旋翼无人机的自主轨迹规划的方法，提高了四旋翼无人机的轨迹规划能力和电塔巡检效率。附图说明图1是本专利技术四旋翼无人机电塔巡检示教示意图；图2是本专利技术四旋翼无人机自主规划三维轨迹进行电塔巡检示意图；图3是本专利技术四旋翼无人机自主规划三维避障轨迹进行电塔巡检示意图；图4是本专利技术基于运动学习的四旋翼无人机电塔巡检方法运动学习及泛化过程；图5是本专利技术四旋翼无人机的多自由度运动学习原理图(以三个自由度为例)。具体实施方式下面结合附图和实例对本专利技术作更进一步的说明。本专利技术所提出的方法首先需要对一次具体的电塔巡检任务进行学习，图1是四旋翼无人机电塔巡检示教示意图。如图1所示，电塔巡检过程分为上升过程(实现)和下降过程(虚线)；上升过程中起点为点A，终点为点B；下降过程中起点为点B，终点为点C。由于上升过程和下降过程是起点和终点不同，并且是两种不同的运动形式，因此需要单独对同种性质的运动进行分析，本文仅以上升过程本文档来自技高网...

【技术保护点】
一种基于运动学习的四旋翼无人机电塔巡检方法，其特征在于具体包括如下步骤：步骤S1：运动学习过程：通过遥控器示教四旋翼无人机完成一次具体的电塔巡检任务，收集该具体的电塔巡检任务三维轨迹序列作为运动学习样本，基于动力学方程和运动学习样本提取运动基元；所述三维轨迹序列即三个自由度的位移、速度、加速度信息；步骤S2：泛化过程：为新的电塔巡检任务设定起点终点，根据动力学方程和提取的运动基元泛化出新巡检任务三维轨迹序列，将产生的三维轨迹序列作为导航路径给四旋翼无人机完成电塔巡检任务，若新的电塔巡检任务中没有障碍物则步骤S2后规划结束；步骤S3：若新的电塔巡检任务的规划路径上有障碍物，首先确定障碍物大致的中心位置坐标，然后在已有学习基础上通过设计耦合因子重新规划出可行三维避障轨迹；最后将规划出的可行避障轨迹给四旋翼无人机完成自主电塔巡检任务。

【技术特征摘要】
1.一种基于运动学习的四旋翼无人机电塔巡检方法，其特征在于具体包括如下步骤：步骤S1：运动学习过程：通过遥控器示教四旋翼无人机完成一次具体的电塔巡检任务，收集该具体的电塔巡检任务三维轨迹序列作为运动学习样本，基于动力学方程和运动学习样本提取运动基元；所述三维轨迹序列即三个自由度的位移、速度、加速度信息；步骤S2：泛化过程：为新的电塔巡检任务设定起点终点，根据动力学方程和提取的运动基元泛化出新巡检任务三维轨迹序列，将产生的三维轨迹序列作为导航路径给四旋翼无人机完成电塔巡检任务，若新的电塔巡检任务中没有障碍物则步骤S2后规划结束；步骤S3：若新的电塔巡检任务的规划路径上有障碍物，首先确定障碍物大致的中心位置坐标，然后在已有学习基础上通过设计耦合因子重新规划出可行三维避障轨迹；最后将规划出的可行避障轨迹给四旋翼无人机完成自主电塔巡检任务。2.根据权利要求1所述的基于运动学习的四旋翼无人机电塔巡检方法，其特征在于：步骤S1提取运动基元时，引入带有恒定系数线性微分方程，将四旋翼无人机的点到点运动描述为一种带有非线性强制项的动力学系统模型；通过遥控器示教四旋翼无人机完成一次具体的电塔巡检任务，基于四旋翼无人机内部的位置估计模块，分别获取四旋翼无人机上升阶段和下降阶段起点到终点三个自由度各自位移、速度和加速度的序列，基于获得的学习样本和动力学系统模型分别提取四旋翼无人机上升和下降阶段的运动基元序列，提取到的基元序列作为后续步骤中自主规划路径的基础。3.根据权利要求1所述的基于运动学习的四旋翼无人机电塔巡检方法，其特征在于：步骤S2中，设定新的电塔巡检任务起点和终点，将学到的运动基元带入有非...

【专利技术属性】
技术研发人员：吴怀宇，陈鹏震，牛洪芳，钟锐，刘友才，程果，
申请(专利权)人：武汉科技大学，
类型：发明
国别省市：湖北,42