CN110737261A - 一种车辆的自动停靠站控制方法及系统 - Google Patents
一种车辆的自动停靠站控制方法及系统 Download PDFInfo
- Publication number
- CN110737261A CN110737261A CN201810720155.0A CN201810720155A CN110737261A CN 110737261 A CN110737261 A CN 110737261A CN 201810720155 A CN201810720155 A CN 201810720155A CN 110737261 A CN110737261 A CN 110737261A
- Authority
- CN
- China
- Prior art keywords
- inbound
- paths
- path
- station
- obstacles
- 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
- 238000000034 method Methods 0.000 title claims abstract description 26
- 230000004888 barrier function Effects 0.000 claims abstract description 15
- 238000004590 computer program Methods 0.000 claims description 5
- 230000009977 dual effect Effects 0.000 claims 1
- 206010034962 Photopsia Diseases 0.000 description 4
- 230000003068 static effect Effects 0.000 description 2
- 230000006399 behavior Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000003032 molecular docking Methods 0.000 description 1
- 238000012216 screening Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
Abstract
本发明涉及一种车辆的自动停靠站控制方法及系统,属于自动驾驶路径规划技术领域。本发明通过规划出多条全局进站路径,并根据各进站路径是否存在障碍物来选择相应一条进站路径进行停靠,既保证了所选择的停靠路径是全局路径,又保证了所选择的停靠路径满足无碰撞要求,解决了目前所选择的停靠路径停站位置、方向不合理的问题,优化了车辆停靠过程中的进站路径。
Description
技术领域
本发明涉及一种车辆的自动停靠站控制方法及系统,属于自动驾驶路径规划技术领域。
背景技术
自动驾驶车辆路径规划分为两类:一类是基于地图信息的全局路径规划,它是根据先验环境模型找出的一条可顺利通过的路径;另外一类是基于自动驾驶车辆周围信息的局部路径规划,它是在车辆运行环境部分未知或者完全未知的情况下,通过自身传感器实时获取道路及障碍物信息,并规划出一条局部路径,实现无碰撞行驶。全局路径规划的任务是根据全局静态地图数据库信息规划出自起始点到目标点的一条无碰撞、可通过的路径;而局部规划的任务是根据局部环境信息和自身状态信息,规划出一段无碰撞的局部路径。全局路径为局部规划提供导向约束,全局路径算法实时性较差,同时依赖于全局静态地图,属于道路级路径规划,而局部规划实时性好,能够根据局部环境动态规划路径,属于车道级路径规划,可直接用于控制。
对于公交车自动停靠站场景,目前通用的做法为,首先根据环境地图规划出一条全局进站路径,在无障碍物的情况下,车辆沿着全局路径循迹即可实现精确停靠站,当全局路径有障碍物遮挡的情况下,使用局部规划算法(如B样条、触须法、多项式曲线等)规划出一条局部路径,对于进出站场景,由于局部环境的不确定性因素较多,同时又处于换道避障与精确进站的双层任务下,造成局部规划模块规划出的曲线难以同时兼顾两者,要不无法精确进站,要不无法避障。
发明内容
本发明的目的是提供一种车辆的自动停靠站控制方法,以解决目前车辆停靠控制方法中存在的停靠位置、方向不合理的问题;同时,本发明还提供了一种车辆的自动停靠站控制系统。
本发明为解决上述技术问题而提供一种车辆的自动停靠站控制方法,该方法包括以下步骤:
1)规划出至少两条全局进站路径;
2)选取其中一条进站路径,并判断该进站路径上是否有障碍物,若没有,则按照该进站路径行驶;
3)当所选取的进站路径上有障碍物时,则逐个判断其余进站路径是否存在障碍物,直至找到没有障碍物的进站路径。
本发明通过规划出多条全局进站路径,并根据各进站路径是否存在障碍物来选择相应一条进站路径进行停靠,既保证了所选择的停靠路径是全局路径,又保证了所选择的停靠路径满足无碰撞要求,解决了目前所选择的停靠路径停站位置、方向不合理的问题,优化了车辆停靠过程中的进站路径。
进一步地,为了解决所有规划路径均存在障碍物时的路径选择问题,当所有进站路径上都有障碍物时,按照距离站台最近的进站路径行驶,并进行报警提醒。
进一步地,为了保证能够选择到路径的最优,所述步骤2)选取的是距离站台最近的进站路径。
进一步地,为了保证所选择的路径较优,在逐个判断其余进站路径时是按照进站路径距离站台由近到远的顺序来选择的。
进一步地,所述的报警提醒采用喇叭和或双闪灯信号实现。
本发明还提供了一种车辆的自动停靠站控制系统,该控制系统包括存储器和处理器,以及存储在所述存储器上并在所述处理器上运行的计算机程序,所述处理器与所述存储器相耦合,所述处理器执行所述计算机程序时实现以下步骤:
1)规划出至少两条全局进站路径;
2)选取其中一条进站路径,并判断该进站路径上是否有障碍物,若没有,则按照该进站路径行驶;
3)当所选取的进站路径上有障碍物时,则逐个判断其余进站路径是否存在障碍物,直至找到没有障碍物的进站路径。
进一步地,当所有进站路径上都有障碍物时,按照距离站台最近的进站路径行驶,并进行报警提醒。
进一步地,所述步骤2)选取的是距离站台最近的进站路径。
进一步地,在逐个判断其余进站路径时是按照进站路径距离站台由近到远的顺序来实现的。
进一步地,所述的报警提醒采用喇叭和或双闪灯信号实现。
附图说明
图1是本发明车辆的自动停靠站控制方法的原理图;
图2是本发明车辆的自动停靠站控制方法的流程图。
具体实施方式
下面结合附图对本发明的具体实施方式进行详细说明。
本发明首先通过环境地图规划出多条全局进站路径;然后选取其中一条进站路径,并判断该进站路径上是否有障碍物,若没有,则按照该进站路径行驶;当所选取的进站路径上有障碍物时,则逐个判断其余进站路径是否存在障碍物,直至找到没有障碍物的进站路径。下面以城市公交车辆停靠站为例对本发明的停靠站控制方法进行详细说明,该方法的实现流程如图2所示,具体实施过程如下。
1.规划出至少两条全局进站路径。
本发明根据环境地图规划出N条全局进站路径,这N条路径均是全局路径。主要是通过采集多名驾驶员在不同场景下(如车速、障碍物)的进出站位置与速度曲线,并通过车辆运动学方程进行约束,最后筛选出多条模拟驾驶员进站行为的路径。整体实施方式类似于多名驾驶员在同一条路上开出的多条导航线。
X=V*COS(θ)
Y=V*SIN(θ)
θ=V*TAN(δ)/L
其中,(X,Y)为车辆位置坐标,θ为车辆航向角,δ为前轮偏角,V为车速,L为轴距。
车辆沿着这N条路径中的任一条仅能够实现精确停靠站。对本实施例而言,规划出的N条进站路径如图1所示,3是所规划出的一组N条进站路径,2是站台,1是自动驾驶公交车,其中最右边的进站路径最靠近站台2,自动驾驶公交车1沿着进站路径3中的任意一条均可到达站台2。
2.选取其中一条进站路径,并判断该进站路径上是否有障碍物,若没有,则按照该进站路径行驶。
所规划出的N条路径中的任一条进站路径均能够到达站台,可以首先选择其中任意一条进行判断,当判断到所选择的进站路径上没有有障碍物时,则控制车辆沿着该进站路径进行停靠。其中障碍物检测可通过在车辆上设置雷达、摄像头等方式实现,这在车辆碰撞检测领域属于非常成熟的技术,这里不再详述。
由于所规划出的N条进站路径距离站台的远近不同,距离站台越近的路径越优,因此,在选择时,首先选择距离站台最近的进站路径进行判断,一旦该进站路径满足无碰撞要求,则选择该进站路径进行停靠站,这样,就选择到了最优路径来进行停靠。
3.当所选取的进站路径上有障碍物时,则逐个判断其余进站路径是否存在障碍物,直至找到没有障碍物的进站路径。
若选取的路径上有障碍物时,则说明不能沿着该进站路径进行停靠,则需要从其余的停靠进站路径中选取新的路径进行障碍物的重新判断。为了保证所选取的进站路径较优,本发明按照距离站台由近到远的顺序逐个选取进站路径进行障碍物判断,直至找到满足无碰撞要求的进站路径,并按照该进站路径进行停靠。对本实施例而言,如图1所示,按照从右向左的顺序逐个进行障碍物检测判断,直至达到最左边的进站路径。
若在逐个选取进站路径进行障碍物判断过程,发现所有进站路径均不能满足无碰撞要求,则按照距离站台最近的进站路径进行停靠站,并通过喇叭、双闪灯信号提醒。
上述方法可以作为一种计算机程序,存储在车辆的自动停靠站控制系统中的存储器中并可在车辆的自动停靠站控制系统中的处理器上运行,该系统中的处理器可以采用单片机、FPGA、DSP、PLC或MCU等实现,存储器可以采用RAM存储器、闪存、ROM存储器、EPROM存储器、EEPROM存储器、寄存器、硬盘、移动磁盘、CD-ROM或者本领域已知的任何其他形式的存储介质,可以将该存储介质耦接至处理器,使处理器能够从该存储介质读取信息,或者该存储介质可以是处理器的组成部分。
通过上述过程本发明能够按照最靠站台的一条路径行驶,当有障碍物遮挡时,由仅到远逐个判断该条轨迹上是否有障碍物,直到满足无碰撞要求时,按照此条路径行驶,否则继续,当所有路径上都有障碍物时,按照距离站台最近进站路径行驶,并通过喇叭、双闪灯信号提醒。所选的任一路径均是规划出的全局路径,解决了目前公交车进靠站系统鲁棒性差,进站不合理等问题,提高了车辆进站停靠位置的合理性。
Claims (10)
1.一种车辆的自动停靠站控制方法,其特征在于,该方法包括以下步骤:
1)规划出至少两条全局进站路径;
2)选取其中一条进站路径,并判断该进站路径上是否有障碍物,若没有,则按照该进站路径行驶;
3)当所选取的进站路径上有障碍物时,则逐个判断其余进站路径是否存在障碍物,直至找到没有障碍物的进站路径。
2.根据权利要求1所述车辆的自动停靠站控制方法,其特征在于,当所有进站路径上都有障碍物时,按照距离站台最近的进站路径行驶,并进行报警提醒。
3.根据权利要求1或2所述的车辆的自动停靠站控制方法,其特征在于,所述步骤2)选取的是距离站台最近的进站路径。
4.根据权利要求1或2所述的车辆的自动停靠站控制方法,其特征在于,在逐个判断其余进站路径时是按照进站路径距离站台由近到远的顺序来选择的。
5.根据权利要求2所述的车辆的自动停靠站控制方法,其特征在于,所述的报警提醒采用喇叭和或双闪灯信号实现。
6.一种车辆的自动停靠站控制系统,其特征在于,该控制系统包括存储器和处理器,以及存储在所述存储器上并在所述处理器上运行的计算机程序,所述处理器与所述存储器相耦合,所述处理器执行所述计算机程序时实现以下步骤:
1)规划出至少两条全局进站路径;
2)选取其中一条进站路径,并判断该进站路径上是否有障碍物,若没有,则按照该进站路径行驶;
3)当所选取的进站路径上有障碍物时,则逐个判断其余进站路径是否存在障碍物,直至找到没有障碍物的进站路径。
7.根据权利要求6所述车辆的自动停靠站控制系统,其特征在于,当所有进站路径上都有障碍物时,按照距离站台最近的进站路径行驶,并进行报警提醒。
8.根据权利要求6或7所述的车辆的自动停靠站控制系统,其特征在于,所述步骤2)选取的是距离站台最近的进站路径。
9.根据权利要求6或7所述的车辆的自动停靠站控制系统,其特征在于,在逐个判断其余进站路径时是按照进站路径距离站台由近到远的顺序来实现的。
10.根据权利要求7所述的车辆的自动停靠站控制系统,其特征在于,所述的报警提醒采用喇叭和或双闪灯信号实现。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810720155.0A CN110737261B (zh) | 2018-07-03 | 2018-07-03 | 一种车辆的自动停靠站控制方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810720155.0A CN110737261B (zh) | 2018-07-03 | 2018-07-03 | 一种车辆的自动停靠站控制方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110737261A true CN110737261A (zh) | 2020-01-31 |
CN110737261B CN110737261B (zh) | 2023-06-02 |
Family
ID=69234330
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810720155.0A Active CN110737261B (zh) | 2018-07-03 | 2018-07-03 | 一种车辆的自动停靠站控制方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110737261B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112622933A (zh) * | 2020-12-24 | 2021-04-09 | 北京百度网讯科技有限公司 | 车辆停靠点的确定方法及装置 |
CN114184201A (zh) * | 2020-09-15 | 2022-03-15 | 郑州宇通客车股份有限公司 | 一种用于路口的转向路径生成方法、系统及车辆 |
CN114370874A (zh) * | 2020-10-15 | 2022-04-19 | 郑州宇通客车股份有限公司 | 一种车辆、车辆路径规划方法及装置 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101556625A (zh) * | 2009-05-19 | 2009-10-14 | 上海理工大学 | 驾驶员对路径信息板动态响应行为的动态模拟方法 |
JP2011034128A (ja) * | 2009-07-29 | 2011-02-17 | Toyota Motor Corp | 運転誘導装置 |
KR20150086065A (ko) * | 2014-01-17 | 2015-07-27 | 전남대학교산학협력단 | 무인운전차량의 자율 주행을 위한 경로 추종 시스템 및 방법 |
CN105318884A (zh) * | 2014-07-28 | 2016-02-10 | 现代自动车株式会社 | 生成用于自动车辆的全局路径的装置和方法 |
CN105599764A (zh) * | 2014-11-12 | 2016-05-25 | 现代自动车株式会社 | 用于自主车辆的行车路线规划装置及方法 |
CN106406320A (zh) * | 2016-11-29 | 2017-02-15 | 重庆重智机器人研究院有限公司 | 机器人路径规划方法及规划路线的机器人 |
CN107031619A (zh) * | 2015-12-11 | 2017-08-11 | 现代自动车株式会社 | 用于控制自动驾驶系统的路径的方法和设备 |
CN107664993A (zh) * | 2016-07-29 | 2018-02-06 | 法乐第(北京)网络科技有限公司 | 一种路径规划方法 |
CN107672585A (zh) * | 2017-08-29 | 2018-02-09 | 广州小鹏汽车科技有限公司 | 一种自动泊车路径规划方法及系统 |
-
2018
- 2018-07-03 CN CN201810720155.0A patent/CN110737261B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101556625A (zh) * | 2009-05-19 | 2009-10-14 | 上海理工大学 | 驾驶员对路径信息板动态响应行为的动态模拟方法 |
JP2011034128A (ja) * | 2009-07-29 | 2011-02-17 | Toyota Motor Corp | 運転誘導装置 |
KR20150086065A (ko) * | 2014-01-17 | 2015-07-27 | 전남대학교산학협력단 | 무인운전차량의 자율 주행을 위한 경로 추종 시스템 및 방법 |
CN105318884A (zh) * | 2014-07-28 | 2016-02-10 | 现代自动车株式会社 | 生成用于自动车辆的全局路径的装置和方法 |
CN105599764A (zh) * | 2014-11-12 | 2016-05-25 | 现代自动车株式会社 | 用于自主车辆的行车路线规划装置及方法 |
CN107031619A (zh) * | 2015-12-11 | 2017-08-11 | 现代自动车株式会社 | 用于控制自动驾驶系统的路径的方法和设备 |
CN107664993A (zh) * | 2016-07-29 | 2018-02-06 | 法乐第(北京)网络科技有限公司 | 一种路径规划方法 |
CN106406320A (zh) * | 2016-11-29 | 2017-02-15 | 重庆重智机器人研究院有限公司 | 机器人路径规划方法及规划路线的机器人 |
CN107672585A (zh) * | 2017-08-29 | 2018-02-09 | 广州小鹏汽车科技有限公司 | 一种自动泊车路径规划方法及系统 |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114184201A (zh) * | 2020-09-15 | 2022-03-15 | 郑州宇通客车股份有限公司 | 一种用于路口的转向路径生成方法、系统及车辆 |
CN114184201B (zh) * | 2020-09-15 | 2023-08-25 | 宇通客车股份有限公司 | 一种用于路口的转向路径生成方法、系统及车辆 |
CN114370874A (zh) * | 2020-10-15 | 2022-04-19 | 郑州宇通客车股份有限公司 | 一种车辆、车辆路径规划方法及装置 |
CN114370874B (zh) * | 2020-10-15 | 2023-08-25 | 宇通客车股份有限公司 | 一种车辆、车辆路径规划方法及装置 |
CN112622933A (zh) * | 2020-12-24 | 2021-04-09 | 北京百度网讯科技有限公司 | 车辆停靠点的确定方法及装置 |
CN112622933B (zh) * | 2020-12-24 | 2022-07-08 | 北京百度网讯科技有限公司 | 车辆停靠点的确定方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN110737261B (zh) | 2023-06-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2020135742A1 (zh) | 自动驾驶车辆的横向决策系统及横向决策确定方法 | |
US9688272B2 (en) | Surroundings monitoring apparatus and drive assistance apparatus | |
CN109987092B (zh) | 一种车辆避障换道时机的确定方法及避障换道的控制方法 | |
US10583839B2 (en) | Method of lane change decision-making and path planning | |
US20160325750A1 (en) | Travel control apparatus | |
CN106428007A (zh) | 车辆的自主行驶控制装置和自主行驶控制方法 | |
JP6641583B2 (ja) | 車両制御装置、車両制御方法、およびプログラム | |
CN111469847B (zh) | 一种变道路径规划的方法及系统 | |
JP2019159426A (ja) | 車両制御装置、車両制御方法、およびプログラム | |
JP2019160032A (ja) | 車両制御装置、車両制御方法、およびプログラム | |
CN112265542B (zh) | 一种自动驾驶会车场景处理方法及其装置、车辆 | |
CN111731294B (zh) | 行驶控制装置、行驶控制方法以及存储程序的存储介质 | |
CN112937557B (zh) | 一种基于曲率控制的代客泊车路径规划方法及系统 | |
CN111399512A (zh) | 行车控制方法、行车控制装置和车辆 | |
CN111422187A (zh) | 车辆以及用于控制车辆的方法 | |
CN110737261A (zh) | 一种车辆的自动停靠站控制方法及系统 | |
CN110673595B (zh) | 车辆自动驾驶时避障的方法、系统及车辆 | |
JP2019144689A (ja) | 車両制御装置 | |
CN113320545A (zh) | 一种基于线控智能车辆的预路口行为决策方法 | |
JP6365402B2 (ja) | 走行制御装置 | |
CN111103882A (zh) | 一种无人驾驶电动汽车的自主跟车控制方法 | |
CN114572250A (zh) | 一种自动驾驶通过交叉路口的方法及存储介质 | |
JP7223588B2 (ja) | 運転特性推定方法及び運転特性推定装置 | |
CN113386771A (zh) | 道路模型的生成方法及设备 | |
CN113370994A (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 | ||
CB02 | Change of applicant information | ||
CB02 | Change of applicant information |
Address after: No. 6, Yutong Road, Guancheng Hui District, Zhengzhou, Henan 450061 Applicant after: Yutong Bus Co.,Ltd. Address before: 450061 Yudao Road, Guancheng District, Zhengzhou City, Henan Province Applicant before: ZHENGZHOU YUTONG BUS Co.,Ltd. |
|
GR01 | Patent grant | ||
GR01 | Patent grant |