[发明专利]一种光纤陀螺SINS六位置系统级标定方法有效
申请号: | 201710795340.1 | 申请日: | 2017-09-06 |
公开(公告)号: | CN107655493B | 公开(公告)日: | 2021-04-06 |
发明(设计)人: | 徐晓苏;吴梅;王捍兵 | 申请(专利权)人: | 东南大学 |
主分类号: | G01C25/00 | 分类号: | G01C25/00 |
代理公司: | 南京苏高专利商标事务所(普通合伙) 32204 | 代理人: | 王安琪 |
地址: | 210096 *** | 国省代码: | 江苏;32 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 光纤 陀螺 sins 位置 系统 标定 方法 | ||
1.一种光纤陀螺SINS六位置系统级标定方法,其特征在于,包括如下步骤:
(1)将惯性组件安装在转台上,惯性组件初始朝向为东-北-天;惯性组件通电预热,设定采样周期;
(2)开始采集惯性组件数据并建立惯性组件误差模型和捷联惯导系统误差模型;
(3)使惯性组件在步骤(1)中设定的初始位置静置1分钟进行静态导航,然后使惯性组件以10°/s的角速度绕X轴正向旋转180°,使惯性组件的朝向为东-南-地,并静置1分钟进行静态导航;在转台条件下,仅由陀螺误差引起的姿态误差方程写成如下形式:
仅由加速度计误差引起的速度误差方程写成如下形式:
在东-北-天的朝向时:
展开得:
加速度计引起的速度误差方程:
展开得:
绕X轴旋转,转动角度为180°,标定时采用的转速ω为10°/s,ω远大于地球自转分量和陀螺零偏,所以地球自转分量和陀螺零偏忽略不计,ωx≈ω,ωy≈0,ωz≈0,则有:
展开得:
对上面各式进行积分得:
旋转完后,在东-南-地的朝向时:
加速度计引起的速度误差方程:
展开得:
根据此步骤中两个位置上的速度误差解析得到加速度计相关激励误差项;
(4)使惯性组件绕X轴正向旋转90°,使惯性组件的朝向为东-地-北,并静置1分钟进行静态导航,然后是惯性组件以10°/s的角速度绕Z轴正向旋转180°,使惯性组件的朝向为西-天-北,并静置1分钟进行静态导航;在东-地-北的朝向时:
展开得:
绕Z轴旋转,转动角度为180°,ωx≈0,ωy≈0,ωz≈ω,则有:
展开得:
对上面各式进行积分得:
旋转完后,在西-天-北的朝向时:
加速度计引起的速度误差方程:
展开得:
根据此步骤中两个位置上的速度误差解析得到加速度计相关激励误差项;
(5)使惯性组件绕Z轴正向旋转90°,使惯性组件的朝向为天-东-北,并静置1分钟进行静态导航,然后是惯性组件以10°/s的角速度绕Y轴正向旋转180°,使惯性组件的朝向为地-东-南,并静置1分钟进行静态导航,停止采数;在天-东-北的朝向时:
展开得:
绕Y轴旋转,转动角度为180°,ωx≈0,ωy≈ω,ωz≈0,则有:
展开得:
对上面各式进行积分得:
旋转完后,在地-东-南的朝向时:
加速度计引起的速度误差方程:
展开得:
根据此步骤中两个位置上的速度误差解析得到加速度计相关激励误差项;
(6)对惯性组件采集的数据进行离线导航解算,并计算系统速度误差和姿态误差;
(7)设计卡尔曼滤波器对惯性组件误差进行滤波估计;
(8)将步骤(1)到步骤(5)重复执行,每次重复执行都更换不同的旋转角速度;对每次重复执行采集得到的数据进行导航解算和卡尔曼滤波估计,对计算得到的不同角速度下的惯性组件误差结果取平均值,作为最终的结果。
2.如权利要求1所述的光纤陀螺SINS六位置系统级标定方法,其特征在于,步骤(1)中,采样周期为T=0.005s。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于东南大学,未经东南大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201710795340.1/1.html,转载请声明来源钻瓜专利网。
- 上一篇:用于查询信息的方法及装置
- 下一篇:一种摇摆基座条件下惯导系统粗对准方法