舵机与霍尔传感器的使用

2 1 舵机工作原理舵机在 6 V 电压下正常工作，而大赛组委会统一提供的标准电源输出电压为 72 V，则需一个外围电压转换电路将电源电压转换为舵机的工作电压 6 V。图 2 为舵机供电电路。舵机由舵盘、位置反馈电位计、减速齿轮组、直流动电机和控制电路组成，内部位置反馈减速齿轮组由直流电动机驱动，其输出轴带动一个具有线性比例特性的位置反馈电位器作为位置检测。当电位器转角线性地转换为电压并反馈给控制电路时，控制电路将反馈信号与输入的控制脉冲信号相比较，产生纠正脉冲，控制并驱动直流电机正向或反向转动，使减速齿轮组输出的位置与期望值相符。从而达到舵机精确控制转向角度的目的。舵机工作原理框图如图 3 所示。2 2 舵机的安装与调节舵机的控制脉宽与转角在-45 +45 范围内线性变化。对于对速度有一定要求的智能车，舵机的响应速度和舵机的转向传动比直接影响车模能否以最佳速度顺利通过弯道。车模在赛道上高速行驶，特别是对于前瞻性不够远的红外光电检测智能车，舵机的响应速度及其转向传动比将直接影响车模行驶的稳定性，因此必须细心调试，逐一解决。由于舵机从执行转动指令到响应输出需占用一定的时间，因而产生舵机实时控制的滞后。虽然车模在进入弯道时能够检测到黑色路线的偏转方向，但由于舵机的滞后性，使得车模在转弯过程中时常偏离跑道，且速度越快，偏离越远，极大限制车模在连续弯道上行驶的最大时速，使得车模全程赛道速度很难进一步提高。为了减小舵机响应时间，在遵守比赛规则不允许改造舵机结构的前提下，利用杠杆原理，采用加长舵机力臂的方案来弥补这一缺陷，加长舵机力臂示意图如图 4 所示。图 4 中，R 为舵机力臂； 为舵机转向角度；F 为转向所需外力； 为外力同力臂的夹角。在舵机输出盘上增加长方形杠杆，在杠杆的末端固定转向传动连杆，其表达式为：加长力臂后欲使前轮转动相同角度时，在舵机角速度 相同的条件下舵机力臂加长后增大了线速度 v，最终使得舵机的转向角度 减小。舵机输出转角 减小，舵机的响应时间 t 也会变短。同时由式(1) 可推出线速度口增大后，前轮转向所需的时间 t 相应也会变短，其表达式为：t=dsdv (2)此外，当舵机连杆水平且与舵机力臂垂直时，得到力矩 M，可由式(3)表示：M=FRsin (3)说明当舵机连杆和舵机力臂垂直时 =900，此时 sin 得到最大值。在舵机力臂 R 一定和外力 F 相同条件下，舵机产生的力矩 M 最大，实现前轮转向的时间最短。在实际调试车模时发现，这种方法对提高舵机的响应速度也具有局限性：当在舵机输出力矩相同的条件下，力臂越长，作用力越小。在转向遇到较大转向阻力时，会影响舵机对转向轮控制的精度，甚至使转向轮的响应速度变慢；另外，舵机机械结构精度产生的空程差也会在力臂加长中放大。使得这一非线性环节对控制系统的不利影响增大。因此，舵机安装的高度具有最佳范围，仍需通过试验反复测试。3 霍尔传感器的应用由于在赛前比赛赛道的几何图形是未公开的。赛前车模训练的路线与实际比赛的路线相差甚远，若车模自适应性调整不好，车模会在连续弯道处频繁的偏转。赛道的变更给车模的适应性和稳定性带来了一定挑战。为了使得车模能够平稳地沿着赛道行驶，除控制前轮转向舵机以外，还需要控制好各种路况的车速，使得车模在急转弯和下坡时不会因速度过快而冲出赛道。因此，利用霍尔传感器检测车模瞬时速度，实现对车模速度的闭环反馈控制，小车的 PC9S12 控制板能够根据赛道路况变化而相应执行软件给定的加速、减速、刹车等指令，在最短的时间内由当前速度转变为期望的速度，使得车模快速平稳行驶。基于霍尔效应，固定在转盘附近的霍尔传感器便可在每个小钢磁通过时产生一个相应的脉冲，检测出单位时间的脉冲数，便可知被测转速。霍尔传感测速装置示意图如图 5