运动控制基础：位置、速度、加速度、力/转矩等基本物理量，运动学与动力学基础，坐标系与运动描述
运动控制系统本质上是“对机械运动过程进行精确调控”的技术，其核心对象是物体的位置、速度、加速度以及产生这些运动的力或转矩。无论是伺服电机驱动机械臂、数控机床进给轴，还是AGV小车行走，其底层逻辑都遵循同一套物理语言。本章将系统梳理这些基本物理量的定义与工程单位，厘清运动学（描述运动）与动力学（解释运动原因）的边界，并建立坐标系与运动描述的统一框架。这是后续学习PID调节、前馈控制、轨迹规划与伺服选型的数学与物理基石。
上图展示了运动控制中物理量的整体框架：左侧为运动学量，描述“物体在何处、移动多快、加速多猛”；右侧为动力学量，解释“是什么力或转矩造成了这种运动”；底部则列出了工程中常用的坐标系类型。下面我们逐一展开。
2.1 基本物理量：定义、单位与工程直觉
2.1.1 位置与位移
位置（Position）是描述物体在空间中相对于参考点（原点）的空间坐标。在直线运动中，位置通常用 x(t) 表示；在旋转运动中，位置用角度 θ(t) 表示。位置是运动控制的最终目标——伺服系统的核心任务就是让实际位置精确跟踪指令位置。
位移（Displacement）是位置的变化量，即 Δx = x(t₂) - x(t₁)。位移是矢量，具有方向和大小。工程中常将“位置”与“位移”混用，但严格区分：位置是量，位移是相对量。
| 物理量 | 直线运动单位 | 旋转运动单位 | 工程常用单位 | 典型传感器 |
|---|---|---|---|---|
| 位置 | 米 (m) | 弧度 (rad) | mm、μm、° | 编码器、光栅尺 |
| 速度 | m/s | rad/s | mm/s、m/min、rpm | 测速发电机、编码器差分 |
| 加速度 | m/s² | rad/s² | mm/s²、g | 加速度计、编码器二次差分 |
| 力/转矩 | 牛顿 (N) | 牛·米 (N·m) | kgf、N·m、oz·in | 力传感器、电流环估算 |
2.1.2 速度与加速度
速度（Velocity）是位置对时间的一阶导数：v(t) = dx(t)/dt。速度是矢量，包含大小和方向。在运动控制中，速度决定了生产效率（节拍时间），也直接影响轮廓加工精度。例如，数控机床的进给速度通常以 mm/min 表示，而伺服电机的额定转速以 rpm 表示。
加速度（Acceleration）是速度对时间的一阶导数，也是位置的二阶导数：a(t) = dv(t)/dt = d²x(t)/dt²。加速度直接关联惯性力（F = ma），因此决定了系统需要多大的驱动力矩。加速度越大，对电机峰值转矩和驱动器电流能力的要求越高。
加加速度（Jerk）是加速度的变化率：j(t) = da(t)/dt。虽然加加速度不是基本物理量，但在轨迹规划中至关重要——过大的加加速度会引起机械振动和冲击，影响加工表面质量和设备寿命。S型速度曲线就是通过限制加加速度来平滑运动的。
2.1.3 力与转矩
力（Force）是改变物体运动状态的原因，单位为牛顿（N）。在直线运动中，电机通过丝杠、皮带或直线电机产生推力，克服负载重力和摩擦力，并产生加速度。
转矩（Torque）是旋转运动中的“力”，单位为牛·米（N·m）。伺服电机的输出转矩通过减速器放大后驱动负载。转矩与力之间的关系为：T = F × r（r 为力臂）。
在运动控制中，转矩控制是最内环的控制方式。电流环本质上就是转矩环，因为电机输出转矩与电枢电流成正比（直流电机：T = Kt·I；交流伺服：T = 1.5·p·ψf·iq）。因此，转矩控制 = 电流控制，这是理解伺服驱动架构的关键。
2.2 运动学与动力学：描述与解释
2.2.1 运动学（Kinematics）
运动学研究物体的运动几何描述，不涉及力与质量。它回答“物体如何运动”的问题，包括位置、速度、加速度之间的关系。运动学方程是轨迹规划的基础：
// 匀加速直线运动方程
v(t) = v₀ + a·t
x(t) = x₀ + v₀·t + ½·a·t²
v² = v₀² + 2·a·(x - x₀)在运动控制中，运动学用于：
- 轨迹规划：根据起点、终点、最大速度、最大加速度，生成位置-时间曲线。
- 正解与逆解：对于机械臂，正运动学是已知关节角度求末端位置；逆运动学是已知末端位置求关节角度。
- 速度前馈：根据期望位置轨迹，计算期望速度，作为前馈信号叠加到速度环。
2.2.2 动力学（Dynamics）
动力学研究力/转矩与运动之间的关系，回答“为什么这样运动”的问题。其核心是牛顿第二定律和转动定律：
直线运动：F = m·a
旋转运动：T = J·α其中，m 为质量（kg），J 为转动惯量（kg·m²），α 为角加速度（rad/s²）。
动力学分析在以下场景中至关重要：
- 电机选型：计算负载所需的峰值转矩和有效转矩（RMS转矩），确保电机不过热。
- 惯量匹配：负载惯量与电机转子惯量的比值通常建议在 1~10 之间。比值过大，系统响应迟钝且容易振荡；比值过小，则电机选型过大造成浪费。
- 前馈控制：动力学前馈（如重力补偿、摩擦力补偿）可以显著提高跟踪精度。
2.3 坐标系与运动描述
2.3.1 常用坐标系类型
| 坐标系 | 定义 | 应用场景 | 特点 |
|---|---|---|---|
| 笛卡尔坐标系 | 基于 X/Y/Z 正交轴 | 直角坐标机器人、CNC 三轴加工 | 直观，便于直线插补 |
| 关节坐标系 | 每个关节角度作为坐标轴 | 六轴工业机器人 | 直接反映电机位置，便于伺服控制 |
| 工具坐标系 | 固定在末端执行器上 | 焊接、涂胶、装配 | 便于编程，与工件姿态相关 |
| 用户/工件坐标系 | 用户自定义，固定在工件上 | 多工位加工、流水线 | 简化编程，便于批量生产 |
2.3.2 运动描述：点到点与连续轨迹
点到点运动（PTP）只关心起点和终点，不关心中间路径。例如，伺服电机从位置 A 快速转到位置 B，中间路径可以是任意曲线。PTP 运动常用于换刀、上下料等辅助动作。
连续轨迹运动（CP）要求末端沿指定路径运动，如直线、圆弧或样条曲线。CP 运动需要多轴协调插补，每个轴的位置指令由插补器实时计算。例如，CNC 加工圆弧时，X 轴和 Y 轴必须按照圆的参数方程同步运动。
2.3.3 坐标变换基础
在机器人或多轴系统中，经常需要在不同坐标系之间转换。齐次变换矩阵是描述坐标系间平移和旋转的数学工具：
// 二维旋转矩阵
R(θ) = [cosθ -sinθ]
[sinθ cosθ]
// 齐次变换矩阵（3x3）
T = [R t]
[0 1]其中，R 为旋转矩阵，t 为平移向量。通过矩阵乘法，可以将点在工具坐标系中的坐标转换到基坐标系中。
2.4 案例拆解：从物理量到伺服调试
下面通过一个完整的调试案例，展示本章物理量如何在实际工程中综合应用。
场景：某自动化设备需要将工件从 A 点搬运到 B 点，使用伺服电机 + 同步带驱动直线模组。已知负载质量 m = 5 kg，行程 L = 0.6 m，要求节拍时间 t = 1.2 s（含定位稳定时间 0.2 s），定位精度 ±0.05 mm。
第一步：运动学规划
采用梯形速度曲线。设加速时间 t₁ = 0.2 s，匀速时间 t₂ = 0.6 s，减速时间 t₃ = 0.2 s，定位稳定时间 t₄ = 0.2 s。
总位移 L = ½·v_max·t₁ + v_max·t₂ + ½·v_max·t₃
0.6 = ½·v_max·0.2 + v_max·0.6 + ½·v_max·0.2
0.6 = 0.1·v_max + 0.6·v_max + 0.1·v_max = 0.8·v_max
v_max = 0.75 m/s
a_max = v_max / t₁ = 0.75 / 0.2 = 3.75 m/s²第二步：动力学计算
加速段所需推力 F_acc = m·a + F_friction
假设摩擦系数 μ = 0.1，则 F_friction = μ·m·g = 0.1×5×9.8 = 4.9 N
F_acc = 5×3.75 + 4.9 = 23.65 N
匀速段所需推力 F_const = F_friction = 4.9 N
减速段所需推力 F_dec = -m·a + F_friction = -18.75 + 4.9 = -13.85 N（制动）第三步：电机选型
同步带轮直径 d = 0.04 m，则减速器输出轴所需转矩：
T_load = F × (d/2) = 23.65 × 0.02 = 0.473 N·m（峰值）
T_rms = √[(T_acc²·t₁ + T_const²·t₂ + T_dec²·t₃) / (t₁+t₂+t₃)]
= √[(0.473²×0.2 + 0.098²×0.6 + 0.277²×0.2) / 1.0]
≈ 0.28 N·m考虑减速比 i = 3，则电机侧峰值转矩 = 0.473 / 3 = 0.158 N·m。选择额定转矩 0.32 N·m、峰值转矩 0.95 N·m 的 400W 伺服电机，惯量匹配比约为 4.5:1，满足要求。
第四步：调试验证
实际调试中发现定位时有 0.3 mm 过冲。分析原因：速度环增益过高导致加速度过大，触发机械共振。调整措施：
- 将速度环增益从 35 Hz 降至 25 Hz，位置环增益从 25 Hz 降至 18 Hz。
- 启用 S 型加减速，加加速度限制为 50 m/s³。
- 增加 2 ms 低通滤波，抑制同步带高频振动。
调整后，定位精度达到 ±0.03 mm，稳定时间缩短至 0.15 s，节拍满足要求。
2.5 常见误区与总结
- 误区一：将“加速度”与“加加速度”混为一谈。加速度决定力的大小，加加速度决定冲击和振动。高速高精设备必须同时限制两者。
- 误区二：只关注额定转矩，忽略峰值转矩。伺服电机的峰值转矩通常为额定值的 2~3 倍，但持续时间有限（如 1~3 秒），选型时必须校核加速阶段的峰值需求。
- 误区三：坐标系定义不统一。在多轴系统中，若工具坐标系与工件坐标系未正确标定，会导致轨迹偏移。建议在设备调试前完成 TCP（工具中心点）标定。
- 误区四：忽略单位换算。例如，编码器反馈为脉冲数，位置环增益的单位为 1/s，速度环增益的单位为 (rpm)/(V) 或 (rad/s)/(A)，换算错误会导致调试参数完全失效。
本章总结：位置、速度、加速度是运动控制的“表象”，力/转矩是“内因”，坐标系是“语言”。掌握这些基础物理量及其数学关系，是理解伺服环路（电流环→速度环→位置环）的前提。下一层级的进阶内容将围绕传递函数与频域分析展开，但无论多复杂的控制算法，最终都要回归到“让实际位置、速度、加速度精确跟随指令”这一根本目标上。