Agricultural machine operation path planning method and device
By rastering the operation map and creating virtual obstacles, the problem of poor adaptability of agricultural machinery operation path planning in complex farmland environments is solved, and efficient and convenient path planning is achieved to meet different operation needs.
Patent Information
- Application Number
- CN202411425597.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-10-13
- Publication Date
- 2024-12-06
- Estimated Expiration
- 2044-10-13
AI Technical Summary
The existing agricultural machinery operation path planning methods lack adaptability and intelligence capabilities when facing complex farmland environments, resulting in difficult, low efficiency, poor applicability of path planning, and not widely used commercial solutions.
By rastering the job map, creating virtual obstacles and marking roads, virtual obstacles and actual obstacles on the raster map, planning the job path based on the logo position, using virtual obstacles to guide the movement direction of agricultural machinery, simplifying path search, and improving Path planning efficiency.
It significantly reduces the difficulty of path planning, improves efficiency and applicability, saves computing resources, can meet different operational needs, and provides higher path planning convenience and accuracy.
Smart Images

Figure CN119085660A_ABST
Abstract
Description
Technical Field
[0001] The present application belongs to the technical field of agricultural machinery operation path planning, and specifically relates to an agricultural machinery operation path planning method and device. Background Art
[0002] With the rapid development of modern agricultural technology and autonomous driving technology, improving operation efficiency and crop yield has become the key. As an important part of precision agriculture, full coverage path planning aims to ensure that agricultural machinery covers the entire farmland area efficiently and evenly. In the existing technology, commonly used path planning methods include straight line round trip, spiral and Z-shaped, but these methods have certain limitations, such as irregular field boundary path planning and agricultural machinery reversing difficulties, such as lack of adaptability and intelligent capabilities to complex farmland environments. In the existing technology, there are also researchers who have studied the full coverage path planning method, but there are problems such as the complexity of the scheme implementation process and the questionable applicability of the new environment. So far, there has been no commercial solution for full coverage operation path planning for farmland. There is no global path planning method suitable for farmland agricultural machinery that is widely used in production, mainly in the form of cutting division combined with turning curves. Summary of the invention
[0003] The purpose of this application is to provide a method and device for agricultural machinery operation path planning to solve the problem of difficulty in agricultural machinery operation path planning.
[0004] According to a first aspect of an embodiment of the present application, a method for planning an agricultural machinery operation path is provided, comprising:
[0005] Rasterize the operation map to obtain a raster map;
[0006] Create virtual obstacles along the target operation direction;
[0007] Marking roads, virtual obstacles, passed grids, and actual obstacles in grids of the grid map by marking them from small to large;
[0008] A work path is planned on the grid map based on the marker position.
[0009] In some optional embodiments of the present application, planning a work path on the grid map based on the flag position includes:
[0010] Repeat the following steps starting from the grid map entrance until the current grid is the grid map exit;
[0011] Select the next grid based on the priority of the flag position and moving direction of the grid adjacent to the current grid;
[0012] Mark the current grid as a grid that has been passed;
[0013] Make the next raster the current raster.
[0014] In some optional embodiments of the present application, the priority of the moving direction is dynamically switched based on the current orientation of the agricultural machinery.
[0015] In some optional embodiments of the present application, selecting the next grid based on the priority of the flag position and the moving direction of the grid adjacent to the current grid includes:
[0016] Get the target grid with the smallest flag from the grids adjacent to the current grid;
[0017] When the target grid is one, taking the target grid as the next grid;
[0018] When there are more than or equal to two target grids, the target grid with the highest priority in the moving direction is used as the next grid.
[0019] In some optional embodiments of the present application, the grid width of the grid map is 1 / 2 of the operating width of the agricultural machinery.
[0020] In some optional embodiments of the present application, rasterizing the operation map to obtain a raster map includes:
[0021] Rasterizing the operation map to obtain an initial grid map;
[0022] Expanding the boundaries of the initial grid map to obtain the grid map;
[0023] The width difference between the grid map and the initial grid map is greater than or equal to 1 / 4 of the operating width of the agricultural machinery.
[0024] In some optional embodiments of the present application, creating a virtual obstacle along the target operation direction includes:
[0025] Taking the direction of the longest side of the grid map as the target operation direction;
[0026] Creating a plurality of parallel virtual obstacles along a target operation direction so that the virtual obstacles run through the grid map;
[0027] In some optional embodiments of the present application, the distance between adjacent virtual obstacles is the side length of the grid;
[0028] The sum of the width of the virtual obstacle and the side length of the grid is less than or equal to the working width of the agricultural machinery.
[0029] According to a third aspect of an embodiment of the present application, there is provided an agricultural machinery operation path planning device, comprising:
[0030] A rasterization module, used for rasterizing the operation map to obtain a raster map;
[0031] The obstacle constraint module is used to create multiple parallel virtual obstacles along the target operation direction;
[0032] An identification module, used to mark roads, virtual obstacles, grids that have been passed, and actual obstacles in the grid of the grid map by marking them from small to large;
[0033] A planning module is used to plan an operation path on the grid map based on the marker position.
[0034] According to a third aspect of an embodiment of the present application, an electronic device is provided, which may include:
[0035] processor;
[0036] a memory for storing processor-executable instructions;
[0037] Among them, the processor is configured to execute instructions to implement the agricultural machinery operation path planning method as described in any embodiment of the first aspect.
[0038] The above technical solution of the present application has the following beneficial technical effects:
[0039] The embodiment of the present application provides a method for planning the path of agricultural machinery operation, which provides virtual obstacles to guide the target operation direction, thereby constraining the movement direction of the agricultural machinery, helping to achieve path search more quickly, significantly reducing the difficulty of path planning, improving the efficiency of path planning, saving computing resources, and meeting different operation requirements. Through multiple flags, the movement direction can be screened at multiple levels, improving the convenience and applicability accuracy of operation path planning. BRIEF DESCRIPTION OF THE DRAWINGS
[0040] Figure 1 is a flow chart of a method for planning an agricultural machinery operation path in an exemplary embodiment of the present application;
[0041] Figure 2 is a flow chart of a method for planning an agricultural machinery operation path in another exemplary embodiment of the present application;
[0042] Figure 3 is a schematic diagram of a grid map in an exemplary embodiment of the present application;
[0043] Figure 4 is a schematic diagram of a grid map in another exemplary embodiment of the present application;
[0044] Figure 5 is a schematic diagram of the working width of an agricultural machine in an exemplary embodiment of the present application;
[0045] Figure 6is a schematic diagram of an agricultural machine avoiding obstacles and detouring in an exemplary embodiment of the present application;
[0046] Figure 7 is a schematic diagram of an agricultural machinery operation path planning device in an exemplary embodiment of the present application;
[0047] Figure 8 is a schematic diagram of the structure of an electronic device in an exemplary embodiment of the present application; DETAILED DESCRIPTION
[0048] In order to make the purpose, technical solutions and advantages of the present application clearer, the present application is further described in detail below in conjunction with specific implementations and with reference to the accompanying drawings. It should be understood that these descriptions are only exemplary and are not intended to limit the scope of the present application. In addition, in the following description, the description of known structures and technologies is omitted to avoid unnecessary confusion of the concepts of the present application.
[0049] The accompanying drawings show schematic diagrams of layer structures according to embodiments of the present application. These figures are not drawn to scale, and some details are magnified and some details may be omitted for the purpose of clarity. The shapes of various regions and layers shown in the figures and the relative sizes and positional relationships therebetween are only exemplary, and may deviate in practice due to manufacturing tolerances or technical limitations, and those skilled in the art may additionally design regions / layers with different shapes, sizes, and relative positions according to actual needs.
[0050] Obviously, the described embodiments are only part of the embodiments of the present application, not all of the embodiments. Based on the embodiments in the present application, all other embodiments obtained by ordinary technicians in the field without creative work are within the scope of protection of the present application.
[0051] In the description of the present application, it should be noted that the terms "first", "second" and "third" are only used for descriptive purposes and cannot be understood as indicating or implying relative importance.
[0052] In addition, the technical features involved in the different embodiments of the present application described below can be combined with each other as long as they do not conflict with each other.
[0053] In the related technologies, agricultural machinery works back and forth along a straight line, which is suitable for relatively regular rectangular fields. However, when the edge of the field is unevenly covered, it is easy to cause repeated operations or omissions, and it is difficult to adapt to fields with irregular boundaries. Agricultural machinery uses the center of the field as the center of the circle and expands its operations along a spiral line, which is limited by its turning operation method. The operation efficiency is low at turns and its adaptability to irregular fields is poor. Grid-based algorithm technology is mainly aimed at solving the optimal solution of search algorithms and avoiding dead zones, which is quite different from the actual application method, and is difficult to develop, has high application costs, and the huge amount of calculations easily leads to waste of resources.
[0054] In the following, in combination with the accompanying drawings, a method and device for planning an agricultural machinery operation path provided by an embodiment of the present application are described in detail through specific embodiments and their application scenarios.
[0055] like Figure 1 As shown, in the first embodiment of the present application, a method for planning an agricultural machinery operation path is provided, comprising the following steps:
[0056] Step S101: rasterizing the operation map to obtain a raster map;
[0057] Step S102: creating virtual obstacles along the target operation direction;
[0058] Step S103: marking roads, virtual obstacles, passed grids, and actual obstacles in the grid map by marking them from small to large;
[0059] Step S104: planning a work path on the grid map based on the markers.
[0060] In this embodiment, virtual obstacles are used to guide the moving direction of agricultural machinery to be close to the target working direction. The target working direction can be set according to actual needs. Virtual obstacles are also used to mark the boundaries of grid maps. When planning the working path, grids with smaller flags are given priority as working paths. This embodiment provides a method for planning the working path of agricultural machinery, which provides virtual obstacles to guide the target working direction, thereby constraining the moving direction of agricultural machinery, helping to achieve path search more quickly, significantly reducing the difficulty of path planning, improving the efficiency of path planning, saving computing resources, and meeting different working requirements. The moving direction can be screened at multiple levels through a variety of flags, which improves the convenience and applicability of working path planning.
[0061] like Figure 2 As shown, in the second embodiment of the present application, a method for planning an agricultural machinery operation path is provided, comprising the following steps:
[0062] Import a raster map:
[0063] Rasterization: Convert the work map (such as fields, obstacles, roads, etc.) into a raster map.
[0064] The grid size is determined according to the operating width of the agricultural machinery (for example, 1 / 2 of the operating width is used in the schematic diagram);
[0065] Boundary expansion: In order to take into account the buffer zone for agricultural machinery operations, the field boundary is expanded outward by 1 / 4 of the operating width based on the margin;
[0066] Flag bit setting: assign different flag bits (such as 1, 2, 0) to different types of grids (such as obstacles, virtual obstacles, and inside of fields);
[0067] Obtain the entry and exit positions and the side length of the field: traverse the grid map: determine the boundary length of the field by traversing the markers;
[0068] Selection of working direction: Select the longest side of the field as the main working direction of the agricultural machinery to reduce the number of turns;
[0069] Generate virtual obstacles:
[0070] Virtual obstacles: Create virtual obstacles on both sides of the longest side of the field to guide the agricultural machinery to operate in the predetermined direction, such as Figure 3 As shown;
[0071] Flag bit update: Set the grid flag bit of the virtual obstacle to 2 to distinguish it from the actual obstacle;
[0072] Set the central operation end point: set the central end point of the agricultural machinery operation inside the last virtual obstacle;
[0073] Virtual agricultural machinery path search:
[0074] Initial position: Start searching the path from the actual location of the agricultural machinery, and mark the grid position of the virtual agricultural machinery as 2;
[0075] Neighborhood detection: Check the grids (up, down, left, right) adjacent to the current position of the agricultural machinery, and determine the moving direction according to the flag (go to the grid with the flag of 0);
[0076] Flag position update: After the agricultural machinery moves, the flag position of the grid it passes through is updated, and the order of appearance of the grids is recorded;
[0077] Working flag setting: The working flag is set according to whether the agricultural machine enters the actual working area (not adjacent to the actual obstacle grid) (the working flag is set to 1 if it is not adjacent to the actual obstacle grid, otherwise it is set to 0, and the default is 0);
[0078] Constraints and edge work limited by virtual obstacles:
[0079] Arriving at the central operation end point: Under the constraints of virtual obstacles, the agricultural machine stops searching after reaching the central operation end point;
[0080] Clear the virtual obstacle of the edge: set the virtual obstacle grid mark position adjacent to the actual obstacle to 0;
[0081] Edge wrapping operation: compare the shortest distance from the current grid to the outermost grid to the field exit, determine the edge wrapping direction according to the distance on the left and right sides of the farmland boundary (counterclockwise by default), and repeat the path search until the edge wrapping starting point, such as Figure 4 ;
[0082] Repeat the path search until you reach the exit:
[0083] Continue searching: Starting from the starting point of the edge, continue searching for the path until the agricultural machinery reaches the exit of the field;
[0084] Path recording and conversion:
[0085] Record grid sequence: save the grid flag sequence recorded in the search process as 3 sequences and the corresponding flag sequence;
[0086] Center point replacement: replace the grid representation with the center point of the grid to simplify the path;
[0087] Coordinate transformation: Convert the center point coordinates from the grid coordinate system to the longitude and latitude coordinate system to obtain the longitude and latitude point coordinates of the global path and the corresponding work flag.
[0088] The current grid-based algorithm technology is mainly aimed at solving the optimal solution of the search algorithm and avoiding dead zones, which is quite different from the actual application method, and has high development difficulty and application cost. The round-trip and spiral methods have the problems of insufficient edge coverage and low operation efficiency. The present invention provides a simple method to solve the problems of low efficiency, poor adaptability, uneven operation, etc. faced by the current full coverage path planning technology when the surface is complex and irregular. Compared with the prior art, the present invention does not need to use complex search algorithms, which greatly simplifies the development difficulty. At the same time, the parameter modification is simple, avoiding the operation width requirements caused by different agricultural machinery operation requirements. This method not only handles the boundary coverage well, but also has excellent applicability. This method can also proportionally reduce the ratio of grid width to operation range on the existing basis according to actual needs, so as to further adapt to agricultural machinery operations and path accuracy requirements.
[0089] like Figure 7 As shown, based on the same inventive concept, a third embodiment of the present application provides an agricultural machinery operation path planning device, comprising:
[0090] A rasterization module 11, used for rasterizing the operation map to obtain a raster map;
[0091] The obstacle constraint module 12 is used to create multiple parallel virtual obstacles along the target operation direction;
[0092] The marking module 13 is used to mark the roads, virtual obstacles, passed grids, and actual obstacles in the grid of the grid map by marking the positions from small to large;
[0093] The planning module 14 is used to plan the operation path on the grid map based on the markers.
[0094] Alternatively, if Figure 8 As shown, an embodiment of the present application also provides an electronic device 1100, including a processor 1101, a memory 1102, and a program or instruction stored in the memory 1102 and executable on the processor 1101. When the program or instruction is executed by the processor 1101, each process of the above-mentioned agricultural machinery operation path planning method embodiment is implemented, and the same technical effect can be achieved. To avoid repetition, it will not be repeated here.
[0095] It should be noted that the electronic devices in the embodiments of the present application include the mobile electronic devices and non-mobile electronic devices mentioned above.
[0096] An embodiment of the present application further provides a chip, which includes a processor and a communication interface, wherein the communication interface is coupled to the processor, and the processor is used to run programs or instructions to implement the various processes of the above-mentioned agricultural machinery operation path planning method embodiment, and can achieve the same technical effect. To avoid repetition, it will not be repeated here.
[0097] It should be understood that the chip mentioned in the embodiments of the present application can also be called a system-level chip, a system chip, a chip system or a system-on-chip chip, etc.
[0098] It should be noted that, in this article, the terms "comprise", "include" or any other variant thereof are intended to cover non-exclusive inclusion, so that the process, method, article or device including a series of elements includes not only those elements, but also includes other elements not explicitly listed, or also includes elements inherent to such process, method, article or device. In the absence of further restrictions, the elements defined by the sentence "comprise one..." do not exclude the presence of other identical elements in the process, method, article or device including the element. In addition, it should be pointed out that the scope of the methods and devices in the embodiments of the present application is not limited to performing functions in the order shown or discussed, and may also include performing functions in a substantially simultaneous manner or in reverse order according to the functions involved, for example, the described method may be performed in an order different from that described, and various steps may also be added, omitted, or combined. In addition, the features described with reference to certain examples may be combined in other examples.
[0099] Through the description of the above implementation methods, those skilled in the art can clearly understand that the above-mentioned embodiment methods can be implemented by means of software plus a necessary general hardware platform, and of course by hardware, but in many cases the former is a better implementation method. Based on such an understanding, the technical solution of the present application, or the part that contributes to the prior art, can be embodied in the form of a computer software product, which is stored in a storage medium (such as ROM / RAM, a disk, or an optical disk), and includes a number of instructions for a terminal (which can be a mobile phone, a computer, a server, or a network device, etc.) to execute the methods described in each embodiment of the present application.
[0100] The embodiments of the present application are described above in conjunction with the accompanying drawings, but the present application is not limited to the above-mentioned specific implementation methods. The above-mentioned specific implementation methods are merely illustrative and not restrictive. Under the guidance of the present application, ordinary technicians in this field can also make many forms without departing from the purpose of the present application and the scope of protection of the claims, all of which are within the protection of the present application.
Claims
1. A method for planning an agricultural machinery operation path, characterized in that: include: Rasterize the operation map to obtain a raster map; Create virtual obstacles along the target operation direction; Marking roads, virtual obstacles, passed grids, and actual obstacles in grids of the grid map by marking them from small to large; A work path is planned on the grid map based on the marker position.
2. The agricultural machinery operation path planning method according to claim 1, characterized in that: Planning a work path on the grid map based on the flag position includes: Repeat the following steps starting from the grid map entrance until the current grid is the grid map exit; Select the next grid based on the priority of the flag position and moving direction of the grid adjacent to the current grid; Mark the current grid as a grid that has been passed; Make the next raster the current raster.
3. The agricultural machinery operation path planning method according to claim 2, characterized in that: The priority of the moving direction is dynamically switched based on the current orientation of the agricultural machine.
4. The agricultural machinery operation path planning method according to claim 2, characterized in that: The next grid is selected based on the priority of the flag position and moving direction of the grid adjacent to the current grid, including: Get the target grid with the smallest flag from the grids adjacent to the current grid; When the target grid is one, taking the target grid as the next grid; When there are more than or equal to two target grids, the target grid with the highest priority in the moving direction is used as the next grid.
5. The method for planning an agricultural machinery operation path according to claim 1, characterized in that: The grid width of the grid map is 1 / 2 of the operating width of the agricultural machinery.
6. The method for planning an agricultural machinery operation path according to claim 1, characterized in that: Rasterize the job map to get a raster map, including: Rasterizing the operation map to obtain an initial grid map; Expanding the boundaries of the initial grid map to obtain the grid map; The width difference between the grid map and the initial grid map is greater than or equal to 1 / 4 of the operating width of the agricultural machinery.
7. The method for planning an agricultural machinery operation path according to claim 1, characterized in that: Create virtual obstacles along the target operation direction, including: Taking the direction of the longest side of the grid map as the target operation direction; A plurality of parallel virtual obstacles are created along the target operation direction so that the virtual obstacles run through the grid map.
8. The method for planning an agricultural machinery operation path according to claim 8, characterized in that: The distance between adjacent virtual obstacles is the side length of the grid; The sum of the width of the virtual obstacle and the side length of the grid is less than or equal to the working width of the agricultural machinery.
9. An agricultural machinery operation path planning device, characterized in that: include: A rasterization module, used for rasterizing the operation map to obtain a raster map; The obstacle constraint module is used to create multiple parallel virtual obstacles along the target operation direction; An identification module, used to mark roads, virtual obstacles, grids that have been passed, and actual obstacles in the grid of the grid map by marking them from small to large; A planning module is used to plan an operation path on the grid map based on the marker position.
Citation Information
Patent Citations
Moving control method of robot and robot
CN106695790A
Unmanned rice transplanter operation path planning method and system
CN117008608A
Cited By
Agricultural machine precise operation path planning system based on Beidou high-precision positioning
CN121028130A
Agricultural Machinery Precision Operation Path Planning System Based on BeiDou High-Precision Positioning
CN121028130B
