综合训练题二：自动泊车.docx

综合训练题二摘要自动泊车是一项非常具有实用性的技术。自动泊车系统可通过各类传感器获取车位相对汽车的距离，通过控制汽车前轮转角和瞬时速度控制车辆行驶。本文针对自动泊车系统的研究，参考生活中人工入库的实际情况，对整个倒车过程车辆运动规律进行深入分析之后，运用了几何学相关知识求出了车辆在各段泊车的位置，通过数学建模的方法对泊车策略进行分析，从而实现自动、安全、快速的停车入库。针对问题一，我们将汽车倒车入库的过程划分为三个阶段，仔细分析汽车倒车入库的过程之后我们考虑这三段过程中可能会发生的接触车库警戒线，列出约束条件，建立数学模型，并采用数形结合的方法对模型进行求解，最终求出汽车能够安全入库的起始点位置范围为下列曲线6.853y13.47-2.47x5.207y8.99-0.45x+0.385(6.442-x-3.722 ;x(-2.47,3.72)x-2.82+y-9.2222.47;x(3.72,5.207)x-3.722+y-0.626.442;x(2.05,3.72)所包络的不规则区域。针对问题二，我们应该在汽车能够安全倒车入库并停在最恰当位置的前提下寻求满足前轮转角之和最小和后轮行驶距离最短的最佳泊车策略，先针对设任意起始点分析，对问题一中所构建的模型稍加改动，增加了对最终停车位置的约束条件，并针对前轮转角和后轮行驶距离构建双目标函数，由几何问题转化为多目标非线性规划问题，因为非具体值，无法通过软件直接求解，通过任意选取多个具体的值，运用Matlab软件的fgoalattain函数对该双目标非线性规划问题求解，得到多个起始点的最佳泊车策略，并进行了比较分析。关键词：数形结合；Matlab；多目标函数非线性规划；fgoalattain函数 一、问题重述 随着汽车产业及科技的高速发展，智能驾驶汽车成为了国内外公认的未来汽车重要发展方向之一。而在汽车智能化进程中，自动泊车是一项非常具有挑战性和实用性的技术。自动泊车系统可通过各类传感器获取车位相对汽车的距离，通过控制汽车前轮转角和瞬时速度控制车辆行驶。 若考虑系统控制容易性，参考人工倒车入库，当车辆位于与车位垂直的任意位置时，先通过前行或后退到达理想停车起始点后，再确定前进转角和后退转角，使车身与车位在同一直线上后，直接倒车完成入库，即“一进二退”。这种两段式倒车模式提高了泊车过程中车辆行驶的紧凑性，同时减少了泊车行驶空间。 考虑大众新款捷达，长4487mm，宽1706mm，轴距2603mm，前轮距1460mm，后轮距1500mm，目标车库为小型汽车库标准大小长6m，宽2.8m，车库周围情况如图。建立模型给出泊车策略，最终实现汽车自动、安全、快速的停车入库。1) 建立模型，按照车辆与车位之间的距离把车辆位置进行分组，给出每一组对应的倒车理想起始点，a=400mm，b=8000mm，c=300mm。2) 建立模型，给出由理想起始点到倒车入库的泊车策略，包括车速、前轮转角、后轮行驶距离。二、问题分析问题一的分析 在问题一中，首先明确问题，题目要求寻找汽车能够安全入库的起始点位置的区域范围；然后，我们结合题目信息以及实际生活中的倒车过程，分析了制约汽车安全入库的影响因素，主要是受到车库周围事物的影响；我们将汽车倒车入库的过程分为三段，前两段轨迹为圆弧，其中第一段圆弧与第二段圆弧相切，第三段轨迹为直线运动；最后根据车库周围障碍物的制约构建不等式，并采用数形结合的方法得到区域范围，求出区域边界方程，最后得出满足汽车安全入库的起始点位置的区域。问题二的分析在问题二中，题目要求根据前轮转角和后轮行驶距离设计出从任意入库起始点开始的最佳泊车策略，即在问题一汽车安全入库的基础上寻求倒车优化方案，从而建立优化模型。为了使得汽车出库和入库时行驶方便，参考上图中车位旁边的两辆汽车的停放位置，要使停车位置最佳，则需要在满足问题一中约束条件的的前提下增加对停车位置的约束，并构建有关汽车行驶距离和两段泊车转角的多目标函数非线性规划，将任意点看做取多个具体点，最后运用Matlab软件进行求解，得到每个具体起始点的最优泊车策略。三、模型假设1、假设汽车在自动泊车过程中不存在车轮打滑的情况；2、假设汽车在自动泊车的过程中没有其他正在行驶的汽车及行人干扰其倒车入库；3、假设在汽车自动泊车入库的过程中每一段泊车车车轮转角都为定值；4、假设汽车在自动泊车过程中车的行驶速度都为7km/h以下的自动泊车安全速度；四、符号说明符号意义单位备注与之间的夹角rad汽车后轮轴中点到车头顶点连线与汽车中心轴之间的夹角rad汽车在第一段倒车过程中的前轮转角rad汽车在第二段倒车过程中的前轮转角rad汽车车身的宽度m=1.706t汽车的后轮距mt=1.500汽车的长度mS=4.487汽车的轴距mL=2.603车位的长度m车位的宽度m已经停放好的汽车车身左侧与车位左侧边界线之间的距离m表示与之间的距离mb=8已经停放好的汽车车身前沿与车位上边界线之间的距离md车身与车位在同一条直线上之后，车直线行驶到最终泊车点的距离m汽车第一段行驶轨迹的半径m汽车第二段行驶轨迹的半径m五、模型的建立与求解5.1 问题一模型建立与求解5.1.1 问题一的分析问题一中，我们参考了生活中倒车实际情况的同时，结合题目信息，将倒车的过程分为三段。如图所示，从汽车位于与车位垂直的任意位置时起，至汽车按照题目已知的转向角36度前进到某一合适的地点止，为第一段，第一段路程的轨迹是一段半径为圆心角为的圆弧；汽车从第一段行程的终点按照相同的转向角36度后退到车身与车位在同一条直线上止为第二段，由如图1几何关系知第二段路程的轨迹是一段半径为圆心角为的圆弧；最后汽车沿直线行驶距离后直接后退到车位的合适位置停车，为第三段。那么，为保证汽车能够安全倒车入库，影响其倒车起始点位置所在区域范围的约束条件有四个：第一，汽车位于第一段路程的起始点与车位垂直时，车身不能越过和；第二，汽车在第一段路程的终点处不能越过上边界线；第三，汽车在倒车的第二段过程中，车身（轮廓线在地面的投影）不能越过D点；第四，汽车在倒车的第三段过程终点停车时，车身左侧不能越过FG，右侧不能越过DE。5.1.2 问题一模型的建立通过对原问题的分析，我们以汽车两后轮连线中心点的轨迹代替汽车的运行轨迹，可以建立如下的数学模型. 首先明确变量：如图，以车位的左下角顶点F为坐标原点，设汽车位于初始点位置时，两后轮连线中心点坐标为,汽车位于第一段路程的 终点处时，两后轮连线中心点坐标为，汽车位于第二段路程的终点处时，两后轮连线中心点坐标为，汽车在第三段路程的终点处停车时，两后轮中心点坐标为，汽车在第一段和第二段过程中两后轮连线中心点轨迹为圆弧，设第一段轨迹圆心为，半径为,第二段轨迹圆心为，半径为，。 图1第一步：取F点坐标为（0,0）用不等式表示出约束条件1，即汽车位于第一段路程的起始点与车位垂直时，车身不能越过。 （1-1）式中：n表示车位的长度 b表示之间的距离 W表示汽车的宽度第二步:用不等式表示出约束条件2，即汽车在第一段路程的终点处不能越过上边界线。 汽车从运动到过程中，轨迹为以为圆心，为半径的圆弧，为汽车沿圆弧前进时的前轮转角，则的坐标用表示为 ， ，由勾股定理得 ，则A点的纵坐标为，由图像易得由此可得 （1-2）式中：W表示汽车的宽度 S表示汽车的长度 L表示汽车的轴距第三步:用不等式表示出约束条件3，即汽车在倒车的第二段过程中，车身（轮廓线在地面的投影）不能越过D点。在第二段过程中，当汽车运行到车身与线段垂直时，汽车两后轮连线中点为，此时汽车刚好以全部的车身长度侧对,车身离车位边角点的距离最小，所以需满足。在直角三角形中,点横坐标为,点的纵坐标为，D点坐标为（m，n）,则由两点间的距离公式得。当且时需满足,即当且 时， （1-3） 式中：m表示车位的宽度第四步: 用不等式表示出约束条件4，即汽车在倒车的第三段过程终点停车时，车身左侧不能越过FG，右侧不能越过DE。如图所示，两后轮连线中点点的横坐标为,则，由此可得 （1-4） （1-5）另外两后轮连线中心点的纵坐标为，则， 在问题一中，题目假定汽车转弯时固定按照36度的转向角前进和后退，即，综上所述，由1-1到1-5知问题一的模型为 5.1.3 问题一模型的求解算法步骤与结果。如果模型求解比较困难，可以采取简化方法或者启发式算法或者暴力索或者计算机模拟等方法求解搜。对于问题一，我们采用了数形结合的方法求解，求解结果为下列曲线6.853y13.47-2.47x5.207y8.99-0.45x+0.385(6.442-x-3.722 ;-2.47x3.72x-2.82+y-9.2222.47;3.72x5.207x-3.722+y-0.626.442;2.05x xx =0.74290.48950.69959.6233 fvalfval =1.189314.0010 xx =0.71820.52630.80105.1533 fvalfval = 1.21139.5233 xx =0.51340.59401.17133.5117 fvalfval =1.75025.5841 xx =0.51340.7