弯道策略(飞思卡尔).docx

(第二届 中南民族)10.3 整体策略分析在确定的赛道上，对于机械确定的车辆，总有一个理论的最高速度。能否接近这个速度就取决于控制策略的好坏。采用直线高速弯道低速还是直线、弯道都采用中速，在不同的赛道上可能各有优点。与其采用一个适应各种赛道的控制策略不如使用拨码开关，根据现场不同的情况来人为调节不同的策略。10.1 急弯急弯在这里指半径65cm以下，圆弧超过90度的弯道。急弯是限制智能车速度的主要因素。急弯处，摄像头将会发现车身与赛道之间的偏差，这种偏差的发现有一个过程，总是先看到较小的偏差，而后看到较大的偏差。在看到较小偏差时（图中状态1）采用低速，大幅度偏差（图中状态2）时采用中速。在直线上采用高速。这种速度分配比直线高速，小偏差中速，大偏差低速有更好的急弯通过性能（急弯通过性能指按照规则能够顺利通过弯道的最快速度。速度越快，通过性越好）。 10.2 小蛇形弯小蛇形弯指圆弧切点与中心线之间的距离小于8cm的弯道。如下图所示。目的是在小蛇形弯道直线通过。 采用区间加权平均的办法处理蛇形弯。区间指只有偏差在设定的范围以内才作加权平均处理。使用九行数据作加权平均。实际加权平均的效果由于摄像头可视范围的限制，并不是很明显。能够直线行驶快速通过蛇形弯道是因为，在区间范围以内将伺服电机的转动角度给的很小。 在实际的测试中，对于偏差大于10cm的蛇形弯就不会当作直线来处理了。（第三届 武汉科技 首安）4.2 转角的控制对于舵机的控制，我们采用开环控制，由于舵机的控制精度高，一个PWM占空比对应一个角度，因此开环控制的效果较好。我们采用的是PD控制，因为这样可以让舵机的控制速度更快，输入黑线位置和黑线位置的变化率，通过分段比例控制输出相应的PWM值。因为小车处于弯道和直道的转向模型不同，统一的比例带过大会导致小车振荡，过小导致最大控制量偏小，小车转向不足，过弯时冲出赛道。使用分段比例控制既方便又可以解决以上两种问题。 当小车处于直道时，最中间的光电管检测到信号，当处于不同曲率的弯道时，上排两侧不同的光电管将检测到信号。所以，根据上排光电管检测到的不同信号，可以判断出小车所处的位置。然后，根据小车的位置再相应的调整舵机。调整舵机的原则是：小车处于直道，则摆正舵机。小车处于弯道的曲率越大，则将舵机的转角摆的越大。除此之外，小车还会遇到黑色交叉线的特殊情况，对此，本系统将保持原有的小车方向与速度，使小车不受交叉线的干扰。如果小车转过的弯过大，则可能使上排光电管全部偏离黑色轨迹，从而没有一个光电管检测到黑线，这时本系统将会把舵机转至最大角，让小车急转驶回黑线，同时，将速度降至最低，防止小车冲出轨迹。（PPT教程里的）6.3.4 控制策略及控制算法v 为保证小车一直沿着黑色引导线快速行驶，系统主要的控制对象是小车的转向和车速。即应使小车在直道上以最快的速度行驶。在进入弯道的过程中尽快减速，且转向要适合弯道的曲率，确保小车平滑地转弯，并在弯道中保持恒速。从弯道进入直道时，小车的舵机要转至中间，速度应该立即得到提升，直至以最大的速度行进。为实现上述控制思想，可以采用不同的控制方法来控制小车的转角和速度。 v转角的控制v 为了使舵机迅速地转至期望的角度，先通过前排发射接收光电管检测黑线，当小车处于直道时，最中间的光电管检测到信号，当处于不同曲率的弯道时，前排两侧不同的光电管将检测到信号。所以，根据前排光电管检测到的不同信号，可以判断出小车所处的位置。然后，根据小车的位置再对调整舵机进行相应的调整。 v 调整舵机的原则是：小车处于直道时，摆正舵机。小车处于弯道的曲率越大，则舵机转角越大。除此之外，小车还会遇到黑色交叉线的特殊情况，对此，本系统将保持小车原有的方向与速度，使小车不受交叉线的干扰。如果小车转过的弯过大，则可能使前排光电管全部偏离黑色轨迹，从而没有一个光电管检测到黑线，故应使舵机保持原角度，让小车急转驶回正道。同时，将速度适当降低，防止小车冲出轨迹。 v 这里采用比例和微分相结合的PD控制方法。 v （1）比例控制：通过前面提取的position与中心位置相减得到比例控制的偏差量，然后再根据偏差量的大小采用比例系数控制舵机转向。 v （2）微分控制：通过存储连续20次采样所得到的黑线位置，可以计算出相应的黑线位置变化率，进而根据这个变化率的大小，来调整微分系数，以控制舵机转向。 4.2.3.2 最小转弯半径根据比赛规则，赛道的最小转弯半径为500mm，所以需要测试在在没有侧滑的情况下赛车的前轮转向半径能否满足该条件。由于机械限位，PWM 波脉宽设置范围在（1.2-1.8）,经过实际测量，在设定在两端极限的情况下，没有发生侧滑。注：测试是在驱动电机PWM 为80的情况下进行的。因此系统最小转弯半径为1.8ms 脉宽和1.2ms 脉宽下的左转最小转弯半径约为421mm，右转为395mm，可满足实际要求。4.3 程序代码运行电机的转速以及舵机的转角，在软件上都是通过对 PWM 波占空比进行设置来相应控制的。前面提到，舵机转角控制需要将两个八位寄存器合成为一个十六位寄存器。要将程序中的舵机位置信号，比如6000，要分配给PWM0 和1，分配时这2个端口的赋值必须是16 进制，比如6000 的十六进制为0x1770，那么赋值时就必须为PWMDTY0= 0x17，PWMDTY1= 0x70，因此这就牵涉到如何将1 个十进制数分配为2 个十六进制数问题。有2 种方案，一种是除法取余，另一种是移位操作，前者编译生成的代码比后者要多，所以采用移位操作来实现，即取高位时与0xFF00 先作“&”计算，然后将所得到的数向右移8 位（8），即可取得高8 位；同理，取低8 位时只要与0x00FF 作“&”计算即可。程序代码如下：PWMCTL_CON01 = 1; / PWM01 合并 16 btPWMPRCLK = 0x33; / A=B=32M/8=4MPWMSCLA = 100; / SA=A/2/100=20kPWMSCLB = 1; / SB=B/2/1 =2000kPWMCLK = 0b00011100; / PWM0,1-A; PWM2,3-SB; PWM4-SAPWMPOL = 0xff; / 位极性1 DutyHigh TimePWMCAE = 0x00; / 对齐方式左对齐PWMPER0 = 0x9c; /PWMPER1 = 0x40; / 20000 = 0x4e20; Frequency=A/20000=200HzPWMDTY0 = 0x19; /PWMDTY1 = 0x00; / 舵机DTY 初始值PWME_PWME1 = 1; / 舵机enable（第四届 北科大）4.2 弯道策略分析在车辆进弯时，需要对三个参数进行设定：切弯路径、转向角度、入弯速度。其中，切弯路径主要决定了车辆是选择内道过弯还是外道过弯。切内道，路经最短，但是如果地面附着系数过小会导致车辆出现侧滑的不稳定行驶状态，原因是切内道时，曲率半径过小，同时速度又很快，所以模型车需要的向心力会很大，而赛道本身是平面结构，向心力将全部由来自地面的摩擦力提供，因此赛道表面的附着系数将对赛车的运行状态有很大影响。切外道，路径会略长，但是有更多的调整机会，同时曲率半径的增加会使得模型车可以拥有更高的过弯速度。转向角度决定了车辆过弯的稳定性。合适的转向角度会减少车辆在转弯时的调整，不仅路径可以保证最优，运动状态的稳定也会带来效率的提高，减少时间。在考虑转向角度设置时需要注意以下几个问题：对于检测赛道偏移量的传感器而言，在增量较小时的转向灵敏度；检测到较大弯道时的转向灵敏度；对于类似S 弯的变向连续弯道的处理。对于入弯速度的分析，应该综合考虑路径和转向角度的影响。简单而言，我们会采取入弯减速，出弯加速的方案，这样理论上可以减少过弯时耗费的时间。然而，在过去几届比赛中，通过观察各参赛车对弯道的处理后，我们发现并不是所有人都选择了相同的方案。正如前面说到的那样，不联系路径和转向角度，只是单纯地分析过弯速度，会造成思路的局限甚至错误。例如，在不能及时判断入弯和出弯的标志点就采取“入弯减速、出弯加速”的方案，会出现弯道内行驶状态不稳定、路径差，同时出弯加速时机过晚，一样会浪费时间。所以现在本系统参考实际驾驶时的一些经验，对过弯速度的处理方式确定为：入弯时急减速，以得到足够的调整时间，获得正确的转向角度；在弯道内适当提速，并保持角度不变，为出弯时的加速节约时间；出弯时，先准确判断标志，然后加速，虽然会耗费一些时间，但是面对连续变向弯道可以减少判断出错的概率，保证行驶状态的稳定性，而且弯道内的有限加速对后面的提速也有很大的帮助。综合考虑用可以接收的额外时间换回行驶稳定性还是值得的。下面以常见的几种弯道转角处理方式解释各方案的优缺点，其中，横坐标表示由传感器采集回来的赛道中心线相对赛车中心线的偏移量，纵坐标表示转角大小。a 图表示偏移量与转向角度呈线性关系，在计算及程序编写上都比较简单，也可以实现控制赛车行驶的目标，但是由于规则制定比较简单，对赛车实际行驶状态的分析不够全面，所以在实际应用时不能简单套用。b 图表示的是在赛车略微偏离赛道中心时，不要对行驶方向作太大调整，而是在当偏离度大到预定值时急速调整转角以保证过弯的及时，同时在以判断出是急弯后，也不要进行大的变动，因为此时转角的值已经很大，仅需对舵机进行微调就可以保证方向的正确性。这种方案的优点是综合考虑了赛车对个弯道的适应程度，同时保证了在直线行驶时的稳定性，和抗干扰性，但是对急弯的响应可能不够及时，这是该方案的主要缺点。c 图表示的对弯道的处理方案与B 图恰好相反，它提高了相应灵敏度，降低了抗干扰性，对于多弯道，且弯道曲率半径较小的赛道有比较好的适应性。d、e 图是两种比较特殊的处理方案，它们不能用于赛车的全程控制，只是考虑到赛车的实际运行特点对某部分的偏移量有特别要求是使用。对于传统四轮车辆，转向时前轮有比较严格的角度关系，而它们的得到是由转向系统决定的。这样两套系统都对某个值做出了限制，必然会有矛盾，在车由0 度转到最大转角时，并不是每时每刻都能同时满足两种条件的限制，那么为了赛车行驶的稳定性，我们可能会在小范围内对转角波动，以得到附近最合适的转角值，减小矛盾。4.3 弯道策略制定在智能车比赛中，我们使用的是通用二输入一输出系统，其中两个输入量是中心线偏移量，和相邻两次检测的偏移量差值；输出量可以分别选用舵机转角值和速度输出值做两套系统。中心线偏移量的隶属度函数表为9 级： 速度规则表为：速度精确值为：转角规则表为：转角精确值为：（第三届 上海）5.3 控制策略 5.3.1 控制目标 只有合理的速度分配和转角控制才能将车模的性能发挥出来，这不是多少半径的弯就给多少速度那么简单。飞思卡尔智能车比赛也是一种赛车比赛，只不过将赛车手换成了自动控制系统。在赛车比赛中，车速并不是一切，要想跑出好的成绩，还需要一条合理的行车线。因此，我们的目标不仅是让车模能加到高速，并且要优化车模的走线。在我们长期的测试中，以下赛道特征是最容易出问题的。1. 半径500mm 60S弯2. 半径500mm 120S弯3. 半径500mm 270弯4. 半径500mm 发夹弯5. 大半径弧线 在测试中我们发现，车模只要能正常通过最小半径的弯和最大半径的弯，其余半径的弯道多半不会有问题，变半径的弯道也是如此。在小半径急弯中，车模容易减速不及时而冲出跑道，而在大半径弯中，车模容易切弯过度而冲出跑道。因此，以上几个赛道特征是有代表性的。我们的对于以上赛道特征的控制目标如下： 1. 60S弯: 全速直走。2. 120S弯: 保持中速切线。这里的难点在于要走切线，但不能过度切线。3. 270弯: 速度降到最低，略微切线。这里切的程度与车模的机械性能有很大关系，尽管在270弯中，沿线走不一定比切线走要慢，但若车模冲得太远，图像中容易丢失黑线，对图像处理不利，因此最好能把行车线控制在小圈以内。4. 发夹弯： 速度降到最低，沿线通过。我们认为这是所有赛道特征里最严峻的弯道，因此只要能通过发夹弯，其它急弯都不是问题。5. 大半径弧线: 高速切线通过下面将介绍我们速度和舵角的控制策略及其所达到的效果。（第三届 东大猎鹰）3.3方向控制策略根据光电传感器采集回来的道路信息，进行存储、分析和计算。当不同位置的传感器检测到黑线，舵机的PWM模块就给不同的值，使舵机摆动不同的角度。由前面得到的道路状态信息，而增加相应权值不一样的摆动角度。当智能车在直线上高速行走的时候，中间4个传感器检测到黑线的舵机摆角，比原来基数的舵机摆角更加小。当智能小车的舵机摆角不正，跑直道有振荡的时候，这样可以使小车在直道高速运行的时候，左右来回振荡变小。当