STM32三轴运动控制系统开发与优化实践

1. 项目概述

最近在折腾三轴运动控制系统时，发现一个基于STM32的脱机雕刻机项目特别有意思。这个项目原本是国外开发者写的，但经过我们团队的深度改造后，不仅移植到了STM32F1和STM32F4两个硬件平台，还添加了上万字的中文注释，使得代码的可读性大大提升，即使是刚入门的新手也能轻松理解其中的精妙之处。

这个项目的核心功能是实现三轴联动控制，支持直线和圆弧两种插补方式，并且带有加减速控制。这些功能对于CNC雕刻机、3D打印机等需要精确运动控制的设备来说至关重要。项目提供了完整的MDK工程源码，分别针对STM32F1和STM32F4两个系列进行了优化，方便不同硬件平台的开发者使用。

提示：F4版本利用了STM32F4的DSP库进行加速运算，性能比F1版本有显著提升。

2. 硬件平台选择

2.1 STM32F1与F4的差异

STM32F1和F4虽然同属STM32系列，但在性能和外设上有显著差异：

1. 主频差异：

   • F1系列最高72MHz
   • F4系列最高168MHz

2. 浮点运算能力：

   • F1没有硬件FPU
   • F4带有硬件FPU

3. DMA控制器：

   • F4的DMA功能更强大
   • 支持更多的DMA通道

4. 定时器性能：

   • F4的定时器分辨率更高
   • 支持更复杂的PWM输出模式

2.2 硬件选型建议

对于运动控制系统，建议根据以下情况选择硬件平台：

1. 选择F1的情况：

   • 预算有限
   • 运动控制要求不高（脉冲频率<50kHz）
   • 不需要复杂的三维插补

2. 选择F4的情况：

   • 需要高性能运动控制
   • 脉冲频率要求高（>100kHz）
   • 需要进行复杂的数学运算（如三维插补）

3. 运动控制核心实现

3.1 三轴联动主控函数

运动控制的核心是实时计算和调整各轴的运动参数。下面是核心控制函数的实现：

c复制// 三轴联动主控函数（F4版本用DSP库加速）
void Motion_Core_Update(void)
{
    // 实时计算剩余步数
    int32_t steps_remaining = max(max(x_steps, y_steps), z_steps);
    
    // 动态调整脉冲频率（核心加速算法）
    if (steps_remaining > 200) {
        current_freq = max_freq;  // 全速运行模式
    } else {
        // 减速曲线计算（平方根函数实现平滑减速）
        current_freq = sqrt(2 * accel * steps_remaining);
    }
    
    // 更新定时器自动重装载值，调整脉冲频率
    TIM_SetAutoreload(STEP_TIMER, SystemCoreClock / current_freq / 2);
}

这个函数的关键点在于：

1. 根据剩余步数动态调整脉冲频率
2. 在接近终点时采用平方根减速曲线，实现平滑减速
3. 通过直接操作定时器寄存器实现高精度的脉冲控制

注意：F4版本中使用了DSP库的sqrt函数，计算速度比标准库函数快5-8倍。

3.2 直线插补算法

直线插补是运动控制系统中最基本的插补方式，其核心思想是根据目标位置计算各轴的步进增量：

c复制void Line_Interp(int32_t target[], float feedrate)
{
    // 计算各轴总步数（取绝对值）
    x_steps = labs(target[X] - current_pos[X]);
    y_steps = labs(target[Y] - current_pos[Y]);
    z_steps = labs(target[Z] - current_pos[Z]);
    
    // 取最大步数作为基准
    step_count = max(x_steps, max(y_steps, z_steps));
    
    // 步进增量计算（使用定点数运算避免浮点开销）
    x_inc = (target[X] - current_pos[X]) << 16 / step_count;
    y_inc = (target[Y] - current_pos[Y]) << 16 / step_count;
    z_inc = (target[Z] - current_pos[Z]) << 16 / step_count;
    
    // 启动加减速调度器
    Accel_Engine_Start(step_count);
}

这段代码的几个关键技术点：

1. 使用定点数运算（<<16相当于乘以65536）代替浮点运算，提高计算效率
2. 以最大步数轴为基准，确保各轴同步到达目标位置
3. 步进增量预先计算并存储，减少实时计算负担

4. 圆弧插补实现

4.1 圆弧插补状态机

圆弧插补比直线插补复杂得多，本项目采用了改进的Bresenham算法实现：

c复制// 圆弧插补状态机结构体
typedef struct {
    int32_t  x, y;       // 当前坐标
    int32_t  d;          // 决策参数
    uint8_t  quadrant;   // 当前象限
    uint16_t over90_flag;// 超过90度标志
} Arc_State;

// 圆弧插补主函数
void Arc_Interp(Arc_State *arc)
{
    while(arc->d <= 0) {
        step_X();  // 输出X轴脉冲
        arc->d += 2 * arc->x + 1;
        arc->x++;
        
        if(arc->d > 0) {
            step_Y();  // 输出Y轴脉冲
            arc->d += 2 * (arc->y - arc->x) + 1;
            arc->y--;
        }
        
        // 处理象限切换
        if(arc->x > arc->y && !arc->over90_flag) {
            arc->quadrant++;
            arc->over90_flag = 1;
        }
    }
}

圆弧插补的关键技术：

1. 使用决策参数d决定下一步的移动方向
2. 通过象限标志处理超过90度的圆弧
3. 状态机结构保存当前插补状态，支持中断恢复

4.2 圆弧插补的精度控制

在实际测试中，圆弧插补的精度主要受以下因素影响：

1. 脉冲当量（每个脉冲对应的实际移动距离）
2. 算法本身的累积误差
3. 机械系统的反向间隙

通过实验测量，本算法实现的圆弧插补精度可以达到：

• XY平面：±2个脉冲
• 其他平面：±3个脉冲（需要额外的补偿算法）

5. 加减速控制

5.1 梯形加减速算法

运动控制系统必须要有良好的加减速控制，否则会出现失步或机械冲击的问题。本项目实现了自适应的梯形加减速算法：

c复制// 梯形加减速参数生成
void Accel_Engine_Calc(int32_t total_steps)
{
    // 计算加速段步数
    uint32_t accel_steps = (max_freq * max_freq) / (2 * accel);
    
    if(total_steps > 2 * accel_steps) {
        // 完整梯形：加速-匀速-减速
        cruise_steps = total_steps - 2 * accel_steps;
    } else {
        // 三角波模式：只有加减速
        accel_steps = total_steps / 2;
        cruise_steps = 0;
    }
    
    // 生成速度曲线表
    for(int i=0; i<accel_steps; i++){
        speed_table[i] = sqrt(2 * accel * i);  // 加速段
    }
}

这个算法的智能之处在于：

1. 自动判断运动距离是否足够完成完整的梯形加减速
2. 当距离不足时自动切换为三角波加减速模式
3. 预先计算并存储速度曲线，减少实时计算负担

5.2 加减速参数调优

在实际应用中，加减速参数需要根据具体机械系统进行调整：

1. 加速度设置：

   • 过大：可能导致失步或机械振动
   • 过小：影响运动效率

2. 最大速度设置：

   • 受限于电机和驱动器的性能
   • 需要考虑机械结构的刚性

建议的调优步骤：

1. 从保守的参数开始（低加速度和速度）
2. 逐步提高参数，观察运动效果
3. 找到出现问题的临界点，然后回退10-20%作为工作参数

6. 定时器配置

6.1 STM32F1的定时器配置

F1系列使用标准外设库配置定时器：

c复制// F1的定时器初始化（72MHz主频）
void STEP_TIM_Init(void)
{
    TIM_TimeBaseInitTypeDef  timer;
    timer.TIM_Prescaler = 0;  // 不分频
    timer.TIM_CounterMode = TIM_CounterMode_Up;
    timer.TIM_Period = 7200;  // 初始10kHz
    TIM_TimeBaseInit(TIM3, &timer);
    TIM_Cmd(TIM3, ENABLE);
}

关键配置点：

1. 不使用预分频，直接使用系统时钟
2. 向上计数模式
3. 初始频率设置为10kHz（可根据需要调整）

6.2 STM32F4的定时器配置

F4系列使用HAL库和DMA实现高性能脉冲输出：

c复制// F4的DMA脉冲发射（168MHz主频）
void STEP_DMA_Start(void)
{
    HAL_TIM_PWM_Start(&htim1, TIM_CHANNEL_1);
    HAL_TIM_OC_Start_DMA(&htim1, TIM_CHANNEL_2, 
                        (uint32_t*)pulse_buffer, PULSE_BUF_SIZE);
}

F4方案的优势：

1. 使用DMA传输，减轻CPU负担
2. 支持更高的脉冲频率（实测可达200kHz）
3. 脉冲输出更精确，抖动更小

重要提示：使用DMA输出脉冲时，GPIO必须配置为复用推挽模式，否则波形质量会下降。

7. 项目移植与使用

7.1 硬件连接配置

要使用这个项目，需要根据实际硬件修改以下配置：

1. 电机驱动接口：

   • 在motor_pin.h中配置步进电机驱动引脚
   • 包括步进脉冲、方向使能等信号

2. 机械参数：

   • 在config.h中设置steps_per_mm参数
   • 根据丝杠导程和步进电机步距角计算

3. 限位开关：

   • 配置限位开关的GPIO引脚
   • 设置合适的中断触发方式

7.2 开发环境配置

1. F1版本：

   • MDK-ARM开发环境
   • 标准外设库

2. F4版本：

   • 需要启用FPU支持
   • 添加DSP库
   • 配置正确的时钟树

7.3 常见问题解决

在实际使用中可能会遇到以下问题：

1. 电机不转动：

   • 检查GPIO配置是否正确
   • 验证定时器是否正常工作
   • 检查电机驱动器供电和使能信号

2. 运动方向相反：

   • 调整方向引脚极性
   • 修改代码中的方向控制逻辑

3. 高速时失步：

   • 降低最大速度或加速度
   • 检查电源供电是否充足
   • 优化机械结构的刚性

8. 性能优化技巧

8.1 代码级优化

1. 使用查表法：

   • 预先计算常用参数并存储
   • 减少实时计算量

2. 内联函数：

   • 对频繁调用的小函数使用内联
   • 减少函数调用开销

3. 汇编优化：

   • 对关键函数使用汇编实现
   • 特别是脉冲输出相关代码

8.2 系统级优化

1. 中断优先级管理：

   • 运动控制中断设为最高优先级
   • 避免被其他中断打断

2. 内存优化：

   • 合理使用DMA和缓冲
   • 减少内存拷贝操作

3. 电源管理：

   • 优化供电电路设计
   • 确保高速运动时电源稳定

9. 扩展功能实现

基于这个项目，可以进一步实现以下扩展功能：

1. 三维螺旋插补：

   • 在圆弧插补基础上添加Z轴联动
   • 需要修改插补算法

2. G代码解析器：

   • 实现完整的G代码支持
   • 增加文件系统读取功能

3. 人机界面：

   • 添加LCD显示和按键输入
   • 支持参数设置和状态显示

4. 网络控制：

   • 通过WiFi或以太网实现远程控制
   • 添加Modbus等工业协议支持

10. 实际应用案例

这个运动控制核心已经成功应用于多个项目：

1. 桌面级CNC雕刻机：

   • 加工面积：300×300mm
   • 最高速度：5000mm/min
   • 重复精度：±0.02mm

2. 激光切割机：

   • 支持PWM控制激光功率
   • 实现速度-功率同步控制

3. 3D打印机：

   • 实现五轴联动控制
   • 支持多种打印材料参数预设

在实际使用中，这个运动控制核心表现出色：

• 脉冲频率稳定，无丢步现象
• 运动轨迹平滑，加工质量好
• 资源占用低，可扩展性强

对于想要学习运动控制开发的工程师来说，这个项目提供了很好的起点。通过研究这些源码，可以深入理解运动控制的核心原理和实现方法。