前凸后翘的步进电机调速算法~

水深无声 2022-09-04 01:47 161阅读 0赞

\[导读\] 大家好，我是逸珺。

今天想分享一种超级实用的步进电机调速算法，这种算法在步进电机调速方案中可以说是一种非常优异的方案。

## 梯形调速算法 ##

为啥需要设计一个调速算法呢？步进电机不是给多少脉冲就动多少步吗？但是带上负载了就可能失步，所谓失步，简单理解就是实际电机轴转过的度数，没有输入脉冲对应度数多。为什么会这样呢？电机的扭矩有可能无法驱动负载。一般会做一个启动加速控制过程，停止的时候做一个减速控制，中间做一个匀速控制。这就是比较常见的梯形调速控制算法。

![ebfc78096098bdc3665b8587dd0e96d8.png][]

这样一个梯形调速算法，相当于步进电机的运动过程包含三个阶段：

*  ①加速过程
 *  ②匀速过程
 *  ③减速过程

①加速过程所用到的加速度为：

一般加速过程与减速过程所用的加速度绝对值是相同的，减速过程相当于加速度为-a.

所以总的行程图中速度曲线下阴影部分三个过程的面积：

由于加速过程与减速过程所用到的加速度绝对值相等，所以,所以

梯形速度调速算法很简单，比较容易实现，但是这个算法却有缺陷。

![502778967fb152a4ecb2d6dffd9f8206.png][]

图中红色圆圈的位置，加速度从a突变为0，或从0突变为-a,这些突变点会带来什么后果呢？来看看其加速度曲线：

![952bee2615e351f991835d157ee4deb3.png][]

电机带着负载运动，比如常见的丝杆将电机的旋转运动，转化直线运动，又或者齿轮或滚珠结构，带动负载进行旋转运动。具有一定的质量的负载，在加速度突变情况下，很有可能会造成机械振动。

比较专业一点的术语称为急动(Jerk)，其实就是考察加速度的变化率的，也可以称为**加加速度**，我们知道速度的变化率就是加速度，而加速度的变化率就是加加速度。

如果用数学语言来装下逼，就是速度函数对时间的一阶导数就是加速度，而对加速度曲线的一阶导数就是加加速度。因此上图中加速度在时刻突变，意味着加加速度为无穷大。

> **对于给定的负载，加加速度越大，产生的不需要的振动能量就越大，振动能量的频谱也就越宽。这意味着加速度变化越快，振动就越强大，激发的振动模式数量也就越多。由于振动能量被系统机械吸收，如果振动频率与机械和控制系统中的共振相匹配，则可能会导致稳定时间增加或精度降低。**

这样一说，好像就有思路了，我们如果能做到加速度的变化率是连续的，是否这种变化就会变得平滑呢？运动是不是就更柔性？所谓变化率连续，是不是就是相对于加速度函数的导数曲线是连续的就可以了？

## S-曲线调速算法 ##

假定来归一化速度曲线为从0加速到1，假设能做出如下调速曲线：

![b0c9583173ef0b1fe13bbe08c2d19d5e.png][]

这样来看看这些拐点：

![4f341b910ed98becdb8acc6542cac1e8.png][]

看速度曲线先是比较缓慢的增加，然后再比较快速的增加，然后在慢慢第逼近到期望的设定速度，因此这是一个变加速过程。再来做一个进一步的假设，把加速度过程的时间也做一个归一化：

![8be4e371925df2d7f4e07f2a900c719b.png][]

对于函数，可以看出：

前面说,那么，意味着在0、1时刻，加速度为0。

假设速度曲线函数为：

则其一阶导数为：

这样就可以得出下面的方程组了：

解出a和b：

因此，调速曲线就得到了：

其加速度曲线为：

整个过程的加速度曲线长这样：

![ace7064797193c1132c64bdf3f9f7bd6.png][]

这样一来，加速度就是连续变化的，没有突变点。解决了之前提到的急动的问题。由于加速、减速过程完全对称，因此我们关心的运动距离控制，则很容易用下图中绿色区域的面积计算得到：

![136038bf6ea86db82a6a8bf8ee0e4791.png][]

有了这样的数学模型，编码实现就是水到渠成的事情了。

## 总结一下 ##

电机速度控制，一般尽量做到柔性调速，本文分享的步进电机的S-曲线调速数学算法模型，是一个非常棒的算法模型。速度一开始缓慢增加到快速增加，再回到缓慢增加直到速度达到设定期望速度。从设计上，兼顾了快速启停，又能尽最大程度降低加速度突变这一对矛盾。希望对有兴趣的朋友有所帮助。

--------------------

**推荐阅读：**

[专辑|Linux文章汇总][Linux]

[专辑|程序人生][Link 1]

[专辑|C语言][C]

[我的知识小密圈][Link 2]

关注公众号，后台回复「**1024**」获取学习资料网盘链接。

**欢迎点赞，关注，转发，在看，您的每一次鼓励，我都将铭记于心~**

![ada85ace6702fd43e30f658a105a6789.png][]

嵌入式Linux

微信扫描二维码，关注我的公众号

[ebfc78096098bdc3665b8587dd0e96d8.png]: /images/20220829/992d47f1782d4bce808851272c0be15d.png
[502778967fb152a4ecb2d6dffd9f8206.png]: /images/20220829/79474600c7d54ee5b9c8c429b19982ab.png
[952bee2615e351f991835d157ee4deb3.png]: /images/20220829/5ff8ea165fe74998b9a8965b72818e5d.png
[b0c9583173ef0b1fe13bbe08c2d19d5e.png]: /images/20220829/ab28c71545b44b84bd55393a426a2cee.png
[4f341b910ed98becdb8acc6542cac1e8.png]: /images/20220829/f3ded0cf3bbf487b80443ddb529c0937.png
[8be4e371925df2d7f4e07f2a900c719b.png]: /images/20220829/ad24fb0ee1d1405389d4db56e80060b1.png
[ace7064797193c1132c64bdf3f9f7bd6.png]: /images/20220829/77c13297a14743ba802b5659a3aadc74.png
[136038bf6ea86db82a6a8bf8ee0e4791.png]: /images/20220829/d2c056500db743b0a06c7d143fe2a9d3.png
[Linux]: https://mp.weixin.qq.com/mp/appmsgalbum?__biz=MzA5NTM3MjIxMw%3D%3D&action=getalbum&album_id=1319528681890709506#wechat_redirect
[Link 1]: https://mp.weixin.qq.com/mp/appmsgalbum?__biz=MzA5NTM3MjIxMw%3D%3D&action=getalbum&album_id=1351786687592202240#wechat_redirect
[C]: https://mp.weixin.qq.com/mp/appmsgalbum?__biz=MzA5NTM3MjIxMw%3D%3D&action=getalbum&album_id=1377857816341577728#wechat_redirect
[Link 2]: http://mp.weixin.qq.com/s?__biz=MzA5NTM3MjIxMw%3D%3D&chksm=9042f716a7357e003fc6c87cfacb76508df6c06e14fb9f01c54aca3801f456b9ff5b6ce71ef3&idx=2&mid=2247492044&scene=21&sn=695b9297a39bf2d5a4548a161892d182#wechat_redirect
[ada85ace6702fd43e30f658a105a6789.png]: /images/20220829/da1a81fce51d4d228f1838cc96190c60.png