技术领域
本发明属于无人飞行器运动控制技术领域,尤其涉及一种基于滑模控制的四旋翼无人机参数预测和扰动的自适应轨迹跟踪控制器及其设计方法。
背景技术
随着科学技术的不断发展,飞行器的研究领域不断扩大,飞行器的种类不断丰富,其中四旋翼无人机的研究备受人们的关注。四旋翼无人机是一种通过遥控或机载程序实现飞行任务的无人驾驶设备。这种无人机凭借机动灵活、成本低、结构简单的优点可以在电力巡检、农业植保、环境监测领域广泛使用。而在四旋翼无人机的结构中,控制器是无人机能否实现预期效果的重要组成部分。
在四旋翼无人机的研究领域中,无人机的轨迹跟踪控制是一个十分热门的研究领域。四旋翼无人机具有复杂的动力学模型,同时四旋翼无人机的飞行环境复杂多变,所以控制四旋翼无人机在轨迹跟踪过程中保持稳定的姿态与位置是十分有研究意义的。研究四旋翼无人机的轨迹跟踪运动可以为四旋翼无人机的其他运动控制奠定良好的理论帮助。
发明内容
有鉴于此,为了弥补现有技术的空白和不足,本发明的目的在于提供一种基于滑模控制的四旋翼无人机参数预测和扰动的自适应轨迹跟踪控制器及其设计方法,其所要解决的技术问题是:实现四旋翼无人机的姿态和运动位置的稳定控制。
其设计的控制器主要包括以下方案:
基于四旋翼无人机的非线性力学模型,根据四旋翼无人机轨迹跟踪的姿态角目标和飞行位置目标,所述姿态角目标用于使无人机的翻滚角、俯仰角和偏航角误差收敛且稳定;所述飞行位置目标用于使无人机切向、法向和垂向位置误差收敛且稳定;对于四旋翼无人机的姿态虚拟控制输入,其利用滑模变结构控制方法得到系统的姿态控制输入函数,同时,对系统的不确定状态参数和外界扰动进行预测,并用预测值代替实际值来提前给予自适应控制补偿;对于四旋翼无人机的位置虚拟控制输入,其利用滑模变结构控制方法得到系统的位置控制输入函数,同时,对系统的不确定状态参数和外界扰动进行预测,并用预测值代替实际值来提前给予自适应控制补偿;根据期望的偏航角和虚拟控制输入反解四旋翼无人机滚动角和俯仰角的期望值作为内环回路的参考输入。
该控制器的设计方法主要包括以下步骤:
步骤S1:分析四旋翼无人机的运动机理,建立四旋翼无人机的非线性力学模型;
步骤S2:制定四旋翼无人机轨迹跟踪的姿态角目标和飞行位置目标,所述姿态角目标用于使无人机的翻滚角、俯仰角和偏航角误差收敛且稳定;所述飞行位置目标用于使无人机切向、法向和垂向位置误差收敛且稳定;
步骤S3:设计四旋翼无人机的姿态虚拟控制输入,利用滑模变结构控制方法得到系统的姿态控制输入函数,同时,对系统的不确定状态参数和外界扰动进行预测,并用预测值代替实际值来提前给予自适应控制补偿;
步骤S4:设计四旋翼无人机的位置虚拟控制输入,利用滑模变结构控制方法得到系统的位置控制输入函数,同时,对系统的不确定状态参数和外界扰动进行预测,并用预测值代替实际值来提前给予自适应控制补偿;
步骤S5:根据期望的偏航角和虚拟控制输入反解四旋翼无人机滚动角和俯仰角的期望值作为内环回路的参考输入。
以及,步骤S6:构造Lyapunov函数,验证步骤S3中的四旋翼无人机姿态、预测值和步骤S4中的四旋翼无人机位置、预测值的渐进稳定性。
步骤S7:通过MATLAB仿真实验,验证基于滑模控制的四旋翼无人机参数预测和扰动的自适应轨迹跟踪控制器的有效性。
与现有技术相比,本发明及其优选方案具有以下有益效果:
1、通过对四旋翼无人机系统的不确定状态参数进行预测,来提前给予自适应控制补偿,有效提高了无人机的轨迹跟踪效率和跟踪精度,确保了自适应轨迹跟踪控制器的稳定性。
2、通过预测四旋翼无人机所受的外界扰动,来提前对系统的控制输入进行补偿,降低了气流、风阻和执行器故障对无人机轨迹跟踪控制的消极影响,提高无人机的抗扰动能力,消除了飞行过程中的抖振现象,提高了系统对环境的自适应适应力。
附图说明
下面结合附图和具体实施方式对本发明进一步详细的说明:
图1是本发明实施例四旋翼无人机模型示意图;
图2是本发明实施例控制系统流程示意图;
图3是本发明实施例无人机飞行轨迹示意图;
图4是本发明实施例无人机飞行轨迹分量示意图;
图5是本发明实施例无人机飞行位置误差示意图;
图6是本发明实施例无人机飞行轨迹及位置误差放大图示意图;
图7是本发明实施例无人机飞行速度误差分量示意图;
图8是本发明实施例无人机飞行速度示意图;
图9是本发明实施例无人机飞行姿态角分量示意图;
图10是本发明实施例无人机飞行姿态角误差示意图;
图11是本发明实施例无人机飞行姿态角及姿态角误差放大图示意图;
图12是本发明实施例无人机飞行姿态角速度误差示意图;
图13是本发明实施例系统的参数变量预测值示意图;
图14是本发明实施例虚拟控制函数的参数变量预测值示意图;
图15是本发明实施例姿态扰动变量预测值示意图;
图16是本发明实施例位置扰动变量预测值示意图;
图17是本发明实施例系统的控制输入示意图;
图18是本发明实施例无人机飞行位置控制输入示意图。
具体实施方式
为让本专利的特征和优点能更明显易懂,下文特举实施例,作详细说明如下:
本实施例从四旋翼无人机的需求出发,结合四旋翼无人机的运动特点,设计一种基于滑模控制的四旋翼无人机参数预测和扰动的自适应轨迹跟踪控制器:其基于四旋翼无人机的非线性力学模型,根据四旋翼无人机轨迹跟踪的姿态角目标和飞行位置目标,所述姿态角目标用于使无人机的翻滚角、俯仰角和偏航角误差收敛且稳定;所述飞行位置目标用于使无人机切向、法向和垂向位置误差收敛且稳定;对于四旋翼无人机的姿态虚拟控制输入,其利用滑模变结构控制方法得到系统的姿态控制输入函数,同时,对系统的不确定状态参数和外界扰动进行预测,并用预测值代替实际值来提前给予自适应控制补偿;对于四旋翼无人机的位置虚拟控制输入,其利用滑模变结构控制方法得到系统的位置控制输入函数,同时,对系统的不确定状态参数和外界扰动进行预测,并用预测值代替实际值来提前给予自适应控制补偿;根据期望的偏航角和虚拟控制输入反解四旋翼无人机滚动角和俯仰角的期望值作为内环回路的参考输入。
以下结合其设计和验证过程进行进一步的解释和阐述:
步骤一:在四旋翼无人机建模的过程中,使用两套独立的空间坐标系,分别为惯性坐标系O
其中,k
不妨设化简参数为:
同时,设计无人机在x方向,y方向和z方向上的控制输入为:
设置f
步骤二:四旋翼无人机在轨迹跟踪的过程中,需要完成两项控制任务,分别是姿态角目标和飞行位置目标。其中,姿态角目标的实现可以使无人机的翻滚角、俯仰角和偏航角误差收敛且稳定。飞行位置目标的实现可以使无人机的切向、法向和垂向位置误差收敛且稳定。
姿态角目标:四旋翼无人机的实际翻滚角、俯仰角和偏航角分别为φ,θ和ψ。设置无人机的理想翻滚角、俯仰角和偏航角分别为
飞行位置目标:四旋翼无人机的实际飞行位置为[x,y,z]
步骤三:根据步骤二制定的姿态角目标,设计四旋翼无人机的姿态控制器,实现四旋翼无人机的姿态控制。
四旋翼无人机的翻滚角速度和翻滚角加速度分别为:
俯仰角速度和俯仰角加速度分别为:
偏航角速度和偏航角加速度分别为:
设计四旋翼无人机的翻滚角滑模误差为e
其中,翻滚角的滑模面为
对四旋翼无人机的翻滚角误差,俯仰角误差和偏航角误差进行为微分得到:
不妨设
根据自适应控制方法设计系统的控制输入u
其中,c
误差微分
设计预测值
设计预测值
步骤四:根据步骤二制定的飞行位置目标,设计四旋翼无人机的位置控制器,实现四旋翼无人机的飞行位置控制。四旋翼无人机的垂向运动速度和垂向运动加速度分别为:
设置无人机的垂向位置误差和垂向速度误差分别为:
设置虚拟控制项为:
其中,μ
设置系统的控制输入u
其中,c
设计预测值
根据四旋翼无人机的垂向位置控制和所涉及的控制输入u
无人机的法向运动速度和法向运动加速度分别为:
四旋翼无人机的切向位置误差和切向速度误差为:
无人机的法向位置误差和法向速度误差为:
无人机的切向误差和法向误差的微分分别为:
以及,
设置虚拟控制项为:
其中,μ
不妨设
其中,c
设计预测值
步骤五:根据期望偏航角
步骤六:构造Lyapunov函数,验证步骤三中的四旋翼无人机姿态、预测值和步骤四中的四旋翼无人机位置、预测值的渐进稳定性。
首先设计Lyapunov候选函数L
其中,γ
对L
将估计值的更新代入后,
因此,四旋翼无人机的姿态控制的Lyapunov函数为L=L
很明显,
设置Lyapunov候选函数V
其中,η
将估计值更新律代入,则
设置Lyapunov候选函数V
其中,η
将位置控制输入方程代入,Lyapunov函数
设四旋翼无人机的位置误差的Lyapunov函数为V=V
很明显,
步骤七:通过MATLAB对基于滑模控制的四旋翼无人机参数预测和扰动的自适应轨迹跟踪控制器进行仿真实验。无人机飞行轨迹如图3所示。无人机飞行轨迹分量如图4所示。无人机飞行位置误差如图5所示。无人机飞行轨迹及位置误差放大图如图6所示。无人机飞行速度误差分量如图7所示。无人机飞行速度如图8所示。无人机飞行姿态角分量如图9所示。无人机飞行姿态角误差如图10 所示。无人机飞行姿态角及姿态角误差放大图如图11所示。无人机飞行姿态角速度误差如图12所示。系统的参数变量预测值如图13所示。虚拟控制函数的参数变量预测值如图14所示。姿态扰动变量预测值如图15所示。位置扰动变量预测值如图16所示。系统的控制输入如图17所示。无人机飞行位置控制输入如图 18所示。根据仿真结果可以发现所提出的控制器有效的提高四旋翼无人机的轨迹跟踪效率,加快跟踪性能误差的收敛速度,而且减小跟踪误差的波动峰值,提高系统的稳定性,该结果与预期结果一致。
本专利不局限于上述最佳实施方式,任何人在本专利的启示下都可以得出其它各种形式的基于滑模控制的四旋翼无人机参数预测和扰动的自适应轨迹跟踪控制器及其设计方法,凡依本发明申请专利范围所做的均等变化与修饰,皆应属本专利的涵盖范围。
机译: 具有地面效应的四旋翼无人机基于反馈线性化的滑模控制系统
机译: 用于抑制轨迹跟踪误差的最大幅度的控制器的设计方法和使用该控制器的控制器
机译: 用于抑制轨迹跟踪误差的最大幅度的控制器的设计方法和使用该控制器的控制器