[发明专利]一种适用于低精度无方位基准双轴转位设备的惯性测量单元标定方法有效
申请号: | 201410145103.7 | 申请日: | 2014-04-11 |
公开(公告)号: | CN103983274A | 公开(公告)日: | 2014-08-13 |
发明(设计)人: | 刘明;穆杰;周海;罗伟;李泽洪 | 申请(专利权)人: | 湖北航天技术研究院总体设计所 |
主分类号: | G01C25/00 | 分类号: | G01C25/00 |
代理公司: | 武汉开元知识产权代理有限公司 42104 | 代理人: | 王和平;陈懿 |
地址: | 430040 湖*** | 国省代码: | 湖北;42 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 适用于 精度 方位 基准 双轴转位 设备 惯性 测量 单元 标定 方法 | ||
1.一种适用于低精度无方位基准双轴转位设备的惯性测量单元标定方法,其特征在于:包含如下步骤:
步骤一:将惯性测量单元安装在双轴转位设备上,所述惯性测量单元初始位置保证X轴朝上或朝下,惯性测量单元通电预热后开始采集输出的原始数据,所述惯性测量单元先在第0个位置上静止3-5分钟后,再转动到第1个位置静止3-5分钟,随后转动到第2个位置,依此类推,直至在第18个位置上静止3-5分钟后停止采集惯性测量单元输出的原始数据;
步骤二:利用步骤一采集的惯性测量单元原始数据,在第0位置上使用双矢量定姿法进行初始对准,进而得到第0位置上导航起始时刻的天向转角然后利用对准结果和第0位置上的采集数据进行导航解算,进而得到第0位置上导航过程中的实时速度以及实时天向转角θn(0),设第0位置上导航起始时刻的速度均为0,以速度和天向转角为观测结果拟合出第0位置上的和一阶中间参数所述包含和所述和分别为第0位置上的参数在x轴、y轴和z轴上投影的标量,所述包含和所述和分别为第0位置上的一阶中间参数在x轴、y轴和z轴上投影的标量;
步骤三:利用步骤一采集的惯性测量单元原始数据,在第i位置上使用双矢量定姿法进行初始对准,所述i=0,1,2……17,然后在第i个位置到第i+1个位置的转动过程中以及第i+1个位置上的静止过程中进行连续导航,通过导航获取转动到达第i+1个位置瞬间的速度和以及瞬间的天向转角以及转动完成后在第i+1个位置静止过程中的实时速度和以及实时天向转角θn(i+1),
式中:g是重力加速度,T是实时时间,
ωvx、ωvy和ωvz分别为系数ωv在x轴、y轴和z轴上的分量,
以速度和天向转角为观测,拟合出第i+1位置上的和一阶中间参数其中,i=0,1,2……17,所述包含和包含和所述和分别为第i+1位置上的参数在x轴、y轴和z轴上投影的标量,所述和分别为第i+1位置上的一阶中间参数在x轴、y轴和z轴上投影的标量;
步骤四:在惯性测量单元坐标系内,加速度计的误差模型为::
上述误差模型的向量形式为:
其中,
fb为载体坐标系下加速度计测得的比力,
fxb、fyb和fzb分别为fb在x轴、y轴和z轴上的投影,
为载体坐标系下的加速度计零偏,
Ka包括加速度计标度因数误差和加速度计失准角,
Ka2为加速度计二次项系数,
δfb为载体坐标系下加速度计测得的比力误差;
陀螺的误差模型为:
上述误差模型的向量形式为:
其中,
ωb为载体坐标系下陀螺测得的角速度,
为载体坐标系下陀螺零偏,
Kg包括陀螺标度因数误差和陀螺失准角,
εb为载体坐标系下陀螺测得的角速度误差;
然后将加速度计零偏Bax、Bay、Baz,加速度计标度因数Kaxx、Kayy、Kazz,加速度计失准角Kayx、Kazx、Kazy,加速度计二次项系数Kax2、Kay2、Kaz2,陀螺标度因数Kgxx、Kgyy、Kgzz,陀螺失准角Kgxy、Kgxz、Kgyx、Kgyz、Kgzx、Kgzy共计21个误差参数记为一阶误差参数K,其中,Bax、Bay、Baz分别为加速度计零偏Ba在x轴、y轴和z轴上投影的标量;
在每个位置上,依据一阶中间参数Δg与一阶误差参数K的关系,利用步骤二得到的构建方程即:
其中,
δfn(0)为导航坐标系(n系,navigation)下第0个位置的比力误差,
g是重力加速度,
是在第0个位置上从载体坐标系(b系,body)到导航坐标系的方向余弦矩阵,
是在第0个位置上从导航坐标系到载体坐标系的方向余弦矩阵,
为载体坐标系下的加速度计零偏,
fn为导航坐标系下的比力,
Ka包括加速度计标度因数误差和加速度计失准角,
Ka2为加速度计二次项系数,
[X]V表示垂直分量与X相同,水平分量为0的矢量;
用步骤三中的构建方程其中,中i=0,1,2…17,中i=1,2…18,即:
其中,
δfn(i-1)和δfn(i)分别为导航坐标系下第i-1和第i个位置下的比力误差,
fn为导航坐标系下的比力,
ΔΦn(i-1~i)为在导航坐标系下从第i-1到第i个位置旋转过程中引入的姿态误差,
g是重力加速度,
和分别是在第i-1个和第i个位置上从载体坐标系到导航坐标系的方向余弦矩阵,
和分别是在第i-1个和第i个位置上从导航坐标系到载体坐标系的方向余弦矩阵,
为载体坐标系下的加速度计零偏,
Ka包括加速度计标度因数误差和加速度计失准角,
Ka2为加速度计二次项系数,
[X]H代表水平分量与X相同,垂直分量为0的矢量,
为从第i-1个位置到第i个位置的旋转过程中,载体坐标系到导航坐标系的方向余弦矩阵,
εn为陀螺测得的角速度误差在导航坐标系下的投影,
εb为载体坐标系下陀螺测得的角速度误差,
ωb为载体坐标系下陀螺测得的角速度,
为载体坐标系下陀螺零偏,
Kg包括陀螺标度因数误差和陀螺失准角,
T是实时时间;
将以上方程联立得到如下方程:
最终构建如下方程:
Δg=AK
步骤五:利用步骤四中的联立方程计算A的最小二乘逆矩阵进而通过计算出一阶误差参数K;
步骤六:利用步骤五计算的K求解每个静止位置i对应的其中i=0,1,2…18,计算方法如下:
当i=0时,的计算方法如下:
其中,
为在第0个位置上的
fn为导航坐标系下的比力,
为导航坐标系下第0个位置的姿态误差,包括第0个位置上初始对准引入的姿态误差,
为中与一阶误差参数相关的项,
为地球自转角速度在导航坐标系下的投影,
g是重力加速度,
[X]H代表水平分量与X相同,垂直分量为0的矢量,
[X]V代表垂直分量与X相同,水平分量为0的矢量,
[X]T为矩阵X或向量X的转置,
和分别为导航坐标系下第0个位置计算的比力误差在X轴和Z轴的分量,
L为纬度;
当i=1,2……18时,的计算方法如下:
其中,
为在第i个位置上的
fn为导航坐标系下的比力,
为导航坐标系下第i个位置的姿态误差,包括第i-1个位置上初始对准引入的姿态误差及第i-1个位置到第i个位置旋转过程中引入的姿态误差,
为中与一阶误差参数相关的项,
为地球自转角速度在导航坐标系下的投影,
g是重力加速度,
[X]H代表水平分量与x轴相同,垂直分量为0的矢量,
[X]V代表垂直分量与x轴相同,水平分量为0的矢量,
[X]T为矩阵X或向量X的转置,
和分别为导航坐标系下第i-1个位置计算的比力误差在X轴和Z轴的分量,
L为纬度,
ΔΦn(i-1~i)为在导航坐标系下从第i-1到第i个位置旋转过程中引入的姿态误差,
δfn(i-1)为导航坐标系下第i-1个位置下的比力误差,
是在第i-1个位置上从载体坐标系到导航坐标系的方向余弦矩阵,
是在第i-1个位置上从导航坐标系到载体坐标系的方向余弦矩阵,
为载体坐标系下的加速度计零偏,
Ka包括加速度计标度因数误差和加速度计失准角,
Ka2为加速度计二次项系数,
εn为陀螺测得的角速度误差在导航坐标系下的投影,
εb为载体坐标系下陀螺测得的角速度误差,
为从第i-1个位置到第i个位置的旋转过程中,载体坐标系到导航坐标系的方向余弦矩阵,
ωb为载体坐标系下陀螺测得的角速度,
为载体坐标系下陀螺零偏,
Kg包括陀螺标度因数误差和陀螺失准角,
T是实时时间;
然后通过步骤二中的及步骤三中的计算出每个静止位置上的二阶中间参数其中,中i=0,1,2……17,中i=0,1,2,……,18;
步骤七:将二阶误差参数即陀螺零偏Bgx、Bgy、Bgz记为列向量ω,依据二阶中间参数和二阶误差参数ω之间的关系,利用步骤六中构建方程其中i=0,1,2……18,即:
其中,
表示第i个位置的二阶中间参数,
fn为导航坐标系下的比力,
为导航坐标系下第i个位置的姿态误差,包括第i-1个位置上初始对准引入的姿态误差及第i-1个位置到第i个位置旋转过程中引入的姿态误差,
为中与二阶误差参数相关的项,
为地球自转角速度在导航坐标系下的投影,
和分别为导航坐标系下第i-1个和第i个位置的等效陀螺零偏,
导航坐标系下第i-1个位置的等效陀螺零偏在Z轴上的投影,
ωie为地球自转角速率,
是在第i-1个位置上从载体坐标系到导航坐标系的方向余弦矩阵,
为载体坐标系下的陀螺零偏;
将以上方程联立得到如下方程:
步骤八:利用步骤七中的联立方程计算B的最小二乘逆矩阵进而通过计算出二阶误差参数ω;
步骤九:当一阶误差参数K和二阶误差参数ω的残差大于阈值时,用一阶误差参数K和二阶误差参数ω残差补偿前次标定的误差参数,然后将得到的一阶误差参数K和二阶误差参数ω以及步骤一中采集的惯性测量单元原始数据代入到导航方程中,再进行一次一阶中间参数Δg、二阶中间参数一阶误差参数K和二阶误差参数ω残差的解算,然后对一阶误差参数K和二阶误差参数ω进行残差补偿,依此类推,经过多次迭代直至某一次迭代计算得到的一阶误差参数K和二阶误差参数ω残差小于阈值。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于湖北航天技术研究院总体设计所,未经湖北航天技术研究院总体设计所许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201410145103.7/1.html,转载请声明来源钻瓜专利网。