CN102658819A - 一种基于仿人智能控制的汽车自动泊车入位方法 - Google Patents
一种基于仿人智能控制的汽车自动泊车入位方法 Download PDFInfo
- Publication number
- CN102658819A CN102658819A CN2012101510483A CN201210151048A CN102658819A CN 102658819 A CN102658819 A CN 102658819A CN 2012101510483 A CN2012101510483 A CN 2012101510483A CN 201210151048 A CN201210151048 A CN 201210151048A CN 102658819 A CN102658819 A CN 102658819A
- Authority
- CN
- China
- Prior art keywords
- automobile
- key point
- predetermined key
- current
- 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.)
- Granted
Links
Images
Abstract
本发明涉及汽车自动泊车入位,特别是一种基于仿人智能控制的汽车自动泊车入位方法。该方法第一步是根据汽车参数和泊车位参数确定自动泊车入位路径,并选取该路径上的几个预定关键点作为跟踪目标;第二步,根据汽车泊车入位过程中的位姿相对于当前预定关键点的误差及其误差变化率驱动构建的特征模型确定出当前特征状态;第三步,根据驾驶员泊车入位操作为基础构建的控制模态集,由当前特征状态确定出当前控制模态;第四步,根据当前控制模态控制汽车运动到当前预定关键点;依照第二步至第四步的方法依次控制汽车运动到最后一个预定关键点,即可实现汽车泊车入位。本发明涉及的自动泊车入位方法计算量小、普适性好。
Description
技术领域
本发明涉及汽车自动泊车入位,特别是一种基于仿人智能控制的汽车自动泊车入位方法。
背景技术
汽车自动泊车入位是在无人操控方向盘的情况下,汽车从行驶车道运动到泊车位的机动行为,根据汽车自身相对于泊车位的方向,可分为平行泊车入位、垂直泊车入位和斜形泊车入位等几种情况。自动泊车入位的主要参数包括:车长Lc、车宽Wc、轴距L、前轮转角最小转半径Rm、车位长Lp、车位宽Wp等。从控制论观点来看,车辆系统是一个多输入多输出的非线性欠驱动耦合系统,研究自动泊车入位的控制问题是提高泊车安全性和减轻驾驶复杂性的有效途径之一,具有重要研究意义和应用价值。
目前,自动泊车入位的控制方法主要有:(1)基于路径规划的方法(参考文献[1]:KangZhi Liu,Minh Quan Dao,Takuya Inoue.An exponentially ε-convergent control algorithm forchained systems and its application to automatic parking systems[J].IEEE Transactions onControl Systems Technology,2006,14(6):1113-1126)。(2)基于经验知识的方法(参考文献[2]:Taark Ozkul,Mohammed Moqbel,Suhail B.Aldhafri.Development of a hierarchical driver aidfor parallel parking using fuzzy biomimetic approach[J].Journal of Computing and InformationTechnology,2010,18(1):31-44)。(3)基于路径规划和基于经验知识相结合的方法(参考文献[3]:K.Demirli,M.Khoshnejad.Autonomous parallel parking of a car-like mobile robot by aneuro-fuzzy sensor-based controller[J].Fuzzy Sets and Systems,2009,160:2876-2891)。但普遍存在普适性差、计算复杂、计算量大等问题。例如,基于路径规划的方法对传感器和执行器的精确性要求很高,在泊车入位过程中,很难补偿执行过程中和系统的动态性引起的误差,即使位置误差能够被随后的反复迭代运动所补偿,也会增加相应的时间成本,从而影响泊车入位的效果;基于经验知识的方法采用模糊控制及其与神经网络和遗传算法相结合,这类方法样本数据的获得比较困难,模糊化、解模糊化、训练神经网络和参数寻优时计算复杂、计算量大。
综上,研究自动泊车入位方法具有重要研究意义和应用价值,但现有方法存在诸多问题,需要提出一种计算量小、普适性更好的自动泊车入位方法。
发明内容
本发明的目的在于提供一种计算量小、普适性好的自动泊车入位方法,实现汽车自动泊车入位。
为达到上述目的,本发明的构思是:采用仿人智能的方法,通过模仿驾驶员泊车入位的经验技巧,跟踪泊车入位路径上的几个预定关键点实现汽车泊车入位。
基于上述构思,本发明采用如下技术方案:
一种基于仿人智能控制的汽车自动泊车入位方法,其特征在于:该方法第一步是根据汽车参数和泊车位参数确定自动泊车入位路径,并选取该路径上的几个预定关键点作为跟踪目标;第二步,根据汽车泊车入位过程中的位姿相对于当前预定关键点的误差及其误差变化率驱动构建的特征模型确定出当前特征状态;第三步,根据驾驶员泊车入位操作为基础构建的控制模态集,由当前特征状态确定出当前控制模态;第四步,根据当前控制模态控制汽车运动到当前预定关键点;依照第二步至第四步的方法依次控制汽车运动到最后一个预定关键点,即可实现汽车泊车入位。该方法包括以下步骤:
特征模型Φ={Φ1,Φ2,Φ3,Φ4}为:
其中,
描述汽车在距离上是远离还是接近预定关键点P1;
描述汽车在距离上是远离还是接近预定关键点P4;
eθ=θ为车身方向θ相对于目标方向0°的角度;
描述车身在方向上是远离还是接近目标;
eθ0=θ-θ0为车身方向θ相对于直线l1的角度;
d1、d2、d3、d4、θc、θc0:为阀值;
控制模态集Ψ={Ψ1,Ψ2,Ψ3,Ψ4}为:
本发明涉及的自动泊车入位方法计算量小、普适性好。
附图说明
图1为靠右自动平行泊车入位示意图;
图中:101为直线l1,102为直线l2,103为直线l1与x轴的夹角θ0,201为圆O1,202为圆O3,203为圆O1的半径R1,204为圆O3的半径R3,301为预定关键点P1,302为预定关键点P2,303为预定关键点P3,304为预定关键点P4,401为待泊车入位的汽车,402为车长Lc,403为车宽Wc,404为汽车的轴距L,501为泊车位长Lp,502为泊车位宽Wp。
图2为本发明流程图。
图3为在实验参数设置:车长Lc=3.5m,车宽Wc=1.6m,轴距L=2.4m,前轮转角车位长Lp=5.0m,车位宽Wp=2.4m,初始状态为表1中序号1情况下,本发明控制汽车泊车入位的效果图。
图4为在实验参数设置:车长Lc=4.5m,车宽Wc=1.8m,轴距L=2.6m,前轮转角车位长Lp=6.0m,车位宽Wp=2.4m,初始状态为表1中序号2情况下,本发明控制汽车泊车入位的效果图。
表1 实验参数设置值
由图3-图5仿真结果可知,针对不同尺寸的四轮汽车自动泊车入位,本发明控制效果好、普适性好。
具体实施方式
下面根据附图和具体实施对本发明作进一步阐述。以靠右自动平行泊车入位为例进行说明。
以预定关键点P4(0,0)为原点O建立直角坐标系XOY;
取直线l1:y=ax+b,(a=tanθ0为l1直线的斜率, 为前轮转角最大值, 和点作圆O1,与直线l1相切于点P3,与x轴相切于原点O,圆O1的圆心O1在y轴正方向上,且圆O1的半径R1满足R1≥Rm;过点P1作与x轴平行的直线l2,作圆O3,与直线l1相切于点P2,与直线l2相切于点P1,且圆O3的半径R3满足R3≥Rm;
通过计算得:
构建特征基元集Q={Q1,Q2,Q3,Q4}为:
其中,
描述汽车在距离上是远离还是接近预定关键点P2;
eθ=θ为车身方向θ相对于目标方向0°的角度;
描述车身在方向上是远离还是接近目标;
eθ0=θ-θ0为车身方向θ相对于直线l1的角度;
d1、d2、d3、d4、θc、θc0:为阀值;
设计关联矩阵为:
得特征模型Φ={Φ1,Φ2,Φ3,Φ4}为:
(3)由当前特征状态驱动构建的控制模态集Ψ,确定出当前控制模态ψij,根据当前控制模态ψij控制汽车运动到当前预定关键点:
构建控制模态集Ψ={Ψ1,Ψ2,Ψ3,Ψ4}为:
Claims (1)
1.一种基于仿人智能控制的汽车自动泊车入位方法,其特征在于:该方法第一步是根据汽车参数和泊车位参数确定自动泊车入位路径,并选取该路径上的几个预定关键点作为跟踪目标;第二步,根据汽车泊车入位过程中的位姿相对于当前预定关键点的误差及其误差变化率驱动构建的特征模型确定出当前特征状态;第三步,根据驾驶员泊车入位操作为基础构建的控制模态集,由当前特征状态确定出当前控制模态;第四步,根据当前控制模态控制汽车运动到当前预定关键点;依照第二步至第四步的方法依次控制汽车运动到最后一个预定关键点,即可实现汽车泊车入位;具体步骤如下:
以预定关键点P4(0,0)为原点O建立直角坐标系XOY;
取直线l1:y=az+b,(a=tanθ0为l1直线的斜率, 为前轮转角最大值, 和点P1(x1,y1),作圆O1,与直线l1相切于点P3,与x轴相切于原点O,圆O1的圆心O1在y轴正方向上,且圆O1的半径R1满足R1≥Rm;过点P1作与x轴平行的直线l2,作圆O3,与直线l1相切于点P2,与直线l2相切于点P1,且圆O3的半径R3满足R3≥Rm;
通过计算得:
特征模型Φ={Φ1,Φ2,Φ3,Φ4}为:
其中,
为汽车当前位置(x,y)与预定关键点P1之间的距离;
eθ=θ为车身方向θ相对于目标方向0°的角度;
eθ0=θ-θ0为车身方向θ相对于直线l1的角度;
d1、d2、d3、d4、θc、θc0:为阀值;
控制模态集Ψ={Ψ1,Ψ2,Ψ3,Ψ4}为:
如果汽车当前处于特征状态则采用控制模态ψij进行控制,i=1,2,3,4;j=1,2,3,4。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210151048.3A CN102658819B (zh) | 2012-05-16 | 2012-05-16 | 一种基于仿人智能控制的汽车自动泊车入位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210151048.3A CN102658819B (zh) | 2012-05-16 | 2012-05-16 | 一种基于仿人智能控制的汽车自动泊车入位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102658819A true CN102658819A (zh) | 2012-09-12 |
CN102658819B CN102658819B (zh) | 2015-03-11 |
Family
ID=46768456
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210151048.3A Expired - Fee Related CN102658819B (zh) | 2012-05-16 | 2012-05-16 | 一种基于仿人智能控制的汽车自动泊车入位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102658819B (zh) |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102963356A (zh) * | 2012-12-12 | 2013-03-13 | 涂亚庆 | 一种自动泊车系统的仿人智能控制结构 |
CN105035075A (zh) * | 2015-06-24 | 2015-11-11 | 合肥中科自动控制系统有限公司 | 一种用于自主平行泊车的路径规划方法 |
CN105128856A (zh) * | 2015-08-24 | 2015-12-09 | 奇瑞汽车股份有限公司 | 停车入库方法及装置 |
CN108275146A (zh) * | 2017-01-05 | 2018-07-13 | 重庆长安汽车股份有限公司 | 全自动泊车车速分段控制系统及方法 |
CN108407803A (zh) * | 2018-02-05 | 2018-08-17 | 华南理工大学 | 一种基于驾驶经验的自动泊车控制算法 |
CN108423067A (zh) * | 2017-02-15 | 2018-08-21 | 联创汽车电子有限公司 | 水平泊车控制方法及控制系统 |
CN108725579A (zh) * | 2017-04-25 | 2018-11-02 | 纵目科技(上海)股份有限公司 | 泊车过程中的方向控制方法及系统、模型、终端及车辆 |
CN109739231A (zh) * | 2018-12-29 | 2019-05-10 | 北京智行者科技有限公司 | 自动驾驶充电车停车控制方法及系统 |
CN110091918A (zh) * | 2018-01-29 | 2019-08-06 | 杭州海康汽车技术有限公司 | 一种获取泊车路径的方法及装置 |
CN110379178A (zh) * | 2019-07-25 | 2019-10-25 | 电子科技大学 | 基于毫米波雷达成像的无人驾驶汽车智能泊车方法 |
CN110525428A (zh) * | 2019-08-29 | 2019-12-03 | 合肥工业大学 | 一种基于模糊深度强化学习的自动泊车方法 |
CN112950994A (zh) * | 2019-12-10 | 2021-06-11 | 中移物联网有限公司 | 一种泊车信息的处理方法、装置及泊车位设备 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6275754B1 (en) * | 1996-10-09 | 2001-08-14 | Honda Giken Kogyo Kabushiki Kaisha | Automatic steering system for vehicle |
JP2006516939A (ja) * | 2003-05-19 | 2006-07-13 | ダイムラークライスラー・アクチェンゲゼルシャフト | 車両制御システム |
WO2008055567A1 (de) * | 2006-11-08 | 2008-05-15 | Volkswagen Aktiengesellschaft | Parklenkassistent mit verbesserter quereinparkfunktion |
DE102007009745A1 (de) * | 2007-02-28 | 2008-09-04 | Continental Automotive Gmbh | Einparkhalbautomat |
US20100204866A1 (en) * | 2009-02-09 | 2010-08-12 | Gm Global Technology Operations, Inc. | Path Planning for Autonomous Parking |
CN202080275U (zh) * | 2011-05-25 | 2011-12-21 | 周友义 | 一种自动倒车入位控制系统 |
CN102303604A (zh) * | 2011-06-29 | 2012-01-04 | 广东好帮手电子科技股份有限公司 | 一种自动泊车系统 |
CN102407848A (zh) * | 2010-09-21 | 2012-04-11 | 高强 | 具有自动泊车与智能驾驶功能的控制器系统 |
-
2012
- 2012-05-16 CN CN201210151048.3A patent/CN102658819B/zh not_active Expired - Fee Related
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6275754B1 (en) * | 1996-10-09 | 2001-08-14 | Honda Giken Kogyo Kabushiki Kaisha | Automatic steering system for vehicle |
JP2006516939A (ja) * | 2003-05-19 | 2006-07-13 | ダイムラークライスラー・アクチェンゲゼルシャフト | 車両制御システム |
WO2008055567A1 (de) * | 2006-11-08 | 2008-05-15 | Volkswagen Aktiengesellschaft | Parklenkassistent mit verbesserter quereinparkfunktion |
DE102007009745A1 (de) * | 2007-02-28 | 2008-09-04 | Continental Automotive Gmbh | Einparkhalbautomat |
US20100204866A1 (en) * | 2009-02-09 | 2010-08-12 | Gm Global Technology Operations, Inc. | Path Planning for Autonomous Parking |
CN102407848A (zh) * | 2010-09-21 | 2012-04-11 | 高强 | 具有自动泊车与智能驾驶功能的控制器系统 |
CN202080275U (zh) * | 2011-05-25 | 2011-12-21 | 周友义 | 一种自动倒车入位控制系统 |
CN102303604A (zh) * | 2011-06-29 | 2012-01-04 | 广东好帮手电子科技股份有限公司 | 一种自动泊车系统 |
Non-Patent Citations (1)
Title |
---|
陈浩,涂亚庆: "自动停车入位方法现状分析及发展探讨", 《自动化与仪器仪表》, no. 1, 31 January 2012 (2012-01-31), pages 26 - 29 * |
Cited By (19)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102963356A (zh) * | 2012-12-12 | 2013-03-13 | 涂亚庆 | 一种自动泊车系统的仿人智能控制结构 |
CN105035075B (zh) * | 2015-06-24 | 2018-08-21 | 合肥中科自动控制系统有限公司 | 一种用于自主平行泊车的路径规划方法 |
CN105035075A (zh) * | 2015-06-24 | 2015-11-11 | 合肥中科自动控制系统有限公司 | 一种用于自主平行泊车的路径规划方法 |
CN105128856A (zh) * | 2015-08-24 | 2015-12-09 | 奇瑞汽车股份有限公司 | 停车入库方法及装置 |
CN105128856B (zh) * | 2015-08-24 | 2018-06-26 | 奇瑞汽车股份有限公司 | 停车入库方法及装置 |
CN108275146A (zh) * | 2017-01-05 | 2018-07-13 | 重庆长安汽车股份有限公司 | 全自动泊车车速分段控制系统及方法 |
CN108423067A (zh) * | 2017-02-15 | 2018-08-21 | 联创汽车电子有限公司 | 水平泊车控制方法及控制系统 |
CN108725579A (zh) * | 2017-04-25 | 2018-11-02 | 纵目科技(上海)股份有限公司 | 泊车过程中的方向控制方法及系统、模型、终端及车辆 |
CN110091918A (zh) * | 2018-01-29 | 2019-08-06 | 杭州海康汽车技术有限公司 | 一种获取泊车路径的方法及装置 |
CN110091918B (zh) * | 2018-01-29 | 2021-12-31 | 杭州海康汽车软件有限公司 | 一种获取泊车路径的方法及装置 |
CN108407803A (zh) * | 2018-02-05 | 2018-08-17 | 华南理工大学 | 一种基于驾驶经验的自动泊车控制算法 |
CN108407803B (zh) * | 2018-02-05 | 2019-10-18 | 华南理工大学 | 一种基于驾驶经验的自动泊车控制算法 |
CN109739231A (zh) * | 2018-12-29 | 2019-05-10 | 北京智行者科技有限公司 | 自动驾驶充电车停车控制方法及系统 |
CN110379178A (zh) * | 2019-07-25 | 2019-10-25 | 电子科技大学 | 基于毫米波雷达成像的无人驾驶汽车智能泊车方法 |
CN110379178B (zh) * | 2019-07-25 | 2021-11-02 | 电子科技大学 | 基于毫米波雷达成像的无人驾驶汽车智能泊车方法 |
CN110525428A (zh) * | 2019-08-29 | 2019-12-03 | 合肥工业大学 | 一种基于模糊深度强化学习的自动泊车方法 |
CN110525428B (zh) * | 2019-08-29 | 2020-09-04 | 合肥工业大学 | 一种基于模糊深度强化学习的自动泊车方法 |
CN112950994A (zh) * | 2019-12-10 | 2021-06-11 | 中移物联网有限公司 | 一种泊车信息的处理方法、装置及泊车位设备 |
CN112950994B (zh) * | 2019-12-10 | 2023-04-07 | 中移物联网有限公司 | 一种泊车信息的处理方法、装置及泊车位设备 |
Also Published As
Publication number | Publication date |
---|---|
CN102658819B (zh) | 2015-03-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102658819B (zh) | 一种基于仿人智能控制的汽车自动泊车入位方法 | |
CN106671982B (zh) | 基于多智能体的无人驾驶电动汽车自动超车系统及方法 | |
Guo et al. | Lane changing trajectory planning and tracking controller design for intelligent vehicle running on curved road | |
Li et al. | Development of a new integrated local trajectory planning and tracking control framework for autonomous ground vehicles | |
Li et al. | An optimization-based path planning approach for autonomous vehicles using the DynEFWA-artificial potential field | |
Ren et al. | Integrated model predictive and torque vectoring control for path tracking of 4‐wheel‐driven autonomous vehicles | |
Althoff et al. | Safety verification of autonomous vehicles for coordinated evasive maneuvers | |
CN104881030B (zh) | 基于快速终端滑模原理的无人车侧纵向耦合跟踪控制方法 | |
Zhang et al. | A novel steering system for a space-saving 4WS4WD electric vehicle: design, modeling, and road tests | |
CN105857306A (zh) | 一种用于多种泊车场景的车辆自主泊车路径规划方法 | |
Bae et al. | Path generation and tracking based on a Bezier curve for a steering rate controller of autonomous vehicles | |
CN102963356A (zh) | 一种自动泊车系统的仿人智能控制结构 | |
CN205499046U (zh) | 一种自动驾驶转向控制系统 | |
CN113359771B (zh) | 一种基于强化学习的智能自动驾驶控制方法 | |
Qiu et al. | Hierarchical control of trajectory planning and trajectory tracking for autonomous parallel parking | |
Li et al. | Dynamically integrated spatiotemporal‐based trajectory planning and control for autonomous vehicles | |
CN105644566B (zh) | 一种基于车联网的电动汽车辅助换道轨迹的跟踪方法 | |
Sun et al. | Ribbon model based path tracking method for autonomous land vehicle | |
CN113848927A (zh) | 一种自主规划路径的自动驾驶系统 | |
Gim et al. | Safe and efficient lane change maneuver for obstacle avoidance inspired from human driving pattern | |
Moon et al. | Automatic parking controller with a twin artificial neural network architecture | |
Cai et al. | Multi-maneuver vertical parking path planning and control in a narrow space | |
CN205615575U (zh) | 一种车辆自动驾驶辅助转向系统 | |
Yang et al. | A trajectory planning and fuzzy control for autonomous intelligent parking system | |
Bae et al. | Steering rate controller based on curvature of trajectory for autonomous driving vehicles |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20150311 Termination date: 20170516 |