法律状态公告日
法律状态信息
法律状态
2017-11-14
授权
授权
2016-03-30
实质审查的生效 IPC(主分类):G01C25/00 申请日:20151224
实质审查的生效
2016-03-02
公开
公开
技术领域
本发明是基于扩展高增益观测器的陀螺飞轮系统扰动估计方法,具体涉及惯性导航领 域。
背景技术
陀螺飞轮是一种应用于航天器的兼具执行器和敏感器功能的机电伺服装置,其基于传 统的惯性仪器—动力调谐陀螺仪的物理结构发展而来。但是,陀螺飞轮与动力调谐陀螺仪 功能上的明显不同在于,陀螺飞轮不仅实现与动力调谐陀螺仪一样的二维载体角速率测量 功能,还能实现三维控制力矩输出功能。而陀螺飞轮为实现三维力矩输出功能,陀螺飞轮 转子在两维径向需产生大角度的倾侧运动,在轴向需产生调速运动,这些运动状态的显著 不同,导致了陀螺飞轮在三维力矩输出基础上实现二维航天器角速率测量功能较动力调谐 陀螺仪更为复杂。
动力调谐陀螺仪研制中均需要实现漂移误差补偿,以克服不理想因素的影响,从而保 证测量精度。而动力调谐陀螺仪最常采用的静态漂移误差补偿方法为伺服转台法和力矩反 馈法,这两种静态漂移误差补偿方法可以对诸如不等弹性,质量不平衡等因素引起的系统 误差进行标定补偿;但是,由于该方法为一种静态的标定方法,无法对像陀螺飞轮这样的 转子长时间工作于大倾侧运动状态的系统进行完整的标定补偿,因此需要进一步研究动态 的扰动估计方法对由于陀螺飞轮转子大倾侧运动产生的漂移误差进行估计,利用实验估计 得到的试验数据序列对扰动进行建模补偿。
卡尔曼滤波技术为一种最优状态估计方法,它通过递推算法,由实时获得的存在噪声 污染的离散实验数据,对系统状态进行无偏及最小方差的最优估计。但是,卡尔曼滤波依 赖于准确完整的系统数学模型,而对陀螺飞轮系统,由于不理想因素引起的扰动未知,且 很难对其进行建模,所以利用卡尔曼滤波进行陀螺飞轮系统的扰动估计存在较大困难。基 于自抗扰思想发展而来扩展状态观测器为一种非线性状态观测器,此种非线性状态观测器 方法可将陀螺飞轮系统中的扰动扩张为一阶状态,利用特定的非光滑非线性误差反馈,结 合适当的设计参数,实现对所有状态的观测。虽然众多学者对此种非线性状态观测器方法 进行了深入研究,但是,非线性状态观测器方法由于设计参数众多,导致参数整定困难, 且非线性状态观测器方法采用连续非光滑非线性结构,难以用传统的观测器设计理论进行 收敛性及观测误差分析,尤其对高阶(二阶以上)系统的误差收敛问题仍未得到很好的解 决。对陀螺飞轮系统,若利用非线性状态观测器方法进行扰动估计,较为合理的设计参数 选择及误差收敛性证明则显得较为繁琐复杂,实现难度较大。
发明内容
本发明为了解决陀螺飞轮在大倾侧角工作状态的动态扰动估计问题,进而提出基于扩 展高增益观测器的陀螺飞轮系统扰动估计方法,包括以下步骤:
步骤一、根据陀螺飞轮系统的动力学方程,构建含有未知扰动影响的陀螺飞轮系统状 态方程;
陀螺飞轮系统的倾侧传感器直接测量转子沿径向运动两维倾侧角φx,φy,利用第二类拉 格朗日法建立的陀螺飞轮系统动力学方程,通过相应的坐标变换,将系统的未考虑扰动的 理想动力学方程转换为可通过传感器直接测量得到的φx,φy所在的壳体坐标系下,从而可得 到考虑未建模扰动的陀螺飞轮系统状态方程;
选用陀螺飞轮转子在两维方向的倾侧角(φx,φy)及倾侧角速度作为状态变量:
量测方程如公式(2)所示:
其中,f1(x,t),f2(x,t)表示理想情况下,陀螺飞轮的非线性机理项;ux,uy表示两维力 矩器的控制力矩,gx1(x,t),gx2(x,t),gy1(x,t),gy2(x,t)表示两维力矩器的非线性系数项;
σx(x,t),σy(x,t)表示系统的未建模扰动项;y1,y2分别表示可测量的陀螺飞轮转子两维倾侧 角(φx,φy);
由公式(1)(2)整理后,可得公式(3):
其中,σd(x,t)为陀螺飞轮系统连续有界的未建模非线性扰动项;u为两维连续有界控 制输入,即两维力矩器输出;f(x,t),g(x,t)均为标称模型,且为二次连续可微有界的非 线性函数;
其中,
其中,Cθ与Sθ的表达式分别为转角θ的余弦值cosθ和正弦值sinθ;
Irx,Iry,Irz分别为转子在转子体坐标系三惯性主轴方向转动惯量,为已知量;
Igx,Igy,Igz分别为平衡环在平衡环体坐标系三惯性主轴方向转动惯量,为已知量;
kx,ky分别为已知的挠性支撑扭杆抗扭刚度;cgx,cgy分别为已知的挠性支撑阻尼系数;
Tcx=ktyiy,Tcy=ktxix分别为两维力矩器输出至转子的控制力矩,即方程(1)中的ux,uy;
ktx,kty分别为已知传感器的标度因子,ix,iy分别为两维力矩器的电流,为传感器可测量;
θz,分别表示陀螺飞轮电机轴转角与转速,均为传感器可测量;
方程中的θx,θy,φz,I1,I2,β1,β2,η均为中间变量,具体形式分别如下:
I2=Igz-Igy-Iry+Irxsin2θy+Irzcos2θy;
步骤二、根据含有未知扰动的陀螺飞轮系统状态方程,利用两维倾侧传感器可测量 φx,φy,设计扩展高增益观测器;
为利用量测方程y=Cx,实现对状态变量x和非线性扰动项σd(x,t)的准确估计,设计 如下扩展高增益观测器:
其中,为高增益观测器状态变量;
H(ε),F(ε)为观测器的增益矩阵,其具体形式如下:
其中,设计参数ε>0为小的设计参数;设计参数αij,i=1,2,3,j=1,2均选择为实数;
步骤三、观测误差收敛性验证及观测器设计参数ε调节;
分析所设计的陀螺飞轮扩展高增益观测器的观测误差收敛性,根据观测精度需求,调 整并给出适用的扩展高增益观测器设计参数;
定义误差向量即
其中,
将方程(4)第二式带入到方程(6)的第三式及第六式,并整理成矩阵形式, 如公式(7):
式(7)可进一步简写为:
其中,
根据状态方程(8),非线性项δ可视为系统的扰动输入,状态视为系统输出,则期 望中hi,i=1,2...6的设计能够抵消δ对的影响,实现状态观测误差的渐进收敛,考虑由 扰动输入δ至状态输出的传递函数,对(8)进行拉氏变换,得到公式(9):
公式(9)进一步展开为:
其中,
分别记
设
其中,αij,i=1,2,3;j=1,2满足如下(12)所示的Hurwitz多项式;ε为正常数,且ε<<1;
s3+α1js2+α2js+α3j,j=1,2(12)
将h1~h6带入至Gj(s)中,可得:
其中,P(s)=(εs)3+α1j(εs)2+α2j(εs)+α3j,j=1,2;
步骤四、实现陀螺飞轮系统扰动估计;
利用扩展后的高增益观测器进行陀螺飞轮系统的扰动观测,结合步骤三调节设计参数 ε,对利用多元回归模型表征的扰动进行估计,直至观测数据满足期望估计精度指标,得 到陀螺飞轮系统大倾侧运动所产生的扰动估计试验数据序列,实现陀螺飞轮系统未建模的 扰动项σdx(x,t),σdy(x,t)的估计。
本发明有益效果:
1、本发明方法利用所设计扩展高增益观测器,充分地利用两维倾侧传感器测量信息与 观测信息的误差,较大程度地削弱了差分运算所产生的不利影响,提高了观测精确度;
2、本发明方法与传统的机械陀螺仪采用静态误差方法相比,本发明针对的是由陀螺飞 轮转子大倾侧角运动所引起的扰动进行估计,为一种动态的误差估计方法,可用于在静态 误差标定基础上进一步对陀螺飞轮测量方程进行扰动估计与补偿,为现有误差标定技术的 一种补充技术。
附图说明
图1是基于扩展高增益观测器的陀螺飞轮系统扰动估计方法的流程示意框图;
图2是设计参数ε=0.1时,陀螺飞轮在x轴的扰动估计值图;
图3是设计参数ε=0.1时,陀螺飞轮在y轴的扰动估计值图;
图4是设计参数ε=0.1时,陀螺飞轮在x轴的扰动估计误差图;
图5是设计参数ε=0.1时,陀螺飞轮在y轴的扰动估计误差图;
图6是设计参数ε=0.001时,陀螺飞轮在x轴的扰动估计值图;
图7是设计参数ε=0.001时,陀螺飞轮在y轴的扰动估计值图;
图8是设计参数ε=0.001时,陀螺飞轮在x轴扰动估计误差图;
图9是设计参数ε=0.001时,陀螺飞轮在y轴的扰动估计误差图。
具体实施方式
具体实施方式一:本实施方式基于扩展高增益观测器的陀螺飞轮系统扰动估计方法按 照以下步骤来实现:
步骤一、根据陀螺飞轮系统的动力学方程,建立含有未知扰动的陀螺飞轮系统状态方 程;
步骤二、根据含有未知扰动的陀螺飞轮系统状态方程,设计扩展高增益观测器;
步骤三、观测误差收敛性及观测器设计参数ε调节;
步骤四、实现陀螺飞轮系统扰动估计。
具体实施方式二:本实施方式与具体实施方式一不同的是:其特征在于,所述的步骤 一含有未知扰动的陀螺飞轮系统状态方程按照以下步骤实现:
陀螺飞轮转子在两维方向的倾侧角(φx,φy)及倾侧角速度作为状态变量x:
量测方程如公式(2)所示:
其中,f1(x,t),f2(x,t)表示理想情况下,陀螺飞轮的非线性机理项;ux,uy表示两维力 矩器的控制力矩,gx1(x,t),gx2(x,t),gy1(x,t),gy2(x,t)表示两维力矩器的非线性系数项;
σx(x,t),σy(x,t)表示系统的未建模扰动项;y1,y2分别表示可测量的陀螺飞轮转子两维倾侧 角(φx,φy);
由公式(1)(2)整理后,可得公式(3):
其中,σd(x,t)为陀螺飞轮系统连续有界的未建模非线性扰动项;u为两维连续有界控 制输入,即两维力矩器输出;f(x,t),g(x,t)均为标称模型,且为二次连续可微有界非线 性函数;
其中,
其中,Cθ与Sθ的表达式分别为转角θ的余弦值cosθ和正弦值sinθ;
Irx,Iry,Irz分别为转子在转子体坐标系三惯性主轴方向转动惯量,为已知量;
Igx,Igy,Igz分别为平衡环在平衡环体坐标系三惯性主轴方向转动惯量,为已知量;
kx,ky分别为已知的挠性支撑扭杆抗扭刚度;cgx,cgy分别为已知的挠性支撑阻尼系数;
Tcx=ktyiy,Tcy=ktxix分别为两维力矩器输出至转子的控制力矩,即方程(1)中的ux,uy;
ktx,kty分别为已知传感器的标度因子,ix,iy分别为两维力矩器的电流,为传感器可测量;
θz,分别表示陀螺飞轮电机轴转角与转速,均为传感器可测量;
方程中的θx,θy,φz,I1,I2,β1,β2,η均为中间变量,具体形式分别如下:
I2=Igz-Igy-Iry+Irxsin2θy+Irzcos2θy;
具体实施方式三:本实施方式与具体实施方式一或二不同的是:其特征在于,所述的 步骤二设计扩展高增益观测器按照以下步骤实现:
利用量测方程y=Cx,实现对状态变量x和非线性扰动项σd(x,t)的估计,设计如下扩 展高增益观测器:
其中,为高增益观测器状态变量;
H(ε),F(ε)为观测器的增益矩阵,其具体形式如下:
其中,设计参数ε>0为小的设计参数;设计参数αij,i=1,2,3,j=1,2均选择为实数, 且应满足如下Hurwitz多项式:
s3+α1js2+α2js+α3j,j=1,2
其它步骤及参数与具体实施方式一至二之一相同。
具体实施方式四:本实施方式与具体实施方式一至三之一不同的是:其特征在于,所 述的步骤三观测误差收敛性及观测器设计参数ε调节按照以下步骤来实现:
分析所设计的陀螺飞轮扩展高增益观测器的观测误差收敛性,根据观测精度需求,调 整并给出适用的扩展高增益观测器设计参数;
定义误差向量即
其中,
将方程(4)第二式带入到方程(6)的第三式及第六式,并整理成矩阵形式, 如公式(7):
式(7)可进一步简写为:
其中,
根据状态方程(8),非线性项δ可视为系统的扰动输入,状态视为系统输出,则期 望中hi,i=1,2...6的设计能够抵消δ对的影响,实现状态观测误差的渐进收敛,考虑由 扰动输入δ至状态输出的传递函数,对(8)进行拉氏变换,得到公式(9):
公式(9)进一步展开为:
其中,
分别记
设
其中,αij,i=1,2,3;j=1,2满足如下(12)所示的Hurwitz多项式;ε为正常数,且ε<<1;
s3+α1js2+α2js+α3j,j=1,2(12)
将h1~h6带入至Gj(s)中,可得:
其中P(s)=(εs)3+α1j(εs)2+α2j(εs)+α3j,j=1,2;
其它步骤及参数与具体实施方式一至三之一相同。
具体实施方式五:本实施方式与具体实施方式一至四之一不同的是:其特征在于,所 述的步骤四陀螺飞轮系统扰动估计按照以下步骤来实现:
利用步骤二所设计的扩展后的高增益观测器进行陀螺飞轮系统的扰动观测,结合步骤 三调节设计参数ε,对利用多元回归模型表征的陀螺飞轮系统的扰动进行估计,使观测数 据满足期望估计精度指标,得到陀螺飞轮系统大倾侧运动所产生的扰动估计试验数据序 列,实现陀螺飞轮系统未建模的扰动项σdx(x,t),σdy(x,t)的估计;
其它步骤及参数与具体实施方式一至四之一相同。
实施例
设陀螺飞轮系统扰动σk数学描述如公式(14)所示:
其中,a,bi,cj均为常值待定系数,m,n为多元回归模型的选用的阶数,f=ωm/(2π)为时变 电机旋转频率,ωm为电机转速;仿真时陀螺飞轮物理系统数学模型如公式(1)中σx,σy表 示为如公式(15)所示:
式(15)即实验中扩展高增益观测器的估计目标;
陀螺飞轮系统转子、平衡环的转动惯量Jr,Jg分别给定为:
其中,Jrxy,Jrxz,Jryz表示由转子不平衡引起的扰动因素,其影响在陀螺飞轮系统方程如公式 (1)中体现为σx(x,t),σy(x,t)未知扰动项,仿真中扰动影响已由公式(15)表征;
陀螺飞轮系统中两对扭杆的抗扭刚度k和阻尼系数cg分别设为:
k=0.092N·m/rad;cg=2.5e-4N·m·s/rad
设陀螺飞轮在航天器三轴方向均处于力矩输出状态,陀螺飞轮三轴输入指令分别为电 机驱动轴转速指令:ω'm=23·sin(0.2π·t)+157rad/s,转子沿径向x轴,y轴的两维倾侧角 指令分别为:
φ'y=1·sin(0.2π·t)°
扩展高增益观测器设计参数αij,i=1,2,3,j=1,2如下:
α1j=12.6;α2j=312.1;α3j=3225.3;j=1,2
根据陀螺飞轮参数设置和输入指令,传感器中不考虑量测噪声时,ε分别取0.1,0.001 时,系统扰动(σx,σy)的观测效果分别如图2-图9所示。
根据图2-图9可知,当ε=0.1时,观测误差位于10-3数量级内;当ε=0.001时,观测误 差位于10-4数量级内,观测误差提高了一个数量级;利用所设计的高增益观测器对陀螺飞轮 两径向轴的扰动估计均达到较好的观测效果,扰动的估计精度随ε取值的减小而提 高。
机译: 基于扰动估计观测器的伺服控制方法
机译: 扩展扰动观测器控制一阶系统的方法和装置
机译: 基于段相关旅行时间估计的扰动边缘检测基于中心的预期扰动识别方法和系统