[发明专利]用于模态匹配状态硅微机械陀螺仪带宽拓展数字校正方法在审
申请号: | 201710366532.0 | 申请日: | 2017-05-23 |
公开(公告)号: | CN107238381A | 公开(公告)日: | 2017-10-10 |
发明(设计)人: | 李宏生;杨成;朱昆朋 | 申请(专利权)人: | 东南大学 |
主分类号: | G01C19/5726 | 分类号: | G01C19/5726 |
代理公司: | 南京苏高专利商标事务所(普通合伙)32204 | 代理人: | 曾教伟 |
地址: | 211189 江*** | 国省代码: | 江苏;32 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | 本发明公开了一种用于模态匹配状态硅微机械陀螺仪带宽拓展数字校正方法,该方法是采用如下步骤实现的1)建立模态匹配状态硅微机械陀螺仪闭环检测模型;2)在硅微机械陀螺仪的检测回路中增设比例积分相位超前校正器;3)对校正器进行离散化,得到用于模态匹配状态硅微机械陀螺仪带宽拓展的数字校正器;所述比例积分相位超前数字校正器包含比例环节、积分环节和相位超前环节。本发明解决了模态匹配状态下硅微机械陀螺仪无法兼顾静态灵敏度和工作带宽的问题,用于模态匹配状态硅微机械陀螺仪带宽拓展的数字校正。 | ||
搜索关键词: | 用于 匹配 状态 微机 陀螺仪 带宽 拓展 数字 校正 方法 | ||
【主权项】:
一种用于模态匹配状态硅微机械陀螺仪带宽拓展数字校正方法,其特征在于,包括以下步骤:1)对开环检测进行改进,构成陀螺闭环检测环路,根据闭环检测工作原理,可以得到角速度检测闭环传递函数为:式(A7)中:Hclose(s)为陀螺检测闭环传递函数,Vclose为硅微机械陀螺仪闭环检测输出电压,Ωz表示输入角速度,my为陀螺检测模态检测质量,Ax为驱动梳齿振动位移,Hopen(s)为陀螺检测开环传递函数,KyVF为反馈电压到检测反馈力的转换系数,Kyc为检测模态梳齿电容转换增益,Kcv为电容电压转换增益,Kamp为检测回路前置放大器增益,Vref为解调基准电压,为解调相角,Flpf(s)为相敏解调环节中的低通滤波器传递函数,Gy(s)为陀螺检测模态传递函数,Ffb(s)为力反馈校正器;闭环检测系统的静态灵敏度可以表示为:式(A8)中:Ks为硅微机械陀螺仪闭环检测静态灵敏度,Hclose(s)为陀螺检测闭环传递函数,my为陀螺检测模态检测质量,Ax为驱动梳齿振动位移,Hopen(s)为陀螺检测开环传递函数,KyVF为反馈电压到检测反馈力的转换系数,Kyc为检测模态梳齿电容转换增益,Kcv为电容电压转换增益,Kamp为检测回路前置放大器增益,Vref为解调基准电压,为解调相角,Flpf(0)为低通滤波器静态增益,Gy(s)为陀螺检测模态传递函数,Ffb(0)为力反馈校正器静态增益;当校正器静态增益Ffb(0)很大,即满足环路增益>>1时,此时有:Ks=2myAxωdKyVF--(A9)]]>式(A9)中:Ks为硅微机械陀螺仪闭环检测静态灵敏度,my为陀螺检测模态检测质量,Ax为驱动梳齿振动位移,ωd为驱动角频率,KyVF为反馈电压到检测反馈力的转换系数;从式(A9)可以发现,当环路增益很大时,检测闭环控制系统的静态灵敏度与陀螺频差无关,也与前馈检测增益无关;只与检测质量块大小、驱动模态振动幅度和谐振频率以及检测力反馈转换增益有关;比较式(A9)和式(A4)可知,与开环检测系统的静态灵敏度相比,闭环检测系统的静态灵敏度受温度等环境影响较小,因此可以显著改善系统的稳定性和可靠性;2)为了方便设计闭环校正器,从哥氏力输入和反馈力输出的角度构成单位负反馈系统,该闭环反馈系统的开环传递函数为:式(A10)中:Hopen(s)表示闭环反馈系统的开环传递函数,Ff为检测反馈力,Ωz表示输入角速度,Kyc为检测模态梳齿电容转换增益,Kcv为电容电压转换增益,Kamp为检测回路前置放大器增益,Vref为解调基准电压,Ax为驱动梳齿振动位移,ωd为驱动角频率,Flpf(s)为低通滤波器传递函数,Ffb(s)为力反馈校正器传递函数,KyVF为反馈电压到检测反馈力的转换系数,为解调相角,ωy为硅微机械陀螺仪检测模态的谐振角频率,Qy为检测模态品质因数;在系统中加入频率特性合适的校正器,应该使开环系统频率特性形状满足:低频段增益充分大,以保证系统稳态误差的要求;中频段对数幅频特性斜率‑20dB/dec,并占据充分宽的频带,以保证系统具备适当的相角裕度;高频段增益应尽快减小,以削弱噪声的影响;由于模态匹配状态下的陀螺检测模型可以看作一阶惯性环节,因此,可以采用比例积分环节与相位超前环节相结合的串联校正方式来对检测控制回路进行整形;校正器的传递函数为:Ffb(s)=(Kp+Kis)·(s+ω1s+ω2)---(A11)]]>式(A11)中:Ffb(s)为力反馈校正器传递函数,Kp、Ki分别为比例积分控制器的比例系数和积分系数,ω1和ω2分别为相位超前环节的零极点,且ω1<ω2;3)由于硅微机械陀螺仪实际控制系统中的校正器由数字电路实现,因此,需要对式(A11)进行离散域变换,比例积分控制器的离散域模型为:D1(z)=Kp+KiT0·11-z-1=(Kp+KiT)z-Kpz-1---(A12)]]>式(A12)中:D1(z)为比例积分控制器的离散域表达式,Kp、Ki分别为比例积分控制器的比例系数和积分系数,T0为离散系统采样间隔;相位超前环节的离散模型利用双线性变换法得:D2(z)=s+ω1s+ω2|s=2T01-z-11+z-1=(2+ω1T0)z+(ω1T0-2)(2+ω2T0)z+(ω2T0-2)---(A13)]]>式(A13)中:D2(z)为相位超前环节的离散域表达式,ω1和ω2分别为相位超前环节的零极点,T0为离散系统采样间隔;因此,所发明的比例积分控制器与相位超前环节串联数字校正器的表达式为:D(z)=D1(z)·D2(z)=(Kp+KiT)z-Kpz-1·(2+ω1T0)z+(ω1T0-2)(2+ω2T0)z+(ω2T0-2)---(A14)]]>式(A14)中:D(z)为所发明的数字校正器,D1(z)为比例积分控制器的离散域表达式,D2(z)为相位超前环节的离散域表达式,Kp、Ki分别为比例积分控制器的比例系数和积分系数,ω1、ω2分别为相位超前环节的零极点,T0为离散系统采样间隔。
下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于东南大学,未经东南大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/patent/201710366532.0/,转载请声明来源钻瓜专利网。
- 上一篇:罗盘定位仪
- 下一篇:一种硅微陀螺仪差分电容检测电路
- 同类专利
- 用于最小化旋转速率传感器的比例因子误差的控制装置和方法-201580042984.2
- 拉尔夫·理查德·欧姆伯杰;史蒂芬·齐默尔曼 - 诺思罗普·格鲁曼·利特夫有限责任公司
- 2015-04-17 - 2019-11-05 - G01C19/5726
- 本发明涉及一种用于控制旋转速率传感器的控制装置(200),其具有第一控制回路(202)和第二控制回路(204)。第一控制回路具有用于控制旋转速率传感器沿第一方向的振动的第一控制单元(210)、第一数字‑模拟转换器(240),用以将由第一控制单元(210)输出的第一数字控制信号(215)转换成第一模拟信号(245),借助该第一模拟信号控制旋转速率传感器沿第一方向的振动、以及第一模拟‑数字转换器(250),用以将描述旋转速率传感器沿第一方向的振动的第一模拟测量信号(235)转换成向第一控制单元(210)传输的第一数字读取信号(255)。
- 角速度检测装置以及电子设备-201510973704.1
- 成瀬秀人;佐藤健二;高田丰 - 精工爱普生株式会社
- 2011-09-07 - 2018-08-31 - G01C19/5726
- 一种角速度检测装置以及电子设备,其可在不利用高次温度补偿电路的条件下对因振动泄漏分量而引起的角速度信号的温度变化进行补偿。角速度检测装置(1)包括:振子(陀螺传感器元件(100)),其产生包含角速度分量和振动泄漏分量的信号;驱动电路(20),其生成驱动信号并将之供给至振子;角速度信号生成部(同步检波电路(350)以及积分电路(360)),其从振子产生的信号中提取角速度分量并生成与之大小对应的角速度信号(36a);振动泄漏信号生成部(同步检波电路(352)以及积分电路(362)),其从振子产生的信号中提取振动泄漏分量并生成与之大小对应的振动泄漏信号(36b);加减运算部(加减运算电路(370)),其在角速度信号(36a)上以给定比率加上或减去振动泄漏信号(36b)以对角速度信号(36a)的温度特性进行补正。
- 用于模态匹配状态硅微机械陀螺仪带宽拓展数字校正方法-201710366532.0
- 李宏生;杨成;朱昆朋 - 东南大学
- 2017-05-23 - 2017-10-10 - G01C19/5726
- 本发明公开了一种用于模态匹配状态硅微机械陀螺仪带宽拓展数字校正方法,该方法是采用如下步骤实现的1)建立模态匹配状态硅微机械陀螺仪闭环检测模型;2)在硅微机械陀螺仪的检测回路中增设比例积分相位超前校正器;3)对校正器进行离散化,得到用于模态匹配状态硅微机械陀螺仪带宽拓展的数字校正器;所述比例积分相位超前数字校正器包含比例环节、积分环节和相位超前环节。本发明解决了模态匹配状态下硅微机械陀螺仪无法兼顾静态灵敏度和工作带宽的问题,用于模态匹配状态硅微机械陀螺仪带宽拓展的数字校正。
- 驱动电路、角速度检测装置、电子设备以及移动体-201710123918.9
- 金本啓 - 精工爱普生株式会社
- 2017-03-03 - 2017-09-15 - G01C19/5726
- 本发明提供一种能够使驱动信号的抖动减少的驱动电路、角速度检测装置、电子设备以及移动体。驱动电路包括第一转换部,其具有第一运算放大器和第一电容,并且将从角速度检测元件的第一电极输出且向所述第一运算放大器输入的第一信号蓄积在所述第一电容中而转换为电压;第一相位调节部,其根据所述第一转换部的输出信号而对驱动所述角速度检测元件的驱动信号的相位进行调节,并且对所述驱动信号的频带进行限制;以及驱动信号生成部,其根据所述第一相位调节部的输出信号而生成所述驱动信号。
- 用于从非线性周期信号确定旋转的系统和方法-201580034055.7
- R.L.沃特斯;X.黄;C.H.塔利四世;Y.张;J.D.雅各布斯;M.S.弗雷利克;J.A.布雷肖;B.W.奇萨姆 - 路梅戴尼科技公司
- 2015-06-26 - 2017-02-22 - G01C19/5726
- 系统和方法在这里被公开用于确定旋转。一种陀螺仪包括驱动框架和基底,所述驱动框架被弹性地耦合于基底。所述陀螺仪包括驱动结构,其被构造为引起驱动框架沿第一轴振荡。所述陀螺仪包括弹性地耦合于所述驱动框架的感测质量块。所述陀螺仪包括被构造用于测量所述感测质量块沿正交于第一轴的第二轴的位移的感测质量块感测结构。所述陀螺仪包括测量电路,所述测量电路被构造用于确定所述驱动框架的速度、从所述被测量的位移提取科里奥利分量,和基于所述被确定的速度和被提取的科里奥利分量确定陀螺仪的旋转速率。
- 用于从来自传感器的非线性周期信号提取系统参数的系统和方法-201580034051.9
- R.L.沃特斯;J.D.雅各布斯;C.H.塔利;X.黄;Y.张;M.S.弗雷利克 - 路梅戴尼科技公司
- 2015-06-26 - 2017-02-15 - G01C19/5726
- 用于从来自传感器的非线性周期信号提取系统参数的系统和方法在这里被公开。例如惯性装置的传感器包括第一结构和第二结构,所述第二结构弹性地耦合于第一结构。所述传感器被构造为基于在第一结构和第二结构之间的电流产生输出电压。所述第二结构相对第一结构的单调运动引起电流方向的反向。
- 一种基于纳米光栅检测的新型陀螺仪-201310546139.1
- 李孟委;王莉;朱京;白晓晓;王琪;禇伟航;刘俊 - 中北大学
- 2013-11-06 - 2017-01-04 - G01C19/5726
- 本发明公开了一种基于纳米光栅检测的新型陀螺仪,包括:键合基板、垫衬框体、支撑框体、驱动悬臂梁、可动框体、检测悬臂梁、质量块、激光光源、光电转换器件、信号检测模块。根据本发明的微机械陀螺仪,其整体结构对称,两质量块驱动方向相对,差分耦合输出,结构合理、紧凑,应用纳米光栅检测,抗电磁干扰能力强,且具有灵敏度高、可靠性好的优势。
- 一种基于纳米光栅检测的新型陀螺仪-201320697940.1
- 李孟委;王莉;朱京;白晓晓;王琪;禇伟航;刘俊 - 中北大学
- 2013-11-06 - 2014-05-21 - G01C19/5726
- 本实用新型公开了一种基于纳米光栅检测的新型陀螺仪,包括:键合基板、垫衬框体、支撑框体、驱动悬臂梁、可动框体、检测悬臂梁、质量块、激光光源、光电转换器件、信号检测模块。根据本实用新型的微机械陀螺仪,其整体结构对称,两质量块驱动方向相对,差分耦合输出,结构合理、紧凑,应用纳米光栅检测,抗电磁干扰能力强,且具有灵敏度高、可靠性好的优势。
- 一种基于振动式微机械陀螺的正交误差和寄生科氏力的分离测试方法-201110366153.4
- 张霞 - 西安邮电学院
- 2011-11-17 - 2013-05-22 - G01C19/5726
- 本发明公开了一种基于振动式微机械陀螺的正交误差和寄生科氏力的分离测试方法。给振动式微机械陀螺输入一个绕敏感轴旋转的大的角速度信号,测量检测方向处理电路输出端交流信号的幅度和该信号与振动式微机械陀螺传感器的驱动信号之间的相位差。再令输入角速度为零,测量检测方向处理电路输出端交流信号的幅度和该信号与驱动信号之间的相位差。利用上述测量结果即可成功实现正交误差和寄生科氏力的分离。利用反馈方向处理电路内部的移相器来调节反馈方向处理电路输出端信号的相位,使之与科里奥利加速度信号所引起的检测方向处理电路输出端的信号相位一致,经后级电路的相干解调和低通滤波后,可实现陀螺系统的灵敏度最大。
- 用于微机械陀螺的正交误差处理方法及装置-201210057358.9
- 陈志华;肖定邦;吴学忠;胡小平;侯占强;苏剑彬;张旭;刘学 - 中国人民解放军国防科学技术大学
- 2012-03-06 - 2012-07-25 - G01C19/5726
- 本发明公开了一种用于微机械陀螺的正交误差处理方法及装置,方法步骤如下:1)对微机械陀螺施加驱动载波信号和检测载波信号;2)获取微机械陀螺的输出信号并分别进行一次解调获得驱动信号和检测信号;3)调整驱动信号的放大增益,将放大后的驱动信号和检测信号进行减法运算后输出,同时提取所述减法运算输出信号的幅值模拟量,根据所述幅值模拟量闭环调整驱动信号的放大增益;装置包括同步解调单元、自动增益控制模块、减法器和输出幅值获取单元,输出幅值获取单元的输入端与减法器的输出端相连、输出端与自动增益控制模块的控制端相连。本发明能够精确消除正交误差、提高微机械陀螺输出性能,具有体积小、重量低、成本低、功耗小的优点。
- 专利分类