1.基于前馈补偿PID控制的无人机复杂动态目标追踪方法,其特征在于,包括以下步骤:
S1、对移动目标进行识别抓取,得到像素点误差数据;
S2、通过对所述像素点误差数据融合无人机高度数据和对无人机姿态角变化补偿,得出无人机与目标物水平横滚方向及俯仰方向的相对距离;
S3、对移动目标的速度进行计算,将补偿后的无人机与目标物水平横滚方向及俯仰方向的相对距离作为串级PID控制系统的输入误差变量,并加入移动目标速度作为前馈补偿量以实现无人机与移动目标相对静止。
2.如权利要求1所述的基于前馈补偿PID控制的无人机复杂动态目标追踪方法,其特征在于,步骤S2中,通过以下公式进行补偿:ΔX0=H×Δx×M
ΔY0=H×Δy×M
Δx'=H×sinθ
ΔX1=ΔX0‑Δx'
ΔY1=ΔY0‑Δy'
其中,H为无人机离地高度;ΔX0表示补偿前在高度H上无人机处于水平状态下,移动目标与无人机对应的水平横滚方向的相对距离;Δx为x方向像素点误差数据;M为单位像素点在一米高度对应地面偏移的位移;ΔY0表示补偿前在H高度上无人机处于水平状态下,移动目标与无人机对应的俯仰方向的相对距离;Δy为y方向像素点误差数据;(Δx’,Δy’)为无人机姿态角变化带来的移动目标偏差;ΔX1为补偿后的移动目标与无人机对应的水平横滚方向的相对距离;ΔY1为补偿后的移动目标与无人机对应的俯仰方向的相对距离。
3.如权利要求2所述的基于前馈补偿PID控制的无人机复杂动态目标追踪方法,其特征在于,所述高度H通过激光传感器直接读取。
4.如权利要求1所述的基于前馈补偿PID控制的无人机复杂动态目标追踪方法,其特征在于,通过以下公式对移动目标的速度进行计算:V目标=v1+v2
其中,V目标为移动目标与地面的相对运动速度,v1为无人机水平横滚方向或俯仰方向的速度,v2为无人机与运动目标在水平横滚方向或俯仰方向的相对速度。
5.如权利要求4所述的基于前馈补偿PID控制的无人机复杂动态目标追踪方法,其特征在于,通过光流传感器直接读取无人机水平横滚方向或俯仰方向的速度v1。
6.如权利要求4所述的基于前馈补偿PID控制的无人机复杂动态目标追踪方法,其特征在于,利用误差微分变量得到无人机与运动目标在水平横滚方向或俯仰方向的相对速度v2。
7.如权利要求1所述的基于前馈补偿PID控制的无人机复杂动态目标追踪方法,其特征在于,步骤S1包括:利用图像处理元器件openmv对移动目标进行识别抓取。
8.如权利要求7所述的基于前馈补偿PID控制的无人机复杂动态目标追踪方法,其特征在于,所述图像处理元器件openmv通过串口的连接方式与无人机飞控主板连接,且水平放置于无人机正下方,镜头垂直朝下,镜头模块部分朝向无人机机头方向。
9.如权利要求7所述的基于前馈补偿PID控制的无人机复杂动态目标追踪方法,其特征在于,所述图像处理元器件openmv对拍摄的视野内进行红色色块识别,通过手动设定需要读取色块的RGB阈值区间;若无法找到对应色块,则手动对设定的色块进行阈值调整,直到稳定清晰地显示色块。
10.如权利要求7所述的基于前馈补偿PID控制的无人机复杂动态目标追踪方法,其特征在于,所述图像处理元器件openmv利用库函数img.draw_rectangle对目标物框定,并且使用库函数img.draw_cross对方框正中间画十字箭头,并返回十字箭头的坐标值(x,y)。