CN107560615A - 用于停车场自动驾驶***的停车路径规划方法 - Google Patents
用于停车场自动驾驶***的停车路径规划方法 Download PDFInfo
- Publication number
- CN107560615A CN107560615A CN201710684053.3A CN201710684053A CN107560615A CN 107560615 A CN107560615 A CN 107560615A CN 201710684053 A CN201710684053 A CN 201710684053A CN 107560615 A CN107560615 A CN 107560615A
- Authority
- CN
- China
- Prior art keywords
- node
- parking
- parking lot
- distance
- driving system
- 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
Landscapes
- Navigation (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明公开了一种用于停车场自动驾驶***的停车路径规划方法,包括以下步骤:根据停车场内的路网信息对停车场进行数学建模;在停车场道路交叉口以及每个停车位选择对应节点,并进行编号,建立对应的矩阵关系;读取线路信息表中的线路信息,以起点和终点的距离为权值;将路网的节点图构造迪杰斯特拉地图,根据迪杰斯特拉算法计算最优路径。可以快速的规划停车场起点到停车位的最优路径。
Description
技术领域
本发明属于汽车自动驾驶决策技术领域,具体地涉及一种用于停车场自动驾驶***的停车路径规划方法。
背景技术
随着汽车自动驾驶技术不断地发展,自动驾驶在停车场内的应用也开始得到广泛关注。在目前传统的停车场中,最为困扰驾驶员的难题有两个:一是找空停车位和泊入狭小车位的困难;二是多个车辆找空停车位时可能导致的停车场堵塞现象。
停车场自动驾驶***不仅可以提高停车过程的便捷性,也可以有效缓解找车位导致的停车场堵塞问题。停车场自动驾驶***利用超声波传感器和智能车轮传感器来搜索停车空间,产生到达停车位置的停车路径,并且控制驾驶。也就是说,智能停车辅助***允许驾驶者在没有方向盘操作的情形下仅仅通过控制前后运动以及制动操作而自动停驻车辆。
目前路径规划方法大多数运用在城市道路中,而停车场自动驾驶***领域还未涉及到路径规划的问题。因此,由停车场起点到停车位的路径规划方法使停车场自动驾驶***领域一个亟待解决的问题。本发明因此而来。
发明内容
针对上述技术方案存在的问题,本发明提出了一种用于停车场自动驾驶***的停车路径规划方法,可以快速的规划停车场起点到停车位的最优路径。
本发明的技术方案是:
一种用于停车场自动驾驶***的停车路径规划方法,包括以下步骤:
S01:根据停车场内的路网信息对停车场进行数学建模;
S02:在停车场道路交叉口以及每个停车位选择对应节点,并进行编号,建立对应的矩阵关系;
S03:读取线路信息表中的线路信息,以起点和终点的距离为权值;
S04:将路网的节点图构造迪杰斯特拉地图,根据迪杰斯特拉算法计算最优路径。
优选的,所述步骤S04还包括,对道路交叉口进行平滑处理,计算转弯半径,得到转弯轨迹。
优选的,所述步骤S01中,所述路网信息至少包括停车场道路的宽度方向、停车位的宽度、长度以及停车位的分布状况。
优选的,所述步骤S02中,将每个停车位前方的顺向道路的中线与停车位宽度的中线的交点作为停车位节点;若道路交叉口处的曲率变化没有超过设定阈值,选择道路交点为节点,若曲率变化大于所设阈值,选择曲率变化点及圆弧中心点为节点。
优选的,所述步骤S04中,根据迪杰斯特拉算法计算最优路径,包括:
S11:起点集合S,即S={v},v为起点,v的距离为0,U包含除v外的其他节点集合,即U={其余节点},若v与U中节点相邻,则<u,v>有权值,若u不是v的邻接点,则<u,v>权值为∞;
S12:从U中选取一个距离v最小的节点k,把k加入S中,选定的距离就是v到k的最短路径长度;
S13:以k为新考虑的中间点,修改U中各节点的距离;若从起点v经过节点k到节点u的距离比原先不经过节点k的距离短,则修改节点u的距离值,修改后的距离值是节点k的距离加上k到u的距离值;
S14:重复步骤S12和S13直到所有节点都包含在S中。
与现有技术相比,本发明的优点是:
可以快速的规划停车场起点到停车位的最优路径。
附图说明
下面结合附图及实施例对本发明作进一步描述:
图1为本发明用于停车场自动驾驶***的停车路径规划方法的流程图;
图2是停车场建模示意图;
图3是停车场中选取节点示意图;
图4是在道路交叉口处经过圆滑处理后的轨迹示意图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚明了,下面结合具体实施方式并参照附图,对本发明进一步详细说明。应该理解,这些描述只是示例性的,而并非要限制本发明的范围。此外,在以下说明中,省略了对公知结构和技术的描述,以避免不必要地混淆本发明的概念。
实施例:
下面结合附图,对本发明的较佳实施例作进一步说明。
如图1所示,一种用于停车场自动驾驶***的停车路径规划方法,包括以下步骤:
根据停车场内的路网信息对停车场进行数学建模。通过停车场的路网信息得到停车场道路的宽度方向等以及停车位的宽度长度以及停车位的分布状况。如图2所示,实例中对一停车场进行数学建模;
实例中每一行有31个停车位,一共93个停车位。每个停车位长度为6米,宽度为3米。其中绿色矩形代表着草坪,宽度为1米,长度为6米。两排停车位中间的道路宽度为10米。
在停车场道路交叉口以及每个停车位选择对应节点,并进行编号,建立对应的矩阵关系,如图3所示;把每个停车位前方的顺向道路的中线与停车位宽度的中线的交点作为停车位节点,若道路交叉口处的曲率变化没有超过设定阈值,选择道路交点为节点,若曲率变化大于所设阈值,选择曲率变化点及圆弧中心点为节点。
读取线路信息表中的线路信息选择起点和终点,以距离为权值;实际中可以连接的相邻的节点以实际距离作为权值,不可连接的节点距离设置为较大的数值。终点位置是通过车辆与停车场的通讯得到一个空停车位的位置信息,并读取空停车位的位置信息,找到对应的节点编号。自动驾驶的汽车可以通过设置速度行驶,不需要考虑时间作为权值,仅以距离作为权值即可,节省了计算的时间。
实例中将中间一排最左侧一点作为起点v,随机选择一个空车位作为终点。将紧邻的节点的正向距离作为权值,把不能直接到达的和反向节点间的权值设置为一个较大的数值,这样降低了计算时间,对自动驾驶汽车具有很大意义。
将路网的节点图构造迪杰斯特拉地图;
根据迪杰斯特拉算法计算出最优的路径,包括如下步骤:
a.实例中初始时,S只包含起点的集合,即S={v},v的距离为0。U包含除v外的其他节点的集合,即U={其余节点},若v与U中节点相邻,则<u,v>正常有权值,若u不是v的邻接点,则<u,v>权值为∞。
b.从U中选取一个距离v最小的节点k,把k加入S中(该选定的距离就是v到k的最短路径长度)。
c.以k为新考虑的中间点,修改U中各节点的距离;若从起点v到节点u的距离(经过节点k)比原来距离(不经过节点k,即v直接到达u)短,则修改节点u的距离值,修改后的距离值是节点k的距离加上k到u的距离值。
d.重复步骤b和c直到所有节点都包含在S中。
如图4所示,对道路交叉口曲线进行平滑处理;道路交叉口处用圆弧处理圆弧要与直线相切,转弯半径为路宽的一半,可得出转弯的轨迹。以便于自动驾驶车辆能够通过道路交叉口,不受动力学问题的约束。实例中,转弯半径为3.5米,转向角为90度。此方法可以让自动驾驶车辆可以平稳的过此交叉口,不会由于航线角的图片导致车辆不能通过交叉口。
应当理解的是,本发明的上述具体实施方式仅仅用于示例性说明或解释本发明的原理,而不构成对本发明的限制。因此,在不偏离本发明的精神和范围的情况下所做的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。此外,本发明所附权利要求旨在涵盖落入所附权利要求范围和边界、或者这种范围和边界的等同形式内的全部变化和修改例。
Claims (5)
1.一种用于停车场自动驾驶***的停车路径规划方法,其特征在于,包括以下步骤:
S01:根据停车场内的路网信息对停车场进行数学建模;
S02:在停车场道路交叉口以及每个停车位选择对应节点,并进行编号,建立对应的矩阵关系;
S03:读取线路信息表中的线路信息,以起点和终点的距离为权值;
S04:将路网的节点图构造迪杰斯特拉地图,根据迪杰斯特拉算法计算最优路径。
2.根据权利要求1所述的用于停车场自动驾驶***的停车路径规划方法,其特征在于,所述步骤S04还包括,对道路交叉口进行平滑处理,计算转弯半径,得到转弯轨迹。
3.根据权利要求1所述的用于停车场自动驾驶***的停车路径规划方法,其特征在于,所述步骤S01中,所述路网信息至少包括停车场道路的宽度方向、停车位的宽度、长度以及停车位的分布状况。
4.根据权利要求1所述的用于停车场自动驾驶***的停车路径规划方法,其特征在于,所述步骤S02中,将每个停车位前方的顺向道路的中线与停车位宽度的中线的交点作为停车位节点;若道路交叉口处的曲率变化没有超过设定阈值,选择道路交点为节点,若曲率变化大于所设阈值,选择曲率变化点及圆弧中心点为节点。
5.根据权利要求1所述的用于停车场自动驾驶***的停车路径规划方法,其特征在于,所述步骤S04中,根据迪杰斯特拉算法计算最优路径,包括:
S11:起点集合S,即S={v},v为起点,v的距离为0,U包含除v外的其他节点集合,即U={其余节点},若v与U中节点相邻,则<u,v>有权值,若u不是v的邻接点,则<u,v>权值为∞;
S12:从U中选取一个距离v最小的节点k,把k加入S中,选定的距离就是v到k的最短路径长度;
S13:以k为新考虑的中间点,修改U中各节点的距离;若从起点v经过节点k到节点u的距离比原先不经过节点k的距离短,则修改节点u的距离值,修改后的距离值是节点k的距离加上k到u的距离值;
S14:重复步骤S12和S13直到所有节点都包含在S中。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710684053.3A CN107560615B (zh) | 2017-08-11 | 2017-08-11 | 用于停车场自动驾驶***的停车路径规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710684053.3A CN107560615B (zh) | 2017-08-11 | 2017-08-11 | 用于停车场自动驾驶***的停车路径规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107560615A true CN107560615A (zh) | 2018-01-09 |
CN107560615B CN107560615B (zh) | 2021-04-23 |
Family
ID=60975344
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710684053.3A Active CN107560615B (zh) | 2017-08-11 | 2017-08-11 | 用于停车场自动驾驶***的停车路径规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107560615B (zh) |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108710365A (zh) * | 2018-04-19 | 2018-10-26 | 五邑大学 | 一种基于最优路径巡航的水上机器人自动充电方法及装置 |
CN108766026A (zh) * | 2018-07-26 | 2018-11-06 | 谭智 | 一种基于区块链技术的停车导航方法及*** |
CN109596138A (zh) * | 2018-12-29 | 2019-04-09 | 北京智行者科技有限公司 | 自动驾驶充电车停车路径规划方法及*** |
CN110471418A (zh) * | 2019-08-22 | 2019-11-19 | 北京交通大学 | 智能停车场中的agv调度方法 |
WO2020132959A1 (en) * | 2018-12-26 | 2020-07-02 | Baidu.Com Times Technology (Beijing) Co., Ltd. | Spiral curve based vertical parking planner system for autonomous driving vehicles |
CN111380554A (zh) * | 2018-12-28 | 2020-07-07 | 哲内提 | 在定义的拓扑内通过有意义的链路进行有效的搜索 |
CN111741876A (zh) * | 2018-03-30 | 2020-10-02 | 日立汽车***株式会社 | 驻车辅助装置 |
CN112258879A (zh) * | 2020-10-16 | 2021-01-22 | 安徽亿力停车场投资有限公司 | 一种利用随机矩阵优化城市停车构造方法 |
CN112687123A (zh) * | 2019-10-17 | 2021-04-20 | 丰田自动车株式会社 | 自动泊车*** |
CN112908027A (zh) * | 2021-02-03 | 2021-06-04 | 芜湖泊啦图信息科技有限公司 | 基于停车场内主定位点特征路径构建的控制算法及其*** |
CN114882732A (zh) * | 2022-05-18 | 2022-08-09 | 合肥观佳智能科技有限公司 | 一种智慧城市的智能化停车管理*** |
CN115457798A (zh) * | 2022-08-15 | 2022-12-09 | 东风汽车集团股份有限公司 | 自动驾驶车辆停车位导引方法、装置、设备及存储介质 |
CN115565399A (zh) * | 2021-07-02 | 2023-01-03 | 北京万集科技股份有限公司 | 基于v2x的停车场路径获取方法和装置、存储介质 |
CN117877263A (zh) * | 2024-01-18 | 2024-04-12 | 扬州新盛物业管理有限公司 | 用于人车分流的停车场数据管理方法及*** |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101739817A (zh) * | 2009-11-26 | 2010-06-16 | 西北工业大学 | 一种动态起点的最短路径规划方法 |
JP2011066576A (ja) * | 2009-09-16 | 2011-03-31 | Toshiba Corp | パーキング無線通信システム |
CN102207736A (zh) * | 2010-03-31 | 2011-10-05 | 中国科学院自动化研究所 | 基于贝塞尔曲线的机器人路径规划方法及装置 |
CN202600981U (zh) * | 2011-12-06 | 2012-12-12 | 西安博昱新能源有限公司 | 一种应用rfid标签的地下车位引导停车*** |
CN106157689A (zh) * | 2016-08-29 | 2016-11-23 | 上海交通大学 | 一种停车场动态车位管理*** |
-
2017
- 2017-08-11 CN CN201710684053.3A patent/CN107560615B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2011066576A (ja) * | 2009-09-16 | 2011-03-31 | Toshiba Corp | パーキング無線通信システム |
CN101739817A (zh) * | 2009-11-26 | 2010-06-16 | 西北工业大学 | 一种动态起点的最短路径规划方法 |
CN102207736A (zh) * | 2010-03-31 | 2011-10-05 | 中国科学院自动化研究所 | 基于贝塞尔曲线的机器人路径规划方法及装置 |
CN202600981U (zh) * | 2011-12-06 | 2012-12-12 | 西安博昱新能源有限公司 | 一种应用rfid标签的地下车位引导停车*** |
CN106157689A (zh) * | 2016-08-29 | 2016-11-23 | 上海交通大学 | 一种停车场动态车位管理*** |
Non-Patent Citations (6)
Title |
---|
吴若伟 等: "基于Dijkstra算法的大型停车场最优泊车路径规划", 《工业控制计算机》 * |
张玉杰 等: "Dijkstra优化算法在停车场车位引导***中的应用", 《计算机测量与控制》 * |
王一军 等: "现代大型停车场车位诱导优化算法及仿真", 《计算机仿真》 * |
程小凤: "Dijkstra改进算法在停车场内部路径引导中的应用", 《交通科技与经济》 * |
袁琳 等: "基于权值的Dijkstra停车路径规划算法的优化与实现", 《湖北大学学报(自然科学版)》 * |
许增昭 等: "Dijkstra改进算法在泊位诱导***中的应用于仿真", 《科学技术与工程》 * |
Cited By (22)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111741876A (zh) * | 2018-03-30 | 2020-10-02 | 日立汽车***株式会社 | 驻车辅助装置 |
CN111741876B (zh) * | 2018-03-30 | 2022-04-29 | 日立安斯泰莫株式会社 | 驻车辅助装置 |
CN108710365A (zh) * | 2018-04-19 | 2018-10-26 | 五邑大学 | 一种基于最优路径巡航的水上机器人自动充电方法及装置 |
CN108766026A (zh) * | 2018-07-26 | 2018-11-06 | 谭智 | 一种基于区块链技术的停车导航方法及*** |
CN108766026B (zh) * | 2018-07-26 | 2020-05-05 | 谭智 | 一种基于区块链技术的停车导航方法及*** |
WO2020132959A1 (en) * | 2018-12-26 | 2020-07-02 | Baidu.Com Times Technology (Beijing) Co., Ltd. | Spiral curve based vertical parking planner system for autonomous driving vehicles |
CN111380554B (zh) * | 2018-12-28 | 2024-03-15 | 哲内提 | 在定义的拓扑内通过有意义的链路进行有效的搜索 |
CN111380554A (zh) * | 2018-12-28 | 2020-07-07 | 哲内提 | 在定义的拓扑内通过有意义的链路进行有效的搜索 |
US11035685B2 (en) * | 2018-12-28 | 2021-06-15 | Zenuity Ab | Route planning algorithm for efficiently searching through meaningful links within a defined topology |
CN109596138A (zh) * | 2018-12-29 | 2019-04-09 | 北京智行者科技有限公司 | 自动驾驶充电车停车路径规划方法及*** |
CN110471418B (zh) * | 2019-08-22 | 2021-06-04 | 北京交通大学 | 智能停车场中的agv调度方法 |
CN110471418A (zh) * | 2019-08-22 | 2019-11-19 | 北京交通大学 | 智能停车场中的agv调度方法 |
CN112687123A (zh) * | 2019-10-17 | 2021-04-20 | 丰田自动车株式会社 | 自动泊车*** |
CN112687123B (zh) * | 2019-10-17 | 2022-12-27 | 丰田自动车株式会社 | 自动泊车*** |
CN112258879B (zh) * | 2020-10-16 | 2021-11-02 | 安徽亿力停车场投资有限公司 | 一种利用随机矩阵优化城市停车构造方法 |
CN112258879A (zh) * | 2020-10-16 | 2021-01-22 | 安徽亿力停车场投资有限公司 | 一种利用随机矩阵优化城市停车构造方法 |
CN112908027A (zh) * | 2021-02-03 | 2021-06-04 | 芜湖泊啦图信息科技有限公司 | 基于停车场内主定位点特征路径构建的控制算法及其*** |
CN115565399A (zh) * | 2021-07-02 | 2023-01-03 | 北京万集科技股份有限公司 | 基于v2x的停车场路径获取方法和装置、存储介质 |
CN114882732A (zh) * | 2022-05-18 | 2022-08-09 | 合肥观佳智能科技有限公司 | 一种智慧城市的智能化停车管理*** |
CN115457798A (zh) * | 2022-08-15 | 2022-12-09 | 东风汽车集团股份有限公司 | 自动驾驶车辆停车位导引方法、装置、设备及存储介质 |
CN115457798B (zh) * | 2022-08-15 | 2023-09-19 | 东风汽车集团股份有限公司 | 自动驾驶车辆停车位导引方法、装置、设备及存储介质 |
CN117877263A (zh) * | 2024-01-18 | 2024-04-12 | 扬州新盛物业管理有限公司 | 用于人车分流的停车场数据管理方法及*** |
Also Published As
Publication number | Publication date |
---|---|
CN107560615B (zh) | 2021-04-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107560615A (zh) | 用于停车场自动驾驶***的停车路径规划方法 | |
CN109927716B (zh) | 基于高精度地图的自主垂直泊车方法 | |
WO2020135742A1 (zh) | 自动驾驶车辆的横向决策***及横向决策确定方法 | |
CN110466516B (zh) | 一种基于非线性规划的曲线道路自动车换道轨迹规划方法 | |
CN112590775B (zh) | 一种自动泊车方法、装置、车辆及存储介质 | |
KR102332045B1 (ko) | 운전 참고 선 처리 방법, 장치 및 차량 | |
CN109084798A (zh) | 网络下发带有道路属性的控制点的路径规划方法 | |
CN103158703A (zh) | 一种平行泊车的控制方法 | |
CN110657814A (zh) | 轨迹规划方法和装置、车辆及其控制方法和*** | |
CN110869266B (zh) | 用于计算车辆的运动轨迹的方法和设备 | |
CN109709943B (zh) | 一种自动驾驶公交车进站停靠点的选取方法 | |
CN108773374A (zh) | 泊车方法及装置 | |
CN110979330A (zh) | 一种车辆变道控制方法、装置及车辆 | |
CN111186443A (zh) | 变道路径规划方法、装置、电子设备和计算机可读介质 | |
CN105277203A (zh) | 一种导航动作的生成方法、导航方法和设备 | |
JP2014501651A (ja) | 車両を横方向制御するための横方向制御パラメタ設定を決定する方法および装置 | |
CN107246878A (zh) | 一种导航路径的确定方法、装置及汽车 | |
JP7192610B2 (ja) | 走行支援方法および走行支援装置 | |
CN114791288A (zh) | 矿区车辆的行驶路径规划方法、装置及计算机设备 | |
CN109816981A (zh) | 一种自动驾驶方法、装置及存储介质 | |
JP2022502311A (ja) | 環境ターゲットの特徴点抽出方法及び装置 | |
CN110940346B (zh) | 一种用于自动驾驶变道的高精地图处理方法及装置 | |
CN109556623A (zh) | 融合触须算法与切线图法的迭代式路径规划算法 | |
CN114115268A (zh) | 路径生成方法、装置、交通工具及存储介质 | |
CN113074746A (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 | ||
TR01 | Transfer of patent right | ||
TR01 | Transfer of patent right |
Effective date of registration: 20221026 Address after: 215200 No. 139, Lian Yang Road, Wujiang District, Suzhou, Jiangsu. Patentee after: TSINGHUA University SUZHOU AUTOMOTIVE RESEARCH INSTITUTE(WUJIANG) Patentee after: TSINGHUA University Address before: 215200 No. 139, Lian Yang Road, Wujiang District, Suzhou, Jiangsu. Patentee before: TSINGHUA University SUZHOU AUTOMOTIVE RESEARCH INSTITUTE(WUJIANG) |