2. 坐标系与定位技术:GNSS、RTK与农机姿态解算
定位是农机自动导航的「眼睛」。没有精准的坐标,路径规划就是纸上谈兵。这一章,我带你从卫星信号到农机坐标系,把定位的底子打牢。
2.1 全球导航卫星系统(GNSS)原理
GNSS 不是 GPS,它是所有卫星导航系统的统称。包括美国的 GPS、中国的北斗、俄罗斯的 GLONASS、欧盟的 Galileo。说白了,就是天上飞着一群卫星,地面上的接收机通过测量信号传播时间,算出自己离每颗卫星有多远。
原理其实不复杂:
- 卫星发射信号,包含自己的位置和发射时间。
- 接收机收到信号,记录到达时间。
- 时间差 × 光速 = 距离。
- 同时收到至少 4 颗卫星的信号,就能解算出三维坐标(x, y, z)和时间偏差。
为什么精度这么差?因为信号穿过大气层会折射,卫星轨道有微小误差,接收机时钟也不够准。这些误差叠加起来,几米就没了。
2.2 RTK 差分定位:厘米级的关键
RTK(Real-Time Kinematic,实时动态差分)是解决精度问题的核心手段。它的思路很简单:
- 在已知精确坐标的位置架设一个基准站。
- 基准站接收卫星信号,算出自己的测量坐标与真实坐标的偏差。
- 基准站把这个偏差通过电台或 4G 网络发给流动站(农机上的接收机)。
- 流动站用这个偏差修正自己的测量结果。
这样一来,公共误差(大气折射、卫星轨道误差)就被抵消了。精度直接从米级跳到厘米级——2-3 厘米,足够让农机沿着规划路径走。
| 定位方式 | 典型精度 | 适用场景 | 成本 |
|---|---|---|---|
| 单点 GNSS | 2-5 m | 地块边界测绘、粗略导航 | 低 |
| DGPS(差分 GPS) | 0.5-1 m | 大面积粗耕、变量施肥 | 中 |
| RTK(实时动态差分) | 2-3 cm | 精量播种、自动驾驶、对行作业 | 高 |
| PPK(后处理动态差分) | 2-5 cm | 测绘、不需要实时反馈的场景 | 中高 |
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° |
2.5 知识体系总览
下面这张图把本章的核心逻辑串起来了。从卫星信号到农机坐标,每一步都有对应的技术和注意事项。
2.6 实战要点总结
这一章内容不少,我帮你拎几个关键点:
- RTK 是刚需:农机自动驾驶没有 RTK,精度根本不够。别省这个钱。
- 杆臂补偿必须做:天线位置和车辆控制点不重合,不做补偿就是瞎指挥。
- 航向用双天线:磁罗盘在农机上不靠谱,双天线虽然贵但省心。
- IMU 要定期校准:温度变化、振动都会让 IMU 零偏漂移。我一般每季度校准一次。