CN107608217B - 基于复合学习的mems陀螺仪模糊滑模控制方法 - Google Patents
基于复合学习的mems陀螺仪模糊滑模控制方法 Download PDFInfo
- Publication number
- CN107608217B CN107608217B CN201711073629.9A CN201711073629A CN107608217B CN 107608217 B CN107608217 B CN 107608217B CN 201711073629 A CN201711073629 A CN 201711073629A CN 107608217 B CN107608217 B CN 107608217B
- Authority
- CN
- China
- Prior art keywords
- fuzzy
- sliding mode
- fuzzy logic
- mems
- model
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Landscapes
- Gyroscopes (AREA)
- Medicines Containing Antibodies Or Antigens For Use As Internal Diagnostic Agents (AREA)
Abstract
本发明公开了一种基于复合学习的MEMS陀螺仪模糊滑模控制方法,用于解决现有MEMS陀螺仪模态控制方法实用性差的技术问题。技术方案是首先根据模糊预测误差和跟踪误差,设计模糊逻辑权值的复合自适应律,修正模糊逻辑的权重系数,实现未知动力学的有效动态估计;同时由于系统处于滑动模态时,对参数不确定和外界干扰不敏感,设计滑模控制器,实现未知动力学的前馈补偿。本发明考虑预测误差和跟踪误差,设计模糊逻辑权值的复合学习更新律,修正模糊逻辑的权重系数,实现未知动力学的有效动态估计。结合滑模控制理论,实现对MEMS陀螺未知动力学的前馈补偿,进一步提高MEMS陀螺仪的控制精度,实用性好。
Description
技术领域
本发明涉及一种MEMS陀螺仪模态控制方法,特别涉及一种基于复合学习的MEMS陀螺仪模糊滑模控制方法。
背景技术
MEMS陀螺仪由于其体积小、功耗低、成本低、容易与处理电路集成等优点,广泛应用于各种角运动测量领域。为保证其测量精度,要求MEMS陀螺仪检测质量块必须沿着驱动方向以驱动轴的固有频率做恒幅振动。然而,由于环境因素变化和陀螺制造缺陷的影响,常规PID控制无法实现MEMS陀螺仪的高精度控制,导致陀螺产生严重漂移。
随着非线性控制技术的发展,Park S等人将非线性控制理论引入MEMS陀螺仪控制,弱化驱动模态与检测模态的界限,对驱动轴和检测轴均施以反馈控制力,使两个轴向的模态运动跟踪指定的正弦参考轨迹,进而有效提高MEMS陀螺仪的控制精度。
《Adaptive global sliding mode control for MEMS gyroscope using RBFneural network》(Yundi Chu and Juntao Fei,《Mathematical Problems inEngineering》,2015)一文采用RBF神经网络学习MEMS陀螺动力学的不确定项,再利用全局滑模方法对不确定及干扰进行补偿。这种方法虽然实现了不确定未知情况下的MEMS陀螺控制,但由于违背了神经网络逼近不确定的本意,针对实际应用中,环境不稳定导致MEMS陀螺仪未知动力学动态变化的情况,难以实现有效动态估计。
发明内容
为了克服现有MEMS陀螺仪模态控制方法实用性差的不足,本发明提供一种基于复合学习的MEMS陀螺仪模糊滑模控制方法。该方法首先根据模糊预测误差和跟踪误差,设计模糊逻辑权值的复合自适应律,修正模糊逻辑的权重系数,实现未知动力学的有效动态估计;同时由于系统处于滑动模态时,对参数不确定和外界干扰不敏感,设计滑模控制器,实现未知动力学的前馈补偿。本发明考虑预测误差和跟踪误差,设计模糊逻辑权值的复合学习更新律,修正模糊逻辑的权重系数,实现未知动力学的有效动态估计。结合滑模控制理论,实现对MEMS陀螺未知动力学的前馈补偿,进一步提高MEMS陀螺仪的控制精度,实用性好。
本发明解决其技术问题所采用的技术方案:一种基于复合学习的MEMS陀螺仪模糊滑模控制方法,其特点是包括以下步骤:
(a)考虑正交误差的MEMS陀螺仪的动力学模型为:
其中,m为检测质量块的质量;Ωz为陀螺输入角速度;为静电驱动力; x*分别是MEMS陀螺仪检测质量块沿驱动轴的加速度,速度和位移;y*分别是检测质量块沿检测轴的加速度,速度和位移;dxx,dyy是阻尼系数;kxx,kyy是刚度系数;dxy是阻尼耦合系数,kxy是刚度耦合系数。
为提高机理分析准确度,对MEMS陀螺动力学模型进行无量纲化处理。取无量纲化时间t*=ωot,然后在式(1)两边同时除以参考频率的平方参考长度q0和检测质量块质量m,可以得到MEMS陀螺的无量纲化模型为
其中,
重新定义相关系统参数为
则MEMS陀螺的无量纲化模型化简为
令A=2S-D,B=Ω2-K,考虑环境因素和未建模因素造成的参数波动,则式(4)表示为
所述的无量纲化模型由状态变量q=[x y]T和控制输入u=[ux uy]T组成。其中,x,y分别为无量纲化后检测质量块沿驱动轴和检测轴的运动位移;ux uy分别表示无量纲化后施加在驱动轴和检测轴的力;A、B、C是模型的参数,且其值与陀螺仪的结构参数和动力学特性有关;P为模型参数不确定带来的未知动力学,且ΔA,ΔB为环境因素和未建模因素造成的未知的参数波动。
(b)构造模糊逻辑系统逼近所述的模糊逻辑系统由M条IF-THEN语句描述,其中第i条规则有如下形式:
Rule i:
采用乘积推理机、单值模糊器和中心平均解模糊器,模糊系统的输出为
其中,Xin是模糊逻辑系统的输入向量,且 为模糊逻辑的权值矩阵;θ(Xin)为M维模糊基向量。模糊基向量的第i个元素为
其中,分别是xi,yi到论域A1i,A2i,A3i,A4i的隶属度,的隶属函数设计为如下高斯函数:
其中,σi分别是该高斯函数的中心和标准差。
定义最优估计参数w*为
其中,ψ是w的集合。
因此,动力学模型的不确定项表示为
其中,ε为模糊系统的逼近误差。
且不确定项的估计误差为
其中,且
(c)建立MEMS陀螺的动力学参考模型为
其中,qd为参考振动位移信号,为qd的二阶导数;Ax,Ay分别为检测质量块沿驱动轴和检测轴振动的参考振幅;ωx,ωy分别为检测质量块沿驱动轴和检测轴振动的参考角频率。
构建跟踪误差为
e=q-qd (13)
定义滑模面其中,β满足Hurwitz条件。则
滑模控制器设计为
其中,K0为正定矩阵。
将滑模控制器式(15)代入式(14),有
(d)定义并且定义新的信号
定义建模误差为预测误差。为了使闭环系统保证s和的收敛,考虑预测误差和滑模函数,模糊逻辑权值矩阵的复合学习更新律设计为
其中,λ,为正定矩阵。
(e)根据得到的控制器式(15)和复合学习权重更新律式(18),返回到MEMS陀螺的动力学模型式(5),对陀螺检测质量块的振动位移和速度进行跟踪控制。
本发明的有益效果是:该方法首先根据模糊预测误差和跟踪误差,设计模糊逻辑权值的复合自适应律,修正模糊逻辑的权重系数,实现未知动力学的有效动态估计;同时由于系统处于滑动模态时,对参数不确定和外界干扰不敏感,设计滑模控制器,实现未知动力学的前馈补偿。本发明考虑预测误差和跟踪误差,设计模糊逻辑权值的复合学习更新律,修正模糊逻辑的权重系数,实现未知动力学的有效动态估计。结合滑模控制理论,实现对MEMS陀螺未知动力学的前馈补偿,进一步提高MEMS陀螺仪的控制精度,实用性好。
下面结合附图和具体实施方式对本发明作详细说明。
附图说明
图1是本发明基于复合学习的MEMS陀螺仪模糊滑模控制方法的流程图。
具体实施方式
参照图1。本发明基于复合学习的MEMS陀螺仪模糊滑模控制方法具体步骤如下:
(a)考虑正交误差的MEMS陀螺仪的动力学模型为:
其中,m为检测质量块的质量;Ωz为陀螺输入角速度;为静电驱动力; x*分别是MEMS陀螺仪检测质量块沿驱动轴的加速度,速度和位移;y*分别是检测质量块沿检测轴的加速度,速度和位移;dxx,dyy是阻尼系数;kxx,kyy是刚度系数;dxy是阻尼耦合系数,kxy是刚度耦合系数。
为提高机理分析准确度,对MEMS陀螺动力学模型进行无量纲化处理。取无量纲化时间t*=ωot,然后在式(1)两边同时除以参考频率的平方参考长度q0和检测质量块质量m,可以得到MEMS陀螺的无量纲化模型为
其中,
重新定义相关系统参数为
则MEMS陀螺的无量纲化模型可化简为
令A=2S-D,B=Ω2-K,考虑环境因素和未建模因素造成的参数波动,则式(4)可表示为
该模型由状态变量q=[x y]T和控制输入u=[ux uy]T组成。其中,x,y分别为无量纲化后检测质量块沿驱动轴和检测轴的运动位移;ux uy分别表示无量纲化后施加在驱动轴和检测轴的力;A、B、C是模型的参数,且其值与陀螺仪的结构参数和动力学特性有关;P为模型参数不确定带来的未知动力学,且ΔA,ΔB为环境因素和未建模因素造成的未知的参数波动。
根据某型号的振动式硅微机械陀螺,选取陀螺各参数为m=0.57×10-7kg,q0=[10-6 10-6]Tm,ω0=1kHz,Ωz=5.0rad/s,kxx=80.98N/m,kyy=71.62N/m,kxy=0.05N/m,dxx=0.429×10-6Ns/m,dyy=0.0429×10-6Ns/m,dxy=0.0429×10-6Ns/m,则可计算得到
(b)利用模糊逻辑动态估计模型参数不确定带来的未知动力学。
构造模糊逻辑系统逼近该模糊逻辑系统由M条IF-THEN语句描述,其中第i条规则有如下形式:
Rule i:
采用乘积推理机、单值模糊器和中心平均解模糊器,模糊系统的输出为
其中,Xin是模糊逻辑系统的输入向量,且 为模糊逻辑的权值矩阵;θ(Xin)为M=44=256维模糊基向量,模糊基向量的第i个元素为
其中,分别是xi,yi到论域A1i,A2i,A3i,A4i的隶属度,以为例,隶属函数可设计为如下高斯函数:
其中,σi分别是该高斯函数的中心和标准差。xmi,ymi分别在[-2020],[-0.24 0.24],[-10 10],[-0.12 0.12]之间任意取值,σi=1。
定义最优估计参数w*为
其中,ψ是w的集合。
因此,动力学模型的不确定项可表示为
其中,ε为模糊系统的逼近误差。
且不确定项的估计误差为
其中,且
(c)引入滑模控制,实现未知动力学的前馈补偿。
建立MEMS陀螺的动力学参考模型为
其中,qd为参考振动位移信号,为qd的二阶导数;Ax,Ay分别为检测质量块沿驱动轴和检测轴振动的参考振幅,且Ax=10μm,Ay=0.12μm;ωx,ωy分别为检测质量块沿驱动轴和检测轴振动的参考角频率,且ωx=2000rad/s,ωy=2000rad/s。
构建跟踪误差为
e=q-qd (13)
定义滑模面其中,β为正定矩阵,取值为则
滑模控制器可设计为
其中,K0为正定矩阵,取值为
将控制器式(15)代入式(14),有
(d)设计模糊逻辑权值矩阵的复合学习更新律。
定义并且定义新的信号
定义建模误差为预测误差。为了使闭环系统保证s和的收敛,考虑预测误差和滑模函数,模糊逻辑权值矩阵的复合学习更新律可设计为
其中,λ,为正定矩阵,取值为
(e)根据得到的控制器式(15)和复合学习权重更新律式(18),返回到MEMS陀螺的动力学模型式(5),对陀螺检测质量块的振动位移和速度进行跟踪控制。
本发明未详细说明部分属于领域技术人员公知常识。
Claims (1)
1.一种基于复合学习的MEMS陀螺仪模糊滑模控制方法,其特征在于包括以下步骤:
(a)考虑正交误差的MEMS陀螺仪的动力学模型为:
其中,m为检测质量块的质量;Ωz为陀螺输入角速度;为静电驱动力; x*分别是MEMS陀螺仪检测质量块沿驱动轴的加速度,速度和位移;y*分别是检测质量块沿检测轴的加速度,速度和位移;dxx,dyy是阻尼系数;kxx,kyy是刚度系数;dxy是阻尼耦合系数,kxy是刚度耦合系数;
为提高机理分析准确度,对MEMS陀螺动力学模型进行无量纲化处理;取无量纲化时间t*=ωot,然后在式(1)两边同时除以参考频率的平方参考长度q0和检测质量块质量m,可以得到MEMS陀螺的无量纲化模型为
其中,
重新定义相关系统参数为
则MEMS陀螺的无量纲化模型化简为
令A=2S-D,B=Ω2-K,考虑环境因素和未建模因素造成的参数波动,则式(4)表示为
所述的无量纲化模型由状态变量q=[x y]T和控制输入u=[ux uy]T组成;其中,x,y分别为无量纲化后检测质量块沿驱动轴和检测轴的运动位移;ux uy分别表示无量纲化后施加在驱动轴和检测轴的力;A、B、C是模型的参数,且其值与陀螺仪的结构参数和动力学特性有关;P为模型参数不确定带来的未知动力学,且ΔA,ΔB为环境因素和未建模因素造成的未知的参数波动;
(b)构造模糊逻辑系统逼近所述的模糊逻辑系统由M条IF-THEN语句描述,其中第i条规则有如下形式:
采用乘积推理机、单值模糊器和中心平均解模糊器,模糊系统的输出为
其中,Xin是模糊逻辑系统的输入向量,且 为模糊逻辑的权值矩阵;θ(Xin)为M维模糊基向量;模糊基向量的第i个元素为
其中,分别是xi,yi到论域A1i,A2i,A3i,A4i的隶属度,的隶属函数设计为如下高斯函数:
其中,σi分别是该高斯函数的中心和标准差;
定义最优估计参数w*为
其中,ψ是w的集合;
因此,动力学模型的不确定项表示为
其中,ε为模糊系统的逼近误差;
且不确定项的估计误差为
其中,且
(c)建立MEMS陀螺的动力学参考模型为
其中,qd为参考振动位移信号,为qd的二阶导数;Ax,Ay分别为检测质量块沿驱动轴和检测轴振动的参考振幅;ωx,ωy分别为检测质量块沿驱动轴和检测轴振动的参考角频率;
构建跟踪误差为
e=q-qd (13)
定义滑模面其中,β满足Hurwitz条件;则
滑模控制器设计为
其中,K0为正定矩阵;
将滑模控制器式(15)代入式(14),有
(d)定义并且定义新的信号
定义建模误差为预测误差;为了使闭环系统保证s和的收敛,考虑预测误差和滑模函数,模糊逻辑权值矩阵的复合学习更新律设计为
其中,λ,为正定矩阵;
(e)根据得到的控制器式(15)和复合学习权重更新律式(18),返回到MEMS陀螺的动力学模型式(5),对陀螺检测质量块的振动位移和速度进行跟踪控制。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711073629.9A CN107608217B (zh) | 2017-11-05 | 2017-11-05 | 基于复合学习的mems陀螺仪模糊滑模控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711073629.9A CN107608217B (zh) | 2017-11-05 | 2017-11-05 | 基于复合学习的mems陀螺仪模糊滑模控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107608217A CN107608217A (zh) | 2018-01-19 |
CN107608217B true CN107608217B (zh) | 2019-09-24 |
Family
ID=61085472
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711073629.9A Active CN107608217B (zh) | 2017-11-05 | 2017-11-05 | 基于复合学习的mems陀螺仪模糊滑模控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107608217B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108897226B (zh) * | 2018-08-20 | 2019-07-19 | 西北工业大学 | 基于干扰观测器的mems陀螺仪预设性能非奇异滑模控制方法 |
CN110174844B (zh) * | 2019-07-03 | 2021-08-10 | 西北工业大学 | 一种远程操控系统的广义阶滑模预测控制方法 |
CN112286055B (zh) * | 2020-10-26 | 2022-08-26 | 贵州大学 | 无精确参考轨迹的分数阶mems陀螺仪加速自适应反演控制方法 |
CN116909136B (zh) * | 2023-06-21 | 2023-12-26 | 山东大学 | 基于确定学习的2-dof直升机滑模控制方法及系统 |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN100381787C (zh) * | 2006-03-27 | 2008-04-16 | 北京航空航天大学 | 一种陀螺仪标度因数和输入轴失准角的解耦测试设备 |
CN100538276C (zh) * | 2007-11-16 | 2009-09-09 | 北京航空航天大学 | 一种基于集成神经网络的微小卫星用mems陀螺仪误差补偿方法 |
US8884710B2 (en) * | 2011-10-25 | 2014-11-11 | Invensense, Inc. | Gyroscope with phase and duty-cycle locked loop |
CN103616818B (zh) * | 2013-11-14 | 2015-12-30 | 河海大学常州校区 | 微陀螺仪的自适应模糊神经全局快速终端滑模控制方法 |
CN103900610B (zh) * | 2014-03-28 | 2016-06-29 | 哈尔滨工程大学 | 基于灰色小波神经网络的mems陀螺随机误差预测方法 |
CN104281056B (zh) * | 2014-09-18 | 2017-07-21 | 河海大学常州校区 | 基于神经网络上界学习的微陀螺仪鲁棒自适应控制方法 |
CN105045097B (zh) * | 2015-05-26 | 2017-10-27 | 河海大学常州校区 | 一种基于神经网络的微陀螺仪反演全局滑模模糊控制方法 |
US10451418B2 (en) * | 2015-12-09 | 2019-10-22 | Invensense, Inc. | MEMS gyroscope amplitude control via quadrature |
CN107289969A (zh) * | 2016-04-01 | 2017-10-24 | 南京理工大学 | 一种mems惯性传感器自动批量标定方法及系统 |
-
2017
- 2017-11-05 CN CN201711073629.9A patent/CN107608217B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN107608217A (zh) | 2018-01-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107607101B (zh) | 基于干扰观测器的mems陀螺滑模控制方法 | |
CN107678282B (zh) | 考虑未知动力学和外部干扰的mems陀螺智能控制方法 | |
CN107607103B (zh) | 基于干扰观测器的mems陀螺仪复合学习控制方法 | |
CN107608217B (zh) | 基于复合学习的mems陀螺仪模糊滑模控制方法 | |
CN107607102B (zh) | 基于干扰观测器的mems陀螺滑模抖振抑制方法 | |
Wei et al. | On disturbance rejection in magnetic levitation | |
CN108897226B (zh) | 基于干扰观测器的mems陀螺仪预设性能非奇异滑模控制方法 | |
CN103116275B (zh) | 基于滑模补偿的微陀螺仪鲁棒神经网络控制系统及方法 | |
CN102636995B (zh) | 基于rbf神经网络滑模控制微陀螺仪的方法 | |
CN104281056B (zh) | 基于神经网络上界学习的微陀螺仪鲁棒自适应控制方法 | |
CN102385342B (zh) | 虚拟轴机床并联机构运动控制的自适应动态滑模控制方法 | |
CN108803324A (zh) | 多关节工业机械臂反步有限时间滑模控制方法 | |
CN102914972A (zh) | 基于模型整体逼近的微陀螺仪rbf网络自适应控制方法 | |
CN102681443B (zh) | 一种基于模糊补偿的微机电陀螺仪模糊自适应控制系统 | |
CN110389528A (zh) | 基于扰动观测的数据驱动mems陀螺仪驱动控制方法 | |
CN112181002B (zh) | 微陀螺仪双递归扰动模糊神经网络分数阶滑模控制方法 | |
CN110703610B (zh) | 微陀螺仪的递归模糊神经网络非奇异终端滑模控制方法 | |
CN102411302A (zh) | 基于直接自适应模糊控制的mems微陀螺仪控制方法 | |
CN105278331A (zh) | 一种微陀螺的鲁棒自适应神经网络h无穷控制方法 | |
CN104503246A (zh) | 微陀螺仪系统的间接自适应神经网络滑模控制方法 | |
CN107608216B (zh) | 基于平行估计模型的mems陀螺仪复合学习控制方法 | |
CN107870566B (zh) | 基于平行估计复合学习的mems陀螺仪快速启动方法 | |
CN112077839A (zh) | 一种机械臂的运动控制方法及装置 | |
Dai et al. | Adaptive force tracking control of electrohydraulic systems with low load using the modified LuGre friction model | |
CN111427267B (zh) | 一种采用力与力矩自适应估计的高速飞行器攻角跟踪方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |