1. 从一次撞机事故说起：梯形加减速解决不了的问题
1.1 那次“咔咔咔”的声音和一顿一顿的走位
STM32步进电机S型加减速程序源码与分析这类话题，我其实是被一次事故“逼”着开始研究的。早年间帮一个朋友调一台小型贴标机构的Y轴，电机带着同步带和滑块跑，空机测试时一切正常，一装上标签卷和导向机构，问题全出来了：启动瞬间整个横梁“咔”一声，像是在硬生生撞什么东西；匀速跑动时能明显感觉到滑块一顿一顿，不是流畅地走，而是一格一格地蹦；更麻烦的是停止时总要有几毫米的过冲，把标签贴歪。那时候第一反应是机械装配有问题，调了张紧轮、换了同步带，甚至换过电机，折腾了一周也没解决。
后来才意识到，问题根本不在机械，而在速度规划。步进电机和伺服电机不一样，它不靠闭环反馈知道当前位置，而是严格按收到的脉冲个数和频率转。脉冲频率就是转速，频率的每次突变，对电机来说相当于瞬间变速。机械系统里有惯量，滚珠丝杠、同步带、滑块、负载，这些都有质量，速度突变时惯性会让转子跟不上脉冲指令，轻则顿挫抖动，重则失步丢步。那次事故就是典型的频率突变导致的失步——电机实际走的步数和控制器发出的指令步数对不上，后面的每一次定位都会偏移。
也正是这次事故，让我把注意力从机械装配转移到了控制程序本身，开始认真研究S型加减速的实现。
1.2 为什么梯形加减速救不了场
绝大多数步进电机程序里，速度规划用的是梯形加减速：启动后以一个固定的加速度升速，到达设定速度后匀速，接近目标位置前再以固定加速度减速。它的优点是计算简单、占用内存少、容易理解，很多开源项目和开发板例程都这么写。但在要求稍微高一点的场合，梯形曲线的短板非常明显——加速度在两个拐点上发生了跳变。
跳变有多严重？你在开车时如果一脚踩死刹车，车里的人会往前栽；如果缓缓踩下去，人不会太难受。梯形加减速就是在“启动瞬间加速度从0直接跳到某个值，减速瞬间又从某个值直接跳回0”，等于把一脚油门和一脚刹车的冲击全部集中在几个毫秒里释放。步进电机转子本来是带惯性的，突然要求它从静止直接进入一个高加速度状态，它不可能瞬时响应，于是出现了“咔咔咔”的机械冲击和丢步。
要量化这个问题，需要引入一个概念：加加速度（jerk），也就是加速度的变化率。用公式解释一下：速度v对时间t求导是加速度a（a = dv/dt），加速度对时间求导是加加速度j（j = da/dt）。
- 梯形加减速中，加速度只有一个固定阶跃值，拐点处加速度瞬间改变，斜率不存在，这意味着j是无穷大；
- S型加减速的核心，就是让加速度不是阶跃突变，而是以某个有限斜率连续上升、再连续下降，让j控制在机械可承受的范围内。
所以S型加减速本质上回答了一个梯形回答不了的问题：如何在速度从0到最大、再从最大到0的过程中，不让加速度出现突变。这看起来只是多了一个jerk参数，但整套数学构造和代码实现都比梯形复杂一个量级。不过对于带负载、高速度、大行程的三维平台、贴片机、雕刻机、机械臂来说，这笔复杂度的投入完全值得。
2. S型曲线的数学构造与嵌入式落地
2.1 先从物理直觉写：jerk、加速度、速度三者的关系
在做程序之前，先把物理模型理清楚。想象一辆车从静止起步到一百码再刹停，最舒服的驾驶方式不是一脚油门踩到底，而是慢慢把油门踩深（加速度逐渐变大），维持一段深踩油门（加速度恒定），再慢慢松油门让加速度逐渐归零。这个“油门深度”的变化过程，就是加加速、匀加速、减加速。S型加减速曲线的名字，就看速度曲线在时间轴上是不是呈现出“S”字形：两头平缓、中间陡峭。
用数学语言描述：设加加速度为j，加速度为a，速度为v，位移为s，三者对时间的关系是：
- a(t) = a0 + j·t，加速度随时间线性变化；
- v(t) = v0 + ∫a(t)dt，速度是加速度的积分；
- s(t) = s0 + ∫v(t)dt，位移是速度的积分。
j为常数时，加速度曲线是直线，速度曲线是抛物线拼接，位移曲线是三次多项式拼接，这也是很多人把S型加减速称为“三次S曲线”的来历。
嵌入式程序里，我们不关心连续解，只关心离散的脉冲间隔，但物理关系必须保留：脉冲间隔反映了瞬时速度，加速度和jerk则以时间和距离的形式决定速度曲线形状。这种“受约束的积分关系”，就是S型规划的全部秘密。
2.2 七段式S型速度规划：每一段干什么、边界条件怎么算
实际工程中最常用的是七段式S型曲线。名字里的“七段”指加速段和减速段各被拆成三段，加上中间的匀速段。加速侧的三段是：
- 加加速段（jerk为正，加速度从0线性上升到最大加速度）；
- 匀加速段（加速度保持最大）；
- 减加速段（jerk为负，加速度从最大线性下降到0）。
减速侧与加速侧对称：加减速段、匀减速段、减减速段。中间如果行程够长，还会夹一个匀速段。
这七段关系列成一张表：
| 段号 | 段名 | 加速度a | 速度变化趋势 | 说明 |
|---|---|---|---|---|
| 1 | 加加速段 | 0 → a_max | 缓慢上升 | 冲击主要控制在这一段 |
| 2 | 匀加速段 | a_max | 线性上升 | 速度变化率最大 |
| 3 | 减加速段 | a_max → 0 | 上升放缓 | 为进入匀速做准备 |
| 4 | 匀速段 | 0 | 恒定 | 如果没有这段，速度为三角形曲线 |
| 5 | 加减速段 | 0 → -a_max | 下降放缓 | 减速开始 |
| 6 | 匀减速段 | -a_max | 线性下降 | 速度快速下降 |
| 7 | 减减速段 | -a_max → 0 | 下降放缓 | 平稳停住 |
关键的计算在三个边界条件上：目标速度vmax、最大加速度amax、加加速度jmax。给定这三个值，加速段需要的最小步数和最小时间就能算出来。
以加速侧为例。设加加速段时间为t1，匀加速段时间为t2，减加速段时间也等于t1。速度要达到vmax，必须满足：
- vmax - v0 = jmax·t1² + amax·t2（这里v0是起始速度，一般取0或低频启转速度）；
- amax = jmax·t1。
从第二个式子得到 t1 = amax / jmax。如果vmax足够大，t2 = (vmax - v0) / amax - t1；如果算出来的t2小于0，说明在达到vmax之前加速度就必须开始下降，这时不存在匀加速段，速度曲线退化成“三角形”加速（只有加加速和减加速），峰值速度也到不了vmax，只能达到一个中间值。
这个判断非常重要，因为程序跑起来以后不可能动态算浮点积分，必须在运动开始前就把各段步数规划好。规划步数的方法是把每段时间上的速度积分换算成脉冲步数，比如加加速段的步数大约是 v0·t1 + amax·t1²/6（这是速度线性上升时曲线下的面积），匀加速段的步数是 (v0 + amax·t1)·t2 + amax·t2²/2，以此类推。
2.3 为什么我最终选择位置域查表，而不是中断里跑公式
七段式越算越复杂，很多人会想：直接在定时器中断里实时用公式算当前速度，不就行了？理论可行，但嵌入式平台上有两个现实问题。
第一个问题是浮点运算耗时。STM32虽然有浮点单元，但不是所有系列都带；即使带，中断里做exp、除法、乘法，在高速脉冲（每秒钟几万步）下会挤占大量CPU时间，导致中断嵌套、脉冲丢失。第二个问题是误差累积。时间域的实时积分每一轮都会引入累积误差，行程越长误差越大，最终体现在终点位置不准上。
我后来把方案改成了位置域查表：让速度成为“已完成步数”的函数，而不是“当前时间”的函数。加速段一共要走N_acc步，那么第i步完成时的速度可以预先算成一张表。运动过程中，中断每产生一个脉冲，只做一件事——步数加一，然后查表得到该位置对应的速度，换算成定时器重装值，更新ARR。整个过程没有浮点指数运算，也不是每周期都从头积分，最终速度只跟位置有关，和程序跑了多久无关。
查表还有另一个好处：用来拟合的曲线可以非常自由。你可以用标准七段式的解析积分，也可以直接用sigmoid函数去拟合一条速度—位置曲线，甚至可以把别人导出的速度曲线直接采样成表。步进电机控制只关心“位置和速度的对应关系”，不关心你这条曲线到底是用哪个公式画出来的。这给调试带来了极大的灵活性——改曲线形状，只需要重新生成表，不需要动中断处理函数。
3. STM32驱动侧架构：脉冲、中断与速度更新
3.1 三种产生脉冲的方式：PWM硬件、定时器翻转、软件翻转
S型加减速调度好之后，关键是如何让STM32按计算出来的速度产生脉冲。常见方案有三种，各有取舍，我整理成表：
| 方式 | 实现原理 | 优点 | 缺点 | 适用场景 |
|---|---|---|---|---|
| 定时器PWM输出 | 用定时器输出比较通道产生PWM波形 | CPU占用低，频率稳定，方向引脚另用GPIO控制 | 每次频率改变需要更新ARR，更新时机要处理好 | 大多数工程项目的首选 |
| 定时器中断翻转GPIO | 每次更新中断里翻转一次电平 | 灵活，便于插入状态判断 | 中断频率高，CPU占用大 | 低速场合或原型验证 |
| 软件延时驱动 | 用DWT/延时循环翻转GPIO | 不占用定时器 | 延时期间CPU被阻塞 | 不推荐用于正式产品 |
我的做法是定时器PWM输出模式，脉冲频率由定时器的自动重装值ARR决定。假设定时器时钟是1MHz，想要输出频率为F（Hz）的脉冲，ARR就是1000000 / F。这个公式很朴素，但它是驱动侧一切逻辑的出发点：S型加减速计算出“当前速度”，驱动侧只把它翻译成“定时器ARR值”。
3.2 定时器中断里那点事：ARR更新的时序与量化误差
使用PWM硬件时，中断处理函数里的逻辑很简单：定时器溢出/比较事件触发中断，在中断里步数加一，根据加减速阶段查表得到速度，更新ARR，让下一次脉冲周期的频率变成新的值。
代码核心是这样的：
void TMR_UP_IRQHandler(void) { if (__HAL_TIM_GET_FLAG(&htim, TIM_FLAG_UPDATE)) { __HAL_TIM_CLEAR_FLAG(&htim, TIM_FLAG_UPDATE); motion.completed_steps++; // 步数+1 if (motion.state == STATE_ACCEL) { if (motion.completed_steps >= motion.accel_steps) { motion.state = STATE_RUN; motion.speed = motion.max_speed; } else { motion.speed = lookupspeed(motion.acc_table, motion.completed_steps, motion.table_len); } } else if (motion.state == STATE_DECEL) { uint32_t dec_done = motion.completed_steps - motion.accel_steps - motion.cruise_steps; if (dec_done >= motion.decel_steps) { motion.state = STATE_STOP; motion.speed = 0; } else { motion.speed = lookupspeed(motion.dec_table, dec_done, motion.table_len); } } // 1MHz定时器时钟下的ARR计算 if (motion.speed > 0.001f) { __HAL_TIM_SET_AUTORELOAD(&htim, (uint32_t)(1000000UL / motion.speed)); } } }这里有一个工程细节很容易被忽略：ARR更新后，定时器要等到下一个计数周期结束才会按新值重装，所以实际产生的脉冲周期变化会比计算点晚一个周期。也就是说，我们查表得到“第i步结束后的目标速度”，但实际生效的是“第i+1个脉冲的周期”。这个相位差在半闭环步进控制里影响不大，因为加减速过程是连续的，晚一拍不会改变整体曲线走向。
另一个细节是整数转换带来的量化误差。1000000 / speed的结果是整数，四舍五入或者截断都会让每个脉冲周期有微小偏差。如果每个周期都向下取整，几百步以后偏差可能累积成明显的频率偏低。解决的办法是在代码里加一个小数余量：用定点数表示当前速度，每次更新ARR时把余数保留下来，累加到下一个周期。我在实际项目里直接用浮点speed变量配合ARM的FPU做，精度够用；如果目标芯片不带FPU，建议用32位定点数，把速度放大1000倍存储，计算ARR时再除回来。
3.3 与步进驱动器配合的接口考量
STM32输出的通常是脉冲和方向两个逻辑信号，而不是电机绕组的直接功率。实际驱动由外部的细分步进驱动器完成，STM32通过“脉冲+方向”接口跟它对接。
这里有几个容易踩的坑：
- 脉冲频率上限取决于驱动器的最大输入频率。一般驱动器支持200kHz以上，但细分倍数越高，同样的机械转速对应的脉冲频率越高；
- 方向信号切换要提前于脉冲信号。否则第一个脉冲到来时方向还没稳定，电机可能往反方向转一下；稳妥做法是方向切换后延时至少5微秒；
- 如果驱动器支持光耦隔离输入，最好用，可以屏蔽干扰，但要注意脉冲高电平持续时间不能太短，否则光耦来不及响应。
细分设置直接决定“步”的机械含义。例如一个1.8度步距角的电机，8细分下每脉冲就是0.225度，一秒钟12000步等价于电机每秒转1.5圈。做S型加减速规划时，所有速度、加速度、加加速度参数都以“步/秒”和“步/秒²”为单位，细分改变后这些参数要重新换算，这一点很多人在换驱动器或改细分的时侯容易忘。
4. 加减速核心源码逐行剖析
4.1 结构体与初始化：把运动参数一次性算成步数
我给运动控制专门建了一个结构体，把所有运行参数集中管理，这样不同轴之间复制起来也很容易：
typedef struct { uint32_t total_steps; // 目标总步数，含符号可表示方向 uint32_t accel_steps; // 加速段步数 uint32_t cruise_steps; // 匀速段步数 uint32_t decel_steps; // 减速段步数 float max_speed; // 目标峰值速度，步/秒 float start_speed; // 启动速度，步/秒 float max_accel; // 最大加速度，步/秒^2 float max_jerk; // 最大加加速度，步/秒^3 float speed; // 当前运行速度 uint8_t state; // 加速/匀速/减速/停止 uint32_t completed_steps; // 已完成步数 uint16_t *acc_table; // 加速段查表指针 uint16_t *dec_table; // 减速段查表指针 uint16_t table_len; // 表长 } SCurve_t;初始化函数要做的事情是：先判断这是一个短行程（速度达不到max_speed）还是长行程，再分配加速、匀速、减速段步数。短行程的判断就是前面说的加速段位移 + 减速段位移大于总步数，这时要降低目标速度，重新计算三个段的步数。
这个逻辑是整个程序里最容易出错的部分。我的经验是用“距离优先”而不是“速度优先”：不管目标速度设多高，先算最多能跑多远，如果距离不够，就降低峰值速度到能匹配的最大值，而不是让中间出现一段没有任何减速缓冲的高速运动。
4.2 查表插值函数与Timer ARR计算
查表函数不长，但性能关键：
uint16_t lookupspeed(const uint16_t *table, uint32_t pos, uint16_t len) { if (len == 1) return table[0]; // 把已完成步数映射到[0, len-1]区间 float f = (float)pos * (len - 1) / (float)lookup_denominator; uint16_t idx = (uint16_t)f; float frac = f - idx; if (idx >= len - 1) return table[len - 1]; uint16_t v0 = table[idx]; uint16_t v1 = table[idx + 1]; return (uint16_t)(v0 + (v1 - v0) * frac); }这里表里存的是“速度 × 1000”的定点值，线性插值可以减少量化台阶。为什么要插值？因为一张表如果直接存N_acc步的速度值，行程一变表就要重做；而固定表长（比如256点）配合线性插值，可以在不同行程之间复用同一张归一化曲线，只是位置映射的缩放系数不同。
归一化S型曲线的生成可以用sigmoid拟合，也可以直接用七段式积分。我用sigmoid做了个对比版：将位置归一化到0到1，速度归一化到0到1，用 s(x) = 1 / (1 + exp(-k·(x - 0.5))) 来拟合，再裁剪首尾，让曲线上起终点速度严格等于0和1。曲线形状完全由k控制，k小了曲线更软、加减速更平缓；k大了更接近直线，冲击变大。
在初始化时把这条归一化曲线算成表，运行时按实际段步数缩放映射即可：
void generate_scurve_table(uint16_t *table, uint16_t len, float steepness) { float s0 = 1.0f / (1.0f + expf(steepness * 0.5f)); float s1 = 1.0f / (1.0f + expf(-steepness * 0.5f)); for (int i = 0; i < len; i++) { float x = (float)i / (len - 1); float val = 1.0f / (1.0f + expf(-steepness * (x - 0.5f))); val = (val - s0) / (s1 - s0); // 裁剪到[0,1] table[i] = (uint16_t)(val * 1000.0f); } }注意：这里生成的只是速度曲线的“归一化形状”，真正的速度还要乘上目标峰值速度。我把乘法和定时器基准频率结合，在中断里一起算完，省掉一次乘除。
4.3 状态机：加速、匀速、减速、停止的切换逻辑
整个加减速运行过程可以抽象成一个小状态机，四种状态分别是：
- STATE_ACCEL：加速中，查加速表更新速度；
- STATE_RUN：匀速中，速度固定为目标峰值速度；
- STATE_DECEL：减速中，查减速表更新速度；
- STATE_STOP：运动结束，关闭脉冲输出。
它在中断里的切换逻辑就是我前面代码片段里写的那个样子。加速段步数跑完进匀速段，匀速段步数跑完进减速段，减速段步数跑完进停止。
这里有一个必须注意的细节：到达停止状态时，电机可能因为机械惯性还停不稳，或者最后一步脉冲频率很低导致转子欠冲。我的处理是保留一个“停步稳速”的小功能：减速段的最后若干步，速度不是直接到0，而是维持一个很小的启动速度，走固定几步后再停，相当于把脉冲频率降到一个低于“共振低限”的数值，再切断输出。电机就不会出现低频振动和最后一步的啪一声。
4.4 边界条件：加速距离不够时怎么办
前面提到短行程问题，这里展开说。假设运动参数是vmax=10000步/秒，amax=12000步/秒²，jmax=120000步/秒³，算出来的加速段需要大约416步，减速段也是对称为416步。如果目标总步数只有500步，那么416 + 416 = 832步大于500，显然不可能达到10000步/秒，中间必然有一段在高速区直接减速。
对于这种情况，我的初始化函数会重算一个满足总距离的峰值速度。具体做法是用二分法搜索v_peak，让“加速段步数 + 减速段步数”最接近总步数，然后重新生成加速表和减速表。二分法迭代大概十多次，初始化时执行，不影响实时中断。
如果不处理这个边界，会发生极其危险的现象：电机加速到一半，程序发现总步数已经用了一半，立刻进入减速状态，但因为峰值速度太高、减速距离不够，最后几百步相当于高速急刹车，失步、堵转、机械冲击全来了。
5. 实测调参与排坑记录
5.1 同一条S曲线，不同负载的差异；参数怎么定
调S型加减速，核心参数就是三个：最大加速度amax、最大加加速度jmax、峰值速度vmax。记住一个规律：负载惯量越大，amax和jmax就得越小。加速度决定电机的电磁转矩需求，jerk决定机械系统的抖动程度。
我的起步参考值是这样定的：
- 先把jmax设得很大（比如amax的10倍），此时S曲线接近梯形，如果机器没有明显冲击，逐步减小jmax直到机械共振消失；
- 再单独调amax，看电机在低速高速切换时是否有失步趋势，有的话减小amax；
- vmax通常由工艺产能决定，能不改就不改。
| 负载类型 | 建议amax（步/秒²） | 建议jmax（步/秒³） |
|---|---|---|
| 空载小滑块，轻同步带 | 50000 ~ 80000 | amax × 5 ~ 8 |
| 中等负载，约2kg | 20000 ~ 40000 | amax × 3 ~ 5 |
| 重负载龙门轴 | 5000 ~ 15000 | amax × 2 ~ 4 |
这些值只能作为起点。真正的调参手段是看执行机构的振动声音和温升：电机闷响说明加速度偏大，皮带抖说明jerk偏大，碰一下机构明显抖动就说明S曲线不够软。
5.2 三个高频坑
第一个坑是减速点算错导致高速直接刹车。这个前面已经说了，根源是短行程边界没处理。我见过不止一个项目，运动距离一改，电机就撞限位，后来干脆在初始化里输出三段的步数日志，每次启动打印一次，这样一眼就能看出减速段是否合理。
第二个坑是中断里做浮点公式运算。早期我试过在中断里动态计算七段式积分公式，代码很简洁，但实际跑起来低速时还没事，高速时中断处理时间越来越长，偶尔会出现脉冲间隔不均，电机声音都变了。换成查表后，中断里只剩一个整数查表和一次整数除法，CPU占用率降了一个量级。
第三个坑是低频共振。步进电机在几十到几百赫兹区间存在明显的低频共振，如果S曲线从0开始，它的起始段必然经过这个区间，电机会在刚启动时抖动一下。我的方案是设置一个start_speed，一般取500到1000步/秒，让电机从有意义的低速直接进入S曲线，绕开最低的共振区间。代价是启动瞬间有一个小的速度阶跃，但500步/秒的阶跃冲击远小于1500步/秒以上，基本可以接受。
5.3 与梯形加减速的实测对比
用前面提到的那台贴标机构做了一组对比，负载约2kg，目标速度9000步/秒，行程2000步。
| 项目 | 梯形加减速 | S型加减速 |
|---|---|---|
| 最大加速度 | 40000 步/秒² | 40000 步/秒² |
| 加加速度 | 无穷大（阶跃） | 150000 步/秒³ |
| 机械噪音 | 启动有明显“咔”声 | 无明显冲击声 |
| 停机过冲 | 约3~5mm | 小于1mm |
| 连续往返100次丢步数 | 偶发，约2~4步 | 0步 |
| 整段运动时间 | 约0.38秒 | 约0.42秒 |
时间上慢了0.04秒，但换来了几乎零丢步和更低的机械冲击。对于贴标、定位这类以一致性为命脉的场合，这0.04秒完全值得。
参数整定上还有一个小建议：先用一个客户能接受的低速度跑通整个流程，确认S曲线形状合适后再逐步提高速度上限。很多人一上来就按理论峰值速度跑，结果机械共振点恰好落在加速中段，排查起来非常痛苦。
关于S型加减速，我自己一直保留着一个习惯：在任何一版源码里都预留一个“曲线形状参数”，哪怕一开始只做最简的梯形，也把jerk这个变量留在初始化结构体里。因为只要运动控制项目跑到后期，总会面对更重的负载、更高的速度要求，到那时候再回过头改架构，远比一开始就留好扩展点麻烦得多。如果你正在做STM32步进电机方案，建议先把七段式的段分配逻辑和位置域查表搞清楚，再谈其他花哨的速度拟合方法——把地基打牢，后面换任何曲线都是一张表的事。
