[发明专利]一种基于机具位姿估计的水田无人农机路径跟踪控制方法

摘要

本发明公开了一种基于机具位姿估计的水田无人农机路径跟踪控制方法，包括以下步骤：S1、在农机机身安装全球卫星定位测量装置GNSS，获取农机车体中心坐标，获取农机机具位姿估计；S2、建立农机车体和机具的运动学模型；S3、建立农机运动学模型预测路径跟踪控制器，以水田农机行驶速度和转向轮角作为系统输入控制变量，以农机具位姿为系统状态变量，建立农机机具的状态空间模型，采用欧拉法对模型进行离散化，获得农机具线性误差模型；设计目标函数和约束条件，求解农机机具的最优控制输入增量。本发明提高了水田无人农机路径跟踪精度和抗干扰性能。