1. 项目背景与核心需求
在工业控制、3D打印、CNC加工等领域，步进电机的运动控制一直是关键环节。传统的匀速运动或简单线性加减速在实际应用中往往会产生机械振动、丢步等问题。S型加减速曲线因其加速度连续变化的特性，能够显著改善电机启停时的平稳性。
STM32F103作为经典的Cortex-M3内核微控制器，凭借其丰富的外设资源和适中的价格，成为中小型运动控制项目的首选。但受限于72MHz主频和单精度浮点运算能力，如何在其上高效实现S型加减速算法，一直是工程师们关注的焦点。
2. S型曲线数学原理剖析
2.1 基本数学模型
S型曲线的核心是加速度随时间呈连续变化，其数学表达式为分段函数：
code复制a(t) = J*t (加速阶段)
a(t) = A_max (匀速加速阶段)
a(t) = A_max - J*(t-t1) (减速阶段)
其中J为加加速度（Jerk），A_max为最大加速度。这种设计使得速度曲线呈现平滑的"S"形过渡。
2.2 离散化处理
在嵌入式实现中，我们需要将连续曲线离散化为步进电机的脉冲序列。关键参数包括：
- 起始速度V_start
- 最大速度V_max
- 加速度A_max
- 加加速度J
- 总步数Steps
通过积分运算可以得到各时间点的理论速度：
c复制float calc_s_curve_velocity(float t) {
if (t < t1) {
return V_start + 0.5*J*t*t;
} else if (t < t2) {
return V1 + A_max*(t-t1);
} else {
return V2 + A_max*(t-t2) - 0.5*J*(t-t2)*(t-t2);
}
}
3. STM32硬件实现方案
3.1 定时器配置
使用TIM1/TIM8高级定时器生成PWM脉冲：
c复制void TIM1_Init(uint32_t arr, uint32_t psc) {
TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure;
RCC_APB2PeriphClockCmd(RCC_APB2Periph_TIM1, ENABLE);
TIM_TimeBaseStructure.TIM_Period = arr;
TIM_TimeBaseStructure.TIM_Prescaler = psc;
TIM_TimeBaseStructure.TIM_ClockDivision = 0;
TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;
TIM_TimeBaseInit(TIM1, &TIM_TimeBaseStructure);
TIM_Cmd(TIM1, ENABLE);
TIM_CtrlPWMOutputs(TIM1, ENABLE);
}
3.2 速度曲线生成
采用查表法+实时计算混合方案：
- 预计算加速段的速度表格
- 运行时通过插值计算实际周期
c复制uint32_t get_next_period(uint32_t step) {
if (step < accel_steps) {
return accel_table[step];
} else if (step < (total_steps - decel_steps)) {
return min_period;
} else {
return decel_table[step - (total_steps - decel_steps)];
}
}
4. 关键参数整定技巧
4.1 参数相互关系
各参数间存在严格的约束关系：
code复制总位移 = ∫v(t)dt
最大速度受限于：
V_max ≤ √(A_max/J)
4.2 实用调试方法
- 先确定机械系统允许的最大加加速度J
- 根据负载惯量设定A_max
- 通过实验微调曲线平滑度
典型参数范围：
- 3D打印机：J=200-500 mm/s³
- CNC机床：J=50-200 mm/s³
5. 性能优化策略
5.1 定点数运算优化
将浮点运算转换为Q格式定点数：
c复制#define Q 14
int32_t q_mul(int32_t a, int32_t b) {
return (a * b) >> Q;
}
int32_t velocity_to_period(int32_t vel) {
return (1 << Q) / vel;
}
5.2 中断优化方案
使用TIM中断+DMA传输组合：
- 预先计算多个周期的ARR值
- 通过DMA循环写入TIMx_ARR
- 减少CPU中断开销
6. 实测波形分析
通过逻辑分析仪捕获的典型波形特征：
- 加速阶段：脉冲周期逐渐缩短
- 匀速阶段：周期保持稳定
- 减速阶段：脉冲周期逐渐增长
异常波形诊断：
- 出现周期跳变：检查中断优先级
- 速度波动大：调整Jerk值
- 丢步现象：降低A_max
7. 进阶应用扩展
7.1 多轴联动控制
通过主从定时器同步：
c复制TIM_SelectInputTrigger(TIM2, TIM_TS_ITR0);
TIM_SelectSlaveMode(TIM2, TIM_SlaveMode_Gated);
7.2 动态参数调整
运行时修改曲线参数：
c复制void update_profile(float new_vmax, float new_accel) {
// 临界点保护
if (current_step > decel_start) return;
// 重新计算剩余步数
recalc_decel_steps();
}
8. 常见问题解决方案
-
电机异响振动：
- 降低初始Jerk值
- 检查机械传动间隙
- 增加微步细分
-
定位不准确：
- 校验步距角参数
- 检查驱动器电流设置
- 增加闭环反馈
-
高速丢步：
- 提升供电电压
- 优化加速曲线
- 检查线缆质量
实际调试中发现，机械系统的谐振频率会显著影响S型曲线的效果。建议先用低频扫频测试找出机械共振点，然后在速度规划中避开这些频段。
9. 完整实现代码结构
工程文件组织示例：
code复制/motor_control
├── /drivers
│ ├── timer.c # 定时器配置
│ └── gpio.c # 接口驱动
├── /algorithm
│ ├── scurve.c # S曲线计算
│ └── planner.c # 运动规划
└── /application
├── main.c # 主逻辑
└── config.h # 参数配置
核心调度逻辑：
c复制while(1) {
if (new_command) {
plan_movement(target, vmax, accel);
start_movement();
}
if (is_moving) {
update_position();
check_limits();
}
}
经过多个实际项目验证，这套方案在STM32F103上可实现：
- 最高10kHz的脉冲频率
- 加减速过程平滑无抖动
- 定位精度±1个脉冲
- CPU占用率<30%
对于更复杂的多轴协调运动，可以考虑升级到STM32F4系列芯片，其硬件FPU和更高主频能够处理更精细的运动规划。但在成本敏感的应用中，F103经过优化的S型曲线算法仍然是性价比极高的选择。