1. 课程导入

农机自动驾驶导航控制工程，是研究农业机械在田间作业过程中如何自动感知自身位置、姿态与作业环境，并通过控制算法驱动转向、油门、机具等执行机构，使农机沿预定路径稳定、精准、高效完成耕、种、管、收等作业任务的一门交叉工程学科。它把卫星定位、惯性测量、车辆动力学、自动控制、嵌入式系统与农艺要求融合在一起，最终目标是让"机器自己会走、走得直、走得准、走得稳"。

一、核心原理：从"感知—决策—执行"闭环理解导航控制

农机自动驾驶并不是单一技术，而是一个典型的闭环控制系统。其基本链路可拆解为四个环节：

• 定位感知：GNSS（GPS/北斗/GLONASS）提供绝对位置，RTK差分把定位精度从米级提升到厘米级；IMU提供航向角、俯仰角、横滚角，弥补卫星信号遮挡和更新率不足。
• 状态估计：通过卡尔曼滤波或互补滤波融合GNSS与IMU数据，得到农机的位置、速度、航向和姿态估计。
• 路径规划与跟踪：根据地块边界、作业幅宽和农艺要求生成AB线、地头转弯路径；控制器计算横向偏差和航向偏差，输出转向指令。
• 执行控制：转向电机或液压阀驱动前轮，油门/换挡机构维持速度，机具控制器调节播种、施肥、喷药执行机构。

其中，路径跟踪控制是核心难点。常用算法包括纯追踪（Pure Pursuit）、Stanley控制、模型预测控制（MPC）和PID控制。纯追踪算法通过前视距离计算目标点，形式简单、鲁棒性好，是农机导航中应用最广的方法之一。

纯追踪横向控制简化逻辑：
1. 在当前位姿 (x, y, θ) 前方取前视点 P
2. 计算前视点与车体航向的夹角 α
3. 曲率 κ = 2·sin(α) / Ld   （Ld 为前视距离）
4. 期望前轮转角 δ = arctan(κ · L)  （L 为轴距）
5. 转向执行器跟踪 δ，闭环修正横向偏差

二、发展历程：从辅助驾驶到无人化作业

农机自动驾驶的发展大致经历四个阶段：

1. 机械导向阶段（20世纪80—90年代）：依靠垄沟、机械触杆、激光平地等被动导向，精度低、依赖人工。
2. GPS辅助阶段（2000年前后）：单点GPS用于地块测量和作业记录，精度米级，只能做辅助显示。
3. RTK自动导航阶段（2010年前后）：RTK厘米级定位成熟，自动转向系统开始普及，实现AB线直线作业和地头自动掉头。
4. 智能无人化阶段（2020年至今）：多传感器融合、视觉感知、云端调度、农机协同作业，向无人农场和集群作业演进。

三、应用价值：为什么农机需要自动驾驶

农机自动驾驶的价值体现在农艺、经济和管理三个层面：

四、学习目标与整体知识框架

本课程面向农机自动驾驶导航控制工程，学习目标包括：理解导航控制系统组成与工作原理；掌握定位、姿态估计与路径跟踪核心算法；能够进行系统标定、参数调试与故障排查；了解典型农机平台与农艺适配要求。

整体知识框架可分为五层：

• 基础层：坐标系、车辆运动学、控制理论基础。
• 感知层：GNSS/RTK、IMU、轮速、视觉传感器与数据融合。
• 决策层：路径规划、AB线生成、地头转弯策略、避障。
• 控制层：横向控制、纵向控制、机具控制与执行机构。
• 系统层：标定、调试、测试、故障诊断与工程集成。

五、常见误区与学习建议