CN113375678B - 一种行车路径规划方法、管理服务器及停车管理系统 - Google Patents
一种行车路径规划方法、管理服务器及停车管理系统 Download PDFInfo
- Publication number
- CN113375678B CN113375678B CN202010159230.8A CN202010159230A CN113375678B CN 113375678 B CN113375678 B CN 113375678B CN 202010159230 A CN202010159230 A CN 202010159230A CN 113375678 B CN113375678 B CN 113375678B
- Authority
- CN
- China
- Prior art keywords
- point
- path
- information
- vehicle
- road section
- 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
Images
Classifications
-
- 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
- G01C21/30—Map- or contour-matching
-
- 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
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
- Traffic Control Systems (AREA)
Abstract
本申请实施例提供了一种行车路径规划方法、管理服务器及停车管理系统,行车路径规划所使用的地图包括对指定场景中的行车道路分割得到的多个单向路段,各单向路段包括至少一条车道,各车道包括多个路径点,各路径点携带几何信息,可以看出该地图为包含了拓扑信息和几何信息的混合地图。在进行行车路径规划时,在通过最优路段搜索得到从起始单向路段至目标单向路段的路段序列后,可以直接从地图中找到对应的路径点序列,该路径点序列即为全局的行车路径,避免了在每次进行行车路径规划时还需要进行插值计算等复杂运算,从而提高了行车路径规划的效率。
Description
技术领域
本申请涉及自动驾驶技术领域,特别是涉及一种行车路径规划方法、管理服务器及停车管理系统。
背景技术
近些年,随着城市的发展,汽车的保有量越来越高,停车难成为困扰人们的难题,阻碍城市发展。如何更方便的使用车辆,摆脱停车的难题已成为城市发展的研究热点。目前,在一些车辆上已使用APA(Automated Parking Assist,自动停车辅助)技术,APA技术是指将车辆停在车位附近(例如5米内),车辆可自动定位车位位置,基于车位位置自动地停入车位。这种停车方式虽然能够实现自动停车,缩短停车入位的时长,但是,需要用户将车辆先开到空车位附近,而用户寻找空车位的过程往往耗时较长。
为了应对上述问题,提出了一种AVP(Automated Valet Parking,全自动代客停车)技术,AVP技术包含两个主要过程:代客停车和代客提车。代客停车指的是在车辆需要停放时,用户可以下车,AVP系统帮助用户将车辆自动驾驶到车位旁并停车入位的过程;代客提车指的是用户可以远程请求提取车辆并设定提车点,AVP系统将车辆从车位中提出,自动驾驶到用户设定的提车点的过程。如何快速有效地规划出行车路径是AVP技术中的关键问题。
当前的行车路径规划方法主要是利用拓扑地图进行规划,拓扑地图是使用节点以及节点之间的连接关系表示的地图,在利用拓扑地图进行行车路径规划时,首先确定出起始节点与目标节点间的局部路径,由于拓扑地图中的节点一般为行车道路的路口,而任两个路口之间的距离可能较远,会有多条可达路径,因此需要通过插值加密的方式在任两个路口之间插入一个或多个路点,最终才能够得到全局的行车路径,在每次进行行车路径规划时都需要进行在线的插值计算,导致行车路径规划的效率较低。
发明内容
本申请实施例的目的在于提供一种行车路径规划方法、管理服务器及停车管理系统,以提高行车路径规划的效率。具体技术方案如下:
第一方面,本申请实施例提供了一种行车路径规划方法,该方法包括:
获取指定场景的地图、起始点信息及目标点信息,其中,地图包括对指定场景中的行车道路分割得到的多个单向路段,各单向路段包括至少一条车道,各车道包括多个路径点,各路径点携带几何信息;
根据起始点信息及各路径点的几何信息,从地图中查找起始路径点,并根据目标点信息及各路径点的几何信息,从地图中查找目标路径点;
从起始路径点所属的起始单向路段开始,进行最优路段搜索,得到从起始单向路段至目标路径点所属的目标单向路段的路段序列;
从地图中,确定路段序列中各单向路段的车道上从起始路径点至目标路径点之间的所有路径点组成的序列作为行车路径。
可选的,指定场景为停车场。
可选的,地图的建立方式,包括:
获取指定场景的点云信息,其中,点云信息包括路网信息及多个停车区域的信息;
根据路网信息,对行车道路进行分割,得到多个单向路段,其中,各单向路段包括至少一条车道;
根据多个停车区域的信息,确定各停车区域中的车位;
在各车道上设置多个路径点、各车位上设置多个车位点,并对各路径点标注几何信息;
基于多个单向路段及多个停车区域,生成指定场景的地图。
可选的,地图还包括指定场景中的多个停车区域,各停车区域包括至少一个车位,各车位包括多个车位点,一个车位的指定车位点连接至相邻路段的一个路径点;几何信息包括路径点的位置信息及航向角;
获取起始点信息及目标点信息的步骤,包括:
接收待停车辆发送的停车请求,并将停车请求携带的待停车辆的定位信息和航向角确定为起始点信息;
接收监控设备发送的车位空闲信息,根据车位空闲信息及定位信息,为待停车辆分配待停车位,并将待停车位的位置信息和车位标识确定为目标点信息;
根据起始点信息及各路径点的几何信息,从地图中查找起始路径点的步骤,包括:
根据待停车辆发送的定位信息和航向角以及各路径点的位置信息和航向角,从地图中查找距离待停车辆对应位置最近、且与待停车辆的航向角之差小于预设阈值的路径点作为起始路径点;
根据目标点信息及各路径点的几何信息,从地图中查找目标路径点的步骤,包括:
根据待停车位的位置信息和车位标识,从地图中查找待停车位对应的第一车位;确定第一车位的指定车位点连接的相邻路段上的路径点为目标路径点。
可选的,在根据目标点信息及各路径点的几何信息,从地图中查找目标路径点的步骤之后,该方法还包括:
将目标路径点沿航向角的正方向移动预设距离。
可选的,在从地图中,确定路段序列中各单向路段的车道上从起始路径点至目标路径点之间的所有路径点组成的序列作为行车路径的步骤之后,该方法还包括:
将行车路径发送至待停车辆,以使待停车辆显示行车路径和/或按照行车路径自动驾驶至目标点,并停入待停车位。
可选的,地图还包括指定场景中的多个停车区域,各停车区域包括至少一个车位,各车位包括多个车位点,一个车位的指定车位点连接至相邻路段的一个路径点;几何信息包括路径点的位置信息及航向角;
获取起始点信息及目标点信息的步骤,包括:
接收提车客户端发送的提车请求;
根据提车请求,确定待提车辆的位置信息和航向角为起始点信息、提车点的位置信息为目标点信息;
根据起始点信息及各路径点的几何信息,从地图中查找起始路径点的步骤,包括:
若待提车辆为相较于行车道路平行停放,则根据待提车辆的位置信息,从地图中查找待提车辆所停放的第二车位;确定第二车位的指定车位点连接的相邻路段上的路径点为候选起始路径点;若根据候选起始路径点的航向角及待提车辆的航向角,确定候选起始路径点与待提车辆的航向不一致,则查找与候选起始路径点所属单向路段相反航向的对向路段;若对向路段中与候选起始路径点最近的对向路径点的航向角与待提车辆的航向角之差小于预设阈值,则确定对向路径点为起始路径点;
若待提车辆为相较于行车道路垂直停放,则根据待提车辆的位置信息,从地图中查找待提车辆所停放的第三车位;确定第三车位的指定车位点连接的相邻路段上的路径点为候选起始路径点;确定候选起始路径点为起始路径点,或者,确定与候选起始路径点所属单向路段相反航向的对向路段中与候选起始路径点最近的对向路径点为起始路径点;
根据目标点信息及各路径点的几何信息,从地图中查找目标路径点的步骤,包括:
根据提车点的位置信息,从地图中查找距离提车点对应位置最近的路径点作为目标路径点。
可选的,在从地图中,确定路段序列中各单向路段的车道上从起始路径点至目标路径点之间的所有路径点组成的序列作为行车路径的步骤之后,该方法还包括:
将行车路径发送至提车客户端,以使提车客户端显示行车路径,和/或,将行车路径发送至待提车辆,以使待提车辆按照行车路径自动驾驶至提车点。
可选的,从起始路径点所属的起始单向路段开始,进行最优路段搜索,得到从起始单向路段至目标路径点所属的目标单向路段的路段序列的步骤,包括:
从起始路径点所属的起始单向路段开始执行:
步骤A,获取各下一单向路段的行车距离及从各下一单向路段的结束路径点至目标路径点的估计距离,并接收监控设备发送的各单向路段的通行信息;
步骤B,根据各下一单向路段的行车距离、从各下一单向路段的结束路径点至目标路径点的估计距离以及各下一单向路段的通行信息,计算各下一单向路段的路段代价;
步骤C,确定路段代价最小的下一单向路段为当前单向路段的目标下一单向路段;
循环执行步骤A至步骤C,直至搜索到目标路径点所属的目标单向路段,得到从起始单向路段至目标单向路段的路段序列。
第二方面,本申请实施例提供了一种行车路径规划装置,该装置包括:地图管理模块及路径规划模块;
地图管理模块,用于选择指定场景的地图,并将该地图下发至路径规划模块,其中,地图包括对指定场景中的行车道路分割得到的多个单向路段,各单向路段包括至少一条车道,各车道包括多个路径点,各路径点携带几何信息;
路径规划模块,用于获取起始点信息及目标点信息;根据起始点信息及各路径点的几何信息,从地图中查找起始路径点,并根据目标点信息及各路径点的几何信息,从地图中查找目标路径点;从起始路径点所属的起始单向路段开始,进行最优路段搜索,得到从起始单向路段至目标路径点所属的目标单向路段的路段序列;从地图中,确定路段序列中各单向路段的车道上从起始路径点至目标路径点之间的所有路径点组成的序列作为行车路径。
可选的,地图管理模块,具体用于:
获取指定场景的点云信息,其中,点云信息包括路网信息及多个停车区域的信息;
根据路网信息,对行车道路进行分割,得到多个单向路段,其中,各单向路段包括至少一条车道;
根据多个停车区域的信息,确定各停车区域中的车位;
在各车道上设置多个路径点、各车位上设置多个车位点,并对各路径点标注几何信息;
基于多个单向路段及多个停车区域,生成指定场景的地图。
可选的,地图还包括指定场景中的多个停车区域,各停车区域包括至少一个车位,各车位包括多个车位点,一个车位的指定车位点连接至相邻路段的一个路径点;几何信息包括路径点的位置信息及航向角;
该装置还包括:车位管理分配模块;
车位管理分配模块,用于接收监控设备发送的车位空闲信息,根据车位空闲信息及定位信息,为待停车辆分配待停车位,并将待停车位的位置信息和车位标识发送至路径规划模块;
路径规划模块,具体用于:
接收待停车辆发送的停车请求以及所述车位管理分配模块发送的待停车位的位置信息和车位标识;将停车请求携带的待停车辆的定位信息和航向角确定为起始点信息,将待停车位的位置信息和车位标识确定为目标点信息;
根据待停车辆发送的定位信息和航向角以及各路径点的位置信息和航向角,从地图中查找距离待停车辆对应位置最近、且与待停车辆的航向角之差小于预设阈值的路径点作为起始路径点;
根据待停车位的位置信息和车位标识,从地图中查找待停车位对应的第一车位;确定第一车位的指定车位点连接的相邻路段上的路径点为目标路径点。
可选的,路径规划模块,还用于:
将目标路径点沿航向角的正方向移动预设距离。
可选的,路径规划模块,还用于:
将行车路径发送至待停车辆,以使待停车辆显示行车路径和/或按照行车路径自动驾驶至目标点,并停入待停车位。
可选的,地图还包括指定场景中的多个停车区域,各停车区域包括至少一个车位,各车位包括多个车位点,一个车位的指定车位点连接至相邻路段的一个路径点;几何信息包括路径点的位置信息及航向角;
路径规划模块,具体用于:
接收提车客户端发送的提车请求;根据提车请求,确定待提车辆的位置信息和航向角为起始点信息、提车点的位置信息为目标点信息;
若待提车辆为相较于行车道路平行停放,则根据待提车辆的位置信息,从地图中查找待提车辆所停放的第二车位;确定第二车位的指定车位点连接的相邻路段上的路径点为候选起始路径点;若根据候选起始路径点的航向角及待提车辆的航向角,确定候选起始路径点与待提车辆的航向不一致,则查找与候选起始路径点所属单向路段相反航向的对向路段;若对向路段中与候选起始路径点最近的对向路径点的航向角与待提车辆的航向角之差小于预设阈值,则确定对向路径点为起始路径点;
若待提车辆为相较于行车道路垂直停放,则根据待提车辆的位置信息,从地图中查找待提车辆所停放的第三车位;确定第三车位的指定车位点连接的相邻路段上的路径点为候选起始路径点;确定候选起始路径点为起始路径点,或者,确定与候选起始路径点所属单向路段相反航向的对向路段中与候选起始路径点最近的对向路径点为起始路径点;
根据提车点的位置信息,从地图中查找距离提车点对应位置最近的路径点作为目标路径点。
可选的,路径规划模块,还用于:
将行车路径发送至提车客户端,以使提车客户端显示行车路径,和/或,将行车路径发送至待提车辆,以使待提车辆按照行车路径自动驾驶至提车点。
可选的,该装置还包括:交通流计算模块;
交通流计算模块,用于接收监控设备发送的各单向路段的通行信息,并将通行信息发送至路径规划模块;
路径规划模块,具体用于:
从起始路径点所属的起始单向路段开始执行:
步骤A,获取各下一单向路段的行车距离及从各下一单向路段的结束路径点至目标路径点的估计距离,并接收交通流计算模块发送的各单向路段的通行信息;
步骤B,根据各下一单向路段的行车距离、从各下一单向路段的结束路径点至目标路径点的估计距离以及各下一单向路段的通行信息,计算各下一单向路段的路段代价;
步骤C,确定路段代价最小的下一单向路段为当前单向路段的目标下一单向路段;
循环执行步骤A至步骤C,直至搜索到目标路径点所属的目标单向路段,得到从起始单向路段至目标单向路段的路段序列。
第三方面,本申请实施例提供了一种管理服务器,包括处理器和存储器,其中,存储器存储有能够被处理器执行的机器可执行指令,机器可执行指令由处理器加载并执行,以实现本申请实施例第一方面所提供的方法。
第四方面,本申请实施例提供了一种机器可读存储介质,机器可读存储介质内存储有机器可执行指令,机器可执行指令在被处理器加载并执行时,实现本申请实施例第一方面所提供的方法。
第五方面,本申请实施例提供了一种停车管理系统,该系统包括:管理服务器及车辆;
管理服务器,用于获取指定场景的地图、起始点信息及目标点信息,其中,地图包括对指定场景中的行车道路分割得到的多个单向路段,各单向路段包括至少一条车道,各车道包括多个路径点,各路径点携带几何信息;根据起始点信息及各路径点的几何信息,从地图中查找起始路径点,并根据目标点信息及各路径点的几何信息,从地图中查找目标路径点;从起始路径点所属的起始单向路段开始,进行最优路段搜索,得到从起始单向路段至目标路径点所属的目标单向路段的路段序列;从地图中,确定路段序列中各单向路段的车道上从起始路径点至目标路径点之间的所有路径点组成的序列作为行车路径,并将行车路径发送至车辆;
车辆,用于接收行车路径,并按照行车路径从起始点行驶至目标点。
可选的,管理服务器,还用于获取指定场景的点云信息,其中,点云信息包括路网信息及多个停车区域的信息;根据路网信息,对行车道路进行分割,得到多个单向路段,其中,各单向路段包括至少一条车道;根据多个停车区域的信息,确定各停车区域中的车位;在各车道上设置多个路径点、各车位上设置多个车位点,并对各路径点标注几何信息;基于多个单向路段及多个停车区域,生成指定场景的地图。
可选的,该系统还包括数据采集器;
数据采集器,用于采用预设的定位建图方法,获得指定场景的点云信息,并将指定场景的点云信息发送至管理服务器;
管理服务器,具体用于接收数据采集器发送的指定场景的点云信息。
可选的,地图还包括指定场景中的多个停车区域,各停车区域包括至少一个车位,各车位包括多个车位点,一个车位的指定车位点连接至相邻路段的一个路径点;几何信息包括路径点的位置信息及航向角;
车辆为待停车辆,该系统还包括监控设备;
待停车辆,还用于定位得到自身的定位信息和航向角,并向管理服务器发送停车请求,其中,停车请求携带定位信息和航向角;
监控设备,用于对指定场景进行监控,得到车位空闲信息,并将车位空闲信息发送至管理服务器;
管理服务器,具体用于接收待停车辆发送的停车请求,并将停车请求携带的待停车辆的定位信息和航向角确定为起始点信息;接收监控设备发送的车位空闲信息,根据车位空闲信息及定位信息,为待停车辆分配待停车位,并将待停车位的位置信息和车位标识确定为目标点信息;根据待停车辆发送的定位信息和航向角以及各路径点的位置信息和航向角,从地图中查找距离待停车辆对应位置最近、且与待停车辆的航向角之差小于预设阈值的路径点作为起始路径点;根据待停车位的位置信息和车位标识,从地图中查找待停车位对应的第一车位;确定第一车位的指定车位点连接的相邻路段上的路径点为目标路径点。
可选的,管理服务器,还用于将目标路径点沿航向角的正方向移动预设距离。
可选的,待停车辆,具体用于显示行车路径,和/或,按照行车路径自动驾驶至目标点,并停入待停车位。
可选的,地图还包括指定场景中的多个停车区域,各停车区域包括至少一个车位,各车位包括多个车位点,一个车位的指定车位点连接至相邻路段的一个路径点;几何信息包括路径点的位置信息及航向角;车辆为待提车辆;
该系统还包括:提车客户端;
提车客户端,用于向管理服务器发送提车请求;
管理服务器,具体用于接收提车客户端发送的提车请求;根据提车请求,确定待提车辆的位置信息和航向角为起始点信息、提车点的位置信息为目标点信息;若待提车辆为相较于行车道路平行停放,则根据待提车辆的位置信息,从地图中查找待提车辆所停放的第二车位;确定第二车位的指定车位点连接的相邻路段上的路径点为候选起始路径点;若根据候选起始路径点的航向角及待提车辆的航向角,确定候选起始路径点与待提车辆的航向不一致,则查找与候选起始路径点所属单向路段相反航向的对向路段;若对向路段中与候选起始路径点最近的对向路径点的航向角与待提车辆的航向角之差小于预设阈值,则确定对向路径点为起始路径点;若待提车辆为相较于行车道路垂直停放,则根据待提车辆的位置信息,从地图中查找待提车辆所停放的第三车位;确定第三车位的指定车位点连接的相邻路段上的路径点为候选起始路径点;确定候选起始路径点为起始路径点,或者,确定与候选起始路径点所属单向路段相反航向的对向路段中与候选起始路径点最近的对向路径点为起始路径点;根据提车点的位置信息,从地图中查找距离提车点对应位置最近的路径点作为目标路径点。
可选的,管理服务器,还用于将行车路线发送至提车客户端;
提车客户端,还用于显示行车路径;
待提车辆,具体用于按照行车路径自动驾驶至提车点。
可选的,该系统还包括监控设备;
监控设备,用于对指定场景进行监控,得到各单向路段的通行信息,并将各单向路段的通行信息发送至管理服务器;
管理服务器,具体用于从起始路径点所属的起始单向路段开始执行:步骤A,获取各下一单向路段的行车距离及从各下一单向路段的结束路径点至目标路径点的估计距离,并接收监控设备发送的各单向路段的通行信息;步骤B,根据各下一单向路段的行车距离、从各下一单向路段的结束路径点至目标路径点的估计距离以及各下一单向路段的通行信息,计算各下一单向路段的路段代价;步骤C,确定路段代价最小的下一单向路段为当前单向路段的目标下一单向路段;循环执行步骤A至步骤C,直至搜索到目标路径点所属的目标单向路段,得到从起始单向路段至目标单向路段的路段序列。
本申请实施例有益效果:
本申请实施例提供的一种行车路径规划方法、管理服务器及停车管理系统,方法包括:获取指定场景的地图、起始点信息及目标点信息,其中,地图包括对指定场景中的行车道路分割得到的多个单向路段,各单向路段包括至少一条车道,各车道包括多个路径点,各路径点携带几何信息;根据起始点信息及各路径点的几何信息,从地图中查找起始路径点,并根据目标点信息及各路径点的几何信息,从地图中查找目标路径点;从起始路径点所属的起始单向路段开始,进行最优路段搜索,得到从起始单向路段至目标路径点所属的目标单向路段的路段序列;从地图中,确定路段序列中各单向路段的车道上从起始路径点至目标路径点之间的所有路径点组成的序列作为行车路径。
本申请实施例中,行车路径规划所使用的地图包括对指定场景中的行车道路分割得到的多个单向路段,各单向路段包括至少一条车道,各车道包括多个路径点,各路径点携带几何信息,可以看出该地图为包含了拓扑信息和几何信息的混合地图。在进行行车路径规划时,在通过最优路段搜索得到从起始单向路段至目标单向路段的路段序列后,可以直接从地图中找到对应的路径点序列,该路径点序列即为全局的行车路径,避免了在每次进行行车路径规划时还需要进行插值计算等复杂运算,从而提高了行车路径规划的效率。
附图说明
为了更清楚地说明本申请实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本申请实施例的行车路径规划方法的流程示意图;
图2为本申请实施例的地图的元素组成示意图;
图3为本申请实施例的单向路段示意图;
图4为本申请实施例的停车区域示意图;
图5为本申请实施例的车道之间为实线的单向路段之间的连接关系示意图;
图6为本申请实施例的车道之间为虚线的单向路段之间的连接关系示意图;
图7为本申请实施例的路口交通的连接关系示意图;
图8为本申请实施例的单向路段和停车区域的连接示意图;
图9为本申请实施例的代客停车的流程示意图;
图10为本申请实施例的代客提车的流程示意图;
图11为本申请实施例的代客停车、代客提车的示例图;
图12为本申请一实施例的行车路径规划装置的结构示意图;
图13为本申请另一实施例的行车路径规划装置的结构示意图;
图14为本申请再一实施例的行车路径规划装置的结构示意图;
图15为本申请实施例的管理服务器的结构示意图;
图16为本申请一实施例的停车管理系统的结构示意图;
图17为本申请另一实施例的停车管理系统的结构示意图;
图18为本申请又一实施例的停车管理系统的结构示意图;
图19为本申请再一实施例的停车管理系统的结构示意图;
图20为本申请再一实施例的停车管理系统的结构示意图。
具体实施方式
下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。
为了提高行车路径规划的效率,本申请实施例提供了一种行车路径规划方法、管理服务器及停车管理系统。下面,首先对本申请实施例所提供的行车路径规划方法进行介绍。
本申请实施例所提供的行车路径规划方法的执行主体为管理服务器,该管理服务器是智能停车系统的后台管理设备,用于进行停车和提车的控制管理,以及行车路径的规划。实现本申请实施例所提供的行车路径规划方法的方式,可以为设置于管理服务器的软件、硬件电路和逻辑电路中的至少一种方式。
如图1所示,本申请实施例所提供的一种行车路径规划方法,可以包括如下步骤。
S101,获取指定场景的地图、起始点信息及目标点信息。
其中,指定场景的地图包括对指定场景中的行车道路分割得到的多个单向路段,各单向路段包括至少一条车道,各车道包括多个路径点,各路径点携带几何信息。
S102,根据起始点信息及各路径点的几何信息,从地图中查找起始路径点,并根据目标点信息及各路径点的几何信息,从地图中查找目标路径点。
S103,从起始路径点所属的起始单向路段开始,进行最优路段搜索,得到从起始单向路段至目标路径点所属的目标单向路段的路段序列。
S104,从地图中,确定路段序列中各单向路段的车道上从起始路径点至目标路径点之间的所有路径点组成的序列作为行车路径。
应用本申请实施例,行车路径规划所使用的地图包括对指定场景中的行车道路分割得到的多个单向路段,各单向路段包括至少一条车道,各车道包括多个路径点,各路径点携带几何信息,可以看出该地图为包含了拓扑信息和几何信息的混合地图。在进行行车路径规划时,在通过最优路段搜索得到从起始单向路段至目标单向路段的路段序列后,可以直接从地图中找到对应的路径点序列,该路径点序列即为全局的行车路径,避免了在每次进行行车路径规划时还需要进行插值计算等复杂运算,从而提高了行车路径规划的效率。
指定场景的地图为针对指定场景预先建立的高精度混合地图,该地图中即可体现指定场景中节点以及节点之间的连接关系的拓扑信息,也可以体现几何点、线、面的几何信息,也就是说,本申请实施例中的地图为指定场景的拓扑地图和几何地图有机结合后的混合地图。本申请实施例中的指定场景为划分有停车位的场景,例如停车场、市政路边停车位、小区地面停车位等,优选的,本申请实施例最为适用的场景为停车场。本申请实施例中的地图一般为高精地图,是一种用于自动驾驶的专题地图,由含有语义信息的车道模型、道路部件、道路属性三类矢量信息,以及用于多传感器定位的特征图层构成。地图中至少包括对指定场景中的行车道路分割得到的多个单向路段,每一个单向路段都包括至少一条车道,每一条车道包括多个路径点,每一个路径点都携带有几何信息。一个路径点的几何信息表征了该路径点的方向、位置等。
起始点信息是指行车路径规划的起始点对应的信息,例如在停车场景下,待停车辆的当前位置、待停车辆的航向等等,再如在提车场景下,待提车辆所处的车位位置、车位的朝向等等;目标点信息是指行车路径规划的目标点对应的信息,例如在停车场景下,待停车位的位置、待停车位的标识等等,再如在提车场景下,提车点的位置、方向等等。
可选的,地图的建立方式,具体可以包括如下步骤:
第一步,获取指定场景的点云信息,其中,点云信息包括路网信息及多个停车区域的信息。
第二步,根据路网信息,对行车道路进行分割,得到多个单向路段,其中,各单向路段包括至少一条车道。
第三步,根据多个停车区域的信息,确定各停车区域中的车位。
第四步,在各车道上设置多个路径点、各车位上设置多个车位点,并对各路径点标注几何信息。
第五步,基于多个单向路段及所述多个停车区域,生成指定场景的地图。
在进行行车路径规划之前,首先要建立对应的地图,可以采用预设的定位建图方法对指定场景进行建图,获得指定场景的3D点云信息,这里所提及的定位建图方法可以是SLAM(Simultaneous Localization and Mapping,同步建图与定位)、L-SLAM(Lidar-Simultaneous Localization and Mapping,激光同步建图与定位)等建图方式。指定场景的3D点云信息还可以是其他数据采集器(例如图像传感器、激光雷达等)根据定位建图方法得到,则可以直接从其他数据采集器中获取到指定场景的3D点云信息。从点云信息中可以提取到车道线、车位框线、可行驶区域、道路、车道等路网信息和停车区域的信息,根据路网信息,对行车道路进行分割,得到多个单向路段,并且根据多个停车区域的信息,确定各停车区域中的车位,再通过在各车道上设置多个路径点、各车位上设置多个车位点,并对各路径点标注几何信息,最后基于多个单向路段及多个停车区域,即可生成指定场景的地图。
如图2所示,地图的组成基元为:Segment(单向路段)、Lane(车道)、Zone(停车区域)、Spot(车位)、Waypoint(路径点/车位点)。Waypoint中主要包含了相对于全局坐标系的坐标(x,y),yaw(航向角),以及Curvature(曲率)等几何信息,Waypoint可以等间隔设置,例如每间隔0.1米设置一个Waypoint。
为了便于识别和应用,可以对地图中的各基元进行编号,Segment和Zone为一级基元,共享编号,编号形式为单个正整数x;Lane和Spot为二级基元,编号形式为两个正整数x.y,其中第一个正整数编号x为所属的Segment或者Zone的编号;Waypoint为三级基元,编号形式为三个正整数x.y.z,其中前两个正整数编号x.y为所属的Lane或者Spot的编号。
对于一条行车道路场景而言,Segment可以理解为对道路进行纵向分割,Lane可以理解为对道路进行横向分割,如图3所示,Segment中包含若干个相互平行的车道Lane,且同一个Segment中Lane的数量一定,沿着行驶方向,Lane在Segment中从左到右排列,编号从x.1开始,逐个增大,行车道路中Segment分割的原则如下:1.横向车道数量产生变化,即车道数增加或减少;2.车道数量超出限制;3.车道边线属性变化,即实线变成虚线或者虚线变成实线,表征了行驶方向的变化;4.几何形状发生明显变化,例如直行变成弯道。
Lane的中心线上设置若干个Waypoint,编号为x.y的Lane的入口第一个Waypoint编号为x.y.1,同一条Lane的Waypoint末尾编号沿着行驶方向逐个增大。
Segment和Lane的组合定义了单向路段的信息,而Zone和Spot的组合则定义了停车区域的信息,如图4所示,Zone的几何位置由若干个Waypoint定义角点,角点的编号为x.0.z,这些角点也被称为Perimeterpoint。Zone中包含若干个Spot,编号为x.y.z。Spot主要由5个Waypoint定义,其中编号x.y.1为Connectpoint点,一般是距车道最近的一条边框上的中点,负责和相连Lane中的Waypoint连接;x.y.2到x.y.5为Permeterpoint,负责定义Spot的几何信息,其中序号规定为Connectpoint起始,顺时针编号。
Segment(前)和Segment(后)之间的连接关系是由各自的Lane(前)和Lane(后)之间的连接关系组成的。Lane和Lane之间的连接关系内容包括几何连接关系和连接关系属性。
Lane和Lane之间的集合连接关系由Waypoint定义,内部车道之间均为实线的Segment相连时,由于车辆只能朝向一个方向行驶、不可变道,因此连接关系比较简单,如图5所示,只需将几何相连的Lane的首尾Waypoint定义相连即可。内部车道之间存在虚线的Segment相连时,由于车辆可以变线,连接关系将会变得比较复杂,如图6所示,几何连接关系需要反映前后Lane之间的连通性,因此需要增加许多可以通过变道实现的连接关系。
对于每一个具体的几何连接关系,连接关系中的Lane(前)都会定义该连接关系的连接关系属性(直行、左转、右转)以及其自身的类别(直行车道、左转车道、右转车道)。非路口的Segment相连均为一对一的连接,所有连接关系属性均为直行连接,Lane的类别均属于直行车道;路口的Segment相连一般是一对多的连接,此时连接关系属性和Lane的类别需要根据不同的连接关系进行区分定义。
在本申请实施例的地图中,不存在特定的路口数据,所有路口都是由若干个Segment组合得到的。如图7所示,1、2、3、4、5、6号Segment均为正常的单向Segment,其通过丁字路口实现连接,丁字路口中包含了7、8、9、10、11、12号Segment实现对1~6号Segment的连接。其中,7、8号Segment为直行Segment,分别连接1、6号和5、2号Segment;9、10号Segment为弯道Segment,分别连接1、4号和3、2号Segment;11、12号Segment为弯道Segment,分别连接3、6号和5、4号segment。
对于图7所示的Segment1的Lane1.1,针对Waypoint1.1.2和7.1.1定义的几何连接,Lane1.1定义的连接关系属性为直行,Lane1.1为直行车道;针对Waypoint1.1.2和9.1.1定义的几何连接,Lane1.1定义的连接关系属性为左转,Lane1.1为左转车道。
Segment(前)和Segment(后)之间的连接,几何连接关系最终都是由Lane(前)的最后一个Waypoint和Lane(前)的第一个Waypoint组成。Segment和Zone的连接,几何连接关系可以由Lane中的任一Waypoint和Spot中的Connectpoint相连,如图8所示。
综上所述,地图中,Segment包含Lane,Lane中包含有携带几何信息的Waypoint,Spot通过Waypoint与Lane进行关联。这样在后续进行行车路径规划时,可以选择使用Segment作为规划使用的拓扑图节点,在完成拓扑层的规划后,从对应的Segment以及目标点的位置可以直接从地图的Waypoint中输出可供自动驾驶使用的全局路径轨迹点。
在获取到指定场景的地图、起始点信息和目标点信息后,由于起始点信息和目标点信息为实际场景下的信息,需要对应的在地图中查找起始路径点和目标路径点,然后从起始路径点所属的起始单向路段开始,进行最优路段搜索,得到从起始单向路段至目标路径点所属的目标单向路段的路段序列。
基于上述的地图,车辆的起始点和目标点通常会归属于某一个Segment,把起始点归属的Segment定义为起始Segment,目标点归属的Segment定义为目标Segment。起始点和目标点的真实位置和地图中的路径点有对应关系,基于两个点的距离、航向角等参数,可以从地图中确定出起始路径点和目标路径点。再从起始Segment开始,进行最优路段搜索,一般是基于路段内的行驶距离、路段拥堵程度等进行搜索,搜索出到达目标Segment最快、最近的各Segment组成路段序列。由于每个Segment都包含了多个Waypoint,路段序列中各Segment的waypoint组合成的序列即可作为行车路径轨迹点。
在本申请实施例中,主要分为代客停车和代客提车两种情况,下面分别对这两种实施情况进行介绍。
如图9所示,代客停车的流程包括如下步骤。
第一步,用户通过HMI(Human Machine Interface,人机接口)触发停车操作。
HMI一般是车辆上安装的界面接口,也可以是停车场入口处设置的界面接口。用户在有停车需求时,可以在HMI上点击停车按键,以触发停车操作。
第二步,待停车辆上传定位结果到管理服务器作为行车路径规划的起始点信息。
在本申请实施例中,地图还可以包括指定场景中的多个停车区域,各停车区域包括至少一个车位,各车位包括多个车位点,一个车位的指定车位点连接至相邻路段的一个路径点。路径点的几何信息包括路径点的位置信息及航向角。具体获取起始点信息的步骤可以为:管理服务器接收待停车辆发送的停车请求,并将停车请求携带的待停车辆的定位信息和航向角确定为起始点信息。
第三步,管理服务器接收监控设备发送的车位空闲信息,根据车位空闲信息及定位信息,为待停车辆分配待停车位。
在停车系统的前端一般设置有监控设备,监控设备架设在指定场景的车位上方,用于监控对应车位的空闲与否,同时对这些监控设备可以进行标定,将监控设备的监控区域内的车位与地图中的Spot进行对应。监控设备可以通过有线或者无线的方式将视频流数据传输至管理服务器,视频流数据中携带有车位空闲信息。
管理服务器在接收到监控设备发送的车位空闲信息和待停车辆上传的定位信息后,可以根据车位空闲信息和定位信息,为待停车辆分配待停车位,分配待停车位的原则可以是基于车位与待停车辆的距离、停车区域内车位使用率等进行分配,车位分配不属于本申请实施例重点讨论的内容,因此这里不再详述。
第四步,管理服务器将待停车位的位置信息和车位标识作为行车路径规划的目标点信息。
在本申请实施例中,具体获取目标点信息的步骤可以为:管理服务器接收监控设备发送的车位空闲信息,根据车位空闲信息及待停车辆的定位信息,为待停车辆分配待停车位,并将待停车位的位置信息和车位标识确定为目标定信息。
可选的,在从地图中查找到目标路径点之后,还可以将目标路径点沿航向角的正方向移动预设距离。
由于车辆需要倒车入位,而确定出的目标路径点往往对着车位的中间位置,为了满足车辆倒车入位的要求,需要将确定出来的目标路径点沿着航向角的正方向移动一定的距离,该距离根据一般的停车经验进行设置。
第五步,管理服务器进行行车路径规划。
第六步,将行车路径发送至待停车辆。
待停车辆在接收到行车路径后,可以显示行车路径,也可以按照行车路径自动驾驶至目标点,并停入待停车位。待停车辆上可以安装有显示屏,在显示屏上显示出行车路径,用户则可以按照该行车路径将待停车辆开到目标点,然后再通过APA自动停车入位;用户还可以随意将待停车辆停下,然后离车,在进行行车路径规划后,通过AVP技术,待停车辆自动地驾驶至目标点,并自动停车入位。
在进行行车路径规划时,可以执行如下步骤:
步骤1,根据待停车辆发送的定位信息和航向角以及各路径点的位置信息和航向角,从地图中查找距离待停车辆对应位置最近、且与待停车辆的航向角之差小于预设阈值的路径点作为起始路径点。
步骤2,根据待停车位的位置信息和车位标识,从地图中查找待停车位对应的第一车位;确定第一车位的指定车位点连接的相邻路段上的路径点为目标路径点。
步骤3,从起始路径点所属的起始单向路段开始,进行最优路段搜索,得到从起始单向路段至目标路径点所属的目标单向路段的路段序列。
步骤4,从地图中,确定路段序列中各单向路段的车道上从起始路径点至目标路径点之间的所有路径点组成的序列作为行车路径。
可选的,上述步骤3具体可以通过如下方式实现:
从起始路径点所属的起始单向路段开始执行:
步骤A,获取各下一单向路段的行车距离及从各下一单向路段的结束路径点至目标路径点的估计距离,并接收监控设备发送的各单向路段的通行信息。
步骤B,根据各下一单向路段的行车距离、从各下一单向路段的结束路径点至目标路径点的估计距离以及各下一单向路段的通行信息,计算各下一单向路段的路段代价。
步骤C,确定路段代价最小的下一单向路段为当前单向路段的目标下一单向路段。
循环执行步骤A至步骤C,直至搜索到目标路径点所属的目标单向路段,得到从起始单向路段至目标单向路段的路段序列。
如上述实施例,在本申请实施例中采用地图进行行车路径规划,车辆的起始点和目标点通常会归属于某一个Segment,把起始点归属的Segment定义为起始Segment,目标点归属的Segment定义为目标Segment。假设整个拓扑图有n个Segment,设定静态代价向量为A=[a1,a2,…,ai,…,an],其中,ai为第i个Segment的代价,表征第i个Segment的行车距离。针对于起始Segment,ai可以记作从车辆的当前位置到该Segment的结束Waypoint的累计距离;针对目标Segment,ai可以记作从该Segment的起始Waypoint到目标路径点的累计距离,其他情况下,ai为整个Segment的长度,定义连通矩阵:
连通矩阵C为一个n*n的矩阵,其中,
在停车系统的前端设置的监控设备,还可以用于监控指定场景内道路的车流量情况和拥堵情况,将采集的通信信息发送给管理服务器,同时也需要对这些监控设备进行标定,将监控设备的监控区域内的车道与地图中的Segment进行对应。定义动态代价向量D=[d1,d2,…,di,…,dn]*k,用来表示Segment的通行代价,由监控设备发送的通信信息决定,其中,di表示第i个Segment的通行代价,如果该Segment通行无阻,则为0,如果该Segment被其他车辆堵死,不能行进,则为1,在0到1之间的变化区间表示该Segment的通行能力下降,但还是可以通行,k为尺度因子,具体的值由工程经验设定。
在进行行车路径规划之前,首先需要在地图中确定起始Segment和目标Segment,在代客停车的场景下,以待停车辆上报的定位信息为参考,在地图中寻找距离待停车辆对应位置最近、且与待停车辆的航向角之差小于预设阈值的路径点作为起始路径点,将起始路径点所属的Segment作为起始Segment。根据待停车位的位置信息和车位标识,从地图中寻找待停车位对应的第一车位,确定第一车位的指定车位点连接的相邻路段上的路径点为目标路径点,将目标路径点所属的Segment作为目标Segment。
定义路径规划算法的代价函数f(i)为:
f(i)=g(j)+k*di+h(i),其中,h(i)=|xi-xdes|+|yi-ydes|
上述代价函数f(i)为加权系数,加权系数由工程经验确定。g(j)可以为下一Segment的行车距离,也可以为从起始Segment到当前Segment的累计距离,di为第i个Segment的动态代价,h(i)为启发函数,用于描述下一Segment到达目标Segment的估计距离,此处使用下一Segment的结束路径点(xi,yi)至目标路径点(xdes,ydes)的欧式距离进行表示。
根据路径规划算法,从起始Segment开始,算法每一步会从连通矩阵C中寻找相邻路段,利用上述公式计算出各相邻的下一单向路段的f(i),并对比找出路段代价最小的下一单向路段作为当前单向路段的目标下一单向路段,如此循环直至找到目标Segment为止,此时即获得了全局的行车路径的路段序列,再结合地图中Segment和Waypoint的信息,输出Waypoint序列作为行车路径。
如图10所示,代客提车的流程包括如下步骤。
第一步,用户通过提车客户端发送提车请求。
第二步,管理服务器根据提车请求,确定待提车辆的位置信息和航向角为起始点信息、提车点的位置信息为目标点信息。
用户在通过提车客户端上传提车请求时,可以输入待提车辆的车牌号、停车位置等信息,根据这些信息,管理服务器可以确定出待提车辆的位置信息和航向角,将待提车辆的位置信息和航向角作为行车路径规划的起始点信息;用户在通过提车客户端上传提车请求时,还可以输入提车点的位置信息,即希望将车辆提到哪个位置,可以是提车客户端所在位置、停车场出口或者停车场内的任意位置等,管理服务器可以将提车点的位置信息作为目标点信息。
第三步,管理服务器进行行车路径规划。
第四步,将行车路径发送至提车客户端,和/或,将行车路径发送至待提车辆。
提车客户端在接收到行车路径后,可以显示行车路径,以便用户直观的观察到待提车辆从哪个方向行驶过来。待提车辆也可能会接收到行车路径,在接收到行车路径后,可以通过AVP技术,按照行车路径自动驾驶至提车点。
在进行行车路径规划时,可以执行如下步骤:
步骤1,判断待提车辆相较于行车道路是平行停放还是垂直停放,如果是平行停放则执行步骤2,如果是垂直停放则执行步骤3。
步骤2,根据待提车辆的位置信息,从地图中查找待提车辆所停放的第二车位;确定第二车位的指定车位点连接的相邻路段上的路径点为候选起始路径点;若根据候选起始路径点的航向角及待提车辆的航向角,确定候选起始路径点与待提车辆的航向不一致,则查找与候选起始路径点所属单向路段相反航向的对向路段;若对向路段中与候选起始路径点最近的对向路径点的航向角与待提车辆的航向角之差小于预设阈值,则确定对向路径点为起始路径点。
步骤3,根据待提车辆的位置信息,从地图中查找待提车辆所停放的第三车位;确定第三车位的指定车位点连接的相邻路段上的路径点为候选起始路径点;确定候选起始路径点为起始路径点,或者,确定与候选起始路径点所属单向路段相反航向的对向路段中与候选起始路径点最近的对向路径点为起始路径点。
步骤4,根据提车点的位置信息,从地图中查找距离提车点对应位置最近的路径点作为目标路径点。
步骤5,从起始路径点所属的起始单向路段开始,进行最优路段搜索,得到从起始单向路段至目标路径点所属的目标单向路段的路段序列。
步骤6,从地图中,确定路段序列中各单向路段的车道上从起始路径点至目标路径点之间的所有路径点组成的序列作为行车路径。
在代客提车的场景下进行行车路径规划时,首先需要判断待提车辆是平行停放还是垂直停放。如果是平行停放,则根据待提车辆的位置信息从地图中查找待提车辆所在的Spot,将Spot所连接的Segment作为候选起始Segment,所连接的Waypoint作为候选起始路径点,然后判断候选起始路径点是否与待提车辆的航向一致,如果一致则继续,不一致则将考察候选起始Segment的对向Segment(即相反航向的Segment)是否满足航向角要求,即判断对向Segment中与候选起始路径点最近的对向路径点的航向角与待提车辆的航向角之差是否小于预设阈值,如果满足,则将对向路径点作为新的起始路径点。
垂直停放因为左泊出和右泊出均可,则可以不考虑航向角。根据待提车辆的位置信息从地图中查找待提车辆所在的Spot,将Spot所连接的Segment作为候选起始Segment,所连接的Waypoint作为候选起始路径点。可以将该候选起始路径点确定为起始路径点,也可以将与候选Segment相反航向的对向Segment中与候选起始路径点最近的对向路径点确定为起始路径点。
路段序列的确定可以采用上述代客停车实施例中的方式,这里不再赘述。
下面结合具体实例,对本申请实施例所提供的代客停车和代客提车流程进行介绍,如图11所示。
实施例一:代客停车。
假设待停车辆位于Lane 3.1上,且车头朝上,规划得到的待停车位为Spot 14.1,根据车辆的位置和姿态选择Segment 3作为起始Segment,由于Spot 14.1的Waypoint14.1.1连接至Lane 6.1的Waypoint 6.1.3,则可以确定Segment 6作为目标Segment。
根据上述实施例中的路径规划算法开始搜索,Segment 3的下一Segment有Segment 10和Segment 11,根据代价计算函数,因为Segment 11距离目标Segment的距离更近,则选择Segment 11作为下一目标Segment,Segment 10留作候选考察路段。
因为Segment 11的下一Segment只有Segment 6,而Segment 6即为目标Segment,则退出路径搜索,规划的路段序列为:Segment 3-Segment 11-Segment 6。基于地图可以确定出行车路径为路径点序列:3.1.1-3.1.2-11.1.1-11.1.2-6.1.1-6.1.2-6.1.3。
实施例二:代客提车。
假设待提车辆位于Spot 13.1、提车点位于Lane 2.1上,由于Spot 13.1的Waypoint 13.1.1连接至Lane 5.1的Waypoint 5.1.1,则可以确定Segment 5作为起始Segment,根据提车点的位置选择Segment 2作为目的Segment。
根据上述实施例中的路径规划算法开始搜索,Segment 5的下一Segment有Segment 8和Segment 12,根据代价计算函数,因为Segment 8距离目标Segment的距离更近,则选择Segment 8作为下一目标Segment,Segment 12留作候选考察路段。
因为Segment 8的下一Segment只有Segment 2,而Segment 2即为目标Segment,则退出路径搜索,规划的路段序列为:Segment 5-Segment 8-Segment 2。基于地图可以确定出行车路径为路径点序列:5.1.1-5.1.2-5.1.3-8.1.1-8.1.2-2.1.1。
基于上述方法实施例,本申请实施例提供了一种行车路径规划装置,如图12所示,该装置包括:地图管理模块1210及路径规划模块1220;
地图管理模块1210,用于选择指定场景的地图,并将该地图下发至路径规划模块1220,其中,地图包括对指定场景中的行车道路分割得到的多个单向路段,各单向路段包括至少一条车道,各车道包括多个路径点,各路径点携带几何信息;
路径规划模块1220,用于获取起始点信息及目标点信息;根据起始点信息及各路径点的几何信息,从地图中查找起始路径点,并根据目标点信息及各路径点的几何信息,从地图中查找目标路径点;从起始路径点所属的起始单向路段开始,进行最优路段搜索,得到从起始单向路段至目标路径点所属的目标单向路段的路段序列;从地图中,确定路段序列中各单向路段的车道上从起始路径点至目标路径点之间的所有路径点组成的序列作为行车路径。
可选的,地图管理模块1210,具体可以用于:
获取指定场景的点云信息,其中,点云信息包括路网信息及多个停车区域的信息;
根据路网信息,对行车道路进行分割,得到多个单向路段,其中,各单向路段包括至少一条车道;
根据多个停车区域的信息,确定各停车区域中的车位;
在各车道上设置多个路径点、各车位上设置多个车位点,并对各路径点标注几何信息;
基于多个单向路段及多个停车区域,生成指定场景的地图。
可选的,地图还可以包括指定场景中的多个停车区域,各停车区域包括至少一个车位,各车位包括多个车位点,一个车位的指定车位点连接至相邻路段的一个路径点;几何信息包括路径点的位置信息及航向角;
路径规划模块1220,具体可以用于:
接收提车客户端发送的提车请求;根据提车请求,确定待提车辆的位置信息和航向角为起始点信息、提车点的位置信息为目标点信息;
若待提车辆为相较于行车道路平行停放,则根据待提车辆的位置信息,从地图中查找待提车辆所停放的第二车位;确定第二车位的指定车位点连接的相邻路段上的路径点为候选起始路径点;若根据候选起始路径点的航向角及待提车辆的航向角,确定候选起始路径点与待提车辆的航向不一致,则查找与候选起始路径点所属单向路段相反航向的对向路段;若对向路段中与候选起始路径点最近的对向路径点的航向角与待提车辆的航向角之差小于预设阈值,则确定对向路径点为起始路径点;
若待提车辆为相较于行车道路垂直停放,则根据待提车辆的位置信息,从地图中查找待提车辆所停放的第三车位;确定第三车位的指定车位点连接的相邻路段上的路径点为候选起始路径点;确定候选起始路径点为起始路径点,或者,确定与候选起始路径点所属单向路段相反航向的对向路段中与候选起始路径点最近的对向路径点为起始路径点;
根据提车点的位置信息,从地图中查找距离提车点对应位置最近的路径点作为目标路径点。
可选的,路径规划模块1220,还可以用于:
将行车路径发送至提车客户端,以使提车客户端显示行车路径,和/或,将行车路径发送至待提车辆,以使待提车辆按照行车路径自动驾驶至提车点。
应用本申请实施例,行车路径规划所使用的地图包括对指定场景中的行车道路分割得到的多个单向路段,各单向路段包括至少一条车道,各车道包括多个路径点,各路径点携带几何信息,可以看出该地图为包含了拓扑信息和几何信息的混合地图。在进行行车路径规划时,在通过最优路段搜索得到从起始单向路段至目标单向路段的路段序列后,可以直接从地图中找到对应的路径点序列,该路径点序列即为全局的行车路径,避免了在每次进行行车路径规划时还需要进行插值计算等复杂运算,从而提高了行车路径规划的效率。并且,通过将行车路径发送至提车客户端或者待停车辆,使得提车客户端显示行车路径,和/或,待提车辆按照行车路径自动驾驶至提车点,进而提高了代客提车的效率。
基于图12所示的行车路径规划装置,本申请实施例还提供了一种行车路径规划装置,如图13所示,该装置包括:地图管理模块1310、车位管理分配模块1320和路径规划模块1330。
地图管理模块1310,用于选择指定场景的地图,并将该地图下发至路径规划模块1330,其中,地图包括对指定场景中的行车道路分割得到的多个单向路段,各单向路段包括至少一条车道,各车道包括多个路径点,各路径点携带几何信息,地图还包括指定场景中的多个停车区域,各停车区域包括至少一个车位,各车位包括多个车位点,一个车位的指定车位点连接至相邻路段的一个路径点,几何信息包括路径点的位置信息及航向角;
车位管理分配模块1320,用于接收监控设备发送的车位空闲信息,根据车位空闲信息及定位信息,为待停车辆分配待停车位,并将待停车位的位置信息和车位标识发送至路径规划模块1330;
路径规划模块1330,用于接收待停车辆发送的停车请求以及车位管理分配模块1320发送的待停车位的位置信息和车位标识;将停车请求携带的待停车辆的定位信息和航向角确定为起始点信息,将待停车位的位置信息和车位标识确定为目标点信息;根据待停车辆发送的定位信息和航向角以及各路径点的位置信息和航向角,从地图中查找距离待停车辆对应位置最近、且与待停车辆的航向角之差小于预设阈值的路径点作为起始路径点;根据待停车位的位置信息和车位标识,从地图中查找待停车位对应的第一车位;确定第一车位的指定车位点连接的相邻路段上的路径点为目标路径点;从起始路径点所属的起始单向路段开始,进行最优路段搜索,得到从起始单向路段至目标路径点所属的目标单向路段的路段序列;从地图中,确定路段序列中各单向路段的车道上从起始路径点至目标路径点之间的所有路径点组成的序列作为行车路径。
可选的,路径规划模块1330,还可以用于:
将目标路径点沿航向角的正方向移动预设距离。
可选的,路径规划模块1330,还可以用于:
将行车路径发送至待停车辆,以使待停车辆显示行车路径和/或按照行车路径自动驾驶至目标点,并停入待停车位。
应用本申请实施例,行车路径规划所使用的地图包括对指定场景中的行车道路分割得到的多个单向路段,各单向路段包括至少一条车道,各车道包括多个路径点,各路径点携带几何信息,可以看出该地图为包含了拓扑信息和几何信息的混合地图。在进行行车路径规划时,在通过最优路段搜索得到从起始单向路段至目标单向路段的路段序列后,可以直接从地图中找到对应的路径点序列,该路径点序列即为全局的行车路径,避免了在每次进行行车路径规划时还需要进行插值计算等复杂运算,从而提高了行车路径规划的效率。并且,通过将行车路径发送至待停车辆,使得待停车辆能够显示行车路径和/或按照行车路径自动驾驶至目标点停入待停车位,进而提高了代客停车的效率。
基于图12所示的行车路径规划装置,本申请实施例还提供了一种行车路径规划装置,如图14所示,该装置包括:地图管理模块1410、交通流计算模块1420和路径规划模块1430;
地图管理模块1410,用于选择指定场景的地图,并将该地图下发至路径规划模块1430,其中,地图包括对指定场景中的行车道路分割得到的多个单向路段,各单向路段包括至少一条车道,各车道包括多个路径点,各路径点携带几何信息;
交通流计算模块1420,用于接收监控设备发送的各单向路段的通行信息,并将通行信息发送至路径规划模块1430;
路径规划模块1430,用于获取起始点信息及目标点信息;根据起始点信息及各路径点的几何信息,从地图中查找起始路径点,并根据目标点信息及各路径点的几何信息,从地图中查找目标路径点;从起始路径点所属的起始单向路段开始执行:步骤A,获取各下一单向路段的行车距离及从各下一单向路段的结束路径点至目标路径点的估计距离,并接收交通流计算模块发送的各单向路段的通行信息;步骤B,根据各下一单向路段的行车距离、从各下一单向路段的结束路径点至目标路径点的估计距离以及各下一单向路段的通行信息,计算各下一单向路段的路段代价;步骤C,确定路段代价最小的下一单向路段为当前单向路段的目标下一单向路段;循环执行步骤A至步骤C,直至搜索到目标路径点所属的目标单向路段,得到从起始单向路段至目标单向路段的路段序列;从地图中,确定路段序列中各单向路段的车道上从起始路径点至目标路径点之间的所有路径点组成的序列作为行车路径。
应用本申请实施例,行车路径规划所使用的地图包括对指定场景中的行车道路分割得到的多个单向路段,各单向路段包括至少一条车道,各车道包括多个路径点,各路径点携带几何信息,可以看出该地图为包含了拓扑信息和几何信息的混合地图。在进行行车路径规划时,在通过最优路段搜索得到从起始单向路段至目标单向路段的路段序列后,可以直接从地图中找到对应的路径点序列,该路径点序列即为全局的行车路径,避免了在每次进行行车路径规划时还需要进行插值计算等复杂运算,从而提高了行车路径规划的效率。并且,在进行行车路径规划时,考虑单向路段的通行信息,避免路段拥堵,能够提高代客停车或者代客提车的效率。
本申请实施例提供了一种管理服务器,如图15所示,包括处理器1501和存储器1502,其中,存储器1501存储有能够被处理器1502执行的机器可执行指令,机器可执行指令由处理器1502加载并执行,以实现本申请实施例所提的行车路径规划方法。
上述存储器可以包括RAM(Random Access Memory,随机存取存储器),也可以包括NVM(Non-volatile Memory,非易失性存储器),例如至少一个磁盘存储器。可选的,存储器还可以是至少一个位于远离前述处理器的存储装置。
上述处理器可以是通用处理器,包括CPU、NP(Network Processor,网络处理器)等;还可以是DSP(Digital Signal Processor,数字信号处理器)、ASIC(ApplicationSpecific Integrated Circuit,专用集成电路)、FPGA(Field-Programmable Gate Array,现场可编程门阵列)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件。
存储器1502与处理器1501之间可以通过有线连接或者无线连接的方式进行数据传输,并且管理服务器与其他设备之间可以通过有线通信接口或者无线通信接口进行通信。图15所示的仅为通过总线进行数据传输的示例,不作为具体连接方式的限定。
本申请实施例中,处理器通过读取存储器中存储的机器可执行指令,并通过加载和执行机器可执行指令,能够实现:行车路径规划所使用的地图包括对指定场景中的行车道路分割得到的多个单向路段,各单向路段包括至少一条车道,各车道包括多个路径点,各路径点携带几何信息,可以看出该地图为包含了拓扑信息和几何信息的混合地图。在进行行车路径规划时,在通过最优路段搜索得到从起始单向路段至目标单向路段的路段序列后,可以直接从地图中找到对应的路径点序列,该路径点序列即为全局的行车路径,避免了在每次进行行车路径规划时还需要进行插值计算等复杂运算,从而提高了行车路径规划的效率。
另外,本申请实施例提供了一种机器可读存储介质,该机器可读存储介质内存储有机器可执行指令,机器可执行指令在被处理器加载并执行时,实现本申请实施例所提供的行车路径规划方法。
本申请实施例中,机器可读存储介质存储有在运行时执行本申请实施例所提供的行车路径规划方法的机器可执行指令,因此能够实现:行车路径规划所使用的地图包括对指定场景中的行车道路分割得到的多个单向路段,各单向路段包括至少一条车道,各车道包括多个路径点,各路径点携带几何信息,可以看出该地图为包含了拓扑信息和几何信息的混合地图。在进行行车路径规划时,在通过最优路段搜索得到从起始单向路段至目标单向路段的路段序列后,可以直接从地图中找到对应的路径点序列,该路径点序列即为全局的行车路径,避免了在每次进行行车路径规划时还需要进行插值计算等复杂运算,从而提高了行车路径规划的效率。
本申请实施例提供了一种停车管理系统,如图16所示,该系统包括:管理服务器1610及车辆1620;
管理服务器1610,用于获取指定场景的地图、起始点信息及目标点信息,其中,地图包括对指定场景中的行车道路分割得到的多个单向路段,各单向路段包括至少一条车道,各车道包括多个路径点,各路径点携带几何信息;根据起始点信息及各路径点的几何信息,从地图中查找起始路径点,并根据目标点信息及各路径点的几何信息,从地图中查找目标路径点;从起始路径点所属的起始单向路段开始,进行最优路段搜索,得到从起始单向路段至目标路径点所属的目标单向路段的路段序列;从地图中,确定路段序列中各单向路段的车道上从起始路径点至目标路径点之间的所有路径点组成的序列作为行车路径,并将行车路径发送至车辆1620;
车辆1620,用于接收行车路径,并按照行车路径从起始点行驶至目标点。
可选的,管理服务器1610,还可以用于:
获取指定场景的点云信息,其中,点云信息包括路网信息及多个停车区域的信息;根据路网信息,对行车道路进行分割,得到多个单向路段,其中,各单向路段包括至少一条车道;根据多个停车区域的信息,确定各停车区域中的车位;在各车道上设置多个路径点、各车位上设置多个车位点,并对各路径点标注几何信息;基于多个单向路段及多个停车区域,生成指定场景的地图。
可选的,该系统还可以包括数据采集器;
数据采集器,用于采用预设的定位建图方法,获得指定场景的点云信息,并将指定场景的点云信息发送至管理服务器;
管理服务器,具体可以用于接收数据采集器发送的指定场景的点云信息。
管理服务器可以自身具有点云信息计算的功能,即管理服务器可以自己采用定位建图方法获得指定场景的点云信息;也可以在系统中布置一台数据采集器,例如图像传感器、激光雷达等。例如,由数据采集器采用定位建图方法获得指定场景的点云信息,管理服务器从数据采集器中获取该指定场景的点云信息。又例如,利用激光雷达采集指定场景的点云信息。又例如,利用TOF(Time of flight)飞行时间相机采集指定场景的点云信息。
应用本申请实施例,行车路径规划所使用的地图包括对指定场景中的行车道路分割得到的多个单向路段,各单向路段包括至少一条车道,各车道包括多个路径点,各路径点携带几何信息,可以看出该地图为包含了拓扑信息和几何信息的混合地图。在进行行车路径规划时,在通过最优路段搜索得到从起始单向路段至目标单向路段的路段序列后,可以直接从地图中找到对应的路径点序列,该路径点序列即为全局的行车路径,避免了在每次进行行车路径规划时还需要进行插值计算等复杂运算,从而提高了行车路径规划的效率。
基于图16所示的系统,本申请实施例还提供了一种停车管理系统,如图17所示,该系统包括:监控设备1710、管理服务器1720、待停车辆1730;
待停车辆1730,用于定位得到自身的定位信息和航向角,并向管理服务器1720发送停车请求,其中,停车请求携带定位信息和航向角;
监控设备1710,用于对指定场景进行监控,得到车位空闲信息,并将车位空闲信息发送至管理服务器1720;
管理服务器1720,用于获取指定场景的地图、起始点信息及目标点信息,其中,地图包括对指定场景中的行车道路分割得到的多个单向路段,各单向路段包括至少一条车道,各车道包括多个路径点,各路径点携带几何信息,指定场景中的多个停车区域,各停车区域包括至少一个车位,各车位包括多个车位点,一个车位的指定车位点连接至相邻路段的一个路径点,几何信息包括路径点的位置信息及航向角;接收待停车辆发送的停车请求,并将停车请求携带的待停车辆的定位信息和航向角确定为起始点信息;接收监控设备发送的车位空闲信息,根据车位空闲信息及定位信息,为待停车辆分配待停车位,并将待停车位的位置信息和车位标识确定为目标点信息;根据待停车辆发送的定位信息和航向角以及各路径点的位置信息和航向角,从地图中查找距离待停车辆对应位置最近、且与待停车辆的航向角之差小于预设阈值的路径点作为起始路径点;根据待停车位的位置信息和车位标识,从地图中查找待停车位对应的第一车位;确定第一车位的指定车位点连接的相邻路段上的路径点为目标路径点;从起始路径点所属的起始单向路段开始,进行最优路段搜索,得到从起始单向路段至目标路径点所属的目标单向路段的路段序列;从地图中,确定路段序列中各单向路段的车道上从起始路径点至目标路径点之间的所有路径点组成的序列作为行车路径,并将行车路径发送至待停车辆1730;
待停车辆1730,还用于接收行车路径,并按照行车路径从起始点行驶至目标点。
可选的,管理服务器1720,还可以用于:将目标路径点沿航向角的正方向移动预设距离。
可选的,待停车辆1730,具体可以用于:显示行车路径,和/或,按照行车路径自动驾驶至目标点,并停入待停车位。
应用本申请实施例,行车路径规划所使用的地图包括对指定场景中的行车道路分割得到的多个单向路段,各单向路段包括至少一条车道,各车道包括多个路径点,各路径点携带几何信息,可以看出该地图为包含了拓扑信息和几何信息的混合地图。在进行行车路径规划时,在通过最优路段搜索得到从起始单向路段至目标单向路段的路段序列后,可以直接从地图中找到对应的路径点序列,该路径点序列即为全局的行车路径,避免了在每次进行行车路径规划时还需要进行插值计算等复杂运算,从而提高了行车路径规划的效率。并且,通过将行车路径发送至待停车辆,使得待停车辆能够显示行车路径和/或按照行车路径自动驾驶至目标点停入待停车位,进而提高了代客停车的效率。
基于图16所示的系统,本申请实施例还提供了一种停车管理系统,如图18所示,该系统包括:提车客户端1810、管理服务器1820、待提车辆1830;
提车客户端1810,用于向管理服务器1820发送提车请求;
管理服务器1820,用于获取指定场景的地图、起始点信息及目标点信息,其中,地图包括对指定场景中的行车道路分割得到的多个单向路段,各单向路段包括至少一条车道,各车道包括多个路径点,各路径点携带几何信息,指定场景中的多个停车区域,各停车区域包括至少一个车位,各车位包括多个车位点,一个车位的指定车位点连接至相邻路段的一个路径点,几何信息包括路径点的位置信息及航向角;接收提车客户端发送的提车请求;根据提车请求,确定待提车辆的位置信息和航向角为起始点信息、提车点的位置信息为目标点信息;若待提车辆为相较于行车道路平行停放,则根据待提车辆的位置信息,从地图中查找待提车辆所停放的第二车位;确定第二车位的指定车位点连接的相邻路段上的路径点为候选起始路径点;若根据候选起始路径点的航向角及待提车辆的航向角,确定候选起始路径点与待提车辆的航向不一致,则查找与候选起始路径点所属单向路段相反航向的对向路段;若对向路段中与候选起始路径点最近的对向路径点的航向角与待提车辆的航向角之差小于预设阈值,则确定对向路径点为起始路径点;若待提车辆为相较于行车道路垂直停放,则根据待提车辆的位置信息,从地图中查找待提车辆所停放的第三车位;确定第三车位的指定车位点连接的相邻路段上的路径点为候选起始路径点;确定候选起始路径点为起始路径点,或者,确定与候选起始路径点所属单向路段相反航向的对向路段中与候选起始路径点最近的对向路径点为起始路径点;根据提车点的位置信息,从地图中查找距离提车点对应位置最近的路径点作为目标路径点;从起始路径点所属的起始单向路段开始,进行最优路段搜索,得到从起始单向路段至目标路径点所属的目标单向路段的路段序列;从地图中,确定路段序列中各单向路段的车道上从起始路径点至目标路径点之间的所有路径点组成的序列作为行车路径,并将行车路径发送至待提车辆1830;
待提车辆1830,用于接收行车路径,并按照行车路径从起始点行驶至目标点。
可选的,管理服务器1820,还可以用于将行车路线发送至提车客户端1810;
提车客户端1810,还可以用于显示行车路径;
待提车辆1830,具体可以用于按照行车路径自动驾驶至提车点。
应用本申请实施例,行车路径规划所使用的地图包括对指定场景中的行车道路分割得到的多个单向路段,各单向路段包括至少一条车道,各车道包括多个路径点,各路径点携带几何信息,可以看出该地图为包含了拓扑信息和几何信息的混合地图。在进行行车路径规划时,在通过最优路段搜索得到从起始单向路段至目标单向路段的路段序列后,可以直接从地图中找到对应的路径点序列,该路径点序列即为全局的行车路径,避免了在每次进行行车路径规划时还需要进行插值计算等复杂运算,从而提高了行车路径规划的效率。并且,通过将行车路径发送至提车客户端或者待停车辆,使得提车客户端显示行车路径,和/或,待提车辆按照行车路径自动驾驶至提车点,进而提高了代客提车的效率。
基于图16所示的系统,本申请实施例还提供了一种停车管理系统,如图19所示,该系统包括:监控设备1910、管理服务器1920、车辆1930;
监控设备1910,用于对指定场景进行监控,得到各单向路段的通行信息,并将各单向路段的通行信息发送至管理服务器1920;
管理服务器1920,用于获取指定场景的地图、起始点信息及目标点信息,其中,地图包括对指定场景中的行车道路分割得到的多个单向路段,各单向路段包括至少一条车道,各车道包括多个路径点,各路径点携带几何信息;根据起始点信息及各路径点的几何信息,从地图中查找起始路径点,并根据目标点信息及各路径点的几何信息,从地图中查找目标路径点;从起始路径点所属的起始单向路段开始执行:步骤A,获取各下一单向路段的行车距离及从各下一单向路段的结束路径点至目标路径点的估计距离,并接收监控设备发送的各单向路段的通行信息;步骤B,根据各下一单向路段的行车距离、从各下一单向路段的结束路径点至目标路径点的估计距离以及各下一单向路段的通行信息,计算各下一单向路段的路段代价;步骤C,确定路段代价最小的下一单向路段为当前单向路段的目标下一单向路段;循环执行步骤A至步骤C,直至搜索到目标路径点所属的目标单向路段,得到从起始单向路段至目标单向路段的路段序列;从地图中,确定路段序列中各单向路段的车道上从起始路径点至目标路径点之间的所有路径点组成的序列作为行车路径,并将行车路径发送至车辆1930。
车辆1930,用于接收行车路径,并按照行车路径从起始点行驶至目标点。
应用本申请实施例,行车路径规划所使用的地图包括对指定场景中的行车道路分割得到的多个单向路段,各单向路段包括至少一条车道,各车道包括多个路径点,各路径点携带几何信息,可以看出该地图为包含了拓扑信息和几何信息的混合地图。在进行行车路径规划时,在通过最优路段搜索得到从起始单向路段至目标单向路段的路段序列后,可以直接从地图中找到对应的路径点序列,该路径点序列即为全局的行车路径,避免了在每次进行行车路径规划时还需要进行插值计算等复杂运算,从而提高了行车路径规划的效率。并且,在进行行车路径规划时,考虑单向路段的通行信息,避免路段拥堵,能够提高代客停车或者代客提车的效率。
对于装置、管理服务器、机器可读存储介质及停车管理系统实施例而言,由于其涉及的方法内容基本相似于前述的方法实施例,所以描述的比较简单,相关之处参见方法实施例的部分说明即可。
在一种实施方式下,停车管理系统的系统框架如图20所示,该停车管理系统包括三个主体设备,其中,监控设备为布设在停车场内的多个摄像机,这些摄像机主要负责两个功能。一是监控车位占用情况,即对应车位的空闲与否,同时对这些摄像机进行标定,将其所监控区域内的车位与停车场地图中的车位Spot进行对应;二是监控通行情况,即停车场内道路的车流量情况和拥堵情况,同时也需要对这些摄像机进行标定,将其所监控区域内的车道与停车场地图中的单向路段Segment进行对应。这些摄像机通过有线或者无线的方式将视频流数据传输至管理服务器。
管理服务器由四个模块:车位管理分配模块、交通流计算模块、地图管理模块和路径规划模块。
车位管理分配模块主要负责接收监控摄像机的数据和待停车辆上报的定位数据,根据车位空闲情况和待停车辆的位置,为待停车辆分配待停车位,并将待停车位的车位位置发送给路径规划模块。
交通流计算模块主要负责接收监控摄像机发送的各个路段的监控数据,对出现在路段上的车辆进行跟踪和统计,以单位时间经过的车辆数目和平均通行速度作为惩罚项,计算得到路段的动态通行代价,供路径规划模块使用。
地图管理模块主要负责响应待停车辆向管理服务器发出的停车请求,根据待提车辆上报的位置选择停车场地图,并将停车场地图下发到待停车辆和路径规划模块,供HMI显示和路径规划。
路径规划模块主要负责进行行车路径规划,具体的路径规划过程见上述方法实施例,这里不再赘述。
车辆中包括两个模块,一是车辆的自定位模块,用于获得车辆位姿、用户位置等,并上报给管理服务器;二是HMI模块,用于接收和显示管理服务器下发的行车路径。除此之外,在代客提车功能中,用户可以通过HMI模块上传用户想让车辆到达的目标点。
需要说明的是,在本文中,诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。
本说明书中的各个实施例均采用相关的方式描述,各个实施例之间相同相似的部分互相参见即可,每个实施例重点说明的都是与其他实施例的不同之处。尤其,对于装置、管理服务器、机器可读存储介质及停车管理系统实施例而言,由于其基本相似于方法实施例,所以描述的比较简单,相关之处参见方法实施例的部分说明即可。
以上所述仅为本申请的较佳实施例而已,并非用于限定本申请的保护范围。凡在本申请的精神和原则之内所作的任何修改、等同替换、改进等,均包含在本申请的保护范围内。
Claims (19)
1.一种行车路径规划方法,其特征在于,所述方法包括:
获取指定场景的地图、起始点信息及目标点信息,其中,所述地图包括对所述指定场景中的行车道路分割得到的多个单向路段,各单向路段包括至少一条车道,各车道包括多个路径点,各路径点携带几何信息;所述几何信息包括路径点的位置信息及航向角;
根据所述起始点信息及所述各路径点的几何信息,从所述地图中查找起始路径点,并根据所述目标点信息及所述各路径点的几何信息,从所述地图中查找目标路径点;
从所述起始路径点所属的起始单向路段开始,进行最优路段搜索,得到从所述起始单向路段至所述目标路径点所属的目标单向路段的路段序列;
从所述地图中,确定所述路段序列中各单向路段的车道上从所述起始路径点至所述目标路径点之间的所有路径点组成的序列作为行车路径。
2.根据权利要求1所述的方法,其特征在于,所述指定场景为停车场。
3.根据权利要求1所述的方法,其特征在于,所述地图的建立方式,包括:
获取所述指定场景的点云信息,其中,所述点云信息包括路网信息及多个停车区域的信息;
根据所述路网信息,对所述行车道路进行分割,得到多个单向路段,其中,各单向路段包括至少一条车道;
根据所述多个停车区域的信息,确定各停车区域中的车位;
在各车道上设置多个路径点、各车位上设置多个车位点,并对各路径点标注几何信息;
基于所述多个单向路段及所述多个停车区域,生成所述指定场景的地图。
4.根据权利要求1所述的方法,其特征在于,所述地图还包括所述指定场景中的多个停车区域,各停车区域包括至少一个车位,各车位包括多个车位点,一个车位的指定车位点连接至相邻路段的一个路径点;
获取起始点信息及目标点信息,包括:
接收待停车辆发送的停车请求,并将所述停车请求携带的所述待停车辆的定位信息和航向角确定为起始点信息;
接收监控设备发送的车位空闲信息,根据所述车位空闲信息及所述定位信息,为所述待停车辆分配待停车位,并将所述待停车位的位置信息和车位标识确定为目标点信息;
所述根据所述起始点信息及所述各路径点的几何信息,从所述地图中查找起始路径点,包括:
根据所述待停车辆发送的定位信息和航向角以及所述各路径点的位置信息和航向角,从所述地图中查找距离所述待停车辆对应位置最近、且与所述待停车辆的航向角之差小于预设阈值的路径点作为起始路径点;
所述根据所述目标点信息及所述各路径点的几何信息,从所述地图中查找目标路径点,包括:
根据所述待停车位的位置信息和车位标识,从所述地图中查找所述待停车位对应的第一车位;
确定所述第一车位的指定车位点连接的相邻路段上的路径点为目标路径点。
5.根据权利要求4所述的方法,其特征在于,在所述根据所述目标点信息及所述各路径点的几何信息,从所述地图中查找目标路径点之后,所述方法还包括:
将所述目标路径点沿航向角的正方向移动预设距离。
6.根据权利要求4所述的方法,其特征在于,在所述从所述地图中,确定所述路段序列中各单向路段的车道上从所述起始路径点至所述目标路径点之间的所有路径点组成的序列作为行车路径之后,所述方法还包括:
将所述行车路径发送至所述待停车辆,以使所述待停车辆显示所述行车路径和/或按照所述行车路径自动驾驶至所述目标点,并停入所述待停车位。
7.根据权利要求1所述的方法,其特征在于,所述地图还包括所述指定场景中的多个停车区域,各停车区域包括至少一个车位,各车位包括多个车位点,一个车位的指定车位点连接至相邻路段的一个路径点;
获取起始点信息及目标点信息,包括:
接收提车客户端发送的提车请求;
根据所述提车请求,确定待提车辆的位置信息和航向角为起始点信息、提车点的位置信息为目标点信息;
所述根据所述起始点信息及所述各路径点的几何信息,从所述地图中查找起始路径点,包括:
若所述待提车辆为相较于行车道路平行停放,则根据所述待提车辆的位置信息,从所述地图中查找所述待提车辆所停放的第二车位;确定所述第二车位的指定车位点连接的相邻路段上的路径点为候选起始路径点;若根据所述候选起始路径点的航向角及所述待提车辆的航向角,确定所述候选起始路径点与所述待提车辆的航向不一致,则查找与所述候选起始路径点所属单向路段相反航向的对向路段;若所述对向路段中与所述候选起始路径点最近的对向路径点的航向角与所述待提车辆的航向角之差小于预设阈值,则确定所述对向路径点为起始路径点;
若所述待提车辆为相较于行车道路垂直停放,则根据所述待提车辆的位置信息,从所述地图中查找所述待提车辆所停放的第三车位;确定所述第三车位的指定车位点连接的相邻路段上的路径点为候选起始路径点;确定所述候选起始路径点为起始路径点,或者,确定与所述候选起始路径点所属单向路段相反航向的对向路段中与所述候选起始路径点最近的对向路径点为起始路径点;
所述根据所述目标点信息及所述各路径点的几何信息,从所述地图中查找目标路径点,包括:
根据所述提车点的位置信息,从所述地图中查找距离所述提车点对应位置最近的路径点作为目标路径点。
8.根据权利要求7所述的方法,其特征在于,在所述从所述地图中,确定所述路段序列中各单向路段的车道上从所述起始路径点至所述目标路径点之间的所有路径点组成的序列作为行车路径之后,所述方法还包括:
将所述行车路径发送至所述提车客户端,以使所述提车客户端显示所述行车路径,和/或,将所述行车路径发送至所述待提车辆,以使所述待提车辆按照所述行车路径自动驾驶至所述提车点。
9.根据权利要求1所述的方法,其特征在于,所述从所述起始路径点所属的起始单向路段开始,进行最优路段搜索,得到从所述起始单向路段至所述目标路径点所属的目标单向路段的路段序列,包括:
从所述起始路径点所属的起始单向路段开始执行:
步骤A,获取各下一单向路段的行车距离及从所述各下一单向路段的结束路径点至所述目标路径点的估计距离,并接收监控设备发送的各单向路段的通行信息;
步骤B,根据所述各下一单向路段的行车距离、从所述各下一单向路段的结束路径点至所述目标路径点的估计距离以及所述各下一单向路段的通行信息,计算所述各下一单向路段的路段代价;
步骤C,确定路段代价最小的下一单向路段为当前单向路段的目标下一单向路段;
循环执行步骤A至步骤C,直至搜索到所述目标路径点所属的目标单向路段,得到从所述起始单向路段至所述目标单向路段的路段序列。
10.一种管理服务器,其特征在于,包括处理器和存储器,其中,所述存储器存储有能够被所述处理器执行的机器可执行指令,所述机器可执行指令由所述处理器加载并执行,以实现权利要求1-9任一项所述的方法。
11.一种停车管理系统,其特征在于,所述系统包括:管理服务器及车辆;
所述管理服务器,用于获取指定场景的地图、起始点信息及目标点信息,其中,所述地图包括对所述指定场景中的行车道路分割得到的多个单向路段,各单向路段包括至少一条车道,各车道包括多个路径点,各路径点携带几何信息;所述几何信息包括路径点的位置信息及航向角;根据所述起始点信息及所述各路径点的几何信息,从所述地图中查找起始路径点,并根据所述目标点信息及所述各路径点的几何信息,从所述地图中查找目标路径点;从所述起始路径点所属的起始单向路段开始,进行最优路段搜索,得到从所述起始单向路段至所述目标路径点所属的目标单向路段的路段序列;从所述地图中,确定所述路段序列中各单向路段的车道上从所述起始路径点至所述目标路径点之间的所有路径点组成的序列作为行车路径,并将所述行车路径发送至所述车辆;
所述车辆,用于接收所述行车路径,并按照所述行车路径从所述起始点行驶至所述目标点。
12.根据权利要求11所述的系统,其特征在于,所述管理服务器,还用于:
获取所述指定场景的点云信息,其中,所述点云信息包括路网信息及多个停车区域的信息;根据所述路网信息,对所述行车道路进行分割,得到多个单向路段,其中,各单向路段包括至少一条车道;根据所述多个停车区域的信息,确定各停车区域中的车位;在各车道上设置多个路径点、各车位上设置多个车位点,并对各路径点标注几何信息;基于所述多个单向路段及所述多个停车区域,生成所述指定场景的地图。
13.根据权利要求12所述的系统,其特征在于,所述系统还包括数据采集器;
所述数据采集器,用于采用预设的定位建图方法,获得所述指定场景的点云信息,并将所述指定场景的点云信息发送至所述管理服务器;
所述管理服务器,具体用于接收所述数据采集器发送的所述指定场景的点云信息。
14.根据权利要求11所述的系统,其特征在于,所述地图还包括所述指定场景中的多个停车区域,各停车区域包括至少一个车位,各车位包括多个车位点,一个车位的指定车位点连接至相邻路段的一个路径点;所述几何信息包括路径点的位置信息及航向角;
所述车辆为待停车辆,所述系统还包括监控设备;
所述待停车辆,还用于定位得到自身的定位信息和航向角,并向所述管理服务器发送停车请求,所述停车请求携带所述定位信息和航向角;
所述监控设备,用于对所述指定场景进行监控,得到车位空闲信息,并将所述车位空闲信息发送至所述管理服务器;
所述管理服务器,具体用于接收所述待停车辆发送的停车请求,并将所述停车请求携带的所述待停车辆的定位信息和航向角确定为起始点信息;接收所述监控设备发送的车位空闲信息,根据所述车位空闲信息及所述定位信息,为所述待停车辆分配待停车位,并将所述待停车位的位置信息和车位标识确定为目标点信息;根据所述待停车辆发送的定位信息和航向角以及所述各路径点的位置信息和航向角,从所述地图中查找距离所述待停车辆对应位置最近、且与所述待停车辆的航向角之差小于预设阈值的路径点作为起始路径点;根据所述待停车位的位置信息和车位标识,从所述地图中查找所述待停车位对应的第一车位;确定所述第一车位的指定车位点连接的相邻路段上的路径点为目标路径点。
15.根据权利要求14所述的系统,其特征在于,所述管理服务器,还用于将所述目标路径点沿航向角的正方向移动预设距离。
16.根据权利要求14所述的系统,其特征在于,所述待停车辆,具体用于显示所述行车路径,和/或,按照所述行车路径自动驾驶至所述目标点,并停入所述待停车位。
17.根据权利要求11所述的系统,其特征在于,所述地图还包括所述指定场景中的多个停车区域,各停车区域包括至少一个车位,各车位包括多个车位点,一个车位的指定车位点连接至相邻路段的一个路径点;所述几何信息包括路径点的位置信息及航向角;所述车辆为待提车辆;
所述系统还包括:提车客户端;
所述提车客户端,用于向所述管理服务器发送提车请求;
所述管理服务器,具体用于接收提车客户端发送的提车请求;根据所述提车请求,确定待提车辆的位置信息和航向角为起始点信息、提车点的位置信息为目标点信息;若所述待提车辆为相较于行车道路平行停放,则根据所述待提车辆的位置信息,从所述地图中查找所述待提车辆所停放的第二车位;确定所述第二车位的指定车位点连接的相邻路段上的路径点为候选起始路径点;若根据所述候选起始路径点的航向角及所述待提车辆的航向角,确定所述候选起始路径点与所述待提车辆的航向不一致,则查找与所述候选起始路径点所属单向路段相反航向的对向路段;若所述对向路段中与所述候选起始路径点最近的对向路径点的航向角与所述待提车辆的航向角之差小于预设阈值,则确定所述对向路径点为起始路径点;若所述待提车辆为相较于行车道路垂直停放,则根据所述待提车辆的位置信息,从所述地图中查找所述待提车辆所停放的第三车位;确定所述第三车位的指定车位点连接的相邻路段上的路径点为候选起始路径点;确定所述候选起始路径点为起始路径点,或者,确定与所述候选起始路径点所属单向路段相反航向的对向路段中与所述候选起始路径点最近的对向路径点为起始路径点;根据所述提车点的位置信息,从所述地图中查找距离所述提车点对应位置最近的路径点作为目标路径点。
18.根据权利要求17所述的系统,其特征在于,所述管理服务器,还用于将所述行车路线发送至所述提车客户端;
所述提车客户端,还用于显示所述行车路径;
所述待提车辆,具体用于按照所述行车路径自动驾驶至所述提车点。
19.根据权利要求11所述的系统,其特征在于,所述系统还包括监控设备;
所述监控设备,用于对所述指定场景进行监控,得到各单向路段的通行信息,并将所述各单向路段的通行信息发送至所述管理服务器;
所述管理服务器,具体用于从所述起始路径点所属的起始单向路段开始执行:步骤A,获取各下一单向路段的行车距离及从所述各下一单向路段的结束路径点至所述目标路径点的估计距离,并接收监控设备发送的各单向路段的通行信息;步骤B,根据所述各下一单向路段的行车距离、从所述各下一单向路段的结束路径点至所述目标路径点的估计距离以及所述各下一单向路段的通行信息,计算所述各下一单向路段的路段代价;步骤C,确定路段代价最小的下一单向路段为当前单向路段的目标下一单向路段;循环执行步骤A至步骤C,直至搜索到所述目标路径点所属的目标单向路段,得到从所述起始单向路段至所述目标单向路段的路段序列。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010159230.8A CN113375678B (zh) | 2020-03-09 | 2020-03-09 | 一种行车路径规划方法、管理服务器及停车管理系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010159230.8A CN113375678B (zh) | 2020-03-09 | 2020-03-09 | 一种行车路径规划方法、管理服务器及停车管理系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113375678A CN113375678A (zh) | 2021-09-10 |
CN113375678B true CN113375678B (zh) | 2023-05-05 |
Family
ID=77569422
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010159230.8A Active CN113375678B (zh) | 2020-03-09 | 2020-03-09 | 一种行车路径规划方法、管理服务器及停车管理系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113375678B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114842661B (zh) * | 2022-07-04 | 2022-09-16 | 成都宜泊信息科技有限公司 | 一种管理室内地图通行路段实时状态的方法和系统 |
CN115223389B (zh) * | 2022-07-15 | 2023-11-21 | 西南交通大学 | 一种基于动态路段代价的停车引导路径规划方法 |
CN115457798B (zh) * | 2022-08-15 | 2023-09-19 | 东风汽车集团股份有限公司 | 自动驾驶车辆停车位导引方法、装置、设备及存储介质 |
CN117058919B (zh) * | 2023-10-10 | 2024-01-12 | 北京集度科技有限公司 | 车位推荐方法、装置、计算机设备及存储介质 |
CN117232548B (zh) * | 2023-11-10 | 2024-03-01 | 北京赛目科技股份有限公司 | 一种路径规划方法、装置、电子设备及存储介质 |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102798395A (zh) * | 2011-05-26 | 2012-11-28 | 上海博泰悦臻电子设备制造有限公司 | 路径规划提醒方法及系统 |
CN103292816B (zh) * | 2012-02-23 | 2016-08-03 | 北京四维图新科技股份有限公司 | 电子地图生成方法、装置及路径规划方法、装置 |
CN108151751B (zh) * | 2017-11-21 | 2020-04-21 | 武汉中海庭数据技术有限公司 | 一种基于高精度地图和传统地图结合的路径规划方法及装置 |
CN109541634B (zh) * | 2018-12-28 | 2023-01-17 | 歌尔股份有限公司 | 一种路径规划方法、装置和移动设备 |
CN110827572A (zh) * | 2019-01-25 | 2020-02-21 | 长城汽车股份有限公司 | 用于代客泊车的路径规划方法及装置 |
CN109767646B (zh) * | 2019-02-28 | 2021-02-12 | 北京智行者科技有限公司 | 泊车方法及装置 |
CN109916422B (zh) * | 2019-03-29 | 2021-06-29 | 北京经纬恒润科技股份有限公司 | 一种全局路径规划方法及装置 |
CN110595493A (zh) * | 2019-09-25 | 2019-12-20 | 北京蓦然认知科技有限公司 | 一种实时动态路径规划方法和装置 |
-
2020
- 2020-03-09 CN CN202010159230.8A patent/CN113375678B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN113375678A (zh) | 2021-09-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113375678B (zh) | 一种行车路径规划方法、管理服务器及停车管理系统 | |
CN110782696B (zh) | 用于代客泊车的控制系统 | |
US11874119B2 (en) | Traffic boundary mapping | |
CN107851125B9 (zh) | 通过车辆和服务器数据库进行两步对象数据处理以生成、更新和传送精确道路特性数据库的系统和方法 | |
CN110861650B (zh) | 车辆的路径规划方法、装置,车载设备和存储介质 | |
CN107850453B (zh) | 匹配道路数据对象以更新精确道路数据库的系统和方法 | |
CN107850672B (zh) | 用于精确车辆定位的系统和方法 | |
US9857191B2 (en) | Context-based routing and access path selection | |
WO2020151632A1 (zh) | 用于代客泊车的路径规划方法及装置 | |
CN110562258B (zh) | 一种车辆自动换道决策的方法、车载设备和存储介质 | |
US11333762B2 (en) | Merging data from multiple LiDAR devices | |
US20180259968A1 (en) | Planning for unknown objects by an autonomous vehicle | |
CN110136426A (zh) | 一种还车招车系统及方法 | |
WO2021238306A1 (zh) | 一种激光点云的处理方法及相关设备 | |
US20180259967A1 (en) | Planning for unknown objects by an autonomous vehicle | |
WO2021102957A1 (zh) | 一种车道保持方法、车载设备和存储介质 | |
CN110807412B (zh) | 一种车辆激光定位的方法、车载设备和存储介质 | |
CN107895504A (zh) | 室内停车场车位引导系统及其地图重构方法 | |
US11367289B1 (en) | Machine learning-based framework for drivable surface annotation | |
CN110517527A (zh) | 异构多源无线传感网络及其自主无人泊车方法 | |
US20220234575A1 (en) | Vehicle operation using maneuver generation | |
CN110494341A (zh) | 一种智能驾驶车辆让行方法、装置及车载设备 | |
CN110375786A (zh) | 一种传感器外参的标定方法、车载设备及存储介质 | |
Damerow et al. | Intersection warning system for occlusion risks using relational local dynamic maps | |
US20230168368A1 (en) | Guardrail estimation method based on multi-sensor data fusion, and vehicle-mounted device |
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 |