[发明专利]一种消除地球自转角速度对旋转调制型捷联惯导系统精度影响的方法有效
申请号: | 201410080777.3 | 申请日: | 2014-03-06 |
公开(公告)号: | CN103900566A | 公开(公告)日: | 2014-07-02 |
发明(设计)人: | 于飞;阮双双;奔粤阳;鲍桂清;杨晓龙;李敬春;赵维珩;郭妍 | 申请(专利权)人: | 哈尔滨工程大学 |
主分类号: | G01C21/16 | 分类号: | G01C21/16 |
代理公司: | 暂无信息 | 代理人: | 暂无信息 |
地址: | 150001 黑龙江省哈尔滨市南岗区*** | 国省代码: | 黑龙江;23 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 消除 地球 自转 角速度 旋转 调制 型捷联惯导 系统 精度 影响 方法 | ||
1.一种消除地球自转角速度对旋转调制型捷联惯导系统精度影响的方法,其特征在于,包括下列步骤:
步骤一:建立一个旋转机构,将IMU安装在转台上,并且使IMU坐标系的三根轴与载体系的三轴平行,系统开机后预热1小时;
步骤二:对系统进行初始对准,获得初始捷联姿态矩阵
步骤三:测量当地的经纬度值λ和获得初始时刻地心惯性坐标系与导航坐标系之间的方向余弦矩阵:
步骤四:根据步骤三获得的地心惯性坐标系与导航坐标系之间的方向余弦矩阵,测量出IMU坐标系与惯性系之间的姿态角θ1、θ2和θ3,其测量公式为:
θ2=arcsin(C31)
Cij,i,j=1,2,3是IMU坐标系与地心惯性坐标系之间的转换矩阵中的各个元素,由步骤二和步骤三获得;
步骤五:控制转位机构依次绕IMU坐标系的zs轴、ys轴和xs轴分别转动θ3、θ2和θ1,使IMU坐标系与地心惯性系重合,同时控制IMU绕zs轴顺时针以大小为ωie的旋转角速度转动;
步骤六:控制IMU绕着地心惯性坐标系的zi轴和yi轴按系统旋转方案转动;
步骤七:将陀螺仪和加速度计采集的信息实时的输入导航计算机中进行导航解算,最终给出载体的导航参数信息。
2.根据权利要求1所述的一种消除地球自转角速度对旋转调制型捷联惯导系统精度影响的方法,其特征在于:
所述的步骤六中,IMU绕着地心惯性坐标系的zi轴和yi轴按系统旋转方案依次旋转时,陀螺仪输出角速度的误差形式为:
式中Eg、δkg和εs分别为标定后的安装误差,是IMU坐标系相对地心惯性坐标系的旋转角速度在IMU坐标系下的分量,由于在步骤五中,IMU与地心惯性坐标系重合,因此与时变的方向余弦矩阵无关;
将陀螺仪的输出误差转换到地理坐标系下进行积分,转换矩阵为:
是IMU坐标系绕地心惯性系的方向余弦矩阵,由每次转动过程获得;是导航坐标系在地球自转角速度ωie的作用下与惯性坐标系之间的方向余弦矩阵,其表达形式为:
由于ωie<<ω,ω是IMU的旋转角速度,因此在每一次转动周期中,可以认为是常值,通过导航解算的积分过程,可以完全消除旋转调制过程中地球自转角速度对系统精度的影响。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于哈尔滨工程大学,未经哈尔滨工程大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201410080777.3/1.html,转载请声明来源钻瓜专利网。