自动化作业设备路径规划方法与系统技术方案

本发明专利技术提供一种自动化作业设备路径规划方法与系统，获取自动化作业设备的未作业范围，并确定所述未作业范围的各个顶点，确定各所述顶点的坐标，以任意单个所述顶点为作业起点，根据作业起点坐标、作业路径预设宽度以及相邻两个顶点，计算路径规划起点坐标，沿平行于未作业范围边界的方向，与未作业范围边界间隔所述作业路径预设宽度距离，在未作业范围内侧进行路径规划，当未作业范围为零时，终止路径规划，获得所述自动化作业设备的路径。整个过程中，规划的路径由外向内逐渐收缩，可较大程度减小整个作业过程中自动化作业设备的小半径转向，降低转向过程的能量消耗，提升作业时间与效率。

Path planning method and system for automatic operation equipment

The present invention provides a system and automated equipment path planning method, no operation scope obtain automatic operation equipment, and make sure each vertex the non operating range, determine the coordinates of each of the vertices in the vertex, any single operation as starting point, according to the work starting point coordinates, and the adjacent two preset working path width a vertex, calculation of path planning starting point coordinates, not parallel to the boundary direction and scope of work, not the work scope boundary interval operation path width preset distance, path planning is not in the scope of work inside, when not operating range is zero, the termination of path planning, path to obtain the automation equipment. In the whole process, gradually shrinking the planning path from the outside to the inside, can greatly reduce the small radius of roboticized equipment during the whole operation to reduce the energy consumption, to improve the operation efficiency and time.

【技术实现步骤摘要】
自动化作业设备路径规划方法与系统
本专利技术涉及路径规划
，特别是涉及自动化作业设备路径规划方法与系统。
技术介绍
随着人们生活水平的提高，目前越来越多的自动化作业设备应用到实际生产生活中，给人们带来了巨大便利。例如目前常见的植保无人机自动进行植保操作、智能扫地机器人自动进行清扫操作等。自动化作业设备在进行自动化作业过程中，如何合理规划好作业路径是非常重要的环节，合理路径规划能够有效提升自动化作业设备的作业效率，带来更大的经济效益并给人们带来更多的生活便利性。然而，一般自动化作业设备路径规划一般基于起始点与终止点采用固定路径规划或采用自动检测故障物的方式，当检测到故障物时进行转向(扫地机器人多采用此种方式)等方式进行路径规划。作业路径固定规划或无序随意变动都会使自动化作业设备无目的、无针对性针对当前应用场景进行合理的作业，降低了自动化作业设备的作业效率。
技术实现思路
基于此，有必要针对一般自动化作业设备路径规划固定或无序设定，无法针对当前应用场景进行合理规划，严重降低自动化作业设备的作业效率的问题，提供一种自动化作业设备路径规划方法与系统，针对当前应用场景，合理规划自动化作业设备路径，有效提升其作业效率。一种自动化作业设备路径规划方法，包括步骤：获取自动化作业设备的未作业范围，并确定未作业范围的各个顶点；构建平面坐标系，确定各顶点的坐标；以任意单个顶点为作业起点，根据作业起点坐标、作业路径预设宽度以及各顶点中与作业起点相邻的两个顶点坐标，计算路径规划起点坐标，作业路径预设宽度不大于自动化作业设备的作业宽度的一半；沿平行于未作业范围边界的方向，与未作业范围边界间隔作业路径预设宽度距离，在未作业范围内侧进行路径规划；当未作业范围为零时，终止路径规划，获得自动化作业设备的路径。一种自动化作业设备路径规划系统，包括：顶点确定模块，用于获取自动化作业设备的未作业范围，并确定未作业范围的各个顶点；坐标构建模块，用于构建平面坐标系，确定各顶点的坐标；起点计算模块，用于以任意单个顶点为作业起点，根据作业起点坐标、作业路径预设宽度以及各顶点中与作业起点相邻的两个顶点坐标，计算路径规划起点坐标，作业路径预设宽度不大于自动化作业设备的作业宽度的一半；路径划设模块，用于沿平行于未作业范围边界的方向，与未作业范围边界间隔作业路径预设宽度距离，在未作业范围内侧进行路径规划；终止模块，用于当未作业范围为零时，终止路径规划，获得自动化作业设备的路径。本专利技术自动化作业设备路径规划方法与系统，获取自动化作业设备的未作业范围，并确定未作业范围的各个顶点，确定各顶点的坐标，以任意单个顶点为作业起点，根据作业起点坐标、作业路径预设宽度以及相邻两个顶点，计算路径规划起点坐标，沿平行于未作业范围边界的方向，与未作业范围边界间隔作业路径预设宽度距离，在未作业范围内侧进行路径规划，当未作业范围为零时，终止路径规划，获得自动化作业设备的路径。整个过程中，规划的路径由外向内逐渐收缩，可较大程度减小整个作业过程中自动化作业设备的小半径转向，降低转向过程的能量消耗，提升作业时间与效率。附图说明图1为本专利技术自动化作业设备路径规划方法其中一个实施例的流程示意图；图2为植保作业示意图；图3为本专利技术自动化作业设备路径规划方法应用于植保作业的路径规划示意图；图4为本专利技术自动化作业设备路径规划系统其中一个实施例的结构示意图。具体实施方式为了便于说明本专利技术自动化作业设备路径规划方法的技术方案及其带来的效果，下面将以自动化作业设备为植保无人机的应用实例，详细介绍整个方案。如图1所示，一种自动化作业设备路径规划方法，包括步骤：S100：获取自动化作业设备的未作业范围，并确定未作业范围的各个顶点。自动化作业设备的未作业范围可以根据自动作业设备任务指示等数据来获得。例如当前需要对1千米*1千米范围内的植物进行植保操作，那么此时植保无人机的未作业范围即为1千米*1千米的区域范围。具体来说，未作业范围的边界可以是各种多边形，例如常见的长方形、五边形、六边形等，还可以是不规则的多边形。在这个未作业范围中有多个顶点，将这些顶点依次连接起来即可围成未作业范围，如图2所示，在图2中，未作业范围的顶点包括G1、G2、G3以及G4。简单来说，顶点即发生转向的点，相邻两个顶点处于相同直线上，该直线构成未作业范围的边界线，例如顶点G1和G2所处直线构成未作业范围的边界线G1G2，植保无人机在达到顶点时将会发生转向，不会继续沿直线飞行。S200：构建平面坐标系，确定各顶点的坐标。构建平面坐标系，以便准确表征各个顶点之间相对位置。平面坐标可以选择以自动化作业设备停靠点为原点构建平面坐标系，以向东的方向为X轴，以向北的方向为Y轴，建立二维直角坐标系。在具体应用实例中，以植保无人机停靠点为原点，构建平面坐标系，采用全球定位系统或者北斗系统获取植保作业范围的顶点地理位置以及植保无人机停靠点(原点)的地理位置，在构建的平面坐标系中，将顶点地理位置以及植保无人机停靠点的地理位置表征出来，获得各个顶点的坐标，即在图2中获得G1、G2、G3以及G4的坐标。S300：以任意单个顶点为作业起点，根据作业起点坐标、作业路径预设宽度以及各顶点中与作业起点相邻的两个顶点坐标，计算路径规划起点坐标，作业路径预设宽度不大于自动化作业设备的作业宽度的一半。任意选择单个顶点作为作业起点，选择与该作业起点所处单个边界平行的方向开始作业。假定选择图2中顶点为G1为作业起点，选择与G1所处单个边界G1G2或G1G4平行方向开始作业，如选择G1G2方向开始作业。自动化作业设备一般都有固定有作业宽度，作业宽度值可以从自动化作业设备属性参数介绍或铭牌中获得。自动化作业设备是沿路径进行作业的，那么单次能够作业宽度最大值为自动化作业设备的作业宽度的一半，即在规划自动作业设备路径时，作业路径预设宽度应小于或等于自动化作业设备的作业宽度的一半。在图2中，植保无人机作业路径预设宽度为W/2，其中W为植保无人机的植保作业宽度。作业起点与其相邻的两个顶点连线构成未作业范围的两条边界线，在图2中，作业起点相邻的两个顶点为G2和G4，获取G2和G4的坐标。基于作业起点G1、其相邻两个顶点G2和G4的坐标、以及作业路径预设宽度W/2，即可以通过直线方程求解出路径规划起点坐标P1的坐标。S400：沿平行于未作业范围边界的方向，与未作业范围边界间隔作业路径预设宽度距离，在未作业范围内侧进行路径规划。未作业范围的边界是一个变化的范围，即未作业范围＝初始未作业范围-已作业范围。如在图2中，当植保无人机还在P1点准备进行植保操作时，未作业范围为G1、G2、G3以及G4合围的区域，当植保无人机植保作业至P2点时，未作业范围为G5、G6、G2、G3以及G4合围的区域。在步骤S300中计算获得P1的坐标，以P1为起始点，沿平行于G1G2的方向，与未作业范围边界间隔作业路径预设宽度距离，计算P2的坐标，依次顺序迭代确定各个路径规划中转向点的坐标。S500：当未作业范围为零时，终止路径规划，获得自动化作业设备的路径。当未作业范围为零时，表明自动化作业设备按照当前规划的路径可以完成本次作业任务，终止路径规划，获得自动化作业设备的路径。未作业范围为零的判定条件可以通过仿真模拟本文档来自技高网...

【技术保护点】
一种自动化作业设备路径规划方法，其特征在于，包括步骤：获取自动化作业设备的未作业范围，并确定所述未作业范围的各个顶点；构建平面坐标系，确定各所述顶点的坐标；以任意单个所述顶点为作业起点，根据作业起点坐标、作业路径预设宽度以及各所述顶点中与所述作业起点相邻的两个所述顶点坐标，计算路径规划起点坐标，所述作业路径预设宽度不大于所述自动化作业设备的作业宽度的一半；沿平行于未作业范围边界的方向，与未作业范围边界间隔所述作业路径预设宽度距离，在未作业范围内侧进行路径规划；当未作业范围为零时，终止路径规划，获得所述自动化作业设备的路径。

【技术特征摘要】
1.一种自动化作业设备路径规划方法，其特征在于，包括步骤：获取自动化作业设备的未作业范围，并确定所述未作业范围的各个顶点；构建平面坐标系，确定各所述顶点的坐标；以任意单个所述顶点为作业起点，根据作业起点坐标、作业路径预设宽度以及各所述顶点中与所述作业起点相邻的两个所述顶点坐标，计算路径规划起点坐标，所述作业路径预设宽度不大于所述自动化作业设备的作业宽度的一半；沿平行于未作业范围边界的方向，与未作业范围边界间隔所述作业路径预设宽度距离，在未作业范围内侧进行路径规划；当未作业范围为零时，终止路径规划，获得所述自动化作业设备的路径。2.根据权利要求1所述的自动化作业设备路径规划方法，其特征在于，所述以任意单个所述顶点为作业起点，根据作业起点坐标、作业路径预设宽度以及各所述顶点中与所述作业起点相邻的两个所述顶点坐标，计算路径规划起点坐标的步骤包括：在各所述顶点中任意选取作业起点；确定各所述顶点中与所述作业起点相邻的第一顶点和第二顶点，获取所述第一顶点的坐标与所述第二顶点的坐标；根据所述作业起点的坐标以及所述第一顶点的坐标，获取所述未作业范围中所述作业起点与所述第一顶点所处边界直线的直线方程，记为第一边界的直线方程；根据所述第一边界的直线方程与所述作业路径预设宽度，获取路径规划第一直线的直线方程；根据所述作业起点的坐标以及所述第二顶点的坐标，获取所述未作业范围中所述作业起点与所述第二顶点所处边界直线的直线方程，记为第二边界的直线方程；根据所述路径规划第一直线的直线方程与所述第二边界的直线方程，确定路径规划起点坐标。3.根据权利要求2所述的自动化作业设备路径规划方法，其特征在于，所述沿平行于未作业范围边界的方向，与未作业范围边界间隔所述作业路径预设宽度距离，在未作业范围内侧进行路径规划的步骤包括：采用计算所述路径规划起点坐标相同方式，在未作业范围内侧迭代计算路径规划下一转向点坐标。4.根据权利要求3所述的自动化作业设备路径规划方法，其特征在于，所述当未作业范围为零时，终止路径规划的步骤包括：当迭代计算出的路径规划下一转向点坐标与相邻已路径规划的路径的垂直距离小于2倍所述作业路径预设宽度时，判定当前转折点为路径规划终点，终止路径规划。5.根据权利要求1所述的自动化作业设备路径规划方法，其特征在于，所述构建平面坐标系，确定各所述顶点的坐标的步骤包括：确定所述自动化作业设备停放位置；以所述自动化作业设备停放位置为坐标原点，构建平面坐...

【专利技术属性】
技术研发人员：王维，周泽蕴，
申请(专利权)人：湖南挚新科技发展有限公司，
类型：发明
国别省市：湖南,43