1.一种车辆状态估计方法,其特征在于:包括以下步骤:步骤1:构建车辆状态的线性系统,所述车辆状态的线性系统采用状态方程和观测方程来描述,状态方程和观测方程中的噪声采用非高斯噪声统计模型来描述;所述车辆状态包括车辆位置和车辆速度;
步骤2:在车辆状态的线性系统下,采用基于混合核函数的自适应核最大相关熵卡尔曼滤波方法,对车辆状态进行估计,以此获取车辆状态的最优状态估计;
其中,所述基于混合核函数的自适应核最大相关熵卡尔曼滤波方法,包括:根据前一时刻的车辆状态估计和前一时刻的状态估计误差协方差,进行一步预测,得到当前时刻的预测车辆状态估计和预测误差协方差;
将针对观测方程残差项的核函数和针对状态方程预测误差项的核函数的加权和作为代价函数;对代价函数进行最大化处理,得到当前时刻的车辆状态估计和当前时刻的状态估计误差协方差;
其中,针对观测方程残差项的核函数和针对状态方程预测误差项的核函数的核宽根据观测方程残差项自适应更新。
2.根据权利要求1所述的一种车辆状态估计方法,其特征在于:记前一时刻为 时刻,当前时刻为 时刻;
所述状态方程表示为:
(1)式中, 表示 时刻的车辆状态, 表示 时刻的状态转移矩阵, 表示 时刻的车辆状态, 表示 时刻的过程噪声;所述过程噪声为服从均值为0、协方差矩阵为 的非高斯分布,其中, , 表示期望运算,上标T表示转置;
所述观测方程表示为:
(2)式中, 表示 时刻的观测输出, 表示 时刻的观测矩阵, 表示 时刻的测量噪声;所述测量噪声为服从均值为0、协方差矩阵为 的非高斯分布,其中, 。
3.根据权利要求2所述的一种车辆状态估计方法,其特征在于:所述状态方程和观测方程中的噪声采用非高斯噪声统计模型来描述,具体表示为: (3) (4)式中, 分别表示过程噪声和测量噪声的高斯组件的凸组合系数,分别表示过程噪声和测量噪声的非高斯强度系数, 表示符合均值为
0、方差为 的正态分布, 表示符合均值为0、方差为 的正态分布, 表示符合均值为0、方差为 的正态分布, 表示符合均值为0、方差为 的正态分布, 表示 时刻的过程噪声协方差, 表示 时刻的测量噪声协方差。
4.根据权利要求3所述的一种车辆状态估计方法,其特征在于:所述根据前一时刻的车辆状态估计和前一时刻的状态估计误差协方差,进行一步预测,得到当前时刻的预测车辆状态估计值和预测误差协方差,具体为:根据 时刻的车辆状态估计和 时刻的状态估计误差协方,按照以下预测方程,进行一步预测,得到 时刻的预测车辆状态估计值和预测误差协方差: (5) (6)式中, 表示 时刻的一步车辆状态预测, 表示 时刻的车辆状态估计, 表示预测误差协方差; 表示 时刻的状态估计误差协方差。
5.根据权利要求4所述的一种车辆状态估计方法,其特征在于:所述观测方程残差项表示为: ;所述状态方程预测误差项表示为: ;
所述针对观测方程残差项的核函数,表示为:
(7)
式中, 表示2范数, 表示1范数, 表示混合系数, 表示核宽, 表示平方根函数, 表示以自然常数e为底的指数函数;
所述针对状态方程预测误差项的核函数,表示为:(8)
所述代价函数表示为:
(9)。
6.根据权利要求5所述的一种车辆状态估计方法,其特征在于:所述针对观测方程残差项的核函数和针对状态方程预测误差项的核函数的核宽根据观测方程残差项自适应更新,表示为: (10)式中, 表示 时刻的车辆状态估计。
7.根据权利要求6所述的一种车辆状态估计方法,其特征在于:所述对代价函数进行最大化处理,得到当前时刻的车辆状态估计和当前时刻的状态估计误差协方差,具体为:对代价函数关于 时刻的车辆状态估计 求导,并让导数为0,表示为:(11)
式中, 表示符号函数; 表示针对观测方程残差项的核函数的缩写; 表示针对状态方程预测误差项的核函数的缩写;在核函数中做近似 ;
得到:
(12) (13) (14)
式中, 表示 维单位矩阵, 表示滤波增益, 表示时刻的状态估计误差协方差,表示中间变量, 。