1.一种垂直起降无人机在移动平台上自主着陆的控制方法,其特征在于,包括以下步骤:S1:建立垂直起降无人机的动力学模型、移动平台的运动学模型以及垂直起降无人机与移动平台的相对运动学模型;
S2:设计预定性能规范误差变换方法;
S3:采用基于预定性能规范误差变换方法的反演控制方法设计得到垂直起降无人机的位置控制律;
S4:设计期望旋转矩阵,及期望角速度;
S5:计算垂直起降无人机在移动平台上自动着陆所需要的力矩,实现自主着陆控制。
2.根据权利要求1所述的一种垂直起降无人机在移动平台上自主着陆的控制方法,其特征在于,所述步骤S1包括以下步骤:S11:建立垂直起降无人机的动力学模型,模型描述为:其中,p=[px,py,pz]Τ是垂直起降无人机在世界坐标系中的三维位置, 是p的一阶微分,v=[vx,vy,vz]Τ是垂直起降无人机在世界坐标系下的线速度,是v的一阶微分,Ω=[Ωx,Ωy,Ωz]Τ是垂直起降无人机在本体坐标系下的角速度,Ω∧表示角速度的斜对称矩阵,使得RΩ∧=R×Ω,m和J=diag(J1,J2,J3)分别表示垂直起降无人机的质量和惯性矩阵,g是重力加速度,i3=[0,0,1]Τ是单位向量,f和τ=[τx,τy,τz]Τ分别为推力和扭力,R是旋转矩阵,由垂直起降无人机沿欧拉角ψ,φ,θ旋转得到,ψ,φ,θ分别表示为偏航角,滚转角与俯仰角;
S12:建立移动平台的运动学模型,模型描述为:其中,rl=[xl,yl,h]T表示移动平台在世界坐标系中的位置,xl是移动平台的横坐标,yl是移动平台的纵坐标,h是移动平台的高度,θl是移动平台本体坐标系相对于世界坐标系的旋转角度,vl和ωl分别表示移动平台的线速度和角速度;
S13:建立垂直起降无人机与移动平台的相对运动学模型,模型描述为:rlp=p-rl (6)其中,rlp=[xlp,ylp,zlp]Τ是垂直起降无人机和移动平台的实时相对三维位置。
3.根据权利要求1所述的一种垂直起降无人机在移动平台上自主着陆的控制方法,其特征在于,所述步骤S2预定性能规范误差变换方法为:其中,ζk=ek/ρk,ek为定义的误差,εk为变换后的误差,ρk为误差性能函数,k∈{1,2,…
6}。
4.根据权利要求3所述的一种垂直起降无人机在移动平台上自主着陆的控制方法,其特征在于,所述步骤S3包括以下步骤:S31:垂直起降无人机搭载的单目视觉装置捕获移动平台上设置的AprilTag视觉系统中的AprilTag视觉标志信息,根据已知的AprilTag视觉标志物理尺寸,由单应矩阵得到垂直起降无人机和移动平台之间的实时相对三维位置rlp=[xlp,ylp,zlp]Τ和姿态信息;
Τ
S32:定义位置误差ep=[e1,e2,e3] 为:其中, 表示期望的相对位置;
S33:根据预定性能规范误差变换方法,得到变换后的位置误差εp=[ε1,ε2,ε3]Τ;
S34:对变换后的位置误差求一阶微分式可得:其中,是rl的一阶微分,并且Q=diag(q1,q2,q3)与η=(η1,η2,η3)Τ分别被定义为:为ρk的一阶微分;
S35:设置虚拟期望垂直起降无人机的线速度为 依据式(9),得到虚拟期望垂直无人机的线速度控制律为:
其中,K1、K2均为中间控制器的增益;
S36:定义速度误差ev=[e4,e5,e6]Τ为:S37:根据预定性能规范误差变换方法,得到变换后的速度误差εv=[ε4,ε5,ε6]Τ,对变换后的速度误差求一阶微分式可得:Τ
其中,Qv=diag(q4,q5,q6)与ηv=(η4,η5,η6) 分别被定义为:S38:依据式(14)及式(2),设计位置控制律为:Τ -1
u=-(K3Qv +Qv K4)εv (17)其中,K3,K4是正定矩阵。
5.根据权利要求4所述的一种垂直起降无人机在移动平台上自主着陆的控制方法,其特征在于,所述步骤S4,具体包括以下步骤:S41:设置期望旋转角度ψ*=0;
S42:根据推力向量F=mgi3-mu和期望旋转角度向量y=[cosψ*,sinψ*,0]Τ,设计期望旋转矩阵为Rd=[r1,r2,r3],其中S44:推力向量的一阶微分式表示为 使用一阶低通滤波器求取 一阶低通滤波器形式如下:
其中,Kα是一个正定对称矩阵;
S43:期望角速度表示为:
其中,(·)∨表示为(·)∧的逆操作, 为期望旋转矩阵Rd的一阶微分式, 表示为:
I3×3是3阶单位矩阵。
6.根据权利要求5所述的一种垂直起降无人机在移动平台上自主着陆的控制方法,其特征在于,所述步骤S5具体包括以下步骤:S51:将式(2)改写为:
依据式(17),则垂直起降无人机的饱和推力设计为:S52:旋转矩阵的误差项定义如下:
eΩ=Ω-RΤRdΩd (26)其中,Rd为期望旋转矩阵,R为实际旋转矩阵,eR为旋转矩阵误差;Ωd为期望角速度,Ω为实际角速度,eΩ为角速度误差;
S53:结合式(4)、式(25)、式(26),得到垂直起降无人机的力矩为:τ=-KReR-KΩeΩ+Ω×JΩ (26)其中,KR、KΩ为姿态控制增益。
7.一种垂直起降无人机在移动平台上自主着陆的系统,其特征在于,所述系统包含垂直起降无人机、单目视觉装置、自主着陆控制模块、AprilTag视觉基准系统、移动平台,其中:所述单目视觉装置与所述自主着陆控制模块相连,单目视觉装置将采集的图像信息发送给自主着陆控制模块;
所述自主着陆控制模块与所述垂直起降无人机相连,将控制指令发送给垂直起降无人机;
所述移动平台上设置AprilTag视觉基准系统;
所述AprilTag视觉基准系统处于单目视觉装置视角范围内。
8.根据权利要求7所述的一种垂直起降无人机在移动平台上自主着陆的系统,其特征在于,所述垂直升降无人机为四旋翼无人机。
9.根据权利要求8所述的一种垂直起降无人机在移动平台上自主着陆的系统,其特征在于,所述单目视觉装置为单目相机。