法律状态公告日
法律状态信息
法律状态
2015-08-05
未缴年费专利权终止 IPC(主分类):G01P21/00 授权公告日:20110928 终止日期:20140611 申请日:20100611
专利权的终止
2011-09-28
授权
授权
2011-01-19
实质审查的生效 IPC(主分类):G01P21/00 申请日:20100611
实质审查的生效
2010-12-08
公开
公开
技术领域
本发明属于惯性导航技术领域,具体涉及一种无依托状态下加速度计的标定方法。
背景技术
对加速度计进行有效的标定可解决其性能参数时变性的问题,对提高测量精度非常必要。传统的标定方法需要借助转台、离心机等标定设备,对未知参数进行完整的系统级标定,标定精度高,但操作复杂,标定周期长,实时性较差;所以针对上述问题提出了无依托状态下加速度计标定的概念,即要求脱离实验室条件,只借助惯性器件自身,在使用现场即可实现标定,由于现场标定条件上的限制,通常只针对加速度计性能影响最严重的参数进行辨识,目前公开发表的加速度计无依托现场标定文献还比较少。
清华大学精密仪器与机械学院的尚捷、顾启泰提出基于虚拟噪声的现场最优标定方法,即两步估计法,该方法同多位置方法比较,具有结构简单、省时、易于实现的优点,但不能标定出安装误差和刻度因数误差,并且只适用于短时间、低中精度导航系统。
北京航空航天大学的刘百奇、房建成针对光纤陀螺IMU提出六位置旋转现场标定方法,借助水平面在六个位置上进行十二次旋转,建立42个非线性输入输出方程,通过旋转积分和对称位置误差相消,进行惯性器件参数标定,该方法操作较复杂,且对旋转平面是否水平具有较高要求,并且不能辨识出加速度计的安装误差和刻度因数误差。
新加坡国立大学的W T Fong、S K Ong和A Y C Nee提出一种基于downhill simple最优化的辨识方案,操作简单,且可以辨识出完整的误差参数,该文献主要针对微机械IMU设计,受器件测量精度的限制,误差模型简化严重,辨识结果精度较低。
发明内容
为了解决上述不能标出或者识别加速度计的安装误差和刻度因数误差,辨识结果精度低的问题,本发明提出一种无依托状态下加速度计的标定方法,在进行标定过程前首先需要考虑对加速度计性能影响最严重的误差参数,简化三轴加速度计的误差模型为
式中,kx、ky、kz为加速度计x、y、z轴刻度因数;K11,K12,K13,K21,K22,K23,K31,K32,K33为安装误差矩阵元素;gx0、gy0、gz0为加速度计x、y、z轴零位偏差;gxm、gym、gzm为加速度计x、y、z轴测量值;gxa、gya、gza为重力加速度g在载体坐标系下投影分量;为安装误差和刻度因数的耦合矩阵。
进而通过5个步骤来完成标定:
步骤1:静基座粗对准,得到载体横滚角γ、俯仰角θ;
步骤2:利用Kalman滤波进行静基座精对准,提高横滚角γ、俯仰角θ的对准精度,并进一步得到重力加速度g在载体坐标系下的投影的三轴分量的计算值(gxa,gya,gza);
步骤3:将载体在10个不同的位置上进行步骤1、步骤2获得10组加速度计x、y、z轴测量值(gxm,gym,gzm)以及10组重力加速度g在载体坐标系下的投影的三轴分量的计算值(gxa,gya,gza)。本步骤中根据载体是否在10个位置上放置完成来判断进行,若没有放置完成,则转步骤1进行,若已经完成,则得到所需数据,继续步骤4。
步骤4:通过非线性最小二乘法得到加速度计的零位偏差gx0,gy0,gz0;
步骤5:通过线性最小二乘法得到耦合矩阵
将步骤4得到零位偏差gx0,gy0,gz0以及步骤5中耦合矩阵的值代入式(1)中,构建式(1)误差模型。从而可对加速度计的测量值gxm,gym,gzm,进行有效的修正,得到修正后的重力加速度g在载体坐标系下投影分量gxa,gya,gza,从而提高了测量的精度。
本发明的优点在于:
(1)可实现外场条件下加速度计的无依托标定,脱离实验室条件,不借助于传统的标定设备;
(2)标定过程简单,标定速度快,可实现加速度计每次使用前均进行标定,有效的解决了性能参数时变性的问题。
(3)非线性最小二乘方法的应用可以解决误差模型非线性的问题,避免了传统标定对转台等标定设备的依赖,实现了加速度计无依托状态下的标定。
附图说明
图1为本发明的标定方法的步骤流程图。
具体实施方式
下面结合附图对本发明进行进一步的详细说明。
本发明进行标定前需要首先简化三轴加速度计的误差模型:
在现场标定的前提下,只考虑对加速度计性能影响最严重的误差参数,可将三轴加速度计的误差模型简化为:
式中,为安装误差矩阵,K11、K12、K13、K21、K22、K23、K31、K32及K33为安装误差矩阵元素;kx、ky、kz为加速度计x、y、z轴刻度因数;gx0、gy0、gz0为加速度计x、y、z轴零位偏差;gxm、gym、gzm为加速度计x、y、z轴测量值;gxa、gya、gza为重力加速度g在载体坐标系下投影分量的计算值。
将式(1)进一步化简合并可得:
其中,为安装误差和刻度因数的耦合矩阵S。
将安装误差和刻度因数的耦合矩阵S表示为如下的简化方式:
其中,式(3)所示矩阵中元素与式(2)中安装误差和刻度因数的耦合矩阵中元素一一对应;
本发明一种无依托状态下加速度计的标定方法,通过以下5步来对加速度计进行标定,具体步骤如下:
步骤1:静基座粗对准,得到载体横滚角γ、俯仰角θ。本发明实施例中将载体横滚角γ、俯仰角θ的对准误差控制在1°以内,具体得到载体横滚角γ、俯仰角θ通过下述过程来实现。
通过:
得到载体的载体坐标系和地理坐标系之间的方向余弦矩阵:
其中,为重力加速度g在载体坐标系下投影的三轴分量测量值;为重力加速度g在地理坐标系下投影的三轴分量;ωie为地球自转角速度,为一常量,数值为7.292115147e-5弧度每秒;为地球自转角速度在载体坐标系投影的三轴分量;为地球自转角速度在地理系下投影的三轴分量;L为当地地理纬度;g为当地重力加速度。
将式(6)中方向余弦矩阵表示为如下的简化方式:
其中,式(7)所示矩阵中元素与式(6)矩阵中元素一一对应;
由此,根据式(7)可得到载体误差在1°以内的俯仰角θ、横滚角γ:
θ=sin-1T23 (8)
γ=tg-1(-T13/T33) (9)
步骤2:利用Kalman滤波进行静基座精对准,提高横滚角γ、俯仰角θ的对准精度,得到俯仰角θ′、横滚角γ′。
本发明实施例中将载体对准误差在50角秒以内,具体得到俯仰角θ′、横滚角γ′的过程如下。
将Kalman滤波运用到静基座精对准中,Kalman滤波状态方程为:
Kalman滤波测量方程为:
其中,φx、φy、φz分别为载体俯仰误差角、横滚误差角、航向误差角;εx、εy、εz分别为载体安装坐标系x、y、z轴向陀螺误差;分别为载体安装坐标系x、y轴向加速度计误差;δVx、δVy分别为载体安装坐标系x、y轴向载体速度误差;R为地球半径;ηx、ηy分别为载体安装坐标系x、y轴速度噪声;L为当地地理纬度。
通过式(10)、式(11)可得到φx、φy、φz、εx、εy、εz、δVx、δVy。
由φx、φy、φz组成误差矩阵,令其为C,表示如下:
则可得精对准后的方向余弦矩阵
将精对准后的方向余弦矩阵表示为如下的简化方式:
其中,式(14)所示矩阵中元素与式(13)精对准后的方向余弦矩阵中元素一一对应。通过式(14)可得:
θ′=sin-1T′23 (15)
γ′=tg-1(-T′13/T′33) (16)
从而获得载体对准误差在50角秒以内的俯仰角θ′、横滚角γ′。将重力加速度g投影到载体坐标系下,可得到重力加速度g在载体坐标系下的投影的三轴分量的计算值:
gxa=-sin(γ′)·cos(θ′)·g (17)
gya=sin(θ′)·g (18)
gza=cos(γ′)·cos(θ′)·g (19)
步骤3:将载体在10个不同的位置放置,在每个位置上都需要进行步骤1和步骤2中的静基座粗对准和静基座精对准,判断10个位置是否放置完成,若没有完成则转步骤1进行,若完成,则获得10组加速度计x、y、z轴测量值(gxm,gym,gzm)以及10组重力加速度g在载体坐标系下的投影的三轴分量的计算值(gxa,gya,gza)。
步骤4:通过非线性最小二乘法得到加速度计的零位偏差gx0,gy0,gz0。
a、构建目标函数;
根据式(3)可将式(2)变形,令目标函数
f(p)=[S11(gxm-gx0)+S12(gym-gy0)+S13(gzm-gz0)]2+[S21(gxm-gx0)+S22(gym-gy0)+S23(gzm-gz0)]2 (20)
+[S31(gxm-gx0)+S32(gym-gy0)+S33(gzm-gz0)]2-(gxp2+gyp2+gzp2)
其中,p=[gx0,gy0,gz0,S11,S12,S13,S21,S22,S23,S31,S32,S33];
b、求目标函数f(p)的雅可比矩阵;
目标函数f(p)的雅可比矩阵J为:
式中,f1...f10为第1到第10位置下的目标函数f(p);p1...p12为向量p的第1到第12个元素。
c、迭代逼近未知向量p;
解方程:
得到向量p第k步修正量δ(k)。
其中,Jk为雅可比矩阵J第k步更新值,为Jk的转置;vk为可调迭代步长;I为12阶单位阵;为目标函数f(p)在第1到第10位置时第k步的更新结果;
通过
p(k+1)=p(k)+δ(k) (23)
式中,p(k+1)为p向量第k+1步更新值;p(k)为p向量第k步更新值;对式(20),(21),(22),(23)反复求解迭代,直到向量p收敛到稳定值。向量p的前三个元素gx0,gy0,gz0即为加速度计的零位偏差。
步骤5:通过线性最小二乘法得到耦合矩阵S;
将步骤4中获得的零位偏差gx0,gy0,gz0带入式(2),可将式(2)误差模型蜕化为线性,利用线性最小二乘法可求得耦合矩阵S为:
S=(R*(GT*(G*GT)-1))-1 (25)
其中:
式中,gxa1...gxa10,gya1...gya10,gza1...gza10为重力加速度g在第1到第10个位置下在载体坐标系下的投影;gxm1...gxm10,gym1...gym10,gzm1...gzm10为加速度计在第1到第10个位置下x、y、z轴测量值。
将步骤4得到零位偏差gx0,gy0,gz0以及步骤5中安装误差和刻度因数的耦合矩阵S的值代入式(2)中,便可构建式(2)误差模型,从而可对加速度计的测量值gxm,gym,gzm,进行有效的修正,得到修正后的重力加速度g在载体坐标系下投影分量gxa,gya,gza,从而提高了测量的精度。
上述步骤4与步骤5中进行的非线性最小二乘和线性最小二乘均需要步骤1、步骤2中载体所在的10个位置间的相关性要小,即10组(gxa,gya,gza)之间、10组(gxm,gym,gzm)之间相关性要小。本发明采用如下位置选取方法(以俯仰角、横滚角的不同代表不同的位置),如表1所示。
表1 10位置选择方案一
上述方案满足相关性要求,且在这种选取方法下标定精度高。对该位置方案的仿真验证如下:经过数学软件MATLAB编程验证,根据位置方案进行标定实验,如果可以精确的辨识出零位偏差等参数,则说明10个标定位置不相关,否则反之。验证过程中共进行3000次实验,记录其中可以准确辨识出待求参数的实验次数作为方案的评价指标,并选取不同的10位置方案进行对比,结果如表5。
10位置选择如表2的方案二如下:
表2 10位置选取方案二
10位置选择如表3的方案三如下:
表3 10位置选取方案三
10位置选择如表4的方案四如下:
表4 10位置选取方案四
10位置选择在四种方案下,各进行3000次实验,各方案下可以准确辨识出待求参数的实验次数的统计结果如表5所示:
表5 对比结果
从表5中可以看出,10位置选择在方案一的情况下,准确辨识出待求参数的实验次数最高,因此选择方案一为优选方案。
机译: 一种不间断的配电方法,该方法使用绝缘的带电电线张紧器和旁路跨接电缆来分隔电线杆跨度内的电线,并在无电线状态下在该部分内执行工作。
机译: 一种无容器处理方法,该方法处于材料的重力补偿后的状态下,其设备
机译: 一种用于快速返回的方法,该方法通过在模具的初始位置将几乎无方向的测量力的指针移至初始状态下的无模量表中,从而为量表的测量工具供电