1.一种四旋翼无人机分数阶递推滑模轨迹跟踪控制方法,其特征在于:包括以下步骤:步骤1:针对四旋翼无人机模型不确定和未知扰动的四旋翼无人机,构建四旋翼无人机动力学模型;
步骤2:设定四旋翼无人机轨迹跟踪飞行位置目标和姿态角目标,所述飞行位置目标用于使无人机位置误差收敛于0且保持稳定;所述姿态角目标用于使无人机翻滚角、俯仰角和偏航角误差收敛于0且保持稳定;
步骤3:根据飞行位置目标,设计四旋翼无人机动力学模型中位置子系统的分数阶递推滑模面,通过滑模变结构控制方法对位置子系统的分数阶递推滑模面进行处理,并利用自适应增益调整法估计位置子系统中的不确定和扰动的未知上界,用未知上界的估计值代替实际值,最终得到位置子系统的控制输入;
步骤4:根据期望的偏航角和位置子系统的控制输入反解出四旋翼无人机期望的俯仰角、翻滚角;
步骤5:将反解出的俯仰角、翻滚角作为四旋翼无人机动力学模型中姿态子系统的参考输入,并根据姿态角目标设计姿态子系统的分数阶递推滑模面,通过滑模变结构控制方法对姿态子系统的分数阶递推滑模面进行处理,并利用自适应增益调整法估计姿态子系统中的不确定和扰动的未知上界,用未知上界的估计值代替实际值,最终得到姿态子系统的控制输入;
步骤6:将获得的位置子系统的控制输入和姿态子系统的控制输入作为四旋翼无人机动力学模型的输入,实现四旋翼无人机轨迹跟踪飞行位置目标和姿态角目标。
2.根据权利要求1所述的一种四旋翼无人机分数阶递推滑模轨迹跟踪控制方法,其特征在于:所述四旋翼无人机动力学模型的计算公式如下:其中,x,y,z分别表示在x、y、z轴的值,φ表示翻滚角,θ表示俯仰角,ψ表示偏航角,g表示重力加速度,l表示螺旋桨中心到重心的距离,m表示机体质量,Ix,Iy,Iz分别表示机体绕x,y,z轴的转动惯量,K1,K2,K3分别表示三个坐标方向上的空气阻力系数,K4,K5,K6分别表示三个转动方向上的空气阻力系数;u1表示位置子系统的控制输入,u2,u3,u4表示姿态子系统的控制输入,u1控制无人机的垂直起降,u2控制无人机的翻滚通道,u3控制无人机的俯仰通道,u4控制无人机的偏航通道;τi,i=1,2,3表示位置通道上的模型不确定部分,τi,i=4,5,6表示姿态通道上的模型不确定部分;di,i=1,2,3表示在运动位置上所受的外界扰动,di,i=4,5,6表示在转动角度上所受的外界扰动。
3.根据权利要求2所述的一种四旋翼无人机分数阶递推滑模轨迹跟踪控制方法,其特征在于:为位置子系统;
为姿态子系统。
4.根据权利要求3所述的一种四旋翼无人机分数阶递推滑模轨迹跟踪控制方法,其特征在于:根据位置控制目标,得到四旋翼无人机实际位置坐标为(x,y,z),期望的位置坐标为(xd,yd,zd),获得位置跟踪误差ex=x-xd,ey=y-yd,ez=z-zd收敛于0并保持稳定;
根据姿态控制目标,得到姿态控制目标,四旋翼无人机实际姿态角为(φ,θ,ψ),期望的姿态角为(φd,θd,ψd),获得姿态跟踪误差eφ=φ-φd,eθ=θ-θd,eψ=ψ-ψd收敛于0并保持稳定。
5.根据权利要求4所述的一种四旋翼无人机分数阶递推滑模轨迹跟踪控制方法,其特征在于:所述步骤3,包括如下步骤:在四旋翼无人机位置子系统的基础上,设计四旋翼无人机在X方向,Y方向和Z方向上的控制输入ux、uy、uz,计算公式如下:设计位置子系统分数阶非奇异终端滑模面,计算公式如下:
由分数阶非奇异终端滑模面设计分数阶递推滑模面,计算公式如下:
其中,σIx,σIy,σIz为设计的中间变量,c1,c2,λ为正的常数增益,α1,α2为分数阶的阶次,b1,b2,β为常数阶次;D(*)代表分数阶函数,σx、σy、σz分别代表在X方向,Y方向和Z方向上分数阶非奇异终端滑模面,sx、sy、sz分别代表在X方向,Y方向和Z方向上的分数阶递推滑模面;
在不考虑干扰的情况下,令分数阶递推滑模面等于0可求得等效控制律,计算公式如下:其中,uxeq、uyeq、uzeq分别代表在X方向,Y方向和Z方向上的等效控制律;
根据自适应控制方法设计切换控制律,计算公式如下:
其中,uxsw、uysw、uzsw分别代表在X方向,Y方向和Z方向上的切换控制律,k1,k2为正常数增益,ν为趋近律的指数,η1,η2,η3为自适应律增益,ε为设计的滑模面的边界,是一个很小的正数;
其中,为各通道不确定和扰动的未知上界的估计值,其导数为:
最终位置子系统的位置子系统的控制输入u1,计算公式如下:
6.根据权利要求5所述的一种四旋翼无人机分数阶递推滑模轨迹跟踪控制方法,其特征在于:根据期望的偏航角ψd和控制输入ux,uy,uz,可以反解出期望的翻滚角φd和俯仰角θd,计算公式如下:
7.根据权利要求6所述的一种四旋翼无人机分数阶递推滑模轨迹跟踪控制方法,其特征在于:所述步骤5,具体步骤如下:将反解出的期望的翻滚角φd和俯仰角θd作为姿态子系统的参考输入,设计姿态子系统分数阶非奇异终端滑模面,计算公式如下:由分数阶非奇异终端滑模面设计分数阶递推滑模面,计算公式如下:
其中,σIφ,σIθ,σIψ为设计的中间变量,c1,c2,λ为正的常数增益,α1,α2为分数阶的阶次,b1,b2,β为常数阶次;D(*)代表分数阶函数,σφ、σθ、σψ分别代表在φ方向,θ方向和ψ方向上的分数阶非奇异终端滑模面,sφ、sθ、sψ分别代表在φ方向,θ方向和ψ方向上的分数阶递推滑模面;
在不考虑干扰的情况下,令分数阶递推滑模面等于0可求得等效控制律,计算公式如下:其中,uφeq、uθeq、uψeq分别代表在φ方向,θ方向和ψ方向上的等效控制律;
根据自适应控制方法设计切换控制律,计算公式如下:
其中,k1,k2为正常数增益,ν为趋近律的指数,η1,η2,η3为自适应律增益,ε为设计的滑模面的边界,是一个很小的正数;uφsw、uθsw、uψsw分别代表在φ方向,θ方向和ψ方向上的切换控制律;
其中,为各通道不确定和扰动的未知上界的估计值,其导数为:
最终姿态子系统的控制输入,计算公式如下: