首页> 中国专利> 一种无依托状态下加速度计的标定方法

一种无依托状态下加速度计的标定方法

摘要

本发明公开了一种无依托状态下加速度计的标定方法,应用对象为具有静基座姿态初始对准能力的惯性导航系统。首先简化误差模型,多次改变载体位置,针对每一个位置利用静基座粗对准、精对准获得姿态信息,并依据姿态信息计算重力加速度g在载体坐标系下投影的三轴分量,并记录每个位置下加速度计测量值。本发明给出了一种10位置标定方案,依据上述投影分量计算值和测量值,利用非线性最小二乘法辨识零位偏差,获得零位偏差后可将误差模型蜕化为线性模型,再使用线性最小二乘法辨识安装误差和刻度因数耦合矩阵,从而实现加速度计关键参数标定。本发明可实现加速度计无依托标定,过程简单、速度快,可有效估计具有时变性的加速度计关键参数。

著录项

  • 公开/公告号CN101907638A

    专利类型发明专利

  • 公开/公告日2010-12-08

    原文格式PDF

  • 申请/专利权人 北京航空航天大学;

    申请/专利号CN201010205033.1

  • 发明设计人 张海;毛友泽;沈晓蓉;任章;

    申请日2010-06-11

  • 分类号G01P21/00;

  • 代理机构北京永创新实专利事务所;

  • 代理人官汉增

  • 地址 100191 北京市海淀区学院路37号

  • 入库时间 2023-12-18 01:18:04

法律信息

  • 法律状态公告日

    法律状态信息

    法律状态

  • 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设计,受器件测量精度的限制,误差模型简化严重,辨识结果精度较低。

发明内容

为了解决上述不能标出或者识别加速度计的安装误差和刻度因数误差,辨识结果精度低的问题,本发明提出一种无依托状态下加速度计的标定方法,在进行标定过程前首先需要考虑对加速度计性能影响最严重的误差参数,简化三轴加速度计的误差模型为

gxagyagza=K11kxK12kyK13kzK21kxK22kyK23kzK31kxK32kyK33Kz(gxm-gx0)(gym-gy0)(gzm-gz0)---(1)

式中,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为本发明的标定方法的步骤流程图。

具体实施方式

下面结合附图对本发明进行进一步的详细说明。

本发明进行标定前需要首先简化三轴加速度计的误差模型:

在现场标定的前提下,只考虑对加速度计性能影响最严重的误差参数,可将三轴加速度计的误差模型简化为:

gxagyagza=K11K12K13K21K22K23K31K32K33kx(gxm-gx0)ky(gym-gy0)kz(gzm-gz0)---(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)进一步化简合并可得:

gxagyagza=K11kxK12kyK13kzK21kxK22kyK23kzK31kxK32kyK33Kz(gxm-gx0)(gym-gy0)(gzm-gz0)---(2)

其中,为安装误差和刻度因数的耦合矩阵S。

将安装误差和刻度因数的耦合矩阵S表示为如下的简化方式:

S=S11S12S13S21S22S23S31S32S33---(3)

其中,式(3)所示矩阵中元素与式(2)中安装误差和刻度因数的耦合矩阵中元素一一对应;

本发明一种无依托状态下加速度计的标定方法,通过以下5步来对加速度计进行标定,具体步骤如下:

步骤1:静基座粗对准,得到载体横滚角γ、俯仰角θ。本发明实施例中将载体横滚角γ、俯仰角θ的对准误差控制在1°以内,具体得到载体横滚角γ、俯仰角θ通过下述过程来实现。

通过:

gxbgybgzb=Cnbgxngyngzn---(4)

ωiexbωieybωiezb=Cnbωiexnωieynωiezn---(5)

得到载体的载体坐标系和地理坐标系之间的方向余弦矩阵:

Cnb=gxbωiexbωiezbgyb-ωieybgzbgybωieybωiexbgzb-ωiezbgxbgzbωiezbωiezbgxb-ωiexbgyb·01gtanL-1g01ωiesecL01iesecL00

=(ωiezbgyb-ωieybgzb)·1gωiesecLgxb·1gtanL+ωiexb·1ωiesecL-gxb·1g(ωiexbgzb-ωiezbgxb)·1gωieseclgyb·1gtanL+ωieyb·1ωiesecL-gyb·1g(ωieybgxb-ωiexbgyb)·1iesecLgzb·1gtanL+ωiezb·1ωiesecL-gzb·1g---(6)

其中,为重力加速度g在载体坐标系下投影的三轴分量测量值;为重力加速度g在地理坐标系下投影的三轴分量;ωie为地球自转角速度,为一常量,数值为7.292115147e-5弧度每秒;为地球自转角速度在载体坐标系投影的三轴分量;为地球自转角速度在地理系下投影的三轴分量;L为当地地理纬度;g为当地重力加速度。

将式(6)中方向余弦矩阵表示为如下的简化方式:

Cnb=T11T12T13T21T22T23T31T32T33---(7)

其中,式(7)所示矩阵中元素与式(6)矩阵中元素一一对应;

由此,根据式(7)可得到载体误差在1°以内的俯仰角θ、横滚角γ:

θ=sin-1T23                        (8)

γ=tg-1(-T13/T33)                  (9)

步骤2:利用Kalman滤波进行静基座精对准,提高横滚角γ、俯仰角θ的对准精度,得到俯仰角θ′、横滚角γ′。

本发明实施例中将载体对准误差在50角秒以内,具体得到俯仰角θ′、横滚角γ′的过程如下。

将Kalman滤波运用到静基座精对准中,Kalman滤波状态方程为:

φ·xφ·yφ·zϵ·xϵ·yϵ·z·x·yδ·Vxδ·Vy=0ωiesinL-ωiecosL100000-1/R-ωiesinL00010001/R0ωiecosL0000100tgL/R0000000000000000000000000000000000000000000000000000-g00000000g000000000φxφyφzϵxϵyϵzxyδVxδVy---(10)

Kalman滤波测量方程为:

δVxδVy=00000000100000000001φxφyφzϵxϵyϵzxyδVxδVy+ηxηy---(11)

其中,φ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,表示如下:

C=1-φz-φyφz1φxφy-φx1---(12)

则可得精对准后的方向余弦矩阵

Cnb=Cnb*C=T11+T12*φz+T13*φy-T11*φz+T12-T13*φx-T11*φy+T12*φx+T13T21+T22*φz+T23*φy-T21*φz+T22-T23*φx-T21*φy+T22*φx+T23T31+T32*φz+T33*φy-T31*φz+T32-T33*φx-T31*φy+T32*φx+T33---(13)

将精对准后的方向余弦矩阵表示为如下的简化方式:

Cnb=T11T12T13T21T22T23T31T32T33---(14)

其中,式(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;

解方程:

(JkTJk+vkI)δ(k)=-JkTf(k)---(22)

得到向量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)

其中:

G=gxa1...gxa10gya1...gya10gza1...gza10;GT为G的转置;R=gxm1-gx0...gxm10-gx0gym1-gy0...gym10-gy0gzm1-gz0...gzm10-gz0

式中,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位置选择方案一

  姿态角  1  2  3  4  5  6  7  8  9  10  俯仰角/(°)  0  -20  40  -60  80  -100  120  -140  160  -180

横滚角/(°)-10 30-50 70-90 110-130  150-170  10

上述方案满足相关性要求,且在这种选取方法下标定精度高。对该位置方案的仿真验证如下:经过数学软件MATLAB编程验证,根据位置方案进行标定实验,如果可以精确的辨识出零位偏差等参数,则说明10个标定位置不相关,否则反之。验证过程中共进行3000次实验,记录其中可以准确辨识出待求参数的实验次数作为方案的评价指标,并选取不同的10位置方案进行对比,结果如表5。

10位置选择如表2的方案二如下:

表2  10位置选取方案二

  姿态角  1  2  3  4  5  6  7  8  9  10  俯仰角/(°)  0  -20  40  -60  80  -100  120  -140  160  -180  横滚角/(°)  0  30  -50  70  -90  110  -130  150  -170  10

10位置选择如表3的方案三如下:

表3  10位置选取方案三

  姿态角  1  2  3  4  5  6  7  8  9  10  俯仰角/(°)  0  -20  40  -60  80  -100  120  -140  160  -180  横滚角/(°)  -10  10  -30  50  -70  90  -110  130  -150  170

10位置选择如表4的方案四如下:

表4  10位置选取方案四

  姿态角  1  2  3  4  5  6  7  8  9  10  俯仰角/(°)  0  -20  40  -60  80  -100  120  -140  160  -180  横滚角/(°)  0  -30  50  -70  90  -110  130  -150  170  -10

10位置选择在四种方案下,各进行3000次实验,各方案下可以准确辨识出待求参数的实验次数的统计结果如表5所示:

表5  对比结果

从表5中可以看出,10位置选择在方案一的情况下,准确辨识出待求参数的实验次数最高,因此选择方案一为优选方案。

去获取专利,查看全文>

相似文献

  • 专利
  • 中文文献
  • 外文文献
获取专利

客服邮箱:kefu@zhangqiaokeyan.com

京公网安备:11010802029741号 ICP备案号:京ICP备15016152号-6 六维联合信息科技 (北京) 有限公司©版权所有
  • 客服微信

  • 服务号