目标跟踪方法、装置和系统制造方法及图纸
【技术实现步骤摘要】
本专利技术涉及无人驾驶飞行器
，尤其涉及一种目标跟踪方法、装置和系统。
技术介绍
无人飞行器(也称为无人机、无人驾驶飞行器等)是一种以无线电遥控或者在自主、半自主程序控制下的不载人的飞行器。由于其成本较低，无人员伤亡风险，机动性好等优势，其在各类航空拍摄、地质测量、线路巡检、应急救援等领域应用广泛。其中，无人机凭借其独特的机动优势，大量应用于航空拍摄中。随着智能化技术发展，人们对无人飞行器的智能功能提出了更高的要求，如要求无人机对被摄目标自动跟踪等。一般说来，飞行器对目标的跟踪是通过视觉传感器或者基于GPS标准定位实现的。例如专利申请CN105100728A、专利CN103149939B的方案，均使用视觉传感器作为目标跟踪传感器。专利申请CN104965522A的方案是基于GPS标准定位实现的。但是，现有的视频识别系统构成复杂，在视线短时被遮挡或者目标高速运动的情况下算法会丢失目标，有一定的局限性。采用视觉传感器作为目标跟踪传感器，其跟踪算法冗长，不利于无人机机载系统集成。基于GPS定位的目标跟踪系统定位和跟踪精度不高，难以实现被摄目标在拍摄设备中的影响稳定锁定。
技术实现思路
技术问题有鉴于此，本专利技术要解决的技术问题是，提供一种新的目标跟踪方法、装置与系统，能够提高无人机在拍摄过程中的定位和跟踪精度。解决方案为了解决上述技术问题，本专利技术提供一种目标跟踪方法，包括：
【技术保护点】
一种目标跟踪方法，其特征在于，包括：根据被摄目标和飞行器的位置信息建立参考坐标系，得到在所述参考坐标系下从所述被摄目标到所述飞行器的第一位置矢量；根据所述飞行器的当前姿态信息，计算在所述参考坐标系下从所述飞行器的天线位置到云台位置的方向矢量；根据所述第一位置矢量和所述方向矢量，计算在所述参考坐标系下从所述被摄目标到所述云台位置的第二位置矢量，并将所述第二位置矢量转换为所述飞行器的目标姿态信息；根据所述飞行器的当前姿态信息和目标姿态信息，得到目标控制量，所述目标控制量用于指示对云台运动控制的调整量。
【技术特征摘要】
1.一种目标跟踪方法，其特征在于，包括：
根据被摄目标和飞行器的位置信息建立参考坐标系，得到在所述参考坐
标系下从所述被摄目标到所述飞行器的第一位置矢量；
根据所述飞行器的当前姿态信息，计算在所述参考坐标系下从所述飞行
器的天线位置到云台位置的方向矢量；
根据所述第一位置矢量和所述方向矢量，计算在所述参考坐标系下从所
述被摄目标到所述云台位置的第二位置矢量，并将所述第二位置矢量转换为
所述飞行器的目标姿态信息；
根据所述飞行器的当前姿态信息和目标姿态信息，得到目标控制量，所
述目标控制量用于指示对云台运动控制的调整量。
2.根据权利要求1所述的方法，其特征在于，根据被摄目标和飞行器的
位置信息建立参考坐标系，得到在所述参考坐标系下从所述被摄目标到所述
飞行器的第一位置矢量，包括：
从所述被摄目标的GNSS信标获取所述被摄目标在地理坐标系下的位置
信息；
从所述飞行器的GNSS接收机及天线获取所述飞行器在地理坐标系下的
位置信息；
根据所述被摄目标和所述飞行器在所述地理坐标系下的位置信息建立
所述参考坐标系，得到所述第一位置矢量。
3.根据权利要求2所述的方法，其特征在于，根据所述被摄目标和所述
飞行器在所述地理坐标系下的位置信息建立所述参考坐标系，得到所述第一
位置矢量，包括：
根据所述被摄目标在所述地理坐标系下的位置信息Pt(lont,latt,heit)，
和所述飞行器所述地理坐标系下的位置信息Pu(lonu,latu,heiu)，采用下式1
和式2建立所述参考坐标系，得到所述第一位置矢量A1(x1,y1,z1)，
x1＝(lonu-lont)*cos(latt)*lon0式1，
y1＝(latu-latt)*lat0式2，
z1＝heiu-heit式3，
其中，lon0＝2*π*a/360，lat0＝(2*π*c+4*(a-c))/360，π为圆周率，a为地
球长轴半径，c为地球短轴半径，lon表示经度、lat表示维度、hei表示高度，
t表示所述被摄目标，u表示所述飞行器，cos()表示余弦函数，x1、y1、z1表
示所述参考坐标系下的坐标值。
4.根据权利要求1至3中任一项所述的方法，其特征在于，根据所述飞
行器的当前姿态信息，计算在所述参考坐标系下从所述飞行器的天线位置到
云台位置的方向矢量，包括：
从姿态传感器获得所述飞行器的当前姿态信息；
根据所述飞行器的当前姿态信息，计算在所述参考坐标系下从所述飞行
器的天线相位中心到云台运动中心的方向矢量。
5.根据权利要求4所述的方法，其特征在于，根据所述飞行器的当前姿
态信息，计算在所述参考坐标系下从所述飞行器的天线相位中心到云台运动
中心的方向矢量，包括：
根据所述飞行器的当前姿态信息Attiu(Pitchu,Rollu,Yawu),，采用下式3
至式5，计算在所述参考坐标系下从所述飞行器的天线相位中心到云台运动
中心的方向矢量dA’(dx’,dy’,dz’)，
dx’＝dx(cos(Rollu)cos(Yawu)-sin(Pitchu)sin(Rollu)sin(Yawu))-dy(cos(Pitchu)sin(
Yawu))+dz(sin(Rollu)cos(Yawu)+sin(Pitchu)cos(Rollu)sin(Yawu))式3，
dy’＝dx(cos(Rollu)sin(Yawu)-sin(Pitchu)sin(Rollu)cos(Yawu))-dy(cos(Pitchu)cos(
Yawu))+dz(sin(Rollu)sin(Yawu)+sin(Pitchu)cos(Rollu)cos(Yawu))式4，
dz’＝dx(-cos(Pitchu)sin(Rollu))-dy(sin(Pitchu)+dz(cos(Pitchu)cos(Rollu))式5，
其中，Pitchu表示飞行器u的当前俯仰角,Rollu表示飞行器u的当前翻滚
\t角,Yawu表示飞行器u的当前偏航角，sin()表示正弦函数；
dA(dx,dy,dz)表示天线相位中心到云台运动中心的方向矢量在所述飞
行器的机体坐标系下坐标值。
6.根据权利要求5所述的方法，其特征在于，根据所述第一位置矢量和
所述方向矢量，计算在所述参考坐标系下从所述被摄目标到所述云台位置的
第二位置矢量，并将所述第二位置矢量转换为所述飞行器的目标姿态信息，
包括：
根据所述第一位置矢量A1(x1,y1,heiu-heit)和所述方向矢量
dA’(dx’,dy’,dz’)，计算从所述被摄目标到云台运动中心的第二位置矢量A2＝(x2,y2,z2)＝(A1+dA’)；
采用下式6，将所述第二位置矢量转换为所述飞行器的在机体坐标系下
的目标姿态信息Attic(Pitchc,Rollc,Yawc)：
Attic(Pitchc,Rollc,Yawc)＝(arcsin(x2/|A2|),arcsin(y2/|A2|),arcsin(z2/|A2|))式6，
其中，arcsin()为反正弦函数。
7.根据权利要求6所述的方法，其特征在于，根据所述飞行器的当前姿
态信息和目标姿态信息，得到目标控制量，包括：
根据所述飞行器的当前姿态信息Attiu(Pitchu,Rollu,Yawu)和目标姿态
信息，采用下式7得到三轴云台的目标控制量Output，
Output＝(Pitchc-Pitchu,Rollc-Rollu,Yawc-Yawu)式7。
8.一种目标跟踪装置，其特征在于，包括：
第一位置矢量模块，用于根据被摄目标和飞行器的位置信息建立参考坐
标系，得到在所述参考坐标系下从所述被摄目标到所述飞行器的第一位置矢
量；
方向矢量模块，用于根据所述飞行器的当前姿态信息，计算在所述...
【专利技术属性】
技术研发人员：高鹏，朱棣，
申请(专利权)人：北京博瑞爱飞科技发展有限公司，
类型：发明
国别省市：北京;11
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。