OpenEdv-开源电子网

 找回密码
 立即注册
正点原子全套STM32/Linux/FPGA开发资料,上千讲STM32视频教程免费下载...
查看: 3612|回复: 1

步进电机加减速算法,随便写写

[复制链接]

181

主题

311

帖子

0

精华

金牌会员

Rank: 6Rank: 6

积分
1055
金钱
1055
注册时间
2012-8-26
在线时间
52 小时
发表于 2016-7-22 10:43:13 | 显示全部楼层 |阅读模式
再此给出两个定时器中断,用于控制步进电机的转速

定时器1用来控制步进电机的速度,定时器2控制步进电机脉冲信号

控制一个步进电机感觉STM32已经很累了,多轴联动估计难,要优化的很好才行。有兴趣的朋友,一起来搞一个开源多轴联动的方案吧。


uint16_t capture = 0;       
__IO uint16_t bujindianji1maichongjiange = 10000;
__IO uint16_t bujindianji2maichongjiange = 10000;
__IO uint16_t bujindianji3maichongjiange = 10000;
__IO uint16_t bujindianji4maichongjiange = 10000;
s32 ti,ai;

u32 tim[ 10 ];
void        TIM1_UP_TIM16_IRQHandler(void)
        {
               
        if(TIM_GetITStatus(TIM1, TIM_IT_Update))
        {
                tim[ 0 ]++;
                tim[ 1 ]++;
                tim[ 2 ]++;
                if(bujindianji1mubiaobushu > bujindianji1xianbushu)
                {
                        bujindianji1jiansusuoxubushu = ((bujindianji1xiansubu/20 * bujindianji1xiansubu) / (bujindianji1jiasubu)*10);
                        if((bujindianji1mubiaobushu - bujindianji1xianbushu)<bujindianji1jiansusuoxubushu)
                        {
                                bujindianji1jiajiansu = -1;
                        }
                        if(bujindianji1jiajiansu == -1)
                        {
                                bujindianji1xiansubu-=bujindianji1jiasubu / 100;
                        }
                        if(bujindianji1jiajiansu == 1)
                        {
                                bujindianji1xiansubu+=bujindianji1jiasubu / 100;
                        }
                               
                        if(bujindianji1xiansubu > (bujindianji1max * bujindianji1yihaomimaichongshu/1000))bujindianji1xiansubu =( bujindianji1max * bujindianji1yihaomimaichongshu/1000);
                        if(bujindianji1xiansubu < (bujindianji1min * bujindianji1yihaomimaichongshu/1000))bujindianji1xiansubu =( bujindianji1min * bujindianji1yihaomimaichongshu/1000);
                       
                        if(bujindianji1xiansubu > (bujindianji1mubiaosudu * bujindianji1yihaomimaichongshu/1000))bujindianji1xiansubu =( bujindianji1mubiaosudu * bujindianji1yihaomimaichongshu/1000);

                        bujindianji1maichongjiange = 2000000/bujindianji1xiansubu;

                }
        }               
        TIM_ClearITPendingBit(TIM1, TIM_IT_Update);//&#199;&#229;3yTIMxμ&#196;&#214;D&#182;&#207;′y′|àí&#206;&#187;               
        }





void TIM2_IRQHandler(void)
{
  if (TIM_GetITStatus(TIM2, TIM_IT_CC1) != RESET)
  {               
                if(bujindianji1mubiaobushu > bujindianji1xianbushu)                                //2&#189;&#189;&#248;μ&#231;&#187;ú1&#213;y×a
    {

      bujindianji1maichongyinjiao =! bujindianji1maichongyinjiao;
      bujindianji1xianbushu++;
                        //bujindianji1xianweizhi = bujinxianji1xianbushu /
    }
                if(bujindianji1mubiaobushu == bujindianji1xianbushu)     
                {
                        bujindianji1jiajiansu = 1;
                }
                TIM_ClearITPendingBit(TIM2, TIM_IT_CC1);
    capture = TIM_GetCapture1(TIM2);
    TIM_SetCompare1(TIM2, capture + bujindianji1maichongjiange);
  }
  if (TIM_GetITStatus(TIM2, TIM_IT_CC2) != RESET)
  {
               
    TIM_ClearITPendingBit(TIM2, TIM_IT_CC2);
    capture = TIM_GetCapture2(TIM2);
    TIM_SetCompare2(TIM2, capture + bujindianji2maichongjiange);
  }
       
  if (TIM_GetITStatus(TIM2, TIM_IT_CC3) != RESET)
  {
    TIM_ClearITPendingBit(TIM2, TIM_IT_CC3);
    capture = TIM_GetCapture3(TIM2);
    TIM_SetCompare3(TIM2, capture + bujindianji3maichongjiange);

  }
  if (TIM_GetITStatus(TIM2, TIM_IT_CC2) != RESET)
  {
    TIM_ClearITPendingBit(TIM2, TIM_IT_CC4);
    capture = TIM_GetCapture4(TIM2);
    TIM_SetCompare4(TIM2, capture + bujindianji4maichongjiange);
  }
}


为了雅典娜?为了爱与正义
正点原子逻辑分析仪DL16劲爆上市
回复

使用道具 举报

11

主题

179

帖子

0

精华

金牌会员

Rank: 6Rank: 6

积分
1103
金钱
1103
注册时间
2016-7-19
在线时间
168 小时
发表于 2016-12-5 13:33:20 | 显示全部楼层
回复 支持 反对

使用道具 举报

您需要登录后才可以回帖 登录 | 立即注册

本版积分规则



关闭

原子哥极力推荐上一条 /2 下一条

正点原子公众号

QQ|手机版|OpenEdv-开源电子网 ( 粤ICP备12000418号-1 )

GMT+8, 2025-5-26 00:21

Powered by OpenEdv-开源电子网

© 2001-2030 OpenEdv-开源电子网

快速回复 返回顶部 返回列表