CN113094967A - 一种无人车位置预测方法及装置 - Google Patents
一种无人车位置预测方法及装置 Download PDFInfo
- Publication number
- CN113094967A CN113094967A CN202110346692.5A CN202110346692A CN113094967A CN 113094967 A CN113094967 A CN 113094967A CN 202110346692 A CN202110346692 A CN 202110346692A CN 113094967 A CN113094967 A CN 113094967A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- equation
- reference object
- constructing
- prediction
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/20—Design optimisation, verification or simulation
- G06F30/25—Design optimisation, verification or simulation using particle-based methods
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/11—Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/02—Services making use of location information
- H04W4/023—Services making use of location information using mutual or relative location information between multiple location based services [LBS] targets or of distance thresholds
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Mathematical Physics (AREA)
- Pure & Applied Mathematics (AREA)
- General Engineering & Computer Science (AREA)
- Mathematical Optimization (AREA)
- Computational Mathematics (AREA)
- Mathematical Analysis (AREA)
- Data Mining & Analysis (AREA)
- Algebra (AREA)
- Signal Processing (AREA)
- Databases & Information Systems (AREA)
- Software Systems (AREA)
- Operations Research (AREA)
- Computer Networks & Wireless Communication (AREA)
- Computer Hardware Design (AREA)
- Evolutionary Computation (AREA)
- Geometry (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明公开了一种无人车位置预测方法及装置包括:无人车在GPS无法定位的情况,可以采用粒子滤波或者马尔可夫模型预测车辆未来的状态,其中,在检测到车辆周围存在参照物的情况下,获取参照物的位置信息和车辆的第一历史行驶状态信息;基于参照物与车辆的空间关系构建车辆的观测方程;通过观测方程和车辆的第一运动状态信息进行粒子滤波,预测车辆的未来位置信息;在车辆周围不存在参照物的情况下,获取车辆在不同历史时刻的第二行驶状态信息,并通过马尔可夫模型和车辆在不同历史时刻的第二行驶状态信息,预测车辆未来位置。由此,即使GPS信号不佳的情况下,也可以通过对车辆位置进行预测的方法,对车辆进行定位,保障了无人车的正常行驶。
Description
技术领域
本发明涉及无人车技术领域,尤其涉及一种无人车位置预测方法及装置。
背景技术
无人驾驶车辆(以下简称无人车)是一种不需要人工控制即可对其周围环境进行感知,对场景进行决策判断,对其进行控制的现代车辆。无人车在行驶过程中,无人车的GPS(英文全称:Global Positioning System,中文全称:全球定位系统)信号可能会被非高斯噪声干扰,甚至会丢失信号,这种情况下,无人车无法定位位置,很容易影响无人车的正常行驶。
发明内容
有鉴于此,本实施例中,通过离子滤波和马尔可夫模型分别预测车辆未来位置信息,这样即使车辆GPS信号不佳的情况下,也能保障无人车的正常行驶。
本发明实施例公开了一种无人车位置预测方法,包括:
在车辆周围存在参照物的情况下,获取参照物的位置信息和车辆的第一历史行驶状态信息;
基于参照物与车辆的空间关系构建车辆的观测方程;
通过观测方程和车辆的第一历史行驶状态信息进行粒子滤波,预测车辆的未来位置信息;
在车辆周围不存在参照物的情况下,获取车辆在不同历史时刻的第二行驶状态信息,并通过马尔可夫模型和车辆在不同历史时刻的第二行驶状态信息,预测车辆未来位置。
可选的,所述基于参照物与车辆的空间关系构建车辆的观测方程,包括:
根据参照物的位置信息,构建车辆与参照物距离的方程,以及车辆与参照物航向角的方程;
通过所述车辆的预期车速与实际车速的偏差,构建车速的观测值方程;
基于车辆与参照物距离的方程、车辆与参照物航向角的方程以及车速的观测值方程以及非高斯噪声,构建车辆的观测方程。
可选的,所述通过观测方程和车辆的第一历史行驶状态信息进行粒子滤波,预测车辆的未来位置信息,包括:
构建车辆的第一运动学模型;所述第一运动学模型表征车辆质心的坐标、偏航角和期望车速、前轮角以及车辆轴距之间的关系;
通过所述运动学模型和车辆的第一历史行驶状态预测粒子的下一步行驶状态,得到每个粒子的行驶状态预测值;
将每个粒子的行驶状态预测值输入到观测方程中,得到每个粒子的观测值;
获取车辆当前的观测值;所述观测值包括:当前车辆与周围物体的距离、当前车辆与周围物体的角度以及实际车速和预期车速的偏差;
通过车辆当前的观测值和粒子的预测值,计算粒子的权重;
基于粒子的权重对粒子进行筛选;
对于筛选后的粒子,返回执行通过所述运动学模型预测粒子的下一步状态,得到每个粒子的状态预测值。
可选的,所述车辆周围不存在参照物的情况下,获取车辆在不同历史时刻的第二行驶状态信息,包括:
构建车辆的第二运动学模型;所述第二运动学模型表征车辆质心的坐标、偏航角和偏航角速度、车辆的轴距、车辆速度之间的关系;
通过所述第二运动学模型,获取车辆在不同历史时刻的第二行驶状态信息;所述不同历史时刻的行驶状态信息包括:车辆的纵向车速和偏航角速度。
可选的,所述通过马尔可夫模型和车辆在不同历史时刻的第二行驶状态信息,预测车辆未来位置,包括:
通过所述车辆在不同历史时刻的第二行驶状态信息,构建变阶、变预测步长的马尔可夫模型;
通过变阶变预测步长的马尔可夫模型构建转移概率,并且确定约束条件;
依据所述转移概率以及约束条件以及动态滑动窗口理论,构建动态转移概率;
根据动态转移概率确定预测方程;
根据所述预测方程预测车辆的未来位置。
本发明实施例还公开了一种无人车位置预测装置,包括:
获取单元,用于在车辆周围存在参照物的情况下,获取参照物的位置信息和车辆的第一历史行驶状态信息;
观测方程构建单元,用于基于参照物与车辆的空间关系构建车辆的观测方程;
第一未来位置预测单元,用于通过观测方程和车辆的第一历史行驶状态信息进行粒子滤波,预测车辆的未来位置信息;
第二未来位置预测单元,用于在车辆周围不存在参照物的情况下,获取车辆在不同历史时刻的第二行驶状态信息,并通过马尔可夫模型和车辆在不同历史时刻的第二行驶状态信息,预测车辆未来位置。
可选的,所述观测方程构建单元,包括:
距离和航向角方程构建子单元,用于根据参照物的位置信息,构建车辆与参照物距离的方程,以及车辆与参照物航向角的方程;
车速观测值方程构建子单元,用于通过所述车辆的预期车速与实际车速的偏差,构建车速的观测值方程;
车辆观测方程构建子单元,用于基于车辆与参照物距离的方程、车辆与参照物航向角的方程以及车速的观测值方程以及非高斯噪声,构建车辆的观测方程。
可选的,所述第一未来位置预测单元,包括:
第一运动学模型构建子单元,用于构建车辆的第一运动学模型;所述第一运动学模型表征车辆质心的坐标、偏航角和期望车速、前轮角以及车辆轴距之间的关系;
第一预测子单元,用于通过所述运动学模型和车辆的第一历史行驶状态预测粒子的下一步行驶状态,得到每个粒子的行驶状态预测值;
第二预测子单元,用于将每个粒子的行驶状态预测值输入到观测方程中,得到每个粒子的观测值;
第一获取子单元,用于获取车辆当前的观测值;所述观测值包括:当前车辆与周围物体的距离、当前车辆与周围物体的角度以及实际车速和预期车速的偏差;
粒子权重计算子单元,用于通过车辆当前的观测值和粒子的预测值,计算粒子的权重;
粒子筛选子单元,用于基于粒子的权重对粒子进行筛选;
迭代子单元,用于对于筛选后的粒子,返回执行通过所述运动学模型预测粒子的下一步状态,得到每个粒子的状态预测值。
可选的,所述第二未来位置预测单元,包括:
第二运动学模型构建子单元,用于构建车辆的第二运动学模型;所述第二运动学模型表征车辆质心的坐标、偏航角和偏航角速度、车辆的轴距、车辆速度之间的关系;
第二获取子单元,用于通过所述第二运动学模型,获取车辆在不同历史时刻的第二行驶状态信息;所述不同历史时刻的行驶状态信息包括:车辆的纵向车速和偏航角速度。
可选的,所述第二未来位置预测单元,包括:
马尔可夫模型构建子单元,用于通过所述车辆在不同历史时刻的第二行驶状态信息,构建变阶、变预测步长的马尔可夫模型;
转移概率构建子单元,用于通过变阶变预测步长的马尔可夫模型构建转移概率,并且确定约束条件;
动态转移概率构建子单元,用于依据所述转移概率以及约束条件以及动态滑动窗口理论,构建动态转移概率;
预测方程构建子单元,用于根据动态转移概率确定预测方程;
预测子单元,用于根据所述预测方程预测车辆的未来位置。
本发明实施例公开了一种无人车位置预测方法及装置,包括:在检测到车辆周围存在参照物的情况下,获取参照物的位置信息和车辆的第一历史行驶状态信息;基于参照物与车辆的空间关系构建车辆的观测方程;通过观测方程和车辆的第一运动状态信息进行粒子滤波,预测车辆的未来位置信息;在车辆周围不存在参照物的情况下,获取车辆在不同历史时刻的第二行驶状态信息,并通过马尔可夫模型和车辆在不同历史时刻的第二行驶状态信息,预测车辆未来位置。由此,即使GPS信号不佳的情况下,也可以通过对车辆位置进行预测的方法,对车辆进行定位,保障了无人车的正常行驶。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据提供的附图获得其他的附图。
图1示出了本发明实施例提供的一种无人车位置预测方法的流程示意图;
图2示出了本发明实施例公开的一种无人车位置预测装置的结构示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
参考图1,示出了本发明实施例提供的一种无人车位置预测方法的流程示意图,在本实施例中,该方法包括:
S101:在车辆周围存在参照物的情况下,获取参照物的位置信息和车辆的第一历史行驶状态信息;
本实施例中,无人车上安装有传感器,可以用来探测周围的物体,将探测到的周围的物体表示为无人车的参照物,例如可以为车辆周围的建筑物,或者车辆周围的树木。其中,在探测到车辆周围的参照物后,可以根据预设的世界地图,或者预设的某区域的地图以及参照物的相关信息(例如参照物的图片)获取参照物的位置信息。
其中,第一历史行驶状态信息例如包括:车辆的位置和偏航角。本实施例中,可以通过多种方式获取车辆的第一历史行驶状态信息,本实施例中不进行限定。
S102:基于参照物与车辆的空间关系构建车辆的观测方程;
在车辆信号不佳,或者GPS失灵的情况下,难以确定车辆当前位置。在参照物位置已知的情况下,本实施例中,可以根据车辆与参照物的空间关系预测车辆位置,其中,车辆与参照物的位置关系可以包括:车辆与参照物的距离、车辆与参照物的航向角等。除此之外,车辆的位置也与车辆的速度有关,因此预测车辆位置的参数还可以包括车辆车速的观测值,本实施例中通过车辆的期望速度和实际速度的偏差表示车辆的观测值。
其中,根据周围环境的信息,无人驾驶车辆可以通过计算其与周围参考对象的相对距离来实现实时定位。车辆与周围物体的距离方程如下公式1)所示:
其中,d为传感器测量到的车辆与周围参考物体的距离,(x0,y0)为参考物体的坐标,可在构建的地图中确定。s(t)为实时测量噪声。
其中,车辆位置与周围参考物体位置之间的航向角方程如下公式2)所示:
其中,θ为传感器测得的车辆与周围参考物体之间的航向角,同时也受到测量噪声的干扰。
为了满足高速无人驾驶车辆实时定位的要求,需要考虑车辆行驶状态信息。实际纵向速度与预期纵向速度的偏差作为观测值,其观测方程如下公式3)所示:
△v(t)=[vr(t)-v(t)]+s(t) 3)
通过上述可知,车辆的观测方程可以表示为如下的公式4):
Z(t)=h(X(t))+s(t) 4);
其中,h(X(t))通过如下的公式5)表示:
如上所示,车辆观测方程的构建方法包括:
根据参照物的位置信息,构建车辆与参照物距离的方程,以及车辆与参照物航向角的方程;
通过所述车辆的预期车速与实际车速的偏差,构建车速的观测值方程;
基于车辆与参照物距离的方程、车辆与参照物航向角的方程以及车速的观测值方程以及非高斯噪声,构建车辆的观测方程。
其中,非高斯噪声可以包括多种,本实施例中不进行限定,例如可以包括:色噪声或闪烁噪声。
S103:通过观测方程和车辆的第一运动状态信息进行粒子滤波,预测车辆的未来位置信息;
本实施例中,通过粒子滤波预测车辆未来位置的过程中,可以通过观测方程不断更新粒子的位置,并剔除劣质粒子,更新新的粒子,从而指导粒子空间分布。
具体的,粒子滤波的过程包括如下的S201-S207:,包括:
S201:构建车辆的第一运动学模型;所述第一运动学模型表征车辆质心的坐标、偏航角和期望车速、前轮角以及车辆轴距之间的关系;
S202:通过所述运动学模型和车辆的第一历史行驶状态预测粒子的下一步行驶状态,得到每个粒子的行驶状态预测值;
其中,在粒子更新的过程中,通过t-1时刻的历史行驶状态以及车辆的运动学方程预测车辆下一时刻t的状态,具体的,将例如包括:车辆位置与偏航角。
S203:将每个粒子的行驶状态预测值输入到观测方程中,得到每个粒子的观测值;
S204:获取车辆当前的观测值;所述观测值包括:当前车辆与周围物体的距离、当前车辆与周围物体的角度以及实际车速和预期车速的偏差;
S205:通过车辆当前的观测值和粒子的预测值,计算粒子的权重;
S206:基于粒子的权重对粒子进行筛选;
S207:对于筛选后的粒子,返回执行S201。
举例说明:粒子滤波过程中,粒子滤波过程包括:
(3)在当前t时刻,测量系统能够唯一采集到的一个观测值Zc(t)(车辆的距离),可以用于计算每个粒子的权值。根据权值,控制器可以复制大量的优质粒子,剔除劣质粒子,从而指导粒子空间的分布,权值的计算公式可以表示为如下的公式6)
其归一化权值可以通过如下的公式7)表示:
S104:在车辆周围不存在参照物的情况下,获取车辆在不同历史时刻的第二行驶状态信息,并通过马尔可夫模型和车辆在不同历史时刻的第二行驶状态信息,预测车辆未来位置。
本实施例中,车辆在不同历史时刻的第二行驶状态信息,例如可以包括:车辆的纵向车速和偏航角,其中车辆的第二行驶状态,例如可以通过车辆的第二运动学模型确定,具体的,包括:
构建车辆的第二运动学模型;所述第二运动学模型表征车辆质心的坐标、偏航角和偏航角速度、车辆的轴距、车辆速度之间的关系;
通过所述第二运动学模型,获取车辆在不同历史时刻的行驶状态信息;所述不同历史时刻的行驶状态信息包括:车辆的纵向车速和偏航角速度。
其中,车辆的第二运动学模型可以通过如下的公式8)表示:
其中,通过车辆的第二运动学模型可以获得车辆在不同时刻的状态,例如,在不同时刻车辆的纵向车速和偏航角速度。
其中,获取的车辆在不同历史时刻的行驶状态,并且车辆在不同时刻的状态构建马尔可夫过程的离散状态集。
举例说明:假设随机过程{Xn,n∈T}的参数集T属于离散时间集,T={0,1,2,…},其对应的Xn属于马尔可夫过程的离散状态集I={i0,i1,i2,…,in}。
本实施例中,通过马尔可夫模型和车辆在不同历史时刻的第二行驶状态信息,预测车辆未来位置的过程包括如下的:S301-S305,包括:
S301:通过所述车辆在不同历史时刻的第二行驶状态信息,构建变阶、变预测步长的马尔可夫模型;
S302:通过变阶变预测步长的马尔可夫模型构建转移概率,并且确定约束条件;
S303:依据所述转移概率以及约束条件以及动态滑动窗口理论,构建动态转移概率;
S304:根据动态转移概率确定预测方程;
S305:根据所述预测方程预测车辆的未来位置。
其中,在构建马尔可夫模型的过程中,条件概率公式可以通过如下的公式9)表示:
通过该条件概率公式构建变阶、变预测步长的马尔可夫模型,其中,马尔可夫模型可以通过如下的公式10)表示:
需要说明的是,构建的变阶、变预测步长的马尔可夫模型为高阶的马尔可夫模型。
其中,s为马尔可夫模型的阶数,n为预测步长,m为状态数,根据数据库中车辆的速度和角速度的取值范围来设定状态数量。
本实施例中,高阶马尔可夫模型的转移概率通过如下的公式11)表示:
基于动态滑动窗口理论,在传感器数据采集过程中,窗口随着数据流向前移动,实时更新动态转移概率矩阵。动态转移概率矩阵P(t)的表达形式如下所示:
最后,预测方程可以通过如下的公式14)表示:
其中,Xt为t时刻的概率分布,Pk为k阶的转移概率矩阵,s为可调节的阶数。
本实施例中,通过粒子滤波或者马尔可夫模型预测车辆未来的状态,包括:在检测到车辆周围存在参照物的情况下,获取参照物的位置信息和车辆的第一历史行驶状态信息;基于参照物与车辆的空间关系构建车辆的观测方程;通过观测方程和车辆的第一运动状态信息进行粒子滤波,预测车辆的未来位置信息;在车辆周围不存在参照物的情况下,获取车辆在不同历史时刻的第二行驶状态信息,并通过马尔可夫模型和车辆在不同历史时刻的第二行驶状态信息,预测车辆未来位置。由此,即使GPS信号不佳的情况下,也可以通过对车辆位置进行预测的方法,对车辆进行定位,保障了无人车的正常行驶。
参考图2,示出了本发明实施例公开的一种无人车位置预测装置的结构示意图,在本实施例中,该装置包括:
获取单元201,用于在车辆周围存在参照物的情况下,获取参照物的位置信息和车辆的第一历史行驶状态信息;
观测方程构建单元202,用于基于参照物与车辆的空间关系构建车辆的观测方程;
第一未来位置预测单元203,用于通过观测方程和车辆的第一运动状态信息进行粒子滤波,预测车辆的未来位置信息;
第二未来位置预测单元,用于在车辆周围不存在参照物的情况下,获取车辆在不同历史时刻的第二行驶状态信息,并通过马尔可夫模型和车辆在不同历史时刻的第二行驶状态信息,预测车辆未来位置。
可选的,所述观测方程构建单元,包括:
距离和航向角方程构建子单元,用于根据参照物的位置信息,构建车辆与参照物距离的方程,以及车辆与参照物航向角的方程;
车速观测值方程构建子单元,用于通过所述车辆的预期车速与实际车速的偏差,构建车速的观测值方程;
车辆观测方程构建子单元,用于基于车辆与参照物距离的方程、车辆与参照物航向角的方程以及车速的观测值方程以及非高斯噪声,构建车辆的观测方程。
可选的,所述第一未来位置预测单元,包括:
第一运动学模型构建子单元,用于构建车辆的第一运动学模型;所述第一运动学模型表征车辆质心的坐标、偏航角和期望车速、前轮角以及车辆轴距之间的关系;
第一预测子单元,用于通过所述运动学模型和车辆的第一历史行驶状态预测粒子的下一步行驶状态,得到每个粒子的行驶状态预测值;
第二预测子单元,用于将每个粒子的行驶状态预测值输入到观测方程中,得到每个粒子的观测值;
第一获取子单元,用于获取车辆当前的观测值;所述观测值包括:当前车辆与周围物体的距离、当前车辆与周围物体的角度以及实际车速和预期车速的偏差;
粒子权重计算子单元,用于通过车辆当前的观测值和粒子的预测值,计算粒子的权重;
粒子筛选子单元,用于基于粒子的权重对粒子进行筛选;
迭代子单元,用于对于筛选后的粒子,返回执行通过所述运动学模型预测粒子的下一步状态,得到每个粒子的状态预测值。
可选的,所述第二未来位置预测单元,包括:
第二运动学模型构建子单元,用于构建车辆的第二运动学模型;所述第二运动学模型表征车辆质心的坐标、偏航角和偏航角速度、车辆的轴距、车辆速度之间的关系;
第二获取子单元,用于通过所述第二运动学模型,获取车辆在不同历史时刻的第二行驶状态信息;所述不同历史时刻的行驶状态信息包括:车辆的纵向车速和偏航角速度。
可选的,所述第二未来位置预测单元,包括:
马尔可夫模型构建子单元,用于通过所述车辆在不同历史时刻的第二行驶状态信息,构建变阶、变预测步长的马尔可夫模型;
转移概率构建子单元,用于通过变阶变预测步长的马尔可夫模型构建转移概率,并且确定约束条件;
动态转移概率构建子单元,用于依据所述转移概率以及约束条件以及动态滑动窗口理论,构建动态转移概率;
预测方程构建子单元,用于根据动态转移概率确定预测方程;
预测子单元,用于根据所述预测方程预测车辆的未来位置。
通过本实施例的装置,在检测到车辆周围存在参照物的情况下,获取参照物的位置信息和车辆的第一历史行驶状态信息;基于参照物与车辆的空间关系构建车辆的观测方程;通过观测方程和车辆的第一运动状态信息进行粒子滤波,预测车辆的未来位置信息;在车辆周围不存在参照物的情况下,获取车辆在不同历史时刻的第二行驶状态信息,并通过马尔可夫模型和车辆在不同历史时刻的第二行驶状态信息,预测车辆未来位置。由此,即使GPS信号不佳的情况下,也可以通过对车辆位置进行预测的方法,对车辆进行定位,保障了无人车的正常行驶。
需要说明的是,本说明书中的各个实施例均采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似的部分互相参见即可。
对所公开的实施例的上述说明,使本领域专业技术人员能够实现或使用本发明。对这些实施例的多种修改对本领域的专业技术人员来说将是显而易见的,本文中所定义的一般原理可以在不脱离本发明的精神或范围的情况下,在其它实施例中实现。因此,本发明将不会被限制于本文所示的这些实施例,而是要符合与本文所公开的原理和新颖特点相一致的最宽的范围。
Claims (10)
1.一种无人车位置预测方法,其特征在于,包括:
在车辆周围存在参照物的情况下,获取参照物的位置信息和车辆的第一历史行驶状态信息;
基于参照物与车辆的空间关系构建车辆的观测方程;
通过观测方程和车辆的第一历史行驶状态信息进行粒子滤波,预测车辆的未来位置信息;
在车辆周围不存在参照物的情况下,获取车辆在不同历史时刻的第二行驶状态信息,并通过马尔可夫模型和车辆在不同历史时刻的第二行驶状态信息,预测车辆未来位置。
2.根据权利要求1所述的方法,其特征在于,所述基于参照物与车辆的空间关系构建车辆的观测方程,包括:
根据参照物的位置信息,构建车辆与参照物距离的方程,以及车辆与参照物航向角的方程;
通过所述车辆的预期车速与实际车速的偏差,构建车速的观测值方程;
基于车辆与参照物距离的方程、车辆与参照物航向角的方程以及车速的观测值方程以及非高斯噪声,构建车辆的观测方程。
3.根据权利要求1所述的方法,其特征在于,所述通过观测方程和车辆的第一历史行驶状态信息进行粒子滤波,预测车辆的未来位置信息,包括:
构建车辆的第一运动学模型;所述第一运动学模型表征车辆质心的坐标、偏航角、期望车速、前轮角以及车辆轴距之间的关系;
通过所述运动学模型和车辆的第一历史行驶状态信息预测粒子的下一步行驶状态,得到每个粒子的行驶状态预测值;所述第一历史行驶状态信息包括车辆的位置和偏航角;
将每个粒子的行驶状态预测值输入到观测方程中,得到每个粒子的观测值;
获取车辆当前的观测值;所述观测值包括:当前车辆与周围物体的距离、当前车辆与周围物体的角度以及实际车速和预期车速的偏差;
通过车辆当前的观测值和粒子的预测值,计算粒子的权重;
基于粒子的权重对粒子进行筛选;
对于筛选后的粒子,返回执行通过所述运动学模型预测粒子的下一步状态,得到每个粒子的状态预测值。
4.根据权利要求1所述的方法,其特征在于,所述车辆周围不存在参照物的情况下,获取车辆在不同历史时刻的第二行驶状态信息,包括:
构建车辆的第二运动学模型;所述第二运动学模型表征车辆质心的坐标、偏航角和偏航角速度、车辆的轴距、车辆速度之间的关系;
通过所述第二运动学模型,获取车辆在不同历史时刻的第二行驶状态信息;所述不同历史时刻的行驶状态信息包括:车辆的纵向车速和偏航角速度。
5.根据权利要求所述的方法,其特征在于,所述通过马尔可夫模型和车辆在不同历史时刻的第二行驶状态信息,预测车辆未来位置,包括:
通过所述车辆在不同历史时刻的第二行驶状态信息,构建变阶、变预测步长的马尔可夫模型;
通过变阶变预测步长的马尔可夫模型构建转移概率,并且确定约束条件;
依据所述转移概率以及约束条件以及动态滑动窗口理论,构建动态转移概率;
根据动态转移概率确定预测方程;
根据所述预测方程预测车辆的未来位置。
6.一种无人车位置预测装置,其特征在于,包括:
获取单元,用于在车辆周围存在参照物的情况下,获取参照物的位置信息和车辆的第一历史行驶状态信息;
观测方程构建单元,用于基于参照物与车辆的空间关系构建车辆的观测方程;
第一未来位置预测单元,用于通过观测方程和车辆的第一历史行驶状态信息进行粒子滤波,预测车辆的未来位置信息;
第二未来位置预测单元,用于在车辆周围不存在参照物的情况下,获取车辆在不同历史时刻的第二行驶状态信息,并通过马尔可夫模型和车辆在不同历史时刻的第二行驶状态信息,预测车辆未来位置。
7.根据权利要求6所述的装置,其特征在于,所述观测方程构建单元,包括:
距离和航向角方程构建子单元,用于根据参照物的位置信息,构建车辆与参照物距离的方程,以及车辆与参照物航向角的方程;
车速观测值方程构建子单元,用于通过所述车辆的预期车速与实际车速的偏差,构建车速的观测值方程;
车辆观测方程构建子单元,用于基于车辆与参照物距离的方程、车辆与参照物航向角的方程以及车速的观测值方程以及非高斯噪声,构建车辆的观测方程。
8.根据权利要求6所述的装置,其特征在于,所述第一未来位置预测单元,包括:
第一运动学模型构建子单元,用于构建车辆的第一运动学模型;所述第一运动学模型表征车辆质心的坐标、偏航角和期望车速、前轮角以及车辆轴距之间的关系;
第一预测子单元,用于通过所述运动学模型和车辆的第一历史行驶状态预测粒子的下一步行驶状态,得到每个粒子的行驶状态预测值;
第二预测子单元,用于将每个粒子的行驶状态预测值输入到观测方程中,得到每个粒子的观测值;
第一获取子单元,用于获取车辆当前的观测值;所述观测值包括:当前车辆与周围物体的距离、当前车辆与周围物体的角度以及实际车速和预期车速的偏差;
粒子权重计算子单元,用于通过车辆当前的观测值和粒子的预测值,计算粒子的权重;
粒子筛选子单元,用于基于粒子的权重对粒子进行筛选;
迭代子单元,用于对于筛选后的粒子,返回执行通过所述运动学模型预测粒子的下一步状态,得到每个粒子的状态预测值。
9.根据权利要求6所述的装置,其特征在于,所述第二未来位置预测单元,包括:
第二运动学模型构建子单元,用于构建车辆的第二运动学模型;所述第二运动学模型表征车辆质心的坐标、偏航角和偏航角速度、车辆的轴距、车辆速度之间的关系;
第二获取子单元,用于通过所述第二运动学模型,获取车辆在不同历史时刻的第二行驶状态信息;所述不同历史时刻的行驶状态信息包括:车辆的纵向车速和偏航角速度。
10.根据权利要求6所述的装置,其特征在于,所述第二未来位置预测单元,包括:
马尔可夫模型构建子单元,用于通过所述车辆在不同历史时刻的第二行驶状态信息,构建变阶、变预测步长的马尔可夫模型;
转移概率构建子单元,用于通过变阶变预测步长的马尔可夫模型构建转移概率,并且确定约束条件;
动态转移概率构建子单元,用于依据所述转移概率以及约束条件以及动态滑动窗口理论,构建动态转移概率;
预测方程构建子单元,用于根据动态转移概率确定预测方程;
预测子单元,用于根据所述预测方程预测车辆的未来位置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110346692.5A CN113094967B (zh) | 2021-03-31 | 2021-03-31 | 一种无人车位置预测方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110346692.5A CN113094967B (zh) | 2021-03-31 | 2021-03-31 | 一种无人车位置预测方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113094967A true CN113094967A (zh) | 2021-07-09 |
CN113094967B CN113094967B (zh) | 2023-01-20 |
Family
ID=76671545
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110346692.5A Active CN113094967B (zh) | 2021-03-31 | 2021-03-31 | 一种无人车位置预测方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113094967B (zh) |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2019053377A (ja) * | 2017-09-13 | 2019-04-04 | 株式会社デンソーアイティーラボラトリ | 車両行動予測装置、車両行動予測方法および車両行動予測用のニューラルネットワークの学習方法 |
CN109767619A (zh) * | 2018-12-29 | 2019-05-17 | 江苏大学 | 一种智能网联纯电动汽车行驶工况预测方法 |
-
2021
- 2021-03-31 CN CN202110346692.5A patent/CN113094967B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2019053377A (ja) * | 2017-09-13 | 2019-04-04 | 株式会社デンソーアイティーラボラトリ | 車両行動予測装置、車両行動予測方法および車両行動予測用のニューラルネットワークの学習方法 |
CN109767619A (zh) * | 2018-12-29 | 2019-05-17 | 江苏大学 | 一种智能网联纯电动汽车行驶工况预测方法 |
Non-Patent Citations (2)
Title |
---|
半杯茶的小酒杯: "自动驾驶定位算法(十三)-粒子滤波(Particle Filter)", 《HTTPS://ZHUANLAN.ZHIHU.COM/P/100600881?UTM_SOURCE=WECHAT_SESSION》 * |
胡玉文 等: "应用于地面无人车辆的窗口约束马尔可夫定位", 《北京理工大学学报》 * |
Also Published As
Publication number | Publication date |
---|---|
CN113094967B (zh) | 2023-01-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11726477B2 (en) | Methods and systems for trajectory forecasting with recurrent neural networks using inertial behavioral rollout | |
JP7086111B2 (ja) | 自動運転車のlidar測位に用いられるディープラーニングに基づく特徴抽出方法 | |
CN110775052B (zh) | 一种基于视觉与超声波感知融合的自动泊车方法 | |
JP7060625B2 (ja) | 自動運転車において3dcnnネットワークを用いてソリューション推断を行うlidar測位 | |
CN112083726B (zh) | 一种面向园区自动驾驶的双滤波器融合定位系统 | |
JP2018037064A (ja) | 能動的探索なしの強化学習に基づくオンライン学習法及び車両制御方法 | |
CN111788571A (zh) | 车辆跟踪 | |
CN109885883A (zh) | 一种基于gk聚类算法模型预测的无人车横向运动的控制方法 | |
CN111142091A (zh) | 一种融合车载信息的自动驾驶系统激光雷达在线标定方法 | |
DE112018005907T5 (de) | Informationsverarbeitungsvorrichtung, informationsverarbeitungsverfahren, programm und beweglicher körper | |
CN113238251B (zh) | 一种基于车载激光雷达的目标级语义定位方法 | |
CN110736456B (zh) | 稀疏环境下基于特征提取的二维激光实时定位方法 | |
CN115993825A (zh) | 一种基于空地协同的无人车集群控制系统 | |
CN111707258B (zh) | 一种外部车辆监测方法、装置、设备及存储介质 | |
CN111452786B (zh) | 一种无人车辆避障方法及系统 | |
CN111257853B (zh) | 一种基于imu预积分的自动驾驶系统激光雷达在线标定方法 | |
CN115066632A (zh) | 利用模型几何学习跟踪移动对象的扩张状态的系统和方法 | |
CN114387462A (zh) | 一种基于双目相机的动态环境感知方法 | |
WO2022251766A1 (en) | Trajectory consistency measurement for autonomous vehicle operation | |
CN105590087A (zh) | 一种道路识别方法及装置 | |
CN112539747B (zh) | 一种基于惯性传感器和雷达的行人航位推算方法和系统 | |
CN113094967B (zh) | 一种无人车位置预测方法及装置 | |
CN117452946A (zh) | 一种基于数字孪生的智能汽车远程驾驶方法及系统 | |
CN115123217B (zh) | 矿区障碍车辆行使轨迹生成方法、装置及计算机设备 | |
CN114670870A (zh) | 障碍物slt空间风险场环境建模方法及其装置、相关产品 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |