CN113701756A - 一种新型自适应无人车辆倒车入库路径规划与跟踪方法 - Google Patents
一种新型自适应无人车辆倒车入库路径规划与跟踪方法 Download PDFInfo
- Publication number
- CN113701756A CN113701756A CN202110891317.9A CN202110891317A CN113701756A CN 113701756 A CN113701756 A CN 113701756A CN 202110891317 A CN202110891317 A CN 202110891317A CN 113701756 A CN113701756 A CN 113701756A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- tracking
- point
- path
- garage
- 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 45
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 14
- 230000003044 adaptive effect Effects 0.000 claims description 6
- 238000004364 calculation method Methods 0.000 abstract description 4
- 238000004088 simulation Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000010365 information processing Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
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/20—Instruments for performing navigational calculations
-
- 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/18—Propelling the vehicle
- B60W30/18009—Propelling the vehicle related to particular drive situations
- B60W30/18036—Reversing
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提供一种新型自适应无人车辆倒车入库路径规划与跟踪方法,包括以下步骤:步骤10)利用车载传感器获取车辆信息和车库信息;步骤20)根据车辆信息和车库信息,基于贝塞尔曲线计算倒车路径;步骤30)基于纯跟踪算法对倒车路径进行跟踪,完成车辆的倒车入库。本发明新型自适应无人车辆倒车入库路径规划与跟踪方法,利用车辆信息与车库信息之间的关系,基于贝塞尔曲线计算得到倒车路径,再基于纯跟踪算法进行倒车路径跟踪,完成车辆的倒车入库。本发明实施例方法对于不同相对位置的不同大小车辆与车库有较好的适用性,车辆能自动准确完成倒车入库。本发明方法计算复杂度低,能够在实车嵌入式控制器上实现,有很好的应用前景。
Description
技术领域
本发明属于无人驾驶汽车路径规划与跟踪技术领域,具体涉及一种新型自适应无人车辆倒车入库路径规划与跟踪方法。
背景技术
车辆数据的获取与信息处理是实现无人驾驶汽车自主行驶的关键技术之一,而倒车入库是车辆在使用过程中不可避免的技术问题。在获得车辆的行驶数据,以及车辆的目标位置后,如何进行合适的路径规划,并对规划好的路径进行跟踪控制,使无人车辆完成倒车入库的任务,是实现自动驾驶车辆的必备环节。考虑不同车辆与不同车库的路径规划与跟踪算法,即根据传感器获得的车辆以及车库信息,根据相关几何关系,计算出使车辆可以平稳行驶,不会发生碰撞的倒车入库路径,并对该路径进行纯跟踪的倒车入库算法。
目前,国内外许多研究者针对无人驾驶汽车的倒车入库研究,大都使用传感器进行障碍以及碰撞的识别,使用反馈控制方法实现无人驾驶汽车倒车入库的路径规划跟踪。最常用的方法之一是通过车库与车辆的角度进行计算,绘制圆弧来进行车辆的路径规划,由于车辆在倒车入库时的轨迹曲线就是不同半径大小的圆弧,故圆弧形的曲线在倒车入库过程中被广泛的应用。
倒车入库路径规划算法的关键在于如何针对不同的车辆位姿进行倒车入库。由于初始车辆的位姿不同,得到车辆与车库位置时,使用圆弧进行轨迹规划不一定是可行的,那么如何计算得到一条使车辆平稳行驶,且并不会发生碰撞的倒车入库路径,是倒车入库的关键问题。因此,很多国内外学者对车辆倒车时的路径规划算法提出了很多改进。张芳等针对不同位姿的车辆与车库,提出了一种基于车辆与车库之间夹角的规划算法。特斯拉团队通过使用多传感器的方式,提出了一种根据汽车周围环境进行自适应调节的倒车入库方法。
发明内容
本发明所要解决的技术问题是:提供一种新型自适应无人车辆倒车入库路径规划与跟踪方法,对于不同相对位置的不同大小车辆与车库,均能自动成功完成倒车入库。
为解决上述技术问题,本发明提供一种新型自适应无人车辆倒车入库路径规划与跟踪方法,包括以下步骤:
步骤10)利用车载传感器获取车辆信息和车库信息;
步骤20)根据车辆信息和车库信息,基于贝塞尔曲线计算倒车路径;
步骤30)基于纯跟踪算法对倒车路径进行跟踪,完成车辆的倒车入库。
作为本发明实施例的进一步改进,所述步骤20)具体包括:
步骤201)根据车辆信息和车库信息,利用式(1)计算得到点集P:
Pb=(1-t)2P0+2t(1-t)P1+t2P2 式(1)
式中,点Pb表示点集P中的点,t=0.01i,i=0,1,2,...,100,点P0表示车辆位置(xv,yv),点P2表示车库库口的中心点 点P1表示点P0和点P2所在贝塞尔曲线的中心点(x1,y1)=(x2+ΔS1_2cosθ,y2+ΔS1_2sinθ),ΔS0_2表示点P1与点P2之间的距离,
作为本发明实施例的进一步改进,所还步骤20)还包括:
步骤202)从点P2处开始,沿车库中心线,每隔0.0S米取一个点Pci,直到取到车库尾处,记为点集Pc;将点集Pc补充至点集P中,获得路径点集Pparking。
作为本发明实施例的进一步改进,所述步骤30)具体包括:
步骤301)车辆基于纯跟踪算法跟踪倒车路径,在跟踪过程中,当车辆与倒车路径的下一个跟踪点的距离小于前视距离Sview时,开始跟踪下一个跟踪点,直至跟踪完倒车路径的所有跟踪点;
其中,车辆跟踪一个跟踪点具体包括:
利用式(2)计算车辆的前轮转角,根据前轮转角跟踪跟踪点Qnow:
如果前轮转角δ大于最大前轮转角,则使前轮转角δ等于最大前轮转角。
作为本发明实施例的进一步改进,所述步骤30)还包括:
步骤302)车辆在跟踪倒车路径过程中,根据车辆当前位置信息,判断是否会出现碰撞,若判断会出现碰撞,则重复步骤20)得到新的倒车路径,车辆跟踪新的倒车路径。
作为本发明实施例的进一步改进,所述步骤302)具体包括:
车辆在跟踪倒车路径过程中,计算车辆距离车库对边所在直线的距离ΔS,当ΔS<0.2m时,车辆切换为前进状态;前进3米后,切换为倒车状态;重复步骤20)得到新的倒车路径,跟踪新的倒车路径。
与现有技术相比,本发明的技术方案具有以下有益效果:本发明实施例提供的新型自适应无人车辆倒车入库路径规划与跟踪方法,利用车辆信息与车库信息之间的关系,基于贝塞尔曲线计算得到倒车路径,再基于纯跟踪算法进行倒车路径跟踪,完成车辆的倒车入库。本发明实施例方法对于不同相对位置的不同大小车辆与车库有较好的适用性,车辆能自动准确完成倒车入库。本发明方法计算复杂度低,能够在实车嵌入式控制器上实现,有很好的应用前景。
附图说明
图1为本发明实施例的新型自适应无人车辆倒车入库路径规划与跟踪方法的流程图;
图2为本发明实施例中纯跟踪算法阿克曼转向模型示意图;
图3为本发明实施例方法仿真获得的倒车路径曲线绘制图;
图4为本发明实施例方法仿真过程中绘制的调整过程图。
具体实施方式
下面对本发明的技术方案进行详细的说明。
本发明实施例提供一种新型自适应无人车辆倒车入库路径规划与跟踪方法,如图1所示,包括以下步骤:
步骤10)利用车载传感器获取车辆信息和车库信息。
步骤20)根据车辆信息和车库信息,基于贝塞尔曲线计算倒车路径;
步骤30)基于纯跟踪算法对倒车路径进行跟踪,完成车辆的倒车入库。
本发明实施例方法在获得车辆信息和车库信息后,通过获得的车辆信息和车库信息对车辆的倒车路径进行计算,对于不同的车辆、车库信息计算出来的倒车路径不同,均可以很好完成车辆的倒车入库过程。
具体的,步骤10)中,通过车载传感器获得车辆位置信息和车库信息,所得信息参数均为厘米级。车辆信息包括车辆中心点在大地坐标系下坐标为(xp,yp),车辆本身位置的坐标为(xv,yv),车辆航向角γ和车辆轴距Ldshaft。车库信息包括车库的长宽Llength,Lwidth,车库的朝向θ和车道宽Lroad。
优选的,所述步骤20)具体包括:
步骤201)根据车辆信息和车库信息,利用式(1)计算得到点集P:
Pb=(1-t)2P0+2t(1-t)P1+t2P2 式(1)
式中,点Pb表示点集P中的点,t=0.01i,i=0,1,2,...,100;点P0表示车辆位置,其坐标为(xv,yv);点P2表示车库库口的中心点,其坐标为 点P1表示点P0和点P2所在贝塞尔曲线的中心点,其坐标为(x1,y1)=(x2+ΔS1_2cosθ,y2+ΔS1_2sinθ),ΔS0_2表示点P1与点P2之间的距离,
进一步,所述步骤20)还包括:
步骤202)从点P2处开始,沿车库中心线,每隔0.05米取一个点Pci,直到取到车库尾处,记为点集Pc;将点集Pc补充至点集P中,获得路径点集Pparking。
本发明实施例方法通过贝塞尔曲线计算得到点集可以保证在车辆倒车入库过程中不会出现计算出的车辆转角大于车辆实际最大转角的情况,再进行补点,不点后的点集可以使车辆倒入车库的合适位置。
优选的,所述步骤30)具体包括:
步骤301)车辆基于纯跟踪算法跟踪倒车路径,在跟踪过程中,当车辆与倒车路径的下一个跟踪点的距离小于前视距离Sview时,开始跟踪下一个跟踪点,直至跟踪完倒车路径的所有跟踪点;
其中,车辆跟踪一个跟踪点具体包括:
利用式(2)计算车辆的前轮转角,根据前轮转角跟踪跟踪点Qnow:
如果前轮转角δ大于最大前轮转角,则使前轮转角δ等于最大前轮转角。
计算得到前轮转角后根据所得的转角对车辆进行控制,在倒车过程中保证车辆的前轮角度与计算所得角度一致,完成车辆的跟踪控制。
进一步,所述步骤30)还包括:
步骤302)车辆在跟踪倒车路径过程中,根据车辆当前位置信息,判断是否会出现碰撞,若判断会出现碰撞,则重复步骤20)得到新的倒车路径,车辆跟踪新的倒车路径。
进一步,所述步骤302)具体包括:
车辆在跟踪倒车路径过程中,计算车辆距离车库对边所在直线的距离ΔS,当ΔS<0.2m时,车辆切换为前进状态;前进3米后,切换为倒车状态;重复步骤20)得到新的倒车路径,跟踪新的倒车路径。
对本发明方法进行仿真,得到的仿真结果如图3和图4所示。
如图3(a)所示,当车辆离车库过近时,所得倒车路径曲线先向外延伸,可以很好的避免车辆与车库碰撞,再结合位姿的调整,该调整过程如图4所示,可以很好的完成倒车入库,有效的避免碰撞的发生,实现在任意位置进行倒车入库。如图3(b)所示,当初始车辆纵向位置距离车库较大时,所得倒车路径曲线较为平缓,可以很好的完成路径跟踪。当初始车辆与车库处于任意位姿时,如图3所示,均可以很好的完成倒车入库曲线的规划。仿真试验结果表明,本发明实施例方法具有较好的效果,可以实现在任意位置进行倒车入库。
以上显示和描述了本发明的基本原理、主要特征和优点。本领域的技术人员应该了解,本发明不受上述具体实施例的限制,上述具体实施例和说明书中的描述只是为了进一步说明本发明的原理,在不脱离本发明精神和范围的前提下,本发明还会有各种变化和改进,这些变化和改进都落入要求保护的本发明范围内。本发明要求保护的范围由权利要求书及其等效物界定。
Claims (6)
1.一种新型自适应无人车辆倒车入库路径规划与跟踪方法,其特征在于,包括以下步骤:
步骤10)利用车载传感器获取车辆信息和车库信息;
步骤20)根据车辆信息和车库信息,基于贝塞尔曲线计算倒车路径;
步骤30)基于纯跟踪算法对倒车路径进行跟踪,完成车辆的倒车入库。
3.根据权利要求2所述的新型自适应无人车辆倒车入库路径规划与跟踪方法,其特征在于,所述步骤20)还包括:
步骤202)从点P2处开始,沿车库中心线,每隔0.05米取一个点Pci,直到取到车库尾处,记为点集Pc;将点集Pc补充至点集P中,获得路径点集Pparking。
5.根据权利要求4所述的新型自适应无人车辆倒车入库路径规划与跟踪方法,其特征在于,所述步骤30)还包括:
步骤302)车辆在跟踪倒车路径过程中,根据车辆当前位置信息,判断是否会出现碰撞,若判断会出现碰撞,则重复步骤20)得到新的倒车路径,车辆跟踪新的倒车路径。
6.根据权利要求5所述的新型自适应无人车辆倒车入库路径规划与跟踪方法,其特征在于,所述步骤302)具体包括:
车辆在跟踪倒车路径过程中,计算车辆距离车库对边所在直线的距离ΔS,当ΔS<0.2m时,车辆切换为前进状态;前进3米后,切换为倒车状态;重复步骤20)得到新的倒车路径,跟踪新的倒车路径。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110891317.9A CN113701756B (zh) | 2021-08-04 | 一种新型自适应无人车辆倒车入库路径规划与跟踪方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110891317.9A CN113701756B (zh) | 2021-08-04 | 一种新型自适应无人车辆倒车入库路径规划与跟踪方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113701756A true CN113701756A (zh) | 2021-11-26 |
CN113701756B CN113701756B (zh) | 2024-05-31 |
Family
ID=
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103158703A (zh) * | 2013-03-26 | 2013-06-19 | 北京经纬恒润科技有限公司 | 一种平行泊车的控制方法 |
US20150094945A1 (en) * | 2013-09-27 | 2015-04-02 | Transoft Solutions, Inc. | Method and apparatus for generating a vehicle path |
CN107167155A (zh) * | 2017-05-08 | 2017-09-15 | 江苏大学 | 一种地下停车场弯曲坡道路径规划及路径跟踪方法 |
CN108646748A (zh) * | 2018-06-05 | 2018-10-12 | 北京联合大学 | 一种场地无人车轨迹跟踪方法及系统 |
CN110949374A (zh) * | 2019-11-14 | 2020-04-03 | 江苏大学 | 基于两段二阶贝塞尔曲线的自动平行泊车路径规划方法 |
CN110955250A (zh) * | 2019-12-25 | 2020-04-03 | 湖南大学 | 一种车辆倒车路径跟踪控制方法 |
CN111338349A (zh) * | 2020-03-09 | 2020-06-26 | 兰剑智能科技股份有限公司 | Agv的贝塞尔曲线控制方法及系统 |
CN112793562A (zh) * | 2021-02-03 | 2021-05-14 | 武汉理工大学 | 一种自动泊车路径的规划和跟踪控制方法、规划装置、存储介质和计算机设备 |
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103158703A (zh) * | 2013-03-26 | 2013-06-19 | 北京经纬恒润科技有限公司 | 一种平行泊车的控制方法 |
US20150094945A1 (en) * | 2013-09-27 | 2015-04-02 | Transoft Solutions, Inc. | Method and apparatus for generating a vehicle path |
CN107167155A (zh) * | 2017-05-08 | 2017-09-15 | 江苏大学 | 一种地下停车场弯曲坡道路径规划及路径跟踪方法 |
CN108646748A (zh) * | 2018-06-05 | 2018-10-12 | 北京联合大学 | 一种场地无人车轨迹跟踪方法及系统 |
CN110949374A (zh) * | 2019-11-14 | 2020-04-03 | 江苏大学 | 基于两段二阶贝塞尔曲线的自动平行泊车路径规划方法 |
CN110955250A (zh) * | 2019-12-25 | 2020-04-03 | 湖南大学 | 一种车辆倒车路径跟踪控制方法 |
CN111338349A (zh) * | 2020-03-09 | 2020-06-26 | 兰剑智能科技股份有限公司 | Agv的贝塞尔曲线控制方法及系统 |
CN112793562A (zh) * | 2021-02-03 | 2021-05-14 | 武汉理工大学 | 一种自动泊车路径的规划和跟踪控制方法、规划装置、存储介质和计算机设备 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109927716B (zh) | 基于高精度地图的自主垂直泊车方法 | |
CN104512462B (zh) | 车道维持控制装置及方法 | |
Liang et al. | Automatic parking path optimization based on bezier curve fitting | |
CN110361013B (zh) | 一种用于车辆模型的路径规划系统及方法 | |
CN107085938B (zh) | 基于车道线与gps跟随的智能驾驶局部轨迹容错规划方法 | |
CN108032859B (zh) | 自动变道控制方法、装置和汽车 | |
CN110696819B (zh) | 一种自动泊车路径规划方法及系统 | |
CN112141091B (zh) | 解决车位偏移和定位偏移的二次泊车方法、系统及车辆 | |
CN109270933A (zh) | 基于圆锥曲线的无人驾驶避障方法、装置、设备及介质 | |
CN105197010A (zh) | 辅助泊车系统以及辅助泊车控制方法 | |
CN106681327A (zh) | 一种大惯性电动客车的智能驾驶横纵向解耦控制方法及系统 | |
CN107544520A (zh) | 一种用于四轮载具自动驾驶的控制方法 | |
Zhang et al. | Automatic vehicle parallel parking design using fifth degree polynomial path planning | |
CN112249014B (zh) | 车辆横向控制方法、车辆以及计算机可读存储介质 | |
CN106950953A (zh) | 一种自动泊车路径跟踪及车辆控制系统和方法 | |
CN111452868B (zh) | 曲线转弯控制方法、装置、存储介质及车辆 | |
CN113264049A (zh) | 一种智能网联车队协作换道控制方法 | |
CN113885525A (zh) | 一种自动驾驶车辆脱困的路径规划方法、系统、车辆及存储介质 | |
CN113341999A (zh) | 一种基于优化d*算法的叉车路径规划方法及装置 | |
CN109606355A (zh) | 辅助泊车轨迹规划的方法 | |
CN113701756B (zh) | 一种新型自适应无人车辆倒车入库路径规划与跟踪方法 | |
CN113701756A (zh) | 一种新型自适应无人车辆倒车入库路径规划与跟踪方法 | |
CN113625715B (zh) | 一种自动化集装箱码头agv的快速轨迹跟踪控制方法 | |
CN112731944B (zh) | 一种无人驾驶压路机自主避障方法 | |
CN112092800B (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 |