1.一种车载GNSS/INS组合导航系统比例因子误差补偿方法,其特征在于,包括如下步骤:步骤一,建立INS误差方程,其表达式为:n n n
其中,ψ、δV和δP分别为导航坐标系下的姿态误差、速度误差和位置误差,导航坐标系n为n系;f为导航坐标系下的比力; 为车身坐标系转换到导航坐标系的方向余弦矩阵,车身坐标系为b系; 为地球自转角速度在导航坐标系的投影, 为导航坐标系相对于地球坐标系的角速度在导航坐标系的投影, 为导航坐标系相对于惯性坐标系的角速度在b b导航坐标系的投影;δf和δω分别为车身系下加速度计和陀螺仪的测量误差;
步骤二,建立GNSS/INS组合导航系统模型加速度计和陀螺仪误差模型分别为:
δf=bf+εf
δω=bω+εω
式中,
其中,δf和δω分别为加速度计和陀螺仪的误差;bf和bω分别为加速度计和陀螺仪的随机常值误差;εf和εω分别表示加速度计和陀螺仪中的随机噪声;进而与INS误差方程结合,得到基于卡尔曼滤波的GNSS/INS组合导航系统模型;
步骤三,将比例因子误差在GNSS/INS组合导航系统模型方程中表征当加速度计和陀螺仪测量中存在比例因子误差时,其误差模型可分别表示为:其中, 和 分别为加速度计和陀螺仪中由比例因子误差产生的模型误差;sf和sω分别表示加速度计和陀螺仪中的比例因子误差,为常数;f和ω分别表示加速度计和陀螺仪的测量值;
步骤四,将包含比例因子误差的GNSS/INS组合导航系统模型解耦,得到并行的导航状态量估计器和比例因子误差观测器,用来同时估计导航状态量和比例因子误差。
2.根据权利要求1所述的一种车载GNSS/INS组合导航系统比例因子误差补偿方法,其特征在于,步骤二中,所述基于卡尔曼滤波的GNSS/INS组合导航系统模型方程为:式中,w和v为零均值且不相关的高斯白噪声;
T T
y=[VINS‑VGNSS PINS‑PGNSS]=[δV3×1 δP3×1];
C=[06×3 I6×6 06×6];
其中,ψ、δV、δP分别为姿态误差、速度误差和位置误差,bf和bω分别为加速度计和陀螺仪的随机常值误差,VINS和PINS分别为INS输出的速度和位置,VGNSS和PGNSS分别为GNSS输出的速度和位置,0为零矩阵,I为单位矩阵。
3.根据权利要求2所述的一种车载GNSS/INS组合导航系统比例因子误差补偿方法,其特征在于,步骤三,将比例因子误差在GNSS/INS组合导航系统模型方程中表征,并对方程进行离散化处理,得到:其中,I为单位矩阵;Ak为状态转移矩阵,由矩阵F离散化得到;bk为陀螺仪和加速度计比例因子误差向量;Bk表示模型误差进入状态方程的传播矩阵;其余符号意义同前,只是转为离散化形式;并且有:Ak=(I+F△t);
b b
其中,Δt为系统采样周期,ω和f分别为车身系下陀螺仪和加速度计的测量值。
4.根据权利要求3所述的一种车载GNSS/INS组合导航系统比例因子误差补偿方法,其特征在于,步骤四中,导航状态量估计器迭代过程为:当k=0时,初始化:
式中, 为状态量初始值; 为状态量误差协方差初始值;x0为状态量真实值,当k=1,2,3……时,状态量先验估计值更新:
式中, 是状态量先验估计值, 是状态量后验估计值;
状态量先验误差协方差更新:
式中, 是导航状态量估计器的状态量先验误差协方差, 是导航状态量估计器的状态量后验误差协方差,Qk‑1是上述组合导航系统模型方程中噪声wk‑1的协方差;
计算卡尔曼增益:
式中,Kx,k是导航状态量估计器的卡尔曼增益,Rk是上述组合导航系统模型方程中噪声vk的协方差;
新息更新:
式中,rx,k是导航状态量估计器的新息;
状态量后验估计值更新:
状态量后验误差协方差更新:
5.根据权利要求4所述的一种车载GNSS/INS组合导航系统比例因子误差补偿方法,其特征在于,步骤四中,比例因子误差观测器迭代过程为:当k=0时,初始化:
U0=0,
式中, 为比例因子误差量初始值;U0为迭代矩阵初始值;Pb,0为比例因子误差量的误差协方差初始值;b0为比例因子误差量真实值;
当k=1,2,3……时,
先验估计值更新:
式中, 是比例因子误差量先验估计值, 是比例因子误差量后验估计值;
更新算法迭代矩阵:
式中,Vk、Uk、Sk是为算法迭代计算方便设置的中间环节矩阵,无特殊含义;
误差协方差矩阵更新:
式中,Pb,k是比例因子误差量的误差协方差;
计算卡尔曼增益:
式中,Kb,k是比例因子误差观测器的卡尔曼增益;
新息更新:
式中,rb,k是比例因子误差观测器的新息,后验估计值更新:
6.根据权利要求5所述的一种车载GNSS/INS组合导航系统比例因子误差补偿方法,其特征在于,步骤四中,每一次迭代的最后,需用比例因子误差估计值对导航状态量估计值进行补偿,从而得到导航状态量的最优估计为:式中, 为导航状态量的最优估计值。