一种无人机跟拍路径规划与跟踪方法技术

本发明专利技术公开了一种多旋翼无人机跟拍路径规划与跟踪方法，设定无人机与跟拍目标之间的相对位置参数，获得跟拍目标当前制导周期的位置，获得跟拍目标当前制导周期的速度矢量；根据无人机与跟拍目标之间的相对位置参数、跟拍目标当前制导周期的位置与速度矢量，获得无人机当前制导周期的期望位置；根据上一个制导周期计算所得目标航路点与当前制导周期内的目标航路点对当前制导周期内的目标航路点进行跟踪；相机云台根据相机云台的期望俯仰角和相机云台的期望视线偏角进行实时跟拍。本发明专利技术能够锁定无人机的拍摄视角，并能够根据需要实时改变视角；航线跟踪环节采用了航向角的比例控制，所得的无人机轨迹更为平滑。

【技术实现步骤摘要】

本专利技术涉及飞行器导航、制导与控制领域。具体涉及一种无人机跟拍路径规划与跟踪方法。适用于多旋翼无人机跟拍目标时的路径规划与路径跟踪。
技术介绍
多旋翼无人机以其结构简单、成本低廉、机动灵活等特点，使得在航拍摄影、地图测绘、侦察监视等行业的应用日趋广泛。在航拍应用中，无人机自动跟拍是一种拍摄效果良好，且对操作人员技术要求较低的一种拍摄模式，目前多旋翼无人机跟拍方式均为预先设定好无人机与跟拍目标的相对位置，跟拍目标携带定位设备并将实时位置发送至无人机，而无人机在飞行过程中保持与跟拍目标的相对位置不变，这类方案中，无人机的运行轨迹不够平滑，航拍效果因此受到影响。
技术实现思路
本专利技术的目的是针对目前存在的上述问题，提供一种无人机跟拍路径规划与跟踪方法，跟拍轨迹平滑、拍摄角度实时可调的特点，能够实现更好的航拍效果。本专利技术的上述目的通过以下技术方案实现：一种多旋翼无人机跟拍路径规划与跟踪方法，包括以下步骤：步骤1，在无人机启动跟拍飞行时设定无人机与跟拍目标之间的相对位置参数，或者跟拍飞行过程中在当前制导周期内设定无人机与跟拍目标之间的相对位置参数，相对位置参数包括当前制导周期的期望距离L、当前制导周期的期望视线俯仰角ζ、当前制导周期的期望视线偏角步骤2，获得跟拍目标当前的位置作为跟拍目标当前制导周期的位置O，获得跟拍目标当前的速度矢量作为跟拍目标当前制导周期的速度矢量步骤3，根据当前制导周期的期望距离L、当前制导周期的期望视线俯仰角ζ、当前制导周期的期望视线偏角跟拍目标当前制导周期的位置O和跟拍目标当前制导周期的速度矢量获得无人机当前制导周期的期望位置J；步骤4，以无人机当前制导周期的期望位置J为当前制导周期内的目标航路点，并根据上一个制导周期计算所得目标航路点I与当前制导周期内的目标航路点对当前制导周期内的目标航路点进行跟踪，将上一个制导周期的目标航路点I与当前制导周期内的目标航路点连线得到连线IJ，并将无人机当前的位置P向该连线IJ或其延长线投影得到当前投影点Q，通过获得点K的坐标，从而获得无人机的期望速度矢量方向其中，为当前投影点Q到无人机当前制导周期的期望位置J的矢量，点K将矢量分割为和δ为分割的比例系数，在当前制导周期中以固定的控制周期Δt对当前投影点Q和点K的坐标进行更新，无人机在当前制导周期中的各个控制周期中以对应的无人机的期望速度矢量方向进行跟踪；步骤5，根据无人机的位置P与跟拍目标当前制导周期的位置O设置无人机相机云台期望角度；步骤6，在下一个制导周期来临时，返回步骤1。如上所述的步骤3中无人机当前制导周期的期望位置J通过以下公式过得：其中，Jx,Jy,Jz分别为无人机当前制导周期的期望位置J在导航坐标系x,y,z轴上的坐标，L为当前制导周期的期望距离、ζ为当前制导周期的期望视线俯仰角、为当前制导周期的期望视线偏角，ψ为无人机航向角。如上所述的步骤5中设置无人机相机云台期望角度包括以下步骤：步骤5.1、通过以下公式求取跟拍目标当前制导周期的位置O相对于无人机当前位置P的视线俯仰角γ；则跟拍目标当前制导周期的位置O相对于无人机携带的相机云台的期望俯仰角为-γ；γ=arctan(Oz-Pz(Ox-Px)2+(Oy-Py)2)]]>Ox,Oy,Oz分别为跟拍目标当前制导周期的位置O在导航坐标系x,y,z轴上的坐标，Px,Py,Pz分别为无人机当前位置P在导航坐标系x,y,z轴上的坐标；步骤5.2、通过以下公式求取跟拍目标当前制导周期的位置O相对于无人机携带的相机云台的期望视线偏角ξ：ξ=arctan(Oy-PyOx-Px)]]>步骤5.3、相机云台根据-γ和ξ进行实时跟拍。本专利技术与现有技术相比具有以下有益效果：1、本专利技术以跟拍对象的速度矢量为参考，通过视线俯仰角和视线偏角计算无人机期望位置，因此能够锁定无人机的拍摄视角，并能够根据需要实时改变视角；而现有方案通过无人机与跟拍目标在导航坐标系中的相对位置计算无人机期望位置，无人机拍摄视角随着跟拍目标速度方向的变化而变化，需要手动进行修正。2、本专利技术在航线跟踪环节采用了航向角的比例控制，相对于现有跟拍方案中的直接飞向目标航路点，本专利技术所得的无人机轨迹更为平滑。附图说明图1无人机期望位置与跟拍目标当前位置在导航坐标系中的几何关系；图2跟拍目标当前位置相对于无人机当前位置的视线俯仰角和视线偏角；图3无人机位置投影在两个航路点连线IJ上时的航向计算示意图；图4无人机位置投影在两个航路点连线IJ延长线时的航向计算示意图。具体实施方式以下结合具体实施例对本专利技术的技术方案做进一步描述。一种多旋翼无人机跟拍路径规划与跟踪方法，包括以下几个步骤：步骤1，在无人机启动跟拍飞行时设定无人机与跟拍目标之间的相对位置参数，或者跟拍飞行过程中在当前制导周期内设定无人机与跟拍目标之间的相对位置参数。如图1所示，导航坐标系采用原点O在跟拍目标质心，x,y,z轴分别指向北、东、地的当地铅锤坐标系，其中，O为跟拍目标当前制导周期的位置，为跟拍目标当前制导周期的速度矢量，因此无人机的航向角即为跟拍目标当前制导周期的速度矢量在当地水平面上的投影与正北方向的夹角ψ，J,J'则分别为无人机当前制导周期的期望位置以及无人机当前制导周期的期望位置在导航坐标系的当地水平面上的投影点。需要设置或调整的无人机当前制导周期的期望位置与跟拍目标之间的相对位置参数包括当前制导周期的期望距离L、当前制导周期的期望视线俯仰角ζ、当前制导周期的期望视线偏角(1)无人机当前制导周期的期望位置与跟拍目标当前制导周期的位置的当前制导周期的期望距离L，由于无人机携带相机的视场大小限制以及拍摄的不同需求，无人机需要与跟拍目标保持一定的直线距离，即图1中OJ线段的长度，该距离与跟拍目标的速度、摄像机视场大小以及具体应用要求有关，需要预先设置和根据需要动态调整。(2)无人机当前制导周期的期望位置相对于跟拍目标当前制导周期的速度矢量的当前制导周期的期望视线俯仰角ζ，该角度为无人机当前制导周期的期望位置与跟拍目标当前制导周期的位置之间的连线与过导航坐标系x轴和跟拍目标当前制导周期的速度矢量的平面之间的夹角，即图1中的角度ζ，该角度决定了无人机相机以多大的角度俯拍跟拍目标，其大小与具体应用要求有关。(3)无人机当前制导周期的期望位置相对于跟拍目标当前制导周期的速度矢量的当前制导周期的期望视线偏角该角度为无人机当前制导周期的期望本文档来自技高网...

【技术保护点】
一种多旋翼无人机跟拍路径规划与跟踪方法，其特征在于，包括以下步骤：步骤1，在无人机启动跟拍飞行时设定无人机与跟拍目标之间的相对位置参数，或者跟拍飞行过程中在当前制导周期内设定无人机与跟拍目标之间的相对位置参数，相对位置参数包括当前制导周期的期望距离L、当前制导周期的期望视线俯仰角ζ、当前制导周期的期望视线偏角步骤2，获得跟拍目标当前的位置作为跟拍目标当前制导周期的位置O，获得跟拍目标当前的速度矢量作为跟拍目标当前制导周期的速度矢量步骤3，根据当前制导周期的期望距离L、当前制导周期的期望视线俯仰角ζ、当前制导周期的期望视线偏角跟拍目标当前制导周期的位置O和跟拍目标当前制导周期的速度矢量获得无人机当前制导周期的期望位置J；步骤4，以无人机当前制导周期的期望位置J为当前制导周期内的目标航路点，并根据上一个制导周期计算所得目标航路点I与当前制导周期内的目标航路点对当前制导周期内的目标航路点进行跟踪，将上一个制导周期的目标航路点I与当前制导周期内的目标航路点连线得到连线IJ，并将无人机当前的位置P向该连线IJ或其延长线投影得到当前投影点Q，通过获得点K的坐标，从而获得无人机的期望速度矢量方向其中，为当前投影点Q到无人机当前制导周期的期望位置J的矢量，点K将矢量分割为和δ为分割的比例系数，在当前制导周期中以固定的控制周期Δt对当前投影点Q和点K的坐标进行更新，无人机在当前制导周期中的各个控制周期中以对应的无人机的期望速度矢量方向进行跟踪；步骤5，根据无人机的位置P与跟拍目标当前制导周期的位置O设置无人机相机云台期望角度；步骤6，在下一个制导周期来临时，返回步骤1。...

【技术特征摘要】
1.一种多旋翼无人机跟拍路径规划与跟踪方法，其特征在于，包括以下步骤：
步骤1，在无人机启动跟拍飞行时设定无人机与跟拍目标之间的相对位置参数，
或者跟拍飞行过程中在当前制导周期内设定无人机与跟拍目标之间的相对位置参
数，
相对位置参数包括当前制导周期的期望距离L、当前制导周期的期望视线俯仰
角ζ、当前制导周期的期望视线偏角步骤2，获得跟拍目标当前的位置作为跟拍目标当前制导周期的位置O，获得
跟拍目标当前的速度矢量作为跟拍目标当前制导周期的速度矢量步骤3，根据当前制导周期的期望距离L、当前制导周期的期望视线俯仰角ζ、
当前制导周期的期望视线偏角跟拍目标当前制导周期的位置O和跟拍目标当前
制导周期的速度矢量获得无人机当前制导周期的期望位置J；
步骤4，以无人机当前制导周期的期望位置J为当前制导周期内的目标航路点，
并根据上一个制导周期计算所得目标航路点I与当前制导周期内的目标航路点对当
前制导周期内的目标航路点进行跟踪，将上一个制导周期的目标航路点I与当前制
导周期内的目标航路点连线得到连线IJ，并将无人机当前的位置P向该连线IJ或其
延长线投影得到当前投影点Q，通过获得点K的坐标，从而获得无人机的
期望速度矢量方向其中，为当前投影点Q到无人机当前制导周期的期望位置J的矢量，点K将
矢量分割为和δ为分割的比例系数，
在当前制导周期中以固定的控制周期Δt对当前投影点Q和点K的坐标进行更
新，无人机在当前制导周期中的各个控制周期中以对应的无人机的期望速度矢量方

【专利技术属性】
技术研发人员：王谦，金卫民，胡镇，胡阳，张耀，邓海，李顶根，
申请(专利权)人：武汉顶翔智控科技有限公司，江西顶翔智控科技有限公司，
类型：发明
国别省市：湖北;42