广东湘恒智能科技有限公司
主营产品: 西门子PLC代理商,plc变频器,伺服电机,人机界面,触摸屏,线缆,DP接头
步进电机驱动算法—梯形加减速运动算法
发布时间:2024-11-05

什么是梯形加减速

如下图所示,假设该装置使用步进电机实现物体X的移动,系统要求物体X从A点出发,到B点停止,移动的时间越短越好且系统稳定。

图片

使用梯形加减速

OA段为滑块的加速部分、AB则是匀速部分,BC则是减速部分。因其图像呈现梯形,所以我们把这种运动变化称之为梯形加减速

图片


使用加减速的理由

为什么要使用加减速呢?步进电机有一个很重要的技术参数:空载启动频率,也就是在没有负载的情况下能够正常启动的最大脉冲频率,如果脉冲频率大于该值,步进电机则不能够正常启动,发生丢步或者堵转的情况;或者也可以理解为由于步进脉冲变化过快,转子由于惯性的作用跟不上电信号的变化。所以要使用加减速来解决启动频率低的问题,在启动时使用较低的脉冲频率,然后逐渐的加快频率。


梯形加减速算法特点

图片

梯形加减速一共分为三个阶段,OA 加速部分、AB 匀速部分 和 BC 减速部分。在 OA 加速过程中,由低于步进电机的启动频率开始启动(模型中由 0 启动),以固定的加速度增加速度到目标值;在 AB 匀速过程中,以最大速度匀速运动;在 BC 减速部分中,以加速度不变的速度递减到 0;这种算法是一种在加速过程和减速过程中加速度不变的匀变速控制算法,由于速度变化的曲线有折点,所以在启动、停止、匀速段中很容易产生冲击和振动。


算法基础

图片

上图为步进电机与时间的示意图,其中:

  表示第1个脉冲发送时刻  表示第2个脉冲发送时刻  表示第3个脉冲发送时刻  表示定时器的计数周期  表示定时器从  ~  时刻的定时器计数值  表示定时器从  ~   时刻的定时器计数值  和  表示两个脉冲之间的间隔时间步进电机的转动需要控制器发送脉冲,如果控制器以恒定速度发送脉冲,那么步进电机就以恒定速度转动;如果控制器以加速度发送脉冲,那么步进电机就以加速度运动;所以只要改变脉冲的频率就可以改变速度的变化,也就是说调整脉冲之间的时间间隔就可以改变速度。
以 stm32 的gaoji定时器 8 为例,使用定时器PWM输出模式给控制器发送脉冲。gaoji定时器 8 的时钟频率为 168MHZ, 如果将分频值设置为 5,那么定时器的时钟频率则为:  , 相当于计数 28M 次正好为一秒,周期与频率为倒数关系,所以分频值为 5 的定时器 8 的计数周期   ;  和  的值即为ARR寄存器的值,所以我们在固定的定时器频率下,只需要改变ARR的值,即可改变电机的速度。

梯形算法要求的变量

我们通过控制定时器输出PWM波形来描绘上述梯形,至少需要知道以下变量:在加速阶段

加速初始PWM频率,即我们要求的ARR寄存器的值  加速度accel加速阶段总的脉冲数

匀速阶段:

匀速所用的脉冲数

减速阶段:

减速初始频率(也是匀速运动的速度)减速度decel减速所用的脉冲

一般情况下,电机加速度accel、减速度decel和总步数(即总脉冲数)是给定的,我们需要通过这3个变量推导出剩余的变量。知道以上变量,再推导出每步的定时器频率,结合脉冲数即可绘制完整的梯形图。


展开全文
拨打电话 微信咨询 发送询价