STM32步进电机S型与T型加减速控制算法实现

一、算法原理概述

步进电机加减速控制的核心是通过调整脉冲频率实现速度平滑变化，避免启停时的机械冲击和失步。常见算法包括T型（梯形）加减速和S型加减速：

1. T型加减速（梯形加减速）

• 原理：速度随时间呈线性变化（加速度恒定），形成“加速-匀速-减速”三段式梯形速度曲线。
• 特点：实现简单，计算量小，适用于对平稳性要求不高的场景（如3D打印机快速移动）。
• 阶段划分：
  • 加速段：速度从0线性增加到最大速度 \(V_{max}\)，加速度 a恒定。
  • 匀速段：速度保持 \(V_{max}\)不变。
  • 减速段：速度从 \(V_{max}\)线性减小到0，加速度 \(−a\)。

2. S型加减速（S曲线加减速）

• 原理：加速度随时间呈线性变化（加加速度 \(j\)恒定），速度曲线为S形，减少机械冲击。
• 特点：启停更平稳，适用于高精度运动控制（如CNC机床、医疗机器人）。
• 阶段划分（7段式）：
  • 加加速段（\(j>0\)）：加速度从0增加到 \(a_{max}\)。
  • 匀加速段（\(a=a_{max}\)）：加速度恒定，速度线性增加。
  • 减加速段（\(j<0\)）：加速度从 \(a_{max}\)减小到0。
  • 匀速段：速度保持 \(V_{max}\)。
  • 加减速段（\(j<0\)）：加速度从0减小到 \(−a_{max}\)。
  • 匀减速段（\(a=−a_{max}\)）：加速度恒定，速度线性减小。
  • 减减速段（\(j>0\)）：加速度从 \(−a_{max}\)增加到0。

二、T型加减速控制实现（STM32）

1. 核心参数定义

参数	符号	说明
总步数	\(N_{total}\)	目标运动步数
最大速度	\(V_{max}\)	匀速段速度（步/秒）
加速度	\(a\)	加速/减速段加速度（步/秒²）
加速时间	\(t_{acc}\)	加速段时间 \(t_{acc}=V_{max}/a\)
加速步数	\(N_{acc}\)	加速段步数 \(N_{acc}=V_{max}^2/(2a)\)
匀速步数	\(N_{const}\)	\(N_{const}=N_{total}−N_{acc}−N_{dec}\)
减速步数	\(N_{dec}\)	与加速步数相同（对称加减速）

2. 关键计算逻辑

• 判断是否达到最大速度：若 \(N_{total}<2N_{acc}\)，则无法达到 \(V_{max}\)，需重新计算实际最大速度 \(V_{real}=\sqrt{aN_{total}}\)。

• 脉冲间隔计算：加速段第 \(i\)步的脉冲间隔 \(T_i=T_0+i⋅(1/a)\)（\(T_0\)为初始间隔），通过定时器ARR值实现。

3. STM32实现代码（基于HAL库）

（1）定时器配置（脉冲输出）

使用TIM2的OC模式输出脉冲，通过修改ARR和CCR控制频率和占空比（占空比50%）。

TIM_HandleTypeDef htim2;
void TIM2_Init(uint32_t freq) {
  htim2.Instance = TIM2;
  htim2.Init.Prescaler = 72-1; // 72MHz/72=1MHz
  htim2.Init.CounterMode = TIM_COUNTERMODE_UP;
  htim2.Init.Period = (1000000 / freq) - 1; // 频率=freq Hz
  htim2.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
  HAL_TIM_PWM_Init(&htim2);
  
  TIM_OC_InitTypeDef sConfigOC = {0};
  sConfigOC.OCMode = TIM_OCMODE_PWM1;
  sConfigOC.Pulse = htim2.Init.Period / 2; // 50%占空比
  sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
  HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_1);
  HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_1);
}

（2）T型加减速控制函数

typedef struct {
  uint32_t total_steps;  // 总步数
  uint32_t max_speed;    // 最大速度（步/秒）
  uint32_t accel;        // 加速度（步/秒²）
  uint32_t current_step; // 当前步数
  uint32_t current_speed;// 当前速度（步/秒）
  uint8_t state;         // 状态：0-停止，1-加速，2-匀速，3-减速
} T_Profile;

T_Profile t_profile;

// 初始化T型加减速参数
void T_Profile_Init(uint32_t total_steps, uint32_t max_speed, uint32_t accel) {
  t_profile.total_steps = total_steps;
  t_profile.max_speed = max_speed;
  t_profile.accel = accel;
  t_profile.current_step = 0;
  t_profile.current_speed = 0;
  t_profile.state = 1; // 初始加速
  
  // 计算加速步数
  uint32_t N_acc = (max_speed * max_speed) / (2 * accel);
  if (total_steps < 2 * N_acc) {
    // 无法达到最大速度，重新计算实际最大速度
    t_profile.max_speed = sqrt(accel * total_steps);
    N_acc = total_steps / 2;
  }
  t_profile.N_acc = N_acc;
  t_profile.N_dec = N_acc;
  t_profile.N_const = total_steps - 2 * N_acc;
}

// 更新速度（在定时器中断中调用，周期1ms）
void T_Profile_Update(void) {
  if (t_profile.current_step >= t_profile.total_steps) {
    t_profile.state = 0; // 停止
    HAL_TIM_PWM_Stop(&htim2, TIM_CHANNEL_1);
    return;
  }
  
  switch (t_profile.state) {
    case 1: // 加速段
      t_profile.current_speed += t_profile.accel / 1000; // 1ms更新一次
      if (t_profile.current_speed >= t_profile.max_speed) {
        t_profile.current_speed = t_profile.max_speed;
        t_profile.state = 2; // 进入匀速
      }
      if (t_profile.current_step >= t_profile.N_acc) {
        t_profile.state = 3; // 提前进入减速（短距离）
      }
      break;
      
    case 2: // 匀速段
      if (t_profile.current_step >= t_profile.N_acc + t_profile.N_const) {
        t_profile.state = 3; // 进入减速
      }
      break;
      
    case 3: // 减速段
      t_profile.current_speed -= t_profile.accel / 1000;
      if (t_profile.current_speed < 0) t_profile.current_speed = 0;
      break;
  }
  
  // 更新定时器频率（步/秒 -> 频率Hz）
  uint32_t freq = t_profile.current_speed;
  __HAL_TIM_SET_AUTORELOAD(&htim2, (1000000 / freq) - 1);
  t_profile.current_step++;
}

三、S型加减速控制实现（STM32）

1. 核心参数定义

参数	符号	说明
最大速度	\(V_{max}\)	匀速段速度（步/秒）
最大加速度	\(a_{max}\)	匀加速段加速度（步/秒²）
加加速度（ jerk ）	\(j\)	加速度变化率（步/秒³）
加加速时间	\(t_j\)	\(t_j=a_{max}/j\)
总加速时间	\(t_{acc}\)	\(t_{acc}=2t_j+(V_{max}−a_{max}t_j)/a_{max}\)

2. 关键计算逻辑

• 7段式S曲线参数计算：

  • 加加速段步数：\(N_1=\frac{1}{6}jt_j^3\)

  • 匀加速段步数：\(N_2=a_{max}t_j^2+\frac{1}{2}jt_j^3\)

  • 减加速段步数：\(N_3=N_1\)

  • 匀速段步数：\(N_4=N_{total}−2(N_1+N_2+N_3)−(N_5+N_6+N_7)\)（对称减速段）

3. STM32实现代码（简化7段式）

typedef struct {
  uint32_t total_steps;
  uint32_t max_speed;
  uint32_t max_accel;
  uint32_t jerk;
  uint32_t current_step;
  uint32_t current_speed;
  uint32_t current_accel;
  uint8_t state; // 0-停止，1-加加速，2-匀加速，3-减加速，4-匀速，5-加减速，6-匀减速，7-减减速
} S_Profile;

S_Profile s_profile;

// 初始化S型加减速参数
void S_Profile_Init(uint32_t total_steps, uint32_t max_speed, uint32_t max_accel, uint32_t jerk) {
  s_profile.total_steps = total_steps;
  s_profile.max_speed = max_speed;
  s_profile.max_accel = max_accel;
  s_profile.jerk = jerk;
  s_profile.current_step = 0;
  s_profile.current_speed = 0;
  s_profile.current_accel = 0;
  s_profile.state = 1; // 加加速段
  
  // 计算加加速时间t_j
  uint32_t t_j = max_accel / jerk;
  s_profile.t_j = t_j;
}

// 更新S型加减速（在定时器中断中调用）
void S_Profile_Update(void) {
  if (s_profile.current_step >= s_profile.total_steps) {
    s_profile.state = 0;
    HAL_TIM_PWM_Stop(&htim2, TIM_CHANNEL_1);
    return;
  }
  
  switch (s_profile.state) {
    case 1: // 加加速段（j>0）
      s_profile.current_accel += s_profile.jerk / 1000; // 1ms更新
      if (s_profile.current_accel >= s_profile.max_accel) {
        s_profile.current_accel = s_profile.max_accel;
        s_profile.state = 2; // 匀加速
      }
      break;
      
    case 2: // 匀加速段
      s_profile.current_speed += s_profile.current_accel / 1000;
      if (s_profile.current_speed >= s_profile.max_speed) {
        s_profile.current_speed = s_profile.max_speed;
        s_profile.state = 3; // 减加速
      }
      break;
      
    case 3: // 减加速段（j<0）
      s_profile.current_accel -= s_profile.jerk / 1000;
      if (s_profile.current_accel <= 0) {
        s_profile.current_accel = 0;
        s_profile.state = 4; // 匀速
      }
      break;
      
    // 减速段与加速段对称，省略...
  }
  
  // 更新速度和定时器频率
  s_profile.current_speed += s_profile.current_accel / 1000;
  uint32_t freq = s_profile.current_speed;
  __HAL_TIM_SET_AUTORELOAD(&htim2, (1000000 / freq) - 1);
  s_profile.current_step++;
}

参考代码 STM32步进电机 S型T型加减速控制算法 www.youwenfan.com/contentcns/182531.html

四、关键优化与注意事项

1. 脉冲精度提升

• 使用32位定时器（如TIM2/TIM5）提高频率分辨率。

• 采用中断嵌套或DMA减少中断延迟，确保脉冲间隔准确。

2. 多轴联动

• 为每个轴独立计算加减速曲线，通过插补算法（如直线插补、圆弧插补）同步脉冲输出。

3. 实时性保障

• 加减速计算放在后台任务，脉冲输出在定时器中断中完成，避免阻塞。

4. 参数自整定

• 根据电机负载动态调整加速度和加加速度，避免失步（如通过电流反馈检测负载）。

五、应用场景对比

算法	优点	缺点	适用场景
T型加减速	计算简单，实时性好	冲击大，平稳性差	3D打印快速移动、简单机械臂
S型加减速	启停平稳，冲击小	计算复杂，需更多资源	CNC机床、医疗机器人、精密定位