欢迎来到知嘟嘟! 联系电话:13095918853 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13095918853
知嘟嘟经纪人
收藏
专利号: 2016104274813
申请人: 浙江工业大学
专利类型:发明专利
专利状态:已下证
专利领域: 控制;调节
更新日期:2023-12-11
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种四旋翼无人飞行器的有限时间全阶滑模控制方法,其特征在于:包括以下步骤:步骤1,建立四旋翼无人飞行器的动态模型,初始化系统状态、采样时间以及控制参数,过程如下:

1.1在忽略空气阻力和陀螺效应的基础上,对四旋翼无人飞行器进行以下假设:飞行器是刚性的;飞行器的结构是完全对称的;飞行器的重心与机体坐标系原点重合;并定义机体坐标系到惯性坐标系的转移矩阵为:其中,ψ、θ、φ分别为飞行器的偏航角、俯仰角、翻滚角,表示飞行器的惯性坐标系依次绕坐标轴zE、yE、xE旋转的角度;

1.2采用牛顿-欧拉法,从受力角度分析飞行器,其中牛顿公式为:其中,ξ表示飞行器在惯性坐标系下的位置,代表二阶微分,m表示飞行器的质量,F表示作用在飞行器上的合外力,包括飞行器所受重力mg和四个旋翼产生的合力UF;

式(2)展开为:

其中,x、y、z分别表示飞行器在惯性坐标系下xE、yE、zE轴的位置;

将式(1)代入式(3)中得到如下等式:

1.3机体坐标系下欧拉公式为:

其中,τ表示作用在飞行器上的力矩,I表示飞行器在机体坐标系下的转动惯量,ω表示飞行器姿态角速度,表示飞行器姿态角加速度,×表示叉乘;

式(5)展开为:

其中,τx、τy、τz分别代表机体坐标轴上的各轴力矩分量,Ixx、Iyy、Izz分别代表机体坐标轴上的各轴转动惯量分量,p、q、r分别代表机体坐标轴上的各轴姿态角速度分量,分别代表机体坐标轴上的各轴姿态角加速度分量;

式(6)表示为:

考虑到飞行器一般处于低速飞行或者悬停状态下,姿态角变化较小,此时认为将式(7)改写为:

1.4由于存在测量噪声,电源变化以及外界干扰的影响,式(4)和式(8)中的系统参数并不能准确的获得,因此系统的动态模型改写为:其中

dx、dy、dz、dφ、dθ、dψ分别代表模型不确定和外界干扰项;

步骤2,计算系统位置跟踪误差,设计位置全阶滑模面,过程如下:

2.1定义系统位置跟踪误差为

eq=qd-q      (10)其中,q=[x;y;z],qd=[xd;yd;zd]表示为三阶可导期望轨迹;那么式(10)的一阶微分和二阶微分被表示为:

2.2因此,为了避免奇异问题,位置全阶滑模面将定义为:其中,sgn(·)表示符号函数;cq1和cq2是一个正的常数,它的选择是保证多项式p2+cq2p+cq1的全部特征根在复平面的左半部分以保证系统的稳定性;αq1和αq2的选取则是通过以下多项式:其中,αn+1=1,αn=α,α∈(1-ε,1)以及ε∈(0,1);

步骤3,基于四旋翼无人飞行器动态模型,根据位置全阶滑模面以及一阶滤波器,设计位置全阶滑模控制器,过程如下:

3.1考虑式(9),位置全阶滑模控制器被设计为:u=(ueq+un)     (15)vq=-(kqd+kqT+ηq)sgn(sq)    (18)其中, ci和αi是常数,i=q1,q2,已在式(13)中被定义;Tq是正的常数;

kqd,kqT和ηq都是常数;

3.2将式(9)带入式(13)中得到如下等式:其中,dq=[dx;dy;dz]代表系统位置扰动项,并且各元素是有界的,则假定dq≤lqd并且其中lqd是一个有界的常数;kqT的选取是要求在Tq>0时满足kqT≥Tqlqd;

将式(15)-式(16)代入式(19),全阶滑模面被表示成如下等式:sq=dq+un    (20)

将式(18)带入式(17)中得到:在un(0)=0的情况下,得到如下等式:kqT≥Tqlqd≥Tq|un(t)|max≥Tq|un(t)|   (22)

3.3设计李亚普诺夫函数:

对式(20)进行求导得:

将式(18)带入式(24)中得到:因此,

对式(23)进行微分,并代入式(22)得到:因此系统位置跟踪误差能在有限时间内收敛至零,表明系统是稳定的;

步骤4,给定偏航角,计算总升力,俯仰角和翻滚角期待值,过程如下:

4.1由式(9)得到:

步骤5,计算系统姿态角跟踪误差,设计姿态全阶滑模面,过程如下:

5.1定义系统姿态角跟踪误差为

eΩ=Ωd-Ω     (29)

其中,Ω=[φ;θ;ψ],Ωd=[φd;θd;ψd]表示为三阶可导期望姿态角;那么式(29)的一阶微分和二阶微分被表示为:

5.2因此,为了避免奇异问题,姿态全阶滑模面将定义为:其中,cΩ1和cΩ2是一个正的常数,它的选择是保证多项式p2+cΩ2p+cΩ1的全部特征根在复平面的左半部分以保证系统的稳定性;αΩ1和αΩ2的选取则是通过以下多项式:其中,αn+1=1,αn=α,α∈(1-ε,1)以及ε∈(0,1);

步骤6,基于四旋翼无人飞行器动态模型,根据姿态全阶滑模面以及一阶滤波器,设计姿态全阶滑模控制器,过程如下:

6.1考虑式(9),姿态全阶滑模控制器被设计为:τ=b-1(τeq+τn)    (34)vΩ=-(kΩd+kΩT+ηΩ)sgn(sΩ)    (37)其中, a=[a1;a2;a3],b=[b1;b2;b3], ci和αi是常数,i=Ω1,Ω2,已在式(32)中被定义;TΩ是正的常数;kΩd,kΩT和ηΩ都是常数;

6.2将式(9)带入式(32)中得到如下等式:其中,dΩ=[dφ;dθ;dψ]代表系统位置扰动项,并且各元素是有界的,则假定dΩ≤lΩd并且其中lΩd是一个有界的常数;kΩT的选取是要求在TΩ>0时满足kΩT≥TΩlΩd;

将式(34)-式(35)代入式(38),全阶滑模面被表示成如下等式:sΩ=dΩ+τn    (39)

将式(37)带入式(36)中得到:在τn(0)=0的情况下,得到如下等式:kΩT≥TΩlΩd≥TΩ|τn(t)|max≥TΩ|τn(t)|   (41)

6.3设计李亚普诺夫函数:

对式(39)进行求导得:

将式(37)带入式(43)中得到:因此,

对式(42)进行微分,并代入式(41)得到:因此系统姿态角跟踪误差能在有限时间内收敛至零,表明系统是稳定的。