0
  • 聊天消息
  • 系统消息
  • 评论与回复
登录后你可以
  • 下载海量资料
  • 学习在线课程
  • 观看技术视频
  • 写文章/发帖/加入社区
创作中心

完善资料让更多小伙伴认识你,还能领取20积分哦,立即完善>

3天内不再提示

步进电机S型曲线加减速的实现

GReq_mcu168 来源:嵌入式技术开发 作者:嵌入式技术开发 2022-07-01 16:07 次阅读

之前做电机相关的项目比较少,最近有个项目涉及到步进电机的精确控制,参考了一些资料研究了一下S型曲线加减速,这里总结一下分享给大家。

硬件是:STM32+驱动器+步进电机。
STM32定时器输出PWM,控制驱动器来驱动步进电机。单片机只要控制电机方向,以及PWM的频率即可,具体驱动由驱动器实现。 首先说一下什么是S型曲线加速,为什么要S型曲线加速。
S型曲线加速是指步进电机的启动速度按照S型曲线逐渐增加,以达到设定的最大速度。具体的S型曲线方程如下:2cf33e0a-f527-11ec-ba43-dac502259ad0.pngx取值-5~5的曲线图如下:2d043ca0-f527-11ec-ba43-dac502259ad0.png可以看到,刚开始加速和达到最大速度时加速比较缓慢,中间加速比较快。电机的转矩和转速的乘积的k倍等于功率,也就是说,功率一定的时候,转速与转矩成反比关系。所以,转速越低,转矩越大。当电机直接高速启动时,电机可能存在震动、丢步甚至启动不起来的情况。因此需要S型曲线加速,使电机能够缓慢启动。程序实现控制电机的速度,其实就是控制PWM的输出频率。首先需要对S曲线方程进行一些变化,如下:Fcurrent = Fmin + (Fmax-Fmin)/(1+exp( -Flexible(i - num )/num) )
  • Fcurrent为计算出的当前频率。

  • Fmin为加速的起始频率。

  • Fmax为加速的最大频率。

  • -Flexible*(i - num)/num是对S型曲线进行拉伸变化,其中Flexible代表S曲线区间(越大代表压缩的最厉害,中间加速度越大;越小越接近匀加速。理想的S曲线的取值为4-6)

  • i是在循环计算过程中的索引,从0开始

  • num为 加速脉冲数/2 大小

上面计算出的是频率的S曲线,还需要将频率转换成定时器的计数周期,程序如下:

//功能:S加速曲线初始化//参数1 *pbuff          计算出的定时器的周期//参数2 fre_max        最大频率 Hz//参数3 fre_min        最小频率 Hz//参数4 len            加速需要的脉冲数void CurveS_init(uint16_t *pbuff,uint32_t fre_max,uint32_t fre_min,int16_t len){      int16_t i;      uint16_t flexible =4;floatdelt=fre_max-fre_min;floatdeno;      float melo ;floatfre;
       for(i=0; i       {              melo = flexible* (i-len/2) / (len/2);              deno = 1.0f / (1 + expf(-melo));  //              fre = delt * deno + fre_min;              *pbuff++ = (unsigned short)(TIM2_CLOCK_FREQ / fre);       }
}
TIM2_CLOCK_FREQ为定时器的计数频率。 之后要做的就是在加减速过程中,每输出一个PWM脉冲,重新装载一次定时器周期。具体怎样输出指定个数PWM来控制步进电机,可参考之前的文章《STM32定时器产生指定个数脉冲》。在PWM中断中,将计算好的S曲线数组,重新装载到定时器的ARR和CCR寄存器中即可。程序如下:
//PWM回调函数void HAL_TIM_PWM_PulseFinishedCallback(TIM_HandleTypeDef *htim){    Motor.PWMcount++;    SpeedAdjust();//速度调节}
//速度调节函数void SpeedAdjust(void){  switch(Motor.Status)  {    /*加速*/                case SPEED_INCREASE:      if(Motor.Count < Motor.CountMax)      {        __HAL_TIM_SET_AUTORELOAD(&htim2,Period[Motor.Count]);//计算下一个PWM的周期        htim2.Instance->CCR1 = Period[Motor.Count]/2;//占空比50%        Motor.Count++;//加速次数      }      else      {        Motor.Status = SPEED_STABLE;        Motor.Count--;      }break;    /*匀速*/      case SPEED_STABLE:      if(Motor.PWMcount >= (Motor.PWMneed - Motor.Count))      {            Motor.Status = SPEED_DECREASE;        }break;    /*减速*/      case SPEED_DECREASE:      if(Motor.Count >= 0)      {        __HAL_TIM_SET_AUTORELOAD(&htim2,Period[Motor.Count]);//计算下一个PWM的周期        htim2.Instance->CCR1 = Period[Motor.Count]/2;        Motor.Count--;        }      if(Motor.PWMcount >= Motor.PWMneed)      {        HAL_TIM_PWM_Stop_IT(&htim2,TIM_CHANNEL_1);      }      break;    default :      break;  }

其中Motor是自己定义的一个结构体:


typedef struct{  uint8_t Status;   //状态  int32_t Count;     //加减速过程脉冲计数  int32_t CountMax;  //最大加速脉冲数  uint32_t PWMcount;//PWM计数  uint32_t PWMneed; //需要输出的PWM总数}Motor_t;
启动时,初始化参数,启动定时器输出PWM即可:
//PWM--需要输出的脉冲个数void StartPWM(uint32_t PWM){             Motor.PWMcount = 0;       Motor.PWMneed = PWM;       Motor.Count = 0;       Motor.Status = SPEED_INCREASE;       Motor.CountMax = 300;//初始化加速曲线,最小频率100,最大频率10K,加速脉冲数300CurveS_init(Period,10000,100,Motor.CountMax);       __HAL_TIM_SET_AUTORELOAD(&htim2,Period[0]);       htim2.Instance->CCR1 = Period[0];       HAL_TIM_PWM_Start_IT(&htim2, TIM_CHANNEL_1);  //启动定时器PWM输出}
来看一下效果,可以看到,PWM的频率是逐渐增大的。实际测试效果也不错。

审核编辑 :李倩

声明:本文内容及配图由入驻作者撰写或者入驻合作网站授权转载。文章观点仅代表作者本人,不代表电子发烧友网立场。文章及其配图仅供工程师学习之用,如有内容侵权或者其他违规问题,请联系本站处理。 举报投诉
  • 驱动器
    +关注

    关注

    51

    文章

    7244

    浏览量

    142603
  • 步进电机
    +关注

    关注

    149

    文章

    2914

    浏览量

    145874

原文标题:步进电机S型曲线加速的实现

文章出处:【微信号:mcu168,微信公众号:硬件攻城狮】欢迎添加关注!文章转载请注明出处。

收藏 人收藏

    评论

    相关推荐

    两相步进电机和五相步进电机有什么区别?

    加减速时间、动态惯性等方面的表现较佳。       五相步进电机具有更高的细分能力,可以提供更高的精度和更快的加减速时间。此外,由于五相步进
    的头像 发表于 12-22 08:40 404次阅读

    基于单片机的步进电机控制系统设计

    该项目利用51单片机实现了一个步进电机控制系统,可以实现步进电机的正反转、
    的头像 发表于 12-06 16:39 1049次阅读
    基于单片机的<b class='flag-5'>步进</b><b class='flag-5'>电机</b>控制系统设计

    步进电机S加减速算法与查表方式哪个更好?

    步进电机S加减速算法与查表方式哪个更好,有谁用过,能否提供实例?
    发表于 11-08 08:10

    步进电机S曲线生成器的计算以及使用

    根据上一节内容,已经计算了一条任意S曲线的函数。在步进电机S曲线加减速的控制中,需要的S曲线如图
    的头像 发表于 10-26 15:02 815次阅读
    <b class='flag-5'>步进</b><b class='flag-5'>电机</b>S<b class='flag-5'>曲线</b>生成器的计算以及使用

    步进电机S曲线运动的代码实现

    实现步进电机转动总角度720°,其中加减速各90°
    的头像 发表于 10-26 14:55 499次阅读
    <b class='flag-5'>步进</b><b class='flag-5'>电机</b>S<b class='flag-5'>曲线</b>运动的代码<b class='flag-5'>实现</b>

    51单片机控制步进电机硬件连接部分

    本案例讲解的内容是51单片机控制步进电机硬件连接部分。后续会分别讲解单片机程序,S曲线加减速方法,上位机等相关内容
    的头像 发表于 10-26 11:11 1415次阅读
    51单片机控制<b class='flag-5'>步进</b><b class='flag-5'>电机</b>硬件连接部分

    步进电机的控制,加速和减速是如何实现的?

    控制步进电机加速和减速是如何实现
    发表于 10-15 07:00

    步进电机加减速时间长短有什么不一样吗?

    步进电机加减速时间长短有什么不一样吗?一般步进电机加减速时间是多少? 
    的头像 发表于 10-13 17:39 1151次阅读

    步进电机加减速是通过改变哪个参数实现的?

    步进电机加减速时间一般如何设定?步进电机加减速是通过改变哪个参数
    的头像 发表于 10-13 17:39 1001次阅读

    什么是S形加减速步进电机控制算法—S形加减速运动算法介绍

    如下图所示,假设该装置使用步进电机实现物体X的移动,系统要求物体X从A点出发,到B点停止,移动的时间越短越好且系统稳定。
    发表于 10-07 10:04 2227次阅读
    什么是S形<b class='flag-5'>加减速</b>?<b class='flag-5'>步进</b><b class='flag-5'>电机</b>控制算法—S形<b class='flag-5'>加减速</b>运动算法介绍

    步进电机如何减速

    步进电机作为一种常用、应用广泛的驱动电机,通常会搭配减速设备一起使用,以达到理想传动效果;而步进电机
    的头像 发表于 10-05 09:29 534次阅读

    步进电机可以配什么减速机?

    1.步进电机减速机的原因步进电机切换定子相电流的频率,如改变步进
    的头像 发表于 09-25 08:08 896次阅读
    <b class='flag-5'>步进</b><b class='flag-5'>电机</b>可以配什么<b class='flag-5'>减速</b>机?

    PWM控制直流电机加减速正反转

    源码已经经过验证,C语言,实现对直流电机的控制(正反转,加减速),硬件需要直流电机驱动板
    发表于 09-20 07:15

    步进电机减速电机异同点,接线的端口次序

    步进电机减速电机异同点,接线的端口次序
    的头像 发表于 09-18 09:13 555次阅读

    介绍一款功能强大的步进电机控制驱动芯片

    的转起来并无法满足实际应用的需求,我们还可能面对需要解决一下问题:1)如何减少上位MCU的工作量,比如将对于电机的位置速度控制,传感器限位输入以及编码器输入下放到驱动端?如何规划好加减速轨迹曲线 使
    发表于 04-15 11:17