1. 课程导入

运动控制技术是现代工业自动化、机器人、数控机床、半导体设备、3C电子装配及新能源装备的核心支撑技术。从伺服电机的精确位置闭环，到多轴联动的高速插补，再到视觉引导下的飞拍定位，运动控制系统的性能直接决定了设备的产能、精度与稳定性。而C语言，作为嵌入式实时控制领域的事实标准语言，承担着从寄存器配置、中断服务程序编写，到运动规划算法实现、通信协议解析的全部底层逻辑。本章作为《C语言运动控制编程实战》的开篇，将系统梳理运动控制的基本概念、C语言在其中的核心角色，并给出清晰的课程学习路径，帮助读者建立完整的知识框架。

1.1 运动控制的核心概念与系统构成

1.1.1 运动控制的定义与分类

运动控制（Motion Control）是指对机械执行机构的位移、速度、加速度、力矩等物理量进行精确控制的技术总称。根据控制对象和执行方式的不同，运动控制可分为以下几类：

在实际工业场景中，运动控制系统通常由上位控制器（运动控制卡/PLC/嵌入式控制器）、伺服驱动器、伺服电机、反馈元件（编码器/光栅尺）以及机械传动机构（丝杠、同步带、减速机）组成。C语言编程主要作用于上位控制器和部分驱动器内部的固件逻辑。

1.1.2 运动控制系统的分层架构

从软件工程视角看，运动控制系统可划分为三个层次：应用层（人机交互、工艺逻辑）、运动控制层（轨迹规划、插补、PID调节、电子齿轮/凸轮）、驱动层（电流环、速度环、PWM生成）。C语言在这三层中均有应用，但重点集中在运动控制层和驱动层的实时逻辑中。例如，一个典型的伺服控制周期为125μs~1ms，要求C代码在极短的时间内完成位置环计算、速度前馈、滤波处理及指令输出。

1.2 C语言在运动控制中的核心角色

1.2.1 为什么选择C语言

在运动控制领域，C语言之所以占据主导地位，原因可归纳为以下四点：

• 硬件访问能力：C语言可直接操作寄存器、内存映射IO、中断向量，无需运行时环境开销，满足纳秒级响应需求。
• 实时性保障：C编译后的代码执行时间可精确预测，配合RTOS（如FreeRTOS、RT-Thread）可实现硬实时任务调度。
• 算法表达效率：运动控制涉及大量矩阵运算（如雅可比矩阵）、插补算法（B样条、NURBS），C语言在数值计算方面性能优异。
• 跨平台可移植性：从8位MCU到64位ARM处理器，C代码只需修改底层驱动即可复用，极大降低开发成本。

1.2.2 C语言在运动控制中的具体职责

在典型的嵌入式运动控制器中，C语言承担以下关键任务：

1. 初始化与配置：配置定时器PWM输出、编码器接口（QEP）、ADC采样通道、数字IO方向等。
2. 中断服务程序（ISR）：在定时器中断中执行位置环/速度环计算，在编码器索引中断中执行原点捕获。
3. 轨迹规划：实现梯形/S形速度规划、前瞻加减速控制、圆弧/直线插补。
4. 闭环控制：编写PID控制器、前馈补偿、陷波滤波器等算法代码。
5. 通信协议：实现EtherCAT、CANopen、Modbus等总线协议栈，解析运动指令帧。
6. 故障诊断：监控驱动器报警、编码器断线、限位触发等异常状态，执行安全停机逻辑。

// 示例：定时器中断中的位置环计算（简化版）
void Timer0_ISR(void) {
    int32_t actual_pos = QEP_GetPosition();   // 读取编码器位置
    int32_t target_pos = trajectory_planner(); // 获取规划目标位置
    int32_t error = target_pos - actual_pos;   // 计算跟随误差
    int32_t velocity_cmd = PID_Update(&pid_pos, error); // PID计算
    PWM_SetDuty(velocity_cmd);                 // 输出速度指令
    // 注意：此ISR必须在125μs内执行完毕
}

1.3 课程目标与学习路径规划

1.3.1 课程总体目标

完成本课程学习后，学员应具备以下能力：

• 独立搭建基于MCU/MPU的运动控制最小系统，完成电机驱动、编码器反馈、IO控制的硬件初始化。
• 使用C语言实现梯形/S形速度规划、直线/圆弧插补、电子齿轮/电子凸轮等核心算法。
• 掌握PID参数整定方法，能够通过示波器或逻辑分析仪分析阶跃响应、跟随误差曲线。
• 理解EtherCAT/CANopen等总线通信原理，能够编写从站驱动代码。
• 具备运动控制系统的调试排障能力，能够处理抖动、失步、过冲、共振等常见问题。

1.3.2 课程章节架构与学习路径

本课程共30章，分为五个阶段，每阶段侧重点不同，建议按顺序学习：

1.3.3 学习方法建议

运动控制编程是“理论+实践”极强的领域，建议学员遵循以下学习原则：

1. 先跑通，再优化：不要一开始就追求完美算法，先让电机转起来，再逐步加入规划、闭环、滤波。
2. 善用调试工具：示波器是运动控制调试的“眼睛”，建议学习使用示波器观察PWM波形、编码器A/B/Z信号、控制电压。
3. 重视数学基础：插补、滤波、坐标变换都依赖线性代数和微积分，建议复习相关数学知识。
4. 建立测试基准：每次修改代码后，记录阶跃响应、跟随误差、稳态精度等指标，形成数据对比。

1.4 案例拆解：从零搭建一个单轴伺服控制原型

为帮助读者建立直观认知，本节以一个简化的单轴伺服控制原型为例，展示C语言运动控制编程的完整链路。该案例虽小，但涵盖了运动控制的核心要素。

1.4.1 项目背景与约束

某设备需要控制一个直流有刷电机驱动丝杠滑台，要求：定位精度±0.1mm，最大速度100mm/s，加减速时间0.2s。控制器采用STM32F407（168MHz），电机配备500线增量编码器（4倍频后2000脉冲/圈），丝杠导程5mm。系统无减速机，电机直连丝杠。

1.4.2 关键参数计算

• 脉冲当量：5mm / 2000 = 0.0025mm/脉冲
• 定位精度要求±0.1mm，对应±40个脉冲
• 最大速度100mm/s，对应40000脉冲/s
• 加减速时间0.2s，加速度 = 100mm/s / 0.2s = 500mm/s²

1.4.3 C语言实现要点

// 定时器2用于编码器计数（4倍频模式）
void Encoder_Init(void) {
    TIM2->CR1 = 0;          // 关闭定时器
    TIM2->SMCR = 0x03;      // 编码器模式3（双沿计数）
    TIM2->CCMR1 = 0xC1;     // IC1F=001, IC2F=001, CC1S=01, CC2S=01
    TIM2->CCER = 0x331;     // CC1P=1, CC1NP=1, CC2P=1, CC2NP=1
    TIM2->ARR = 0xFFFF;     // 16位计数
    TIM2->CNT = 0;
    TIM2->CR1 = 0x01;       // 使能定时器
}

// 定时器3用于产生PWM（20kHz频率）
void PWM_Init(void) {
    TIM3->PSC = 84-1;       // 84MHz/84 = 1MHz
    TIM3->ARR = 50-1;       // 1MHz/50 = 20kHz
    TIM3->CCR1 = 0;         // 初始占空比0
    TIM3->CCMR1 = 0x60;     // PWM模式1
    TIM3->CCER = 0x01;      // CH1输出使能
    TIM3->CR1 = 0x01;
}

// 控制周期1ms，在定时器4中断中执行
void TIM4_ISR(void) {
    static int32_t target_pos = 0;
    static int32_t current_pos = 0;
    static int32_t velocity = 0;
    int32_t error;
    
    current_pos = (int16_t)TIM2->CNT;  // 读取编码器
    // 梯形速度规划（简化版）
    if (current_pos < target_pos) {
        velocity += 500;  // 加速度500脉冲/ms²
        if (velocity > 40000) velocity = 40000;
    } else {
        velocity -= 500;
        if (velocity < -40000) velocity = -40000;
    }
    // 位置环PID
    error = target_pos - current_pos;
    TIM3->CCR1 = PID_Update(&pid, error, velocity);
}

1.4.4 调试过程与结果

在调试过程中，发现电机在高速运行时出现明显噪声和振动。通过示波器观察PWM波形，发现占空比输出存在高频抖动。进一步分析发现，PID输出未经过滤波，且编码器读数在高速时存在±2个脉冲的跳变。解决方案：在PID输出端增加一阶低通滤波（截止频率500Hz），并对编码器读数进行滑动平均滤波。修改后，电机运行平稳，定位精度达到±0.05mm，满足要求。

1.5 常见误区与总结复盘

1.5.1 初学者常见误区

• 误区一：忽视控制周期：认为ISR中代码越复杂越好，导致控制周期不稳定。正确做法是保持ISR精简，将非实时任务放到主循环或低优先级任务中。
• 误区二：直接使用浮点运算：在无FPU的低端MCU上，浮点运算耗时严重。应尽量使用定点数或Q格式表示位置和速度。
• 误区三：忽略编码器噪声：编码器信号在电机高速或电磁干扰环境下可能出现毛刺，导致位置读数跳变。应使用硬件滤波（RC电路）和软件滤波（多次采样取多数）。
• 误区四：PID参数整定无章法：盲目试凑PID参数，导致系统振荡或响应过慢。应遵循先比例、后积分、再微分的整定顺序，并使用阶跃响应法辅助分析。

1.5.2 本章总结

本章作为课程导入，建立了运动控制系统的整体认知框架。读者应重点掌握：运动控制系统的分层架构（应用层/控制层/驱动层）、C语言在其中的核心职责（ISR、算法、通信）、以及课程的学习路径（基础→算法→通信→实战→优化）。同时，通过单轴伺服控制原型的案例，初步了解了从参数计算、代码编写到调试优化的完整流程。