法律状态公告日
法律状态信息
法律状态
2022-08-26
实质审查的生效 IPC(主分类):G05B13/04 专利申请号:2022106289823 申请日:20220606
实质审查的生效
2022-08-09
公开
发明专利申请公布
技术领域
本发明涉及基于自适应扩张状态观测器和全局快速终端滑模的三轴惯性稳定平台高精度控制方法,适用于航空测绘稳定平台高精度控制领域。
背景技术
三轴吊舱平台通过基座固连于飞行载体,支撑并稳定遥感载荷,隔离飞行载体非理想姿态运动对遥感载荷视轴的影响来提高遥感载荷的成像质量,具有广泛的应用前景。
作为复杂的多框架耦合系统,三轴惯性稳定平台具有非线性、强耦合、控制难度高等特性。并且三轴惯性稳定平台在飞行过程中存在风扰、飞机发动机振动引起的基座角运动干扰、平台质心和运动成像载荷转轴中心不重合引起的不平衡力矩、稳定平台本身机械和电气构造不完善导致的耦合力矩和摩擦干扰力矩、陀螺和加计测量误差系统内扰,因此,三轴惯性稳定平台在扰动下的高精度控制是测绘系统的关键技术之一。
为提高性能,PID控制方法、鲁棒控制、智能控制、滑模控制方法等各类控制方法被用于三轴惯性稳定平台的高精度控制。PID控制器结构简单,但抗干扰能力差,三轴稳定平台的控制性能很容易受到外界干扰影响而降低。鲁棒控制可以较好地消除三轴惯性稳定平台在飞行过程中存在的模型参数不精确和外界干扰问题,但鲁棒控制具有实时性较差、动态参数响应慢的特性。通过大量的样本训练,神经网络可以实现非线性自适应控制,克服三轴惯性稳定平台所具有的模型不确定性,以及存在多源干扰等问题,实现高精度的姿态控制,但传统的神经网络需要大量的样本数据进行训练,具有实时性差的缺点。滑模变结构控制通过构建滑模面,使系统按照既定规则沿滑动模态运动,是一种有效的解决带有外部扰动以及不确定的非线性问题控制方法,对于存在严重非线性、外界干扰的系统具有不错的控制效果。但是滑模的弊端在于其切换函数,在外部干扰较大时,可能使系统产生抖振。
发明内容
本发明解决的技术问题是:针对三轴惯性稳定平台在执行任务时控制性能容易受到外界干扰影响的问题,提出一种基于自适应扩张状态观测器和全局快速终端滑模的三轴惯性稳定平台高精度控制方法,通过设计自适应扩张状态观测器,实时估计未知的集总干扰,构建全局快速终端滑模控制器,处理三轴惯性稳定平台的非线性、框架内外耦合和参数不确定性,并结合自适应扩张状态观测器对集总干扰的有效估计,替换掉高阶终端函数,降低抖振现象,进而实现复杂环境下的三轴惯性稳定平台高精度控制。
本发明的技术解决方案为:首先针对三轴惯性稳定平台动力学模型,通过设计自适应扩张状态观测器,并利用观测器带宽的自适应变化和对干扰估计偏差的自适应补偿,在保证快速性、超调小和噪声低的同时,实时估计未知的集总干扰,设计全局快速终端滑模控制器,处理三轴惯性稳定平台的非线性、框架内外耦合和参数不确定性,并结合自适应扩张状态观测器对集总干扰的有效估计,替换掉高阶终端函数,降低抖振现象;其实现步骤如下:
(1)针对三轴惯性稳定平台动力学模型,
其中,ζ=r时表示横滚通道,ζ=p时表示俯仰通道,ζ=a时表示航向通道,θ
为了降低未知扰动对三轴惯性稳定平台的影响,提高控制性能,设计自适应扩张状态观测器来在线估计集总干扰;
ζ轴自适应扩张状态观测器定义为:
其中,
式中,ω
ζ轴观测器带宽ω
为了进一步提高自适应扩张状态观测器对扰动的估计精度,定义ζ轴自适应集总干扰估计补偿
其中,
ζ轴自适应律
(2)针对三轴惯性稳定平台的非线性、框架内外耦合和参数不确定性,设计全局快速终端滑模控制器,并结合自适应扩张状态观测器对集总干扰的有效估计,替换掉高阶终端函数,降低抖振现象,实现复杂环境下的三轴惯性稳定平台高精度控制;
ζ轴全局快速终端滑动模态、ζ轴基于自适应扩张状态观测器和全局快速终端滑模控制律以及ζ轴自适应函数表达式分别为:
其中,s
ζ轴基于自适应扩张状态观测器和全局快速终端滑模控制律u
本发明与现有技术相比的优点在于:
(1)本发明针对三轴惯性稳定平台系统模型耦合强,未知外界扰动多的特性,通过设计自适应扩张状态观测器,实时估计未知的集总干扰,利用全局快速终端滑模控制器,处理三轴惯性稳定平台的非线性、框架内外耦合和参数不确定性,并结合自适应扩张状态观测器对集总干扰的有效估计,替换掉高阶终端函数,降低抖振现象,进而实现复杂环境下的三轴惯性稳定平台高精度控制,不仅具有结构简单和控制方便的特性,同时具有抗干扰能力强的特点;
(2)本发明构造的自适应扩张状态观测器既继承了非线性扩张状态观测器和线性扩张状态观测器的优点,又克服了它们的缺点,与非线性扩张状态观测器相比,自适应扩张状态观测器不仅设计灵活,而且能够实现良好的观测性能,同时,自适应扩张状态观测器具有良好的理论分析形式,这也是线性扩张状态观测器的优势,所设计的控制方法实时性好、动态参数响应快、抗干扰能力强,能够满足三轴惯性稳定平台的高精度控制需求;
(3)本发明通过自适应观测带宽来调整自适应扩张状态观测器的观测增益,充分利用三轴惯性稳定平台角度和角速度信息来降低观测器估计曲线的峰值,并且不引入过多的噪声,除此之外,通过自适应集总干扰估计补偿进一步提高自适应扩张状态观测器对集总干扰的估计精度,进而提高系统对扰动的鲁棒性。
附图说明
图1为三轴惯性稳定平台控制流程;
图2为飞行实验中三轴惯性稳定平台俯仰通道控制效果;
图3为飞行实验中三轴惯性稳定平台横滚通道控制效果;
图4为飞行实验中三轴惯性稳定平台航向通道控制效果。
具体实施方式
如图1所示,本发明的具体实现如下
(1)构建自适应扩张状态观测器
基于Newton-Euler理论,三轴惯性稳定平台的动力学方程表示为
其中,ζ=r时表示横滚通道,ζ=p时表示俯仰通道,ζ=a时表示航向通道,θ
为了降低未知扰动对三轴惯性稳定平台的影响,提高控制性能,引入自适应扩张状态观测器来在线估计集总干扰;
建立ζ轴自适应扩张状态观测器如下:
其中,
式中,ω
ζ轴观测器带宽ω
为了进一步提高自适应扩张状态观测器对扰动的估计精度,定义ζ轴集总干扰估计偏差:
其中,ζ轴集总干扰估计偏差ε
其中,
(2)构建全局快速终端滑模控制器
针对三轴惯性稳定平台的非线性、框架内外耦合和参数不确定性,引入全局快速终端滑模控制器,提高三轴惯性稳定平台的快速性和对期望角度的跟踪性能,并结合自适应扩张状态观测器对集总干扰的有效估计,替换掉高阶终端函数,降低抖振现象,全局快速终端滑动模态的设计如下:
其中,s
当ζ轴高阶滑动模态s
当ζ轴跟踪误差e
对ζ轴高阶滑动模态s
且定义ζ轴自适应函数
其中,γ
则ζ轴基于自适应扩张状态观测器和全局快速终端滑模控制律为:
其中,k
根据实际的控制律u
(3)飞行实例
在飞行过程中,根据无人机和目标的位置关系,平台挂载的相机载荷会被要求保持在20米高度,以8米每秒的前飞速度垂直地面拍摄,俯仰通道和横滚通道被要求保持在0度,航向通道被要求保持在90度。地面的监测中心会对无人机和平台进行实时的监控,某次实验的飞行结果如图2、图3和图4所示。
惯性稳定平台实现了高精度、强干扰鲁棒性的控制,在5级阵风等恶劣环境干扰的情况下,俯仰通道的误差均方根值是0.3771度,最大偏差0.8567度;横滚通道的误差均方根值是0.2902度,最大偏差0.8504度;航向通道的误差均方根值是0.0420度,最大偏差0.2048度。
本发明基于自适应扩张状态观测器和全局快速终端滑模的三轴惯性稳定平台高精度控制方法克服了现有控制方法的不足,可以实现三轴惯性稳定平台在复杂多扰环境下的高精度控制。
本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。
机译: 一种用于宽速度感应电动机的控制装置,该控制装置基于通过伦伯格状态观测器进行的磁通估计来进行控制,以及用于定位所述状态观测器的特征值的方法
机译: 用于宽范围感应电机的控制设备,执行基于Luenberger状态观测器手段的通量估计的控制,以及用于定位SAID状态观测器特征值的方法
机译: 基于滑模观测器的永磁直流电动机换向控制装置和方法