4. 田间作业位置与姿态数据采集
农机在田间的作业质量,很大程度上取决于“车在哪里、朝哪个方向、姿态如何”这三类信息能否被准确、连续地记录下来。位置数据回答“作业到哪了”,姿态数据回答“机具是否水平、是否偏摆”,两者融合后才能还原出真实的作业轨迹与作业状态。本节围绕GNSS定位原理与差分技术、IMU姿态测量、定位与姿态融合方法,以及田间轨迹采集与精度评估展开。
一、GNSS定位原理与差分技术
GNSS接收机通过测量卫星信号到达时间,解算出接收机到各颗卫星的伪距,再联立多颗卫星的观测方程求解三维位置与钟差。单点定位的误差来源包括卫星轨道误差、电离层与对流层延迟、多路径效应和接收机噪声,民用单点定位水平精度通常在米级,难以满足播种、施肥、喷药对行距和重叠率的严格要求。
差分技术的核心思想是“用已知点改正未知点”。基准站架设在坐标已知的点位上,实时计算其观测值与理论值的偏差,并通过数据链播发给流动站,流动站用该改正数修正自身观测,从而大幅削弱公共误差。按改正方式可分为位置差分、伪距差分和载波相位差分。其中RTK(实时动态差分)采用载波相位观测,通过基准站与流动站之间的双差处理消除大部分误差,并解算整周模糊度,固定解状态下水平精度可达厘米级(典型标称约±(8mm+1ppm)),是高精度农机导航的主流方案。
实际使用中需关注几个关键条件:基准站与流动站的距离一般控制在10km以内,距离越远,空间相关性越弱,固定解越难维持;数据链(电台或4G/5G网络)必须稳定,链路中断会导致流动站退化为浮点解甚至单点解;田块周边的高大树木、输电线路、建筑物会造成信号遮挡和多路径,应尽量避开。北斗系统在我国及周边地区可见卫星数多、几何构型好,配合北斗地基增强系统或网络RTK服务,可在无自建基准站的情况下获得稳定固定解,适合跨区作业场景。
二、IMU姿态测量
惯性测量单元(IMU)由三轴加速度计和三轴陀螺仪组成,加速度计测量比力,陀螺仪测量角速度。通过对陀螺仪角速度积分可获得姿态角变化,但积分会累积漂移;加速度计在静态或低动态条件下可感知重力方向,用于修正俯仰角和横滚角。两者通过互补滤波或卡尔曼滤波融合,才能得到稳定可靠的姿态输出。
需要明确坐标系约定:本节采用“右-前-上”(RFU)机体坐标系,X轴指向机体右侧,Y轴指向前进方向,Z轴垂直机体向上;姿态角定义为绕X轴的横滚角、绕Y轴的俯仰角、绕Z轴的航向角,均以右手定则为正。航向角无法仅靠加速度计观测,必须借助磁力计或GNSS双天线测向,因此实际系统中常采用GNSS+IMU组合,由GNSS提供航向基准,IMU提供高频姿态更新。
农机作业环境振动大、冲击强,IMU安装应刚性固定在车体靠近质心的位置,减振垫不能过软,否则会引入低频晃动误差。上电后需进行静态初始化,保持车辆静止数十秒完成零偏估计;作业中若长时间停车再启动,应重新检查零偏是否漂移。
三、定位与姿态数据融合
GNSS输出频率通常为1~10Hz,IMU可达100Hz以上,两者时间不同步、频率不一致,直接拼接会造成轨迹抖动。融合的基本思路是以IMU的高频数据做状态递推,以GNSS的位置和速度观测做量测更新,通过扩展卡尔曼滤波估计位置、速度、姿态及传感器零偏。融合后既保留了GNSS的绝对精度,又获得了IMU的平滑性和短时抗遮挡能力。
时间同步是融合成败的关键。工程上通常以GNSS的PPS秒脉冲作为时间基准,将IMU采样时刻对齐到统一时间轴,并对GNSS与IMU之间的固定传输延迟进行标定补偿。若时间戳错位超过一个IMU采样周期,转弯工况下的姿态与位置就会出现明显错配。
四、田间轨迹采集实操
以一次播种作业轨迹采集为例,可按以下流程实施。首先在田块内选取视野开阔处架设基准站或确认网络RTK账号已登录,等待接收机进入固定解(状态标识为RTK Fixed),并记录固定解卫星数(建议不少于12颗)和水平精度因子。随后将IMU与GNSS天线按设计位置安装,测量天线到车体参考点的杆臂向量并录入采集软件,杆臂录入错误会直接导致转弯处轨迹外扩或内缩。
采集软件中设置输出频率为10Hz,记录字段至少包括时间戳、经纬度、高程、固定解状态、卫星数、航向角、横滚角、俯仰角、车速和机具作业状态。作业前让车辆直线行驶50m左右做一次航向检查,观察航向角与行驶方向的偏差是否在允许范围内。作业过程中若固定解降级为浮点解,应在日志中标记该时段,便于后续剔除或加权处理。
采集完成后进行精度评估。常用做法是在田块内布设若干检查点,用更高精度的测量手段获取其坐标作为真值,将轨迹上距检查点最近的位置与之比较,统计水平误差的均方根值(RMSE)。例如某次示例中,选取5个检查点,水平偏差分别为2.1cm、3.4cm、2.8cm、4.0cm、2.5cm,则RMSE约为3.0cm,可判定满足厘米级作业要求;若某点偏差达15cm以上,应回查该处是否存在遮挡、多路径或固定解丢失。姿态精度则可通过静止状态下俯仰角、横滚角的波动幅度评估,波动标准差宜控制在0.3°以内。
需要强调的是,上述数值均为教学示例中的合理假设,实际作业应以现场标定和实测结果为准。位置与姿态数据的质量决定了后续作业面积统计、重叠率分析和变量作业决策的可靠性,采集环节的严谨程度直接决定整条数据链的上限。