CN103033197B - 一种mems陀螺零位漂移的校正方法 - Google Patents
一种mems陀螺零位漂移的校正方法 Download PDFInfo
- Publication number
- CN103033197B CN103033197B CN201210555591.XA CN201210555591A CN103033197B CN 103033197 B CN103033197 B CN 103033197B CN 201210555591 A CN201210555591 A CN 201210555591A CN 103033197 B CN103033197 B CN 103033197B
- Authority
- CN
- China
- Prior art keywords
- delta
- beta
- coordinates system
- epsiv
- centerdot
- 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
- Aiming, Guidance, Guns With A Light Source, Armor, Camouflage, And Targets (AREA)
- Gyroscopes (AREA)
Abstract
本发明涉及一种MEMS陀螺零位飘移的校正方法,通过时间t时刻和时间t+Δt时刻的框架坐标系中方位和俯仰的角度,通过空间坐标变换将其投影到到惯性坐标系:然后计算得到每隔△t时间的飘移角速度,然后将此飘移角速度与陀螺测得框架在惯性坐标系中角速度求和,得到校正后的框架角速度。有益效果:利用***内稳定,精度高的传感器去校正MEMS陀螺零位飘移,校正效果明显。此方法应用场合主要为移动载体领域。本方法主要由软件完成,硬件成本低廉。
Description
技术领域
本发明属于惯导技术领域,涉及一种如何更加有效的使用MEMS陀螺的速度信息的方法,具体涉及一种MEMS陀螺零位漂移的校正方法。
背景技术
MEMS陀螺作为角速率传感器,在消费电子,军工,航空领域得到了广泛的应用,但是其技术特点决定其固有缺点,即零位漂移大,且随温度变化明显,以往大多数应用在消费电子领域,但现在随着对其研究的进一步深入,对其零位漂移消除有了一些解决途径,比如滤波,温度补偿等方法,经过这些方法的处理之后,MEMS陀螺也可用在某些要求较高的领域,比如军工上机载,弹载等领域。
现在MEMS陀螺以其出色的抗震性和低成本在在越来越多的领域得到应用,但其零位漂移对其应用有很大的制约,所以针对消除其零漂,提高精度的研究也越来越多地开展。
发明内容
要解决的技术问题
为了避免现有技术的不足之处,本发明提出一种MEMS陀螺零位漂移的校正方法,将某飞行器中测角信息和姿态信息利用起来,进行空间坐标系变换,来对MEMS陀螺零位漂移补偿的方法。
技术方案
一种MEMS陀螺零位漂移的校正方法,其特征在于步骤如下:
步骤1:测出时间t时刻的框架坐标系方位和俯仰的角度,通过空间坐标变换将其投影到到惯性坐标系:
其中:xft,yft,zft为俯仰和方位的角度在惯性坐标系下投影的直角坐标值;εft,βft为俯仰和方位的角度在惯性坐标系下投影的极坐标值;A(υрtυТtυkt)为弹体坐标系向惯性坐标系转换所乘的方向余弦矩阵,其中υрt,υТt,υкt为t时刻弹体姿态信息;B(βt εt 0)为框架坐标系向弹体坐标系转换所乘的方向余弦矩阵,其中εt,βt为t时刻位标器俯仰和方位测角数据;
所述框架坐标系:原点都取在活动的旋转中心上,当框架的方位与俯仰处于零位时,其三个轴与载体坐标系重合;
所述惯性坐标系:坐标系的原点取在地心,各坐标轴相对于恒星的指向不变化;
所述弹体坐标系:坐标系的原点与导弹的质心重合,X轴沿导弹纵轴指向前方,Z轴沿导弹横轴指向右方,Y轴沿导弹竖轴指向天空并与X轴、Z轴构成右手直角坐标系;导弹相对于惯性坐标系下的俯仰角、滚转角和偏航角统称为姿态角;
步骤2:测出时间t+Δt时刻的框架坐标系中方位和俯仰的角度,通过空间坐标变换将其投影到到惯性坐标系:
步骤3:将t时刻和t+△t时刻角度在惯性坐标系的投影求差:
Δεft(Δt)=εf(t+Δt)-εft
Δβft(Δt)=βf(t+Δt)-βft
步骤4:利用陀螺测得框架在惯性坐标系中角速度ωy,ωz,根据欧拉运动方程得到和角的变化速度:
步骤5:对和进行积分:
步骤6:计算在惯性坐标系中△t时间内天线固有漂移速度为:
步骤7:漂移角速度在惯性坐标系坐标轴上的投影为:
步骤8:每隔△t时间计算一次上述步骤的漂移角速度,然后将此漂移角速度与陀螺测得框架在惯性坐标系中角速度ωy,ωz求和,即得到校正后的框架角速度ωyt,ωzt如下:
ωyt=ωy+ΔωyΔt
ωzt=ωz+ΔωzΔt。
有益效果
本发明提出的一种MEMS陀螺零位漂移的校正方法,通过时间t时刻和时间t+Δt时刻的框架坐标系中方位和俯仰的角度,通过空间坐标变换将其投影到到惯性坐标系:然后计算得到每隔△t时间的漂移角速度,然后将此漂移角速度与陀螺测得框架在惯性坐标系中角速度求和,得到校正后的框架角速度。有益效果:利用***内稳定,精度高的传感器去校正MEMS陀螺零位漂移,校正效果明显。此方法应用场合主要为移动载体领域。本方法主要由软件完成,硬件成本低廉。
具体实施方式
现结合实施例对本发明作进一步描述:
本实施例要解决的技术问题:MEMS陀螺以其出色的抗震性和低成本在机载,弹载设备上有很大的应用前景,但其零位漂移对其应用有很大的制约,本发明提出一种利弹载体测角信息和载体姿态信息的组合来对MEMS陀螺零位进行消除,达到了很好的效果,能满足机载弹载设备的需要。
首先要明确几个坐标系
惯性坐标系:对于研究地球表面附近运载体的惯性***时,经常将惯性参考坐标系的原点取在地心,各坐标轴相对于恒星的指向不变化。
弹体坐标系:坐标系的原点与飞行器的质心重合,X轴沿飞行器纵轴指向前方,Z轴沿飞行器横轴指向右方,Y轴沿飞行器竖轴指向天空并与X轴、Z轴构成右手直角坐标系。飞行器相对于惯性坐标系下的俯仰角、滚转角和偏航角统称为姿态角。
框架坐标系:当飞行载体上存在活动框架设备时,原点都取在活动的旋转中心上,当框架的方位与俯仰处于零位时,其三个轴与载体坐标系重合。
这三个坐标系之间关系如下式:
上式中 代表惯性坐标系, 代表载体坐标系, 等于
其中:
|A|:在惯性坐标系中载体坐标系坐标轴的方向余弦矩阵;
|B|:在载体坐标系中框架坐标系坐标轴的方向余弦矩阵;
载体坐标系中空间量向惯性坐标系中转换时,需要将坐标系做三次旋转即得:
υр,υТ,υк为载体姿态信息。
框架坐标系中空间量向载体坐标系转换时由于载体坐标系横滚与框架坐标系横滚固连,所以只需将坐标系在航向角和俯仰角上作两次旋转即得:
其中:ε,β为天线俯仰和方位测角数据;
本实施例步骤如下:
1>.测出时间t时刻框架坐标系方位和俯仰的角度,通过空间坐标变换将其投影到到惯性坐标系。
其中:xft,yft,zft为俯仰和方位的角度在惯性坐标系下投影的直角坐标值;εft,βft为俯仰和方位的角度在惯性坐标系下投影的极坐标值;A(υрt υТt υkt)为弹体坐标系向惯性坐标系转换所乘的方向余弦矩阵,其中υрt,υТt,υкt为t时刻弹体姿态信息;B(βt εt 0)为框架坐标系向弹体坐标系转换所乘的方向余弦矩阵,其中εt,βt为t时刻位标器俯仰和方位测角数据;
2>.测出时间t+Δt时刻框架坐标系方位和俯仰的角度,通过空间坐标变换将其投影到到惯性坐标系。
3>.将t时刻和t+△t时刻角度在惯性坐标系的投影求差,即
Δεft(Δt)=εf(t+Δt)-εft
Δβft(Δt)=βf(t+Δt)-βft
4>.陀螺测得框架在惯性坐标系中角速度ωy,ωz,由欧拉运动方程得到和角的变化速度:
5>.对和进行积分:
6>.计算在惯性坐标系中△t时间内天线固有漂移速度为:
7>漂移角速度在惯性坐标系坐标轴上的投影为:
8>每隔△t时间按照上述步骤计算一次漂移值。然后将此漂移值与陀螺测得框架在惯性坐标系中角速度ωy,ωz求和,即得到校正后的框架角速度ωyt,ωzt如下。
ωyt=ωy+ΔωyΔt ωzt=ωz+ΔωzΔt
Claims (1)
1.一种MEMS陀螺零位漂移的校正方法,其特征在于步骤如下:
步骤1:测出时间t时刻的框架坐标系方位和俯仰的角度,通过空间坐标变换将其投影到惯性坐标系:
其中:xft,yft,zft为俯仰和方位的角度在惯性坐标系下投影的直角坐标值;εft,βft为俯仰和方位的角度在惯性坐标系下投影的极坐标值;A(υрt υТt υkt)为弹体坐标系向惯性坐标系转换所乘的方向余弦矩阵,其中υрt,υТt,υкt为t时刻弹体姿态信息;B(βt εt 0)为框架坐标系向弹体坐标系转换所乘的方向余弦矩阵,其中εt,βt为t时刻位标器俯仰和方位测角数据;
所述框架坐标系:原点都取在活动的旋转中心上,当框架的方位与俯仰处于零位时,其三个轴与载体坐标系重合;
所述惯性坐标系:坐标系的原点取在地心,各坐标轴相对于恒星的指向不变化;
所述弹体坐标系:坐标系的原点与导弹的质心重合,X轴沿导弹纵轴指向前方,Z轴沿导弹横轴指向右方,Y轴沿导弹竖轴指向天空并与X轴、Z轴构成右手直角坐标系;导弹相对于惯性坐标系下的俯仰角、滚转角和偏航角统称为姿态角;
步骤2:测出时间t+Δt时刻的框架坐标系中方位和俯仰的角度,通过空间坐标变换将其投影到到惯性坐标系:
步骤3:将t时刻和t+△t时刻角度在惯性坐标系的投影求差:
Δεft(Δt)=εf(t+Δt)-εft
Δβft(Δt)=βf(t+Δt)-βft
步骤4:利用陀螺测得框架在惯性坐标系中角速度ωy,ωz,根据欧拉运动方程得到角βft、εft的变化速度和
步骤5:对和进行积分:
步骤6:计算在惯性坐标系中△t时间内天线固有漂移速度为:
步骤7:漂移角速度在惯性坐标系坐标轴上的投影为:
步骤8:每隔△t时间计算一次上述步骤的漂移角速度,然后将此漂移角速度与陀螺测得框架在惯性坐标系中角速度ωy,ωz求和,即得到校正后的框架角速度ωyt,ωzt如下:
ωyt=ωy+ΔωyΔt
ωzt=ωz+ΔωzΔt。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210555591.XA CN103033197B (zh) | 2012-12-20 | 2012-12-20 | 一种mems陀螺零位漂移的校正方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210555591.XA CN103033197B (zh) | 2012-12-20 | 2012-12-20 | 一种mems陀螺零位漂移的校正方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103033197A CN103033197A (zh) | 2013-04-10 |
CN103033197B true CN103033197B (zh) | 2015-03-18 |
Family
ID=48020333
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210555591.XA Active CN103033197B (zh) | 2012-12-20 | 2012-12-20 | 一种mems陀螺零位漂移的校正方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103033197B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103308046A (zh) * | 2013-04-26 | 2013-09-18 | 哈尔滨工程大学 | 一种惯性系下使用位置和航向信息的捷联惯导***陀螺漂移校正方法 |
CN103808332B (zh) * | 2014-03-10 | 2016-04-27 | 陈永刚 | 估算车载陀螺仪的零漂值的方法、装置及车载导航仪 |
CN105424040B (zh) * | 2016-01-15 | 2019-09-13 | 极翼机器人(上海)有限公司 | 一种新型mems惯性传感器阵列余度配置方法 |
CN106595391B (zh) * | 2016-11-23 | 2018-04-03 | 湖北工业大学 | 基于无线传输网络的海上装置零位一致性校正方法 |
CN109582045B (zh) * | 2019-01-08 | 2022-07-01 | 北京慧清科技有限公司 | 一种载体倾斜时天线的初始对准方法 |
CN110530400B (zh) * | 2019-10-29 | 2020-03-20 | 成都纵横自动化技术股份有限公司 | 陀螺仪漂移修正方法、装置、光电吊舱及飞行器 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20070240486A1 (en) * | 2005-03-04 | 2007-10-18 | Moore Robert H | Inertial measurement system and method with bias cancellation |
CN102798399A (zh) * | 2012-08-23 | 2012-11-28 | 辽宁工程技术大学 | 基于双轴转动方案的捷联惯导***误差抑制方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2012037405A (ja) * | 2010-08-09 | 2012-02-23 | Seiko Epson Corp | センサー装置、電子機器及び角速度センサーのオフセット補正方法 |
-
2012
- 2012-12-20 CN CN201210555591.XA patent/CN103033197B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20070240486A1 (en) * | 2005-03-04 | 2007-10-18 | Moore Robert H | Inertial measurement system and method with bias cancellation |
CN102798399A (zh) * | 2012-08-23 | 2012-11-28 | 辽宁工程技术大学 | 基于双轴转动方案的捷联惯导***误差抑制方法 |
Non-Patent Citations (2)
Title |
---|
"惯导陀螺零漂对末制导炮弹弹道性能的影响";宋卫东;《南京理工大学学报(自然科学版)》;20100430;第34卷(第2期);第161-165页 * |
"有风条件下末制导炮弹弹道模型研究";赵庆岚;《工程设计学报》;20081031;第15卷(第5期);第373-377页 * |
Also Published As
Publication number | Publication date |
---|---|
CN103033197A (zh) | 2013-04-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103033197B (zh) | 一种mems陀螺零位漂移的校正方法 | |
CN104374388B (zh) | 一种基于偏振光传感器的航姿测定方法 | |
CN101706281B (zh) | 惯性/天文/卫星高精度组合导航***及其导航方法 | |
CN103175530B (zh) | 一种航空遥感惯性稳定平台耦合力矩估计与补偿方法 | |
CN108152529A (zh) | 一种基于飞行参数计算风速及风向的方法 | |
CN105929836B (zh) | 用于四旋翼飞行器的控制方法 | |
CN105157705B (zh) | 一种半捷联雷达导引头视线角速度提取方法 | |
CN101793523B (zh) | 一种组合导航和光电探测一体化*** | |
CN103196445B (zh) | 基于匹配技术的地磁辅助惯性的载体姿态测量方法 | |
CN106507770B (zh) | 一种用无拖曳技术实现重力梯度卫星姿轨控的方法 | |
CN103900576B (zh) | 一种深空探测自主导航的信息融合方法 | |
CN106289246A (zh) | 一种基于位置和姿态测量***的柔性杆臂测量方法 | |
CN101109959A (zh) | 一种适用于任意运动微小型***的定姿*** | |
CN103438890B (zh) | 基于tds与图像测量的行星动力下降段导航方法 | |
CN102087110B (zh) | 微型水下运动体自主姿态检测装置及方法 | |
CN103557871A (zh) | 一种浮空飞行器捷联惯导空中初始对准方法 | |
CN103674034A (zh) | 多波束测速测距修正的鲁棒导航方法 | |
CN105737858A (zh) | 一种机载惯导***姿态参数校准方法与装置 | |
CN102272554A (zh) | 信号处理模块、具有信号处理模块的导航设备、设置有导航设备的交通工具和提供导航数据的方法 | |
Peng et al. | A new dynamic calibration method for IMU deterministic errors of the INS on the hypersonic cruise vehicles | |
CN105737842A (zh) | 基于旋转调制和虚拟里程仪的车载自主导航方法 | |
CN112556724A (zh) | 动态环境下的微型飞行器低成本导航***初始粗对准方法 | |
CN102707080B (zh) | 一种星敏感器模拟捷联惯导陀螺的方法 | |
CN107741240A (zh) | 一种适用于动中通的组合惯导***自适应初始对准方法 | |
CN104568652A (zh) | 一种高精度测量临近空间大气密度的方法及测量装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |