一种基于自适应扩张状态观测器和全局快速终端滑模的三轴惯性稳定平台高精度控制方法

1.本发明涉及基于自适应扩张状态观测器和全局快速终端滑模的三轴惯性稳定平台高精度控制方法，适用于航空测绘稳定平台高精度控制领域。


背景技术：

2.三轴吊舱平台通过基座固连于飞行载体，支撑并稳定遥感载荷，隔离飞行载体非理想姿态运动对遥感载荷视轴的影响来提高遥感载荷的成像质量，具有广泛的应用前景。
3.作为复杂的多框架耦合系统，三轴惯性稳定平台具有非线性、强耦合、控制难度高等特性。并且三轴惯性稳定平台在飞行过程中存在风扰、飞机发动机振动引起的基座角运动干扰、平台质心和运动成像载荷转轴中心不重合引起的不平衡力矩、稳定平台本身机械和电气构造不完善导致的耦合力矩和摩擦干扰力矩、陀螺和加计测量误差系统内扰，因此，三轴惯性稳定平台在扰动下的高精度控制是测绘系统的关键技术之一。
4.为提高性能，pid控制方法、鲁棒控制、智能控制、滑模控制方法等各类控制方法被用于三轴惯性稳定平台的高精度控制。pid控制器结构简单，但抗干扰能力差，三轴稳定平台的控制性能很容易受到外界干扰影响而降低。鲁棒控制可以较好地消除三轴惯性稳定平台在飞行过程中存在的模型参数不精确和外界干扰问题，但鲁棒控制具有实时性较差、动态参数响应慢的特性。通过大量的样本训练，神经网络可以实现非线性自适应控制，克服三轴惯性稳定平台所具有的模型不确定性，以及存在多源干扰等问题，实现高精度的姿态控制，但传统的神经网络需要大量的样本数据进行训练，具有实时性差的缺点。滑模变结构控制通过构建滑模面，使系统按照既定规则沿滑动模态运动，是一种有效的解决带有外部扰动以及不确定的非线性问题控制方法，对于存在严重非线性、外界干扰的系统具有不错的控制效果。但是滑模的弊端在于其切换函数，在外部干扰较大时，可能使系统产生抖振。


技术实现要素：

5.本发明解决的技术问题是：针对三轴惯性稳定平台在执行任务时控制性能容易受到外界干扰影响的问题，提出一种基于自适应扩张状态观测器和全局快速终端滑模的三轴惯性稳定平台高精度控制方法，通过设计自适应扩张状态观测器，实时估计未知的集总干扰，构建全局快速终端滑模控制器，处理三轴惯性稳定平台的非线性、框架内外耦合和参数不确定性，并结合自适应扩张状态观测器对集总干扰的有效估计，替换掉高阶终端函数，降低抖振现象，进而实现复杂环境下的三轴惯性稳定平台高精度控制。
6.本发明的技术解决方案为：首先针对三轴惯性稳定平台动力学模型，通过设计自适应扩张状态观测器，并利用观测器带宽的自适应变化和对干扰估计偏差的自适应补偿，在保证快速性、超调小和噪声低的同时，实时估计未知的集总干扰，设计全局快速终端滑模控制器，处理三轴惯性稳定平台的非线性、框架内外耦合和参数不确定性，并结合自适应扩张状态观测器对集总干扰的有效估计，替换掉高阶终端函数，降低抖振现象；其实现步骤如
下：
7.(1)针对三轴惯性稳定平台动力学模型，
[0008][0009]
其中，ζ＝r时表示横滚通道，ζ＝p时表示俯仰通道，ζ＝a时表示航向通道，θ
dζ
为ζ轴期望角度，x
1ζ
＝θ
ζ
、x
2ζ
＝ω
ζ
分别为ζ轴实际角度、ζ轴实际角速度，u
ζ
为ζ轴控制电压，b
ζ
为ζ轴控制量增益，f
ζ
为ζ轴已知非线性函数，d
ζ
为ζ轴集总干扰，且其一阶导数有界；
[0010]
为了降低未知扰动对三轴惯性稳定平台的影响，提高控制性能，设计自适应扩张状态观测器来在线估计集总干扰；
[0011]
ζ轴自适应扩张状态观测器定义为：
[0012][0013]
其中，分别为ζ轴角度估计值、ζ轴角速度估计值和ζ轴集总干扰估计值，e
1ζ
为ζ轴实际角度θ
ζ
与ζ轴角度估计值的误差，ω
aζ
是ζ轴观测器带宽，其自适应时变表达式如下：
[0014][0015]
式中，ω
ahζ
为ζ轴观测器带宽上界，ω
alζ
为ζ轴观测器带宽下界，δ
1ζ
＞0为ζ轴角度估计偏差增益，δ
2ζ
＞0为ζ轴角速度估计偏差增益；
[0016]
ζ轴观测器带宽ω
aζ
充分利用了三轴惯性稳定平台角度和角速度信息来降低观测器估计曲线的峰值，并可以不引入过多的噪声；
[0017]
为了进一步提高自适应扩张状态观测器对扰动的估计精度，定义ζ轴自适应集总干扰估计补偿其自适应律表达式为：
[0018][0019]
其中，是ζ轴自适应函数，ε
maxζ
是ζ轴集总干扰估计偏差上边界，ε
minζ
是ζ轴集总干扰估计偏差下边界；
[0020]
ζ轴自适应律通过投影映射关系，不仅保证了ζ轴自适应集总干扰估计补偿的自适应实时变化，也保证了始终满足
[0021]
(2)针对三轴惯性稳定平台的非线性、框架内外耦合和参数不确定性，设计全局快速终端滑模控制器，并结合自适应扩张状态观测器对集总干扰的有效估计，替换掉高阶终端函数，降低抖振现象，实现复杂环境下的三轴惯性稳定平台高精度控制；
[0022]
ζ轴全局快速终端滑动模态、ζ轴基于自适应扩张状态观测器和全局快速终端滑模控制律以及ζ轴自适应函数表达式分别为：
[0023][0024][0025][0026]
其中，s
1ζ
为ζ轴高阶滑动模态，e
ζ
为ζ轴跟踪误差，k
eζ
＞0为ζ轴跟踪误差增益，α
0ζ
＞0，β
0ζ
＞0，q
0ζ
和p
0ζ
都是正奇数且满足p
0ζ
＞q
0ζ
，k
sζ
＞0是ζ轴高阶滑动模态增益，γ
εζ
是ζ轴学习速率；
[0027]
ζ轴基于自适应扩张状态观测器和全局快速终端滑模控制律u
ζ
中，将高阶终端函数替换成自适应扩张状态观测器对集总干扰的估计项降低了抖振现象，提高了三轴惯性稳定平台的控制精度。
[0028]
本发明与现有技术相比的优点在于：
[0029]
(1)本发明针对三轴惯性稳定平台系统模型耦合强，未知外界扰动多的特性，通过设计自适应扩张状态观测器，实时估计未知的集总干扰，利用全局快速终端滑模控制器，处理三轴惯性稳定平台的非线性、框架内外耦合和参数不确定性，并结合自适应扩张状态观测器对集总干扰的有效估计，替换掉高阶终端函数，降低抖振现象，进而实现复杂环境下的三轴惯性稳定平台高精度控制，不仅具有结构简单和控制方便的特性，同时具有抗干扰能力强的特点；
[0030]
(2)本发明构造的自适应扩张状态观测器既继承了非线性扩张状态观测器和线性扩张状态观测器的优点，又克服了它们的缺点，与非线性扩张状态观测器相比，自适应扩张状态观测器不仅设计灵活，而且能够实现良好的观测性能，同时，自适应扩张状态观测器具有良好的理论分析形式，这也是线性扩张状态观测器的优势，所设计的控制方法实时性好、动态参数响应快、抗干扰能力强，能够满足三轴惯性稳定平台的高精度控制需求；
[0031]
(3)本发明通过自适应观测带宽来调整自适应扩张状态观测器的观测增益，充分利用三轴惯性稳定平台角度和角速度信息来降低观测器估计曲线的峰值，并且不引入过多的噪声，除此之外，通过自适应集总干扰估计补偿进一步提高自适应扩张状态观测器对集总干扰的估计精度，进而提高系统对扰动的鲁棒性。
附图说明
[0032]
图1为三轴惯性稳定平台控制流程；
[0033]
图2为飞行实验中三轴惯性稳定平台俯仰通道控制效果；
[0034]
图3为飞行实验中三轴惯性稳定平台横滚通道控制效果；
[0035]
图4为飞行实验中三轴惯性稳定平台航向通道控制效果。
具体实施方式
[0036]
如图1所示，本发明的具体实现如下
[0037]
(1)构建自适应扩张状态观测器
[0038]
基于newton-euler理论，三轴惯性稳定平台的动力学方程表示为
[0039][0040]
其中，ζ＝r时表示横滚通道，ζ＝p时表示俯仰通道，ζ＝a时表示航向通道，θ
dζ
为ζ轴期望角度，x
1ζ
＝θ
ζ
、x
2ζ
＝ω
ζ
分别为ζ轴实际角度、ζ轴实际角速度，u
ζ
为ζ轴控制电压，b
ζ
为ζ轴控制量增益，f
ζ
为ζ轴已知非线性函数，d
ζ
为ζ轴集总干扰，且其一阶导数有界；
[0041]
为了降低未知扰动对三轴惯性稳定平台的影响，提高控制性能，引入自适应扩张状态观测器来在线估计集总干扰；
[0042]
建立ζ轴自适应扩张状态观测器如下：
[0043][0044]
其中，分别为ζ轴角度估计值、ζ轴角速度估计值和ζ轴集总干扰估计值，e
1ζ
为ζ轴实际角度θ
ζ
与ζ轴角度估计值的误差，ω
aζ
是ζ轴观测器带宽，其自适应时变表达式如下：
[0045][0046]
式中，ω
ahζ
为ζ轴观测器带宽上界，ω
alζ
为ζ轴观测器带宽下界，δ
1ζ
＞0为ζ轴角度估计偏差增益，δ
2ζ
＞0为ζ轴角速度估计偏差增益；
[0047]
ζ轴观测器带宽ω
aζ
充分利用了三轴惯性稳定平台角度和角速度信息来降低观测器估计曲线的峰值，并可以不引入过多的噪声；
[0048]
为了进一步提高自适应扩张状态观测器对扰动的估计精度，定义ζ轴集总干扰估计偏差：
[0049][0050]
其中，ζ轴集总干扰估计偏差ε
ζ
是ζ轴未知的有界常变量，满足ε
minζ
≤ε
ζ
≤ε
maxζ
，ε
maxζ
是ζ轴集总干扰估计偏差上边界，ε
minζ
是ζ轴集总干扰估计偏差下边界；为了补偿自适应扩张状态观测器对集总干扰的估计偏差，定义ζ轴自适应集总干扰估计补偿其为ζ轴集总干扰估计偏差ε
ζ
的估计值，估计误差为且ζ轴自适应集总干扰估计补偿的自适应律表达式定义为：
[0051][0052]
其中，是ζ轴自适应函数，ζ轴自适应律通过投影映射关系，不仅保证了ζ轴自适应集总干扰估计补偿的自适应实时变化，也保证了始终满足
[0053]
(2)构建全局快速终端滑模控制器
[0054]
针对三轴惯性稳定平台的非线性、框架内外耦合和参数不确定性，引入全局快速终端滑模控制器，提高三轴惯性稳定平台的快速性和对期望角度的跟踪性能，并结合自适应扩张状态观测器对集总干扰的有效估计，替换掉高阶终端函数，降低抖振现象，全局快速终端滑动模态的设计如下：
[0055][0056]
其中，s
1ζ
为ζ轴高阶滑动模态，e
ζ
为ζ轴跟踪误差，k
eζ
＞0为ζ轴跟踪误差增益，α
0ζ
＞0，β
0ζ
＞0，q
0ζ
和p
0ζ
都是正奇数且满足p
0ζ
＞q
0ζ
；
[0057]
当ζ轴高阶滑动模态s
1ζ
＝0时，有：
[0058][0059]
当ζ轴跟踪误差e
ζ
远离平衡点时，此时是一种快速终端吸引子；当ζ轴跟踪误差e
ζ
接近平衡状态e
ζ
＝0时，是一种线性滑动模态，且ζ轴跟踪误差e
ζ
呈指数衰减；因此，全局快速终端滑动模态既引入了快速终端吸引子，使得ζ轴跟踪误差e
ζ
在有限时间收敛，又保留了线性滑动模态在接近平衡态时的快速性，从而实现ζ轴跟踪误差e
ζ
精准快速地收敛到平衡状态；
[0060]
对ζ轴高阶滑动模态s
1ζ
求取一阶导：
[0061][0062]
且定义ζ轴自适应函数表达式：
[0063][0064]
其中，γ
εζ
是ζ轴学习速率。
[0065]
则ζ轴基于自适应扩张状态观测器和全局快速终端滑模控制律为：
[0066][0067]
其中，k
sζ
＞0是ζ轴高阶滑动模态增益，ζ轴基于自适应扩张状态观测器和全局快速终端滑模控制律u
ζ
中，将高阶终端函数替换成自适应扩张状态观测器对集总干扰的估计项降低了抖振现象，提高了三轴惯性稳定平台的控制精度。
[0068]
根据实际的控制律u
ζ
，三轴惯性稳定平台的姿态角是大范围渐进稳定的，并且ζ轴跟踪误差e
ζ
＝0是在有限时间内可达的，因此三轴惯性稳定平台的实际角度θ
ζ
可以跟踪期望角度θ
dζ
。
[0069]
(3)飞行实例
[0070]
在飞行过程中，根据无人机和目标的位置关系，平台挂载的相机载荷会被要求保持在20米高度，以8米每秒的前飞速度垂直地面拍摄，俯仰通道和横滚通道被要求保持在0度，航向通道被要求保持在90度。地面的监测中心会对无人机和平台进行实时的监控，某次实验的飞行结果如图2、图3和图4所示。
[0071]
惯性稳定平台实现了高精度、强干扰鲁棒性的控制，在5级阵风等恶劣环境干扰的情况下，俯仰通道的误差均方根值是0.3771度，最大偏差0.8567度；横滚通道的误差均方根值是0.2902度，最大偏差0.8504度；航向通道的误差均方根值是0.0420度，最大偏差0.2048度。
[0072]
本发明基于自适应扩张状态观测器和全局快速终端滑模的三轴惯性稳定平台高精度控制方法克服了现有控制方法的不足，可以实现三轴惯性稳定平台在复杂多扰环境下的高精度控制。
[0073]
本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。