《智能车最佳路径寻找及其方法--曲率法》由会员分享，可在线阅读，更多相关《智能车最佳路径寻找及其方法--曲率法（6页珍藏版）》请在金锄头文库上搜索。
1、.-最正确路径寻找及其方法-曲率法 2一路径规划方法的选择一路径规划方法的选择我拟考虑使用一条曲线进展路径规划。我选择曲率法而不选择其他方法有如下考虑：1，从难易程度上面考虑，曲率法不是最简单的方法，但是它有其它方法不能到达的好处，我们通过计算车子每一点的曲率，首先可以反映跑道每一点的弯曲程度，而且，曲率还能反映我们车子经过该点的最大速度和最大向心加速度。 所以即便是我们采用其他方法进展控制，最后还是要回归到求跑道的曲率上面来。二最正确路径的寻找二最正确路径的寻找最正确路径的寻找不是随便找一条曲线作为运行路径， 而是特定的那一条曲线， 在任何赛道情况下，只能找到一条这样的路径，下面我就通过各种
2、赛道的图像来寻找最正确路径：情况一：弯道情况一：弯道红色曲线是规划出来的最正确路径，为重建出来的跑道所转过的角度，0 表示向左转，0 表示向右转。红色曲线与车子起始方向相切，且在满足不压两边跑道的情况下半径最短。设规划出来的路径半径为r，车子需要跑过 角度，车子起点为CarX,CarY,车子目前的速度为 v，以半径 r 为规划路径行进时的最大速度为Vmax，车子的向心加速度va0这个是在车子硬件，机械确定以后提前测出来的，为固定值保存在程序中，意思R就是通过半径为 R 的跑道时，允许的最大速度为v0 。所以车子在规划路径上跑时， 也就是在上图中红色路径上跑的时候， 允许的最大速度为：2. wo
3、rd.zl-.-Vmax a*r v0*rR在此段路程中花费的总时间为：t svr*rv0*Rv0*R*r所以得出 r 越小，总时间花的就越短。故车子应该尽量切道跑。又因为我们规划出来的路径不能压线， 由图分析可得， 我们只要保证我们规划出来的最远处的那个点不压线切靠近侧跑道那么根本可以保证我们规划出来的跑道不压线。由图中标注：a r*cosCarXb r*sinCarYa，b 应满足：LX19 a RX19LY19 b RY19在计算出上面的参数过后，就给舵机和电机赋值，舵机赋值为 1/r，r 可以反映出舵机偏转角的大小，r 越大，路径越平缓，舵机偏转就应该越小，r 越小，路径弯度越大，舵机
4、偏转就应该越大。然后在1/r 的根底上再乘以一个比例系数K，K 是通过实验调节出的一个适宜的值，参数调节适宜后，是会适应所有弯道的，并不只是适 用于当前弯道。电机的赋值采用控速的闭环控制法，保证车子以通过此弯道允许的最大速度Vmax跑过去。补充： 路径规划的时候还需要考虑到车子相对于跑道的偏向， 因为规划出来的路径必须与车子当前的方向相切， 否那么会是车子强制产生一个偏向角， 这种规划出来的路径是不可实现的， 并且在这种情况下也有可能会产生侧滑等等。 所以我们要计算出车身相对于跑道的偏向角度。通过几何关系我们知道计算这个量的前提是找到每一段规划路径的圆心坐标。情况二：小情况二：小 S S 或大
5、或大 S S和情况一中的弯道处理方式一样。. word.zl-.-情况三：直道情况三：直道直道情况一般是弯进直， 所以他的路径一般是靠近弯进直那个侧弯道的一边。 处理情况和弯道一样。如下图：. word.zl-.-三算法实现三算法实现1. 计算 是我们路径规划中其中之一的量，它的计算我们采用扇形的几何关系求出。经过测试，这种方法计算出来的 角较精准，且计算量简便，故予以采用。如下图：r r*cos2 td 2*r*sin2所以：dd2*sin2*sin*cos2t22令n sin2得：dd* 1n22*n2*n t所以有：(4t2d2)*n24td*nd2 0求解上面的方程得：n 4td 16
6、t2d24d2(4t2d2)2*(4t2d2)舍n 4td 16t2d24d2(4t2d2)2*(4t2d2). word.zl-.-故： 2*arcsin(n)；r d；2*n2.向心加速度计算对特定弯道进展测试，以不同的速度通过半径 R 固定的弯道，当在速度为 V 时开V2场出现侧滑，这最大速度V 对应 R，向心加速度a 。因为车子轮胎相对于跑道的R摩擦系数不变，故在任何位置a 的值不变，保存a 的值，在其他跑道中，电机所给的最大速度Vmaxa*R。3.寻找圆心坐标我们需要求解我们规划出来路径的圆心坐标， 这样我们就能求得我们规划路径的方程，然后就能方便的判断我们的规划路径是否压线两边跑道
7、 。而我们现在的量只有起始点和终止点的坐标，设为x1,y1;x2,y2 。还有一个量就是我们规划路径的半径r，通过这三个量我们需要求解出规划路径的圆心坐标。 由于规划出来的路径是理想的，所以圆心坐标也是相当准确的。我们采用的方法是通过过两个点作以半径为 r 的两个圆，相交的两个点即为圆心坐标，如下列图所示：联立方程组：(x x1)2(y y1)2 r2(x x2)2(y y2)2 r2令d2 (x1 x2)2(y1 y2)2. word.zl-.-求解上式，得：1.x1!=x2 & y1!=y21.x1!=x2 & y1!=y24r2*(x1 x2)2(x1 x2)4d2)(y1 y2)y 2d2x 4r *(x1 x2) (x1 x2) d )(y2 y1)(x1 x2)*2dx1 x2222422.x1=x2x1=x2y (y1 y2)24r2d2x 2 x13. 3.y1=y2y1=y2x (x1 x2)24r2d2y 2 y1sigsigk k1 10 01 1X X 大大X X 小小Y Y 小小Y Y 大大X X 大大X X 小小0 0Y Y 大大Y Y 小小4.求直线方程车身方向直线：Y 1Tan(phi)*X CarY CarXTan(phi)与车身方向垂直的直线：Y Tan(phi)*X CarY Tan(phi)*CarX. word.zl-
