一种误差驱动的飞行器预设性能姿态跟踪控制方法

摘要: 本申请涉及飞行器姿态控制,特别涉及一种误差驱动的飞行器预设性能姿态跟踪控制方法。背景技术:1、飞行器姿态控制是实现精确轨道机动、载荷指向及任务执行的核心技术,其...
一种误差驱动的飞行器预设性能姿态跟踪控制方法

本申请涉及飞行器姿态控制,特别涉及一种误差驱动的飞行器预设性能姿态跟踪控制方法。

背景技术:

1、飞行器姿态控制是实现精确轨道机动、载荷指向及任务执行的核心技术,其性能直接影响任务精度与执行可靠性。当前技术发展中,飞行器任务对姿态控制的要求已从稳定即可升级为精确可控、快速收敛和低成本可靠。其核心挑战主要源于复杂的环境与系统特性的耦合影响。

2、现有技术中,无模型姿态跟踪方法利用指数修正跟踪微分器从可测的姿态信息中实时估计广义角速度,从而替代物理陀螺仪,并基于估计的角速度构造姿态跟踪误差;指数型性能函数对跟踪误差的收敛边界进行先验约束,通过误差转换和反馈控制律实现姿态跟踪控制。

3、然而,上述现有技术采用指数修正跟踪微分器对广义角速度进行估计,其依赖于指数收敛机制,指数收敛机制在前期收敛速度快,但后期衰减缓慢,当飞行器在大机动飞行或遭遇强外部扰动时会产生剧烈反应,使得收敛过程中由于产生剧烈响应而诱发超调现象,超调发生后跟踪误差幅值迅速减小,收敛速率随之急剧下降,而由于指数修正跟踪微分器后期衰减极其缓慢,导致跟踪误差难以在规定时间内压缩至预设性能所规定的误差界限内,从而使姿态跟踪误差的收敛轨迹无法与飞行器的预设性能相互匹配,进而导致飞行器姿态的整体跟踪稳定性下降,严重后果影响飞行器的预设性能控制在工程中的实际效果。

技术实现思路

1、基于此,有必要针对上述技术问题,提供一种误差驱动的飞行器预设性能姿态跟踪控制方法。

2、本发明采用下述技术方案:

3、本发明提供了一种误差驱动的飞行器预设性能姿态跟踪控制方法,包括:

4、获取飞行器控制参数;并根据飞行器控制参数,建立飞行器姿态系统模型;

5、采用改进对数型跟踪微分器对飞行器姿态系统模型的姿态四元数进行跟踪,得到飞行器的广义角速度估计值;并根据所述广义角速度估计值和预设的期望姿态四元数,确定飞行器的扩展姿态跟踪误差;其中,所述改进对数型跟踪微分器通过将用于调节姿态跟踪误差收敛速度的加速吸引因子引入对数型障碍lyapunov函数后依次进行求导与坐标变换获得;

6、基于所述扩展姿态跟踪误差,构建由跟踪误差驱动的预设性能控制器,以对飞行器姿态进行跟踪控制。

7、优选地,飞行器控制参数包括:姿态四元数、转动惯量矩阵、控制输入力矩和外部干扰。

8、优选地,建立飞行器姿态系统模型,具体包括:

9、根据所述姿态四元数,建立飞行器本体的姿态运动学方程;

10、根据飞行器的转动惯量矩阵、控制输入力矩和外部干扰,建立飞行器本体的姿态动力学方程;

11、根据姿态运动学方程和姿态动力学方程,通过微分代数变换建立欧拉-拉格朗日形式的飞行器姿态系统模型。

12、优选地,飞行器姿态系统模型的广义角速度为经过辅助矩阵变换后的广义角速度矢量;其中,所述辅助矩阵是根据所述姿态运动学方程中的姿态四元数矢量部分及其叉乘矩阵所确定的。

13、优选地,改进对数型跟踪微分器的构建过程,具体包括:

14、根据飞行器姿态系统模型的状态向量,构建飞行器的对数型障碍李雅普诺夫函数;

15、将用于调节姿态跟踪误差收敛速度引入所述对数型障碍李雅普诺夫函数并进行求导,得到改进对数型二阶跟踪微分系统;

16、根据待跟踪的可积信号和所述状态向量,对改进对数型二阶跟踪微分系统进行坐标变换,得到改进对数型跟踪微分器。

17、优选地,根据所述广义角速度估计值和预设的期望姿态四元数,确定飞行器的扩展姿态跟踪误差,具体包括:

18、根据所述姿态四元数和期望姿态四元数,确定姿态跟踪误差;

19、根据广义角速度估计值和期望姿态四元数的导数,确定广义角速度跟踪误差;

20、根据姿态跟踪误差和广义角速度跟踪误差,确定飞行器的扩展姿态跟踪误差。

21、优选地,基于所述扩展姿态跟踪误差,构建由跟踪误差驱动的预设性能控制器,具体包括:

22、根据预设的误差收敛时间、性能函数初始值、性能函数稳态值、收敛速率调节参数和边界形状调节参数,构建复合指数型指定时间性能函数;

23、根据所述复合指数型指定时间性能函数,确定所述扩展姿态跟踪误差的误差约束边界;

24、根据所述误差约束边界,确定无约束误差转换函数;

25、根据所述无约束误差转换函数,将受约束的所述扩展姿态跟踪误差转换为无约束转换误差;

26、根据所述无约束转换误差和飞行器姿态系统模型,确定无约束转换误差的动态方程;

27、基于所述无约束转换误差的动态方程,构建由跟踪误差驱动的预设性能控制器。

28、优选地,复合指数型指定时间性能函数为单调递减的全局连续有界可导函数。

29、优选地,基于所述无约束转换误差的动态方程,构建由跟踪误差驱动的预设性能控制器,具体包括:

30、根据所述无约束转换误差和预设的正定系数矩阵,确定所述预设性能控制器的反馈控制项;

31、根据所述无约束转换误差的动态方程中的误差转化系数矩阵,确定所述预设性能控制器的补偿控制项;

32、根据所述反馈控制项和所述补偿控制项,构建由跟踪误差驱动的预设性能控制器。

33、优选地,利用由跟踪误差驱动的预设性能控制器对飞行器姿态进行跟踪控制,具体包括:

34、根据所述预设性能控制器和所述无约束转换误差的动态方程,确定无约束转换误差的闭环动态方程;

35、根据所述闭环动态方程,构建候选李雅普诺夫函数并求时间导数;

36、根据求导后李雅普诺夫函数的时间导数的不等式关系,判断所述无约束转换误差的全局有界性;

37、当所述无约束转换误差满足全局有界性时,根据预设的性能控制原理,对飞行器姿态进行跟踪控制。

38、本发明采用的上述至少一个技术方案能够达到以下有益效果:

39、本发明基于加速吸引因子和对数型障碍李雅普诺夫函数构建的改进对数型跟踪微分器,对数型障碍李雅普诺夫函数与加速吸引因子耦合后,当飞行器在大机动飞行或遭遇强外部扰动时会产生剧烈反应而导致误差幅值急速减小时,加速吸引因子在跟踪误差减小时能够凭借低幂次特性保持足够的后期衰减速率,从而在全误差范围内提供持续且自适应的收敛驱动力,对数型障碍李雅普诺夫函数中的对数性质则通过引入状态边界限制,迫使姿态跟踪误差的收敛轨迹始终处于预设性能规定的区域内,使得改进对数型跟踪微分器能够在全误差范围内提供足够收敛驱动力的同时实现快速且全程均匀的收敛行为,得到的姿态跟踪误差具备与预设性能函数相匹配的收敛轨迹,从而使后续控制器能够在规定时间内将跟踪误差压缩至允许范围,最终确保飞行器在复杂工况下姿态跟踪的稳定性和预设性能控制方案的工程可行性。

1.一种误差驱动的飞行器预设性能姿态跟踪控制方法,其特征在于,包括:

2.如权利要求1所述的一种误差驱动的飞行器预设性能姿态跟踪控制方法,其特征在于,所述飞行器控制参数包括:姿态四元数、转动惯量矩阵、控制输入力矩和外部干扰。

3.如权利要求2所述的一种误差驱动的飞行器预设性能姿态跟踪控制方法,其特征在于,所述根据飞行器控制参数,建立飞行器姿态系统模型,具体包括:

4.如权利要求3所述的一种误差驱动的飞行器预设性能姿态跟踪控制方法,其特征在于,所述飞行器姿态系统模型的广义角速度为经过辅助矩阵变换后的广义角速度矢量;其中,所述辅助矩阵是根据所述姿态运动学方程中的姿态四元数矢量部分及其叉乘矩阵所确定的。

5.如权利要求1所述的一种误差驱动的飞行器预设性能姿态跟踪控制方法,其特征在于,所述改进对数型跟踪微分器的构建过程,具体包括:

6.如权利要求1所述的一种误差驱动的飞行器预设性能姿态跟踪控制方法,其特征在于,根据所述广义角速度估计值和预设的期望姿态四元数,确定飞行器的扩展姿态跟踪误差,具体包括:

7.如权利要求1所述的一种误差驱动的飞行器预设性能姿态跟踪控制方法,其特征在于,基于所述扩展姿态跟踪误差,构建由跟踪误差驱动的预设性能控制器,具体包括:

8.如权利要求7所述的一种误差驱动的飞行器预设性能姿态跟踪控制方法,其特征在于,所述复合指数型指定时间性能函数为单调递减的全局连续有界可导函数。

9.如权利要求7所述的一种误差驱动的飞行器预设性能姿态跟踪控制方法,其特征在于,基于所述无约束转换误差的动态方程,构建由跟踪误差驱动的预设性能控制器,具体包括:

10.如权利要求1所述的一种误差驱动的飞行器预设性能姿态跟踪控制方法,其特征在于,利用由跟踪误差驱动的预设性能控制器对飞行器姿态进行跟踪控制,具体包括: