[发明专利]一种行走式农田移动平台机器人导航方法

说明书

本发明的行走式农田移动平台机器人导航方法，利用行走式平台的行走时设备的每次步幅相等的特点，基于等距方向偏差累计的算法，结合农田的数字地图和基准点的设置，来实现行走式农田移动平台机器人在农田中的位置逐步导航，从而结合规划的理想行走路线，实现逐步的导航控制，该系统和方法不依赖卫星定位系统，也不需要其他辅助纠偏的服务，成本较低，定位和导航准确，非常适合农业应用。

技术领域

本发明属于农业自动化机械行走控制的技术领域，具体涉及行走式农田移动平台机器人导航方法。

背景技术

随着我国经济战略的实施与推进，农业机械自动化及智能化水平不断提高，用户对农业机械的自动化程度提出了更高的要求。如今越来越多的农业机械已经集成或者加装了自动导航驾驶系统，用于在起垄、播种、植保等不同的田间作业过程中实现拖拉机的自动驾驶与方向控制，从而保证理想的作业效果。

现有技术中绝大部分是依据卫星导航系统来实现，最早的靠美国的GPS，近两年也有提出依靠中国的北斗系统，由于卫星导航的定位偏差较大，都是以米为单位计算，基本上不能直接使用到农业耕种，到了天气不好时，误差更大，还需要购买配置地面定位的差分纠正的服务来提升定位精度，造成成本较高，农业经营者用不起。很多方案中都存在这个成本高的问题。如中国发明专利202010760596.0，公开了一种无人驾驶拖拉机自动导航转向系统，包括数据采集模块、GPS导航模块、雷达模块、监测模块、无线通信模块、数据处理模块、转向模块、预警管理模块、整机控制模块以及智能终端；所述数据采集模块用于采集农田地块边界信息，所述GPS导航模块用于采集拖拉机行驶过程中拖拉机的位姿信息；所述数据处理模块用于规划拖拉机的期望行驶路线，所述转向模块用于控制拖拉机的转向；所述监测模块结合拖拉机的期望行驶路线、夹角θ和拖拉机的实时位置对拖拉机的偏离值作出分析；所述预警管理模块接收到预警信号和拖拉机的位置信息并分配至对应的管理人员进行处理。

另外现有的导航系统和方法都是基于轮式设备进行设计的，不是针对行走式设备进行设计。

发明内容

为解决上述问题，本专利提出-一种行走式农田移动平台机器人导航方法。

本发明的技术方案：一种行走式农田移动平台机器人导航方法，其特征是：该方法的实现包括设置在农田某一位置的无线电基准点，位于农田移动平台机器人上的两个方向传感器、与无线电基准点进行通信的无线电通信模块、运算模块、存储模块，该方法包括如下步骤：

①首先对待作业农田进行测绘，绘制出农田的数字地图，存入农田移动平台机器人上面的存储模块；

②运算模块根据农田的数字地图具体规划行走式农田移动平台机器人的在该农田的理想行走路线；

③根据农田的数字地图在农田的边沿或者某一角落位置固定无线电基准点N，并同时现场测量该位置在实际农田中的位置数据，将该位置数据存入行走式农田移动平台机器人的存储模块；同时根据步骤②中的理想行走路线在农田中确定该路线的起点位置；

④根据第②步规划的理想行走路线将行走式农田移动平台机器人转移到实际农田中的起点位置，确定理想行走路线行走方向角为θ0，定义机器人第一步实际行走方向为θ₁，第二步行实际走方向为θ2……，第n步实际行走方向为θ_n，θ_n为行走方向和基准方向之间的夹角，θ₀为理想行走路线与基准方向之间的夹角，基准方向为南方向或者北方向；

⑤利用等距偏差累计法来控制机器人的行走路线，具体包括如下子步骤；