CN109131318A - 一种基于拓扑地图的自主泊车路径协调方法 - Google Patents
一种基于拓扑地图的自主泊车路径协调方法 Download PDFInfo
- Publication number
- CN109131318A CN109131318A CN201811219163.3A CN201811219163A CN109131318A CN 109131318 A CN109131318 A CN 109131318A CN 201811219163 A CN201811219163 A CN 201811219163A CN 109131318 A CN109131318 A CN 109131318A
- Authority
- CN
- China
- Prior art keywords
- parking
- node
- path
- parking stall
- road
- 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
- 238000013459 approach Methods 0.000 title claims abstract description 13
- 239000011159 matrix material Substances 0.000 claims abstract description 37
- 238000000034 method Methods 0.000 claims abstract description 15
- 230000004927 fusion Effects 0.000 claims abstract description 5
- 238000013461 design Methods 0.000 claims description 17
- 238000005457 optimization Methods 0.000 claims description 14
- 230000009466 transformation Effects 0.000 claims description 6
- 238000005267 amalgamation Methods 0.000 claims description 4
- 238000009499 grossing Methods 0.000 claims description 3
- 230000007704 transition Effects 0.000 claims description 3
- 238000006073 displacement reaction Methods 0.000 claims description 2
- 238000012545 processing Methods 0.000 claims description 2
- 241000208340 Araliaceae Species 0.000 claims 1
- 235000005035 Panax pseudoginseng ssp. pseudoginseng Nutrition 0.000 claims 1
- 235000003140 Panax quinquefolius Nutrition 0.000 claims 1
- 235000008434 ginseng Nutrition 0.000 claims 1
- 238000004891 communication Methods 0.000 description 4
- 230000006872 improvement Effects 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000001186 cumulative effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 235000013399 edible fruits Nutrition 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 239000000284 extract Substances 0.000 description 1
- 238000000605 extraction Methods 0.000 description 1
- 230000010365 information processing Effects 0.000 description 1
- 239000000203 mixture Substances 0.000 description 1
- 238000012805 post-processing Methods 0.000 description 1
- 238000003672 processing method Methods 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/06—Automatic manoeuvring for parking
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/14—Traffic control systems for road vehicles indicating individual free spaces in parking areas
- G08G1/145—Traffic control systems for road vehicles indicating individual free spaces in parking areas where the indication depends on the parking areas
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明公开一种基于拓扑地图的自主泊车路径协调方法,是基于V2X通信,自主泊车控制器通过停车场服务器提供的停车场拓扑地图、目标空置车位和动态道路通行矩阵,规划行车的全局路径和泊车路径,然后通过融合协调,形成平滑完整的自主泊车路径。本发明方法实现了在车辆运行前就规划出从停车场入口到车位的自主泊车路径,实现全局路径与泊车路径的无偏差融合,使低速自动驾驶与自动泊车能够平滑过渡,解决了低速自动驾驶与自动泊车的高效切换问题。
Description
技术领域
本发明涉及智能网联汽车技术领域,具体涉及一种基于拓扑地图的停车场自主泊车路径协调方法。
背景技术
随着汽车智能化的发展,自动泊车辅助***(Automated Parking Assist,APA)已在实际生活中帮助人们提高了泊车的效率与安全性。然而传统的自动泊车需要驾驶员在停车场中寻找车位,然后将车辆准确地停在泊车位置,泊车整个过程仍需要驾驶员介入,未能减轻该工况下的驾驶负担,因而研发更高智能化程度的自主泊车***,或称为自动代客泊车(Automated Valet Parking,AVP),使汽车能够自主的从停车场入口落客区完成整个低速自动驾驶与自主泊车任务,将人们彻底从泊车工况中解放出来,是弥补APA现有功能缺陷的有效途径。
然而自主泊车的研究尚存在诸多问题与局限性。在自动驾驶的技术背景下,将低速自动驾驶与传统的自动泊车技术相结合是实现自主泊车的有效途径。但采用高精度地图的传统自动驾驶方案不仅计算代价高,硬件成本高,也难以与现有泊车方法结合,并不适用当前APA***升级的平滑过渡,也无法针对性地实现自主泊车功能。而低速自动驾驶与自动泊车的高效切换,即如何解决车辆停车位置、切换时机以及车辆到达车位后的再确认,是自主泊车的关键问题。
发明内容
基于现有技术的不足,本发明的目的在于提出一种基于拓扑地图的自主泊车路径协调方法,着力于解决车辆从停车场落客区到停车位之间的全局路径与泊车路径的融合问题,进而确定低速自动驾驶与泊车切换时的停车位置、切换时机,同时避免了车辆到达车位之后再确认泊车。主要涉及基于激光雷达点云数据的停车场拓扑地图构建和基于拓扑地图的自主泊车路径的协调方法。
本发明解决以上技术问题所采取的技术方案如下:一种基于拓扑地图的自主泊车路径协调方法,该方法用于融合全局路径与泊车路径,确定低速自动驾驶与泊车***切换时的车辆停车位置与切换时机。具体如下:
基于V2X通信,自主泊车控制器根据停车场服务器提供的停车场拓扑地图、目标空置车位和动态道路通行矩阵,规划行车的全局路径和泊车路径,然后通过融合协调,形成平滑完整的自主泊车路径。
包含如下步骤:
(1)在停车场端,布置停车场服务器,所述服务器中存储有停车场拓扑地图,同时具有根据停车场监控实时更新动态道路通行矩阵和空余车位编号,为车辆分配目标空置车位的能力,所述地图中包含有道路主节点、停车位对应道路节点、各节点构建的邻接矩阵、车位信息;在车辆端,布置自主泊车控制器,所述控制器基于V2X通信从停车场服务器下载停车场拓扑地图,并接收目标空置车位信息和当前动态道路通行矩阵;
(2)所述自主泊车控制器根据车辆当前位置及停车场服务器提供的信息,基于停车场拓扑地图,规划车辆在道路上可通行的全局路径,然后根据全局路径末点的行车方向与停车位之间的方位关系确定泊车方向,再根据停车位泊车类型、全局路径末点距离车位的横向距离、停车位顶点坐标信息和车辆的外形参数规划泊车路径;
(3)经过全局路径与泊车路径的拼接、节点优化、平滑处理、路径拟合,得到无偏差融合且平滑过渡的自主泊车路径。
其中,停车场拓扑地图构建的方法是,基于激光雷达点云数据:
1)在激光雷达采集前的预定义坐标系下,从激光雷达采集的点云数据中提取停车位顶点坐标、车道线节点坐标,停车位顶点指车位的四个角点,车道线节点指各路段车道线的端点;
2)根据预定义坐标系的平面中心原点与平面法向量,将步骤1)提取的坐标经过投影变换、四元数变换后变为平面直角坐标系下的坐标;
3)选取停车场内某一点作为坐标系原点,建立停车场坐标系,然后将2)中的坐标转至停车场坐标系下;
4)设计停车位顶点、道路主节点和停车位对应道路节点:
(a)每个停车位的四个角点都作为停车位顶点;
(b)道路主节点:选取同向车道中心线之间的交点作为道路主节点,且主节点之间连线与对应道路侧的车位线平行;
(c)停车位对应道路节点:在预设的车位坐标系基础上确定:即在车位中心面向道路方向时,以车位左后顶点为车位坐标系原点,左后顶点到右后顶点的方向为车位坐标系x轴正方向,左后顶点到左前顶点的方向为y轴正方向;然后,过车位中心且平行于y轴的直线与所面向道路的两个道路主节点连线的交点作为该车位对应的道路节点;
5)构建邻接矩阵:对步骤(4)设计的道路主节点和停车位对应道路节点统一编号,对于任意两节点i,j,根据从节点i到节点j的直接连接情况,确定矩阵中的元素ai,j为0还是1,可通行设置为1,不可通行为0,最终根据节点总数N构建出N*N的邻接矩阵Ar+p;
6)对地图信息统一描述,包括道路拓扑信息和车位信息:
(a)道路拓扑信息Map包括由道路主节点信息Noder和车位对应道路节点信息Nodep构成的所有节点信息Noder+p,以及由邻接矩阵构成的节点连接状态信息:
Map=G(Noder+p,Ar+p)
式中,Noder和Nodep中各节点坐标由停车场坐标系横、纵坐标表示,Nr为道路主节点个数,Np为停车位个数也即车位对应道路节点个数;Ar+p由描述节点之间连接关系的元素ai,j、aj,i构成,ai,j、ai,j∈{0,1};
(b)车位信息表述如下:
Pp,i={np,i,Tp,i,Wi,Li,Di,hi,Ppv,i}
其中,停车场所有车位的车位顶点信息如下:
Np为停车位个数,每个车位四个顶点Vlr,Vrr,Vrf,Vlf分别表示车位左后、右后、右前、左前顶点;
np,i代表第i个车位的车位编号,Tp,i代表第i个车位的车位类型,Wi,Li分别代表第i个车位的宽和长,Di表示第i个车位前方的通车道路宽,hi表示第i个车位泊车起点的横向位移参数;Ppv,i代表第i个车位的四个顶点的坐标;
并构建车位编号与停车位对应道路节点之间的对应关系如下:
P2R={np,i,Nodep,i,DPi,LPi}
Nodep,i代表第i个车位对应的停车位对应道路节点;DPi代表第i个车位所允许的泊车方向;LPi代表第i个车位直线泊车需要添加的节点编号。
其中,基于停车场道路节点设计原则与自主泊车路径规划原则,融合全局路径与泊车路径:
1)基于停车场道路节点设计原则,根据车位信息中的泊车类型,以全局路径Pathglobal末点的方向判断泊车方向,距离车位的横向距离作为泊车规划的初始条件,进而规划出泊车路径Pathparking:
Drtdriving,i∈{-1,0,1}
式中,(xgp,i,ygp,i)为路径第i个节点的坐标,Ngp为路径节点数,Pathparking,i为第i段泊车路径,(xppi,j,yppi,j)为第i段路径第k个节点的坐标,Nppi为第i段路径的节点数,Drtdriving,i为第i段路径允许车辆的行驶方向,定义1为前进,-1为倒车,0表示路径不存在;
2)将全局路径末点替换为泊车起始点,若泊车路径存在前行部分,在节点替换后将全局路径与泊车路径拼接共同作为前进段路径Pathforward,倒车部分作为倒车段路径Pathbackward,表述如下:
Pathforward包括两段路径,若泊车规划不存在车辆前进部分,Pathforward仅取式中第一部分;
3)对拼接后的路径进行节点优化,根据各节点的方向信息判断相关联的节点是否在同一道路直线上,如果在同一条直线上,仅保留首末节点,中间点剔除,节点优化后的结果如下:
式中,角标f/b表示前进段或倒车段路径,(xf,i,yf,i)、(xb,i,yb,i)、ψf,i、ψb,i、Nf、Nb分别表示节点优化后的坐标,对应坐标的航向角和行车路径节点编号;
4)对节点优化后的前进段路径进行平滑处理,对倒车段路径拟合,获得曲率由0~ρmax~0连续变化的可驾驶路径,ρmax为最大曲率。
与现有技术相比,本发明显著的有益效果体现在:
1.提出了基于停车场拓扑地图的自主泊车路径设计及协调方法,该方法基于停车场道路节点设计原则和自主泊车路径规划原则,能够在车辆运行前规划出从停车场入口到进入车位的自主泊车路径,实现全局路径与泊车路径的无偏差融合,进而确定出理想的车辆停车位置与切换时机,使低速自动驾驶与自动泊车能够平滑过渡,从路径规划的角度解决了低速自动驾驶与自动泊车的高效切换问题。
2.提出了基于激光雷达点云数据的停车场拓扑地图构建方法,合理利用了现有的激光雷达数据,所建地图数据结构简洁,在地图中设计车位信息,能够避免车辆到达车位后再确认车位,提高了自主泊车效率,该方法可推广至无GPS信号的停车场地图构建。
3.提出了基于动态道路通行矩阵和改进A*算法的全局路径规划方法,该方法将停车场拓扑地图中各连接节点之间实际道路的可通行能力,反映在动态道路通行矩阵中,该矩阵与改进A*算法中目标函数相结合,可在车辆路径规划阶段考虑当前时刻停车场中的各路段通行能力,规划更加合理的行车路径。
本发明的其他特征和优点将在随后的说明书中阐述,并且部分的从说明书中变得显而易见,或者通过实施本发明而了解。
附图说明
附图仅用于示出具体实施例的目的,而并不认为是对本发明的限制。
图1是自主泊车***架构图;图中泊车路径前进段用虚线框表示,表示某些泊车规划没有前进段路径;车辆定位信息用虚箭头表示,因为该定位信息来自于车辆定位***,而并非直接来自于自主泊车控制器。
图2是自主泊车路径协调方法示意图,图中各关键节点:S1、B、S2、P1、P2、P3、P4、M1、M2、M3、M4。
图3是停车场拓扑地图中自主泊车路线图,图中点画线表示自主泊车路径。
具体实施方式
下面结合附图和实施例对本发明进行详细的描述,其中,附图构成本申请一部分,并与本发明的实施例一起用于阐释本发明。但本领域的技术人员应该知道,以下实施例并不是对本发明技术方案作的唯一限定,凡是在本发明技术方案精神实质下所做的任何等同变换或改动,均应视为属于本发明的保护范围。
本发明提出的一种基于拓扑地图的自主泊车路径协调方法,引用了包括道路拓扑图与车位信息在内的停车场拓扑地图信息,然后基于V2X通信,自主泊车控制器针对停车场服务器提供的停车场拓扑地图、目标空置车位和动态道路通行矩阵,规划融合全局路径与泊车路径构成的自主泊车路径,在规划阶段保证低速自动驾驶与自动泊车能够平滑过渡;实际运行过程中,可根据道路实际通行情况,在线调整自主泊车路径。
如图1所示,在停车场端,布置停车场服务器,该服务器存储有包含道路拓扑图和车位信息的停车场拓扑地图,同时具有根据停车场监控实时更新动态道路通行矩阵和空余车位编号,为车辆分配目标空置车位的能力。在车辆端,布置自主泊车控制器,该控制器基于V2X通信从停车场服务器下载停车场拓扑地图,并接收目标空置车位编号和当前的动态道路通行矩阵。停车场服务器和自主泊车控制器都可在获知道路信息、空余车位信息等情况下,做出自主泊车路径规划,包括全局路径规划、泊车路径规划和路径协调。
因此,方案实施主要包含如下过程:
一、基于激光雷达点云数据的停车场拓扑地图构建
二、基于动态道路通行矩阵与改进A*算法的全局路径规划
三、泊车路径规划
四、全局路径与泊车路径的协调
下面一一予以细述:
一、基于激光雷达点云数据的停车场拓扑地图构建
停车场拓扑地图离线设计,存储于停车场服务器中,通过V2X通信模块与车辆交互,在接收到车辆发出的泊车请求后,将其发送给车载自主泊车控制器。
本发明提出的基于激光雷达点云数据设计停车场拓扑地图的步骤如下:
(1)利用现有的激光雷达点云数据,在采集时预定义的坐标系下,提取停车位顶点坐标、车道线节点坐标,停车位顶点指车位的四个角点,车道线节点指各路段车道线的端点;
(2)根据(1)中坐标系的原点与平面法向量,将提取的坐标经过投影变换、四元数变换后处理为平面直角坐标系下的坐标;
(3)选取停车场坐标系基准点,建立停车场的平面直角坐标系,停车场基准点选取方式基于实际情况任意选取,例如可以选取一个车位的某一顶点作为基准点,该车位长和宽边分别作为x轴与y轴,然后将(2)中的结果经过平面坐标转换至停车场坐标系下;
(4)设计停车位顶点、道路主节点和停车位对应道路节点:
(a)选取每个停车位的四个角点都作为车位顶点;
(b)道路主节点:设计道路节点时,需保证靠近车道的车位线与对应侧道路节点连线平行。针对有车道线的停车场,选取同向车道中心线之间的交点作为道路主节点,且主节点之间连线应与对应道路侧的车位线平行;无车道线的停车场,应在道路中间假设一条平行于对应道路侧车位的直线,作为等效车道中心线,且该直线与车位间要保持安全通行距离,单双向通行视车道宽度选定,以等效车道中心线之间的交点作为道路主节点。将该步骤中涉及到的平行原则称为停车场道路节点设计原则。
(c)停车位对应道路节点:首先建立车位坐标系:站在车位中心(四个顶点对角线交点)面向道路方向时,以车位左后顶点为车位坐标系原点,左后顶点到右后顶点的方向为车位坐标系x轴正方向,左后顶点到左前顶点的方向为y轴正方向;然后,过车位中心且平行于y轴的直线与所面向道路的两个道路主节点连线的交点为该车位对应的道路节点。
(5)构建邻接矩阵:对步骤(4)设计的道路主节点和车位对应的道路节点统一编号,并基于实际的道路连通情况建立描述节点连接关系的邻接矩阵Ar+p,即对于任意两节点i,j,根据从节点i到节点j的直接连接情况,设定Ar+p中的元素ai,j为0或1,可通行设置为1,不可通行为0。同理节点j到节点i,以aj,i描述,最终根据节点总数N构建出N*N的邻接矩阵Ar+p。
(6)对地图信息统一描述,包括道路拓扑信息和车位信息:
(a)道路拓扑信息Map包括由道路主节点Noder和车位对应道路节点Nodep构成的节点信息Noder+p,以及由邻接矩阵构成的节点连接状态信息:
Map=G(Noder+p,Ar+p)
式中,Noder和Nodep中各节点坐标由停车场坐标系横、纵坐标表示,Nr为道路主节点个数,Np为停车位个数也即车位对应道路节点个数;Ar+p由描述节点i,j之间连接关系的元素ai,j(或aj,i)构成,aj,i、ai,j∈{0,1}。
(b)车位信息除了包含自身车位信息如车位顶点之外,还要考虑其他相关信息,包括车位编号,车位类型(包括平行车位、垂直车位、斜向车位等),车位的宽和长,车位前方的通车道路宽,泊车起点的横向位移参数,车位所允许的泊车方向(包括右侧、左侧泊车和直线倒车方式),直线泊车需要添加的节点编号。
其中,停车场所有车位的车位顶点信息集合如下:
Np为停车位个数,每个车位由四个顶点表述,Vlr,Vrr,Vrf,Vlf分别表示车位左后、右后、右前、左前四个顶点,且每个顶点由停车场坐标系横、纵坐标表示。
车位信息表述如下:
Pp,i={np,i,Tp,i,Wi,Li,Di,hi,Ppv,i}
np,i代表第i个车位的车位编号,Tp,i代表第i个车位的车位类型,Wi,Li分别代表第i个车位的宽和长,Di表示第i个车位前方的通车道路宽,hi表示第i个车位泊车起点的横向位移参数;Ppv,i代表第i个车位的四个顶点的坐标。
构建车位编号与车位对应道路节点之间的对应关系如下:
P2R={np,i,Nodep,i,DPi,LPi}
Nodep,i代表第i个车位对应的停车位对应道路节点;DPi代表第i个车位所允许的泊车方向;LPi代表第i个车位直线泊车需要添加的节点编号。
以上步骤均为人工离线完成,停车场拓扑地图数据制作完成后,将Map、Pp,i、P2R等信息存储于停车场服务器中作为停车场地图的原始数据。
二、基于动态道路通行矩阵与改进A*算法的全局路径规划方法
为了使自主泊车控制器能够根据当前时刻的停车场道路通行能力规划出更合理的自主泊车路径,为自主泊车控制器全局规划模块设计了改进的A*算法,通过利用停车服务器向自主泊车控制器提供动态道路通行矩阵,规划更加合理的行车路径。
动态道路通行矩阵Br+p与停车场拓扑地图中的邻接矩阵Ar+p具有相同矩阵维度,表述如下:
式中,bi,j是表征节点i与节点j之间连接关系的元素,bj,i同理,bj,i、bi,j∈[0,1],根据道路的实际通行情况在0~1之间动态调整,0表示两道路节点间不可通行,1表示可直接通行,0与1之间的数表示可通行,但是通行能力不同。
定义道路实际可通行矩阵Cr+p,满足cj,i为矩阵中的元素。
设计改进A*算法的价值函数:
h(i)=|xf-xr+p,i|+|yf-yr+p,i|
cj,i=aj,i·bj,i
故式中f(i)为改进的A*算法的价值函数,k(k≠0)为加权系数,加权系数根据工程经验确定,计算时cj,i∈(0,1],g(j)为起点到上一步检索节点的累计距离,g(j,i)为上一步检索的节点j到当前节点i的距离,h(i)为启发值函数,估计当前节点到目标节点的距离;(xf,yf)为目标车位对应的道路节点坐标,(xr+p,i,yr+p,i)为当前节点对应的Noder+p数据中的坐标。
工作步骤如下:
(1)首先,停车场服务器基于V2X通信模块接收停车场中运行车辆的GPS信息,并实时发送到道路占用信息处理单元,该单元根据接收的车辆GPS信息并将其与停车场拓扑地图匹配,确定各车位置是在哪两个节点之间,若在i与j节点之间,则减小bi,j与bj,i的值,具体变化量自行设计,然后将当前时刻更新后的邻接矩阵Ar+p存储于停车场服务器中。
(2)自主泊车控制器接收来自停车场服务器的停车场地图信息、空余车位编号信息、指定的目标空置车位信息。如图1所示,利用改进A*算法从初始节点开始,算法每一步从Ar+p中搜索出相邻节点,利用改进的目标函数结合Cr+p计算出各相邻节点的f(i),并对比找出该值最小的节点作为下一节点,如此循环直至找到目标空置车位的停车位对应道路节点,最终获得当前函数下的全局路径Pathglobal,整个检索过程与传统A*算法相同,此处不赘述。
式中,(xgp,i,ygp,i)为路径第i个节点的坐标,Ngp为路径节点数。
三、泊车路径规划
基于停车场道路节点设计原则,根据车位信息Pp,i中的Tp,i确定泊车类型(垂直、平行、斜向),以全局路径Pathglobal末点的方向判断泊车方向(左侧、右侧),距离车位的横向距离作为泊车规划的初始条件,规划出泊车路径Pathparking,以上称为自主泊车路径规划原则。
Drtdriving,i∈{-1,0,1}
式中Pathparking,i为第i段泊车路径,(xppi,k,yppi,k)为第i段路径第k个节点的坐标,Nppi为第i段路径的节点数,Drtdriving,i用以描述第i段路径允许车辆的行驶方向,定义1为前进,-1为倒车,0表示路径不存在。
四、全局路径与泊车路径的协调
自主泊车控制器接收到停车场服务器发送的停车场拓扑地图信息、目标空置车位编号和动态道路通行矩阵后,规划此时从当前车辆位置到目标空置车位的自主泊车路径:
(1)基于停车场道路节点设计原则和自主泊车路径规划原则,以规划的全局路径和泊车路径作为路径融合的前提条件,保证全局路径末点与泊车路径起点在同一车道线上。若泊车路径存在前行部分,则将全局路径末点替换为泊车起始点,将泊车起始点与全局路径拼接共同作为前进段路径Pathforward,倒车部分作为倒车段路径Pathbackward,表述如下:
式中,Pathforward包括两段路径,故Pathbackward中路径从i=2开始拼接剩余J-i+1段倒车路径,其中J为倒车路径总段数,若泊车规划不存在车辆前进部分,Pathforward仅需式中第一部分,而Pathbackward从i=1开始拼接。
(2)对路径拼接后的结果进行节点优化,根据各节点的方向信息判断相关联的节点是否在同一道路直线上,如果在同一条直线上,仅保留首末节点,中间点剔除。
节点优化后的结果如下:
式中,角标f/b表示前进段或倒车段路径(f=forword,b=backword),(xf,i,yf,i)、(xb,i,yb,i)、ψf,i、ψb,i、Nf、Nb分别表示节点优化后的坐标,对应坐标的航向角和行车路径节点编号。
(3)对节点优化后的前进段路径进行平滑处理,如图2中的S1-S2段与中M1-M2段,所采用的平滑处理方法不限,但需输出的可驾驶路径需保证曲率连续的基本原则;然后对倒车段路径拟合,如图2中M2-M3(或M2-M3-M4)段曲线,拟合方法不限,获得曲率0~ρmax~0连续变化的倒车路径。
自主泊车控制器将最终得到的自主泊车路径作为参考路径对车辆进行控制,如图3中点画线所示。
Claims (3)
1.一种基于拓扑地图的自主泊车路径协调方法,其特征在于,基于V2X通信,自主泊车控制器根据停车场服务器提供的停车场拓扑地图、目标空置车位和动态道路通行矩阵,规划行车的全局路径和泊车路径,然后通过融合协调,形成平滑完整的自主泊车路径;
包含如下步骤:
(1)在停车场端,布置停车场服务器,所述服务器中存储有停车场拓扑地图,同时具有根据停车场监控实时更新动态道路通行矩阵和空余车位编号,为车辆分配目标空置车位的能力,所述地图中包含有道路主节点、停车位对应道路节点、各节点构建的邻接矩阵、车位信息;在车辆端,布置自主泊车控制器,所述控制器基于V2X通信从停车场服务器下载停车场拓扑地图,并接收目标空置车位信息和当前动态道路通行矩阵;
(2)所述自主泊车控制器根据车辆当前位置及停车场服务器提供的信息,基于停车场拓扑地图,规划车辆在道路上可通行的全局路径,然后根据全局路径末点的行车方向与停车位之间的方位关系确定泊车方向,再根据停车位泊车类型、全局路径末点距离车位的横向距离、停车位顶点坐标信息和车辆的外形参数规划泊车路径;
(3)经过全局路径与泊车路径的拼接、节点优化、平滑处理、路径拟合,得到无偏差融合且平滑过渡的自主泊车路径。
2.根据权利要求1所述的基于拓扑地图的自主泊车路径协调方法,其特征在于,停车场拓扑地图构建的方法是:基于激光雷达点云数据,
1)在激光雷达采集前的预定义坐标系下,从激光雷达采集的点云数据中提取停车位顶点坐标、车道线节点坐标,停车位顶点指车位的四个角点,车道线节点指各路段车道线的端点;
2)根据预定义坐标系的平面中心原点与平面法向量,将步骤1)提取的坐标经过投影变换、四元数变换后变为平面直角坐标系下的坐标;
3)合理选取坐标系原点,建立停车场坐标系,然后将2)中的坐标转换至停车场坐标系下;
4)设计停车位顶点、道路主节点和停车位对应道路节点:
(a)每个停车位的四个角点都作为停车位顶点;
(b)道路主节点:选取同向车道中心线之间的交点作为道路主节点,且主节点之间连线与对应道路侧的车位线平行;
(c)停车位对应道路节点:在预设的车位坐标系基础上确定:即在车位中心面向道路方向时,以车位左后顶点为车位坐标系原点,左后顶点到右后顶点的方向为车位坐标系x轴正方向,左后顶点到左前顶点的方向为y轴正方向;然后,过车位中心且平行于y轴的直线与所面向道路的两个道路主节点连线的交点作为该车位对应的道路节点;
5)构建邻接矩阵:对步骤(4)设计的道路主节点和停车位对应道路节点统一编号,对于任意两节点i,j,根据从节点i到节点j的直接连接情况,确定矩阵中的元素ai,j为0还是1,可通行设置为1,不可通行为0,最终根据节点总数N构建出N*N的邻接矩阵Ar+p;
6)对地图信息统一描述,包括道路拓扑信息和车位信息:
(a)道路拓扑信息Map包括由道路主节点信息Noder和车位对应道路节点信息Nodep构成的所有节点信息Noder+p,以及由邻接矩阵构成的节点连接状态信息:
Map=G(Noder+p,Ar+p)
式中,Noder和Nodep中各节点坐标由停车场坐标系横、纵坐标表示,Nr为道路主节点个数,Np为停车位个数也即车位对应道路节点个数;Ar+p由描述节点之间连接关系的元素ai,j、aj,i构成,ai,j、ai,j∈{0,1};
(b)车位信息表述如下:
Pp,i={np,i,Tp,i,Wi,Li,Di,hi,Ppv,i}
其中,停车场所有车位的车位顶点信息如下:
Np为停车位个数,每个车位四个顶点Vlr,Vrr,Vrf,Vlf分别表示车位左后、右后、右前、左前顶点;
np,i代表第i个车位的车位编号,Tp,i代表第i个车位的车位类型,Wi,Li分别代表第i个车位的宽和长,Di表示第i个车位前方的通车道路宽,hi表示第i个车位泊车起点的横向位移参数;Ppv,i代表第i个车位的四个顶点的坐标;
并构建车位编号与停车位对应道路节点之间的对应关系如下:
P2R={np,i,Nodep,i,DPi,LPi}
Nodep,i代表第i个车位对应的停车位对应道路节点;DPi代表第i个车位所允许的泊车方向;LPi代表第i个车位直线泊车需要添加的节点编号。
3.根据权利要求1所述的基于拓扑地图的自主泊车路径协调方法,其特征在于,基于停车场道路节点设计原则与自主泊车路径规划原则,融合全局路径与泊车路径:
1)基于停车场道路节点设计原则,根据车位信息中的泊车类型,以全局路径Pathglobal末点的方向判断泊车方向,距离车位的横向距离作为泊车规划的初始条件,进而规划出泊车路径Pathparking:
Drtdriving,i∈{-1,0,1}
式中,(xgp,i,ygp,i)为路径第i个节点的坐标,Ngp为路径节点数,Pathparking,i为第i段泊车路径,(xppi,j,yppi,j)为第i段路径第k个节点的坐标,Nppi为第i段路径的节点数,Drtdriving,i为第i段路径允许车辆的行驶方向,定义1为前进,-1为倒车,0表示路径不存在;
2)将全局路径末点替换为泊车起始点,若泊车路径存在前行部分,在节点替换后将全局路径与泊车路径拼接共同作为前进段路径Pathforward,倒车部分作为倒车段路径Pathbackward,表述如下:
Pathforward包括两段路径,若泊车规划不存在车辆前进部分,Pathforward仅取式中第一部分;
3)对拼接后的路径进行节点优化,根据各节点的方向信息判断相关联的节点是否在同一道路直线上,如果在同一条直线上,仅保留首末节点,中间点剔除,节点优化后的结果如下:
式中,角标f/b表示前进段或倒车段路径,(xf,i,yf,i)、(xb,i,yb,i)、ψf,i、ψb,i、Nf、Nb分别表示节点优化后的坐标,对应坐标的航向角和行车路径节点编号;
4)对节点优化后的前进段路径进行平滑处理,对倒车段路径拟合,获得曲率由0~ρmax~0连续变化的可驾驶路径,ρmax为最大曲率。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811219163.3A CN109131318B (zh) | 2018-10-19 | 2018-10-19 | 一种基于拓扑地图的自主泊车路径协调方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811219163.3A CN109131318B (zh) | 2018-10-19 | 2018-10-19 | 一种基于拓扑地图的自主泊车路径协调方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109131318A true CN109131318A (zh) | 2019-01-04 |
CN109131318B CN109131318B (zh) | 2020-03-27 |
Family
ID=64808747
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811219163.3A Active CN109131318B (zh) | 2018-10-19 | 2018-10-19 | 一种基于拓扑地图的自主泊车路径协调方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109131318B (zh) |
Cited By (52)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109724612A (zh) * | 2019-01-14 | 2019-05-07 | 浙江大华技术股份有限公司 | 一种基于拓扑地图的agv路径规划方法及设备 |
CN109798911A (zh) * | 2019-02-28 | 2019-05-24 | 北京智行者科技有限公司 | 一种用于代客泊车的全局路径规划方法 |
CN109866762A (zh) * | 2019-03-11 | 2019-06-11 | 武汉环宇智行科技有限公司 | 基于高精度地图的自主平行泊车方法 |
CN109900279A (zh) * | 2019-02-13 | 2019-06-18 | 浙江零跑科技有限公司 | 一种基于泊车位全局路由的停车场语义地图创建方法 |
CN110159040A (zh) * | 2019-04-26 | 2019-08-23 | 纵目科技(上海)股份有限公司 | 一种立体停车库的泊车方法、***、终端和存储介质 |
CN110155043A (zh) * | 2019-05-09 | 2019-08-23 | 禾多科技(北京)有限公司 | 自动泊车二维定位方法 |
CN110444044A (zh) * | 2019-08-27 | 2019-11-12 | 纵目科技(上海)股份有限公司 | 基于超声波传感器的车辆位姿检测***、终端和存储介质 |
CN110466510A (zh) * | 2019-09-17 | 2019-11-19 | 安徽江淮汽车集团股份有限公司 | 自主泊车***及方法 |
CN110515376A (zh) * | 2019-07-26 | 2019-11-29 | 纵目科技(上海)股份有限公司 | 一种航迹推演校正的评价方法、终端和存储介质 |
CN110517525A (zh) * | 2019-08-14 | 2019-11-29 | 北京智行者科技有限公司 | 一种基于标签***的代客泊车方法 |
CN110568452A (zh) * | 2019-08-16 | 2019-12-13 | 苏州禾昆智能科技有限公司 | 一种基于场端激光雷达的停车场快速建图方法及其*** |
CN110782696A (zh) * | 2019-01-25 | 2020-02-11 | 长城汽车股份有限公司 | 用于代客泊车的控制*** |
CN111076734A (zh) * | 2019-12-12 | 2020-04-28 | 湖南大学 | 一种封闭区域非结构化道路高精地图构建方法 |
CN111341136A (zh) * | 2020-02-11 | 2020-06-26 | 浙江吉利汽车研究院有限公司 | 一种基于车路协同的代客泊车方法、***及存储介质 |
CN111397623A (zh) * | 2020-03-27 | 2020-07-10 | 湖南大学 | 一种基于最佳泊车起始点的路径规划方法 |
CN111409624A (zh) * | 2020-03-13 | 2020-07-14 | 华南理工大学 | 一种基于雷达与汽车的信息交换的代客泊车***及泊车方法 |
CN111445703A (zh) * | 2020-04-29 | 2020-07-24 | 云南电网有限责任公司电力科学研究院 | 一种基于图像识别的智能停车场***及方法 |
CN111547046A (zh) * | 2020-04-30 | 2020-08-18 | 惠州华阳通用电子有限公司 | 一种平行车位预占式自动泊车方法及装置 |
CN111547045A (zh) * | 2020-04-30 | 2020-08-18 | 惠州华阳通用电子有限公司 | 一种垂直车位自动泊车方法及装置 |
CN111824131A (zh) * | 2020-07-10 | 2020-10-27 | 广州小鹏车联网科技有限公司 | 一种自动泊车的方法和车辆 |
CN111845722A (zh) * | 2020-07-24 | 2020-10-30 | 东风汽车有限公司 | 一种汽车自动驾驶方法、汽车自动泊车方法及电子设备 |
CN111862672A (zh) * | 2020-06-24 | 2020-10-30 | 北京易航远智科技有限公司 | 基于顶视图的停车场车辆自定位及地图构建方法 |
CN111907516A (zh) * | 2019-05-09 | 2020-11-10 | 广州汽车集团股份有限公司 | 一种全自动泊车方法和*** |
CN111942384A (zh) * | 2020-07-22 | 2020-11-17 | 广州汽车集团股份有限公司 | 车辆低速自动巡航方法、客户端、车辆低速自动巡航*** |
CN112115741A (zh) * | 2019-06-20 | 2020-12-22 | 上海汽车集团股份有限公司 | 一种泊车库位检测方法及装置 |
CN112224199A (zh) * | 2020-09-15 | 2021-01-15 | 华人运通(上海)自动驾驶科技有限公司 | 遥控泊车控制方法、装置、车辆及存储介质 |
CN112309168A (zh) * | 2020-11-13 | 2021-02-02 | 浙江吉利控股集团有限公司 | 一种停车场地图下载管理方法、装置、***及存储介质 |
CN112339746A (zh) * | 2019-08-09 | 2021-02-09 | 上汽通用汽车有限公司 | 一种泊车***及其泊车方法 |
CN112414422A (zh) * | 2020-11-01 | 2021-02-26 | 北京航空航天大学 | 一种自动泊车的路径规划方法、装置及存储介质 |
CN112466142A (zh) * | 2020-11-13 | 2021-03-09 | 浙江吉利控股集团有限公司 | 一种车辆调度方法、装置、***及存储介质 |
CN112687123A (zh) * | 2019-10-17 | 2021-04-20 | 丰田自动车株式会社 | 自动泊车*** |
CN112799391A (zh) * | 2020-09-15 | 2021-05-14 | 华人运通(上海)自动驾驶科技有限公司 | 用于狭窄车位的泊车方法、装置、车辆及存储介质 |
CN112802346A (zh) * | 2020-12-28 | 2021-05-14 | 苏州易航远智智能科技有限公司 | 基于云端共享和地图融合的自主泊车***和方法 |
CN113077652A (zh) * | 2021-03-19 | 2021-07-06 | 上海欧菲智能车联科技有限公司 | 车位自动搜索方法、装置、电子装置及存储介质 |
CN113147743A (zh) * | 2021-04-27 | 2021-07-23 | 东风汽车集团股份有限公司 | 自动泊车方法、***及存储介质 |
WO2021168698A1 (en) * | 2020-02-26 | 2021-09-02 | Baidu.Com Times Technology (Beijing) Co., Ltd. | A mixed regular and open-space trajectory planning method for autonomous driving vehicle |
CN113492841A (zh) * | 2021-07-22 | 2021-10-12 | 上汽通用五菱汽车股份有限公司 | 泊车控制方法、装置及计算机可读存储介质 |
CN113724524A (zh) * | 2020-05-21 | 2021-11-30 | 丰田自动车株式会社 | 自主代客泊车***以及自主代客泊车方法 |
CN113741474A (zh) * | 2021-09-13 | 2021-12-03 | 上海伯镭智能科技有限公司 | 一种无人驾驶矿车的停泊区域识别方法及装置 |
WO2022042359A1 (zh) * | 2020-08-26 | 2022-03-03 | 深圳市杉川机器人有限公司 | 一种建立工作区域地图的方法及自移动设备 |
CN114137956A (zh) * | 2021-10-28 | 2022-03-04 | 华人运通(上海)云计算科技有限公司 | 一种车云协同路径规划方法及*** |
CN114255594A (zh) * | 2021-12-28 | 2022-03-29 | 吉林大学 | 一种自主代客泊车运动规划与运动控制方法 |
CN114399124A (zh) * | 2022-03-24 | 2022-04-26 | 腾讯科技(深圳)有限公司 | 路径数据处理、路径规划方法、装置和计算机设备 |
CN114550451A (zh) * | 2022-02-18 | 2022-05-27 | 平安国际智慧城市科技股份有限公司 | 停车场的车辆拥堵预警方法、装置、设备及存储介质 |
CN114863714A (zh) * | 2022-04-18 | 2022-08-05 | 桂林电子科技大学 | 一种地下停车位智能引导***及停车后反向寻车方法 |
CN115235498A (zh) * | 2022-07-21 | 2022-10-25 | 重庆长安汽车股份有限公司 | 行泊一体全局路径规划方法、***、电子设备及车辆 |
CN115273028A (zh) * | 2022-07-14 | 2022-11-01 | 清华大学 | 一种基于全域感知的智慧停车场语义地图构建方法及*** |
CN115457798A (zh) * | 2022-08-15 | 2022-12-09 | 东风汽车集团股份有限公司 | 自动驾驶车辆停车位导引方法、装置、设备及存储介质 |
CN115798254A (zh) * | 2022-11-23 | 2023-03-14 | 武汉大学 | 基于最小邻接道路闭合单元的园区停车引导方法 |
CN116309943A (zh) * | 2023-05-24 | 2023-06-23 | 联友智连科技有限公司 | 一种停车场语义地图路网构建方法、装置及电子设备 |
US11878712B2 (en) | 2020-02-26 | 2024-01-23 | Baidu Usa Llc | Trajectory planning with obstacle avoidance for autonomous driving vehicles |
CN117719498A (zh) * | 2024-02-08 | 2024-03-19 | 深圳市欧冶半导体有限公司 | 路径规划方法、装置、电子设备和存储介质 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000285391A (ja) * | 1999-03-31 | 2000-10-13 | Toshiba Corp | 駐車場車両誘導システム |
CN101635098A (zh) * | 2009-08-03 | 2010-01-27 | 钟勇 | 基于室内精确实时定位的停车泊位可视导航*** |
KR101711026B1 (ko) * | 2013-07-17 | 2017-03-14 | 한국전자통신연구원 | 자동 주차 제어 장치 및 방법 |
CN106960589A (zh) * | 2016-01-11 | 2017-07-18 | 福特全球技术公司 | 用于反向垂直停车的***和方法 |
CN107074233A (zh) * | 2014-10-27 | 2017-08-18 | 罗伯特·博世有限公司 | 用于执行车辆的自动泊车过程的方法 |
DE102015221237B4 (de) * | 2015-10-30 | 2019-01-03 | Robert Bosch Gmbh | Verfahren und Vorrichtung zum Lokalisieren eines sich innerhalb eines Parkplatzes befindenden Kraftfahrzeugs |
-
2018
- 2018-10-19 CN CN201811219163.3A patent/CN109131318B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000285391A (ja) * | 1999-03-31 | 2000-10-13 | Toshiba Corp | 駐車場車両誘導システム |
CN101635098A (zh) * | 2009-08-03 | 2010-01-27 | 钟勇 | 基于室内精确实时定位的停车泊位可视导航*** |
KR101711026B1 (ko) * | 2013-07-17 | 2017-03-14 | 한국전자통신연구원 | 자동 주차 제어 장치 및 방법 |
CN107074233A (zh) * | 2014-10-27 | 2017-08-18 | 罗伯特·博世有限公司 | 用于执行车辆的自动泊车过程的方法 |
DE102015221237B4 (de) * | 2015-10-30 | 2019-01-03 | Robert Bosch Gmbh | Verfahren und Vorrichtung zum Lokalisieren eines sich innerhalb eines Parkplatzes befindenden Kraftfahrzeugs |
CN106960589A (zh) * | 2016-01-11 | 2017-07-18 | 福特全球技术公司 | 用于反向垂直停车的***和方法 |
Non-Patent Citations (1)
Title |
---|
陈安: "网联车自动驾驶***研究及停车场场景下的应用", 《中国优秀硕士论文学位论文全文数据库》 * |
Cited By (75)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109724612A (zh) * | 2019-01-14 | 2019-05-07 | 浙江大华技术股份有限公司 | 一种基于拓扑地图的agv路径规划方法及设备 |
CN109724612B (zh) * | 2019-01-14 | 2021-06-15 | 浙江华睿科技有限公司 | 一种基于拓扑地图的agv路径规划方法及设备 |
CN110782696A (zh) * | 2019-01-25 | 2020-02-11 | 长城汽车股份有限公司 | 用于代客泊车的控制*** |
CN109900279A (zh) * | 2019-02-13 | 2019-06-18 | 浙江零跑科技有限公司 | 一种基于泊车位全局路由的停车场语义地图创建方法 |
CN109798911A (zh) * | 2019-02-28 | 2019-05-24 | 北京智行者科技有限公司 | 一种用于代客泊车的全局路径规划方法 |
CN109866762A (zh) * | 2019-03-11 | 2019-06-11 | 武汉环宇智行科技有限公司 | 基于高精度地图的自主平行泊车方法 |
CN110159040A (zh) * | 2019-04-26 | 2019-08-23 | 纵目科技(上海)股份有限公司 | 一种立体停车库的泊车方法、***、终端和存储介质 |
CN110155043A (zh) * | 2019-05-09 | 2019-08-23 | 禾多科技(北京)有限公司 | 自动泊车二维定位方法 |
CN111907516A (zh) * | 2019-05-09 | 2020-11-10 | 广州汽车集团股份有限公司 | 一种全自动泊车方法和*** |
CN112115741A (zh) * | 2019-06-20 | 2020-12-22 | 上海汽车集团股份有限公司 | 一种泊车库位检测方法及装置 |
CN112115741B (zh) * | 2019-06-20 | 2024-02-20 | 上海汽车集团股份有限公司 | 一种泊车库位检测方法及装置 |
CN110515376A (zh) * | 2019-07-26 | 2019-11-29 | 纵目科技(上海)股份有限公司 | 一种航迹推演校正的评价方法、终端和存储介质 |
CN110515376B (zh) * | 2019-07-26 | 2023-11-28 | 纵目科技(上海)股份有限公司 | 一种航迹推演校正的评价方法、终端和存储介质 |
CN112339746A (zh) * | 2019-08-09 | 2021-02-09 | 上汽通用汽车有限公司 | 一种泊车***及其泊车方法 |
CN110517525A (zh) * | 2019-08-14 | 2019-11-29 | 北京智行者科技有限公司 | 一种基于标签***的代客泊车方法 |
CN110517525B (zh) * | 2019-08-14 | 2021-12-10 | 北京智行者科技有限公司 | 一种基于标签***的代客泊车方法 |
CN110568452A (zh) * | 2019-08-16 | 2019-12-13 | 苏州禾昆智能科技有限公司 | 一种基于场端激光雷达的停车场快速建图方法及其*** |
CN110444044A (zh) * | 2019-08-27 | 2019-11-12 | 纵目科技(上海)股份有限公司 | 基于超声波传感器的车辆位姿检测***、终端和存储介质 |
CN110466510A (zh) * | 2019-09-17 | 2019-11-19 | 安徽江淮汽车集团股份有限公司 | 自主泊车***及方法 |
CN112687123B (zh) * | 2019-10-17 | 2022-12-27 | 丰田自动车株式会社 | 自动泊车*** |
CN112687123A (zh) * | 2019-10-17 | 2021-04-20 | 丰田自动车株式会社 | 自动泊车*** |
CN111076734B (zh) * | 2019-12-12 | 2021-07-23 | 湖南大学 | 一种封闭区域非结构化道路高精地图构建方法 |
CN111076734A (zh) * | 2019-12-12 | 2020-04-28 | 湖南大学 | 一种封闭区域非结构化道路高精地图构建方法 |
CN111341136A (zh) * | 2020-02-11 | 2020-06-26 | 浙江吉利汽车研究院有限公司 | 一种基于车路协同的代客泊车方法、***及存储介质 |
US11878712B2 (en) | 2020-02-26 | 2024-01-23 | Baidu Usa Llc | Trajectory planning with obstacle avoidance for autonomous driving vehicles |
WO2021168698A1 (en) * | 2020-02-26 | 2021-09-02 | Baidu.Com Times Technology (Beijing) Co., Ltd. | A mixed regular and open-space trajectory planning method for autonomous driving vehicle |
CN111409624A (zh) * | 2020-03-13 | 2020-07-14 | 华南理工大学 | 一种基于雷达与汽车的信息交换的代客泊车***及泊车方法 |
CN111397623A (zh) * | 2020-03-27 | 2020-07-10 | 湖南大学 | 一种基于最佳泊车起始点的路径规划方法 |
CN111445703A (zh) * | 2020-04-29 | 2020-07-24 | 云南电网有限责任公司电力科学研究院 | 一种基于图像识别的智能停车场***及方法 |
CN111547045A (zh) * | 2020-04-30 | 2020-08-18 | 惠州华阳通用电子有限公司 | 一种垂直车位自动泊车方法及装置 |
CN111547046A (zh) * | 2020-04-30 | 2020-08-18 | 惠州华阳通用电子有限公司 | 一种平行车位预占式自动泊车方法及装置 |
CN113724524B (zh) * | 2020-05-21 | 2023-11-24 | 丰田自动车株式会社 | 自主代客泊车***以及自主代客泊车方法 |
CN113724524A (zh) * | 2020-05-21 | 2021-11-30 | 丰田自动车株式会社 | 自主代客泊车***以及自主代客泊车方法 |
CN111862672A (zh) * | 2020-06-24 | 2020-10-30 | 北京易航远智科技有限公司 | 基于顶视图的停车场车辆自定位及地图构建方法 |
CN111824131A (zh) * | 2020-07-10 | 2020-10-27 | 广州小鹏车联网科技有限公司 | 一种自动泊车的方法和车辆 |
CN111824131B (zh) * | 2020-07-10 | 2021-10-12 | 广州小鹏自动驾驶科技有限公司 | 一种自动泊车的方法和车辆 |
CN111942384A (zh) * | 2020-07-22 | 2020-11-17 | 广州汽车集团股份有限公司 | 车辆低速自动巡航方法、客户端、车辆低速自动巡航*** |
CN111845722B (zh) * | 2020-07-24 | 2021-11-30 | 东风汽车有限公司 | 一种汽车自动驾驶方法、汽车自动泊车方法及电子设备 |
CN111845722A (zh) * | 2020-07-24 | 2020-10-30 | 东风汽车有限公司 | 一种汽车自动驾驶方法、汽车自动泊车方法及电子设备 |
WO2022042359A1 (zh) * | 2020-08-26 | 2022-03-03 | 深圳市杉川机器人有限公司 | 一种建立工作区域地图的方法及自移动设备 |
CN112224199A (zh) * | 2020-09-15 | 2021-01-15 | 华人运通(上海)自动驾驶科技有限公司 | 遥控泊车控制方法、装置、车辆及存储介质 |
CN112799391B (zh) * | 2020-09-15 | 2023-08-01 | 华人运通(上海)自动驾驶科技有限公司 | 用于狭窄车位的泊车方法、装置、车辆及存储介质 |
CN112799391A (zh) * | 2020-09-15 | 2021-05-14 | 华人运通(上海)自动驾驶科技有限公司 | 用于狭窄车位的泊车方法、装置、车辆及存储介质 |
CN112414422A (zh) * | 2020-11-01 | 2021-02-26 | 北京航空航天大学 | 一种自动泊车的路径规划方法、装置及存储介质 |
CN112309168B (zh) * | 2020-11-13 | 2022-06-21 | 浙江吉利控股集团有限公司 | 一种停车场地图下载管理方法、装置、***及存储介质 |
CN112466142A (zh) * | 2020-11-13 | 2021-03-09 | 浙江吉利控股集团有限公司 | 一种车辆调度方法、装置、***及存储介质 |
CN112309168A (zh) * | 2020-11-13 | 2021-02-02 | 浙江吉利控股集团有限公司 | 一种停车场地图下载管理方法、装置、***及存储介质 |
CN112466142B (zh) * | 2020-11-13 | 2022-06-21 | 浙江吉利控股集团有限公司 | 一种车辆调度方法、装置、***及存储介质 |
CN112802346A (zh) * | 2020-12-28 | 2021-05-14 | 苏州易航远智智能科技有限公司 | 基于云端共享和地图融合的自主泊车***和方法 |
CN113077652A (zh) * | 2021-03-19 | 2021-07-06 | 上海欧菲智能车联科技有限公司 | 车位自动搜索方法、装置、电子装置及存储介质 |
CN113147743A (zh) * | 2021-04-27 | 2021-07-23 | 东风汽车集团股份有限公司 | 自动泊车方法、***及存储介质 |
CN113492841B (zh) * | 2021-07-22 | 2022-09-06 | 上汽通用五菱汽车股份有限公司 | 泊车控制方法、装置及计算机可读存储介质 |
CN113492841A (zh) * | 2021-07-22 | 2021-10-12 | 上汽通用五菱汽车股份有限公司 | 泊车控制方法、装置及计算机可读存储介质 |
WO2023000763A1 (zh) * | 2021-07-22 | 2023-01-26 | 上汽通用五菱汽车股份有限公司 | 泊车控制方法、装置及计算机可读存储介质 |
CN113741474B (zh) * | 2021-09-13 | 2022-04-29 | 上海伯镭智能科技有限公司 | 一种无人驾驶矿车的停泊区域识别方法及装置 |
CN113741474A (zh) * | 2021-09-13 | 2021-12-03 | 上海伯镭智能科技有限公司 | 一种无人驾驶矿车的停泊区域识别方法及装置 |
CN114137956B (zh) * | 2021-10-28 | 2023-11-10 | 华人运通(上海)云计算科技有限公司 | 一种车云协同路径规划方法及*** |
CN114137956A (zh) * | 2021-10-28 | 2022-03-04 | 华人运通(上海)云计算科技有限公司 | 一种车云协同路径规划方法及*** |
CN114255594B (zh) * | 2021-12-28 | 2024-03-15 | 吉林大学 | 一种自主代客泊车运动规划与运动控制方法 |
CN114255594A (zh) * | 2021-12-28 | 2022-03-29 | 吉林大学 | 一种自主代客泊车运动规划与运动控制方法 |
CN114550451B (zh) * | 2022-02-18 | 2023-08-18 | 平安国际智慧城市科技股份有限公司 | 停车场的车辆拥堵预警方法、装置、设备及存储介质 |
CN114550451A (zh) * | 2022-02-18 | 2022-05-27 | 平安国际智慧城市科技股份有限公司 | 停车场的车辆拥堵预警方法、装置、设备及存储介质 |
CN114399124A (zh) * | 2022-03-24 | 2022-04-26 | 腾讯科技(深圳)有限公司 | 路径数据处理、路径规划方法、装置和计算机设备 |
CN114863714A (zh) * | 2022-04-18 | 2022-08-05 | 桂林电子科技大学 | 一种地下停车位智能引导***及停车后反向寻车方法 |
CN115273028A (zh) * | 2022-07-14 | 2022-11-01 | 清华大学 | 一种基于全域感知的智慧停车场语义地图构建方法及*** |
CN115235498A (zh) * | 2022-07-21 | 2022-10-25 | 重庆长安汽车股份有限公司 | 行泊一体全局路径规划方法、***、电子设备及车辆 |
CN115235498B (zh) * | 2022-07-21 | 2024-06-07 | 重庆长安汽车股份有限公司 | 行泊一体全局路径规划方法、***、电子设备及车辆 |
CN115457798A (zh) * | 2022-08-15 | 2022-12-09 | 东风汽车集团股份有限公司 | 自动驾驶车辆停车位导引方法、装置、设备及存储介质 |
CN115457798B (zh) * | 2022-08-15 | 2023-09-19 | 东风汽车集团股份有限公司 | 自动驾驶车辆停车位导引方法、装置、设备及存储介质 |
CN115798254A (zh) * | 2022-11-23 | 2023-03-14 | 武汉大学 | 基于最小邻接道路闭合单元的园区停车引导方法 |
CN115798254B (zh) * | 2022-11-23 | 2024-04-12 | 武汉大学 | 基于最小邻接道路闭合单元的园区停车引导方法 |
CN116309943A (zh) * | 2023-05-24 | 2023-06-23 | 联友智连科技有限公司 | 一种停车场语义地图路网构建方法、装置及电子设备 |
CN116309943B (zh) * | 2023-05-24 | 2023-08-08 | 联友智连科技有限公司 | 一种停车场语义地图路网构建方法、装置及电子设备 |
CN117719498A (zh) * | 2024-02-08 | 2024-03-19 | 深圳市欧冶半导体有限公司 | 路径规划方法、装置、电子设备和存储介质 |
CN117719498B (zh) * | 2024-02-08 | 2024-04-16 | 深圳市欧冶半导体有限公司 | 路径规划方法、装置、电子设备和存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN109131318B (zh) | 2020-03-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109131318A (zh) | 一种基于拓扑地图的自主泊车路径协调方法 | |
CN112964271B (zh) | 一种面向多场景的自动驾驶规划方法及*** | |
WO2020108207A1 (zh) | 一种高精度地图的构建方法及装置 | |
CN107560615B (zh) | 用于停车场自动驾驶***的停车路径规划方法 | |
CN110471418B (zh) | 智能停车场中的agv调度方法 | |
CN113375678B (zh) | 一种行车路径规划方法、管理服务器及停车管理*** | |
CN106004860A (zh) | 车辆行驶控制装置 | |
CN103456185A (zh) | 智能车在城市道路行驶中的接力导航方法 | |
CN109582032B (zh) | 多旋翼无人机在复杂环境下的快速实时避障路径选择方法 | |
JP2023531831A (ja) | 駐車スペースのハイブリッド探索を用いた自律駐車 | |
CA3136909A1 (en) | SYSTEMS AND METHODS FOR SIMULTANEOUS LOCATION AND MAPPING USING ASYNCHRONOUS MULTI-ANGLE CAMERAS | |
CN112923940A (zh) | 路径规划方法、装置、处理设备、移动设备及存储介质 | |
CN109031382A (zh) | 一种基于停车位的高精度道路计算匹配方法及*** | |
CN111337047B (zh) | 基于多任务点约束的非结构化道路宏观路径规划方法 | |
CN110517527A (zh) | 异构多源无线传感网络及其自主无人泊车方法 | |
CN112288854B (zh) | 立交桥三维模型的构建方法 | |
CN104699791A (zh) | 一种用于有损浮动车轨迹的路径还原方法 | |
CN101996516A (zh) | 基于矢量法的路径规划预处理方法 | |
CN105698796A (zh) | 一种多机器人调度***的路径搜索方法 | |
CN113538950A (zh) | 一种用于avp场景的停车场导航路网生成方法 | |
CN116414139A (zh) | 基于A-Star算法的移动机器人复杂路径规划方法 | |
Kohlhaas et al. | Planning of high-level maneuver sequences on semantic state spaces | |
CN115344049B (zh) | 一种旅客登机车自动路径规划及车辆控制方法及装置 | |
WO2023108523A1 (zh) | 一种更新地图的方法和装置 | |
Ghosh et al. | Integration of SLAM with GIS to model sustainable urban transportation system: A smart city perspective |
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 |