智能检测论文 自动泊车系统研究大学论文.docx

1、智能检测论文 自动泊车系统研究大学论文智能检测与工程控制课程论文论文题目： 自动泊车系统研究 作 者： 刘小荷 学 号： 141802004 所在学院： 电气与自动化工程学院 任课老师： 张金龙 教授 论文时间： 2015年6月15日 Autonomous Parking System141802004 Liu Xiaohe(School of Electrical and Automation Engineering, Nanjing Normal University )Abstract: To simplify parallel parking, an autonomous parkin

2、g method based on human-simulated intelligent control is proposed, by summarizing and imitating the parking skills of experienced drivers. A four-wheeled vehicle with rear-wheel drive and front wheel steering is used as study object. The vehicle kinematic model is build. According to the drivers exp

3、erience, the parking processing is divided into four stages. Four key points on the programming trajectory composed with two tangent arcs and a tangent are chosen as tracking targets. At these points, conversion between two consecutive parking stages takes place and the vehicle pose is pivotal adjus

4、ted. Twelve character modes are extracted to describe dynamic behaviors of the parking feature from the information of the vehicle pose. Control mode set is developed according to the parking strategy of skilled drivers. When the parking begins, pattern recognition is used to identify the characteri

5、stics model according to the a priori knowledge of character models and the deviation of vehicle position. To control the vehicle parking along the programming trajectory，corresponding control mode is adapted by the characteristics model. Simulink kinematic modes of the vehicle and the proposed huma

6、n-simulated intelligent controller are established, Simulations had been done and the results demonstrated the effectiveness of the proposed methodKey words: autonumous parking; human-simulated intelligent control; characteristic model; control model 自动泊车系统研究141802004 刘小荷（南京师范大学电气与自动化工程学院）摘要: 为简化平行泊

7、车，通过总结模拟熟练驾驶员的泊车经验，提出一种自动泊车的仿人智能控制方法。该方法以后轮驱动、前轮转向的四轮汽车为对象，建立车辆运动学模型; 通过分析熟练驾驶员泊车流程，将泊车过程分为4 个阶段; 在相切圆弧加公切线的规划路径上，选取泊车阶段转换时车辆姿态调整的关键点作为跟踪目标; 根据泊车过程车辆的位姿信息，提取12 种泊车的特征状态，作为描述车辆泊车动态行为的特征模型; 根据熟练驾驶员的泊车策略，构建控制模态集。泊车开始后，依据特征模型先验知识和当前车辆位姿与泊车目标的偏差，对当前车辆特征状态进行模式识别，由辨识出的特征状态驱动相应控制模态，控制汽车按规划路径泊车入位。建立了车辆运动学和仿人

8、智能控制器Simulink 模型，并进行了仿真实验。仿真结果表明，该方法能有效控制车辆泊入车位。关键词: 自动泊车; 仿人智能控制; 特征模型; 控制模态1 工作原理1.1 基本工作原理 超声波测距的方法有很多种，大概分为：相位检测法、声波幅值检测法和往返时间检测法等，车载超声波检测采用往返时间检测法，具体步骤是：超声波发射器向某一方向发射超声波，在发射的同时开始计时，超声波在空气中传播，途中遇到障碍物就立即返回来，超声波接收器收到反射波时就立即停止计时。于是利用超声波在空气中的传播速度，以及超声波在发射后遇到障碍物反射回来的时间差即可计算发射点到障碍物的实际距离，即时间差测距法。原理框图如图

9、1所示：图1 超声波测距的原理框图生活中常用的车载倒车装置通过传感器和摄像头感知车辆周围的物体，如图2 所示。当传感器感应到障碍物时摄像头也将障碍物摄入视频，同时传感器进行测距，保证驾驶员在看到障碍物的同时也能迅速掌握障碍物距离车辆的实际距离，从而更加有效地调整行车状态。图2 车载倒车装置安装位置示意随着社会发展，人们生活要求不断提高，各种工具越来越智能化，城市车辆越来越多，道路泊车问题越来越突出，自动泊车系统便应运而生。自动泊车系统是车载倒车装置的升级，是一种能够快速、安全地使车辆自动驶入泊车位的智能泊车辅助系统，它通过超声波以及图像传感器感知车辆周围环境信息来识别泊车车位，并根据车辆与停车

10、位的相对位置信息，产生相应的泊车轨迹并控制车辆的速度和方向盘转向完成自动泊车。与驾驶员泊车操作复杂、泊车时间长、泊车安全事故率高相比，自动泊车系统提供了一种简单、方便的泊车功能，降低了泊车操作时的难度，提高了车辆的智能化水平。目前，自动泊车系统的开发也成为国内主流汽车主动安全研究的重要方向。自动泊车系统的传感器不但涉及测距单元，更为重要的是一些控制单元的传感器，其传感器分布位置示意图如图3所示。 图3自动泊车系统传感器分布位置示意图1.2控制的实现实现汽车自动泊车，可提高泊车安全性，降低驾驶员操作的复杂性，控制方法是其关键技术之一。因此，研究自动泊车的控制问题具有重要的现实意义和应用价值。当前

11、自动泊车控制方法可归纳为: 基于路径规划的方法，先设计一条可行的期望路径，如相切圆弧加公切线等，控制汽车沿期望路径运动进入泊车位。该方法对传感器和执行器的精确性要求很高，很难补偿系统动态性引起的误差，示意图如图4所示：图4 相切圆弧加公切线方法方法示意图基于经验知识的方法，主要采用模糊控制，将熟练驾驶员的泊车经验转化为模糊控制器，是目前较通用的方法。但模糊控制规则的完备性、模糊变量隶属函数的全局最优性难以保证。示意图如图5所示：图5 基于经验知识的方法方法示意图 泊车是一个“驾驶员-车辆-道路”闭环系统，驾驶员根据对道路、车辆运动状态的感知，经过分析、判断，控制车速与转向，使车辆安全准确地运动

12、到目标位置。根据熟练驾驶员实际操作经验，可将车辆泊车入位过程归纳为4 个阶段，各阶段转换位置是泊车控制的关键点。 阶段一: 寻找车位，确定预备泊车位置，调整车辆姿态，使车身与车位保持平行，距离dy 约为0. 5 m，车尾与泊车位前端基本平齐。 阶段二: 朝泊车位转向( 车位在车身右边时顺时钟打方向盘) ，保持转向角度，倒车进入车位。此过程主要是控制车辆，避免与其他车辆碰撞。 阶段三: 朝泊车位反方向转向( 车位在车身右边时逆时针打方向盘) ，保持转向角度，继续倒车使方向角( 或| /2 | ) 减小。若无碰撞，| |5 且| y |0. 1 m，则认为泊车成功，否则进入阶段四。 阶段四: 车位

13、内姿态调整。控制车辆在车位内前后运动，调整姿态直至泊车成功。基于路径规划和经验知识相结合的方法，既考虑路径规划的精确性，又兼顾经验知识方法的鲁棒性，是当前研究的热点。本文以仿人智能控制理论为指导，通过总结模拟熟练驾驶员泊车经验，提出一种自动泊车的仿人智能控制方法。自动泊车的仿人智能控制器设计基本思路是：根据车辆与车位参数，设计一条圆弧加公切线的泊车规划路径，在规划路径上选取车辆姿态调整的4 个关键点作为跟踪目标; 根据泊车过程车辆的位姿信息，提取泊车的12 种特征模型，作为描述车辆泊车动态行为的特征模型; 根据熟练驾驶员的泊车策略，构建控制模态集。泊车开始后，依据特征模型先验知识和当前车辆位姿

14、与泊车目标的偏差，对当前车辆特征状态进行模式识别，由辨识出的特征状态驱动相应控制模态，从而充分模仿熟练驾驶员在泊车过程中的粗调和微调，得到自动泊车的仿人智能控制器，通过控制车速和前轮转向使汽车依次跟踪各关键点，实现泊车入位。2.车辆运动学模型在研究自动泊车系统时，首先需要确定车辆运动姿态，研究车辆的运动轨迹。因此，需要建立车辆运动学模型。在整个自动泊车过程中，车辆总是处于一种低速行驶状态，车辆在低速行驶过程中不会出现滑动和侧向移动，为此，在这种情况下建立车辆运动学模型如图6 所示。图6 车辆运动学模型图根据车辆运动学模型可以得到以下关系式。 式中:为车辆车轴和水平方向的夹角;为车辆前轮和车辆车

15、轴的夹角;为后轴中心点横坐标;为后轴中心点纵坐标; V 为车辆的运动速度;W 为车辆的轴距。从上面的分析可以得知，汽车模型具有3 个控制状态变量:，以及一个输出状态变量，便可以构建车辆运动学Simulink 模块，如图7 所示。图7 车辆运动学Simulink 模块3.自动泊车的仿人智能控制器设计 根据基于路径规划和经验知识相结合的方法的设计思路，整理出如图7的控制框图：图7 本文方法控制框图自动泊车的仿人智能控制流程如下:步骤1：根据汽车参数和泊车位参数确定4 个关键点Pi( P1为预备倒车位置，P2和P3为关键转向点，P4即原点为泊车成功位置) 作为跟踪目标。步骤2：根据泊车过程中汽车位姿

16、相对于当前关键点Pi的误差及其误差变化率，驱动构建特征模型确定当前特征状态。 步骤3：根据控制模态集 先验知识和当前车辆特征状态，确定出当前控制模态。步骤4：根据当前控制模态控制汽车运动到当前关键点Pi。依照Step 2 至Step4，控制汽车运动到最后一个关键点P4，即泊车入位。控制流程图如图8 所示。图8 本文方法控制流程4.控制方法实现4.1泊车路径与跟踪目标 泊车阶段的转换位置是车辆姿态调整的关键点，为泊车控制的跟踪目标，如图 9所示 。 图9 4个关键点选取在圆弧加公切线的规划路径上共有4 个关键点: 预备泊车点) ，第一转向点，第二转向点和目标泊车点。以车位宽AB 中点为坐标原点，

17、设车宽，前轮转角，最小转弯半径，车位长，车位宽， 由几何知识可推导出4 个关键点坐标:4.2 构建特征模型熟练驾驶员泊车时往往基于车辆位置与姿态采取相应控制策略。对车辆位姿状态进行细分，用特征模型来描述。特征模型为所有特征状的集合，特征状态则由一些特征基元qi的组合来描述。根据汽车当前位置和方向相对于当前关键点的距离和方向及它们的变化趋势等情况，构建特征基元集，并得出特征模型= ， 其中:汽车当前位置( x，y) 与预定关键点P1之间的距离;是描述汽车远离或者接近预定的关键点。（i=1,2,3,4）4.3 构建控制模态驾驶员泊车过程的控制策略，可用控制模态i来描述，通过磅-磅、比例、积分、微分

18、和极值保持等控制特征基元来实现。泊车过程中，需同时控制车速V和前轮转角，2 个控制量的不同组合方式可产生多种控制模态基元。构建控制模态集:4.4控制策略分析图10 12种特征状态泊车过程中，熟练驾驶员会根据车辆位姿状态，采用不同控制策略。对于图10 所示的12 种特征状态，控制策略分析如下:模态1 图10( a) : 车辆远离预备泊车点，应调整车速方向，朝预备泊车点运动;模态2 图10( b) : 车辆靠近预备泊车点，但角度误差较大。此时需调整车身方向角，以较大的角速度和较小的线速度让车辆对准预备泊车点前进;模态3 图10( c) : 车辆已对准并向预备泊车点靠近，但距离较远，可适当提高车速;

19、模态4 图10( d) : 车辆已对准并在继续靠近预备泊车位，且距离较近，应适当减速，以避免超调，即避免超过预备泊车位;模态5 图10( e) : 车辆远离目标泊车位，在倒车进入车库的过程中可能会发生碰撞，造成车辆向相反的方向运动，这时要前进一段距离，将车身方向角调整好后再进入车库;模态6 图10( f) : 车辆靠近目标泊车位，但角度误差较大，应该快速调整车辆姿态，以较大的角速度和较小的线速度让车辆对准目标泊车位置前进;模态7 图10( g) : 车辆已对准目标泊车位，且在靠近目标泊车位置，但距离较远，这时可稍微加大车速，让车辆较快到达目标位置，提高泊车效率;模态8 图10( h) : 车辆

20、已对准目标泊车位，且距离较近并在继续靠近目标泊车位置，此时应适当减速，以避免超过目标泊车位与后方障碍物发生碰撞;模态9 图10( i) : 车辆远离目标泊车位，因不满足泊车成功条件，需加强调整方向角;模态10 图10( i) : 车辆靠近目标泊车位，但角度误差较大，此时应快速调整车辆姿态，以较大的角速度和较小的线速度对准目标泊车位置前进;模态11 图10( k) : 车辆已对准并向目标泊车位靠近，但距离较远，可稍微加大车速;模态12 图10( l) : 车辆已对准并在继续靠近目标泊车位，且距离较近，应适当减速，以免与后方障碍物发生碰撞。在特征模型和控制模态集之间，运用启发式搜索与直接推理模仿驾

21、驶员决策。若车辆处于特征状态，则采用控制模态进行控制，用产生式规则描述控制策略如下:IF，THEN （i = 1，2，3，4，j= 1，2，3，4）5 实验研究在Matlab2010a /Simulink 环境中建立自动泊车系统仿真模型如图11 所示。图11 平行泊车仿真模型图12车辆运动学仿真模型图13( a) ，图13( b) 分别为转向角和方位角的随时间变化情况; 图13( c) 为车辆方向与规划路径公切线的偏离程度，主要描述阶段二的控制精度，10 s 20 s 间偏差较小，说明控制精度较高; 图14（d) 是参考点，即车辆后轴中心的轨迹，与规划路径十分类似，说明控制效果较好。图13 标

22、准车的平行泊车仿真结果6 结论面对泊车系统的多输入多输出的非线性欠驱动耦合特性，传统控制方法难以实现精确控制。本文通过总结模拟熟练驾驶员泊车经验，提出了一种自动泊车的仿人智能控制方法。建立了泊车特征模型和控制模态集，经模式识别确定车辆当前特征状态，进而驱动相应的控制模态，控制车辆按规划路径实现自动泊车入位。仿真实验结果表明了本文方法的有效性。为解决“停车入位难”问题提供了一种有效方法，为构建具有自主知识产权的自动泊车系统做了有益探索。7 参考文献1 Kang Z L，Minh Q D，Takuya I An exponentially -convergent control algorithm

23、 for chained systems and its application to automatic parking systemsJ IEEE Transactions on Control Systems Technology，2006，14( 6) : 1113-11262 Kooktae L，Dalhyung K，Woojin C， et al Car parking control using a trajectory tracking controllerC SICE-ICASE，Bus an: International Joint Conference 2006: 205

24、8-20633 Bernhard M， Joachim D，Stefan G Continuous curvature trajectory design and feed-forward control for parking a carJ IEEE Transactions on Control Systems Technology， 2007，15( 3) : 541-5534 李祖枢，涂亚庆 仿人智能控制M 北京: 国防工业出版社，2003 ( Li Zu-shu，Tu Ya-qing Human-simulated intelligent controlM Beijing: Nati

25、onal Defence Industry Press，2003 )5 李祖枢 仿人智能控制理论与多级摆的摆起控制M 北京: 科学出版社，2006 ( Li Zu-shu Human-Simulated Intelligent Control heory and Multistage Pendulum Swing-up Control M Beijing: Science Press， 2006 6 Tzuu-Hseng S ， Shih JAutonomous fuzzy parking control of a car-like mobile robot C Systems ， Man ， and CyberneticsTai bei : IEEE Transactions ， 2003 : 451-465