一种多目标融合的智能农用机械路径规划方法技术

本发明专利技术的基于多目标融合的智能农用机械路径规划方法，涉及农用机械自动化，实施为：a)、通过照片生成gis地图；b)、生成导航地图，同时对静态障碍进行定位，生成栅格地图；c)、在形成的栅格地图上设置起点、目标点；d)、根据起点、目标点进行直线及转弯路段的路径规划：e)、在按规划路径作业过程中采用深度学习系统识别障碍物，并设置农机与障碍物的安全距离；若遇到动态障碍物，满足安全距离则进行鸣笛示警；若障碍物未躲避，则采用静态避障方法避开障碍物，解除障碍物后继续按原路径作业。实现了农机在未知劳作环境中做出智能决策，完成作业任务的同时保证路径较短且耗油量较少并保证在遇到障碍物时能够迅速避开，大大的提高工作效率。

An intelligent agricultural machinery path planning method with multi target fusion

Agricultural Machinery Intelligent multi-objective path planning method based on the fusion of the present invention relates to agricultural machinery, automation, implementation: a), generating GIS map through photos; b), generation of navigation map, and to locate the static obstacles, generating grid map; c), starting point, goal setting in the grid map; d), path planning for straight and turning sections according to the starting point and goal point: e), in accordance with the working path planning process using deep learning system identify obstacles, and set up agricultural safety distance and obstacles; if to dynamic obstacles, meet the safety distance of warning whistle; if the obstacle is not to avoid static obstacle avoidance method is used to avoid obstacles, remove obstacles to work according to the original path. It realizes the intelligent decision of agricultural machinery in the unknown labor environment, completes the task while ensuring the shorter path and less fuel consumption, and ensures that it can avoid quickly when facing obstacles, and greatly improves the work efficiency.

【技术实现步骤摘要】
一种多目标融合的智能农用机械路径规划方法
本专利技术涉及农用机械自动化，具体涉及一种多目标融合的智能农用机械路径规划方法。
技术介绍
国外农机业多年的发展经验表明，采用智能化、自动化的作业方式是农业发展的必然趋势，是发展高效节本农业的有效途径。世界农业发达国家在采用了高度自动化的作业机械后不仅提高了工作效率，降低了作业成本，而且还提高了其农产品在国际市场上数量和价格的相对优势。我国农机业要想在国际上立足，就必须缩小我国与农业发达国家在农业机械装备方面的差距，这样国外自动化、智能化程度很高的农机装备才不会完全占领我国市场，也避免我国农机行业陷入困境。近年来，随着我国改革开放政策的不断深入，我国科学技术方面也取得了突飞猛进的发展，为我国实现农业生产自动化、智能化打下了基础。多目标优化问题一直是科学研究和工程应用中非常重要的研究课题。进化算法具有解决多目标优化问题的优势，因其不存在对优化问题先验知识方面的要求，可以同时搜索到优化问题的多个解，具有处理大问题空间的能力，能够克服传统多目标优化方法存在的弊端。在中国专利CN201310121591.3(一种考虑目标节点时效性的多目标路径规划方法)中公开了一种考虑搜索机器人目标节点时效性的多目标路径规划装置和方法，通过包含路线规划和路径生成在内的两阶段解耦，使用多目标遗传算法来实现考虑路径消耗和节点时效性两个优化目标的路线规划，从而有助于提高有操作者监督的移动机器人的搜索性能，特别是在路径搜索需要考虑节点时效性问题时可以获得更好的搜索表现。此专利技术在解决多目标优化问题上提供了一种思路，但应用在智能农用机械路径规划上则还需要考虑完成作业任务的同时保证路径较短且耗油量较少并保证在遇到障碍物时能够迅速避开，本专利的关键点就在于此。
技术实现思路
为了达到上述目标，克服现有技术的不足，本专利技术提出一种基于多目标融合的智能农用机械路径规划方法，从而实现农机在未知劳作环境中做出智能决策，实现在完成作业任务的同时保证路径较短且耗油量较少并保证在遇到障碍物时能够迅速避开的目的，能够大大的提高工作效率。首先需清楚，此处最优路径规划要求满足四个条件：在边界工作环境约束内(即要达到全覆盖)、能动态避障、路径最短以及油耗最低，其中全覆盖、路径最短以及油耗最低均可通过最优路径规划实现，则本申请的解决思路可归结为通过找最优路径与动态避障相融合的方法来进行农机路径规划。本申请的基于多目标融合的智能农用机械路径规划方法，步骤如下：a)、通过无人机航拍照片，生成gis地图；b)、根据作业区块边界特征生成供农机使用的导航地图，结合精确定位技术对导航地图中静态障碍进行定位，生成栅格地图；c)、在形成的栅格地图上设置起点、目标点；d)、根据起点、目标点进行路径规划：d-1、从起点到目标点1为直线路段，采用A*算法与Dijkstra算法相结合来进行静态避障从而确定最优直线路径；d-2、从目标点1到目标点2为转弯路段，采用最优控制理论来确定最佳转弯路径；d-3、从目标点2到目标点3为直线路段重复步骤d-1，从目标点3到目标点4为转弯路段重复步骤d-2，按此方法依次规划路径直至到达最终目标点，最终生成一个最优路径电子地图；e)、在按规划路径作业过程中采用深度学习系统识别障碍物，并设置农机与障碍物的安全距离；若遇到动态障碍物，如果满足安全距离则进行鸣笛示警；若障碍物未躲避，则采用上述d-1步骤中静态避障方法避开障碍物，解除障碍物后继续按原路径作业。本专利技术首先通过对农田环境进行路径规划，其中综合了全覆盖、最短路径与最低油耗包括静态避障，使得规划较为全面，提高了工作效率的同时，也节约了成本。同时，引入了深度学习理论，采用深度学习识别系统对图像进行处理，实时监测作业地块周围环境，若遇到动态障碍物能够及时避开。采用路径规划与动态避障相融合的作业方法，使得农机在农田自主作业的时候，大大的提高了其全局掌控性，整体上能够高效，安全地完成作业。附图说明图1是本专利技术实施例的栅格地图示意图：图2是本专利技术A*算法与Dijkstra算法相结合的方法流程图：图3是本专利技术农业机械的运动模型示意图；图4是具体避障方法-最短切线法的附图；图5是基于深度学习系统的动态避障流程图示意图；图6是本专利技术基于多目标融合的智能农用机械路径规划方法流程图示意图。具体实施方式要实现农用机械的智能化，其一大关键技术就是路径规划与导航，但就目前国内对于农机路径规划方面主要涉及的是单一目标，比如在完成作业任务的同时采用最短路径算法外加避障，这样的情况下就忽略了油耗问题，使得总成本不太理想。而本专利技术通过将农用机械最短路径规划方法、农用机械避障方法和农用机械最低油耗运动路径规划方法相结合，从而完美解决上述不足，即智能农用机械路径规划上考虑完成作业任务的同时保证路径较短且耗油量较少并保证在遇到障碍物时能够迅速避开的方案。具体的，本专利技术应用对象为农用机械，工作地点为农田。结合附图做如下详细说明。结合图6，本申请的基于多目标融合的智能农用机械路径规划方法，步骤如下：a)、通过无人机航拍照片，生成gis地图；b)、根据作业区块边界特征生成供农机使用的导航地图，结合精确定位技术对导航地图中静态障碍进行定位，生成栅格地图如图1；c)、在形成的栅格地图上设置起点、目标点；d)、根据起点、目标点进行路径规划：d-1、从起点到目标点1为直线路段，采用A*算法与Dijkstra算法相结合来进行静态避障从而确定最优直线路径；d-2、从目标点1到目标点2为转弯路段，采用最优控制理论来确定最佳转弯路径；d-3、从目标点2到目标点3为直线路段重复步骤d-1，从目标点3到目标点4为转弯路段重复步骤d-2，按此方法依次规划路径直至到达最终目标点，最终生成一个最优路径电子地图；e)、在按规划路径作业过程中采用深度学习系统识别障碍物，并设置农机与障碍物的安全距离；若遇到动态障碍物，如果满足安全距离则进行鸣笛示警；若障碍物未躲避，则采用上述d-1步骤中静态避障方法避开障碍物，解除障碍物后继续按原路径作业。结合图2，步骤d-1中A*算法与Dijkstra算法相结合用来确定最优直线路径的方法步骤为：1)、录入栅格地图信息，记录每个区域的可通或不可通状态。2)、将栅格地图初始化，即所有区域记录均为未搜索区域，并为农机的本次行程设定起点与目标点。3)、搜索当前节点周围的八个节点，去除不可通节点和已扩展节点后将其余节点入临时表，并将当前节点入关闭表。4)、计算临时表中中所存节点f值(从出发点到目标点的估价函数值)并依据估计路径长短排序，选出路径最短的前两个节点(如有重复单次选取)，其余点入开放表。5)、检测步骤4)中选出的节点是否包含目标点：若包含，将目标点放入关闭表，其余点放入开放表，继续步骤6)；若不包含，比较节点f值与最大估计值K的大小。若选出节点f值均大于K,选出节点作为当前节点继续步骤3)；若存在节点f值小于K，将f值小于K的节点作为当前节点继续步骤3)，其余点入开放表。6)、将已包含目标点和一批较优节点的关闭表单独提取出来，将起点放入最短节点集合，其余点入待算节点集合。7)、从待算节点集合中选出距离最短的节点N放入最短节点集合并将N从待算节点集合移除。8)、重新计算待算节点集合各个节点到起始点的距离，本文档来自技高网...

【技术保护点】
一种基于多目标融合的智能农用机械路径规划方法，其特征是：步骤如下：a)、通过无人机航拍照片，生成gis地图；b)、根据作业区块边界特征生成供农机使用的导航地图，结合精确定位技术对导航地图中静态障碍进行定位，生成栅格地图；c)、在形成的栅格地图上设置起点、目标点；d)、根据起点、目标点进行路径规划：d‑1、从起点到目标点1为直线路段，采用A*算法与Dijkstra算法相结合来进行静态避障从而确定最优直线路径；d‑2、从目标点1到目标点2为转弯路段，采用最优控制理论来确定最佳转弯路径；d‑3、从目标点2到目标点3为直线路段重复步骤d‑1，从目标点3到目标点4为转弯路段重复步骤d‑2，按此方法依次规划路径直至到达最终目标点，最终生成一个最优路径电子地图；e)、在按规划路径作业过程中采用深度学习系统识别障碍物，并设置农机与障碍物的安全距离；若遇到动态障碍物，如果满足安全距离则进行鸣笛示警；若障碍物未躲避，则采用上述d‑1步骤中静态避障方法避开障碍物，解除障碍物后继续按原路径作业。

【技术特征摘要】
1.一种基于多目标融合的智能农用机械路径规划方法，其特征是：步骤如下：a)、通过无人机航拍照片，生成gis地图；b)、根据作业区块边界特征生成供农机使用的导航地图，结合精确定位技术对导航地图中静态障碍进行定位，生成栅格地图；c)、在形成的栅格地图上设置起点、目标点；d)、根据起点、目标点进行路径规划：d-1、从起点到目标点1为直线路段，采用A*算法与Dijkstra算法相结合来进行静态避障从而确定最优直线路径；d-2、从目标点1到目标点2为转弯路段，采用最优控制理论来确定最佳转弯路径；d-3、从目标点2到目标点3为直线路段重复步骤d-1，从目标点3到目标点4为转弯路段重复步骤d-2，按此方法依次规划路径直至到达最终目标点，最终生成一个最优路径电子地图；e)、在按规划路径作业过程中采用深度学习系统识别障碍物，并设置农机与障碍物的安全距离；若遇到动态障碍物，如果满足安全距离则进行鸣笛示警；若障碍物未躲避，则采用上述d-1步骤中静态避障方法避开障碍物，解除障碍物后继续按原路径作业。2.根据权利要求1所述的基于多目标融合的智能农用机械路径规划方法，其特征是：步骤d-1中A*算法与Dijkstra算法相结合用来确定最优直线路径的方法步骤为：1)录入栅格地图信息，记录每个区域的可通或不可通状态；2)将栅格地图初始化，即所有区域记录均为未搜索区域，并为农机的本次行程设定起点与目标点；3)搜索当前节点周围的八个节点，去除不可通节点和已扩展节点后将其余节点入临时表，并将当前节点入关闭表；4)计算临时表中中所存节点f值—从出发点到目标点的估价函数值，并依据估计路径长短排序，选出路径最短的前两个节点，如有重复单次选取；其余点入开放表；5)检测步骤4)中选出的节点是否包含目标点：若包含，将目标点放入关闭表，其余点放入开放表，继续步骤6)；若不包含，比较节点f值与最大估计值K的大小：若选出节点f值均大于K,选出节点作为当前节点继续步骤3)；若存在节点f值小于K，将f值小于K的节点作为当前节点继续步骤3)，其余点入开放表；6)将已包含目标点和一批较优节点的关闭表单独提取出来，将起点放入最短节点集合，其余点入待算节点集合；7)从待算节点集合中选出距离最短的节点N放入最短节点集合并将N从待算节点集合移除；8)重新计算待算节点集合各个节点到起始点的距离，因为N已选取，则需要用N来更新各个节点的距离；9)重复步骤7)、8)，当待测节点集合为空时，即已选择出一条起点到终点的最短路径。3.根据权利要求1所述的基于多目标融合的智能农用机械路径规划方法，其特征是：步骤d-2中用最优控制理论确定最佳转弯路径，其方法步骤为：将农业机械如拖拉机模拟为一个两轮的车辆模型，建立车辆运动方程公式：x,y为拖拉机后轮中心点的坐标(m)，θ为拖拉机横摆角(r...

【专利技术属性】
技术研发人员：万忠政，任金梅，黄健，王梦洁，
申请(专利权)人：洛阳中科龙网创新科技有限公司，
类型：发明
国别省市：河南,41