飞思卡尔智能车舵机与测速控制设计

《飞思卡尔智能车舵机与测速控制设计》由会员上传分享，免费在线阅读，更多相关内容在行业资料-天天文库。

1、飞思卡尔智能车舵机和测速的控制设计与实现2．1舵机工作原理   舵机在6V电压下正常工作，而大赛组委会统一提供的标准电源输出电压为7．2V，则需一个外围电压转换电路将电源电压转换为舵机的工作电压6V。图2为舵机供电电路。   舵机由舵盘、位置反馈电位计、减速齿轮组、直流动电机和控制电路组成，内部位置反馈减速齿轮组由直流电动机驱动，其输出轴带动一个具有线性比例特性的位置反馈电位器作为位置检测。当电位器转角线性地转换为电压并反馈给控制电路时，控制电路将反馈信号与输入的控制脉冲信号相比较，产生纠正脉冲，控制并驱动直流电机正向或反向转动，使减速齿轮组输出的位置与期望值

2、相符。从而达到舵机精确控制转向角度的目的。舵机工作原理框图如图3所示。2．2舵机的安装与调节   舵机的控制脉宽与转角在-45°～+45°范围内线性变化。对于对速度有一定要求的智能车，舵机的响应速度和舵机的转向传动比直接影响车模能否以最佳速度顺利通过弯道。车模在赛道上高速行驶，特别是对于前瞻性不够远的红外光电检测智能车，舵机的响应速度及其转向传动比将直接影响车模行驶的稳定性，因此必须细心调试，逐一解决。由于舵机从执行转动指令到响应输出需占用一定的时间，因而产生舵机实时控制的滞后。虽然车模在进入弯道时能够检测到黑色路线的偏转方向，但由于舵机的滞后性，使得车模在转

3、弯过程中时常偏离跑道，且速度越快，偏离越远，极大限制车模在连续弯道上行驶的最大时速，使得车模全程赛道速度很难进一步提高。为了减小舵机响应时间，在遵守比赛规则不允许改造舵机结构的前提下，利用杠杆原理，采用加长舵机力臂的方案来弥补这一缺陷，加长舵机力臂示意图如图4所示。   图4中，R为舵机力臂；θ为舵机转向角度；F为转向所需外力；α为外力同力臂的夹角。在舵机输出盘上增加长方形杠杆，在杠杆的末端固定转向传动连杆，其表达式为：      加长力臂后欲使前轮转动相同角度时，在舵机角速度ω相同的条件下舵机力臂加长后增大了线速度v，最终使得舵机的转向角度θ减小。舵机输出转

4、角θ减小，舵机的响应时间t也会变短。同时由式(1)可推出线速度口增大后，前轮转向所需的时间t相应也会变短，其表达式为：t=ds／dv        (2)   此外，当舵机连杆水平且与舵机力臂垂直时，得到力矩M，可由式(3)表示：M=FRsinα          (3)   说明当舵机连杆和舵机力臂垂直时α=900°，此时sinα得到最大值。在舵机力臂R一定和外力F相同条件下，舵机产生的力矩M最大，实现前轮转向的时间最短。   在实际调试车模时发现，这种方法对提高舵机的响应速度也具有局限性：当在舵机输出力矩相同的条件下，力臂越长，作用力越小。在转向遇到较大转

5、向阻力时，会影响舵机对转向轮控制的精度，甚至使转向轮的响应速度变慢；另外，舵机机械结构精度产生的空程差也会在力臂加长中放大。使得这一非线性环节对控制系统的不利影响增大。因此，舵机安装的高度具有最佳范围，仍需通过试验反复测试。3霍尔传感器的应用   由于在赛前比赛赛道的几何图形是未公开的。赛前车模训练的路线与实际比赛的路线相差甚远，若车模自适应性调整不好，车模会在连续弯道处频繁的偏转。赛道的变更给车模的适应性和稳定性带来了一定挑战。为了使得车模能够平稳地沿着赛道行驶，除控制前轮转向舵机以外，还需要控制好各种路况的车速，使得车模在急转弯和下坡时不会因速度过快而冲出

6、赛道。因此，利用霍尔传感器检测车模瞬时速度，实现对车模速度的闭环反馈控制，小车的PC9S12控制板能够根据赛道路况变化而相应执行软件给定的加速、减速、刹车等指令，在最短的时间内由当前速度转变为期望的速度，使得车模快速平稳行驶。   基于霍尔效应，固定在转盘附近的霍尔传感器便可在每个小钢磁通过时产生一个相应的脉冲，检测出单位时间的脉冲数，便可知被测转速。霍尔传感测速装置示意图如图5所示。显然不是安装小钢磁越多越好，在一定的条件允许范围内，磁性转盘上小钢磁的数目越多，确定传感器测量转速的分辨率也越高，速度控制也越精确。一般4～8片是最佳范围。4结束语   为了参加

7、第四届“飞思卡尔”杯全国大学生智能汽车竞赛，此设计方案在校级代表队资格选拔赛中表现完美，最终跑出19．7s的好成绩，成功入选。实践证明了智能车舵机控制转向和霍尔控制测速优化方案具有可行性和实用性。　　检查原图（大图）　　加长力臂后欲使前轮转动类似角度时，在舵机角速度ω类似的条件下舵机力臂加长后增大了线速度v，结尾使得舵机的转向角度θ减小。舵机输出转角θ减小，舵机的照应时间t也会变短。同时由式(1)可推出线速度口增大后，前轮转向所需的时间t相应也会变短，其表达式为：t=ds／dv　　　　　　　　(2)　　此外，当舵机连杆水平且与舵机力臂垂直时，得到力矩M，可由式

8、(3)示意：M=FRsinα