CN107167155A - 一种地下停车场弯曲坡道路径规划及路径跟踪方法 - Google Patents
一种地下停车场弯曲坡道路径规划及路径跟踪方法 Download PDFInfo
- Publication number
- CN107167155A CN107167155A CN201710318248.6A CN201710318248A CN107167155A CN 107167155 A CN107167155 A CN 107167155A CN 201710318248 A CN201710318248 A CN 201710318248A CN 107167155 A CN107167155 A CN 107167155A
- Authority
- CN
- China
- Prior art keywords
- path
- curved ramp
- ramp
- vehicle
- control
- 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.)
- Pending
Links
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/34—Route searching; Route guidance
- G01C21/3407—Route searching; Route guidance specially adapted for specific applications
- G01C21/3415—Dynamic re-routing, e.g. recalculating the route when the user deviates from calculated route or after detecting real-time traffic data or accidents
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明公开了一种地下停车场弯曲坡道路径规划及路径跟踪方法,是在地下停车场三维弯曲坡道上,由已知规划的行驶路径,通过模型预测算法进行弯曲坡道上路径跟踪,完成弯曲坡道的自动驾驶。该方法具体过程如下:1)当自主车辆开始进入地下停车场坡道时,由车辆定位***给出此时车辆起始点在弯曲坡道的相对位置。2)由自主车辆在弯曲坡道入口处的位置信息,结合数字地图,即可根据螺线的数学公式进行弯曲坡道内的路径规划。3)已知弯曲坡道内的行驶路径,根据模型预测控制进行路径跟踪。相比于目前二维平面路径规划,本发明结合数字地图和螺线公式能够规划出三维路径,采用模型预测进行路径跟踪,弯曲坡道路径跟踪效果较好。
Description
技术领域
本发明属于自动驾驶领域,尤其涉及一种地下停车场弯曲坡道路径规划及路径跟踪方法。
背景技术
随着自动控制技术在汽车所有执行器上得到普遍应用,进而又有若干执行器组合上得到普遍应用,自动驾驶技术有着长远的发展过程,导致今天全自动驾驶呼之欲出。
在全自动驾驶技术中,由于全工况的复杂性及人工智能的不完善性,急需一个正在意义上的全自动驾驶产品推动自动驾驶的前进,因此,局部工况的停车场自主泊车应运而生。停车场自主泊车指的是,自主车辆停在停车场入口处,车辆自主进入停车场,并在停车场内寻库且完成泊车。因此,自主车辆能自主出入停车场,是完成停车场自主泊车的前提。
鉴于上述情况,有必要在停车场自主泊车技术中,提出一种地下停车场弯曲坡道路径规划及路径跟踪方法。
发明内容
本发明提出一种地下停车场弯曲坡道路径规划及路径跟踪方法。在地下停车场自主泊车技术中,自主车辆能自动出入地下停车场时前提,因此,只有通过地下停车场坡道完成自主出入地下停车场,地下停车场自主泊车才能进入寻库及泊车的流程。
本发明解决了在地下停车场弯曲坡道工况下跟踪三维路径的难题,为未来地下停车场自主泊车做铺垫,也补充了在三维立体空间上的路径跟踪。
为实现上述目的,本发明采用的技术方案如下:
本发明提出的一种地下停车场弯曲坡道路径规划及路径跟踪方法是在地下停车场三维弯曲坡道上,由已知规划的行驶路径,通过模型预测算法进行弯曲坡道上路径跟踪,完成弯曲坡道的自动驾驶,补充了路径跟踪技术在三维空间上的不足,该方法具体过程如下:
1)当自主车辆开始进入地下停车场坡道时,由车辆定位***给出此时车辆起始点在弯曲坡道的相对位置。
2)由自主车辆在弯曲坡道入口处的位置信息,结合数字地图,即可根据螺线的数学公式进行弯曲坡道内的路径规划。
3)已知弯曲坡道内的行驶路径,根据模型预测控制进行路径跟踪。
本发明的有益效果:本发明提出了一种地下停车场弯曲坡道路径规划及路径跟踪方法,该方法相比于现有方法具有如下优势:
(1)目前还没有针对地下停车场弯曲坡道这类特定工况的路径跟踪见报道,本发明具有特定性,解决了未来在地下停车场的区域自动驾驶的弯曲坡道路径跟踪的问题,具有较好的前瞻性。
(2)本发明通用性强,不需要地下停车场另外安装设备,成本较低。
(3)本发明结合数字地图和螺线公式进行路径规划,再由模型预测控制进行路径跟踪,具有如下几个好处:第一,相比于目前的二维平面的路径规划,本发明结合数字地图和螺线公式能够规划出三维路径,弥补了二维平面路径规划在三维弯曲坡道的空缺;第二,将模型预测应用在路径跟踪领域中,弯曲坡道路径跟踪效果较好。
附图说明
图1为本发明一实施方式中结合圆柱螺线进行路径规划的示意图。
图2为模型预测控制的路径跟踪框图。
图3为自主车辆在地下停车场弯曲坡道车速控制框图。
具体实施方式
下面结合附图以及具体实例对本发明的技术方案及设计原理进行阐述,但本发明的保护范围并不限于此。
本发明的一种地下停车场弯曲坡道路径规划及路径跟踪方法,由车辆定位***得出自主车辆在地下停车场坡道的起始位置,路径规划***结合数字地图和圆柱螺线生成弯曲坡道的行驶路径,再由模型预测控制对该路径进行跟踪,补充三维空间的路径规划及跟踪解决方案。
图1为本发明所述的一实施方式中结合圆柱螺线进行路径规划的示意图,在所述的一实施方式中,数字地图中的地下停车场弯曲坡道曲线可用圆柱螺线进行表征。
该圆柱面为:x2+y2=a2
由P点起始的圆柱螺线上一点M(x,y,z),|PQ|=2ab,Q表示点Q,a表示圆柱面底面圆的半径、b表示表示影响螺距的一个变量参数。
且,
点O和点P看成是地下停车场弯曲坡道的某一入口处,由于弯曲坡道曲线类型可用圆柱螺线进行表征,因此,从点O到点P之间的任意一点都必有一条圆柱螺线和该点对应。因此,只要由车辆定位***得知车辆在入口处的位置,即点O到点P之间的某一点坐标,就可以通过圆柱螺线规划出一条路径。
图2为模型预测控制的路径跟踪框图,路径跟踪目的是协同控制方向盘角度和车速,使汽车轨迹和规划的路径一致。由得出的规划路径输入到有限时域滚动优化中,滚动优化以车速为约束条件,求解最优解,使车辆轨迹无限逼近规划的路径。同时,路径跟踪由模型预测控制器控制为主,雷达反馈作为辅助反馈进行监控车辆位置。
图3为自主车辆在地下停车场弯曲坡道内车速控制策略,将坡道类型、坡度和弯度作为输入量,由模糊控制器进行模糊控制输出加速度到自主车辆,自主车辆的速度作为反馈量输入到模糊控制器。
该方法具体过程如下:
1)当自主车辆开始进入地下停车场弯曲坡道时,由车辆定位***输出此刻自主车辆在弯曲坡道的位置信息,即自主车辆后轴中心位置在弯曲坡道起始点处的位置,将自主车辆后轴中心位置信息输出到路径规划***。
2)路径规划***接收到来自车辆定位***的自主车辆后轴中心位置信息,数字地图中通过圆柱螺线、圆锥螺线等螺线公式表征的弯曲坡道。自主车辆后轴中心为原点建立三维坐标系,将该原点处的螺线公式结合数字地图提取出来,由以自主车辆后轴中心为原点的三维坐标系和以该原点为起始点的螺线表达式组成自主车辆后轴中心的规划路径。
3)路径跟踪目的是协同控制方向盘角度和车速,使汽车轨迹和规划的路径一致。同时,又要解决坡道车速控制和前车车距控制。路径跟踪由模型预测控制,滚动优化以车速控制为约束条件,求解方向盘角度最优解,优化车速和方向盘在弯曲坡道的协同控制。车速控制由模糊控制器根据坡道类型、坡度和弯度进行模糊控制。若前方有车辆,则将车速控制和车距控制进行决策融合,将融合结果作为求解的约束条件,求方向盘角度最优解。
4)若弯曲坡道前方同方向有车辆时,则需考虑车距保持控制,通过同方向两车的位移差、速度差和设定的安全距离进行车距控制。车距控制公式:
a=k1(Δx-Sa)+k2*Δv
其中,Δx为位移差,Sa为安全距离,Δv为速度差,a表示车辆加速度,k1表示位移差和安全距离之差对于车辆加速度的影响因子,k2表示速度差对于车辆加速度的影响因子。
车距控制输出的加速度和车速控制输出的加速度需要进行决策融合,再将融合结果得到的加速度值作为约束条件,求方向盘角度最优解。
综上所述,地下停车场弯曲坡道的路径规划有别于目前室内的路径规划算法,首先,目前大多数路径规划生成的都是二维路径,大多数路径规划的目的都是规划最优最短路线。因此,地下停车场弯曲坡道路径规划的研究很有必要。本发明补充解决了三维空间的路径规划及跟踪问题,方案简单,成本较低。
所述实施例为针对本发明的可行性实施方式的具体说明,它们并非用以限制本发明的保护范围,凡未脱离本发明技艺精神所为的等效实施方式或变更均应包含在本发明的保护范围之内。
Claims (5)
1.一种地下停车场弯曲坡道路径规划及路径跟踪方法,其特征在于,包括如下步骤:
1)当自主车辆开始进入地下停车场坡道时,由车辆定位***给出此时车辆起始点在弯曲坡道的相对位置;
2)由自主车辆在弯曲坡道入口处的位置信息,结合数字地图,根据螺线的数学公式进行弯曲坡道内的路径规划;
3)已知弯曲坡道内的行驶路径,根据模型预测控制进行路径跟踪。
2.根据权利要求1所述的一种地下停车场弯曲坡道路径规划及路径跟踪方法,其特征在于,所述步骤2)的具体实现包括:将数字地图中的地下停车场弯曲坡道曲线用圆柱螺线进行表征;该圆柱面为:
x2+y2=a2
由P点起始的圆柱螺线上一点M(x,y,z),|PQ|=2ab,Q表示点Q。
且,
点O和点P表示地下停车场弯曲坡道的某一入口处,并且点O到点P之间的任意一点都必有一条圆柱螺线和该点对应;通过车辆定位***得知的车辆在入口处的位置,即点O到点P之间的某一点坐标,即可通过圆柱螺线规划出一条路径。
3.根据权利要求2所述的一种地下停车场弯曲坡道路径规划及路径跟踪方法,其特征在于,步骤2)的具体实现还包括:由得出的规划路径输入到有限时域滚动优化中,滚动优化以车速为约束条件,求解最优解,使车辆轨迹无限逼近规划的路径。
4.根据权利要求1所述的一种地下停车场弯曲坡道路径规划及路径跟踪方法,其特征在于,步骤3)中所述路径跟踪由模型预测控制器控制为主,雷达反馈作为辅助反馈进行监控车辆位置。
5.根据权利要求4所述的一种地下停车场弯曲坡道路径规划及路径跟踪方法,其特征在于,所述路径跟踪的实现包括如下:
将坡道类型、坡度和弯度作为输入量,采用模糊控制进行模糊控制输出加速度到自主车辆,自主车辆的速度作为反馈量输入到模糊控制器;具体过程如下:
1)当自主车辆开始进入地下停车场弯曲坡道时,由车辆定位***输出此刻自主车辆在弯曲坡道的位置信息,即自主车辆后轴中心位置在弯曲坡道起始点处的位置,将自主车辆后轴中心位置信息输出到路径规划***。
2)路径规划***接收到来自车辆定位***的自主车辆后轴中心位置信息,数字地图中通过圆柱螺线或者圆锥螺线公式表征弯曲坡道;自主车辆后轴中心为原点建立三维坐标系,将该原点处的螺线公式结合数字地图提取出来,由以自主车辆后轴中心为原点的三维坐标系和以该原点为起始点的螺线表达式组成自主车辆后轴中心的规划路径;
3)协同控制方向盘角度和车速,使汽车轨迹和规划的路径一致;同时,控制坡道车速和前车车距;路径跟踪由模型预测控制、滚动优化以车速控制为约束条件,求解方向盘角度最优解,优化车速和方向盘在弯曲坡道的协同控制;所述车速控制由模糊控制器根据坡道类型、坡度和弯度进行模糊控制;若前方有车辆,则将车速控制和车距控制进行决策融合,将融合结果作为求解的约束条件,求方向盘角度最优解;
4)若弯曲坡道前方同方向有车辆时,则需考虑车距保持控制,通过同方向两车的位移差、速度差和设定的安全距离进行车距控制;车距控制公式为:
a=k1(Δx-Sa)+k2*Δv
其中,Dx为位移差,Sa为安全距离,Δv为速度差,a表示车辆加速度,k1表示位移差和安全距离之差对于车辆加速度的影响因子,k2表示速度差对于车辆加速度的影响因子;
车距控制输出的加速度和车速控制输出的加速度需要进行决策融合,再将融合结果得到的加速度值作为约束条件,求方向盘角度最优解。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710318248.6A CN107167155A (zh) | 2017-05-08 | 2017-05-08 | 一种地下停车场弯曲坡道路径规划及路径跟踪方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710318248.6A CN107167155A (zh) | 2017-05-08 | 2017-05-08 | 一种地下停车场弯曲坡道路径规划及路径跟踪方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN107167155A true CN107167155A (zh) | 2017-09-15 |
Family
ID=59813210
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710318248.6A Pending CN107167155A (zh) | 2017-05-08 | 2017-05-08 | 一种地下停车场弯曲坡道路径规划及路径跟踪方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107167155A (zh) |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108121205A (zh) * | 2017-12-13 | 2018-06-05 | 深圳市航盛电子股份有限公司 | 一种用于多种泊车场景的路径规划方法、***及介质 |
CN108334086A (zh) * | 2018-01-25 | 2018-07-27 | 江苏大学 | 一种基于软约束二次规划mpc的无人驾驶车辆路径跟踪控制方法 |
CN108973769A (zh) * | 2018-06-15 | 2018-12-11 | 吉林大学 | 一种全线控电动汽车路径跟踪控制方法 |
CN110379150A (zh) * | 2018-09-13 | 2019-10-25 | 北京京东尚科信息技术有限公司 | 一种评估道路通行性的方法和装置 |
CN110928293A (zh) * | 2018-09-19 | 2020-03-27 | 卡特彼勒路面机械公司 | 用于自主施工车辆的施工现场规划 |
CN111930112A (zh) * | 2020-06-30 | 2020-11-13 | 广西科技大学 | 一种基于mpc的智能车辆路径跟踪控制方法及*** |
CN112037567A (zh) * | 2020-09-04 | 2020-12-04 | 中国第一汽车股份有限公司 | 一种代客泊车方法、装置、设备及存储介质 |
CN113335269A (zh) * | 2021-06-02 | 2021-09-03 | 上海追势科技有限公司 | 一种自主泊车坡路车速控制方法 |
CN113701756A (zh) * | 2021-08-04 | 2021-11-26 | 东南大学 | 一种新型自适应无人车辆倒车入库路径规划与跟踪方法 |
CN115053279A (zh) * | 2020-02-04 | 2022-09-13 | 松下知识产权经营株式会社 | 驾驶辅助装置、车辆及驾驶辅助方法 |
US11487299B2 (en) | 2020-03-31 | 2022-11-01 | Wipro Limited | Method and system for localizing autonomous ground vehicles |
US11498586B2 (en) | 2020-03-27 | 2022-11-15 | Wipro Limited | Method and system for dynamically generating a secure navigation path for navigation of autonomous vehicle |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104408771A (zh) * | 2014-11-12 | 2015-03-11 | 东北大学 | 一种基于三维模型的地下矿山斜坡道构建方法 |
CN104484911A (zh) * | 2014-10-29 | 2015-04-01 | 云南大学 | 基于QoE的个性化自动驾驶参数优化设定方法 |
CN105073542A (zh) * | 2013-04-01 | 2015-11-18 | 朴秀旼 | 汽车自动驾驶*** |
CN106184217A (zh) * | 2015-05-25 | 2016-12-07 | 丰田自动车株式会社 | 车辆的自动驾驶*** |
-
2017
- 2017-05-08 CN CN201710318248.6A patent/CN107167155A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105073542A (zh) * | 2013-04-01 | 2015-11-18 | 朴秀旼 | 汽车自动驾驶*** |
CN104484911A (zh) * | 2014-10-29 | 2015-04-01 | 云南大学 | 基于QoE的个性化自动驾驶参数优化设定方法 |
CN104408771A (zh) * | 2014-11-12 | 2015-03-11 | 东北大学 | 一种基于三维模型的地下矿山斜坡道构建方法 |
CN106184217A (zh) * | 2015-05-25 | 2016-12-07 | 丰田自动车株式会社 | 车辆的自动驾驶*** |
Cited By (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108121205B (zh) * | 2017-12-13 | 2021-02-26 | 深圳市航盛电子股份有限公司 | 一种用于多种泊车场景的路径规划方法、***及介质 |
CN108121205A (zh) * | 2017-12-13 | 2018-06-05 | 深圳市航盛电子股份有限公司 | 一种用于多种泊车场景的路径规划方法、***及介质 |
CN108334086A (zh) * | 2018-01-25 | 2018-07-27 | 江苏大学 | 一种基于软约束二次规划mpc的无人驾驶车辆路径跟踪控制方法 |
CN108334086B (zh) * | 2018-01-25 | 2021-06-22 | 江苏大学 | 一种基于软约束二次规划mpc的无人驾驶车辆路径跟踪控制方法 |
CN108973769A (zh) * | 2018-06-15 | 2018-12-11 | 吉林大学 | 一种全线控电动汽车路径跟踪控制方法 |
CN110379150A (zh) * | 2018-09-13 | 2019-10-25 | 北京京东尚科信息技术有限公司 | 一种评估道路通行性的方法和装置 |
CN110379150B (zh) * | 2018-09-13 | 2021-05-25 | 北京京东尚科信息技术有限公司 | 一种评估道路通行性的方法和装置 |
CN110928293A (zh) * | 2018-09-19 | 2020-03-27 | 卡特彼勒路面机械公司 | 用于自主施工车辆的施工现场规划 |
CN110928293B (zh) * | 2018-09-19 | 2024-04-12 | 卡特彼勒路面机械公司 | 用于自主施工车辆的施工现场规划 |
CN115053279A (zh) * | 2020-02-04 | 2022-09-13 | 松下知识产权经营株式会社 | 驾驶辅助装置、车辆及驾驶辅助方法 |
CN115053279B (zh) * | 2020-02-04 | 2023-10-20 | 松下知识产权经营株式会社 | 驾驶辅助装置、车辆及驾驶辅助方法 |
US11498586B2 (en) | 2020-03-27 | 2022-11-15 | Wipro Limited | Method and system for dynamically generating a secure navigation path for navigation of autonomous vehicle |
US11487299B2 (en) | 2020-03-31 | 2022-11-01 | Wipro Limited | Method and system for localizing autonomous ground vehicles |
CN111930112A (zh) * | 2020-06-30 | 2020-11-13 | 广西科技大学 | 一种基于mpc的智能车辆路径跟踪控制方法及*** |
CN112037567A (zh) * | 2020-09-04 | 2020-12-04 | 中国第一汽车股份有限公司 | 一种代客泊车方法、装置、设备及存储介质 |
CN113335269A (zh) * | 2021-06-02 | 2021-09-03 | 上海追势科技有限公司 | 一种自主泊车坡路车速控制方法 |
CN113701756A (zh) * | 2021-08-04 | 2021-11-26 | 东南大学 | 一种新型自适应无人车辆倒车入库路径规划与跟踪方法 |
CN113701756B (zh) * | 2021-08-04 | 2024-05-31 | 东南大学 | 一种新型自适应无人车辆倒车入库路径规划与跟踪方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107167155A (zh) | 一种地下停车场弯曲坡道路径规划及路径跟踪方法 | |
CN110597245B (zh) | 基于二次型规划和神经网络的自动驾驶换道轨迹规划方法 | |
CN106671982B (zh) | 基于多智能体的无人驾驶电动汽车自动超车***及方法 | |
CN105197010B (zh) | 辅助泊车***以及辅助泊车控制方法 | |
CN110361013B (zh) | 一种用于车辆模型的路径规划***及方法 | |
CN103158703B (zh) | 一种平行泊车的控制方法 | |
CN105857306A (zh) | 一种用于多种泊车场景的车辆自主泊车路径规划方法 | |
CN109927716A (zh) | 基于高精度地图的自主垂直泊车方法 | |
CN107856737B (zh) | 一种基于危险程度变权重的人机协同转向控制方法 | |
CN102658819B (zh) | 一种基于仿人智能控制的汽车自动泊车入位方法 | |
CN110304074A (zh) | 一种基于分层状态机的混合式驾驶方法 | |
CN105137970B (zh) | 车辆避障方法及装置 | |
CN110907193B (zh) | 自动驾驶车辆编队行驶的测试方法、装置和*** | |
CN108423067A (zh) | 水平泊车控制方法及控制*** | |
CN108860149A (zh) | 一种用于智能车辆时间最短自由变道的运动轨迹设计方法 | |
CN109709944A (zh) | 一种自动驾驶公交车的进站方法及其进站路径的生成方法 | |
CN113291318B (zh) | 基于部分可观测马尔科夫模型的无人车盲区转弯规划方法 | |
CN107132840A (zh) | 一种越野电驱动无人车辆纵/横/垂拟人化协同控制方法 | |
CN107380162A (zh) | 基于功能分配与多目标模糊决策的协同避撞方法 | |
CN110509923A (zh) | 自动驾驶路径规划方法、***、计算机可读存储介质及车辆 | |
CN109656242A (zh) | 一种自动驾驶行车路径规划*** | |
CN113589685B (zh) | 一种基于深度神经网络的挪车机器人控制***及其方法 | |
CN109712424A (zh) | 一种基于物联网的车辆导航方法 | |
CN114906128A (zh) | 一种基于mcts算法的自动泊车运动规划方法 | |
CN106715246B (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 | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20170915 |