[发明专利]用于农机无人驾驶的田间掉头路径规划及其控制方法

说明书

技术领域

本发明涉及一种自动掉头路径规划及其控制方法，特别涉及一种用于农机无人驾驶的田间掉头路径规划及其控制方法。

背景技术

农机在导航作业时一般需要进行自动掉头对准下一作业行的跟踪，控制农机准确的掉头技术是实现精准农业的关键，该技术可提高农机的作业精度和作业效率，使驾驶员摆脱长时间劳累的重复驾驶工作，降低劳动力。

在现有的农机路径跟踪方法上，控制农机按照设定好的路径行走的控制方法有多种，如BUG算法、人工势场法、VFH算法、模糊逻辑算法、模糊神经网络算法等，这些算法的应用场景均是复杂的作业环境，算法的逻辑复杂， 应用于农机作业不复杂的作业环境下，反应速度较慢，反而降低其控制精度；另外，对于由若干个大小不同的田块组成的田地，工作人员需携带多个导航系统，到一个田地工作时，工作人员需根据田块的实际大小选择一个与之对应的导航系统安装到农机上，到另一块宽幅不同的田块时，将以上导航系统拆下来，将新的导航系统重新安装到农机上，无法根据农机的实际作业模式进行路径控制，适用范围小，成本高，操作麻烦。

发明内容

针对现有技术中的缺陷，本发明的目的在于克服上述现有技术中的不足之处，解决现有技术中控制精度低且适用范围小的技术问题，提供一种用于农机无人驾驶的田间掉头路径规划及其控制方法，本发明的控制精度高，适用范围广。

本发明的目的是这样实现的：一种用于农机无人驾驶的田间掉头路径规划及其控制方法，具体包括以下步骤，

步骤1：输入农机的作业模式；

步骤2：获取农机所处环境的地理信息，根据农机实际的作业模式选择对应的掉头路径；

步骤3：农机在前进过程中，农机通过传感器获得农机位置信息，使用预瞄和PI控制器组合起来计算当前的前轮转向角，控制农机的转向角实现农机的自动掉头。

本发明工作时，工作人员先根据田块的宽幅输入农机的作业模式，通过传感器感应农机周围的环境信息，农机掉头时，农机根据实际的作业模式选择设定好的掉头路径，农机通过传感器检测获得农机的位置信息，使用预瞄控制器和PI控制器相结合起来实时计算出农机的前轮转角，农机在行走过程中通过实时调整农机的前轮转角，通过控制农机的前轮转向角使农机沿着设定的曲线行走，从而实现农机的掉头；本发明中设定了不同作业模式下对应的掉头路径，可通过农机的实际作业模式选择与其相对应的掉头路径，集成度高，适用范围更加广泛，降低成本，操作简便；使用预瞄控制器和PI控制器的结合控制农机的前轮转向角使农机沿着设定好的避障曲线行走，控制精度高；本发明可应用于农机在导航作业时的自动掉头的工作中。

为了进一步提高农机掉头速度，本发明的步骤1中，农机的作业模式包括播种和耕地；步骤2中，播种情况下对应的掉头路径为多线型路径一，耕地情况下对应的掉头路径包括交叉型路径、圆弧路径和多线型路径二，且根据不同的犁具宽度选择不同的掉头路径，犁具宽度包括小宽幅、中宽幅和大宽幅，小宽幅、中宽幅和大宽幅作业模式下对应的掉头路径分别为交叉型路径、圆弧路径和多线型路径二，小宽幅对应的犁具宽度的数值范围为Rmin<W<1.5Rmin,中宽幅对应的犁具宽度的数值范围为1.5Rmin<W≤2Rmin,大宽幅对应的犁具宽度的数值范围为W>2Rmin，Rmin为农机的最小转弯半径，W为犁具宽度；此设计中，将农机的作业模式分为播种和耕地，不同作业模式，对应的掉头路径不同，优化掉头曲线，缩短农机掉头时间。

为了进一步提高农机掉头效率，所述多线型路径一由直线段一、圆弧段一和圆弧段二组成，圆弧段一和圆弧段二相切且对应的半径相同，农机依次经过直线段一、圆弧段一和圆弧段二实现掉头；所述交叉型路径由圆弧段三、直线段二和圆弧段四组成，圆弧段三和圆弧段四相交且关于直线段一的中心对称，圆弧段三和圆弧段四的半径大小相同，农机依次经过圆弧段三、直线段二和圆弧段四实现掉头；所述圆弧路径由圆弧段五、圆弧段六和圆弧段七组成，所述圆弧段六分别和圆弧段五、圆弧段七相切，所述圆弧段五和圆弧段七关于圆弧段六的中心线对称设置，农机依次经过圆弧段五、圆弧段六和圆弧段七实现掉头；所述多线型路径二由圆弧段八、直线段三和圆弧段九组成，圆弧段八和圆弧段九关于直线段三的中心线对称设置，农机依次经过圆弧段八、直线段九和圆弧段九实现掉头。

为了进一步提高农机掉头路径的精度，所述多线型路径一的各个线段的数学关系式为：

（1-1）