4. 农机位姿感知传感器原理与选型
农机自动驾驶要“走得直、对得准”，前提是控制器随时知道两件事：车在哪里（位置），车头朝哪里（航向与姿态）。位姿感知层通常由GNSS/RTK定位、航向测量（双天线或IMU）、姿态传感器和轮速传感器共同构成，它们各自解决不同维度的问题，又通过融合算法互相补足。本节按“原理—选型—安装—标定”的顺序展开，重点讲清每种传感器的输出含义、误差来源，以及在农机上如何落地。
一、GNSS/RTK定位原理
普通GNSS单点定位依靠接收机同时观测多颗卫星的伪距，通过球面交会解算三维位置，民用单点精度通常在米级，且受电离层延迟、卫星钟差、多路径反射影响，无法满足农机对行作业的厘米级要求。RTK（实时动态差分）的思路是引入一个位置已知的基准站：基准站同样观测卫星，把“实测伪距与理论伪距之差”作为改正数，通过电台或4G网络发给流动站，流动站用改正数消除大部分公共误差，再通过载波相位整周模糊度解算，把定位精度提升到水平约±(1~2)cm、高程约±(2~3)cm。
农机作业中需要关注几个关键参数：固定解状态（Fix）、卫星数、PDOP值、差分龄期和基线长度。固定解是可用厘米级结果的前提，浮点解（Float）精度会退化到分米级，单点解则不可用于自动转向。差分龄期反映改正数的新鲜程度，超过5~10秒精度明显下降；基线长度一般建议控制在10km以内，过长会削弱误差的空间相关性。实际调试时，应把“固定解率”作为一项可观测指标，例如在开阔地块记录10分钟，统计Fix状态占比，低于95%就要排查天线位置、遮挡或网络链路。
二、航向测量：双天线与IMU
定位只给出位置，不给车头朝向。航向测量有两条主流路线。其一是双天线GNSS定向：两个天线沿车体纵向（或横向）固定安装，间距称为基线，接收机通过比较两天线收到的同一卫星载波相位差，解算出基线向量在空间中的方向，从而得到航向角。航向精度与基线长度近似成反比，经验上1m基线可做到约0.5°量级，2m基线可优于0.3°。双天线的优点是航向不随时间漂移、上电即绝对，缺点是受多路径和遮挡影响，且基线越长安装越受限。
其二是IMU（惯性测量单元）航向：陀螺仪测量车体绕垂直轴的角速度，对角速度积分得到航向变化量。IMU短时响应快、更新率高（常见100Hz以上），能捕捉转向瞬间的动态，但积分会累积漂移，纯陀螺航向几分钟内就可能漂移数度。因此工程上普遍采用“双天线提供绝对航向基准 + IMU提供高频动态”的组合，用卡尔曼滤波把两者融合：GNSS定向修正IMU的长期漂移，IMU填补GNSS更新间隔内的航向变化。
三、姿态传感器与轮速传感器
姿态传感器（常与IMU一体）输出横滚角、俯仰角和航向角。农机在坡地、垄沟、颠簸路面行驶时，车体横滚和俯仰会改变天线相位中心与地面参考点的几何关系，若不补偿，定位点会“投影”到错误的地面位置。以横滚5°、天线高2m为例，横向投影偏差约为2×sin5°≈0.17m，足以造成明显对行偏差。因此控制器需要用姿态角把天线位置归算到车体参考点（通常是后轴中心或车体几何中心）。
轮速传感器测量车轮转速，乘以轮径得到行驶速度，主要用于：低速时的速度观测、GNSS失锁短时内的航位推算、以及打滑检测。田间土壤松软，驱动轮滑转率可达10%~20%，因此轮速更适合做“相对变化”的参考，而不是绝对速度基准。选型时应关注分辨率（每转脉冲数）和安装间隙，霍尔式或磁电式均可，但要注意泥水、铁屑对信号的影响。
四、安装与标定实操
安装阶段的核心是“把几何关系固定下来并测量准确”。主天线应安装在车体纵向中线上方、尽量高且无遮挡的位置，副天线与主天线构成平行于车体纵轴的基线，基线长度在结构允许下尽量取大。安装完成后必须测量杆臂：天线相位中心相对车体参考点（建议取后轴中心地面投影）的纵向、横向、垂向偏移，作为固定参数写入控制器。IMU应刚性固定在车体基准面上，安装面与车体坐标系的夹角（安装角）需通过标定消除，避免把安装倾斜误判为坡地姿态。
标定通常分三步。第一步是静止零偏标定：车辆停在水平硬地，静止采集2~3分钟IMU数据，求陀螺零偏均值并写入。第二步是航向安装角标定：沿一条已知方位角的直线（可用RTK打两个点计算方位角）匀速行驶50~100m，比较双天线航向与行驶轨迹方位角，差值即为安装角修正量。第三步是轮速标定：在已知长度L的直线段上行驶，记录轮速脉冲累计数N，有效轮径按 D = L / (π·N/每转脉冲数) 反算，或直接用“距离/脉冲数”得到标定系数。
五、选型建议
选型要围绕作业精度、地块条件和成本三方面权衡。对行精度要求±2.5cm的播种、插秧作业，应选支持多星座、固定解稳定、更新率≥10Hz的RTK接收机，并优先考虑带双天线定向的型号以减少对IMU长期精度的依赖。丘陵坡地作业应选横滚/俯仰精度优于0.5°的姿态模块，并确认其动态倾角补偿能力。轮速传感器按每转脉冲数选择，低速作业（<3km/h）建议分辨率不低于每转60脉冲，以保证低速速度观测的平滑性。所有传感器都应确认工作温度、防护等级（田间建议IP67及以上）和电磁兼容性，避免与电台、电机驱动器互相干扰。
最后需要强调：传感器本身精度再高，若杆臂、安装角、轮径系数标定不准，融合结果依然会系统性偏移。调试时应养成“先静态标定、再直线复测、后田间验证”的习惯，把固定解率、航向残差、往返横向偏差作为三项常规检查指标，才能让位姿感知真正支撑起自动转向的稳定控制。