2. 坐标系与定位技术:GNSS、RTK与农机姿态解算

定位是农机自动导航的「眼睛」。没有精准的坐标,路径规划就是纸上谈兵。这一章,我带你从卫星信号到农机坐标系,把定位的底子打牢。

2.1 全球导航卫星系统(GNSS)原理

GNSS 不是 GPS,它是所有卫星导航系统的统称。包括美国的 GPS、中国的北斗、俄罗斯的 GLONASS、欧盟的 Galileo。说白了,就是天上飞着一群卫星,地面上的接收机通过测量信号传播时间,算出自己离每颗卫星有多远。

原理其实不复杂:

  • 卫星发射信号,包含自己的位置和发射时间。
  • 接收机收到信号,记录到达时间。
  • 时间差 × 光速 = 距离。
  • 同时收到至少 4 颗卫星的信号,就能解算出三维坐标(x, y, z)和时间偏差。
我的经验:单点 GNSS 精度在 2-5 米,农田里勉强能分清地块边界,但要让拖拉机走直线?差远了。我见过有人用手机 GPS 导航去犁地,结果相邻两趟重叠了半米,浪费油还压苗。

为什么精度这么差?因为信号穿过大气层会折射,卫星轨道有微小误差,接收机时钟也不够准。这些误差叠加起来,几米就没了。

2.2 RTK 差分定位:厘米级的关键

RTK(Real-Time Kinematic,实时动态差分)是解决精度问题的核心手段。它的思路很简单:

  1. 在已知精确坐标的位置架设一个基准站。
  2. 基准站接收卫星信号,算出自己的测量坐标与真实坐标的偏差。
  3. 基准站把这个偏差通过电台或 4G 网络发给流动站(农机上的接收机)。
  4. 流动站用这个偏差修正自己的测量结果。

这样一来,公共误差(大气折射、卫星轨道误差)就被抵消了。精度直接从米级跳到厘米级——2-3 厘米,足够让农机沿着规划路径走。

定位方式 典型精度 适用场景 成本
单点 GNSS 2-5 m 地块边界测绘、粗略导航 低
DGPS(差分 GPS) 0.5-1 m 大面积粗耕、变量施肥 中
RTK(实时动态差分) 2-3 cm 精量播种、自动驾驶、对行作业 高
PPK(后处理动态差分) 2-5 cm 测绘、不需要实时反馈的场景 中高
避坑指南:我曾经在新疆一个项目里,RTK 基准站架在棉田边,结果信号老是断。查了半天,发现是附近有个高压线塔在干扰电台。后来我把基准站移到 200 米外的开阔地,问题才解决。记住:基准站选址要远离高压线、大型金属结构和大功率发射塔。

2.3 农机坐标系定义

有了厘米级的定位,接下来要回答一个问题:定位点装在农机上哪个位置?

我习惯把农机坐标系定义成这样:

  • 原点 O:通常取农机后轴中心在地面的投影点。为什么是后轴?因为后轴是转向中心,转弯时后轴轨迹最稳定。
  • X 轴:沿农机前进方向为正。
  • Y 轴:垂直于前进方向,指向农机右侧为正。
  • Z 轴:垂直地面向上为正。

但 GNSS 天线通常装在驾驶室顶部,离后轴中心有一段距离。这就需要一个「杆臂补偿」——把天线测到的坐标换算到后轴中心。

杆臂补偿公式(简化版):

X_vehicle = X_antenna - L * cos(θ)
Y_vehicle = Y_antenna - L * sin(θ)

其中 L 是天线到后轴中心的水平距离,θ 是当前航向角。这个补偿不做,路径跟踪会偏一个车身。

2.4 航向角与姿态解算

农机不光要知道自己在哪里,还要知道自己在朝哪个方向走、车身是不是倾斜的。这就涉及航向角和姿态。

航向角(Heading):农机前进方向与正北方向的夹角,顺时针为正,范围 0°-360°。GNSS 双天线可以测航向——两个天线装在车顶前后,基线方向就是车头方向。

姿态角:包括横滚角(Roll)、俯仰角(Pitch)。农机在坡地上作业时,这两个角会影响定位精度和路径跟踪效果。

我一般用 IMU(惯性测量单元)来解算姿态。IMU 里有三轴陀螺仪和三轴加速度计,通过卡尔曼滤波融合数据,输出稳定的姿态角。

参数 含义 典型传感器 精度要求
航向角 前进方向与正北夹角 GNSS 双天线 / 磁罗盘 ±0.1°
横滚角 车身绕前进方向旋转 IMU(加速度计+陀螺仪) ±0.2°
俯仰角 车头上下倾斜 IMU ±0.2°
我的习惯:只用 GNSS 双天线测航向,不用磁罗盘。为什么?农机周围全是铁——发动机、变速箱、液压管路,磁罗盘在这种环境里误差能到 10° 以上。双天线虽然贵一点,但稳定可靠。

2.5 知识体系总览

下面这张图把本章的核心逻辑串起来了。从卫星信号到农机坐标,每一步都有对应的技术和注意事项。

坐标系与定位技术知识体系 GNSS 卫星信号 接收机 → RTK 差分定位(厘米级) 天线坐标 → 杆臂补偿 → 农机后轴中心坐标 航向角(GNSS 双天线) + 姿态角(IMU 卡尔曼滤波) 输出:位置(x, y, z)+ 航向 + 姿态 说明:每一步的误差都会向下传递。RTK 基准站架设不当 → 厘米级变分米级; 杆臂补偿参数错误 → 路径跟踪偏差;IMU 未校准 → 坡地作业跑偏。

2.6 实战要点总结

这一章内容不少,我帮你拎几个关键点:

  • RTK 是刚需:农机自动驾驶没有 RTK,精度根本不够。别省这个钱。
  • 杆臂补偿必须做:天线位置和车辆控制点不重合,不做补偿就是瞎指挥。
  • 航向用双天线:磁罗盘在农机上不靠谱,双天线虽然贵但省心。
  • IMU 要定期校准:温度变化、振动都会让 IMU 零偏漂移。我一般每季度校准一次。
再提醒一句:坐标系定义一定要和路径规划算法统一。我见过一个团队,规划用后轴中心,控制用前轴中心,结果车怎么都走不直。这种低级错误,花了两天才排查出来。