电动滑板增加测速功能

标签：

诸葛小新 发布于 2015-04-27 21:56

作为一款智能滑板（尽管现在还一点也不智能），测速应该是必备的功能。
       在人群中飘过，常有人问“这玩意能跑多快啊？”，我只能根据电机的额定转速给出个模糊值，“时速大概。。。二三十公里吧”，听者将信将疑。如果能够精确测速，咱就不用含糊其辞了。此外，有了测速，可以像汽车一样增加里程计量等数据，测量电池续航能力。最后，滑板 APP的 控制模式有“定速巡航 ”和“手动油门 ”两种方式，不过这里的定速巡航并不是真正意义上的“定速”，只是固定油门，平地的话基本可以保持定速，越到上下坡，显然就不是定速了。如果想实现真正的PID定速控制，测速也是必须的。
       
       如果马达自带编码器，测速很好实现。这款马达不带此功能。首先想到的简单、低成本的方案就是用霍尔传感器。
       关于测速原理，可以参考《基于Arduino与LabVIEW的直流电机转速控制系统 》。我采用的是测频法，简单说就是计算固定周期T（秒）内由于旋转所产生的脉冲次数C。
       如果对非磁性物体测速，需要额外附加一块磁铁。对于电机来说，因为内置磁铁，可以直接测量。我用的电机每旋转一周会产生P=8次脉冲。这样，电机的转速就是： C/T/P  转/秒。有了电机的转速，再加上减速比、驱动轮直径，滑板的速度很容易计算了。
      公式里面C和P是固定的，计数周期T是在程序里面可以设定的，T决定了转速更新时间，比如T=1秒，每1秒钟，转速值才会更新一次，所以T不能太大。同时，T也不能太小，太小的话误差会比较大。尤其当转速较低的时候。初步设定T=0.2秒，效果如何有待进一步测试分析。
 

       霍尔传感器采用的是最便宜的KY-003 EYES 模块，三个接口分别是正电压V、接地G、信号S。由于需要使用信号产生的中断，S接在了Arduino的digital3端口，也就是1号中断。
void initHallSensor() {
  delay(1000);
  Timer1.initialize(200000);  // 0.2s cycle 
  Timer1.attachInterrupt( timerIsr );
  attachInterrupt(1, counter, RISING); // d2 pin for Hall interrupt.
  interrupts();
}

/*counter for Hall sensor, counts the pulse of motor*/
void counter() {
  counter_val[curCounter & 0x01] += 1;
}

       最后说一下需要注意的问题：
       1. 为了周期性测量霍尔传感器产生的中断数量，用到了定时器库TimerOne，而Arduino中的PWM也需要用到定时器，6个PWM输出脚当然也要用这些计时器，它们是这样分配的：
Pins 5 and 6: timer0
Pins 9 and 10: timer1
Pins 11 and 3: timer2
在使用定时器之前，pin 9连接电调的信号线，启用定时器之后，电调无法正常工作，信号线改接pin11，电调工作正常。
       
       2. 霍尔传感器中断的问题，困扰了我一天时间。按照上面的接线和代码，霍尔传感器在马达转过的时候会产生中断，用电脑的usb接口供电的时候，一切正常，但是当用电调对Arduino供电的时候，中断无效，完全没反应。最开始以为是电调信号线导致的问题，仔细检查代码，没有问题，断开电调的信号线，问题照旧。那么唯一不同的就是usb和电调供电的电压了，上电表测，usb电压5v，电调电压6v，难道是因为电调的电压过高导致的中断引脚电压无效？后来想到实际上是霍尔传感器的信号输出电压受到干扰，霍尔传感器我用的是Arduino 3.3v供电，可能是电压不足导致容易受到干扰。立马改成5v供电，烦恼解除了。

增加部分内容，兼回复动力兄留言。

    给驱动轮加磁铁是最先想到的方案，但是后来被否定了。
    原因1. 需要固定一块磁铁，还需要固定好霍尔传感器，两者之间的距离大概在5mm之内才有效。尽管磁铁可以很小，对动力毫无影响，​但还是额外增加了复杂性，如果以后想要更换新的驱动轮或者驱动轮规格发生了变化，会比较麻烦，也不利于美观。用软件工程的术语来讲，测速功能和驱动轮是耦合的。
    原因2. 驱动轮转速相对电机来说较低，测速不够精确。如果在驱动轮上只固定一个磁铁，也就是每转一周产生一次脉冲，当驱动轮转速为5转/秒（按照我用的5寸轮尺寸，滑板速度大约7km/h），脉冲频率为5次/秒，也就是200毫秒/次，假设脉冲计数周期为200毫秒，能够检测到1次脉冲，当驱动轮转速低于5转/秒，得到的速度就都是0。如果增大计数周期，速度更新周期也相应变大，实时性变差。
    如果增加磁铁数量，又回到原因1了。

    归纳起来，转速为R(转/秒)，每转产生的脉冲次数为 C(次/转)， 脉冲计数周期为T，则脉冲频率为RC(次/秒)，也就是 1/RC(秒/次)，如果要保证能够测量到每次脉冲，必须有T>1/RC。假设我们需要测量的最低转速是1(转/秒)，即R=1，就有 T>1/C。 如果转速更新周期T是0.2秒，则C>5；如果每转只产生一次脉冲（C=1，也就是只有一个磁铁），T>1，这样的话速度更新周期过长了。​

    其实电机里面每个线圈就是一个磁铁，c5065每转会产生8次脉冲，所以目前的方案是霍尔传感器直接测量电机转动产生的脉冲。

 
blcakblue2016-01-13 18:32:10
小新老师不好意思打个广告

1550出售一个做好不到一个月的单驱滑板，最高速度30，最远续航20.用的是动力老男孩的遥控。要的私聊1055251363
疯子2015-09-17 11:13:20
诸葛老师， 你的霍尔传感器的接线原理图能show下吗？不知道怎么接呢，是否要加入电阻电容之类的
诸葛小新2015-09-17 18:57:25
我用的是Arduino 模块，不需要再加电阻了，直接和Arduino连接就可以了，线路很简单，正负极、信号读取三根，你应该会接吧。
疯子2015-09-21 14:38:41
回复 诸葛小新 : 会的，我是在想需不需要滤波之类的。我的5065电机每圈产生7个脉冲（两个电机多次测试证实），跟你的8个有点区别。
诸葛小新2015-09-22 10:42:37
回复 疯子 : 滤波的话我觉得不是很有必要，除非想做PID，精确控制速度。
马昌聪2015-08-26 16:19:37
我让电机匀速转动，霍尔传感器检测的速度不怎么稳定？怎么改进？谢谢
诸葛小新2015-08-26 20:06:54
你的意思是：向电调输出固定值，让电机保持匀速转动？
有两种可能，一种是电机确实没有保持匀速，比如收到阻力变化，但是如果空转、输出信号稳定的话，电机应该能够保持匀速。
另外一种可能就是传感器测速频率的问题，但是不知道你的不稳定是什么样的，周期性地跳动？还是无规律地变化。这种不稳定是否受转速影响？还有电机产生的脉冲怎么测的？  但根本问题还是测速频率的问题，具体关系我在上文的补充内容部分已经说明了。 你可以尝试修改测速频率，多观察一下。
马昌聪2015-08-27 16:31:07
回复 诸葛小新 : 我让电机空转，给相同的信号，两次测试的转速不一致，但是每一次的测速基本是稳定的。

还有，我用手转动电机一周，然后用霍尔元件去检测脉冲个数，每次检测到的脉冲个数都基本不同，这个可能是什么的影响？我猜测是电机的抖动造成的，但不知道如何去滤除这种抖动。
诸葛小新2015-08-27 20:12:20
回复 马昌聪 :
我觉得电机抖动的问题应该不大，还是测速的问题。
转动一周脉冲个数不一样？ 那测速肯定不稳定啊。 你是测量电机内部磁铁的脉冲么？ 一周产生几次脉冲？脉冲计数周期是多少？  相同的计数周期，转速越慢、误差越大。用手转速度肯定不稳定、而且速度也很慢，之所以每次到的不同的脉冲个数，可能技术周期比较大，有些脉冲被漏掉了。不存在电机抖动的问题吧，不知道你所说的“抖动”具体指什么。
莫克丁2015-06-02 11:43:34
我现在在用你这个方法，试卷控制两个轮子的转速保持一致（我用的是双驱动方案）
David2015-06-17 08:58:59
你的双驱方案成功了吗？
莫克丁2015-06-19 17:15:03
回复 David : 电机和驱动件买的现成的（电机两个N5056  80A 电调），现在在写两个轮子的驱动方法，也是借鉴各位大侠们的。（近段时间公司老加班，等有空了再弄了）
诸葛小新2015-08-26 20:14:53
精确同步的话得用PID吧？这种测速方法我觉得精度未必够。
其实我个人觉得没必要搞精确同步，只要两个马达的控制信号一致就可以了。
你需要同步的目地是希望直线运动？但是滑板的方向主要是靠我们站在上面移动重心来控制的，误差完全超过电机的同步了。即使电机能够精确同步，我们也很难让滑板精确地走直线，也没有必要。
动力老男孩2015-04-28 02:13:57
晕，想着飞行器的事情，晕了…
滑板的转速固定个磁铁完全无压力 ：）
动力老男孩2015-04-27 23:15:08
轮子上加了磁铁？会不会导致不平衡呢？
诸葛小新2015-04-28 08:36:33
回复见文内
动力老男孩2015-04-28 08:49:18
回复 诸葛小新 : 看到了，原来如此！

作者

诸葛小新

辽宁，大连

58粉丝 6作品 0随笔
  关注 私信

作者的最新作品

查看更多>>


阅读数： 11138