2. 农机自动导航系统工作原理与误差来源总览
农机自动导航系统并不是单一设备，而是一条从“天上”到“地里”的完整信号与执行链路。理解这条链路，是后续做误差分析与修正的前提。因为同一个“跑偏”现象，可能来自卫星信号、姿态解算、路径跟踪算法，也可能来自转向机构的机械间隙。若不清楚误差在链条上的传递位置，修正就会变成盲目调参。
一、系统由哪几个环节构成
典型的农机自动导航系统可划分为四个功能环节，它们首尾相接、逐级传递：
- 定位定姿环节（GNSS/INS组合导航）：GNSS接收机（常见为支持RTK的双频多星座接收机）提供厘米级位置，惯性测量单元（IMU）提供加速度与角速度，二者通过卡尔曼滤波融合，输出车辆的位置、速度、航向角与姿态角。RTK差分改正数通常由基站或网络RTK服务提供。
- 路径规划与跟踪控制环节：导航控制器读取预先设定的AB线、曲线或地块边界，计算车辆当前位姿与目标路径之间的横向偏差和航向偏差，再通过纯追踪（Pure Pursuit）、Stanley等算法输出期望前轮转角。
- 转向执行环节：控制器把期望转角转换为转向指令，驱动电动方向盘、液压比例阀或电控转向器，使前轮实际转动。
- 车辆本体与作业机具：车辆动力学响应转向指令，机具（播种机、喷杆、犁等）随车运动，最终决定作业行的实际位置。
需要特别说明坐标与符号约定：本文统一采用车辆坐标系，以车辆前进方向为X轴正向，向左为Y轴正向，航向角以正北为0°、顺时针为正。横向偏差定义为车辆实际位置相对目标路径的偏移，车辆偏左为正、偏右为负。全文与图示均遵循此约定。
二、误差沿链条如何传递
把误差按环节归类，可以清楚看到它的传递方式：
第一层：定位定姿误差。RTK在开阔地块的固定解水平精度通常可达±2 cm量级，但一旦出现卫星遮挡、多路径或差分链路中断，可能降级为浮点解，误差跳到分米甚至米级。IMU的作用是在GNSS短时失锁时维持航向推算，但陀螺零偏会随时间积累，例如零偏0.5°/s时，10秒航向漂移可达5°。此外，IMU安装角若与车体轴线存在偏差，会直接污染航向输出。
第二层：控制误差。控制器拿到位姿后计算横向偏差。以纯追踪算法为例，前视距离Ld是核心参数：Ld过小，跟踪响应快但易振荡；Ld过大，转向平缓但弯道切内。控制周期与执行延迟也会引入相位滞后，在高速作业时表现为“入弯晚、出弯冲”。
第三层：执行误差。电动方向盘与转向柱之间的齿轮间隙、液压阀的死区，都会造成“指令已发、车轮未动”的回差。转角传感器标定不准，则期望转角与实际转角之间存在系统性比例偏差。
第四层：车辆与机具误差。轮胎滑移率随土壤湿度变化，坡地上重力分量引起侧偏，机具挂接点相对GNSS天线的横向偏置若未补偿，会形成固定偏移。
三、一个可操作的排查思路
面对“作业行偏移”问题，建议按信号流向从上游到下游逐段验证，而不是一上来就调转向参数：
- 静态检查定位质量：车辆静止时观察RTK解状态是否稳定为固定解，水平精度因子与卫星数是否正常，航向输出是否抖动。
- 直线段验证跟踪：在平直地块以固定速度（如6 km/h）行驶，记录横向偏差曲线。若偏差呈缓慢单向漂移，多为定位或航向问题；若呈周期性摆动，多为控制增益或前视距离问题。
- 转向回差测试：原地小幅左右打方向，测量指令转角与实际转角的差值，判断机械间隙与标定偏差。
- 机具偏置核对：测量机具作业中心相对天线的横向距离，确认控制器中的偏置参数与实际一致。