运动控制基础：位置、速度、加速度、力矩、轨迹、插补、坐标系等核心概念与术语
运动控制系统设计的本质，是将用户期望的机械运动转化为驱动器与电机可执行的指令序列。无论是三轴点胶机、六轴工业机器人还是高精度龙门平台，其底层逻辑都围绕一组核心物理量与数学工具展开。本章将系统梳理位置、速度、加速度、力矩、轨迹、插补与坐标系等基础概念，建立统一的术语体系，为后续指令系统设计提供理论支撑。理解这些概念之间的耦合关系，是编写出稳定、高效、可维护运动控制程序的前提。
上图展示了运动控制系统中物理量与数学工具的耦合关系。左侧的物理量（位置、速度、加速度、力矩）构成了指令系统的基本操作对象，右侧的数学工具（坐标系、轨迹、插补、前瞻规划）则决定了如何将这些物理量组织成平滑、高效的指令序列。实际工程中，两者通过控制周期（通常为 0.5ms~8ms）内的插补计算紧密关联。
核心物理量：从位置到力矩的递进关系
运动控制指令最终作用于电机，而电机的输出特性由力矩决定。理解从位置到力矩的递进关系，是设计指令系统的第一课。
- 位置（Position）：描述机械部件在空间中的坐标值。在伺服系统中，位置反馈通常来自编码器（增量式或式），单位为脉冲数或经过换算后的毫米/度。位置指令是运动控制的最顶层指令，例如“移动到X=100mm处”。
- 速度（Velocity）：位置对时间的一阶导数。速度指令决定了机械部件的运动快慢。在梯形或S形速度规划中，速度曲线直接影响了加工效率和机械冲击。
- 加速度（Acceleration）：速度对时间的一阶导数，也是位置对时间的二阶导数。加速度决定了力的大小（F=ma），过大的加速度会导致机械振动和定位超调。现代运动控制器普遍支持独立的加速和减速时间设定。
- 力矩（Torque）：电机输出的旋转力，与电流环给定直接相关。在指令系统中，力矩通常不作为直接目标，而是通过位置/速度环的PID输出间接控制。但在某些特殊场景（如恒力打磨、夹持控制）中，力矩指令成为主要控制模式。
工程经验：在编写运动指令时，不要孤立地看待单个物理量。例如，设定一个过高的加速度值（如10g），即使位置和速度都在电机额定范围内，也可能因力矩饱和导致跟随误差超差。建议在指令系统中预留加速度/减速度的独立参数，并依据负载惯量比进行初步估算。
坐标系：指令的参考框架
坐标系定义了指令中位置数据的参考基准。错误的坐标系设定是运动控制调试中最常见的故障来源之一。
| 坐标系类型 | 适用场景 | 指令示例 | 注意事项 |
|---|---|---|---|
| 关节坐标系（Joint） | 六轴机器人、多轴联动 | J1+30°, J2-45° | 每个轴独立运动，路径不可预测 |
| 笛卡尔坐标系（Cartesian） | 龙门平台、点胶机 | X100 Y50 Z-10 | 需进行运动学正/逆解 |
| 工具坐标系（Tool） | 焊接、涂胶、装配 | Tool[1] X10 Y0 Z20 | 工具中心点（TCP）标定精度直接影响作业质量 |
| 用户坐标系（User） | 多工位切换 | Frame[3] X... | 用于工件偏移补偿，减少重复示教 |
在指令系统设计中，坐标系的选择决定了控制器的计算负载。例如，笛卡尔空间直线插补需要每个插补周期进行逆运动学计算，而关节空间运动则只需简单的比例规划。对于高速高精应用，通常采用“笛卡尔规划+关节执行”的混合架构。
轨迹规划与插补：从目标点到连续运动
轨迹规划解决“如何到达”的问题，插补解决“每个周期走多少”的问题。两者共同决定了机械运动的平滑性与效率。
- PTP（Point-to-Point）运动：仅关心起点和终点，各轴独立运动，路径不可控。适用于点焊、换刀等对路径无要求的场景。
- CP（Continuous Path）运动：包括直线插补（Line）、圆弧插补（Arc）和样条插补（Spline）。CP运动要求各轴在插补周期内严格同步，保证末端轨迹精度。
- 前瞻控制（Look-ahead）：在连续小线段加工（如模具雕刻）中，控制器会预读后续程序段，自动调整拐角速度，避免频繁启停。前瞻段数（通常为20~200段）是衡量运动控制器性能的重要指标。
// 典型插补周期内的指令生成伪代码（1ms周期）
void InterpolationTask(void)
{
// 1. 读取当前轨迹参数（起点、终点、速度、加速度）
TrajectoryPoint current = GetCurrentPoint();
// 2. 计算本周期目标位置（基于S曲线规划）
double target_pos = SCurvePlanner(current.t, current.v0, current.vt);
// 3. 转换为电机指令（含电子齿轮比换算）
int32_t pulse_cmd = (int32_t)(target_pos * PULSE_PER_MM);
// 4. 写入硬件比较寄存器
WriteCompareRegister(pulse_cmd);
}
风险提示：插补周期必须固定且严格定时。如果插补周期抖动超过±10%，会导致速度波动和轨迹轮廓误差。在实时性要求高的场合，应使用独立于操作系统的硬件定时器触发插补中断，而非依赖软件定时器。
案例拆解：直角坐标点胶机的轨迹指令设计
以一台三轴桌面点胶机为例，其运动控制要求为：沿矩形路径点胶，四角需圆角过渡，胶量均匀。设备参数：X/Y轴行程400mm，最大速度300mm/s，加速度0.5g，定位精度±0.02mm。
初始方案与问题：工程师最初采用简单的PTP运动，每个角点执行“停止→转向→启动”流程。实测发现：角点处胶量堆积（因减速导致出胶时间过长），且整体节拍慢（每次启停约0.3s）。
优化过程：
- 将路径改为CP直线插补，并在四个角点插入半径为5mm的圆弧过渡指令（
Arc指令）。 - 启用前瞻功能，设置前瞻段数为50段，拐角速度限制为80mm/s。
- 将加减速曲线从梯形改为S形，加速度从0.5g降至0.3g，但通过缩短过渡段时间补偿节拍。
结果对比：
| 指标 | 优化前 | 优化后 | 提升幅度 |
|---|---|---|---|
| 单件节拍 | 4.2s | 3.1s | 26% |
| 角点胶量偏差 | ±15% | ±3% | 5倍改善 |
| 轨迹轮廓误差 | 0.15mm | 0.04mm | 73% |
复盘要点：轨迹规划不是简单的数学插值，需要结合工艺约束（胶量、节拍）和机械特性（刚度、惯量）综合权衡。本案例中，牺牲部分加速度换取了更平滑的速度曲线，反而通过减少稳定时间提升了整体效率。
常见误区与总结
- 误区一：混淆“插补周期”与“控制周期”。插补周期是轨迹计算周期，控制周期是伺服环更新周期。通常插补周期是控制周期的整数倍（如4ms插补，1ms控制）。
- 误区二：忽视坐标系标定误差。工具坐标系TCP标定误差0.1mm，在高速运动时可能放大为0.5mm的轨迹偏差。应定期校验标定数据。
- 误区三：盲目追求高加速度。加速度提升50%，电机力矩需求可能增加100%以上，需重新校核电机选型与减速比。
- 误区四：将力矩环当作速度环使用。力矩模式适合力控场景，若用于位置控制，需额外增加阻尼补偿，否则极易振荡。
设计建议：在指令系统架构中，建议将物理量参数（速度、加速度、加加速度）与轨迹类型参数（PTP/Line/Arc）分离存储。这样便于在运行中动态调整速度倍率（Override），而不需要重新解析整个指令块。同时，为每个轴单独设置软限位和跟随误差报警阈值，防止异常工况下损坏设备。
本章建立的运动控制术语体系，是后续学习指令语法设计、运动学算法实现和伺服调试的基础。在实际项目中，建议工程师先绘制一张类似本章开头的“概念耦合图”，明确各模块之间的数据流和控制流关系，再进行代码架构设计，这样可以有效避免后期因概念混淆导致的返工。