CN110389530B - 基于数据筛选的mems陀螺仪参数辨识驱动控制方法 - Google Patents
基于数据筛选的mems陀螺仪参数辨识驱动控制方法 Download PDFInfo
- Publication number
- CN110389530B CN110389530B CN201910648375.1A CN201910648375A CN110389530B CN 110389530 B CN110389530 B CN 110389530B CN 201910648375 A CN201910648375 A CN 201910648375A CN 110389530 B CN110389530 B CN 110389530B
- Authority
- CN
- China
- Prior art keywords
- dimensionless
- data
- phi
- drive control
- time
- 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
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Gyroscopes (AREA)
Abstract
本发明涉及一种基于数据筛选的MEMS陀螺仪参数辨识驱动控制方法,属于智能化仪器仪表领域。该方法将陀螺仪动力学模型转化为无量纲的动力学线性参数化模型;设计在线数据筛选方法选择合适的历史数据,并结合当前数据共同构建参数自适应律;采用区间激励的方式松绑参数辨识对持续激励条件的苛刻要求;设计控制器同时实现参数辨识和驱动控制。本发明设计的基于数据筛选的MEMS陀螺仪参数辨识驱动控制方法可解决参数辨识难以获取真值且对持续激励要求严苛的问题,获取精确的动力学模型,同时实现高精度陀螺仪驱动控制,进一步改善MEMS陀螺仪性能。
Description
技术领域
本发明涉及一种MEMS陀螺仪的驱动控制方法,特别是涉及一种基于数据筛选的MEMS陀螺仪参数辨识驱动控制方法,属于智能化仪器仪表领域。
背景技术
实际工程中,精确的动力学模型是MEMS陀螺驱动控制系统设计和系统仿真的重要条件,其中模型参数的准确性直接影响驱动控制精度。因此有必要在驱动控制前对模型参数进行辨识。目前常用的MEMS陀螺参数辨识方法有两种:(1)将动力学模型中的参数和状态都纳入Kalman滤波器的状态向量,以MEMS陀螺检测质量块的位移作为量测量,采用扩展Kalman滤波器或无迹Kalman滤波器进行参数估计;(2)结合动力学参数辨识与驱动控制过程,基于驱动控制跟踪误差设计参数更新律,实现参数在线估计。而在实际工程中,第一种方法计算量偏大,对系统硬件要求高;第二种方法参数辨识精度有限,且要求参数更新律一直满足持续激励条件,这一条件难以保持。
《Adaptive nonsingular terminal sliding mode control of MEMS gyroscopebased on backstepping design》(Juntao Fei,Weifeng Yan and Yuzheng Yang,《International Journal of Adaptive Control Signal Processing》,2015)一文中提出了一种基于反步法的MEMS陀螺仪非奇异终端滑模控制方法,同时给出了动力学模型参数辨识结果。这种方法与上述第二种方法思路相同,所辨识的参数仅能保证稳态收敛,并不能确保最终收敛至参数的真值且持续激励条件难以实现。
发明内容
要解决的技术问题
为克服现有技术辨识参数并不一定能收敛到真值且对持续激励要求严苛的问题,本发明提出一种基于数据筛选的MEMS陀螺仪参数辨识驱动控制方法。该方法设计一种数据筛选方法选择合适的历史数据,并结合当前数据共同构建参数自适应律;采用区间激励的方式松绑了参数辨识对持续激励条件的苛刻要求;设计控制器同时实现参数辨识和驱动控制。
技术方案
一种基于数据筛选的MEMS陀螺仪参数辨识驱动控制方法,其特征在于步骤如下:
步骤1:考虑存在正交误差的MEMS陀螺动力学模型为:
其中,m为检测质量块的质量;Ωz为陀螺输入角速度,和x*分别为MEMS陀螺仪检测质量块沿驱动轴的加速度、速度和位移,和y*分别为沿检测轴的加速度、速度和位移,和为静电驱动力,cxx和cyy为阻尼系数,kxx和kyy为刚度系数,和为非线性系数,cxy和cyx为阻尼耦合系数,kxy和kyx为刚度耦合系数;上述参数根据振动式硅微机械陀螺参数选取;
重新定义
则式(2)可以改写为
F(z)=W*TΦ(z) (5)
步骤2:给出MEMS陀螺动力学式(1)的参考轨迹为
则无量纲动力学式(4)的参考轨迹为
定义跟踪误差为
则控制器设计为
U=Un+Upd-Uad (9)
Upd=K1e1+K2e2 (11)
给出参数的自适应律为
其中,等式右边第一项采用当前时刻数据计算,第二项采用pH个时刻点的历史数据计算,Φ(zi)为Φ(z)在i(i=1,2,…,pH)时刻点的取值,F(zi)为F(z)在i(i=1,2,…,pH)时刻点的取值,且待设计参数满足Hurwitz条件,B=[02×2,I2×2]T;
步骤3:定义一个矩阵Zt存储数据Φ(z),该矩阵行数为6,列数p随存储数据量变化且假设p*是存储数据最后一个时刻点,为p*时刻点的Φ(z),ε为正常数;参数自适应律式(15)选用的在线数据筛选流程如下:
③计算当前Zt矩阵的最小奇异值,并将之记为Sold;然后,分别在i(i=1,2,…,pH)时刻将Φ(z)存入Zt矩阵,得到一组矩阵 计算不同Zt的最小奇异值,并选出所有最小奇异值中的最大值S;继续执行步骤④;
④如果S>Sold,将pH时刻的Φ(z)存入Zt矩阵,即Zt(:,pH)=Φ(z),否则舍弃pH时刻的Φ(z);返回步骤①继续筛选数据;
步骤4:基于步骤3记载的数据筛选方法和参数自适应律式(13)设计控制器式(9)驱动无量纲动力学式(4),并通过量纲转换返回MEMS陀螺动力学模型式(1),实现陀螺驱动控制和参数精确辨识。
有益效果
本发明提出的一种基于数据筛选的MEMS陀螺仪参数辨识驱动控制方法,与现有技术相比的有益效果为:
(1)针对参数辨识难以辨识出真值的问题,设计数据筛选方法选择合适的历史数据,并结合当前数据共同构建参数自适应律,实现参数精确辨识。
(2)针对参数辨识过程中持续激励条件难以实现的问题,采用区间激励的方式设计参数自适应律,放宽对激励条件的限制。
附图说明
图1本发明具体实施流程图
图2本发明数据筛选流程图
具体实施方式
现结合实施例、附图对本发明作进一步描述:
本发明公开了一种基于数据筛选的MEMS陀螺仪参数辨识驱动控制方法,结合图1,具体设计步骤如下:
(a)考虑存在正交误差的MEMS陀螺动力学模型为:
其中,m为检测质量块的质量,Ωz为陀螺输入角速度,和x*分别为MEMS陀螺仪检测质量块沿驱动轴的加速度、速度和位移,和y*分别为沿检测轴的加速度、速度和位移,和为静电驱动力,cxx和cyy为阻尼系数,kxx和kyy为刚度系数,和为非线性系数,cxy和cyx为阻尼耦合系数,kxy和kyx为刚度耦合系数。根据某型号的振动式硅微机械陀螺,选取陀螺各参数为m=5.7×10-9kg,q0=10-5m,ω0=1kHz,Ωz=5.0rad/s,kxx=80.98N/m,kyy=71.62N/m,kxy=0.05N/m,kyx=0.05N/m,cxx=4.29×10-7Ns/m,cyy=4.29×10-8Ns/m,cxy=4.29×10-8Ns/m,cyx=4.29×10-8Ns/m。
取无量纲化时间t=ωot*,无量纲化位移x=x*/q0,y=y*/q0,其中ω0为参考频率,q0为参考长度,对MEMS陀螺动力学模型进行无量纲化处理,得到
重新定义动力学参数为
式(3)可以表示为
定义
则式(4)可以改写为
F(z)=W*TΦ(z) (7)
(b)给出MEMS陀螺动力学式(1)的参考轨迹为
则无量纲动力学式(6)的参考轨迹为
定义跟踪误差为
则控制器设计为
U=Un+Upd-Uad (11)
Upd=K1e1+K2e2 (13)
给出参数的自适应律为
其中,等式右边第一项采用当前时刻数据计算,第二项采用pH个时刻点的历史数据计算,Φ(zi)为Φ(z)在i(i=1,2,…,pH)时刻点的取值,F(zi)为F(z)在i(i=1,2,…,pH)时刻点的取值,且ΓW=diag([10,12,8,3,71,31]),B=[02×2,I2×2]T,P=diag([10,12,71,31])。
(c)定义一个矩阵Zt存储数据Φ(z),该矩阵行数为6,列数p随存储数据量变化且假设p*是存储数据最后一个时刻点,为p*时刻点的Φ(z),ε=0.08。参考图2,参数自适应律式(15)选用的在线数据筛选流程如下:
③计算当前Zt矩阵的最小奇异值,并将之记为Sold。然后,分别在i(i=1,2,…,pH)时刻将Φ(z)存入Zt矩阵,得到一组矩阵 计算不同Zt的最小奇异值,并选出所有最小奇异值中的最大值S。继续执行步骤④。
④如果S>Sold,将pH时刻的Φ(z)存入Zt矩阵,即Zt(:,pH)=Φ(z),否则舍弃pH时刻的Φ(z)。返回步骤①继续筛选数据。
(d)基于(c)部分数据筛选方法和参数自适应律式(15)设计控制器式(11)驱动无量纲动力学式(6),并通过量纲转换返回MEMS陀螺动力学模型式(1),实现陀螺驱动控制和参数精确辨识。
Claims (1)
1.一种基于数据筛选的MEMS陀螺仪参数辨识驱动控制方法,其特征在于步骤如下:
步骤1:考虑存在正交误差的MEMS陀螺动力学模型为:
其中,m为检测质量块的质量;Ωz为陀螺输入角速度,和x*分别为MEMS陀螺仪检测质量块沿驱动轴的加速度、速度和位移,和y*分别为沿检测轴的加速度、速度和位移,和为静电驱动力,cxx和cyy为阻尼系数,kxx和kyy为刚度系数,和为非线性系数,cxy和cyx为阻尼耦合系数,kxy和kyx为刚度耦合系数;上述参数根据振动式硅微机械陀螺参数选取;
重新定义
则式(2)可以改写为
F(z)=W*TΦ(z) (5)
步骤2:给出MEMS陀螺动力学式(1)的参考轨迹为
则无量纲动力学式(4)的参考轨迹为
定义跟踪误差为
则控制器设计为
U=Un+Upd-Uad (9)
Upd=K1e1+K2e2 (11)
给出参数的自适应律为
其中,等式右边第一项采用当前时刻数据计算,第二项采用pH个时刻点的历史数据计算,Φ(zi)为Φ(z)在i时刻点的取值,i=1,2,…,pH,F(zi)为F(z)在i时刻点的取值,i=1,2,…,pH,且待设计参数满足Hurwitz条件,B=[02×2,I2×2]T;
步骤3:定义一个矩阵Zt存储数据Φ(z),该矩阵行数为6,列数p随存储数据量变化且假设p*是存储数据最后一个时刻点,为p*时刻点的Φ(z),ε为正常数;参数自适应律式(15)选用的在线数据筛选流程如下:
③计算当前Zt矩阵的最小奇异值,并将之记为Sold;然后,分别在i时刻将Φ(z)存入Zt矩阵,i=1,2,…,pH,得到一组矩阵 计算不同Zt的最小奇异值,并选出所有最小奇异值中的最大值S;继续执行步骤④;
④如果S>Sold,将pH时刻的Φ(z)存入Zt矩阵,即Zt(:,pH)=Φ(z),否则舍弃pH时刻的Φ(z);返回步骤①继续筛选数据;
步骤4:基于步骤3记载的数据筛选方法和参数自适应律式(13)设计控制器式(9)驱动无量纲动力学式(4),并通过量纲转换返回MEMS陀螺动力学模型式(1),实现陀螺驱动控制和参数精确辨识。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910648375.1A CN110389530B (zh) | 2019-07-18 | 2019-07-18 | 基于数据筛选的mems陀螺仪参数辨识驱动控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910648375.1A CN110389530B (zh) | 2019-07-18 | 2019-07-18 | 基于数据筛选的mems陀螺仪参数辨识驱动控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110389530A CN110389530A (zh) | 2019-10-29 |
CN110389530B true CN110389530B (zh) | 2022-05-17 |
Family
ID=68285100
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910648375.1A Active CN110389530B (zh) | 2019-07-18 | 2019-07-18 | 基于数据筛选的mems陀螺仪参数辨识驱动控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110389530B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11867509B2 (en) | 2021-03-03 | 2024-01-09 | Invensense, Inc. | Robust method for gyroscope drive amplitude measurement |
CN113433819B (zh) * | 2021-06-09 | 2022-05-10 | 浙江中控技术股份有限公司 | 一种系统辨识方法和计算机设备 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107132763A (zh) * | 2017-05-11 | 2017-09-05 | 北方电子研究院安徽有限公司 | 一种mems陀螺仪闭环驱动用自动增益控制电路 |
CN107607101A (zh) * | 2017-11-05 | 2018-01-19 | 西北工业大学 | 基于干扰观测器的mems陀螺滑模控制方法 |
CN107607103A (zh) * | 2017-11-05 | 2018-01-19 | 西北工业大学 | 基于干扰观测器的mems陀螺仪复合学习控制方法 |
CN108897226A (zh) * | 2018-08-20 | 2018-11-27 | 西北工业大学 | 基于干扰观测器的mems陀螺仪预设性能非奇异滑模控制方法 |
-
2019
- 2019-07-18 CN CN201910648375.1A patent/CN110389530B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107132763A (zh) * | 2017-05-11 | 2017-09-05 | 北方电子研究院安徽有限公司 | 一种mems陀螺仪闭环驱动用自动增益控制电路 |
CN107607101A (zh) * | 2017-11-05 | 2018-01-19 | 西北工业大学 | 基于干扰观测器的mems陀螺滑模控制方法 |
CN107607103A (zh) * | 2017-11-05 | 2018-01-19 | 西北工业大学 | 基于干扰观测器的mems陀螺仪复合学习控制方法 |
CN108897226A (zh) * | 2018-08-20 | 2018-11-27 | 西北工业大学 | 基于干扰观测器的mems陀螺仪预设性能非奇异滑模控制方法 |
Non-Patent Citations (2)
Title |
---|
Sliding mode control of MEMS gyroscopes using composite learning;RUI ZHANG etc.;《Neurocomputing》;20180131;第275卷;第2555-2564页 * |
基于智能控制技术的微惯性器件误差抑制方法研究;张睿;《中国优秀博硕士学位论文全文数据库(硕士)信息科技辑》;20180915(第9期);第I140-78页 * |
Also Published As
Publication number | Publication date |
---|---|
CN110389530A (zh) | 2019-10-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110389528B (zh) | 基于扰动观测的数据驱动mems陀螺仪驱动控制方法 | |
CN109927032B (zh) | 一种基于高阶滑模观测器的机械臂轨迹跟踪控制方法 | |
CN108710296B (zh) | 微陀螺仪的分数阶自适应快速终端滑模控制方法 | |
CN110389530B (zh) | 基于数据筛选的mems陀螺仪参数辨识驱动控制方法 | |
JP5139412B2 (ja) | 角度測定の方法およびそれを実施するための角度測定ジャイロシステム | |
CN107807527B (zh) | 微陀螺仪增益可调的自适应超扭曲滑模控制方法 | |
CN105912013A (zh) | 一种组合体航天器姿态无模型自适应控制方法 | |
CN111623779A (zh) | 一种适用于噪声特性未知的时变系统自适应级联滤波方法 | |
CN110389527B (zh) | 基于异类估计的mems陀螺仪滑模控制方法 | |
CN110471293B (zh) | 一种估计时变角速度的z轴陀螺仪滑模控制方法 | |
CN110456639B (zh) | 基于历史数据参数辨识的mems陀螺仪自适应驱动控制方法 | |
CN109062048B (zh) | 基于复合学习的mems陀螺仪预设性能非奇异滑模控制方法 | |
CN110262242B (zh) | 一种微陀螺仪自适应分数阶滑模控制方法 | |
CN115655272B (zh) | Mems加速度计零偏和标度因数的温度补偿方法及系统 | |
CN107870566A (zh) | 基于平行估计复合学习的mems陀螺仪快速启动方法 | |
CN110442023B (zh) | 一种mems陀螺仪驱动与检测模态预设性能抗干扰控制方法 | |
CN110426952B (zh) | 考虑外界干扰的区间数据学习mems陀螺仪高精度驱动控制方法 | |
CN110456638B (zh) | 基于区间数据激励的mems陀螺仪参数辨识自适应驱动控制方法 | |
CN111930154B (zh) | 一种mems陀螺仪的非奇异终端滑模控制方法和装置 | |
CN110579966B (zh) | 一种基于神经网络辨识参数的z轴陀螺仪控制方法 | |
CN110389529B (zh) | 基于平行估计的mems陀螺仪参数辨识驱动控制方法 | |
CN113252068B (zh) | 一种惯组动态特性的确定方法 | |
CN110389526B (zh) | 基于Super-Twisting算法的MEMS陀螺自适应滑模控制方法 | |
Lee et al. | Real-time rls-based joint model identification and state observer design for robot manipulators: Experimental studies | |
CN110456640B (zh) | 基于非奇异终端滑模设计的mems陀螺仪参数辨识神经网络控制方法 |
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 | ||
TR01 | Transfer of patent right |
Effective date of registration: 20230421 Address after: 710072 No. 127 Youyi West Road, Shaanxi, Xi'an Patentee after: Northwestern Polytechnical University Patentee after: RESEARCH & DEVELOPMENT INSTITUTE OF NORTHWESTERN POLYTECHNICAL University IN SHENZHEN Address before: 710072 No. 127 Youyi West Road, Shaanxi, Xi'an Patentee before: Northwestern Polytechnical University |
|
TR01 | Transfer of patent right |