文档介绍：引言智能车高速入弯时,若地面附着力不足以提供转向向心力,将导致侧滑等危险发生。-智能车能否以较高半均车速安全驶过弯道,取决于路径规划基础上的转向半径与车速的合理匹配。D摄像头视野内的道路进行路径规划。局部优化算法包括人工势场[1]、模糊[2]、遗传[3]、蚁群[4]及粒子群算法[5]等,它们对硬件实时性要求较高。本文考虑智能车和道路儿何尺寸,D的位置与姿态,以及弯道类型等因素,建立了简单可行口满足实时性要求的局部路径规划算法,进而确泄了智能车高速稳定行驶的转向角和车速。局部路径规划算法流程控制程序流程如图1所示。首先,采集图像信号并去噪、提取道路中心线;然后,计算并返冋图像失真校止后的世界坐标;第三,计算并返回偏航计算后的当前时刻世界坐标;第四,计算并返回路径规划算法得到的目标转向半径;最后,查询预储存在ROM内的舵机转角和行驶速度,并调用执行程序,完成对脅能车的控制。<[初竣化>凋川“图儉诒狂子程宇返冋校正世界知小関川w/•法于程厅”I返刨当说在號坐林IWHJ“胱机応j■拧饥用皆和“D输出标准PAL制信号,LM1881视频同步分离芯片提取行同步和场同步信号,进而触发单片机图像采集屮断,通过A/D输出图像分辨率为320x600,考虑单片机内存和运算速度限制,D传感器标定假设道路为水平面,D传感器,D图像坐标系与世界坐标系的对应关系。如图2所示,图像坐标系原点位于图像左下角,坐标轴u、D图像平面的横向和纵向;世界坐标系原点0’位于智能车儿何中心,X'和y*轴分别为智能车横向与纵向对称面在水平面的投影线;屮间坐标系原点01’位于视场最近端中点,xl和yl轴分别为中间坐标系所在平面的横向和纵向。图2中各参数的物理意义与儿何尺寸数值见表1。D传感器标走中養数符号、D传空备祝场盘远空距皆能主;D传思器磁最远宾兗盘主妆光学中心02距坦五輕复Sftot学中心02距O筑燮际疾祈三平面距真169**********."D摄像头存在俯仰角以及镜头加工工艺和装配精度等因素的影响,采集的图像存在梯形和桶形失真,故基于小孔成像原理校正失真[6]:视野同一点在图像坐标系与中间坐标系的坐标分别为(u,v)^(xl,yl),通过实验标定二者关系如卜:x=a{u•A;y严恥-1时-恥-IkI](】)式中al,bl为实验标定的拟合系数;a[v-l]zb[v-l],c[v-l]为实验标定的拟合向量的第v个元素(即拟合系数)。依据图3所示的几何关系,可得到坐标(xl,yl)与(X:W)的相应关系。D传感器采集图像开始到单片机输出控制量结朿经历一定程序执行时间,在这段时间内,聖能车行驶一定距离并转过一定角度,故为了针对当前吋刻褂能车相对道路的位置及姿态输出控制量,需将道路中心线各点坐标进行坐标转换,如图4。4侷航算法坐标转换山车速,转向半径及稈序执行时间可求出智能车世界坐标系在程序执行时间内所转过的角度为:0=(0x/=~R式中3为智能车瞬时角速度,t为程序执行时间,V为智能车行驶速度,R为转向半径。故新坐标系的两坐标轴在原坐标系内方程分别为:x轴:xfian8+y1-/?tan0=0⑶一八an®-/?( cos9-1)=0(4)利用点到直线距离公式,可求出任意一点P'(x',y‘)坐标转换后的新坐标P(xzy)o目标转向半径确定智能车行驶道路为中心引导线两侧等宽且总宽为Wr的带状区域,如图5。道路中心线是由直线和曲率不等的圆弧组成的。直道行驶时,會能车转向轮转角为零,完全巡线即可。在弯道行驶时,对智能车给定一个转向轮转角,其行驶轨迹是一段圆弧,故确定智能车目标路径即确定一个目标转向半径,以确保智能车在不触及道路边界的条件下以更短的时间通过弯道。弯道形式大体上可以分为单个弯道和连续弯道两类。5道路几何模型对于单个弯道,当智能车以一定转向半径过弯时,向心力方程为:f=mv2/r式中:F为地面对智能车提供的向心力,M为智能车质量,V为智能车行驶速度,R为转向半径。从(5)式中可知,当向心力一定吋,最高稳定车速与转向半径成开平方关系:(6)式中:kl为比例系数。转向半径与路程成比例关系:S=k2R式中:S为行驶路程,k2为比例系数。则行驶时间:(8)因此,在单个弯道上,选择较小的转向半径可以减少行驶时间。连续弯道山几段半径相同或不同的圆弧组成,当两段圆弧内切时,可近似看成曲率渐变的一段圆弧,当两段圆弧外切时,,减少行驶路程,进而减少行驶时间。.ch由一段圆弧上三点坐标,通过求两条弦线屮垂线交点的方法可求出圆心坐标,如图6所示,其中Pl(xlzyl),P2(x2,y2),P3(x3zy3)为经过偏航算法坐标转换后一段圆弧上的三点,01(x0,yO)为圆弧圆心。计算可得:Y二4•力2+仏°"