1.一种适用于四旋翼飞行器的滑模重复控制器,其特征在于,将高次函数和对数函数在第一象限中更强的调节能力用于趋近律衰减因子,设计改进趋近律其中0<ρ<1,ε>0,λ>1, ln(·)为自然对数函数, 表示向下取整函数,当sk远离滑模面时,指数项和对数项共同作用,提高趋近速率;当sk接近滑模面时,高次函数作为衰减因子,其参数λ用于调节ε的衰减速度,避免稳态抖振;
改进趋近律(1)的收敛性分析过程如下:
1)设sk≥1,则η=1,所以
考虑到当sk=1时,ln(sk)=sk-1且当sk>1时, 所以有ln(sk)∈[0,sk-
1),因此,不等式 恒成立,且当 时,
2)设0<sk<1,则η=0,所以
考虑到 所以不等式 恒成立,当ρ+ε<1时,sk+1≥(1-ρ-ε)sk>0;
综上所述,若取ρ+ε<1,那么当sk>0时,有0<sk+1<sk即sk同号单调收敛,由于趋近律(1)是关于原点对称的奇函数,所以当sk<0时有sk<sk+1<0,因此,ρ+ε<1是sk同号单调收敛即0<sk+1sgn(sk)<|sk|的充分条件;
四旋翼飞行器的对称结构模型和参考坐标中,[x,y,z]表示飞行器的地理位置坐标,[x',y',z']表示飞行器的机体坐标,原点定于飞行器的质心位置,[φ,θ,ψ]表示飞行器姿态的欧拉角,分别为滚转角、俯仰角和偏航角,若以F1,F2,F3和F4分别代表1-4号旋转电机的升力,则F4-F2产生横滚力矩,F3-F1产生俯仰力矩,F2+F4-F1-F3产生偏航力矩,根据Lagrange方程导出四旋翼飞行器的动力学模型,含位置子系统和姿态子系统
其中飞行器总质量为m,质心到四个旋转电机中心的距离均为l,Kx、Ky和Kz分别代表沿三个地理坐标方向的平移阻力系数,Kφ、Kθ和Kψ分别代表围绕三个机体坐标轴旋转的阻力系数,Ix、Iy和Iz代表围绕三个机体坐标轴的转动惯量,C为升力与偏航力矩的比例,g为重力加速度,x、y、z、vx、vy和vz分别代表三个地理坐标方向的位移和速度,φ、θ、ψ、ωφ、ωθ和ωψ分别代表围绕三个机体坐标轴转角和转速,fx、fy、fz、fφ、fθ和fψ为外界干扰,u1、u2、u3和u4分别代表飞行器总升力、滚转力矩、俯仰力矩和偏航力矩,与1-4号电机升力的关系为将式(4)和(5)离散化,得到位置子系统
和姿态子系统
其中wx,k=TSfx,k,wy,k=TSfy,k,wz,k=TSfz,k,wφ,k=TSfφ,k,wθ,k=TSfθ,k,wψ,k=TSfψ,k,因为模型(7)和8)所表示的四旋翼飞行器是四输入六输出的欠驱动系统,无法对所有六个自由度独立控制,令虚拟控制量则轴向的位移与速度表示为
由于只有四个控制输入,控制目标为地理位置坐标上三维空间位置与偏航角的跟踪,滚转角与俯仰角的镇定,设跟踪目标轨迹在三个地理坐标方向的位移分量为rx,k、ry,k和rz,k,偏航角为rψ,k,相应的速度分量为rvx,k、rvy,k、rvz,k和ωψ,k+1,那么x方向的跟踪误差表示为 另外二个方向和偏航角跟踪误差ey,k、ez,k和eψ,k具有相同形式,取位置子系统的滑模切换函数
由(11)结合趋近律(1)得虚拟等效滑模控制器
和滑模重复控制器
式(12)中 是对干扰wx,k的估计,式(13)中 是相邻周期扰动差值dx,k=wx,k-wx,k-N的估计,同理得y轴向位移虚拟滑模控制器滑模重复控制器
和z轴向位移虚拟控制器
滑模重复控制器
由式(9)得
也即
由式(19)第一行得cosψkux,k+sinψkuy,k=uz,ktgθk,所以俯仰角期望轨迹由式(19)第二行得 所以滚转角期望轨迹
结合式(9)、(20)和(21)得升力控制器
取姿态子系统切换函数
以式(8)中φk+1和ωφ,k+1的表达式代入,得到结合趋近律表达式得滚转角滑模控制器
和滚转角滑模重复控制器
式(25)中 是对干扰wφ,k的估计,式(26)中 是相邻周期扰动差值dφ,k=wφ,k-wφ,k-N的估计,同理得俯仰角滑模控制器俯仰角滑模重复控制器
和偏航角滑模控制器
偏航角滑模重复控制器
式(27)和(29)中的 和 分别是对干扰wθ,k和wψ,k的估计,式(28)和(30)中的 和分别是对相邻周期扰动差值dθ,k=wθ,k-wθ,k-N和dψ,k=wψ,k-wψ,k-N的估计。
2.如权利要求1所述的适用于四旋翼飞行器的滑模重复控制器,其特征在于,通过式(20)和(21)解耦得到当前滚转角参考信号rφ,k和俯仰角参考信号rθ,k,控制器(25)和(27)所需的rφ,k+1、rωφ,k+1、rθ,k+1和rωθ,k+1通过跟踪微分器求解,定义待跟踪的输入信号为vk,跟踪结果输出信号及其变化速率分别为y1,k和y2,k,取输出信号初始值y1,k=0,y2,k=0,令跟踪误差ek=y1,k-vk,新的误差估计zk=ek+TSy2,k,设计离散型二阶跟踪微分器其中η>0,δ=TSη,饱和函数fS(·)为
利用上述微分器,根据rφ,k和rθ,k得到rφ,k+1、rωφ,k+1、rθ,k+1和rωθ,k+1。