4. 坐标系与变换

在农机自动驾驶与路径规划中，所有路径点、地块边界、障碍物和作业幅宽最终都要落到一个可计算的坐标体系里。若坐标系定义混乱，即使路径算法本身正确，也会出现“地图上对齐、田里跑偏”的问题。本章围绕全局坐标系、局部坐标系、农机位姿表示、坐标变换与标定方法展开，建立从卫星定位到车体控制的统一空间语言。

一、全局坐标系与局部坐标系的分工

全局坐标系通常采用地心直角坐标系（ECEF）或大地坐标系（经纬高），也可使用UTM投影后的平面坐标。它的优点是绝对、唯一，适合跨地块、跨机群共享；缺点是数值大、直接做局部几何计算时精度和效率都不理想。局部坐标系则以某个基准点为原点，例如地块角点、机库出口或首次定位点，坐标轴通常取东-北-天（ENU）或北-东-地（NED），单位用米，便于路径生成、避障和幅宽计算。

工程上常见的做法是：全局定位数据先投影到局部平面，路径规划在局部坐标系中完成，控制指令再通过逆变换回到车体执行。这样既保留了绝对定位的全局一致性，又获得了局部计算的简洁性。

二、农机位姿表示：位置与姿态的统一描述

农机位姿由位置和姿态两部分组成。位置通常表示为局部坐标系下的 (x, y, z)，其中 z 在平地作业中可近似为高程或忽略。姿态则描述车体朝向和倾斜，常用三种方式表示：

• 欧拉角：横滚角（roll）、俯仰角（pitch）、航向角（yaw）。直观易懂，但存在万向节死锁问题，且旋转顺序不同结果不同。
• 旋转矩阵：3×3正交矩阵，无死锁，便于连续变换，但数值累积误差需要正交化修正。
• 四元数：4个参数表示旋转，无死锁、插值平滑，适合组合导航与高频姿态更新，但物理直观性较差。

在农机场景中，航向角是最关键的姿态量，它直接决定农机前进方向与路径切线的偏差。横滚和俯仰则影响GNSS天线相位中心到地面的投影，尤其在坡地作业中不可忽略。

三、坐标变换链：从天线到车体到田块

农机上的定位天线通常安装在车顶，而控制点往往在后轴中心或车体几何中心。因此，一次完整的坐标变换需要经过多个环节：

1. 天线相位中心在局部坐标系中的位置；
2. 天线到车体参考点的杆臂向量（lever arm）；
3. 车体坐标系到局部坐标系的旋转（由航向、俯仰、横滚决定）；
4. 局部坐标系到全局坐标系的基准平移与旋转。

用齐次变换矩阵可以统一表达为：

P_global = T_global_local · R_local_body · P_body + L_antenna

其中：
T_global_local：局部到全局的平移与旋转
R_local_body：车体到局部的旋转矩阵
P_body：车体参考点坐标
L_antenna：天线杆臂向量

若忽略杆臂补偿，坡地或大航向角变化时，定位点与车体实际位置可能相差数十厘米，直接导致压线或漏耕。

四、标定方法：让变换参数可信

坐标变换的精度取决于标定。农机常用标定内容包括：天线杆臂标定、航向安装角标定、轮速系数标定和IMU安装角标定。标定方法可分为静态标定和动态标定两类。

标定项	常用方法	关键输出	注意事项
天线杆臂	卷尺测量+静态多点解算	天线到后轴中心的向量	需区分车体坐标系轴向定义
航向安装角	直线行驶对比GNSS航向与车体几何航向	安装偏差角	需在开阔无遮挡区域进行
轮速系数	已知距离直线行驶，对比里程计与GNSS距离	脉冲当量或比例系数	胎压、载荷会影响结果
IMU安装角	静止多姿态或动态转弯激励	IMU到车体的旋转矩阵	需补偿零偏和尺度因子

五、典型场景与常见误区

以一个矩形地块的播种作业为例：全局坐标系下地块四角为经纬度，投影到局部ENU坐标系后得到米制边界。路径规划器在局部坐标系中生成往复式作业路径，每个路径点包含(x, y, 航向)。控制器根据当前位姿与目标路径点的偏差计算前轮转角。若天线杆臂未标定，农机在掉头时航向变化剧烈，定位点会绕车体画弧，导致入线偏差增大。

常见误区包括：

• 混淆坐标系轴向：把NED当成ENU使用，导致航向角相差90°或符号相反。
• 忽略旋转顺序：欧拉角在不同旋转顺序下结果不同，必须与标定和控制器保持一致。
• 标定后不复核：标定参数写入后未做直线和转弯验证，错误被掩盖到作业阶段。
• 局部坐标系原点漂移：多次作业使用不同基准点，导致历史路径无法复用。

六、本节知识结构图解

下图给出全局坐标系、局部坐标系、车体坐标系之间的变换关系，以及标定环节在其中的作用位置。

理解并正确实现上述坐标变换与标定流程，是后续路径跟踪、地头转向和作业覆盖控制的基础。只有在统一、可验证的空间基准上，路径规划算法才能稳定地转化为田间的实际行驶轨迹。