一种无人车位置预测方法及装置

文档序号:25817576发布日期:2021-07-09 14:13阅读:来源:国知局

技术特征:
1.一种无人车位置预测方法,其特征在于,包括:在车辆周围存在参照物的情况下,获取参照物的位置信息和车辆的第一历史行驶状态信息;基于参照物与车辆的空间关系构建车辆的观测方程;通过观测方程和车辆的第一历史行驶状态信息进行粒子滤波,预测车辆的未来位置信息;在车辆周围不存在参照物的情况下,获取车辆在不同历史时刻的第二行驶状态信息,并通过马尔可夫模型和车辆在不同历史时刻的第二行驶状态信息,预测车辆未来位置。2.根据权利要求1所述的方法,其特征在于,所述基于参照物与车辆的空间关系构建车辆的观测方程,包括:根据参照物的位置信息,构建车辆与参照物距离的方程,以及车辆与参照物航向角的方程;通过所述车辆的预期车速与实际车速的偏差,构建车速的观测值方程;基于车辆与参照物距离的方程、车辆与参照物航向角的方程以及车速的观测值方程以及非高斯噪声,构建车辆的观测方程。3.根据权利要求1所述的方法,其特征在于,所述通过观测方程和车辆的第一历史行驶状态信息进行粒子滤波,预测车辆的未来位置信息,包括:构建车辆的第一运动学模型;所述第一运动学模型表征车辆质心的坐标、偏航角、期望车速、前轮角以及车辆轴距之间的关系;通过所述运动学模型和车辆的第一历史行驶状态信息预测粒子的下一步行驶状态,得到每个粒子的行驶状态预测值;所述第一历史行驶状态信息包括车辆的位置和偏航角;将每个粒子的行驶状态预测值输入到观测方程中,得到每个粒子的观测值;获取车辆当前的观测值;所述观测值包括:当前车辆与周围物体的距离、当前车辆与周围物体的角度以及实际车速和预期车速的偏差;通过车辆当前的观测值和粒子的预测值,计算粒子的权重;基于粒子的权重对粒子进行筛选;对于筛选后的粒子,返回执行通过所述运动学模型预测粒子的下一步状态,得到每个粒子的状态预测值。4.根据权利要求1所述的方法,其特征在于,所述车辆周围不存在参照物的情况下,获取车辆在不同历史时刻的第二行驶状态信息,包括:构建车辆的第二运动学模型;所述第二运动学模型表征车辆质心的坐标、偏航角和偏航角速度、车辆的轴距、车辆速度之间的关系;通过所述第二运动学模型,获取车辆在不同历史时刻的第二行驶状态信息;所述不同历史时刻的行驶状态信息包括:车辆的纵向车速和偏航角速度。5.根据权利要求所述的方法,其特征在于,所述通过马尔可夫模型和车辆在不同历史时刻的第二行驶状态信息,预测车辆未来位置,包括:通过所述车辆在不同历史时刻的第二行驶状态信息,构建变阶、变预测步长的马尔可夫模型;通过变阶变预测步长的马尔可夫模型构建转移概率,并且确定约束条件;
依据所述转移概率以及约束条件以及动态滑动窗口理论,构建动态转移概率;根据动态转移概率确定预测方程;根据所述预测方程预测车辆的未来位置。6.一种无人车位置预测装置,其特征在于,包括:获取单元,用于在车辆周围存在参照物的情况下,获取参照物的位置信息和车辆的第一历史行驶状态信息;观测方程构建单元,用于基于参照物与车辆的空间关系构建车辆的观测方程;第一未来位置预测单元,用于通过观测方程和车辆的第一历史行驶状态信息进行粒子滤波,预测车辆的未来位置信息;第二未来位置预测单元,用于在车辆周围不存在参照物的情况下,获取车辆在不同历史时刻的第二行驶状态信息,并通过马尔可夫模型和车辆在不同历史时刻的第二行驶状态信息,预测车辆未来位置。7.根据权利要求6所述的装置,其特征在于,所述观测方程构建单元,包括:距离和航向角方程构建子单元,用于根据参照物的位置信息,构建车辆与参照物距离的方程,以及车辆与参照物航向角的方程;车速观测值方程构建子单元,用于通过所述车辆的预期车速与实际车速的偏差,构建车速的观测值方程;车辆观测方程构建子单元,用于基于车辆与参照物距离的方程、车辆与参照物航向角的方程以及车速的观测值方程以及非高斯噪声,构建车辆的观测方程。8.根据权利要求6所述的装置,其特征在于,所述第一未来位置预测单元,包括:第一运动学模型构建子单元,用于构建车辆的第一运动学模型;所述第一运动学模型表征车辆质心的坐标、偏航角和期望车速、前轮角以及车辆轴距之间的关系;第一预测子单元,用于通过所述运动学模型和车辆的第一历史行驶状态预测粒子的下一步行驶状态,得到每个粒子的行驶状态预测值;第二预测子单元,用于将每个粒子的行驶状态预测值输入到观测方程中,得到每个粒子的观测值;第一获取子单元,用于获取车辆当前的观测值;所述观测值包括:当前车辆与周围物体的距离、当前车辆与周围物体的角度以及实际车速和预期车速的偏差;粒子权重计算子单元,用于通过车辆当前的观测值和粒子的预测值,计算粒子的权重;粒子筛选子单元,用于基于粒子的权重对粒子进行筛选;迭代子单元,用于对于筛选后的粒子,返回执行通过所述运动学模型预测粒子的下一步状态,得到每个粒子的状态预测值。9.根据权利要求6所述的装置,其特征在于,所述第二未来位置预测单元,包括:第二运动学模型构建子单元,用于构建车辆的第二运动学模型;所述第二运动学模型表征车辆质心的坐标、偏航角和偏航角速度、车辆的轴距、车辆速度之间的关系;第二获取子单元,用于通过所述第二运动学模型,获取车辆在不同历史时刻的第二行驶状态信息;所述不同历史时刻的行驶状态信息包括:车辆的纵向车速和偏航角速度。10.根据权利要求6所述的装置,其特征在于,所述第二未来位置预测单元,包括:马尔可夫模型构建子单元,用于通过所述车辆在不同历史时刻的第二行驶状态信息,
构建变阶、变预测步长的马尔可夫模型;转移概率构建子单元,用于通过变阶变预测步长的马尔可夫模型构建转移概率,并且确定约束条件;动态转移概率构建子单元,用于依据所述转移概率以及约束条件以及动态滑动窗口理论,构建动态转移概率;预测方程构建子单元,用于根据动态转移概率确定预测方程;预测子单元,用于根据所述预测方程预测车辆的未来位置。
当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1