CN107121980B - 一种基于虚拟约束的自动驾驶车辆路径规划方法 - Google Patents
一种基于虚拟约束的自动驾驶车辆路径规划方法 Download PDFInfo
- Publication number
- CN107121980B CN107121980B CN201710161509.8A CN201710161509A CN107121980B CN 107121980 B CN107121980 B CN 107121980B CN 201710161509 A CN201710161509 A CN 201710161509A CN 107121980 B CN107121980 B CN 107121980B
- Authority
- CN
- China
- Prior art keywords
- lane
- vehicle
- course
- road
- veh
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 33
- 238000001514 detection method Methods 0.000 claims abstract description 12
- 238000012937 correction Methods 0.000 claims description 14
- 230000008569 process Effects 0.000 claims description 10
- 239000011800 void material Substances 0.000 claims 1
- 238000002788 crimping Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 4
- 230000004888 barrier function Effects 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000004927 fusion Effects 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 230000008447 perception Effects 0.000 description 2
- 239000004576 sand Substances 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 235000013399 edible fruits Nutrition 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 230000008439 repair process Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000007619 statistical method Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000002123 temporal effect Effects 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
- G01C21/3446—Details of route searching algorithms, e.g. Dijkstra, A*, arc-flags, using precalculated routes
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明涉及一种基于虚拟约束的自动驾驶车辆路径规划方法,包括以下步骤:根据车道线检测结果获取车体坐标系下的车道中心线航向;利用卡尔曼滤波器和获取的车道中心线航向对车辆的航向进行修正;利用修正后的车辆航向对原始路径中的路径点进行校正;基于三维激光雷达栅格地图,获取自动驾驶车辆与道路的相对横向位置关系;生成虚拟约束;根据自动驾驶***的决策指令,生成期望路径。本发明融合GPS、视觉与激光雷达信息完成车辆与道路相对横向位置的精确定位,不需要高精度定位设备和高精度地图,有助于提高自动驾驶车辆在结构化的、有清晰车道线的城市或高速公路环境下的车道保持与换道能力,对于自动驾驶车辆的安全、稳定、平顺行驶具有重要意义。
Description
技术领域
本发明涉及自动驾驶技术领域,尤其涉及一种基于虚拟约束的自动驾驶车辆路径规划方法。
背景技术
路径规划是自动驾驶车辆的核心技术之一,其作用是保证车辆安全的完成对全局路径的跟踪。在城市道路环境或高速公路环境中,自动驾驶车辆不仅要平顺稳定的在车辆所在车道内行驶,还需要结合环境感知信息以及智能决策指令进行换道、并线等较为复杂的动作。在车道保持的工况下,为了保证车辆精确的跟随车道的中心线及保持横向稳定性,需要将车辆约束在其所在车道内;在换道工况下,需要保证车辆能够精确的换入到目标车道内,避免出现骑线、压线行驶的情况。为了达到上述目的,自动驾驶车辆的路径规划需要依赖车辆与道路相对横向位置的精确定位。有研究通过差分GPS和高精度地图相结合的方式来实现车辆与道路横向位置关系的精确定位,但是这种方式受限于差分GPS信号的作用范围,以及高精度地图的测绘。
现阶段,能够为自动驾驶车辆提供道路边沿、车道线等丰富的环境感知信息的三维激光雷达以及相机仍然是自动驾驶车辆上最重要的传感器。有必要利用现有传感器,设计一种融合环境感知信息与一般GPS定位信息的路径规划方法。
发明内容
鉴于上述的分析,本发明旨在提供一种基于虚拟约束的自动驾驶车 辆路径规划方法,用以解决现有技术受限于差分GPS信号的作用范围以及高精度地图的问题。
本发明的目的主要是通过以下技术方案实现的:
一种基于虚拟约束的自动驾驶车辆路径规划方法,包括以下步骤:
步骤S1:获取车体坐标系下的车道中心线航向;
步骤S2:利用步骤S1中获取的车道中心线航向对车辆航向进行修正;
步骤S3:利用步骤S2修正后的车辆航向对原始路径中的路径点进行校正;
步骤S4:基于三维激光雷达栅格地图,获取自动驾驶车辆与道路的相对横向位置关系;
步骤S5:根据步骤S4获取的自动驾驶车辆与道路的相对横向位置关系生成虚拟约束,所述虚拟约束包括所在车道的边界约束和邻车道边界约束;
步骤S6:根据步骤S5生成的虚拟约束和自动驾驶***的决策指令,生成期望路径。
所述步骤S1还包括以下步骤:
步骤S101:判断车道线检测结果是否有效,若有效,执行步骤S102;若无效,沿用上一周期车道线检测结果;
步骤S102:获取车体坐标系下的车道中心线航向。
所述步骤S102还包括以下步骤:
步骤S1021:计算车道中心线的位置
其中,车道线检测结果(x1,y1)、(x2,y2)、(x3,y3)与(x4,y4)为左右车道线在车体坐标系下的坐标点,(x1,y1)为车辆左前方近车点,(x2,y2)为左前方远车点,(x3,y3)为右前方近车点,(x4,y4)为右前方远车点;
(xc1,yc1)与(xc2,yc2)分别代表车道中心线的近车端与远车端;
步骤S1022:计算车道中心线的航向:
其中θLane代表车道中心线在车体坐标系下的航向。
所述步骤S2还包括以下步骤:
步骤S201:初始化卡尔曼滤波器;
步骤S202:根据车辆当前的转弯半径和速度预测本周期内的大地坐标系下车辆航向预测值:
其中,θveh-pred为大地坐标系下当前时刻车辆航向的预测值,θveh-correct-old为大地坐标系下上一周期车辆航向的修正值,v为车辆当前的速度,R为车辆当前的转弯半径,T为规划周期;
步骤S203:计算车体坐标系下原始路径航向与车道中心线航向的差值:
θerror=θroad-θLane
其中,θerror为车体坐标系下原始路径航向与车道中心线航向的差值, θroad为车体坐标系下原始路径的航向,θLane为车道中心线航向;
步骤S204:计算大地坐标系下车辆的航向测量值:
θveh-measure=θveh-gps+θerror,
其中θveh-measure为大地坐标系下车辆的航向测量值,θveh-gps为大地坐标系下车辆的GPS航向值;
步骤S205:将步骤S202中θveh-pred与步骤S204中θveh-measure作为卡尔曼滤波器的输入得到车辆在大地坐标系下的航向修正值θveh-correct;
步骤S206:将θveh-correct赋值给θveh-correct-old并进入到下一周期。
所述步骤S3还包括以下步骤:
步骤S301:计算大地坐标系下的车辆航向修正值与车辆GPS航向值的偏差:
Δθ=θveh-correct-θveh-gps;
其中,θveh-correct为车辆在大地坐标系下的航向修正值,θveh-gps为大地坐标系下车辆的GPS航向值;
步骤S302:利用步骤S301中结果计算得到校正后的路径点:
其中,[xcorrect ycorrect θcorrect]T是校正后的路径在车体坐标系下的坐标,[xveh-roadyveh-road θveh-road]T是校正前原始路径在车体坐标系下的坐标。
所述步骤S4还包括以下步骤:
步骤S401:统计激光雷达栅格地图中,每一列被占据的栅格的个数OGNi;
步骤S402:根据每一列被占据的栅格的个数OGNi,计算每一列栅格的统计标志量OGSi:
其中i是栅格地图中的列号,OGSi表示栅格地图中第i列栅格的统计标志量,Ot表示栅格地图的占据标志阈值;
步骤S403:根据道路模型宽度RW以及道路模型宽度偏差RWT生成卷积核:
其中Kj为第j列栅格对应的卷积核,RW为道路模型宽度,RWT为道路模型宽度偏差,Gs为被选中作为脉冲的栅格的列号,Gs的取值范围为[0,RWT];
步骤S404:将步骤S402中结果OGSi与步骤S403中结果Kj进行卷积
其中,MW为栅格地图中栅格的列数,卷积过程中如果re=1,那么对应栅格列的匹配值hit就加1;如果re=-1,那么对应栅格列的未匹配值miss就加1;如果re=0,那么对应栅格列的未知值uknow就加1;
步骤S405:根据步骤S404中结果得到某一列栅格为道路中心的概率GCi:
其中GCi代表第i列栅格为道路中心的概率;
步骤S406:找出GCi的最大值,其对应的i就是道路中心所在的栅格的列号;
Cr=i
其中Cr为道路中心所在的栅格列号;
步骤S407:计算左右路沿所在的栅格列号;
其中,Lr和Rr分别为左右路沿所在的栅格的列号;
步骤S408:计算车辆与道路的相对横向位置关系
其中Dl和Dr分别为车辆到左右路沿的距离。
所述步骤S401中,从栅格地图的正中间一列,即车辆所在的那一列,沿着与修正后的路径相垂直的方向开始向栅格地图的两边开始统计。
所述步骤S5还包括以下步骤:
步骤S501:计算车道总数Cz;
步骤S502:定位车辆所在的车道C;
车辆所在的车道序号:
其中C表示车辆所在车道的左数序号,LW为车道宽度;
步骤S503:根据所在车道中心线位置(xc1,yc1)与(xc2,yc2),计算车辆到所在车道中心线的距离Dc;
步骤S504:根据车辆到所在车道中心线的距离Dc和车道宽度LW分别计算车辆到左车道中心线的距离Dcl和车辆到右车道中心线的距离Dcr:
Dcl=LW-Dc
Dcr=LW+Dc
步骤S505:根据车辆距离各个车道中心线的距离生成虚拟约束,所述虚拟约束包括所在车道边界约束和邻车道边界约束。
当所在车道左右两边均有车道时,所述虚拟约束为左车道的左边约束Vll、所在车道的左边约束Vcl、所在车道的右边约束Vcr及右车道的右边约束Vrr;当只有左侧有车道时,所述虚伪约束为左车道的左边约束Vll、所在车道的左边约束Vcl及所在车道的右边约束Vcr;当只有右侧有车道时,所述虚拟约束为所在车道的左边约束Vcl、所在车道的右边约束Vcr及右车道的右边约束Vrr。
所述步骤S6还包括以下步骤:
步骤S601:判断决策指令是否换道,若是,则转入步骤S603;若否,则转入步骤S602;
步骤S602:将校正后的路径平移到所在车道的中心线处作为期望路 径进行跟踪,转入步骤S604;
步骤S603:将校正后的路径平移到目标车道的中心线处作为期望路径进行跟踪,转入步骤S604;
步骤S604:根据期望路径进行路径跟踪。
本发明有益效果如下:
本发明提出的基于虚拟约束的自动驾驶车辆路径规划方法,融合GPS、视觉与激光雷达信息完成车辆与道路相对横向位置的精确定位,而不需要高精度定位设备和高精度地图。在车道保持行驶时,能够有效保证车辆沿着所在车道的中心线行驶,保证了车辆自动行驶时的横向稳定性;在换道时,能够保证车辆准确的换到目标车道,避免自动驾驶过程中车辆骑线或压线行驶。本发明有助于提高自动驾驶车辆在结构化的、有清晰车道线的城市或高速公路环境下的车道保持与换道能力,对于自动驾驶车辆的安全、稳定、平顺行驶具有重要意义。
本发明的其他特征和优点将在随后的说明书中阐述,并且,部分的从说明书中变得显而易见,或者通过实施本发明而了解。本发明的目的和其他优点可通过在所写的说明书、权利要求书、以及附图中所特别指出的结构来实现和获得。
附图说明
附图仅用于示出具体实施例的目的,而并不认为是对本发明的限制,在整个附图中,相同的参考符号表示相同的部件。
图1为本发明中基于虚拟约束的自动驾驶车辆路径规划方法整体流程;
图2为本发明利用卡尔曼滤波原理对车辆的航向进行修正的流程图;
图3为本发明中基于激光雷达栅格地图获取车辆与道路相对横向位置关系的流程图;
图4为本发明中在激光雷达栅格地图上统计每一列被占据的栅格数目的示意图;
图5为本发明中在获取车辆与道路相对横向位置关系时卷积核的生成方式示意图;
图6为本发明中虚拟约束生成流程图;
图7为本发明中虚拟约束生成示意图;
图8为本发明中期望路径生成示意图。
附图标记:
401-车体坐标系、402-车辆、403-栅格地图正中间的一列栅格、404-校正后的路径、405-栅格地图的左右边界、406-统计方向;
501-道路模型宽度偏差RWT、502-被选中作为脉冲的栅格、503-道路模型宽度的边界、504-道路边界、507-生成的卷积核Kj;
702-虚拟约束、703-车道线;
805-车道中心线、807-左换道时的期望路径、808-车道保持时的期望路径、809-右换道时的期望路径。
具体实施方式
下面结合附图来具体描述本发明的优选实施例,其中,附图构成本申请一部分,并与本发明的实施例一起用于阐释本发明的原理。
根据本发明的一个优选实施例,提供了一种基于虚拟约束的自动驾驶车辆路径规划方法,如图1所示,包括以下步骤:
步骤S1:根据车道线检测结果获取车体坐标系下的车道中心线航向;
具体地,所述步骤S1还包括以下子步骤:
步骤S101:判断车道线检测结果是否有效,若有效,执行步骤S102;若无效,沿用上一周期车道线检测结果;
在本实施例中,自动驾驶车辆在结构化的有清晰车道线和道路边沿的环境下进行车道保持和换道,自动驾驶车辆的视觉传感器可以检测出车道线信息,但是考虑到十字路口处没有车道线的情况,所以要对车道线的检测结果是否有效进行判断。
步骤S102:获取车体坐标系下的车道中心线航向;
车道线检测结果(x1,y1)、(x2,y2)、(x3,y3)与(x4,y4)为左右车道线在车体坐标系下的坐标点,其中,(x1,y1)为车辆左前方近车点,(x2,y2)为左前方远车点,(x3,y3)为右前方近车点,(x4,y4)为右前方远车点,根据这四个点,求出车体坐标系下车道中心线的位置以及航向:
步骤S1021:计算车道中心线的位置
其中(xc1,yc1)与(xc2,yc2)分别代表车道中心线的近车端与远车端;
步骤S1022:计算车道中心线的航向
其中θLane代表车道中心线在车体坐标系下的航向。
步骤S2:利用卡尔曼滤波器和步骤S1中获取的车道中心线航向对车辆航向进行修正;
由于从车载GPS得到的车辆的航向具有时间上的滞后和空间上的偏差,所以直接将其用于把大地坐标系下的全局路径转换为车体坐标系下的局部路径时会导致较大的误差,从而使得车辆不能准确的跟踪实际路径;
车道中心线的航向具有相对稳定性,因此可以利用车道中心线的航向对车辆的航向进行修正,考虑到测量噪声的影响,修正后的车辆航向需要利用卡尔曼滤波器进行维护;
具体地,如图2所示,所述步骤S2包括如下步骤:
步骤S201:初始化卡尔曼滤波器;
步骤S202:根据车辆当前的转弯半径和速度预测本周期内的大地坐标系下车辆航向预测值θveh-pred;
其中θveh-pred为大地坐标系下当前时刻车辆航向的预测值,θveh-correct-old为大地坐标系下上一周期车辆航向的修正值,v为车辆当前的速度,R为车辆当前的转弯半径,T为规划周期。
步骤S203:计算车体坐标系下原始路径航向与车道中心线航向的差值:
路径航向和车道中心线航向都是车体坐标系下的航向,且车道中心线航向平行于路径的切线方向。由于车道中心线航向是根据车道线检测结果直接在车体坐标系下计算得到,而路径航向是以车辆的GPS坐标为基点经坐标转换得到,因此,只要求得车体坐标系下的路径航向与车道中心线航向就相当于求出了车辆的GPS航向与其真实航向的差值θerror:
θerror=θroad-θLane
其中,θerror为车体坐标系下原始路径航向与车道中心线航向的差值,θroad为车体坐标系下原始路径的航向,θLane为车道中心线航向;
步骤S204:计算大地坐标系下车辆的航向测量值:
θveh-measure=θveh-gps+θerror
其中θveh-measure为大地坐标系下车辆的航向测量值,θveh-gps为大地坐标系下车辆的GPS航向值;
步骤S205:将步骤S202中θveh-pred与步骤S204中θveh-measure作为卡尔曼滤波器的输入得到车辆在大地坐标系下的航向修正值θveh-correct;
步骤S206:将θveh-correct赋值给θveh-correct-old并进入到下一周期。
步骤S3:利用步骤S2修正后的车辆航向对原始路径中的路径点进行校正;
所述原始路径为车体坐标下的路径,原始路径的起点为车体坐标系原点;
由于车辆航向的不准确,车体坐标系下的原始路径也是存在误差的,因此需要根据修正后的车辆航向,对原始路径进行校正,校正后路径的航向与车辆所在车道的航向一致。
具体地,包括以下步骤:
步骤S301:计算大地坐标系下的车辆航向修正值与车辆GPS航向值的偏差:
Δθ=θveh-correct-θveh-gps
步骤S302:利用步骤S301中结果计算得到校正后的路径点:
其中[xcorrect ycorrect θcorrec]t T是校正后的路径在车体坐标系下的坐标,[xveh-roadyveh-road θveh-road]T是校正前原始路径在车体坐标系下的坐标。
步骤S4:基于三维激光雷达栅格地图,获取自动驾驶车辆与道路的相对横向位置关系;
所述三维激光雷达栅格地图为车体坐标系下的栅格地图,每个栅格对应一个表示该栅格是否被障碍物占据的值;
由于道路GPS点坐标误差的存在,仅仅依靠车辆的GPS定位、路点的GPS定位以及道路模型的宽度,是无法确定车辆在道路上的横向定位的,因此也无法确定车辆在哪个车道上。本发明中提出了基于激光雷达栅格地图,利用统计学方法求得道路中心在栅格地图中的位置,然后在利用车辆与栅格地图的相对关系以及道路模型宽度,可以得到车辆相对于道路中心、道路左边沿、道路右边沿的位置。
具体地,如图3所示,基于三维激光雷达栅格地图,获取自动驾驶车辆与道路的相对横向位置关系的过程包括以下步骤:
步骤S401:统计激光雷达栅格地图中,每一列被占据的栅格的个数OGNi;
优选地,如图4所示,从栅格地图的正中间一列(亦即车辆所在的那一列)沿着与修正后的路径相垂直的方向开始向栅格地图的两边开始统计。
步骤S402:根据每一列被占据的栅格的个数OGNi,计算每一列栅格的统计标志量OGSi:
其中i是栅格地图中的列号,OGSi表示栅格地图中第i列栅格的统计标志量,Ot表示栅格地图的占据标志阈值;
赋值统计结果标志量的原则为:如果第i列被占据的栅格个数大于Ot,那么这一列栅格的统计结果标志量赋值为1;如果第i列被占据的栅格个数不大于Ot,那么再考察第i-1列被占据的栅格的个数是否大于Ot,如果是,那么第i列栅格的统计结果标志量赋值为0,如果否,那么第i列栅格的统计结果标志量赋值为-1。
步骤S403:根据道路模型宽度RW以及道路模型宽度偏差RWT生成卷积核:
其中Kj为第j列栅格对应的卷积核,RW为道路模型宽度,RWT为道路模型宽度偏差,Gs为被选中作为脉冲的栅格的列号,Gs的取值范围为[0,RWT];
如图5所示,生成卷积核的规则如下所述:选定在[0,RWT]范围内的某一列栅格(假设列号为Gs)作为脉冲栅格,如果列号j小于Gs,那么对应的Kj赋值为0;如果列号j等于Gs,那么对应的Kj赋值为1;如果列号j大于Gs且小于RW-Gs,那么对应的Kj赋值为-1;如果列号等于RW-Gs,那么对应的Kj赋值为1;如果列号j大于RW-Gs且小于RW,那么对应的Kj赋值为0。其中,Gs要从0依次取到RWT。
步骤S404:将步骤S402中结果OGSi与步骤S403中结果Kj进行卷积
其中,MW为栅格地图中栅格的列数,卷积过程中如果re=1,那么对应栅格列的匹配值hit就加1;如果re=-1,那么对应栅格列的未匹配值miss就加1;如果re=0,那么对应栅格列的未知值uknow就加1。
步骤S405:根据步骤S404中结果得到某一列栅格为道路中心的概率GCi:
其中GCi代表第i列栅格为道路中心的概率;
由于OGSi和Kj的取值范围都是{-1,0,1},且j的卷积取值范围为[-RW/2,Gs],即Kj在卷积过程中不取-1,卷积过程中如果卷积结果re=1,那么对应栅格列的匹配值hit就加1;如果re=-1,那么对应栅格列的未匹配值miss就加1;如果re=0,那么对应栅格列的未知值uknow就加1。最后如果hit=2,那么对应的第i列栅格为道路中心的概率赋值为0.9;如果hit=1,miss=1或者hit=1,uknow=1,那么对应的第i列栅格为道路中心的概率赋值为0.5;如果miss=2或uknow=2或miss=1,uknow=1,那么对应的第i列栅格为道路中心的概率赋值为0.3。
步骤S406:找出GCi的最大值,其对应的i就是道路中心所在的栅格的列号;
Cr=i
其中Cr为道路中心所在的栅格列号。
步骤S407:计算左右路沿所在的栅格列号;
其中,Lr和Rr分别为左右路沿所在的栅格的列号。
步骤S408:计算车辆与道路的相对横向位置关系
其中Dl和Dr分别为车辆到左右路沿的距离。
步骤S5:根据步骤S4获取的自动驾驶车辆与道路的相对横向位置关系生成虚拟约束,所述虚拟约束包括所在车道的边界约束和邻车道边界约束;
由于本发明中将车辆的行为分为了车道保持与换道两种,在车道保持过程中,仅需考虑车辆所在车道的边界约束、避撞等问题;在换道过程中,只考虑所在车道与目标车道内的障碍物情况即可。因此,根据车辆与道路的相对定位关系、车道宽度以及道路宽度,虚拟出车辆当前所在车道的边界约束以及邻车道边界约束,从而四条虚拟约束可以确定三条车道,因此能够在车道保持时保证车辆横向运动的稳定性,在换道时保证准确的换到目标车道的中心线位置,避免骑线或压线行驶;
具体地,如图6所示,虚拟出所在车道的边界约束和邻车道边界约束的过程包括以下步骤:
步骤S501:计算车道总数Cz;
步骤S502:定位车辆所在的车道C;
车辆所在的车道序号:
其中C表示车辆所在车道的左数序号,LW为车道宽度。
步骤S503:根据所在车道中心线位置(xc1,yc1)与(xc2,yc2),计算车辆到所在车道中心线的距离Dc;
步骤S504:根据车辆到所在车道中心线的距离Dc和车道宽度LW分别计算车辆到左车道中心线的距离Dcl和车辆到右车道中心线的距离Dcr:
Dcl=LW-Dc
Dcr=LW+Dc
步骤S505:根据车辆距离各个车道中心线的距离生成虚拟约束,所述虚拟约束包括所在车道边界约束和邻车道边界约束;
具体地,当所在车道左右两边均有车道时,如图7(a)所示,所述虚拟约束为左车道的左边约束Vll、所在车道的左边约束Vcl、所在车道的右边约束Vcr及右车道的右边约束Vrr;当只有左侧有车道时,如图7(b)所示,所述虚伪约束为左车道的左边约束Vll、所在车道的左边约束Vcl及所在车道的右边约束Vcr;当只有右侧有车道时,如图7(b)所示,所述虚拟约束为所在车道的左边约束Vcl、所在车道的右边约束Vcr及右车道的右边约束Vrr;
靠近道路边界的虚拟约束与道路边界之间有一定的安全距离。
步骤S6:根据步骤S5生成的虚拟约束和自动驾驶***的决策指令,生成期望路径。
校正后的路径可以保证航向与车道线方向一致,但并不能保证该路 径位于当前所在车道的中心位置,因此经校正后的路径首先需要平移到当前所在车道的中心线位置,得到在进行车道保持时的期望路径,而在换道时,则将期望路径平移到目标车道的中心线位置;
图8为期望路径生成示意图;
具体地,包括以下步骤:
步骤S601:判断决策指令是否换道,若是,则转入步骤S603;若否,则转入步骤S602;
步骤S602:将校正后的路径平移到所在车道的中心线处作为期望路径进行跟踪,转入步骤S604;
步骤S603:将校正后的路径平移到目标车道的中心线处作为期望路径进行跟踪,转入步骤S604;
步骤S604:根据期望路径进行路径跟踪。
综上所述,本发明实施例提供了一种基于虚拟约束的自动驾驶车辆路径规划方法,融合GPS、视觉与激光雷达信息完成车辆与道路相对横向位置的精确定位,而不需要高精度定位设备和高精度地图。在车道保持行驶时,能够有效保证车辆沿着所在车道的中心线行驶,保证了车辆自动行驶时的横向稳定性;在换道时,能够保证车辆准确的换到目标车道,避免自动驾驶过程中车辆骑线或压线行驶。本发明有助于提高自动驾驶车辆在结构化的、有清晰车道线的城市或高速公路环境下的车道保持与换道能力,对于自动驾驶车辆的安全、稳定、平顺行驶具有重要意义。
本领域技术人员可以理解,实现上述实施例方法的全部或部分流程,可以通过计算机程序来指令相关的硬件来完成,所述的程序可存储于计算机可读存储介质中。其中,所述计算机可读存储介质为磁盘、光盘、 只读存储记忆体或随机存储记忆体等。
以上所述,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。
Claims (10)
1.一种基于虚拟约束的自动驾驶车辆路径规划方法,其特征在于,包括以下步骤:
步骤S1:获取车体坐标系下的车道中心线航向;
步骤S2:利用步骤S1中获取的车道中心线航向对车辆航向进行修正;
步骤S3:利用步骤S2修正后的车辆航向对原始路径中的路径点进行校正;
步骤S4:基于三维激光雷达栅格地图,获取自动驾驶车辆与道路的相对横向位置关系;
步骤S5:根据步骤S4获取的自动驾驶车辆与道路的相对横向位置关系生成虚拟约束,所述虚拟约束包括所在车道的边界约束和邻车道边界约束;
步骤S6:根据步骤S5生成的虚拟约束和自动驾驶***的决策指令,生成期望路径。
2.根据权利要求1所述的方法,其特征在于,所述步骤S1包括以下步骤:
步骤S101:判断车道线检测结果是否有效,若有效,执行步骤S102;若无效,沿用上一周期车道线检测结果;
步骤S102:获取车体坐标系下的车道中心线航向。
3.根据权利要求2所述的方法,所述步骤S102包括以下步骤:
步骤S1021:计算车道中心线的位置
其中,车道线检测结果(x1,y1)、(x2,y2)、(x3,y3)与(x4,y4)为左右车道线在车体坐标系下的坐标点,(x1,y1)为车辆左前方近车点,(x2,y2)为左前方远车点,(x3,y3)为右前方近车点,(x4,y4)为右前方远车点;
(xc1,yc1)与(xc2,yc2)分别代表车道中心线的近车端与远车端;
步骤S1022:计算车道中心线的航向:
其中θLane代表车道中心线在车体坐标系下的航向。
4.根据权利要求2或3所述的方法,其特征在于,步骤S2采用卡尔曼滤波器对车辆航向进行修正,包括以下步骤:
步骤S201:初始化卡尔曼滤波器;
步骤S202:根据车辆当前的转弯半径和速度预测本周期内的大地坐标系下车辆航向预测值:
其中,θveh-pred为大地坐标系下当前时刻车辆航向的预测值,θveh-correct-old为大地坐标系下上一周期车辆航向的修正值,v为车辆当前的速度,R为车辆当前的转弯半径,T为规划周期;
步骤S203:计算车体坐标系下原始路径航向与车道中心线航向的差值:
θerror=θroad-θLane
其中,θerror为车体坐标系下原始路径航向与车道中心线航向的差值,θroad为车体坐标系下原始路径的航向,θLane为车道中心线航向;
步骤S204:计算大地坐标系下车辆的航向测量值:
θveh-measure=θveh-gps+θerror,
其中θveh-measure为大地坐标系下车辆的航向测量值,θveh-gps为大地坐标系下车辆的GPS航向值;
步骤S205:将步骤S202中θveh-pred与步骤S204中θveh-measure作为卡尔曼滤波器的输入得到车辆在大地坐标系下的航向修正值θveh-correct;
步骤S206:将θveh-correct赋值给θveh-correct-old并进入到下一周期。
5.根据权利要求1所述的方法,其特征在于,所述步骤S3包括以下步骤:
步骤S301:计算大地坐标系下的车辆航向修正值与车辆GPS航向值的偏差:
Δθ=θveh-correct-θveh-gps;
其中,θveh-correct为车辆在大地坐标系下的航向修正值,θveh-gps为大地坐标系下车辆的GPS航向值;
步骤S302:利用步骤S301中结果计算得到校正后的路径点:
其中,[xcorrect ycorrect θcorrect]T是校正后的路径在车体坐标系下的坐标,[xveh-roadyveh-road θveh-road]T是校正前原始路径在车体坐标系下的坐标。
6.根据权利要求1所述的方法,其特征在于,所述步骤S4包括以下步骤:
步骤S401:统计激光雷达栅格地图中,每一列被占据的栅格的个数OGNi;
步骤S402:根据每一列被占据的栅格的个数OGNi,计算每一列栅格的统计标志量OGSi:
其中i是栅格地图中的列号,OGSi表示栅格地图中第i列栅格的统计标志量,Ot表示栅格地图的占据标志阈值;
步骤S403:根据道路模型宽度RW以及道路模型宽度偏差RWT生成卷积核:
其中Kj为第j列栅格对应的卷积核,RW为道路模型宽度,RWT为道路模型宽度偏差,Gs为被选中作为脉冲的栅格的列号,Gs的取值范围为[0,RWT];
步骤S404:将步骤S402中结果OGSi与步骤S403中结果Kj进行卷积
其中,MW为栅格地图中栅格的列数,卷积过程中如果re=1,那么对应栅格列的匹配值hit就加1;如果re=-1,那么对应栅格列的未匹配值miss就加1;如果re=0,那么对应栅格列的未知值uknow就加1;
步骤S405:根据步骤S404中结果得到某一列栅格为道路中心的概率GCi:
其中GCi代表第i列栅格为道路中心的概率;
步骤S406:找出GCi的最大值,其对应的i就是道路中心所在的栅格的列号;
Cr=i
其中Cr为道路中心所在的栅格列号;
步骤S407:计算左右路沿所在的栅格列号;
其中,Lr和Rr分别为左右路沿所在的栅格的列号;
步骤S408:计算车辆与道路的相对横向位置关系
其中Dl和Dr分别为车辆到左右路沿的距离。
7.根据权利要求6所述的方法,其特征在于,所述步骤S401中,从栅格地图的正中间一列,即车辆所在的那一列,沿着与修正后的路径相垂直的方向开始向栅格地图的两边开始统计。
8.根据权利要求6或7所述的方法,其特征在于,所述步骤S5包括以下步骤:
步骤S501:计算车道总数Cz;
步骤S502:定位车辆所在的车道C;
车辆所在的车道序号:
其中C表示车辆所在车道的左数序号,LW为车道宽度;
步骤S503:根据所在车道中心线位置(xc1,yc1)与(xc2,yc2),计算车辆到所在车道中心线的距离Dc;
步骤S504:根据车辆到所在车道中心线的距离Dc和车道宽度LW分别计算车辆到左车道中心线的距离Dcl和车辆到右车道中心线的距离Dcr:
Dcl=LW-Dc
Dcr=LW+Dc
步骤S505:根据车辆距离各个车道中心线的距离生成虚拟约束,所述虚拟约束包括所在车道边界约束和邻车道边界约束。
9.根据权利要求8所述的方法,其特征在于,当所在车道左右两边均有车道时,所述虚拟约束为左车道的左边约束Vll、所在车道的左边约束Vcl、所在车道的右边约束Vcr及右车道的右边约束Vrr;当只有左侧有车道时,所述虚拟约束为左车道的左边约束Vll、所在车道的左边约束Vcl及所在车道的右边约束Vcr;当只有右侧有车道时,所述虚拟约束为所在车道的左边约束Vcl、所在车道的右边约束Vcr及右车道的右边约束Vrr。
10.根据权利要求1所述的方法,其特征在于,所述步骤S6包括以下步骤:
步骤S601:判断决策指令是否换道,若是,则转入步骤S603;若否,则转入步骤S602;
步骤S602:将校正后的路径平移到所在车道的中心线处作为期望路径进行跟踪,转入步骤S604;
步骤S603:将校正后的路径平移到目标车道的中心线处作为期望路径进行跟踪,转入步骤S604;
步骤S604:根据期望路径进行路径跟踪。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710161509.8A CN107121980B (zh) | 2017-03-17 | 2017-03-17 | 一种基于虚拟约束的自动驾驶车辆路径规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710161509.8A CN107121980B (zh) | 2017-03-17 | 2017-03-17 | 一种基于虚拟约束的自动驾驶车辆路径规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107121980A CN107121980A (zh) | 2017-09-01 |
CN107121980B true CN107121980B (zh) | 2019-07-09 |
Family
ID=59718201
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710161509.8A Active CN107121980B (zh) | 2017-03-17 | 2017-03-17 | 一种基于虚拟约束的自动驾驶车辆路径规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107121980B (zh) |
Families Citing this family (39)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109520498B (zh) * | 2017-09-18 | 2022-08-19 | 中车株洲电力机车研究所有限公司 | 一种用于虚拟轨道车辆的虚拟道岔***及方法 |
CN107764273B (zh) * | 2017-10-16 | 2020-01-21 | 北京耘华科技有限公司 | 一种车辆导航定位方法及*** |
JP6928722B2 (ja) * | 2017-10-24 | 2021-09-01 | ニッサン ノース アメリカ,インク | 車両動作のための位置特定の決定 |
CN108088456B (zh) * | 2017-12-21 | 2021-07-16 | 北京工业大学 | 一种具有时间一致性的无人驾驶车辆局部路径规划方法 |
CN109017780B (zh) * | 2018-04-12 | 2020-05-05 | 深圳市布谷鸟科技有限公司 | 一种车辆智能驾驶控制方法 |
CN108562913B (zh) * | 2018-04-19 | 2021-12-17 | 武汉大学 | 一种基于三维激光雷达的无人艇假目标检测方法 |
CN108445886B (zh) * | 2018-04-25 | 2021-09-21 | 北京联合大学 | 一种基于高斯方程的自动驾驶车辆换道规划方法及*** |
CN110766961B (zh) * | 2018-07-27 | 2022-03-18 | 比亚迪股份有限公司 | 寻车方法、装置和*** |
CN109062213B (zh) * | 2018-08-16 | 2021-03-05 | 郑州轻工业学院 | 一种基于修正比例导引的智能车自动驾驶的方法 |
US10761535B2 (en) * | 2018-08-21 | 2020-09-01 | GM Global Technology Operations LLC | Intelligent vehicle navigation systems, methods, and control logic for multi-lane separation and trajectory extraction of roadway segments |
CN109540157B (zh) * | 2018-11-12 | 2021-02-02 | 广东星舆科技有限公司 | 一种车载导航***及控制方法 |
CN109960261B (zh) * | 2019-03-22 | 2020-07-03 | 北京理工大学 | 一种基于碰撞检测的动态障碍物避让方法 |
CN109974739B (zh) * | 2019-04-15 | 2020-11-10 | 西安交通大学 | 基于高精度地图的全局导航***及导航信息生成方法 |
US11105642B2 (en) | 2019-04-17 | 2021-08-31 | Waymo Llc | Stranding and scoping analysis for autonomous vehicle services |
CN110244721B (zh) * | 2019-06-05 | 2022-04-12 | 杭州飞步科技有限公司 | 自动驾驶控制方法、装置、设备及存储介质 |
US10915766B2 (en) * | 2019-06-28 | 2021-02-09 | Baidu Usa Llc | Method for detecting closest in-path object (CIPO) for autonomous driving |
CN110515942B (zh) * | 2019-07-12 | 2023-08-04 | 同济大学 | 一种序列化车道线地图的存储及检索方法 |
CN110361028B (zh) * | 2019-07-26 | 2021-03-16 | 武汉中海庭数据技术有限公司 | 一种基于自动驾驶循迹的路径规划结果生成方法及*** |
CN110550029B (zh) * | 2019-08-12 | 2021-02-09 | 华为技术有限公司 | 障碍物避让方法及装置 |
CN112486156B (zh) * | 2019-09-10 | 2023-09-19 | 中车株洲电力机车研究所有限公司 | 一种车辆自动循迹控制***及控制方法 |
CN112577503B (zh) * | 2019-09-30 | 2024-04-09 | 北京百度网讯科技有限公司 | 车辆起点区域的路径规划方法、装置、设备 |
CN111310597B (zh) * | 2020-01-20 | 2023-07-25 | 北京百度网讯科技有限公司 | 车辆位姿矫正方法、装置、设备及存储介质 |
US12010583B2 (en) | 2020-02-06 | 2024-06-11 | Huawei Technologies Co., Ltd. | Method, apparatus and system for mobile device location determination |
US11683660B2 (en) | 2020-02-06 | 2023-06-20 | Huawei Technologies Co., Ltd. | Method, apparatus and system for determining a location of a mobile device |
US20210256842A1 (en) * | 2020-02-14 | 2021-08-19 | Huawei Technologies Co., Ltd. | System, method and apparatus supporting navigation |
CN113494915A (zh) * | 2020-04-02 | 2021-10-12 | 广州汽车集团股份有限公司 | 一种车辆横向定位方法、装置及*** |
CN111561944B (zh) * | 2020-04-07 | 2022-04-19 | 中铁工程机械研究设计院有限公司 | 一种运梁车运行路径规划方法及自动驾驶运行控制方法 |
CN111559373B (zh) * | 2020-04-26 | 2021-08-13 | 东风汽车集团有限公司 | 一种车辆主动转向控制方法 |
CN112753038B (zh) * | 2020-06-16 | 2022-04-12 | 华为技术有限公司 | 识别车辆变道趋势的方法和装置 |
US11756312B2 (en) * | 2020-09-17 | 2023-09-12 | GM Global Technology Operations LLC | Orientation-agnostic lane tracking in a vehicle |
CN114550474B (zh) * | 2020-11-24 | 2023-03-03 | 华为技术有限公司 | 一种横向规划约束确定方法及装置 |
CN112612269B (zh) * | 2020-12-14 | 2021-11-12 | 北京理工大学 | 针对麦克纳姆轮小车的隐蔽攻击策略获取方法 |
WO2022213373A1 (zh) * | 2021-04-09 | 2022-10-13 | 华为技术有限公司 | 一种轨迹规划方法以及相关设备 |
CN113320547B (zh) * | 2021-07-15 | 2023-08-25 | 广州小鹏自动驾驶科技有限公司 | 路径检测方法、装置及汽车 |
CN113865597A (zh) * | 2021-10-13 | 2021-12-31 | 智道网联科技(北京)有限公司 | 地图匹配定位方法、装置及存储介质 |
CN114200945B (zh) * | 2021-12-13 | 2024-04-02 | 长三角哈特机器人产业技术研究院 | 一种移动机器人的安全控制方法 |
CN114275039B (zh) * | 2021-12-27 | 2022-11-04 | 联创汽车电子有限公司 | 智能驾驶车辆横向控制方法和模块 |
CN114114369B (zh) * | 2022-01-27 | 2022-07-15 | 智道网联科技(北京)有限公司 | 自动驾驶车辆定位方法和装置、电子设备和存储介质 |
CN116279596B (zh) * | 2023-05-26 | 2023-08-04 | 禾多科技(北京)有限公司 | 车辆控制方法、装置、电子设备和计算机可读介质 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1512138A (zh) * | 2002-12-30 | 2004-07-14 | 厦门雅迅网络股份有限公司 | 一种基于gps和gprs实现车辆网络导航的方法 |
CN102591332A (zh) * | 2011-01-13 | 2012-07-18 | 同济大学 | 用于无人驾驶汽车局部路径规划的装置及方法 |
CN102680990A (zh) * | 2012-06-01 | 2012-09-19 | 交通运输部公路科学研究所 | 一种基于gps的汽车列车位置轨迹测量***及方法 |
CN104002747A (zh) * | 2014-06-10 | 2014-08-27 | 北京联合大学 | 一种基于无人驾驶汽车的多激光雷达栅格地图融合*** |
CN105206108A (zh) * | 2015-08-06 | 2015-12-30 | 同济大学 | 一种基于电子地图的车辆碰撞预警方法 |
CN105404844A (zh) * | 2014-09-12 | 2016-03-16 | 广州汽车集团股份有限公司 | 一种基于多线激光雷达的道路边界检测方法 |
CN105711588A (zh) * | 2016-01-20 | 2016-06-29 | 奇瑞汽车股份有限公司 | 一种车道保持辅助***和车道保持辅助方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2011107759A (ja) * | 2009-11-12 | 2011-06-02 | Jfe Steel Corp | 部材の弾塑性変形解析方法 |
-
2017
- 2017-03-17 CN CN201710161509.8A patent/CN107121980B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1512138A (zh) * | 2002-12-30 | 2004-07-14 | 厦门雅迅网络股份有限公司 | 一种基于gps和gprs实现车辆网络导航的方法 |
CN102591332A (zh) * | 2011-01-13 | 2012-07-18 | 同济大学 | 用于无人驾驶汽车局部路径规划的装置及方法 |
CN102680990A (zh) * | 2012-06-01 | 2012-09-19 | 交通运输部公路科学研究所 | 一种基于gps的汽车列车位置轨迹测量***及方法 |
CN104002747A (zh) * | 2014-06-10 | 2014-08-27 | 北京联合大学 | 一种基于无人驾驶汽车的多激光雷达栅格地图融合*** |
CN105404844A (zh) * | 2014-09-12 | 2016-03-16 | 广州汽车集团股份有限公司 | 一种基于多线激光雷达的道路边界检测方法 |
CN105206108A (zh) * | 2015-08-06 | 2015-12-30 | 同济大学 | 一种基于电子地图的车辆碰撞预警方法 |
CN105711588A (zh) * | 2016-01-20 | 2016-06-29 | 奇瑞汽车股份有限公司 | 一种车道保持辅助***和车道保持辅助方法 |
Non-Patent Citations (1)
Title |
---|
《基于GPS/DR紧组合车载导航***研究及实现》;黄攀;《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》;20140415;全文 |
Also Published As
Publication number | Publication date |
---|---|
CN107121980A (zh) | 2017-09-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107121980B (zh) | 一种基于虚拟约束的自动驾驶车辆路径规划方法 | |
EP3699048B1 (en) | Travelling track prediction method and device for vehicle | |
CN109416256B (zh) | 行驶车道推定*** | |
CN106598055B (zh) | 一种智能车局部路径规划方法及其装置、车辆 | |
Clanton et al. | A low-cost solution for an integrated multisensor lane departure warning system | |
US20170343374A1 (en) | Vehicle navigation method and apparatus | |
JP4560739B2 (ja) | 自車位置認識装置及び自車位置認識プログラム | |
CN106918342A (zh) | 无人驾驶车辆行驶路径定位方法及定位*** | |
CN101819042B (zh) | 导航装置及导航方法 | |
CN105509738B (zh) | 基于惯导/多普勒雷达组合的车载定位定向方法 | |
CN104428686B (zh) | 用于获得车辆位置的方法和车辆 | |
CN102047076B (zh) | 用于计算环境表征与环境之间的一致性的方法以及装置 | |
JP6161942B2 (ja) | カーブ形状モデル化装置、車両情報処理システム、カーブ形状モデル化方法、及びカーブ形状モデル化プログラム | |
CN105936276A (zh) | 行驶控制装置 | |
CN106291736A (zh) | 无人驾驶汽车车道动态障碍物检测方法 | |
CN114526745B (zh) | 一种紧耦合激光雷达和惯性里程计的建图方法及*** | |
CN107664993A (zh) | 一种路径规划方法 | |
JP2021516403A (ja) | ロボットの再測位方法 | |
CN102649430A (zh) | 用于容错车辆侧向控制器的冗余车道感测*** | |
CN109491369B (zh) | 车辆实际控制单元的性能评估方法、装置、设备和介质 | |
CN107664504A (zh) | 一种路径规划装置 | |
CN108828645A (zh) | 一种导航定位方法、***、设备及计算机可读存储介质 | |
CN110189547A (zh) | 一种障碍物检测方法、装置及车辆 | |
JP2022546833A (ja) | 地図キャリブレーション誤り検出方法及び装置 | |
CN110517531A (zh) | 一种基于高精度地图数据的多层停车场定位方法 |
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 |