CN112172791B - 基于路径曲率的自动泊车速度规划方法、设备及存储设备 - Google Patents
基于路径曲率的自动泊车速度规划方法、设备及存储设备 Download PDFInfo
- Publication number
- CN112172791B CN112172791B CN202010962428.XA CN202010962428A CN112172791B CN 112172791 B CN112172791 B CN 112172791B CN 202010962428 A CN202010962428 A CN 202010962428A CN 112172791 B CN112172791 B CN 112172791B
- Authority
- CN
- China
- Prior art keywords
- curvature
- speed
- path
- change
- automatic parking
- 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
- 238000000034 method Methods 0.000 title claims abstract description 32
- 230000008859 change Effects 0.000 claims abstract description 60
- 230000001133 acceleration Effects 0.000 claims abstract description 15
- 230000007423 decrease Effects 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims 1
- 230000008569 process Effects 0.000 abstract description 5
- 230000009286 beneficial effect Effects 0.000 abstract description 3
- 230000003247 decreasing effect Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000004069 differentiation Effects 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
Images
Classifications
-
- 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/06—Automatic manoeuvring for parking
-
- 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
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D15/00—Steering not otherwise provided for
- B62D15/02—Steering position indicators ; Steering position determination; Steering aids
- B62D15/027—Parking aids, e.g. instruction means
- B62D15/0285—Parking performed automatically
Landscapes
- Engineering & Computer Science (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Human Computer Interaction (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
本发明提供了一种基于路径曲率的自动泊车速度规划方法、设备及存储设备,根据获取的泊车路径的曲率和弧长信息,将整个泊车路径划分为若干区间,该若干区间包括第一直行段、回旋曲率段、固定圆弧段和第二直行段;针对每个区间,通过公式计算方向盘角速度变化关联速度、偏航角变化关联速度和横向加速度变化关联速度,并比较大小,得到最小的关联速度,即车辆在对应区间的规划速度。一种基于路径曲率的自动泊车速度规划设备及存储设备,用于实现基于路径曲率的自动泊车速度规划方法。本发明的有益效果是:通过把规划路径分类综合考虑方向盘角速度上限、偏航角变化上限、横向加速度上限来规划车速,提高了泊车转弯过程中的舒适性和平稳性。
Description
技术领域
本发明涉及自动泊车领域,尤其涉及一种基于路径曲率的自动泊车速度规划方法、设备及存储设备。
背景技术
自动泊车功能的核心包括传感器数据的感知、融合、决策规划、控制等部分。其中,控制是自动泊车效果的直接体现,车速的平稳变化是舒适性的重要因素。
自动泊车速度规划影响泊车的舒适性,现有的泊车速度基本使用匀速与线性增减结合的方式对速度进行规划,既泊车开始和结束使用线性递增和递减,泊车路径的中间段使用固定车速,这样规划的车速在车辆转弯时,一般会出现方向盘转动不及时、车身偏航角变化过大、横向加速度过大的现象,导致泊车转弯过程的舒适性和平稳性不足,严重时甚至还会影响车内外人员的人身安全。
发明内容
为了解决上述问题,本发明提供了一种基于路径曲率的自动泊车速度规划方法、设备及存储设备,一种基于路径曲率的自动泊车速度规划方法,主要包括以下步骤:
S1:根据获取的泊车路径的曲率和弧长信息,将整个泊车路径划分为若干区间,该若干区间包括第一直行段、回旋曲率段、固定圆弧段和第二直行段;
S2:根据公式计算得到每个区间的方向盘角速度变化关联速度;其中,Vlim-str表示方向盘角速度变化关联速度,表示方向盘角速度变化的上限值,ρ表示区间内直线或曲线对应的曲率,L表示区间内直线或曲线对应的弧长,Δρ表示曲率的变化,ΔL表示弧长的变化,表示方向盘转角变化对曲率的倒数;
S5:针对每个区间,比较方向盘角速度变化关联速度、偏航角变化关联速度和横向加速度变化关联速度的大小,得到最小的关联速度,该最小的关联速度即车辆在对应区间的规划速度。
进一步地,所述回旋曲率段包括以固定曲率变化率增大的第一回旋曲率段和以固定曲率变化率减小的第二回旋曲率段。
进一步地,车辆在第一直行段行驶时,该车辆还没有打方向盘,处于直行状态。
进一步地,车辆在第一回旋曲率段行驶时,开始打方向盘,处于转弯状态,曲率渐渐增大。
进一步地,车辆在第二回旋曲率段行驶时,开始回方向盘,处于转弯状态,曲率渐渐变小。
进一步地,车辆在固定圆弧段行驶时,保持曲率不变。
进一步地,车辆在第二直行段行驶时,方向盘回正,保持直行,直至停止。
一种存储设备,所述存储设备存储指令及数据用于实现一种基于路径曲率的自动泊车速度规划方法。
一种基于路径曲率的自动泊车速度规划设备,包括:处理器及存储设备;所述处理器加载并执行所述存储设备中的指令及数据用于实现一种基于路径曲率的自动泊车速度规划方法。
本发明提供的技术方案带来的有益效果是:通过把规划路径分类综合考虑方向盘角速度上限、偏航角变化上限、横向加速度上限来规划车速,提高了泊车转弯过程中的舒适性和平稳性。
附图说明
下面将结合附图及实施例对本发明作进一步说明,附图中:
图1是本发明实施例中一种基于路径曲率的自动泊车速度规划方法的流程图;
图2是本发明实施例中通过曲率和弧长分区间示意图;
图3是本发明实施例中硬件设备工作的示意图。
具体实施方式
为了对本发明的技术特征、目的和效果有更加清楚的理解,现对照附图详细说明本发明的具体实施方式。
本发明的实施例提供了一种基于路径曲率的自动泊车速度规划方法、设备及存储设备。自动泊车***包括感知模块、规划模块、控制模块,所述感知模块用于识别泊车的最终停车框终点,所述规划模块根据起点和最终停车框终点规划出包括弧长信息及曲率信息的路径,所述控制模块根据路径规划出车速,并下发刹车、加速、转向的指令让车辆按照规划的轨迹行驶。
请参考图1,图1是本发明实施例中一种基于路径曲率的自动泊车速度规划方法的流程图,具体包括如下步骤:
S1:如图2所示,根据获取的泊车路径的曲率和弧长信息,将整个泊车路径划分为5个区间,横坐标表示弧长信息,纵坐标表示曲率信息,第1区间为第一直行段,第2区间为以固定曲率变化率增大的第一回旋曲率段,第3区间为固定圆弧段,第4区间为以固定曲率变化率减小的第二回旋曲率段,第5区间为第二直行段;5个区间的区分依据为:第2-4区间的曲率的绝对值大于0,第2区间和第4区间的曲率变化率大于0;
S2:根据公式计算得到每个区间的方向盘角速度变化关联速度;其中,Vlim-str表示方向盘角速度变化关联速度,表示方向盘角速度变化的上限值,ρ表示区间内直线或曲线对应的曲率,L表示区间内直线或曲线对应的弧长,Δρ表示曲率的变化,ΔL表示弧长的变化,表示方向盘转角变化对曲率的倒数;
S5:针对每个区间,比较方向盘角速度变化关联速度、偏航角变化关联速度和横向加速度变化关联速度的大小,即通过公式Vlim=min(Vlim-str,Vlim-yaw,Vlim-Ay),得到最小的关联速度,该最小的关联速度即车辆在对应区间的规划速度。
如表1所示,对5个区间中的每一个区间的方向盘角速度变化关联速度、偏航角变化关联速度和横向加速度变化关联速度分别进行求取,以得到每个区间对应的规划速度。
上表1中的Vmax表示按照车辆设计要求,整个泊车过程中的所能行驶的最大速度。
请参见图3,图3是本发明实施例的硬件设备工作示意图,所述硬件设备具体包括:一种基于路径曲率的自动泊车速度规划设备401、处理器402及存储设备403。
一种基于路径曲率的自动泊车速度规划设备401:所述一种基于路径曲率的自动泊车速度规划设备401实现所述一种基于路径曲率的自动泊车速度规划方法。
处理器402:所述处理器402加载并执行所述存储设备403中的指令及数据用于实现所述一种基于路径曲率的自动泊车速度规划方法。
存储设备403:所述存储设备403存储指令及数据;所述存储设备403用于实现所述一种基于路径曲率的自动泊车速度规划方法。
本发明的有益效果是:通过把规划路径分类综合考虑方向盘角速度上限、偏航角变化上限、横向加速度上限来规划车速,提高了泊车转弯过程中的舒适性和平稳性。
以上所述仅为本发明的较佳实施例,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (9)
1.一种基于路径曲率的自动泊车速度规划方法,自动泊车***包括感知模块、规划模块、控制模块,所述感知模块用于识别泊车的最终停车框终点,所述规划模块根据起点和最终停车框终点规划出包括弧长信息及曲率信息的路径,所述控制模块根据路径规划出车速,并下发刹车、加速、转向的指令让车辆按照规划的轨迹行驶;其特征在于:包括以下步骤:
S1:根据获取的泊车路径的曲率和弧长信息,将整个泊车路径划分为若干区间,该若干区间包括第一直行段、回旋曲率段、固定圆弧段和第二直行段;
S2:根据公式计算得到每个区间的方向盘角速度变化关联速度;其中,Vlim-str表示方向盘角速度变化关联速度,表示方向盘角速度变化的上限值,δstr表示当前采样时刻的方向盘转角,ρ表示区间内直线或曲线对应的曲率,L表示区间内直线或曲线对应的弧长,Δρ表示曲率的变化,ΔL表示弧长的变化,表示方向盘转角变化对曲率的倒数;
S5:针对每个区间,比较方向盘角速度变化关联速度、偏航角变化关联速度和横向加速度变化关联速度的大小,得到最小的关联速度,该最小的关联速度即车辆在对应区间的规划速度。
2.如权利要求1所述的一种基于路径曲率的自动泊车速度规划方法,其特征在于:所述回旋曲率段包括以固定曲率变化率增大的第一回旋曲率段和以固定曲率变化率减小的第二回旋曲率段。
3.如权利要求1所述的一种基于路径曲率的自动泊车速度规划方法,其特征在于:车辆在第一直行段行驶时,该车辆还没有打方向盘,处于直行状态。
4.如权利要求2所述的一种基于路径曲率的自动泊车速度规划方法,其特征在于:车辆在第一回旋曲率段行驶时,开始打方向盘,处于转弯状态,曲率渐渐增大。
5.如权利要求2所述的一种基于路径曲率的自动泊车速度规划方法,其特征在于:车辆在第二回旋曲率段行驶时,开始回方向盘,处于转弯状态,曲率渐渐变小。
6.如权利要求1所述的一种基于路径曲率的自动泊车速度规划方法,其特征在于:车辆在固定圆弧段行驶时,保持曲率不变。
7.如权利要求1所述的一种基于路径曲率的自动泊车速度规划方法,其特征在于:车辆在第二直行段行驶时,方向盘回正,保持直行,直至停止。
8.一种存储设备,其特征在于:所述存储设备存储指令及数据用于实现权利要求1~7任一项所述的基于路径曲率的自动泊车速度规划方法。
9.一种基于路径曲率的自动泊车速度规划设备,其特征在于:包括:处理器及存储设备;所述处理器加载并执行所述存储设备中的指令及数据用于实现权利要求1~7任一项所述的基于路径曲率的自动泊车速度规划方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010962428.XA CN112172791B (zh) | 2020-09-14 | 2020-09-14 | 基于路径曲率的自动泊车速度规划方法、设备及存储设备 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010962428.XA CN112172791B (zh) | 2020-09-14 | 2020-09-14 | 基于路径曲率的自动泊车速度规划方法、设备及存储设备 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112172791A CN112172791A (zh) | 2021-01-05 |
CN112172791B true CN112172791B (zh) | 2021-10-22 |
Family
ID=73920939
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010962428.XA Active CN112172791B (zh) | 2020-09-14 | 2020-09-14 | 基于路径曲率的自动泊车速度规划方法、设备及存储设备 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112172791B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112937557B (zh) * | 2021-03-09 | 2022-08-12 | 东风汽车集团股份有限公司 | 一种基于曲率控制的代客泊车路径规划方法及*** |
CN113428136B (zh) * | 2021-07-23 | 2022-10-14 | 国汽智控(北京)科技有限公司 | 泊车方法、装置及电子设备 |
CN114132304B (zh) * | 2021-10-13 | 2023-10-13 | 武汉光庭信息技术股份有限公司 | 一种自主泊车中的速度规划方法及装置 |
CN114475782A (zh) * | 2022-02-28 | 2022-05-13 | 东风汽车集团股份有限公司 | 一种自动泊车控制优化方法及*** |
Family Cites Families (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE19940007A1 (de) * | 1999-08-24 | 2001-03-08 | Bosch Gmbh Robert | Verfahren und Vorrichtung zur Unterstützung des Einparkens eines Kraftfahrzeugs |
CN102398596B (zh) * | 2010-09-07 | 2015-04-22 | 北京经纬恒润科技有限公司 | 泊车控制装置与***以及泊车控制方法 |
KR101362326B1 (ko) * | 2012-08-06 | 2014-02-24 | 현대모비스 주식회사 | 주차 정렬 기능을 갖는 차량 후방 카메라 시스템 및 이를 이용한 차량의 주차 지원 시스템 |
DE102014221835A1 (de) * | 2014-10-27 | 2016-04-28 | Ford Global Technologies, Llc | Verfahren und Vorrichtung zur Fahrzeugsteuerung |
DE102016103899A1 (de) * | 2016-03-04 | 2017-09-07 | Valeo Schalter Und Sensoren Gmbh | Verfahren zum autonomen Einparken eines Kraftfahrzeugs in eine Parklücke mit Vorgabe eines Geschwindigkeitsprofils, Fahrerassistenzsystems sowie Kraftfahrzeug |
CN108423067A (zh) * | 2017-02-15 | 2018-08-21 | 联创汽车电子有限公司 | 水平泊车控制方法及控制*** |
CN108725585B (zh) * | 2017-04-14 | 2021-05-25 | 上海汽车集团股份有限公司 | 车辆自主泊车的轨迹跟踪控制方法及装置 |
CN107618502B (zh) * | 2017-08-21 | 2019-12-13 | 上海蔚来汽车有限公司 | 泊车轨迹确定方法、泊车控制方法以及相关设备 |
CN108515966B (zh) * | 2018-03-12 | 2020-01-14 | 广东工业大学 | 一种自动泊车车速控制方法及***、车辆 |
JP7199905B2 (ja) * | 2018-10-18 | 2023-01-06 | フォルシアクラリオン・エレクトロニクス株式会社 | 自動運転制御装置、および自動運転経路演算方法 |
CN109720342B (zh) * | 2019-01-16 | 2020-09-01 | 杭州湘滨电子科技有限公司 | 一种垂直泊车的路径规划设计方法 |
CN110806218B (zh) * | 2019-11-29 | 2021-09-07 | 北京京东乾石科技有限公司 | 泊车路径规划方法、装置和*** |
CN111409625A (zh) * | 2020-04-02 | 2020-07-14 | 北京四维智联科技有限公司 | 一种泊车轨迹确定方法及装置 |
-
2020
- 2020-09-14 CN CN202010962428.XA patent/CN112172791B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN112172791A (zh) | 2021-01-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112172791B (zh) | 基于路径曲率的自动泊车速度规划方法、设备及存储设备 | |
US8849539B2 (en) | Method and module for determining of velocity reference values for a vehicle control system | |
EP2440421B1 (en) | Method and module for controlling a velocity of a vehicle | |
CN109305195B (zh) | 列车控制方法及装置 | |
US8996273B2 (en) | Anticipatory cruise control | |
CN109727469B (zh) | 一种多车道下自动驾驶车辆综合危险度评估方法 | |
CN108153145A (zh) | 一种基于pid和滤波算法的列车速度自动控制方法 | |
CN107067753B (zh) | 一种基于行车安全距离的跟车自动驾驶方法 | |
CN110751835B (zh) | 一种基于北斗导航技术的车辆监测预警***及方法 | |
BRPI1009082B1 (pt) | Método e módulo para determinar os valores determinísticos para sistemas de controle de veículos e produto de programa de computador | |
CN113401105B (zh) | 一种爬行控制方法、装置、车辆及存储介质 | |
CN110304113A (zh) | 一种自动调整列车自动驾驶停车精度的方法 | |
CN112429046B (zh) | 一种混合制动阶段的列车自动控制方法 | |
AU2018416898A1 (en) | Vehicle parking control method and apparatus | |
CN104670229A (zh) | 假想车道线生成装置与方法及车道线保持控制*** | |
SE1050335A1 (sv) | Metod och modul i samband med farthållning | |
KR20170005065A (ko) | 이동 경로를 따라 차량이 주행하는 중에 차량의 가속을 수정하기 위한 시스템 및 방법 | |
CN112356828A (zh) | 一种车辆横向控制方法、装置、车辆和可读存储介质 | |
EP2470406A1 (en) | System and method for maintaining driving times | |
CN113401173A (zh) | 列车运行控制方法、装置、电子设备及存储介质 | |
KR20170005067A (ko) | 이동 경로를 따라 차량이 주행하는 중에 차량의 속도를 수정하기 위한 시스템 및 방법 | |
Lee et al. | A unified framework of adaptive cruise control for speed limit follower and curve speed control function | |
CN111824167B (zh) | 车辆的速度限制方法、装置、车辆及电子设备 | |
CN116534031A (zh) | 一种车辆稳定入弯的车速控制方法 | |
CN114013450B (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 |