CN110271539B - 一种自动垂直泊车控制系统 - Google Patents
一种自动垂直泊车控制系统 Download PDFInfo
- Publication number
- CN110271539B CN110271539B CN201910661795.3A CN201910661795A CN110271539B CN 110271539 B CN110271539 B CN 110271539B CN 201910661795 A CN201910661795 A CN 201910661795A CN 110271539 B CN110271539 B CN 110271539B
- Authority
- CN
- China
- Prior art keywords
- parking
- parking space
- vehicle
- point
- limiting condition
- 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 claims abstract description 24
- 230000008569 process Effects 0.000 claims abstract description 17
- 230000004927 fusion Effects 0.000 claims abstract description 7
- 238000004364 calculation method Methods 0.000 claims description 8
- 238000000605 extraction Methods 0.000 claims description 3
- 238000005516 engineering process Methods 0.000 description 4
- 230000004888 barrier function Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 102100025749 Sphingosine 1-phosphate receptor 2 Human genes 0.000 description 1
- 101710155462 Sphingosine 1-phosphate receptor 2 Proteins 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000006467 substitution reaction Methods 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
- 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
-
- 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
- G08G1/141—Traffic control systems for road vehicles indicating individual free spaces in parking areas with means giving the indication of available parking spaces
- G08G1/143—Traffic control systems for road vehicles indicating individual free spaces in parking areas with means giving the indication of available parking spaces inside the vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明保护一种自动垂直泊车控制系统,包括:车位识别模块,由超声波传感器和环视摄像头传感器探测车位大小及坐标,通过融合获得准确的车位信息数据;限制条件决策模块,根据车位信息数据,解算车位的转弯半径及曲率,通过公式解算限制条件,判断转弯半径是否满足限制条件,如果满足则通过Can总线把数据传给控制执行模块,如果不满足,则再进行泊车路径规划,计算限制条件;控制执行模块,获得泊车路径规划信息,实现泊车过程。本发明在垂直泊车过程引入限制条件,避免垂直泊车过程中,车辆之间发生碰撞,提高垂直泊车过程中的可靠性,提升垂直泊车的整体性能。
Description
技术领域
本发明属于汽车泊车控制领域,具体涉及自动泊车控制技术。
背景技术
近年来,汽车的保有量不断上升,交通技术能力不断提高,对汽车的辅助驾驶技术的需求也在增加,基于现实的需求,开展了对垂直泊车相关技术的研究及探索。由于泊车的控制限制及车身结构的限制,要求车辆按照车位的规范进行停车,在有限的空间资源内完成泊车过程,需要对有限空间进行充分的利用。基于这些限制,避免主车与其他车辆发生碰撞及不发生安全事故,实现车辆安全入库,正是自动垂直泊车技术开发的难点。
现有的自动垂直泊车方法很多,泊车的路径规划方法一般使用曲线,螺旋线等进行轨迹规划,也只考虑的车辆自身的约束条件,如车辆的最小转弯半径等。对于车辆泊车的过程是基于实际的路况环境,考虑车辆的道路宽度,限制车辆最大转弯半径,车辆的行驶角度要求大,对泊车的初始姿态要求偏高。
发明内容
本发明针对现有技术存在的不足,提出一种自动垂直泊车控制系统,主要解决车辆在实际路况上,在道路宽度限制及车辆转弯半径的限制下,顺利完成自动泊车的过程,通过公式引入限制条件作为判别依据,规划出合适的泊车轨迹,对不满足限制条件的泊车路径规划的方法进行剔除,解决在有限空间内,充分利用空间资源,减少泊车中的碰撞及安全问题。
本发明的目的可以通过以下技术方案来实现:
一种自动垂直泊车控制系统,包括:车位识别模块,限制条件决策模块,控制执行模块。
车位识别模块:由超声波传感器和环视摄像头传感器探测车位大小及坐标,通过融合获得准确的车位信息数据。
限制条件决策模块:根据车位信息数据,解算车位的转弯半径,通过公式解算限制条件,判断转弯半径是不是满足限制条件,如果满足即实现泊车过程,如果不满足,则再进行泊车路径规划,在计算限制条件。
控制执行模块:通过泊车路径规划信息获得轨迹的实时曲率,获得车辆半径的大小,车辆的挡位控制信息及车辆的速度。
本发明通过车位识别模块扫描车位线及障碍物信息,获得垂直车位的左右两点的坐标,以车位右顶点(segt1)作为泊车坐标系的原点坐标,车位右侧为X轴正方向,X轴正方向作为航向零点方向,左偏为正角,右偏为负角,Y轴方向垂直X轴正方向,如图1所示。
具体地,所述车位识别模块通过融合获得准确的车位信息数据是通过超声波传感器和环视摄像头传感器扫描车位线及障碍物信息,通过图像特征提取车位线,得到车位的大小,通过超时波雷达数据和摄像头图像识别数据采用加权平均方法进行融合获得车位的四个顶点P1、P2、P3、P4的坐标信息,其中P2点作为原点坐标,并通过图像特征提取,获得L2.y的值,L2.y是车辆左边的车道线或者障碍物边线,输出给限制条件决策模块。
具体地,所述限制条件决策模块解算车辆的转弯半径R、泊车最小半径Rmin及泊车转弯最大半径Rmax,判断R值是否满足条件R>Rmin及R<Rmax,如果不满足条件重新求解R、Rmin及Rmax的值,再进行判断,如果满足条件输出R及曲率(半径的倒数)给控制执行模块。
所述限制条件决策模块的解算过程如下:
最后计算满足条件的泊车最小半径Rmin及泊车最大半径Rmax:
以P2、O2及K3三个点构成一个直角三角形,其中O2是圆心点、K3分别是两垂线的交点,通过直角三角形的大小计算泊车最小半径Rmin,
通过道路宽度来计算泊车最大半径Rmax,
采用本发明的自动垂直泊车系统,在垂直泊车过程中,引入了限制条件,可以减少安全事故的发生,减少经济财产损失,避免垂直泊车过程中,车辆之间发生碰撞,提高垂直泊车过程中的可靠性,优化泊车过程的限制条件的计算方法,提升垂直泊车的整体性能。
附图说明
图1.自动垂直泊车控制系统架构图;
图2.自动垂直泊车控制系统的控制流程图;
图3.车位识别模块探测车位信息及R计算图;
图4.泊车最小半径计算图;
图5.泊车最大半径计算图。
具体实施方式
以下结合附图进一步说明本发明:
如图1所示,本发明的自动垂直泊车控制系统包括车位识别模块、限制条件决策模块和控制执行模块。
所述车位识别模块包含了超声波传感器和环视摄像头传感器。通过超声波传感器和环视摄像头传感器扫描车位线及障碍物信息;通过图像特征提取车位线,得到车位的大小,通过超时波雷达数据和摄像头图像识别数据采用加权平均方法进行融合获得车位的四个顶点P1、P2、P3、P4的坐标信息,其中P2点作为原点坐标;通过图像特征提取,获得L2.y的值,L2.y是车辆左边的车道线或者障碍物边线,即道路的环境信息。车位识别模块通过LinCan总线把数据传给限制条件决策模块。
所述限制条件决策模块,根据车位信息数据,解算车位的转弯半径及曲率,通过公式解算垂直泊车限制条件,判断转弯半径是否满足限制条件,如果满足则通过Can总线把数据传给控制执行模块,如果不满足,则再进行泊车路径规划,计算限制条件。
所述控制执行模块,从限制条件决策模块获得泊车路径规划信息,包括泊车轨迹的实时曲率,获得车辆转弯半径的大小,并根据车辆的挡位控制信息及车辆的速度,输出控制方向盘转角及车速,实现泊车过程。
如图2所示,系统的控制流程如下:
车位识别模块输出P1、P2、P3、P4及L2.y的值;通过限制条件决策模块解算得到R、Rmin及Rmax的值,Rmin和Rmax是限制条件判决条件,通过车身和车位大小计算获得,R值为实车位置解算出来的实时转弯半径,判断R值是否满足条件(R>Rmin及R<Rmax),限制条件必须同时满足才能通过判断,如果判断条件不通过,则重新求解R、Rmin及Rmax的值,再进行判断。如果满足条件,则输出R及曲率给控制执行模块,控制执行模块根据R的值输出车速及方向盘角度,可以顺利泊,控制流程结束。
如图3所示为车位识别模块探测车位信息及R计算图:
车位识别模块提供车位的大小及顶点坐标信息,P1、P2、P3、P4是车位的四个顶点,P2点作为原点坐标,通过公式确定最终停车的位置A1点的坐标L车为车的长度,0.5为车与车位低端的安全距离,车辆的航向角为90度。
车辆的航向角方向垂直于线段S1O2,线段S1O2长度等于线段A2O2长度为泊车半径R,线段S1k2垂直线段A2O2,解算得到R和A2.y值。
d(A2K2)=S1.x-A2.x (1)
d(K2O2)=R-d(A2K2) (2)
由(1)(2)(3)计算得
d(K2S1)=R×cosθ (5)
A2.y=S1.y-d(K2S1) (6)
由(4)(5)(6)计算得
A2.y=S1.y-R×cosθ (7)
其中,O2是转弯半径的圆心、K为两条垂线的交点。
如图4所示为泊车最小半径的计算:
为防止车辆在泊车过程中与P2点的障碍物发生碰撞,线段S1O2的长度和线段A2O2的长度为最小泊车半径Rmin。S1、P2、O2三点在一条直线上,P2、O2及K3三个点构成一个直角三角形,K3为两条垂线的交点,W为车辆的宽度,0.3米为车辆的安全距离,通过公式求解Rmin。
d(P2O2)=Rmin-d(S1P2) (9)
d(A2K3)=P2.x-A2.x (10)
d(K3O2)=Rmin-d(A2K3) (11)
d(P2K3)=P2.y-A2.y (12)
d(P2K3)2+d(K3O2)2=d(P2O2)2 (13)
因P2为原点P2.x=0,P2.y=0
由(8)(9)(10)(11)(12)(13)解算Rmin得:
如图5所示为泊车最大半径的计算:
为了防止车辆与车道左边车位线或障碍物L2之间发生碰撞,保留安全距离0.3米,即线段L2k4,K4为车辆前端左顶点,垂线经过这个点,L1为右边车位线或障碍物、L2为左边车位线或障碍物。线段K3K4为车头到后轴中心得距离为d(K3K4)即h,作为已知量。线段K3S1为w为车宽,L2、K4、O2三点在一条直线上,线段L2O2垂直于线段O2A2,O2.y等于A2.y,O2.x等于(A2.x+Rmax),K3、K4、O2三点构成了直角三角形,线段S1O2长度为Rmax,线段K4O2长度为Rv,L2.y为由车位识别模块输出,求解Rmax。
Rv=L2.y-d(L2k4) (15)
d(K3K4)=h (17)
d(O2K3)2+d(K3K4)2=Rv 2 (18)
由(15)(16)(17)(18)计算得:
本领域的技术人员应该理解,结合本文中所公开的实施例描述的方法步骤可以用硬件、处理器执行的软件模块,或者二者的结合等方式来实施。以上所述的具体实施方式,对本发明的目的、技术方案和有益效果进行了进一步详细说明,所应理解的是,以上所述仅为本发明的具体实施方式而已,并不用于限定本发明的保护范围,凡在本发明的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (3)
1.一种自动垂直泊车控制系统,其特征在于:系统包括车位识别模块、限制条件决策模块和控制执行模块;
所述车位识别模块,由超声波传感器和环视摄像头传感器探测车位大小及坐标,通过融合获得准确的车位信息数据;
所述限制条件决策模块,根据车位信息数据,解算车位的转弯半径及曲率,通过公式解算限制条件,判断转弯半径是否满足限制条件,如果满足则通过Can总线把数据传给控制执行模块,如果不满足,则再进行泊车路径规划,计算限制条件;
所述控制执行模块,从限制条件决策模块获得泊车路径规划信息,包括泊车轨迹的实时曲率,获得车辆的转弯半径的大小,并根据车辆的挡位控制信息及车辆的速度,输出控制方向盘转角及车速,实现泊车过程;
所述限制条件决策模块的解算过程如下:
最后计算满足条件的泊车最小半径Rmin及泊车最大半径Rmax:
以P2、O2及K3三个点构成一个直角三角形,其中O2是圆心点、K3分别是两垂线的交点,通过直角三角形的大小计算泊车最小半径Rmin,
通过道路宽度来计算泊车最大半径Rmax,
所述系统是以车位右顶点(segt1)作为泊车坐标系的原点坐标,车位右侧为X轴正方向,X轴正方向作为航向零点方向,左偏为正角,右偏为负角,Y轴方向垂直X轴正方向。
2.根据权利要求1所述的自动垂直泊车控制系统,其特征在于:所述车位识别模块通过融合获得准确的车位信息数据是通过超声波传感器和环视摄像头传感器扫描车位线及障碍物信息,通过图像特征提取车位线,得到车位的大小,通过超时波雷达数据和摄像头图像识别数据采用加权平均方法进行融合获得车位的四个顶点P1、P2、P3、P4的坐标信息,其中P2点作为原点坐标,并通过图像特征提取,获得L2.y的值,L2.y是车辆左边的车道线或者障碍物边线。
3.根据权利要求2所述的自动垂直泊车控制系统,其特征在于:所述限制条件决策模块解算车辆的转弯半径R、泊车最小半径Rmin及泊车转弯最大半径Rmax,判断R值是否满足条件R>Rmin及R<Rmax,如果不满足条件重新求解R、Rmin及Rmax的值,再进行判断,如果满足条件输出R及曲率给控制执行模块。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910661795.3A CN110271539B (zh) | 2019-07-22 | 2019-07-22 | 一种自动垂直泊车控制系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910661795.3A CN110271539B (zh) | 2019-07-22 | 2019-07-22 | 一种自动垂直泊车控制系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110271539A CN110271539A (zh) | 2019-09-24 |
CN110271539B true CN110271539B (zh) | 2020-12-04 |
Family
ID=67965044
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910661795.3A Active CN110271539B (zh) | 2019-07-22 | 2019-07-22 | 一种自动垂直泊车控制系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110271539B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111017022B (zh) * | 2020-01-19 | 2021-04-30 | 同致电子科技(厦门)有限公司 | 一种基于超声波雷达的低速行车转弯辅助方法 |
CN111731272A (zh) * | 2020-06-17 | 2020-10-02 | 重庆长安汽车股份有限公司 | 基于自动泊车系统的障碍物碰撞规避方法 |
CN111976720B (zh) * | 2020-08-12 | 2023-03-14 | 东风柳州汽车有限公司 | 自主式代客泊车方法、装置、设备及存储介质 |
CN112744213A (zh) * | 2021-01-07 | 2021-05-04 | 广州小鹏自动驾驶科技有限公司 | 一种自动泊车的方法和装置 |
CN113511191B (zh) * | 2021-05-12 | 2022-06-07 | 重庆长安汽车股份有限公司 | 垂直泊车完成判断系统、方法、车辆及存储介质 |
CN114141051B (zh) * | 2021-11-25 | 2023-03-14 | 浙江吉利控股集团有限公司 | 辅助停车方法、辅助停车系统和计算机可读存储介质 |
CN114103934B (zh) * | 2021-12-23 | 2023-06-16 | 岚图汽车科技有限公司 | 自动泊车路径规划方法、装置、设备及可读存储介质 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102014111574A1 (de) * | 2014-08-13 | 2016-02-18 | Valeo Schalter Und Sensoren Gmbh | Verfahren zum Erfassen einer Bewegung eines Kraftfahrzeuges in einem Parkhaus, Fahrerassistenzsystem und Kraftfahrzeug |
CN106143609A (zh) * | 2016-07-15 | 2016-11-23 | 江苏大学 | 一种泊车系统及其垂直方向泊车方法 |
CN106515722A (zh) * | 2016-11-08 | 2017-03-22 | 西华大学 | 一种垂直泊车轨迹规划方法 |
CN106945662A (zh) * | 2017-03-30 | 2017-07-14 | 重庆大学 | 一种垂直自动泊车路径规划方法及系统 |
CN107235077A (zh) * | 2016-03-29 | 2017-10-10 | 长城汽车股份有限公司 | 车辆的泊车辅助方法、系统及车辆 |
CN107933549A (zh) * | 2017-11-23 | 2018-04-20 | 奇瑞汽车股份有限公司 | 一种c型垂直自动泊车方法及装置 |
CN109927715A (zh) * | 2019-02-19 | 2019-06-25 | 惠州市德赛西威智能交通技术研究院有限公司 | 垂直泊车方法 |
-
2019
- 2019-07-22 CN CN201910661795.3A patent/CN110271539B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102014111574A1 (de) * | 2014-08-13 | 2016-02-18 | Valeo Schalter Und Sensoren Gmbh | Verfahren zum Erfassen einer Bewegung eines Kraftfahrzeuges in einem Parkhaus, Fahrerassistenzsystem und Kraftfahrzeug |
CN107235077A (zh) * | 2016-03-29 | 2017-10-10 | 长城汽车股份有限公司 | 车辆的泊车辅助方法、系统及车辆 |
CN106143609A (zh) * | 2016-07-15 | 2016-11-23 | 江苏大学 | 一种泊车系统及其垂直方向泊车方法 |
CN106515722A (zh) * | 2016-11-08 | 2017-03-22 | 西华大学 | 一种垂直泊车轨迹规划方法 |
CN106945662A (zh) * | 2017-03-30 | 2017-07-14 | 重庆大学 | 一种垂直自动泊车路径规划方法及系统 |
CN107933549A (zh) * | 2017-11-23 | 2018-04-20 | 奇瑞汽车股份有限公司 | 一种c型垂直自动泊车方法及装置 |
CN109927715A (zh) * | 2019-02-19 | 2019-06-25 | 惠州市德赛西威智能交通技术研究院有限公司 | 垂直泊车方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110271539A (zh) | 2019-09-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110271539B (zh) | 一种自动垂直泊车控制系统 | |
CN110239535B (zh) | 一种基于多传感器融合的弯道主动避撞控制方法 | |
CN111309013B (zh) | 一种碰撞距离确定方法及系统、车辆、存储介质 | |
US10810878B2 (en) | Vehicle control system, vehicle control method, and vehicle control program | |
CN112166059A (zh) | 车辆的位置估计装置、车辆的位置估计方法以及存储被编程为执行该方法的计算机程序的计算机可读记录介质 | |
CN113916246A (zh) | 一种无人驾驶避障路径规划方法和系统 | |
CN112189225A (zh) | 车道线信息检测装置、方法以及存储被编程为执行该方法的计算机程序的计算机可读记录介质 | |
CN113689735B (zh) | 一种车辆换道碰撞预警方法及装置 | |
CN109859528B (zh) | 一种基于v2x车联网的弯道处车辆位置分类方法 | |
CN109334668B (zh) | 一种基于v2x的自动并线系统 | |
US11042759B2 (en) | Roadside object recognition apparatus | |
CN109814115B (zh) | 一种垂直泊车的角度识别校正方法 | |
US10854083B2 (en) | Vehicle control device, vehicle control method, and storage medium | |
CN115848359B (zh) | 车位自适应泊入路径规划方法、车辆及存储介质 | |
JP2019137185A (ja) | 車両制御システム、車両制御方法、およびプログラム | |
CN114187760B (zh) | 一种基于车路协同系统的弯道车辆相对位置分类方法 | |
CN114132305A (zh) | 用于垂直与斜列泊车路径规划方法、系统、存储介质及车辆 | |
CN113799766B (zh) | 带约束的平行泊车路径规划方法、电子设备及存储介质 | |
US20230115845A1 (en) | Vehicle control device, vehicle control method, and storage medium | |
CN116279433A (zh) | 一种车辆及其泊车路径规划方法、系统 | |
CN115959111A (zh) | 车辆控制装置、车辆控制方法及存储介质 | |
CN115959112A (zh) | 车辆控制装置、车辆控制方法及存储介质 | |
CN114954452A (zh) | 一种基于自适应巡航的车速控制方法及系统 | |
CN101938635A (zh) | 复合影像式停车辅助系统 | |
CN114537383A (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 | ||
TR01 | Transfer of patent right | ||
TR01 | Transfer of patent right |
Effective date of registration: 20210506 Address after: 401120 No.107 dataguzhong Road, Xiantao street, Yubei District, Chongqing Patentee after: Chongqing Changan Automobile Software Technology Co.,Ltd. Address before: 400023, No. 260, Jianxin East Road, Jiangbei District, Chongqing Patentee before: Chongqing Changan Automobile Co.,Ltd. |