不管是小马达,还是大马达,嗯,也就是电机,相信大伙伴们也不会陌生。四驱车是一种很优秀的玩具,从老周小时候就开始流行(动画片《四驱兄弟》估计很多大朋友都看过),直到现在还能看到很多卖四驱车的。为啥会想起四驱车呢?因为小时候玩四驱车让老周认识了很多奇葩马达,什么“红魔鬼”、“蓝芯”、“紫魔鬼”……也不知道是什么逻辑的命名方式,反正那时候大家都这么叫。
这些马达的结构有一个转轴,绕有红色或橙色的线圈(记忆中是这些颜色),有四块磁铁。金属外壳,上部开有两个散热孔。整体形状有圆的也有扁的,许多遥控车的马达是圆的。还有一马达像个竹筒似的,一些太阳帽小风扇里面有。
一般的马达的特点,就是一通电就往一个方向转(正负接反它就反向转),但舵机比普通马达更好玩。360度的舵机与一般马达相似,加电后会往一个方向转动,信号线控制其转动方向和转速;不过我们常说的舵机一般是指 180 度的舵机,这种舵机可以通过信号线让它转动一定的角度,当到达指定的角度后舵机会停下来。
180 度舵机可以:
1、机器人各个关节的运动,可模拟人的关节活动。因为程序可以控制舵机转到指定的角度。
2、遥控小车可以用舵机来拐弯。
3、机械臂 / 机械爪。
4、制作可以转动的摄像头。
5、3D 打印的零部件。
……
只要需要控制转动方向的,都用得上。
舵机依据其工作负荷以及扭力可以有很多种,咱们用来开发做实验的,最好选 9 克舵机。尽管这种舵机力气不大,但是开发板可以直接供电,不用外加电源补电。就是这种,蓝色透明外壳的。
正因为外壳是透明的,所以你能看到里面有什么。当然了,你如果像老周这样喜欢搞破坏的,可以把拆开玩玩。
拆的时候最好戴个手套,毕竟这是电机,你拆过就知道,里面有很多润滑油的。装回去的时候要注意那几个减速齿轮,有的大伙伴一时冲动拆了,然后装不回去。虽然这种舵机一般几块钱一个,但你也不能这么浪费。
舵机里面主要这几个部件:
1、马达。这个肯定有的,不然怎么转。
2、电位器。不同角度会改变不同的电阻值,使控制板能驱动马达转多少圈。
3、控制板。
4、N 个减速齿轮。
上面只是了解一下舵机,接下来看重点——怎么控制角度。一般的教程会跟你说,通过 PWM 设置不同占空比来控制舵机转动角度。这并不算错,因为控制舵机确实是用 PWM 实现的。不过,这样说其实不准确。实际上,让舵机转动多少度是通过高电平的持续时间来控制的。
通常情况下,控制脉冲的周期时长是 20 毫秒,即 20000 微秒。故用PWM时,频率设定 50 Hz(1 / 0.02秒 = 50 Hz)。舵机识别高电平的时间范围为 0.5 ms 到 2.5 ms,即 500 us 到 2500 us。下图是老周盗来的动图。
这就是为什么PWM能控制舵机的原因,在 0.5ms 之前的时间舵机不关心,所以这段时间无论输出信号是高电平还是低电平都可以,因此关注的核心变为高电平什么时候关闭(变为低电平)。
如上图,如果高电平持续到 0.5 毫秒时变为低电平,则舵机旋转至 0 度。
如果高电平在 1.5 毫秒时关闭,则舵机旋转到 90 度。
如果高电平在 2.5 毫秒时关闭,舵机旋转至 180 度。
综上所述,将控制舵机的信号换算为PWM的占空比,需要准备以下条件:
1、周期时间长度,一般为 20000 us,换算为PWM频率为 50Hz。
2、高电平有效的持续时间,一般值为:min = 500us,max = 2500us。
3、500 - 2500 us,其时间段为 2500-500 = 2000us,用180度平分这2000微秒,即每一度角对应的时间为 2000 / 180 ≈ 11.11 us / deg。
综合一下,占空比可这样算:
假设要旋转 90 度,即占空比:
把公式翻译成中文,就是这样
有了上面的基础,写代码就好办了。这里老周写了一个测试程序,这个命令行程序可以通过输入命令来修改参数,这样方便大家做实验。命令帮助信息如下:
using static System.Console; static void ShowHelps() { WriteLine("{0,-15}{1}", "h", "显示帮助信息"); WriteLine("{0,-15}{1}", "x", "退出"); WriteLine("{0,-15}{1}", "d n", "设置周期(微秒)"); WriteLine("{0,-15}{1}", "t n", "高电平起始时间(微秒)"); WriteLine("{0,-15}{1}", "p n", "高电平结束时间(微秒)"); WriteLine("{0,-15}{1}", "a n", "角度"); WriteLine("{0,-15}{1}", "o", "发送脉冲信号"); WriteLine("{0,-15}{1}", "s", "停止脉冲"); WriteLine(); }
下面的代码是计算 1 度角对应的时间长度(微秒)。
static void ComputeMicroToAngle() { microForAngle = (maxMicrosec - minMicrosec) / 180.0d; }
minMicrosec 是高电平持续的最小时间:500us;maxMicrosec 是高电平持续的最大时间:2500us。
这几个变量的声明如下:
/// <summary> /// 高电平持续的最小时间,一般为 500us /// </summary> static int minMicrosec = 500; /// <summary> /// 高电平持续的最大时间,一般为 2500us /// </summary> static int maxMicrosec = 2500; /// <summary> /// 一度角对应的持续时间,单位为微秒(us) /// </summary> static double microForAngle = 0d;
主体代码如下,其余的可以下载源代码查看。
// 创建PWM通道实例 PwmChannel ch = PwmChannel.Create(0, 0); ShowHelps(); //运行后打印一次帮助信息 bool working = true; //用来跳出循环的标志变量 while(working) { Write(">>>"); // 读取键盘输入的一行文本 string line = ReadLine(); // 读取第一个字符 char first = line[0]; // 分析命令 switch(first) { case 'h': //显示帮助信息 ShowHelps(); break; case 'x': //跳出循环,退出程序 working = false; break; case 'd': //设置周期,一般是20000us ch.Frequency = ParseFreq(line[1..].Trim()); break; case 't': //设置高电平持续的最小时间 ParseMinMicrosecond(line[1..].Trim()); ComputeMicroToAngle(); break; case 'p': //设置高电平持续的最大时间 ParseMaxMicrosecond(line[1..].Trim()); ComputeMicroToAngle(); break; case 'a': //设置要旋转的角度 double angle = ParseAngle(line[1..].Trim()); ch.DutyCycle = ComputeDuty(angle, ch.Frequency); break; case 'o': //开始发送脉冲 ch.Start(); break; case 's': //停止发送脉冲 ch.Stop(); break; default: WriteLine("<<< 无效命令"); break; } } ch.Dispose();
编译,发布,上传到树莓派。注意舵机有三条线:
1、红线(一般在中间),接树莓派 5V 引脚(供电正极)。
2、黑线或棕色线,接树莓派任意一个 GND 引脚(供电负极)。
3、黄色(有的是白色)是信号线,用来控制舵机,接树莓派的 GPIO 18,这个是树莓派全系列通用的默认 PWM 引脚。
运行程序,第一步,输入 d 20000,设定周期(为了统一,所有时间参数都是以微秒为单位)。
输入 t 500 设置高电平控制角度的起始时间,就是持续最小值,取500。
输入 p 2500,设置高电平的结束时间,即持续的最大值,一般取 2500。
输入小写字母 o,开始PWM。
输入 a 120,旋转至 120 度。
输入 a 30 ,旋转至 30 度。
输入小写字母 s ,停止PWM信号,输入 x 退出。
看看效果。
相关源代码,请点这里下载