[发明专利]车载导航系统误差协方差阵部分参数自适应调节的方法

摘要

本发明公开了一种车载导航系统误差协方差阵部分参数自适应调节的方法，该方法需要建立车载导航系统的数学模型，根据模型系统能够进行滤波，采用了基于一段时间内轨迹的均值和方差的统计特性构建了GPS轨迹的光滑程度，用于判断是否需要调节误差协方差阵，利用GPS每秒的位移量与DR每秒的位移量构造观测噪声序列，建立了此噪声序列与误差协方差阵之间的关系，使得误差协方差阵在滤波系统中跟随噪声的变化而动态调节。本发明方法实现简单，易于操作；可以对误差协方差阵Q，R参数进行自适应调节；减小试凑法的工作量；提高导航系统的定位精度，与取经验值时直接滤波相比提高7％。

主权项

1、车载导航系统误差协方差阵参数自适应调节的方法，包括如下步骤：步骤一、建立车载导航系统的数学模型；步骤二、系统滤波；依据步骤一建立的数学模型对车辆导航系统进行系统滤波，滤波是一个循环的过程，以周期T为单位，根据上一时刻对当前时刻的估计以及当前时刻的观测变量对当前时刻的状态变量进行滤波估计，获得当前时刻更为精确的状态变量，做为系统滤波的输出值；其特征在于：还包括如下步骤：步骤三、GPS光滑度判定；1)设定轨迹的时间长度；把车辆的运动轨迹根据相等时间长度分成很多不同的轨迹段，设定时间长度H取15s～20s，并且不同轨迹段之间不可有时间重叠；2)DR相对运动序列A的构造；依据步骤1)中设定的时间长度，利用DR解算公式获得每段轨迹内相邻两点之间的距离L：L＝S(k)*(m(k-1)+m(k))/2S(k)表示里程仪的刻度因素，m(k-1)表示前一周期内里程仪累计的脉冲数，m(k)表示当前周期内累计的脉冲数，依据以上公式构造序列A，A中的每个元素表示一个周期1s内车辆行驶的位移量；3)GPS相对运动序列B的构造；依据步骤1)中设定的时间长度，利用GPS相邻时刻输出的位置信息做差，求出每一秒的位移，得出相邻两点间距离，构造序列B；4)构造距离差序列；将两序列A和序列B相减得到一个距离差序列C，获得相邻两秒中GPS测量位移与DR测量位移之差，距离差序列C中的元素有正负之分；5)误差统计；对距离差序列C进行统计，获得一定时间段内如15s内由步骤4)获得的距离差序列C内元素的均值与方差；6)设定比较的阈值判断光滑度；设定均值阈值为5～10，方差阈值为15～20，如果一定时间长度H内距离差序列C中元素的均值和方差均小于设定的均值阈值和方差阈值，则判定这段时间H内的运动轨迹是光滑的，则不需要调节q11、q22、r11、r22四个参数，否则认为是不光滑的，进入步骤四；步骤四、依据GPS光滑度调节协方差阵；所述调节协方差阵的步骤如下：1)统计特性的确定●根据GPS的测量性质在HDOP波动幅度大于0.5的情况下：POSmean_now＝(POSmean_n+POSmean_n+1+POSmean_n+2)/3POSvar_now＝(POSvar_n+POSvar_n+1+POSvar_n+2)/3POSmean_now表示序列差的均值POSmean_n、POSmean_n+1、POSmean_n+2表示连续三个距离差序列C的均值；POSvar_now表示序列差的方差，POSvar_n、POSvar_n+1、POSvar_n+2表示连续三个距离差序列C的方差；·根据GPS的测量性质在HDOP波动幅度小于0.5的情况下：在保证一次序列都是针对同一级别HDOP统计的结果情况下，使用当前序列的方差或者均值数据对协方差阵元素进行更新，从而使得系统滤波性能可以快速跟踪噪声的变化；2)协方差阵元素的更新r11＝r22＝α*POSvar_now 其中α为1～2；q11＝q22＝β*POSvar_now 其中β为10％～40％。