zoukankan      html  css  js  c++  java
  • 【.NET 与树莓派】控制舵机

    不管是小马达,还是大马达,嗯,也就是电机,相信大伙伴们也不会陌生。四驱车是一种很优秀的玩具,从老周小时候就开始流行(动画片《四驱兄弟》估计很多大朋友都看过),直到现在还能看到很多卖四驱车的。为啥会想起四驱车呢?因为小时候玩四驱车让老周认识了很多奇葩马达,什么“红魔鬼”、“蓝芯”、“紫魔鬼”……也不知道是什么逻辑的命名方式,反正那时候大家都这么叫。

    这些马达的结构有一个转轴,绕有红色或橙色的线圈(记忆中是这些颜色),有四块磁铁。金属外壳,上部开有两个散热孔。整体形状有圆的也有扁的,许多遥控车的马达是圆的。还有一马达像个竹筒似的,一些太阳帽小风扇里面有。

    一般的马达的特点,就是一通电就往一个方向转(正负接反它就反向转),但舵机比普通马达更好玩。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 退出。

    看看效果。

    相关源代码,请点这里下载

  • 相关阅读:
    android ContentObserver
    3 个简单、优秀的 Linux 网络监视器
    使用 sar 和 kSar 来发现 Linux 性能瓶颈
    4 个拥有绝佳命令行界面的终端程序
    4 个用于构建优秀的命令行用户界面的 Python 库
    理解 Linux 的平均负载和性能监控
    安装matplotlib
    面向系统管理员的网络管理指南
    使用 Nmon 监控 Linux 的系统性能
    linux smem 查看各进程使用memory情况
  • 原文地址:https://www.cnblogs.com/tcjiaan/p/14415377.html
Copyright © 2011-2022 走看看