3. 运动控制核心概念
AGV（自动导引车）的运动控制，本质上是一个“感知—决策—执行—反馈”的循环过程。在部署运动控制算法之前，工程师必须对一组基础物理量与控制机制建立精确的量化认知。位姿描述AGV在空间中的“在哪里、朝向哪”，速度与加速度描述“动得多快、变化多猛”，角速度描述“转弯多急”，控制周期决定算法执行的节奏，而反馈与闭环控制则是让AGV从“开环盲走”走向“精准循迹”的分水岭。本节将逐一拆解这些核心概念，并结合AGV底盘模型（差速、舵轮、麦克纳姆轮）说明其工程含义。
3.1 位姿：AGV在空间中的完整状态描述
核心原理：位姿（Pose）是AGV运动控制中最基础的物理量，由位置（Position）和姿态（Orientation）两部分组成。在二维平面运动中，位姿通常表示为 (x, y, θ)，其中 (x, y) 是AGV参考点（通常取驱动轮中心或车体几何中心）在全局坐标系中的坐标，θ 是车体纵轴与全局坐标系X轴的夹角（航向角）。位姿描述的是“AGV在哪里、车头朝向哪里”，这是所有路径规划与跟踪控制的前提。
工程判断方法：在实际AGV系统中，位姿的获取方式决定了控制精度上限。常见方式包括：
- 航迹推算（Odometry）：通过编码器累加计算位移与转角，短时精度尚可，但存在累积误差。
- 激光定位（Lidar SLAM）：通过环境特征匹配获得全局位姿，无累积误差，但存在更新频率限制（通常10~50Hz）。
- 二维码/反光板定位：在特定位置提供位姿修正，精度可达±5mm以内。
在部署运动控制算法时，需要明确位姿的坐标系约定：全局坐标系（地图坐标系）与局部坐标系（车体坐标系）之间的转换关系。例如，差速AGV的航迹推算公式为：
Δx = (v_r + v_l) / 2 * cos(θ) * Δt
Δy = (v_r + v_l) / 2 * sin(θ) * Δt
Δθ = (v_r - v_l) / L * Δt其中 v_r、v_l 为左右轮线速度，L 为轮距，Δt 为采样周期。这段公式是位姿估计的基石，任何基于编码器的定位都离不开它。
3.2 速度与加速度：运动规划的“油门”与“刹车”
核心原理：线速度 v（m/s）描述AGV沿运动方向移动的快慢，加速度 a（m/s²）描述速度变化的快慢。在运动控制中，加速度直接决定了AGV启动、停止时的冲击力大小。若加速度过大，会导致货物滑动、车体抖动甚至电机过流；若加速度过小，则影响搬运效率。此外，加加速度（Jerk，即加速度的变化率）也是高端AGV控制中必须考虑的指标，它影响乘客或货物的舒适度与稳定性。
操作流程：梯形速度规划 vs S形速度规划
| 规划方式 | 速度曲线 | 加速度曲线 | 适用场景 |
|---|---|---|---|
| 梯形规划 | 匀加速→匀速→匀减速 | 阶跃变化（不连续） | 低速、短距离、负载较轻 |
| S形规划 | 平滑过渡（正弦或多项式） | 连续变化（无突变） | 高速、长距离、精密对接 |
在部署时，需要根据电机驱动器性能设定最大加速度与最大减速度。例如，某差速AGV最大速度1.5m/s，最大加速度0.8m/s²，则从静止加速到最大速度需要约1.9秒，加速距离约1.4米。若路径规划模块未考虑该距离，AGV将无法在指定位置前完成减速，导致过冲。
3.3 角速度：转弯控制的“方向盘”
核心原理：角速度 ω（rad/s 或 °/s）描述AGV航向角的变化速率。对于差速AGV，角速度由左右轮速差产生：ω = (v_r - v_l) / L。对于舵轮AGV，角速度由转向角与前进速度共同决定。角速度是路径跟踪中转弯控制的核心输入，直接影响AGV能否平滑地通过弯道。
判断方法：在路径跟踪算法（如纯追踪 Pure Pursuit）中，控制器会根据当前位姿与目标路径的横向偏差、航向偏差计算期望角速度。若期望角速度超过AGV的物理极限（例如最大转向速率），则跟踪会失败。因此，在部署前必须标定AGV的最大角速度与最大角加速度。
一个典型的差速AGV转弯场景：假设轮距 L=0.6m，最大轮速差为1.0m/s，则最大角速度为 1.0/0.6 ≈ 1.67 rad/s（约95.5°/s）。若路径规划要求AGV在2秒内完成90°转弯，则平均角速度为0.785 rad/s，低于极限值，可行；但若要求0.5秒内完成90°转弯，则平均角速度达3.14 rad/s，超出极限，必须重新规划路径或降低速度。
3.4 控制周期：算法执行的“心跳”
核心原理：控制周期 T 是运动控制算法每次执行的时间间隔，单位为毫秒（ms）。它决定了控制系统的响应速度与离散化精度。控制周期越短，系统对扰动的响应越快，但计算负载也越高。在AGV部署中，典型控制周期为：
- 底层电流环/速度环：1ms~2ms（由驱动器固件实现）
- 运动控制环（位姿/速度）：5ms~20ms（由控制器实现）
- 路径规划/导航环：50ms~200ms（由上位机实现）
操作流程：在部署运动控制算法时，需要明确各环节的周期匹配关系。例如，若运动控制周期为10ms，而传感器（如激光雷达）的位姿更新周期为100ms，则需要在两次位姿更新之间使用航迹推算进行“插补”，以保证控制指令的连续性。
控制周期的选择还受到通信延迟的影响。若控制器与驱动器之间采用CAN总线通信，波特率500kbps，每条指令约8字节，则总线负载率需控制在合理范围。若控制周期过短，可能导致总线拥塞，反而增加延迟。
3.5 反馈与闭环控制：从“盲走”到“精准”
核心原理：开环控制是指控制器根据预设指令直接驱动执行器，不检测实际输出；闭环控制则通过传感器实时检测被控量（如实际速度、实际位姿），与期望值比较后产生偏差信号，再根据偏差调整控制量。AGV运动控制中，闭环是必须的——因为车轮打滑、地面不平、负载变化等扰动无处不在。
典型闭环结构：
- 内环（速度环）：编码器反馈实际轮速，与期望轮速比较，通过PID调节电机PWM占空比。
- 外环（位置环/位姿环）：根据定位系统（激光/二维码/IMU融合）反馈实际位姿，与目标路径比较，计算期望速度与角速度。
在部署中，PID参数整定是闭环控制的核心工作。以速度环为例，比例系数 Kp 决定响应速度，积分系数 Ki 消除稳态误差，微分系数 Kd 抑制超调。AGV速度环通常采用PI控制（不加微分，因为速度反馈噪声较大）。
// 速度环PI控制伪代码
error = target_speed - actual_speed;
integral += error * dt;
output = Kp * error + Ki * integral;
// 限幅处理
if (output > MAX_OUTPUT) output = MAX_OUTPUT;
if (output < -MAX_OUTPUT) output = -MAX_OUTPUT;案例拆解：AGV停车精度不足的排障过程
| 步骤 | 操作内容 | 关键数据/现象 |
|---|---|---|
| 1. 现象确认 | AGV在目标点前停车，但实际停止位置偏差达±30mm | 目标精度要求±10mm |
| 2. 数据采集 | 记录停车过程中的速度曲线与位姿反馈 | 发现减速段速度波动大，最后10cm速度未降至0 |
| 3. 原因分析 | 检查速度环PI参数与加速度设定 | Kp=0.8，Ki=0.2，加速度设定1.0m/s² |
| 4. 调整措施 | 增大Kp至1.2，减小Ki至0.1，降低加速度至0.6m/s² | 速度波动减小，但停车仍有±15mm偏差 |
| 5. 进一步排查 | 检查编码器分辨率与轮径标定 | 发现轮径标定误差约2%，导致里程计算偏差 |
| 6. 最终解决 | 重新标定轮径，并增加停车前的位置闭环修正 | 停车精度稳定在±5mm以内 |
该案例说明，闭环控制不仅仅是PID参数问题，还涉及传感器标定、机械参数准确性等基础工程问题。在部署运动控制算法时，必须建立系统化的排障流程：先确认现象，再分层排查（执行器→传感器→算法参数→机械标定）。
3.6 总结复盘：核心概念在AGV部署中的联动关系
位姿、速度、加速度、角速度、控制周期、反馈与闭环控制并非孤立概念，它们构成了一个完整的控制链路：位姿是目标与反馈的载体，速度与加速度是执行层的物理约束，角速度是转弯控制的关键，控制周期是算法执行的节拍，反馈与闭环是保证精度的机制。在部署运动控制算法时，建议按以下顺序进行系统检查：
- 明确AGV的物理参数：轮距、轮径、最大速度、最大加速度、最大角速度。
- 确定控制周期：根据总线能力、传感器更新率、驱动器响应时间综合选择。
- 标定传感器：编码器轮径、IMU安装角度、激光定位外参。
- 整定内环（速度环）参数，确保速度跟踪无超调、无静差。
- 整定外环（位姿环）参数，结合路径跟踪算法（如纯追踪、Stanley）进行联调。
- 进行全流程测试：包括直线、弯道、启停、负载变化等场景。