智能车轨迹跟踪和仿真答辩

1、目录目录 智能车行驶轨迹跟踪的智能车行驶轨迹跟踪的MATLABMATLAB仿真仿真一、轨迹跟踪的研究目的、内容和难点一、轨迹跟踪的研究目的、内容和难点研究研究目的目的研究研究难点难点研究研究内容内容 2. 2. 运动学方程构建运动学方程构建 1. 1. 运动学模型构建运动学模型构建 在全局坐标系(O,X,Y)用M点的坐标p=(x,y,)T和q=(v,)T来表征智能车行驶时的线速度和转向时的角速度。L表示前后车轮轴之间的轴距。表示前轮的转角， 为车辆转弯半径。text in here二、运动学模型和轨迹跟踪问题二、运动学模型和轨迹跟踪问题Jqyxv p100sin0cos(1) 假设pr=(xr

2、,yr,r)T和qr=(vr,r)T作为参考跟踪信息，如果当前位姿用pc=(xc,yc,c)T表示那么在局部坐标系Xe-Ye的坐标为pe=(xe,ye,e)T根据坐标转换公式结合式(1)可推出得出位姿误差微分方程为：3.3.位姿误差微分方程位姿误差微分方程rerreerreeeeesincosxyyx p(2) 智能车运动学模型的跟踪控制就是找到对任意误差的初始值，控制系统在(2)控制输入作用下，pe=(xe,ye,e)T有界且 0|),(|limTeeetyx4.4.目的目的定义：定义：使用多个函数符号和相应的切换函数，强行的将一个非线性系统的状态轨迹逐渐的趋近于一个由事先设定好的状态空间曲

3、面上。优点：优点：算法比较简单，响应速度快，受外界噪声及扰动等参数的变化影响较小；对于系统的模型设置参数的不确定性和外部的不确定干预因素有很好的鲁棒性。缺点：缺点：在设计中因为不连续的符号函数和切换函数使得其输出的控制也是不连续的，这就造成了系统在不同的控制下输入时，因来回高速切换函数会引起“抖振”现象。滑滑模模控控制制三、三、智能车辆的滑模跟踪控制器设计智能车辆的滑模跟踪控制器设计实际中运行的整个系统不能准确的按构建的切换函数切换 ，系统本身存在的惯性、滞后、检测误差等因素造成了抖振现象滑模控制是利用开关函数进行控制的控制方法。当系统状态达到一定的值后，不断切换工作状态，在切换的过程其在滑模

4、面附近来回抖动这种现象称为抖振。前人的经验总结几种削弱“抖振”的方法：边界层法、趋近律法、神经变结构控制、切换控制法等，取得了较好的控制效果。抖振现象产生原因优化方法 引理1对任意 且 ，有 (当且仅当x=0时“=”成立)。 根据引理1根据Lyapunov函数： 假设 则有：又因为 (当且仅当vrye=0时“=”式成立)得： 可得结论：只要xe收敛到0且e收敛到 那么整个系统状态ye收敛到0。 根据该结论 ，设计切换函数为：滑模控制器的设计滑模控制器的设计Rxx 0 arctan sinxxx 2e21yVyere,arctanyverereeee arctan sinyvyvxyyyJ0)a

5、rctan(sin(ereryvyv0.yV)arctan(eryv)arctan(21ereeyvxsss(3) 最后设计滑模控制器，令s10，s20即实现xe收敛到零且e收敛到 。从而实现ye0和e0。 取等速趋近率为减弱抖振用连续的函数为切换函数：)arctan(eryv 0,sgn.ss2, 1|.issksiiiii令 由式(2)和(3)得：)arctan(eryv)sin(cos.2.1.ereerrrerevxyvvvvyssseeererrrerexysskvyvvsskvyvq1|sin|cos2222.1111最终得控制律为：(4)其中2211erreereryvvyyvy

6、v，四、四、 控制器在控制器在MATLABMATLAB的仿真的仿真初始条件(x, y, )期望状态(vr, r)控制器参数(k1, k2, 1, 2)(1,-1,pi/6)(8,6,-pi/3)(2,0)(2,sint)(6,6,0.02,0.02)(6,6,0.02,0.02) 文件使用COMMAND运行文件，通过调用编写好的指令来实现控制器仿真。根据源代码在MATLAB中，我们选取如下参数：(a)位姿误差变化曲线(b)直线轨迹跟踪结果(c)理想、实际航向角变化曲线(d)控制量的变化曲线参考轨迹是直线的小误差条件下智能车轨迹跟踪(a)位姿误差变化曲线(b)曲线轨迹跟踪结果(c)理想、实际航向

7、角变化曲线(d)控制量变化曲线参考轨迹是曲线的大误差条件下智能车轨迹跟踪 以上的直线和曲线轨迹跟踪仿真结果图可以看出，不管是任何初始条件（包括初始位置选择、轨迹类型的选择），智能车在所设计的控制器下都能够实现极短时间内（图示小误差在2秒内，大误差在5秒内）实现跟踪的轨迹逐渐收敛于参考轨迹。使智能车位姿误差逐渐减小直至到零，这表明了控制器的设计具有良好的跟踪效果。五、五、 总结与不足总结与不足1、学习滑模控制的基本理论后，构建了智能车的运动模型由此推导出了位姿误差微分方程。以上述理论为基础设计出滑模控制器，能够满足我们对轨迹跟踪的要求。2、采用MATLAB中的滑模控制模块进行编写源程序，把设计的智能车辆放在其中进行仿真，仿真结果表明了控制器的工作状况良好。1、未能对智能小车进行实质性的研究，对此还需要进一步学习和掌握；2、滑模变结构控制是一门比较深入的理论课程，本文只是粗略应用，但对于如何更好地控制其中参数并未涉及。3、对MATLAB本身还有许多其他的功能都未涉及，如可以利用Simulink来仿真，是否能用其他方式得到更好地效果，需进一步探究；4、本文写作目的是能够将智能车的控制