综合训练题二自动泊车

1综合训练题二摘要自动泊车是一项非常具有实用性的技术。自动泊车系统可通过各类传感器获取车位相对汽车的距离，通过控制汽车前轮转角和瞬时速度控制车辆行驶。本文针对自动泊车系统的研究，参考生活中人工入库的实际情况，对整个倒车过程车辆运动规律进行深入分析之后，运用了几何学相关知识求出了车辆在各段泊车的位置，通过数学建模的方法对泊车策略进行分析，从而实现自动、安全、快速的停车入库。针对问题一，我们将汽车倒车入库的过程划分为三个阶段，仔细分析汽车倒车入库的过程之后我们考虑这三段过程中可能会发生的接触车库警戒线，列出约束条件，建立数学模型，并采用数形结合的方法对模型进行求解，最终求出汽车能够安全入库的起始点位置范围为下列曲线√))))))))所包络的不规则区域。针对问题二，我们应该在汽车能够安全倒车入库并停在最恰当位置的前提下寻求满足前轮转角之和最小和后轮行驶距离最短的最佳泊车策略，先针对设任意起始点00(,)xy分析，对问题一中所构建的模型稍加改动，增加了对最终停车位置的约束条件，并针对前轮转角和后轮行驶距离构建双目标函数，由几何问题转化为多目标非线性规划问题，因为00(,)xy非具体值，无法通过软件直接求解，通过任意选取多个具体00(,)xy的值，运用Matlab软件的fgoalattain函数对该双目标非线性规划问题求解，得到多个起始点的最佳泊车策略，并进行了比较分析。关键词：数形结合；Matlab；多目标函数非线性规划；fgoalattain函数2一、问题重述随着汽车产业及科技的高速发展，智能驾驶汽车成为了国内外公认的未来汽车重要发展方向之一。而在汽车智能化进程中，自动泊车是一项非常具有挑战性和实用性的技术。自动泊车系统可通过各类传感器获取车位相对汽车的距离，通过控制汽车前轮转角和瞬时速度控制车辆行驶。若考虑系统控制容易性，参考人工倒车入库，当车辆位于与车位垂直的任意位置时，先通过前行或后退到达理想停车起始点后，再确定前进转角和后退转角，使车身与车位在同一直线上后，直接倒车完成入库，即“一进二退”。这种两段式倒车模式提高了泊车过程中车辆行驶的紧凑性，同时减少了泊车行驶空间。考虑大众新款捷达，长4487mm，宽1706mm，轴距2603mm，前轮距1460mm，后轮距1500mm，目标车库为小型汽车库标准大小长6m，宽2.8m，车库周围情况如图。建立模型给出泊车策略，最终实现汽车自动、安全、快速的停车入库。1)建立模型，按照车辆与车位之间的距离把车辆位置进行分组，给出每一组对应的倒车理想起始点，a=400mm，b=8000mm，c=300mm。2)建立模型，给出由理想起始点到倒车入库的泊车策略，包括车速、前轮转角、后轮行驶距离。二、问题分析问题一的分析在问题一中，首先明确问题，题目要求寻找汽车能够安全入库的起始点位置的区3域范围；然后，我们结合题目信息以及实际生活中的倒车过程，分析了制约汽车安全入库的影响因素，主要是受到车库周围事物的影响；我们将汽车倒车入库的过程分为三段，前两段轨迹为圆弧，其中第一段圆弧与第二段圆弧相切，第三段轨迹为直线运动；最后根据车库周围障碍物的制约构建不等式，并采用数形结合的方法得到区域范围，求出区域边界方程，最后得出满足汽车安全入库的起始点位置的区域。问题二的分析在问题二中，题目要求根据前轮转角和后轮行驶距离设计出从任意入库起始点开始的最佳泊车策略，即在问题一汽车安全入库的基础上寻求倒车优化方案，从而建立优化模型。为了使得汽车出库和入库时行驶方便，参考上图中车位旁边的两辆汽车的停放位置，要使停车位置最佳，则需要在满足问题一中约束条件的的前提下增加对停车位置的约束，并构建有关汽车行驶距离和两段泊车转角的多目标函数非线性规划，将任意点看做取多个具体点，最后运用Matlab软件进行求解，得到每个具体起始点的最优泊车策略。三、模型假设1、假设汽车在自动泊车过程中不存在车轮打滑的情况；2、假设汽车在自动泊车的过程中没有其他正在行驶的汽车及行人干扰其倒车入库；3、假设在汽车自动泊车入库的过程中每一段泊车车车轮转角都为定值；4、假设汽车在自动泊车过程中车的行驶速度都为7km/h以下的自动泊车安全速度；四、符号说明符号意义单位备注01SO与11OS之间的夹角rad(0,)2汽车后轮轴中点到车头顶点连线与汽车中心轴之间的夹角radtanWSL41汽车在第一段倒车过程中的前轮转角rad12(,)692汽车在第二段倒车过程中的前轮转角rad12(,)69W汽车车身的宽度mW=1.706t汽车的后轮距mS汽车的长度mL汽车的轴距mn车位的长度m6nm车位的宽度m2.8ma已经停放好的汽车车身左侧与车位左侧边界线之间的距离m0.4ab表示1l与2l之间的距离mc已经停放好的汽车车身前沿与车位上边界线之间的距离m0.3cd车身与车位在同一条直线上之后，车直线行驶到最终泊车点的距离m1R汽车第一段行驶轨迹的半径m11cotRL2R汽车第二段行驶轨迹的半径m22cotRL5五、模型的建立与求解5.1问题一模型建立与求解5.1.1问题一的分析问题一中，我们参考了生活中倒车实际情况的同时，结合题目信息，将倒车的过程分为三段。如图所示，从汽车位于与车位垂直的任意位置时起，至汽车按照题目已知的转向角36度前进到某一合适的地点止，为第一段，第一段路程的轨迹是一段半径为1cot36RL圆心角为的圆弧；汽车从第一段行程的终点按照相同的转向角36度后退到车身与车位在同一条直线上止为第二段，由如图1几何关系知第二段路程的轨迹是一段半径为2cot36RL圆心角为2的圆弧；最后汽车沿直线行驶距离d后直接后退到车位的合适位置停车，为第三段。那么，为保证汽车能够安全倒车入库，影响其倒车起始点位置0s所在区域范围的约束条件有四个：第一，汽车位于第一段路程的起始点与车位垂直时，车身不能越过2l和1l；第二，汽车在第一段路程的终点处不能越过上边界线1l；第三，汽车在倒车的第二段过程中，车身（轮廓线在地面的投影）不能越过D点；第四，汽车在倒车的第三段过程终点停车时，车身左侧不能越过FG，右侧不能越过DE。5.1.2问题一模型的建立通过对原问题的分析，我们以汽车两后轮连线中心点的轨迹代替汽车的运行轨迹，可以建立如下的数学模型.首先明确变量：如图，以车位的左下角顶点F为坐标原点，设汽车位于初始点位置时，两后轮连线中心点坐标为00,0()Sxy,汽车位于第一段路程的终点处时，两后轮连线中心点坐标为11,1()Sxy，汽车位于第二段路程的终点处时，两后轮连线中心点坐标为,()BBBxy，汽车在第三段路程的终点处停车时，两后轮中心点坐标为33,3()Sxy，汽车在第一段和第二段过程中两后轮连线中心点轨迹为圆弧，设第一段轨迹圆心为1O，半径为1R,第二段轨迹圆心为2O，半径为2R，011SOS。6图1第一步：取F点坐标为（0,0）7用不等式表示出约束条件1，即汽车位于第一段路程的起始点与车位垂直时，车身不能越过2l。022WWnynb（1-1）式中：n表示车位的长度b表示12ll之间的距离W表示汽车的宽度第二步:用不等式表示出约束条件2，即汽车在第一段路程的终点处不能越过上边界线1l。汽车从000(,)Sxy运动到111(,)Sxy过程中，轨迹为以1O为圆心，11cotRL为半径的圆弧，1为汽车沿圆弧前进时的前轮转角，则111(,)Sxy的坐标用00,xy表示为101sinxxR，101(1cos)yyR，由勾股定理得221()()22SLWAS，则A点的纵坐标为11sin()AyyAS，由图像易得tanWSL由此可得2201(1cos)()()sin(),(0,)222SLWyRnb（1-2）式中：W表示汽车的宽度S表示汽车的长度L表示汽车的轴距第三步:用不等式表示出约束条件3，即汽车在倒车的第二段过程中，车身（轮廓线在地面的投影）不能越过D点。在第二段过程中，当汽车运行到车身与线段2DO垂直时，汽车两后轮连线中点为222(,)Sxy，此时汽车刚好以全部的车身长度侧对2DO,车身离车位边角D点的距离最小，8所以需满足22WSD。在直角三角形12RtOCO中,2O点横坐标为2012()sinOxxRR,2O点的纵坐标为20121[()cos]OyyRRR，D点坐标为（m，n）,则由两点间的距离公式得2220120121[()sin][()cos]DOmxRRnyRRR。当2Oxm且2Oyn时需满足222WRDO,即当012()sinxRRm且0121[()cos]yRRRn时，2220120121[()sin][()cos],(0,)22WRmxRRnyRRR（1-3）式中：m表示车位的宽度第四步:用不等式表示出约束条件4，即汽车在倒车的第三段过程终点停车时，车身左侧不能越过FG，右侧不能越过DE。如图所示，两后轮连线中点3S点的横坐标为312(1sin)xxR,101sinxxR则3012sin(1sin)xxRR，由此可得012sin(1sin)2WxRRm（1-4）012sin(1sin)02WxRR（1-5）另外两后轮连线中心点3S的纵坐标为312cosyydR，101(1cos)yyR，则3012(1cos)cosyyRdR，(0,)2在问题一中，题目假定汽车转弯时固定按照36度的转向角前进和后退，即12cot36RRL，综上所述，由1-1到1-5知问题一的模型为9022022000022(1cos)()()sin().22[2sin][2cos]22sin.22sin02cot36arctan(0,)2WWnynbSLWyRnbWRmxRnyRRWxRRmstWxRRRLWSL5.1.3问题一模型的求解算法步骤与结果。如果模型求解比较困难，可以采取简化方法或者启发式算法或者暴力索或者计算机模拟等方法求解搜。对于问题一，我们采用了数形结合的方法求解，求解结果为下列曲线√)))))所包络的不规则区域。5.1.4问题一结果的分析及验证由模型一求解得知求解出区域为七条曲线所包络的范围，由该区域知若行驶的车辆在到达起始点过程中若太靠近停车场左端，曲线所包络起始点区域较少，则以36°车轮转角自动泊车很难实现，若希望车辆自动泊车更顺利，有更多起始点，则应在停车场行驶到泊车起始点过程中应尽量靠右端行驶。10在图a网格图中在包络区域左下角任取起始点000(,)(2,6)Sxy，带入问题一模型式1,2,3,4,5得226.7475613.25252.479cos2.916sin4.78(4.86.44sin)(3.226.44cos)2.476.44sin5.976.44sin7.27取2，带入不等式成立，即000(,)(2,6)Sxy满足模型成立。同理，在图a网格图中在包络区域中上部分任取起始点000(,)(1,11)Sxy，带入问题一模型式1,2,3,4,5，取4成立，000(,)(1,11)Sxy满足模型成立。右下部分取一点000(,)(4,8)Sxy，带入模型，取0成立，此点也满足模型。现在图a网格图中取区域外一点000(,)(0,12)Sxy，带入模型中得sin0.61,sin0.42不等式解为空集，所以不成立。继续取区域边界外靠近边界一点（5，5），带入模型得不等式解集也为空集。由大致取点验证知，模型一模型求解正确。5.2问题二模型建立与求解5.2.1问题二的分析11在问题二中，题目要求根据前轮转角和