21ic电子技术开发论坛 › 单片机与嵌入式系统 › ST MCU › STM32F1定时器输出比较反转模式编程控制步进电机梯形加 ...
返回列表 发新帖我要提问

[STM32F1] STM32F1定时器输出比较反转模式编程控制步进电机梯形加减速

[复制链接]
1378|4
 楼主| beijinglaobai 发表于 2022-8-19 14:45 | 显示全部楼层 |阅读模式
控制步进电机, ST
利用STM32定时器输出比较反转模式编程控制输出的脉冲实现步进电机梯形加减速控制
首先定时定时器控制引脚及运行机构参数
复制
  1. /*********************** 步进电机控制定时器TIM参数定义 ************************/
    


  2. 

  3. #define SMOTOR1_TIMx                          TIM3
    

  4. #define SMOTOR1_TIM_RCC_CLK_ENABLE()          __HAL_RCC_TIM3_CLK_ENABLE()
    

  5. #define SMOTOR1_TIM_RCC_CLK_DISABLE()         __HAL_RCC_TIM3_CLK_DISABLE()
    

  6. #define SMOTOR1_TIM_IRQn                      TIM3_IRQn
    

  7. #define SMOTOR1_TIM_IRQHandler                TIM3_IRQHandler
    


  8. 

  9. #define TIMx_CLOCK_FREQ                       72e6  //72000000  //72M定时器时钟源的最高频率
    


  10. 

  11. // 定义定时器预分频，定时器实际时钟频率为：72MHz/（STEPMOTOR_TIMx_PRESCALER+1）
    

  12. #define SMOTOR1_TIM_PRESCALER               3  // 步进电机驱动器细分设置为：   32  细分
    


  13. 

  14. // 定义定时器周期，当定时器开始计数到SMOTOR1_TIM_PERIOD值是更新定时器并生成对应事
    

  15. // 件和中断.定时器更新频率为：定时器频率/(SMOTOR1_TIM_PERIOD+1) Hz
    

  16. #define SMOTOR1_TIM_PERIOD                    0xFFFF  
    

  17. #define SMOTOR1_TIM_DEFAULT_PULSE             (SMOTOR1_TIM_PERIOD>>1)
    


  18. 

  19. #define SMOTOR1_COUNTER_FREQ                 ((float)TIMx_CLOCK_FREQ / (SMOTOR1_TIM_PRESCALER+1))
    

  20.    
    


  21. 

  22. /*  定义控制输出引脚 */
    

  23. #define SMOTOR1_PUL_GPIO_CLK_ENABLE()         __HAL_RCC_GPIOC_CLK_ENABLE();
    

  24. #define SMOTOR1_PUL_GPIO_PORT                 GPIOC
    

  25. #define SMOTOR1_PUL_GPIO_PIN                  GPIO_PIN_6
    

  26. #define SMOTOR1_PUL_PIN_AF                    GPIO_AF3_TIM8 // 复用功能引脚
    

  27. #define SMOTOR1_PUL_TIMx_CHANNELx             TIM_CHANNEL_1
    

  28. #define SMOTOR1_ACTIVE_CHANNEL                HAL_TIM_ACTIVE_CHANNEL_1
    


  29. 

  30. #define SMOTOR1_DIR_GPIO_CLK_ENABLE()         __HAL_RCC_GPIOC_CLK_ENABLE();
    

  31. #define SMOTOR1_DIR_GPIO_PORT                 GPIOC
    

  32. #define SMOTOR1_DIR_GPIO_PIN                  GPIO_PIN_0
    

  33. #define SMOTOR1_DIR_PIN_AF                    0 // default 
    


  34. 

  35. #define SMOTOR1_ENA_GPIO_CLK_ENABLE()         __HAL_RCC_GPIOE_CLK_ENABLE();
    

  36. #define SMOTOR1_ENA_GPIO_PORT                 GPIOE
    

  37. #define SMOTOR1_ENA_GPIO_PIN                  GPIO_PIN_0
    

  38. #define SMOTOR1_ENA_PIN_AF                    0 // default 
    


  39. 

  40. /* 电机方向和使能控制 */
    

  41. #define SMOTOR1_DIR_FORWARE()                 HAL_GPIO_WritePin(\
    

  42.                                                 SMOTOR1_DIR_GPIO_PORT,\
    

  43.                                                 SMOTOR1_DIR_GPIO_PIN,\
    

  44.                                                 GPIO_PIN_SET\
    

  45.                                                 );
    

  46. #define SMOTOR1_DIR_REVERSAL()                HAL_GPIO_WritePin(\
    

  47.                                                 SMOTOR1_DIR_GPIO_PORT,\
    

  48.                                                 SMOTOR1_DIR_GPIO_PIN,\
    

  49.                                                 GPIO_PIN_RESET\
    

  50.                                                 );  
    


  51. 


  52. 

  53. #define SMOTOR1_ENABLE()                      HAL_GPIO_WritePin(\
    

  54.                                                 SMOTOR1_ENA_GPIO_PORT,\
    

  55.                                                 SMOTOR1_ENA_GPIO_PIN,\
    

  56.                                                 GPIO_PIN_RESET);
    

  57. #define SMOTOR1_DISABLE()                     HAL_GPIO_WritePin(\
    

  58.                                                 SMOTOR1_ENA_GPIO_PORT,\
    

  59.                                                 SMOTOR1_ENA_GPIO_PIN,\
    

  60.                                                 GPIO_PIN_SET)
    


  61. 

  62. //#define  DEFAULTSPEED                         600 // 初始默认速度 600*0.1 RPM
    


  63. 

  64. /************************* 步进电机与驱动器参数宏定义 *************************/
    


  65. 

  66. #define SMOTOR1_STEPANGLE                     (1.8f) // 步距角
    

  67. #define SMOTOR1_MICORSTEP                     (16U)  // 细分数
    

  68. #define SMOTOR1_PULSEREV                      (uint32_t)((SMOTOR1_MICORSTEP*360U)/SMOTOR1_STEPANGLE)// 360/(1.8/32),一转的步数
    

  69. #define SMOTOR1_RATEDSPEED                    (20000U) // 额定转速0.1RPM
然后定义设备运转参数

复制
  1. /* 电机方向定义 */
    

  2. typedef enum 
    

  3. {
    

  4.   MOTOR_DIR_CW = 0,
    

  5.   MOTOR_DIR_CCW
    

  6. }MotorDir_Typedef;
    


  7. 

  8. /* 电机使能状态定义 */
    

  9. typedef enum 
    

  10. {
    

  11.   MOTOR_ENABLE  = 0,
    

  12.   MOTOR_DISABLE
    

  13. }MotorSta_Typedef ;
    


  14. 

  15. /* 电机加减速曲线状态定义 */
    

  16. typedef enum{
    

  17.   STOP  = 0,   // 加减速曲线状态：停止
    

  18.   ACCEL,       // 加减速曲线状态：加速阶段
    

  19.   DECEL,       // 加减速曲线状态：减速阶段
    

  20.   RUN,         // 加减速曲线状态：匀速阶段  
    

  21. }MotorRunSta_Typedef;
    


  22. 

  23. /* 电机加减速参数类型定义 */
    

  24. typedef struct {
    

  25. // 加减速控制相关
    

  26. __IO  MotorRunSta_Typedef             run_state ; // 电机转动状态
    

  27.   int32_t                             decel_start;// 启动减速位置
    

  28.   int32_t                             decel_val;  // 减速阶段步数
    

  29.   int32_t                             min_delay;  // 最小脉冲周期(最大速度,即匀速段速度)
    

  30. __IO  int32_t                         step_delay; // 下个脉冲周期(时间间隔),启动时为加速度
    

  31. __IO  int32_t                         accel_count;// 加(减)速阶段步数计数值
    

  32. __IO  uint32_t                        step_count; // 步数记录
    

  33.    
    

  34. } SpeedRampData_Typedef;        
编写驱动引脚及定时器初始化函数

复制
  1. /*--------------------------- 主控制定时器 -----------------------------------*/
    

  2. /**
    

  3.   * 函数功能: 定时器硬件初始化配置
    

  4.   * 输入参数: 无
    

  5.   * 返 回 值: 无
    

  6.   * 说    明: 无
    

  7.   */
    

  8. static void  SMotor1_GPIO_MspInit(void)
    

  9. {
    

  10.   GPIO_InitTypeDef GPIO_InitStruct={0};
    

  11.   
    

  12.   /* 定时器引脚时钟使能 */
    

  13.   SMOTOR1_PUL_GPIO_CLK_ENABLE();
    

  14.   SMOTOR1_DIR_GPIO_CLK_ENABLE();
    

  15.   SMOTOR1_ENA_GPIO_CLK_ENABLE();
    

  16.   
    

  17.   /* 脉冲输出引脚配置 */  
    

  18.   GPIO_InitStruct.Pin       = SMOTOR1_PUL_GPIO_PIN ;
    

  19.   GPIO_InitStruct.Mode      = GPIO_MODE_AF_PP;      // 复用模式
    

  20.   GPIO_InitStruct.Pull      = GPIO_PULLUP;
    

  21.   GPIO_InitStruct.Speed     = GPIO_SPEED_FREQ_HIGH;
    

  22.   HAL_GPIO_Init(SMOTOR1_PUL_GPIO_PORT, &GPIO_InitStruct);
    

  23.   
    

  24.   /* 方向控制引脚配置 */  
    

  25.   GPIO_InitStruct.Pin       = SMOTOR1_DIR_GPIO_PIN;
    

  26.   GPIO_InitStruct.Mode      = GPIO_MODE_OUTPUT_PP;
    

  27. //  GPIO_InitStruct.Alternate = 0;        
    

  28.   GPIO_InitStruct.Pull      = GPIO_PULLUP;
    

  29.   HAL_GPIO_Init(SMOTOR1_DIR_GPIO_PORT, &GPIO_InitStruct);
    

  30.   
    

  31.   /* 电机使能引脚配置 */  
    

  32.   GPIO_InitStruct.Pin       = SMOTOR1_ENA_GPIO_PIN;
    

  33.   HAL_GPIO_Init(SMOTOR1_ENA_GPIO_PORT, &GPIO_InitStruct);
    

  34.   
    

  35.   /* NVIC中断优先级配置 */
    

  36.   HAL_NVIC_SetPriority(SMOTOR1_TIM_IRQn, 0, 0);
    

  37.   HAL_NVIC_EnableIRQ(SMOTOR1_TIM_IRQn);
    

  38.   
    

  39. }
    


  40. 

  41. /**
    

  42.   * 函数功能: 步进电机控制定时器初始化
    

  43.   * 输入参数: 无
    

  44.   * 返 回 值: 无
    

  45.   * 说    明: 初始化PWM输出功能
    

  46.   */
    

  47. void SMOTOR1_TIMx_Init(void)
    

  48. {
    

  49.   TIM_ClockConfigTypeDef sClockSourceConfig={0};
    

  50.   TIM_BreakDeadTimeConfigTypeDef sconfigBDTR={0};
    

  51.   TIM_OC_InitTypeDef sConfigOC={0};
    

  52.   TIM_MasterConfigTypeDef sMasterConfig={0};
    

  53.   /* 定时器硬件配置 */
    

  54.   SMotor1_GPIO_MspInit();
    

  55.   
    

  56.   __HAL_AFIO_REMAP_TIM3_ENABLE();//TIM3端口完全重映射
    

  57.         
    

  58.   /* 定时器外设配置 */
    

  59.   SMOTOR1_TIM_RCC_CLK_ENABLE();
    

  60.   htimx_SMotor1.Instance               = SMOTOR1_TIMx;
    

  61. //  htimx_SMotor1.Init.Prescaler         = SMOTOR1_TIM_PRESCALER;
    

  62.   htimx_SMotor1.Init.CounterMode       = TIM_COUNTERMODE_UP;
    

  63.   htimx_SMotor1.Init.Period            = SMOTOR1_TIM_PERIOD;
    

  64.   htimx_SMotor1.Init.ClockDivision     = TIM_CLOCKDIVISION_DIV1;
    

  65. //  htimx_SMotor1.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
    

  66.   HAL_TIM_PWM_Init(&htimx_SMotor1);
    


  67. 

  68.   /* 时钟源配置 */
    

  69.   sClockSourceConfig.ClockSource    = TIM_CLOCKSOURCE_INTERNAL; // 内部时钟
    

  70.   sClockSourceConfig.ClockPrescaler = TIM_CLOCKPRESCALER_DIV1;  // 无时钟预分频
    

  71.   sClockSourceConfig.ClockPolarity  = TIM_CLOCKPOLARITY_INVERTED;// 无效配置
    

  72.   sClockSourceConfig.ClockFilter    = 0x0;  
    

  73.   HAL_TIM_ConfigClockSource(&htimx_SMotor1, &sClockSourceConfig);
    

  74.   
    

  75.   sMasterConfig.MasterOutputTrigger = TIM_TRGO_UPDATE;
    

  76.   sMasterConfig.MasterSlaveMode     = TIM_MASTERSLAVEMODE_ENABLE;
    

  77. //  sMasterConfig.MasterOutputTrigger2= TIM_TRGO2_RESET;
    

  78.   HAL_TIMEx_MasterConfigSynchronization(&htimx_SMotor1,&sMasterConfig);
    

  79.   
    

  80.   /* 死区时间和状态配置 */
    

  81.   /** 这里主要配置高级定时器的互补通道输出控制,对于刹车功能的配置是无效的
    

  82.     * 如果使用非高级定时器,可以注释掉这段代码
    

  83.     */
    

  84.   sconfigBDTR.OffStateRunMode  = TIM_OSSR_DISABLE;  // 关闭时的运行模式输出极性 
    

  85.   sconfigBDTR.OffStateIDLEMode = TIM_OSSI_DISABLE;  // 关闭时的空闲模式输出极性
    

  86.   sconfigBDTR.BreakState       = TIM_BREAK_DISABLE; // 不使用刹车功能
    

  87.   sconfigBDTR.BreakPolarity    = TIM_BREAKPOLARITY_LOW;
    

  88.   sconfigBDTR.DeadTime         = 0; // Min_Data = 0x00 and Max_Data = 0xFF
    

  89.   sconfigBDTR.LockLevel        = TIM_LOCKLEVEL_OFF;
    

  90. //  sconfigBDTR.Break2Filter     = 0; // Min_Data = 0x0 and Max_Data = 0xF
    

  91. //  sconfigBDTR.Break2Polarity   = TIM_BREAK2POLARITY_LOW;
    

  92. //  sconfigBDTR.Break2State      = TIM_BREAK2_DISABLE;
    

  93.   sconfigBDTR.AutomaticOutput  = TIM_AUTOMATICOUTPUT_DISABLE;
    

  94.   HAL_TIMEx_ConfigBreakDeadTime(&htimx_SMotor1, &sconfigBDTR);
    

  95.   
    

  96.   /* PWM配置,CH1 PWM Mode*/
    

  97.   sConfigOC.OCMode       = TIM_OCMODE_TOGGLE;
    

  98.   sConfigOC.Pulse        = SMOTOR1_TIM_DEFAULT_PULSE;
    

  99.   sConfigOC.OCPolarity   = TIM_OCPOLARITY_HIGH;
    

  100.   sConfigOC.OCNPolarity  = TIM_OCNPOLARITY_HIGH;
    

  101.   sConfigOC.OCIdleState  = TIM_OCIDLESTATE_RESET;
    

  102.   sConfigOC.OCNIdleState = TIM_OCNIDLESTATE_RESET;
    

  103.   sConfigOC.OCFastMode   = TIM_OCFAST_DISABLE;
    

  104.   HAL_TIM_OC_ConfigChannel(&htimx_SMotor1, &sConfigOC, SMOTOR1_PUL_TIMx_CHANNELx);
    

  105.   
    

  106.   /* 配置电机默认状态,默认禁止电机转动,并且方向是顺时针转动 */
    

  107.   SMotor1_Set_Dir  ( MOTOR_DIR_CW ); // 电机方向,默认顺时针转动.
    

  108.   SMotor1_Set_State( MOTOR_DISABLE );// 电机状态,默认禁止
    

  109. }
    


  110. 

  111. /**
    

  112.   * 函数功能: 设置电机方向
    

  113.   * 输入参数: ptrSMotor 步进电机控制句柄指针
    

  114.   *           Dir 电机方向 参数可选: 
    

  115.   *               [url=home.php?mod=space&uid=2817080]@ARG[/url]  MOTOR_DIR_CW
    

  116.   *               @arg  MOTOR_DIR_CCW
    

  117.   * 返 回 值:
    

  118.   * 说    明:设置步进电机的方向.控制驱动器的DIR端口
    

  119.   */
    

  120. void SMotor1_Set_Dir(MotorDir_Typedef Dir)
    

  121. {
    

  122.   /* 设置对应编号的步进电机方向 */
    

  123.   Motor_Dir = Dir;
    

  124.   if(Dir == MOTOR_DIR_CW)
    

  125.   {
    

  126.     SMOTOR1_DIR_FORWARE();
    

  127.   }
    

  128.   else 
    

  129.   {
    

  130.     SMOTOR1_DIR_REVERSAL();
    

  131.   }
    

  132. }
    


  133. 

  134. /**
    

  135.   * 函数功能: 设置电机状态
    

  136.   * 输入参数: ptrSMotor 步进电机控制结构体指针
    

  137.   *           Ena 电机状态 参数可选: 
    

  138.   *               @arg  MOTOR_ENABLE
    

  139.   *               @arg  MOTOR_DISABLE
    

  140.   * 返 回 值:
    

  141.   * 说    明: 设置步进电机的状态,控制驱动器的ENA端口
    

  142.   */
    

  143. void SMotor1_Set_State( MotorSta_Typedef Ena)
    

  144. {
    

  145.   /* 设置对应编号的步进电机方向 */
    

  146.   Motor_State = Ena;
    

  147.   if(Ena == MOTOR_ENABLE)
    

  148.   {
    

  149.     SMOTOR1_ENABLE();
    

  150.   }
    

  151.   else 
    

  152.   {
    

  153.     SMOTOR1_DISABLE();
    

  154.   }
    

  155. }
编辑定时器中断处理函数

复制
  1. /**
    

  2.   * 函数功能: 定时器中断回调函数
    

  3.   * 输入参数: 无
    

  4.   * 返 回 值: 无
    

  5.   * 说    明: 实现加减速过程
    

  6.   */
    

  7. void HAL_TIM_OC_DelayElapsedCallback(TIM_HandleTypeDef *htim)
    

  8. { 
    

  9.   uint32_t tmp = 0;
    

  10.   // 保存新（下）一个延时周期
    

  11.   uint32_t new_step_delay = 0;
    

  12.   // 加速过程中最后一次延时（脉冲周期）.
    

  13.   __IO static uint16_t last_accel_delay = 0;
    

  14.   // 总移动步数计数器
    

  15.   __IO static uint32_t step_count = 0;
    

  16.   // 记录new_step_delay中的余数，提高下一步计算的精度
    

  17.   __IO static int32_t rest = 0;
    

  18.   //定时器使用翻转模式，需要进入两次中断才输出一个完整脉冲
    

  19.   __IO static uint8_t i = 0;
    

  20.    
    

  21.   if(htim->Channel == SMOTOR1_ACTIVE_CHANNEL)
    

  22.   { 
    

  23.     // 设置比较值    
    

  24.     tmp =__HAL_TIM_GET_COMPARE(&htimx_SMotor1,SMOTOR1_PUL_TIMx_CHANNELx);
    

  25.     tmp += srd.step_delay;
    

  26.     __HAL_TIM_SET_COMPARE(&htimx_SMotor1,SMOTOR1_PUL_TIMx_CHANNELx,(uint16_t)tmp );
    


  27. 

  28.     i++;       // 定时器中断次数计数值
    

  29.     if( ( i & 0x01) == 0) // 偶数，输出一个完整脉冲    
    

  30.     {
    

  31.       switch(srd.run_state) // 加减速曲线阶段
    

  32.       {
    

  33.         case STOP:
    

  34.           step_count = 0;  // 清零步数计数器
    

  35.           rest = 0;        // 清零余值
    

  36.           last_accel_delay = 0;
    

  37.           // 关闭通道
    

  38.           Stop_MotorMoving();
    

  39.           break;
    


  40. 

  41.         case ACCEL:
    

  42.           step_count++;      // 步数加1
    

  43.           srd.accel_count++; // 加速计数值加1
    

  44.         
    

  45.           new_step_delay = srd.step_delay - (((2 * srd.step_delay) + rest)/(4 * srd.accel_count + 1));//计算新(下)一步脉冲周期(时间间隔)
    

  46.           rest = ((2 * srd.step_delay)+rest)%(4 * srd.accel_count + 1);// 计算余数，下次计算补上余数，减少误差
    

  47.         
    

  48.           if(step_count >= srd.decel_start)// 检查是够应该开始减速
    

  49.           {
    

  50.             srd.accel_count = srd.decel_val; // 加速计数值为减速阶段计数值的初始值
    

  51.             srd.run_state = DECEL;           // 下个脉冲进入减速阶段
    

  52.           }
    

  53.           else if(new_step_delay <= srd.min_delay) // 检查是否到达期望的最大速度
    

  54.           {
    

  55.             last_accel_delay = new_step_delay; // 保存加速过程中最后一次延时（脉冲周期）
    

  56.             new_step_delay = srd.min_delay;    // 使用min_delay（对应最大速度speed）
    

  57.             rest = 0;                          // 清零余值
    

  58.             srd.run_state = RUN;               // 设置为匀速运行状态
    

  59.           }
    

  60.           break;
    


  61. 

  62.         case RUN:
    

  63.           step_count ++;  // 步数加1
    

  64.           new_step_delay = srd.min_delay;     // 使用min_delay（对应最大速度speed）
    

  65.           if(step_count >= srd.decel_start)   // 需要开始减速
    

  66.           {
    

  67.             srd.accel_count = srd.decel_val;  // 减速步数做为加速计数值
    

  68.             new_step_delay = last_accel_delay;// 加阶段最后的延时做为减速阶段的起始延时(脉冲周期)
    

  69.             srd.run_state = DECEL;            // 状态改变为减速
    

  70.           }
    

  71.           break;
    


  72. 

  73.         case DECEL:
    

  74.           step_count++;  // 步数加1
    

  75.           srd.accel_count++;
    

  76.           new_step_delay = srd.step_delay - (((2 * srd.step_delay) + rest)/(4 * srd.accel_count + 1)); //计算新(下)一步脉冲周期(时间间隔)
    

  77.           rest = ((2 * srd.step_delay)+rest)%(4 * srd.accel_count + 1);// 计算余数，下次计算补上余数，减少误差
    

  78.           
    

  79.           //检查是否为最后一步
    

  80.           if(srd.accel_count >= -1)
    

  81.           {
    

  82.             srd.run_state = STOP;
    

  83.           }
    

  84.           break;
    

  85.       }     
    

  86.       if(new_step_delay>0xFFFF)
    

  87.         new_step_delay = 0xFFFF;
    

  88.       srd.step_delay = new_step_delay; // 为下个(新的)延时(脉冲周期)赋值
    

  89.     }
    

  90.   }
    

  91. }
    


  92.



然后编写梯形加减速控制算法函数

复制
  1. /****************************** 梯形加减速控制 ********************************/
    

  2. /**
    

  3.   * 函数功能: 停止电机转动
    

  4.   * 输入参数: 无
    

  5.   * 返 回 值: 无
    

  6.   * 说    明: 禁止输出PWM,失能电机
    

  7.   */
    

  8. static void  Stop_MotorMoving()
    

  9. {
    

  10.   HAL_TIM_OC_Stop_IT(&htimx_SMotor1, SMOTOR1_PUL_TIMx_CHANNELx);
    

  11.   LED1_OFF();
    

  12. }
    


  13. 

  14. /**
    

  15.   * 函数功能: 步进电机线性速度控制
    

  16.   * 输入参数: StepMotor 包含了梯形加减速速度控制所需要的参数包括有:
    

  17.   *           @arg  Step  总的步数,单位是步数,也就是脉冲数,1转的脉冲数就是SMOTOR1_PULSEREV
    

  18.   *           @arg  Accel 加速度,单位是r/s^2
    

  19.   *           @arg  Decel 减速度,单位是r/s^2
    

  20.   *           @arg  Speed 最高速度,单位是r/s
    

  21.   * 返 回 值: 无
    

  22.   * 说    明: 计算初始速度值,和各种限制条件,启动脉冲输出
    

  23.   */
    

  24. void STEPMOTOR_LSCMoveRel (float step, float accel,float decel, float speed)
    

  25. {
    

  26.   /* 由于时间变化的一倍,所以速度和加速度也相应的乘上2和4 */
    

  27.   accel = accel * 4; // 由于使用比较翻转模式,
    

  28.   decel = decel * 4; // 计算结果是半个周期的比较值
    

  29.   speed = speed * 2; // 所以时间也要做相应的调整.(t = t*2)
    

  30.   
    

  31.   /* 达到设定的速度时需要的步数 */
    

  32.         float max_s_lim;
    

  33.   /* 必须要开始减速的步数（如果加速没有达到最大速度）*/
    

  34.         float accel_lim;
    

  35.   /* 预分频系数 */
    

  36.   
    

  37.   uint32_t tmp = 0;
    

  38.   
    

  39.   LED1_ON();
    

  40.   
    

  41.   /* 计算起始速度和最大速度对应的定时器周期值 */
    

  42.   // 通过计算第一个(c0) 的步进延时来设定加速度，其中accel单位为 Rev/sec^2
    

  43.   // step_delay = 1/tt * sqrt(2*alpha/accel)
    

  44.   // step_delay = ( tfreq*0.676 ) * sqrt( (2*alpha) / accel )
    

  45.   srd.step_delay = round((SMOTOR1_COUNTER_FREQ * sqrtf(ALPHA_x2 / accel))*0.676f);//C0,初始速度的定时器值
    

  46.   
    

  47.   // 设置最大速度极限.
    

  48.   srd.min_delay = round((ALPHA * SMOTOR1_COUNTER_FREQ ) / speed);
    

  49.   
    

  50.   /* 计算加减速需要的参数 */
    

  51.   // 计算多少步之后达到最大速度的限制
    

  52.   // max_s_lim = speed^2 / (2*alpha*accel)
    

  53.   max_s_lim = speed * speed / (ALPHA_x2 * accel) ;
    

  54.     
    

  55.   // 计算多少步之后必须开始减速
    

  56.   // n1 = (n1+n2)decel / (accel + decel)
    

  57.   accel_lim =  step*decel / (accel + decel) ;  
    

  58.   
    

  59.   /* 计算加速限制条件和开始减速的位置 */
    

  60.   // 使用限制条件可以计算出减速阶段步数
    

  61.   if(accel_lim <= max_s_lim)
    

  62.   {
    

  63.     srd.decel_val = (int32_t)(accel_lim - step);
    

  64.   }
    

  65.   else
    

  66.   {
    

  67.     srd.decel_val = round (- fabs ( max_s_lim * accel / decel) );
    

  68.   }
    

  69.   // 计算开始减速时的步数
    

  70.   srd.decel_start = (int32_t)(step + srd.decel_val);
    

  71.   srd.accel_count = 0;
    

  72.   srd.run_state = ACCEL; 
    

  73.   
    

  74.   SMotor1_Set_Dir(MOTOR_DIR_CW);//  默认方向是顺时针
    

  75.   SMotor1_Set_State(MOTOR_ENABLE);//  使能电机转动
    

  76.   
    

  77.     // 设置比较值    
    

  78.   tmp =__HAL_TIM_GET_COUNTER(&htimx_SMotor1);
    

  79.   tmp += srd.step_delay;
    

  80.   __HAL_TIM_SET_COMPARE(&htimx_SMotor1,SMOTOR1_PUL_TIMx_CHANNELx,(uint16_t)tmp);  
    

  81.   HAL_TIM_OC_Start_IT(&htimx_SMotor1, SMOTOR1_PUL_TIMx_CHANNELx);
    

  82. }


设置运行参数

复制
  1. #define MOTORSPEED        10.0f   //  单位是r/s 
    

  2. #define ACCEL             5.0f    //  单位是r/(s^2)
    

  3. #define DECEL             5.0f    //  单位是r/(s^2)
    

  4. #define STEP              (10*SMOTOR1_PULSEREV) // (100转 的脉冲数,一转是6400)


在主程序中调用初始化程序，运行控制代码就可以了

复制
  1.   /* 初始化配置步进电机1控制定时器 */
    

  2.   SMOTOR1_TIMx_Init();
    


  3. 


  4. 

  5.       STEPMOTOR_LSCMoveRel(STEP, ACCEL, DECEL, MOTORSPEED);   


回复

收藏 举报

相关帖子
littlelida 发表于 2022-8-21 13:59 | 显示全部楼层
实测效果如何
回复

收藏 举报

 楼主| beijinglaobai 发表于 2022-8-21 14:46 | 显示全部楼层

回复

收藏 举报

 楼主| beijinglaobai 发表于 2022-8-21 14:48 | 显示全部楼层

回复

收藏 举报

死不低头 发表于 2025-3-31 22:54 | 显示全部楼层
这样速度上不去
回复

收藏 举报

返回列表 发新帖
高级模式
B Color Image Link Quote Code Smilies
您需要登录后才可以回帖 登录 | 注册

本版积分规则

beijinglaobai

58

主题

113

帖子

1

粉丝
快速回复 在线客服 返回列表 返回顶部