[发明专利]目标跟踪方法、装置和系统

说明书

本发明涉及一种目标跟踪方法、装置和系统，其中，该目标跟踪方法包括：根据被摄目标和飞行器的位置信息建立参考坐标系，得到在所述参考坐标系下从所述被摄目标到所述飞行器的第一位置矢量；根据所述飞行器的当前姿态信息，计算在所述参考坐标系下从所述飞行器的天线位置到云台位置的方向矢量；根据所述第一位置矢量和所述方向矢量，计算在所述参考坐标系下从所述被摄目标到所述云台位置的第二位置矢量，并将所述第二位置矢量转换为所述飞行器的目标姿态信息；根据所述飞行器的当前姿态信息和目标姿态信息，得到目标控制量，所述目标控制量用于指示对云台运动控制的调整量。本发明跟踪精度高，能够实现全天候自主跟踪。

技术领域

本发明涉及无人驾驶飞行器技术领域，尤其涉及一种目标跟踪方法、装置和系统。

背景技术

无人飞行器(也称为无人机、无人驾驶飞行器等)是一种以无线电遥控或者在自主、半自主程序控制下的不载人的飞行器。由于其成本较低，无人员伤亡风险，机动性好等优势，其在各类航空拍摄、地质测量、线路巡检、应急救援等领域应用广泛。其中，无人机凭借其独特的机动优势，大量应用于航空拍摄中。随着智能化技术发展，人们对无人飞行器的智能功能提出了更高的要求，如要求无人机对被摄目标自动跟踪等。

一般说来，飞行器对目标的跟踪是通过视觉传感器或者基于GPS标准定位实现的。例如专利申请CN105100728A、专利CN103149939B的方案，均使用视觉传感器作为目标跟踪传感器。专利申请CN104965522A的方案是基于GPS标准定位实现的。

但是，现有的视频识别系统构成复杂，在视线短时被遮挡或者目标高速运动的情况下算法会丢失目标，有一定的局限性。采用视觉传感器作为目标跟踪传感器，其跟踪算法冗长，不利于无人机机载系统集成。基于GPS定位的目标跟踪系统定位和跟踪精度不高，难以实现被摄目标在拍摄设备中的影响稳定锁定。

发明内容

技术问题

有鉴于此，本发明要解决的技术问题是，提供一种新的目标跟踪方法、装置与系统，能够提高无人机在拍摄过程中的定位和跟踪精度。

解决方案

为了解决上述技术问题，本发明提供一种目标跟踪方法，包括：

根据被摄目标和飞行器的位置信息建立参考坐标系，得到在所述参考坐标系下从所述被摄目标到所述飞行器的第一位置矢量；

根据所述飞行器的当前姿态信息，计算在所述参考坐标系下从所述飞行器的天线位置到云台位置的方向矢量；

根据所述第一位置矢量和所述方向矢量，计算在所述参考坐标系下从所述被摄目标到所述云台位置的第二位置矢量，并将所述第二位置矢量转换为所述飞行器的目标姿态信息；

根据所述飞行器的当前姿态信息和目标姿态信息，得到目标控制量，所述目标控制量用于指示对云台运动控制的调整量。

对于上述方法，在一种可能的实现方式中，根据被摄目标和飞行器的位置信息建立参考坐标系，得到在所述参考坐标系下从所述被摄目标到所述飞行器的第一位置矢量，包括：

从所述被摄目标的GNSS信标获取所述被摄目标在地理坐标系下的位置信息；

从所述飞行器的GNSS接收机及天线获取所述飞行器在地理坐标系下的位置信息；

根据所述被摄目标和所述飞行器在所述地理坐标系下的位置信息建立所述参考坐标系，得到所述第一位置矢量。

对于上述方法，在一种可能的实现方式中，根据所述被摄目标和所述飞行器在所述地理坐标系下的位置信息建立所述参考坐标系，得到所述第一位置矢量，包括：