[发明专利]一种适用于无角度传感器的农机获得前轮期望角度的方法

说明书

本发明涉及一种农机自动驾驶方法，具体说是适用于无角度传感器的农机获得前轮期望角度的方法。它先构建农机运动学模型，再采用LQR控制方法求解，即可得到反馈控制的前轮目标角度即期望角度，从而无需角度传感器，即可获得农机前轮的期望角度。采用该方法的农机无需角度传感器，工作效率较高，不会对农业的生产应用造成损失。

技术领域

本发明涉及一种农机自动驾驶方法，具体说是适用于无角度传感器的农机获得前轮期望角度的方法。

背景技术

随着农业自动化的发展、国家惠农政策的普及以及农民老龄化的比例上升，精准农业逐渐成为国际研究热点。精准农业的普及可以解放双手提高工作效率、提高土地利用率、及时播种收割、节约种子等投入，达到减少劳动力、减少投入、增加产量的目标。

在农机自动驾驶领域，传统的自动驾驶系统一般由四部分组成：一是终端显示单元比如平板。二是控制单元如ECU控制盒。三是执行机构如力矩电机或液压阀。四是角度传感器。其中角度传感器安装在农机前轮的转向节处，用于测量前轮转角的角度。由于角度传感器安装在前轮转向节处，农机工作环境比较恶劣，在工作过程中经常造成角度传感器的损坏或者连接线束的损坏。而角度传感器一旦不能工作，整个自动驾驶系统则处于瘫痪状态，即降低了农业生产的效率又耽误农时，给农业的生产应用带来了重大的损失。

发明内容

本发明要解决的技术问题是提供一种适用于无角度传感器的农机获得前轮期望角度的方法，采用该方法的农机无需安装角度传感器，工作效率较高，不会对农业的生产应用造成损失。

为解决上述问题，提供以下技术方案：

本发明的适用于无角度传感器的农机获得前轮期望角度的方法，其特征在于包括如下步骤：

第一步，构建农机运动学模型

当车辆没有安装角度传感器时，其前轮转角δ无法直接获得，根据阿克曼转向条件，可以间接得到车辆前轮转角：

由于车辆航向角速率来自于GNSS测量航向的差分或者车身天向陀螺，其精度比角度传感器要差，且具有较大的延迟滞后，所以由此间接估算的车辆前轮转角不再符合上述运动学模型；根据控制系统延迟特性和系统辨识结果，建立改进的车辆运动学模型如下：

其中，δ为车辆前轮转角；L为车辆前后轴轴距，直接测量得到；V为车辆后轴中心处前进速度，由车辆的GNSS测量得到；(x，y)为车辆在后轴中心在大地坐标系下的坐标，由车辆的GNSS测量得到；为车辆航向角度，由车辆的GNSS测量得到；k为增益系数；τ为时间常数；δ_cmd为控制指令；

第二步，采用LQR控制方法求解车辆前轮转角δ

上述车辆运动学模型近似写成下面的状态空间表达式：

其中：

U＝δ_cmd

LQR控制的最优目标函数是：累计跟踪误差和累计控制输入的加权，其表达式为：

其中，J为目标函数；Q为非负定的状态加权权阵；R为正定的控制加权权阵；

采用传统方法解算黎卡提方程可得到最优反馈控制角度：

δ_f＝-KX

其中，K为状态反馈调节增益矩阵，由解算黎卡提方程后得到，δ_f：期望角度，即农机自动驾驶时用于控制农机行走的期望角度，从而实现无角度传感器的农机自动驾驶。

其中，第一步构建农机运动学模型中，k取2；τ：取0.2。