当前位置:   article > 正文

STM32控制步进推杆电机通过精准控制脉冲进行复位_微型推杆电机控制电路

微型推杆电机控制电路

1、TB6600升级版驱动器

TB6600升级版驱动器是一款专业的两相混合式步进电机驱动器,其驱动电流电流在3.5A及以下,而我所用的步进电机刚好是两相混合式步进电机,刚好符合。其接线方式我是按照共阴极接法:

所以呢,当ENA=0时,电机启动,ENA=1时,电机停止;

    当DIR=0时,电机正向转动,DIR=1时,电机反向转动;

2、定时器配置PWM输出模式,以及更新中断

  1. void TIM3_PWM_Init(u16 arr,u16 psc)
  2. {
  3. GPIO_InitTypeDef GPIO_InitStructure;
  4. TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure;
  5. TIM_OCInitTypeDef TIM_OCInitStructure;
  6. NVIC_InitTypeDef NVIC_InitStructure;
  7. RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3, ENABLE); //使能定时器3时钟
  8. RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA, ENABLE); //使能GPIO外设和AFIO复用功能模块时钟
  9. //输出TIM3 CH2的PWM脉冲波形 GPIOA.7
  10. GPIO_InitStructure.GPIO_Pin = GPIO_Pin_7; //TIM_CH2
  11. GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP; //复用推挽输出
  12. GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  13. GPIO_Init(GPIOA, &GPIO_InitStructure);//初始化GPIO
  14. //输出TIM3 CH2的PWM脉冲波形 GPIOA.6
  15. GPIO_InitStructure.GPIO_Pin = GPIO_Pin_6; //TIM_CH1
  16. GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP; //复用推挽输出
  17. GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  18. GPIO_Init(GPIOA, &GPIO_InitStructure);//初始化GPIO
  19. //初始化TIM3
  20. TIM_TimeBaseStructure.TIM_Period = arr; //设置在下一个更新事件装入活动的自动重装载寄存器周期的值
  21. TIM_TimeBaseStructure.TIM_Prescaler =psc; //设置用来作为TIMx时钟频率除数的预分频值
  22. TIM_TimeBaseStructure.TIM_ClockDivision = 0; //设置时钟分割:TDTS = Tck_tim
  23. TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up; //TIM向上计数模式
  24. TIM_TimeBaseInit(TIM3, &TIM_TimeBaseStructure); //根据TIM_TimeBaseInitStruct中指定的参数初始化TIMx的时间基数单位
  25. //初始化TIM3 Channel2 PWM模式
  26. TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM2; //选择定时器模式:TIM脉冲宽度调制模式2
  27. TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable; //比较输出使能
  28. TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High; //输出极性:TIM输出比较极性高
  29. TIM_OC2Init(TIM3, &TIM_OCInitStructure); //根据T指定的参数初始化外设TIM3 OC2
  30. //初始化TIM3 Channel1 PWM模式
  31. TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM1; //选择定时器模式:TIM脉冲宽度调制模式1
  32. TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable; //比较输出使能
  33. TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High; //输出极性:TIM输出比较极性高
  34. TIM_OC1Init(TIM3, &TIM_OCInitStructure); //根据T指定的参数初始化外设TIM3 OC1
  35. TIM_OC2PreloadConfig(TIM3, TIM_OCPreload_Enable); //使能TIM3在CCR2上的预装载寄存器
  36. TIM_OC1PreloadConfig(TIM3, TIM_OCPreload_Enable); //使能TIM3在CCR1上的预装载寄存器
  37. TIM_ITConfig(TIM3,TIM_IT_Update,ENABLE ); //使能指定的TIM3中断,允许更新中断
  38. NVIC_InitStructure.NVIC_IRQChannel = TIM3_IRQn; //TIM3中断
  39. NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 0; //先占优先级0级
  40. NVIC_InitStructure.NVIC_IRQChannelSubPriority = 3; //从优先级3级
  41. NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE; //IRQ通道被使能
  42. NVIC_Init(&NVIC_InitStructure); //根据NVIC_InitStruct中指定的参数初始化外设NVIC寄存器
  43. TIM_Cmd(TIM3, DISABLE); //使能TIM3
  44. }

3、定义中断服务函数以及脉冲处理

  1. u32 pulse_P=0;
  2. u32 pulse_N=0;
  3. void TIM3_IRQHandler(void) //TIM3中断
  4. {
  5. if (TIM_GetITStatus(TIM3, TIM_IT_Update) != RESET) //检查指定的TIM中断发生与否:TIM 中断源
  6. {
  7. TIM_ClearITPendingBit(TIM3, TIM_IT_Update ); //清除TIMx的中断待处理位:TIM 中断源
  8. if(DIR1)
  9. {
  10. pulse_N++;
  11. }
  12. else pulse_P++;
  13. LED0=0;
  14. }
  15. }

定义pulse_N变量,当反向转动时候,pulse_N递增;

定义pulse_P变量,当正向转动时候,pulse_P递增;

总结:相当于定于正转反转的脉冲

  1. extern u32 pulse_N;
  2. extern u32 pulse_P;
  3. int pulse_count=0;
  4. TIM3_PWM_Init(899,12); //不分频。PWM频率=72000000/900=80Khz
  5. TIM_SetCompare2(TIM3,450);
  6. TIM_SetCompare1(TIM3,450);
  7. //串口屏的控件指令,通过串口屏控制推杆进行复位
  8. if(USART_RX_BUF[0]==0x11&&USART_RX_BUF[1]==0x12)//推杆复位
  9. {
  10. TIM_Cmd(TIM3, DISABLE);
  11. pulse_count=pulse_P-pulse_N;
  12. pulse_N=0;pulse_P=0;
  13. flag_R=1;
  14. USART_RX_STA=0; //清除标志位
  15. }
  16. //控制逻辑
  17. if(flag_R)
  18. {
  19. if(pulse_count>0)
  20. {
  21. TIM_Cmd(TIM3, ENABLE);
  22. ENA1=0;
  23. DIR1=1;
  24. if(pulse_N>pulse_count)
  25. {
  26. TIM_Cmd(TIM3, DISABLE);
  27. ENA1=1;//步进电机1停止
  28. }
  29. }
  30. else
  31. {
  32. pulse_count=0-pulse_count;
  33. TIM_Cmd(TIM3, ENABLE);
  34. ENA1=0;
  35. DIR1=0;
  36. if(pulse_P>pulse_count)
  37. {
  38. TIM_Cmd(TIM3, DISABLE);
  39. ENA1=1;//步进电机1停止
  40. }
  41. }
  42. }

控制逻辑:串口屏发出推杆复位指令:1、停止脉冲的输出;

                                                             2、计算正转反转脉冲的差值,并将其赋给pulse_count;

                                                             3、对之前记录正转、反转脉冲清零,这样才方便下次的记录以及复位操作;

                                                              4、给出一个推杆复位操作标签;

                  推杆复位的具体操作  :我以逻辑框图展示比较清晰明了,配合上面的代码就可以用了。

使用提醒: 1、使用完复位Function后,需将flag_R标签值改为0,不然他就一直处于复位模式

                    2、该编制思路并没有考虑细分等情况,因为我实现的是对原始初始位置的还原,并不需要,我只需要计算出它相对原始位置的脉冲差值,再以相反的方向相同的脉冲数驱动即可。

实图

        

                                                             

声明:本文内容由网友自发贡献,不代表【wpsshop博客】立场,版权归原作者所有,本站不承担相应法律责任。如您发现有侵权的内容,请联系我们。转载请注明出处:https://www.wpsshop.cn/w/笔触狂放9/article/detail/477035
推荐阅读
相关标签
  

闽ICP备14008679号