|
控制思想 该模块的程序框图如图 4.5 所示。车模在行驶过程中不断采样赛道信息，并通过分 析车模与赛道相对位置判断车模所处赛道路况，是弯道还是直道，弯道时是左转还是右转。直道时小车舵机状态保持不变，弯道时左转或右转，计算转弯半径。我们所用舵机的标准PWM周期为20ms,转动角度最大为左右90度，PWM调制波如图7.2所示。 当给舵机输入脉宽为0.5ms，即占空比为0.5/20=2.5%的调制波时，舵机右转90度；当给舵机输入脉宽为1.5ms，即占空比为1.5/20=7.5%的调制波时，舵机静止不动；当给舵机输入脉宽为2.5ms，即占空比为2.5/20=12.5%的调制波时，舵机左转90度。可以推导出舵机转动角度与脉冲宽度的关系计算公式为： 注：其中t为正脉冲宽度（ms）；θ为转动角度；当左转时取加法计算，右转时取减 法计算结果。 当我们根据赛道弯度计算出转动角度以后便可以根据舵机的参数计算出脉冲宽度，控制舵机转动，舵机转角与PWM脉宽关系如表4-1所示 。
在具体操作中PWM调制波的周期可以设置在20ms左右一定范围内，比如设置为10ms 或是30ms均可以使舵机正常转动，但是设置周期较长时，系统延迟时间较多，舵机转向会出现滞后，导致赛车冲出跑道；设置周期如果过短，系统输出PWM 调制波不稳定，舵机转动也会受影响，不能实现赛车的精确转向。经过反复测试，最终把输出 PWM 调制波周期设定为13ms。 运行电机的转速以及舵机的转角，在软件上都是通过对PWM 波占空比进行设置来相应控制的。前面提到，舵机转角控制需要将两个八位寄存器合成为一个十六位寄存器。程序中的舵机位置信号，当PWM调制波周期设为13ms时，因为总线频率为24MHz,用时钟SB，可计算得到16进制参数为9870H，舵机中间位置时占空比16进制参数为1680H，要分配给PWM6和7，分配时这2个端口的赋值必须是16进制，那么PWM模块初始化赋值为 PWMPER6= 0x98，PWMPER7= 0x70，PWMDTY6= 0x16，PWMDTY7= 0x80，因此这就牵涉到如何将1个十进制数分配为2个十六进制数问题。有2种方案，一种是除法取余，另一种是移位操作，前者编译生成的代码比后者要多，所以采用移位操作来实现，即取高位时 与0xFF00先作“&”计算，然后将所得到的数向右移8位（>>8），即可取得高8位；同理，取低8位时只要与0x00FF作“&”计算即可。 | 
[复制链接]
发表于 2012-9-14 20:01:48
微信
收藏
转播
分享
顶
踩
提升卡
变色卡
抢沙发
