[发明专利]一种侧滑情况下4WID高地隙喷雾机轨迹跟踪控制方法

说明书

本发明公开了一种侧滑情况下4WID高地隙喷雾机轨迹跟踪控制方法，属于农业机械自动导航领域，包括以下步骤：(一)选择喷雾机定位、定向传感器；(二)建立高地隙喷雾机底盘运动学模型和位姿误差模型；(三)将横向滑移速度与前后轴转向偏差这两个可以表征侧滑效应的参数引入理想状态下位姿误差模型并近似线性化得到改进位姿误差模型；(四)基于改进位姿误差模型设计鲁棒自适应控制器，通过参数自适应来补偿未知滑动。本发明解决了传统轨迹跟踪控制器中忽略侧滑而导致跟踪精度低的问题，有效提高了侧滑情况下导航轨迹跟踪精度和喷雾机自动驾驶的稳定性,可满足水田环境下高精度作业的需求。

技术领域

本发明涉及一种农业植保机械定位及自动导航控制领域，具体涉及的是一种侧滑情况下4WID高地隙喷雾机的轨迹跟踪控制方法，属于农业机械自动导航领域。

背景技术

随着现代农业的不断发展，农业机械自动导航技术已广泛应用于播种、施肥、喷药、收获等农业生产过程。农机智能化的高速发展对农机导航精度的要求也越来越高。

当农机运动学模型满足严格的纯滚动约束时，轨迹跟踪控制的结果令人满意，然而由于各种因素，如轮胎打滑，变形等，纯滚动约束不可能得到严格满足，特别是当农机需要在水田、坡地、湿滑草地等地面上行驶时，不可避免地发生侧滑，进而影响自主导航的性能，甚至影响系统的稳定性。因此提出侧滑情况下4WID高地隙喷雾机轨迹跟踪控制算法，将侧滑效应作为未知附加参数加入到喷雾机运动学模型中并设计自适应控制率实时观测并补偿侧滑效应，从而实现侧滑情况下喷雾机的轨迹跟踪控制。

侧滑情况下4WID高地隙喷雾机轨迹跟踪控制算法主要包括基于喷雾机运动学模型的控制方法和侧滑参数估计方法，由于喷雾机模型的复杂性、作业环境以及喷雾机负载的不确定性，导致喷雾机导航控制系统为一个复杂的不确定性系统。针对这一问题，利用自适应控制方法逐步设计控制率，单独设计每个子系统的虚拟控制率，保证每个子系统的收敛率，最终获得整个系统的实际控制率。

本发明的目的在于克服侧滑情况下喷雾机轨迹跟踪精度低的问题。通过将侧滑效应加入喷雾机运动学模型，提供一种设计方法简单，鲁棒性强的自适应轨迹跟踪控制方法。

本发明的目的通过以下技术方案实现：

本发明公开了一种4WID高地隙喷雾机轨迹跟踪控制算法，包括以下步骤：

步骤1，喷雾机采用一款高精度导航定位系统RTK，可提供喷雾机实时高精度的位置、速度和姿态等导航参数。

步骤1.1，步骤1所述的喷雾机采用高度集成的GNSS/INS高精度组合导航系统，其配套的GNSS高精度定位定向接收机内置高精度定位定向板卡，能够快速精确的解算出两个天线相对位置信息和两个天线相位中心连线与真北之间的夹角(方位角)。同时通过接受基准站差分数据，可实现实时载波相位差分定位(RTK)，为喷雾机提供厘米级的高精度位置信息以及侧滑参数信息。

步骤2，针对4WID高地隙喷雾机特殊的行走底盘，首先建立其运动学模型并将侧滑效应作为未知附加参数加入到模型中。

步骤2.1，首先建立全局坐标系与车体坐标系，基于几何学原理建立喷雾机运动学模型，为方便设计算法将喷雾机运动学模型简化为：

步骤3，在运动学模型的基础上建立理想状态下的位姿误差模型。