运动控制基础：运动控制系统的组成、常见运动模式与控制周期

运动控制系统的开发，无论是面向半导体设备、3C自动化、机器人还是数控机床，其底层逻辑都高度一致：在确定性的时间片内，完成位置、速度或力矩的精确输出。理解系统的物理组成、运动模式的数学本质以及实时性的工程约束，是编写可靠状态机代码的前提。本章将围绕这三个核心维度展开，帮助开发者建立从硬件架构到软件时序的完整认知。

上图展示了运动控制系统的基本分层架构。从状态机开发者的视角来看，上位机负责非实时的路径规划与指令下发，运动控制器是状态机运行的主战场，而驱动器与电机则构成了执行与反馈的物理末端。控制周期（T）是连接软件逻辑与硬件动作的节拍器，所有状态机的状态转移、插补运算和PID更新都必须严格在这个时间片内完成。

2.1 运动控制系统的组成与信号流

一个完整的运动控制系统，从功能上可以划分为四个子系统：指令生成子系统、运动规划子系统、执行驱动子系统和反馈测量子系统。理解这四个子系统的边界与接口，是设计状态机的基础。

在状态机开发中，需要特别关注使能（Enable）与报警（Alarm）这两个信号。使能信号是状态机从“待机”切换到“运行”的必要条件，而报警信号则会导致状态机从任何运行状态强制跳转到“故障处理”状态。下表总结了各子系统的关键接口与状态机关注点：

子系统	典型硬件	关键数据/信号	状态机关注点
指令生成	IPC, PLC, HMI	目标位置、速度、加减速	指令缓存区是否为空、指令类型
运动规划	DSP, MCU, FPGA	插补点序列、规划速度	插补缓冲区深度、规划完成标志
执行驱动	伺服驱动器、步进驱动	电流环指令、使能信号	驱动器就绪信号、过流/过温报警
反馈测量	增量编码器、光栅尺	位置计数、Z相脉冲	反馈丢失报警、位置偏差超限

在工程实践中，状态机不仅要处理正常流程，还要处理急停（E-Stop）和硬限位（Hard Limit）。这些信号通常直接连接到驱动器的硬件电路，但状态机必须通过IO映射感知其状态，以便在恢复后执行重新初始化流程。

2.2 常见运动模式：点位、连续与插补

运动模式决定了状态机内部状态转移的触发条件。三种基本模式——点位运动（Point-to-Point）、连续运动（Jog/Continuous）和插补运动（Interpolation）——在状态机实现上有着本质区别。

2.2.1 点位运动（PTP）

点位运动的核心特征是只关心起点和终点，不关心中间路径。典型应用包括贴片机的取放头移动、点胶机的点间移动。在状态机中，PTP模式通常包含以下状态：IDLE → START_MOVE → ACCEL → CONST_VEL → DECEL → IN_POSITION → DONE。关键判断条件是“是否到达目标位置窗口”，即当前位置与目标位置的偏差值小于设定阈值（如0.01mm）。

// 点位运动状态机核心判断逻辑
if (state == ACCEL) {
    if (current_vel >= target_vel) {
        state = CONST_VEL;
    }
} else if (state == CONST_VEL) {
    if (remaining_distance <= decel_distance) {
        state = DECEL;
    }
} else if (state == DECEL) {
    if (abs(current_pos - target_pos) < IN_POSITION_WINDOW) {
        state = IN_POSITION;
    }
}

2.2.2 连续运动（Jog）

连续运动模式用于手动调试或持续进给场景，如数控机床的手轮模式。状态机相对简单：IDLE → RUNNING → IDLE。但难点在于速度的平滑切换。如果直接修改目标速度，会导致加速度突变，引起机械振动。因此，状态机内部需要实现一个斜坡发生器（Ramp Generator），将速度指令按固定加速度递增或递减。

2.2.3 插补运动（Interpolation）

插补运动是多轴联动的核心，常见于CNC加工和机器人轨迹控制。插补分为直线插补（G01）和圆弧插补（G02/G03）。状态机在插补模式下的核心任务不是简单的状态切换，而是在每个控制周期内计算新的目标位置。例如，在直线插补中，需要根据当前周期序号 n 和总周期数 N，计算当前位置：

// 直线插补位置计算
x_current = x_start + (x_end - x_start) * n / N;
y_current = y_start + (y_end - y_start) * n / N;

插补模式的状态机通常包含预填充（Look-Ahead）机制。状态机需要管理一个插补缓冲区，当缓冲区中的点数低于阈值时，触发“请求更多数据”事件，从上层规划器获取新的路径段。如果缓冲区为空，状态机必须进入“等待”状态，防止轨迹中断。

运动模式	状态机复杂度	实时性要求	典型应用	关键状态
点位 (PTP)	低	中 (1ms)	贴片机、点胶机	加速、匀速、减速、到位
连续 (Jog)	低	中 (1ms)	手动调试、进给	运行、停止、方向切换
插补 (Interp)	高	高 (0.1ms~0.5ms)	CNC、机器人	预填充、插补中、缓冲区空

2.3 控制周期与实时性要求

控制周期（T）是运动控制系统的“心跳”。它决定了系统能够响应的最高频率。对于状态机而言，控制周期直接影响状态转移的粒度。如果控制周期为1ms，那么状态机每秒最多执行1000次状态判断。对于高速运动（如主轴转速3000rpm），1ms的周期意味着每转只采样60次，这可能导致位置环增益不足。

为了保证实时性，工程上通常采用以下三种方案之一：

1. 方案一：独立硬件控制器。使用专用的DSP或MCU运行状态机，上位机仅通过以太网或PCIe发送指令。这是最可靠的方式，控制周期可稳定在125μs~500μs。
2. 方案二：实时操作系统扩展。在Windows上安装RTX或INtime等实时扩展，将运动控制任务绑定到实时核。控制周期可达250μs~1ms，但需要仔细处理与Windows非实时任务的数据交换。
3. 方案三：FPGA并行处理。将插补和位置环放在FPGA中实现，状态机逻辑放在软核CPU中。FPGA的硬件并行性可以保证纳秒级的确定性，但开发复杂度较高。

在状态机代码层面，需要遵循“中断内只做必要操作”的原则。控制周期中断服务程序（ISR）中，只执行以下操作：读取编码器计数、执行状态机逻辑、计算PID输出、写入DAC。任何耗时的操作（如日志记录、网络通信、动态内存分配）都必须移出ISR，放到后台任务中执行。

2.4 常见误区与设计复盘

在运动控制状态机的开发中，以下三个误区最为常见，需要开发者特别警惕。

• 误区一：将状态机与运动规划混为一谈。状态机负责“何时做什么”，运动规划负责“怎么做”。例如，在插补运动中，状态机只负责判断“当前是否应该发送下一个插补点”，而插补点的具体坐标计算属于规划算法。如果两者耦合，会导致状态机代码臃肿，难以维护。
• 误区二：忽略控制周期的抖动预算。很多开发者只关注平均控制周期，而忽略了最坏情况下的抖动。在状态机设计中，必须为ISR预留至少30%的CPU余量，以应对突发计算（如圆弧插补中的三角函数计算）。否则，一旦出现抖动，就会导致轨迹偏差。
• 误区三：缺乏对“等待”状态的超时处理。状态机中经常需要等待外部信号（如“驱动器就绪”、“气缸到位”）。如果这些信号因硬件故障永远不返回，状态机将卡死在等待状态。必须在每个等待状态中设置超时定时器，超时后跳转到“故障”状态，并触发报警。