CN105761533B - 一种无人驾驶汽车车位规划方法 - Google Patents
一种无人驾驶汽车车位规划方法 Download PDFInfo
- Publication number
- CN105761533B CN105761533B CN201610181503.2A CN201610181503A CN105761533B CN 105761533 B CN105761533 B CN 105761533B CN 201610181503 A CN201610181503 A CN 201610181503A CN 105761533 B CN105761533 B CN 105761533B
- Authority
- CN
- China
- Prior art keywords
- automobile
- vehicles
- parking stall
- parking
- behind
- 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
Classifications
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/09—Arrangements for giving variable traffic instructions
- G08G1/0962—Arrangements for giving variable traffic instructions having an indicator mounted inside the vehicle, e.g. giving voice messages
- G08G1/0967—Systems involving transmission of highway information, e.g. weather, speed limits
- G08G1/096766—Systems involving transmission of highway information, e.g. weather, speed limits where the system is characterised by the origin of the information transmission
- G08G1/096791—Systems involving transmission of highway information, e.g. weather, speed limits where the system is characterised by the origin of the information transmission where the origin of the information is another vehicle
-
- 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
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Life Sciences & Earth Sciences (AREA)
- Atmospheric Sciences (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明属于汽车电子领域,具体涉及一种无人驾驶汽车车位规划方法;本发明通过多车信息交互和协调,对停车位进行判断和规划,利用汽车自动驾驶功能,在满足条件的情况下,规划出一个满足停车要求的车位,本发明的有益之处在于,提高了停车位资源利用率。
Description
技术领域
本发明属于汽车电子领域,具体涉及一种无人驾驶汽车车位规划方法。
背景技术
随着经济的飞速发展以及人民生活水平的提高,汽车的保有量持续增多,停车位越来越狭窄。经常会出现这样的停车场景,两辆停着的车之间距离很大,但却不足以让另外一辆车停进去,造成了停车位资源的浪费。
此外,随着科技水平的不断进步,智能汽车领域的研究与应用进来得到了迅猛发展,无人驾驶的功能未来也会出现在汽车上。
发明内容
针对有些停车位距离长但仍不满足停车条件,造成停车位资源浪费的问题,本发明提出了一种无人驾驶汽车车位规划方法,通过车车互联,对侧方停车位进行识别和规划,进一步提高停车位的利用率。
为了实现上述目的,本发明具体技术方案如下:一种无人驾驶汽车车位规划方法,包括如下步骤:
1)汽车A进入寻找侧方停车位模式,并向汽车B和汽车C发送停车寻库信号;其中,汽车A、汽车B和汽车C都是无人驾驶汽车;汽车B和汽车C前后相邻且静止;转步骤2);
2)汽车B和汽车C接收到A车停车寻库信号后,分别打开车身前部和后部的测距传感器,测量前后距离信息LBf、LBr、Lcf、Lcr,并将距离信息发送给汽车A,其中,LBf指B车前部测得的距离、LBr指B车后部测得的距离、Lcf指C车前部测得的距离、Lcr指C车后部测得的距离;转步骤3);
3)汽车A根据距离信息,判断停车位是否满足停车要求,如满足停车要求转步骤6),否则转步骤4);
4)汽车A判断是否可规划停车位,如果不能规划,转步骤1),否则进行距离规划,并将规划好的数据x、y发送给汽车B和C,同时汽车A进入等待模式,转步骤5);
5)汽车B和C获得规划数据后,启动自身发动机/电动机,按一定速度,后车向后行驶x,前车向前行驶y,当汽车B和汽车C到达规划位置处时,汽车熄火,并将确认信息发送给汽车A;
6)汽车A进入停车模式。
进一步地,上述步骤3)中,判断停车位是否满足停车要求的方法如下:
3.1)汽车A判断汽车B和汽车C的前后位置关系,令a=|LBr-Lcf|,b=|LBf-Lcr|;如果a>=b,则B车后面,C车在前面,否则,C车后面,B车在前面;
3.2)计算停车位长度,如果B车后面,C车在前面,停车位长c=(LBf+Lcr)/2;如果C车后面,B车在前面,停车位长度为c=(LBr+LCf)/2;
3.3)判断停车位是否满足停车要求,当停车位长度c大于汽车A长度的k1倍时,认为该停车位有效;否则认为该停车位无效;其中,k1为比例系数,且k1>1。
进一步地,上述步骤4)中,规划停车位的方法如下:
4.1)当B车后面,C车在前面时,令Ladd=c+LBr+LCf,当C车后面,B车在前面时,令Ladd=c+LBf+LCr,其中Ladd表示汽车B与汽车C之间及前后空间距离之和;
4.2)汽车A判断是否可规划停车位,当Ladd大于汽车A长度的k1倍时,可规划停车位,转步骤4.3);否则不可规划停车位;
4.3)汽车A规划停车位,汽车A计算后车向后移动的距离x,前车向前移动的距离y,使x+y+c大于汽车A长度LA的k1倍;其中,当B车后面,C车在前面时,x+c+y>LA×k1,0≤x<LBr,0≤y<LCf;当B车后面,C车在前面时,x+c+y>LA×k1,0≤x<LCr,0≤y<LBf。
本发明针对有些停车位距离长但仍不满足停车条件,通过多车信息交互和协调,对停车位进行判断和规划,利用汽车自动驾驶功能,在满足条件的情况下,规划出一个满足停车要求的车位,提高了停车位资源的利用率。
附图说明
图1是无人驾驶汽车车位规划方法整体流程图。
图2是无人驾驶汽车判断空间是否满足停车要求的方法流程图。
图3是无人驾驶汽车判断距离信息能否规划的方法流程图。
图4和图5是无人驾驶汽车按规划路径行驶的示意图。
具体实施方式
下面结合附图和实施实例对本发明作进一步描述。
图1是无人驾驶汽车车位规划方法流程图,包括如下步骤:
1)汽车A进入寻找侧方停车位模式,向周围静止且前后相邻的汽车B和汽车C发送停车寻库信号;其中,汽车A、汽车B和汽车C都是无人驾驶汽车;
2)汽车B和汽车C接收到A车停车寻库信号后,分别打开车身前部和后部的测距传感器,测量前后距离信息LBf、LBr、Lcf、Lcr,并将距离信息发送给汽车A,其中,LBf指B车前部测得的距离、LBr指B车后部测得的距离、Lcf指C车前部测得的距离、Lcr指C车后部测得的距离;
3)汽车A根据4组距离信息,判断停车位是否满足停车要求,如满足停车要求转步骤6)进入停车模式,如不满足停车要求,转步骤4);其中,判断停车位是否满足停车要求的方法如下:
3.1)汽车A判断汽车B和汽车C的前后位置关系,因为LBr与Lcf、LBf与Lcr中有一组是相同空间距离数据,将B车的后端测距数据LBr与C车的前端测距数据Lcf做差,令a=|LBr-Lcf|;将B车的前端测距数据LBf与C车的后端测距数据Lcr做差,令b=|LBf-Lcr|;如果a>=b,则B车后面,C车在前面,如图4所示;否则,则C车后面,B车在前面,如图5所示;
3.2)计算停车位长度,如果B车后面,C车在前面,停车位长c=(LBf+Lcr)/2;如果C车后面,B车在前面,停车位长度为c=(LBr+LCf)/2;
3.3)判断停车位是否满足停车要求,当停车位长度大于汽车A长度的k1倍时,认为该停车位有效;否则认为该停车位无效;其中k1为比例系数,本实施例中,k1取值为1.2;
4)汽车A判断是否可规划停车位,如果不能规划,转步骤1),寻找下一个停车位;如果能规划,则进行距离规划,并将规划好的数据发送给汽车B和C,同时汽车A进入等待模式,转步骤5);其中,规划停车位的方法如下:
4.1)当B车后面,C车在前面时,令Ladd=c+LBr+LCf,当C车后面,B车在前面时,令Ladd=c+LBf+LCr;其中Ladd表示汽车B与汽车C之间及前后空间距离之和;
4.2)汽车A判断是否可规划停车位,当Ladd大于汽车A长度的K倍时,可规划停车位,转步骤4.3);否则不可规划停车位,转步骤1)寻找下一个停车位;
4.3)汽车A规划停车位,汽车A计算后车向后移动的距离x,前车向前移动的距离y,使x+y+c大于汽车A长度的1.2倍;其中,当B车后面,C车在前面时,0≦x≦LBR,0≦Y≦LCF,当C车后面,B车在前面时,0≦x≦LCR,0≦Y≦LBF;
4.4)汽车A将规划数据发送给汽车B和汽车C;
5)汽车B和C获得规划数据后,启动自身发动机/电动机,按一定速度行驶到规划位置,汽车B和汽车C到达规划位置处时,汽车熄火,并将确认信息发送给汽车A;
6)汽车A进入停车模式。
Claims (2)
1.一种无人驾驶汽车车位规划方法,其特征在于包括如下步骤:
1)汽车A进入寻找侧方停车位模式,并向汽车B和汽车C发送停车寻库信号;其中,汽车A、汽车B和汽车C都是无人驾驶汽车;汽车B和汽车C前后相邻且静止;转步骤2);
2)汽车B和汽车C接收到A车停车寻库信号后,分别打开车身前部和后部的测距传感器,测量前后距离信息LBf、LBr、Lcf、Lcr,并将距离信息发送给汽车A,其中,LBf指B车前部测得的距离、LBr指B车后部测得的距离、Lcf指C车前部测得的距离、Lcr指C车后部测得的距离;转步骤3);
3)汽车A根据距离信息,判断停车位是否满足停车要求,如满足停车要求转步骤6),否则转步骤4);
4)汽车A判断是否可规划停车位,如果不能规划,转步骤1),否则进行距离规划,并将规划好的数据x、y发送给汽车B和C,同时汽车A进入等待模式,转步骤5);
5)汽车B和C获得规划数据后,启动自身发动机/电动机,按一定速度,后车向后行驶x,前车向前行驶y,当汽车B和汽车C到达规划位置处时,汽车熄火,并将确认信息发送给汽车A;转步骤6);
6)汽车A进入停车模式;
所述步骤3)中,判断停车位是否满足停车要求的方法如下:
3.1)汽车A判断汽车B和汽车C的前后位置关系,令a=|LBr-Lcf|,b=|LBf-Lcr|;如果a>=b,则B车后面,C车在前面,否则,C车后面,B车在前面;
3.2)计算停车位长度,如果B车后面,C车在前面,停车位长c=(LBf+Lcr)/2;如果C车后面,B车在前面,停车位长度为c=(LBr+LCf)/2;
3.3)判断停车位是否满足停车要求,当停车位长度c大于汽车A长度的k1倍时,认为该停车位有效;否则认为该停车位无效;其中,k1为比例系数,且k1>1。
2.如权利要求1所述的无人驾驶汽车车位规划方法,其特征在于所述步骤4)中,规划停车位的方法如下:
4.1)当B车后面,C车在前面时,令Ladd=c+LBr+LCf,当C车后面,B车在前面时,令Ladd=c+LBf+LCr,其中Ladd表示汽车B与汽车C之间及前后空间距离之和;
4.2)汽车A判断是否可规划停车位,当Ladd大于汽车A长度的k1倍时,可规划停车位,转步骤4.3),否则不可规划停车位;
4.3)汽车A规划停车位,汽车A计算后车向后移动的距离x,前车向前移动的距离y,使x+y+c大于汽车A长度LA的k1倍;其中,当B车后面,C车在前面时,x+c+y>LA×k1,0≤x<LBr,0≤y<LCf;当B车后面,C车在前面时,x+c+y>LA×k1,0≤x<LCr,0≤y<LBf。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610181503.2A CN105761533B (zh) | 2016-03-28 | 2016-03-28 | 一种无人驾驶汽车车位规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610181503.2A CN105761533B (zh) | 2016-03-28 | 2016-03-28 | 一种无人驾驶汽车车位规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105761533A CN105761533A (zh) | 2016-07-13 |
CN105761533B true CN105761533B (zh) | 2018-06-29 |
Family
ID=56346599
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610181503.2A Active CN105761533B (zh) | 2016-03-28 | 2016-03-28 | 一种无人驾驶汽车车位规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105761533B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106875730B (zh) * | 2017-03-13 | 2019-09-17 | 江苏大学 | 一种基于超声波定位和无线电通讯的多车协同入库系统 |
CN107193278B (zh) * | 2017-05-08 | 2021-06-18 | 江苏大学 | 基于定位的图像和地图匹配的可行驶区域识别方法 |
CN111754758A (zh) * | 2017-06-16 | 2020-10-09 | 侯苏华 | 共享单车及其停车方法 |
CN112009462B (zh) * | 2020-08-10 | 2022-07-12 | 广州汽车集团股份有限公司 | 一种前向自动泊车方法及装置 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101510362A (zh) * | 2008-02-14 | 2009-08-19 | 爱信艾达株式会社 | 停车场拥挤状态判定装置、停车场拥挤状态判定方法及计算机程序 |
CN101878494A (zh) * | 2007-12-18 | 2010-11-03 | 本田技研工业株式会社 | 车辆用可否泊车判断装置、车辆用泊车空间检测装置以及车辆用可移动范围检测装置 |
DE102010042843A1 (de) * | 2010-10-25 | 2012-04-26 | Robert Bosch Gmbh | Parkzeitassistenzsystem mit einer elektronischen Parkzeitsteuereinheit |
CN103481820A (zh) * | 2013-09-25 | 2014-01-01 | 江苏大学 | 一种带有安全监测的辅助泊车系统及其方法 |
CN104916162A (zh) * | 2015-05-28 | 2015-09-16 | 惠州华阳通用电子有限公司 | 泊车位检测方法和系统 |
-
2016
- 2016-03-28 CN CN201610181503.2A patent/CN105761533B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101878494A (zh) * | 2007-12-18 | 2010-11-03 | 本田技研工业株式会社 | 车辆用可否泊车判断装置、车辆用泊车空间检测装置以及车辆用可移动范围检测装置 |
CN101510362A (zh) * | 2008-02-14 | 2009-08-19 | 爱信艾达株式会社 | 停车场拥挤状态判定装置、停车场拥挤状态判定方法及计算机程序 |
DE102010042843A1 (de) * | 2010-10-25 | 2012-04-26 | Robert Bosch Gmbh | Parkzeitassistenzsystem mit einer elektronischen Parkzeitsteuereinheit |
CN103481820A (zh) * | 2013-09-25 | 2014-01-01 | 江苏大学 | 一种带有安全监测的辅助泊车系统及其方法 |
CN104916162A (zh) * | 2015-05-28 | 2015-09-16 | 惠州华阳通用电子有限公司 | 泊车位检测方法和系统 |
Non-Patent Citations (1)
Title |
---|
基于无线通信的智能泊车系统设计;马志强等;《测控技术》;20130118;第32卷(第1期);1-3页 * |
Also Published As
Publication number | Publication date |
---|---|
CN105761533A (zh) | 2016-07-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105761533B (zh) | 一种无人驾驶汽车车位规划方法 | |
JP5510471B2 (ja) | 運転モデルの作成装置及び運転モデルの作成方法、並びに運転評価装置及び運転評価方法、並びに運転支援システム | |
CN103996312B (zh) | 具有社会行为交互的无人驾驶汽车控制系统 | |
CN107672595B (zh) | 用于选择和跟踪机动车辆的控制系统和控制方法 | |
CN102157062B (zh) | 获取公交专用道停靠站通行能力的方法 | |
CN108431881A (zh) | 停车辅助信息的显示方法及停车辅助装置 | |
US20140163862A1 (en) | Apparatus and method for controlling parking assistance | |
CN107305739B (zh) | 用于为交通灯辅助应用提供对队列长度的适应的装置和方法 | |
CN110789576B (zh) | 协同编队列车安全防护场景划分方法及装置 | |
CN105806353A (zh) | 自动驾驶装置 | |
CN104228829A (zh) | 停车控制方法、设备和系统 | |
CN109582021A (zh) | 智能车避障方法、装置及计算机可读存储介质 | |
CN104412309B (zh) | 推荐行驶模式生成装置及推荐行驶模式生成方法 | |
CN104299432A (zh) | 一种过饱和路口信号灯控制方法及装置 | |
CN105989720A (zh) | 一种显示信号灯信息的方法及装置 | |
US20190061764A1 (en) | Vehicle situation determination device and vehicle situation determination method | |
CN109835339B (zh) | 一种换道决策方法及装置 | |
CN109849924B (zh) | 弯道速度预警方法、系统及计算机可读存储介质 | |
CN105702035A (zh) | 一种利用历史公交数据评估乘车难易程度的方法 | |
US20190061749A1 (en) | Vehicle status determination device and vehicle status determination method | |
US9725092B2 (en) | Method, host vehicle and following space management unit for managing following space | |
CN110654397A (zh) | 自动泊车功能推送方法及系统 | |
CN102840863B (zh) | 对连续路口导航的方法、系统及导航服务器、移动终端 | |
JP6428927B2 (ja) | 車両誘導装置及び車両誘導方法 | |
CN104210440B (zh) | 停车空间探索装置及自动停车控制系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
CB03 | Change of inventor or designer information |
Inventor after: Shen Zhengnan Inventor after: Jiang Haobin Inventor after: Ma Shidian Inventor after: Li Chenxu Inventor before: Jiang Haobin Inventor before: Shen Zhengnan Inventor before: Ma Shidian Inventor before: Li Chenxu |
|
COR | Change of bibliographic data | ||
GR01 | Patent grant | ||
GR01 | Patent grant |