CN113970927A - Method and device for acquiring operation starting point and electronic equipment - Google Patents
Method and device for acquiring operation starting point and electronic equipment Download PDFInfo
- Publication number
- CN113970927A CN113970927A CN202111165082.1A CN202111165082A CN113970927A CN 113970927 A CN113970927 A CN 113970927A CN 202111165082 A CN202111165082 A CN 202111165082A CN 113970927 A CN113970927 A CN 113970927A
- Authority
- CN
- China
- Prior art keywords
- path
- starting point
- point
- candidate
- job
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 96
- 230000007704 transition Effects 0.000 claims description 44
- 238000005265 energy consumption Methods 0.000 claims description 39
- 239000000463 material Substances 0.000 claims description 22
- 238000004590 computer program Methods 0.000 claims description 8
- 238000004422 calculation algorithm Methods 0.000 claims description 5
- 238000010586 diagram Methods 0.000 description 12
- 238000004364 calculation method Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000013507 mapping Methods 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 238000005507 spraying Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 1
- 239000003621 irrigation water Substances 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 239000000575 pesticide Substances 0.000 description 1
- 238000009331 sowing Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
- G05D1/0285—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using signals transmitted via a public communication network, e.g. GSM network
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Forklifts And Lifting Vehicles (AREA)
Abstract
The embodiment of the application provides a method and a device for acquiring a work starting point and electronic equipment, wherein the method for acquiring the work starting point comprises the following steps: acquiring a breakpoint on an initial operation route when an unmanned equipment operation task is interrupted; acquiring a residual operation section from the initial operation route based on the breakpoint; and determining a work starting point based on the break point and an entering path between the end point of the residual work section and a set starting point respectively. Thus, the operation starting point is determined from the breakpoint and the end point of the surplus operation section, the operation starting point of the surplus operation section can be selectively determined, the energy loss of the surplus operation section can be reduced, and the operation efficiency of the unmanned aerial vehicle can be improved.
Description
Technical Field
The present application relates to the field of unmanned equipment technologies, and in particular, to a method and an apparatus for acquiring a work starting point, and an electronic device.
Background
In the process of carrying out operation tasks when unmanned equipment enters an operation area in the prior art, if all operation tasks cannot be completed at one time, the unmanned equipment interrupts the operation tasks and returns to a set starting point, and then runs from the starting point to an interruption position of the last operation task again to continue operation along the remaining route.
Disclosure of Invention
In order to solve the above technical problem, embodiments of the present application provide a method and an apparatus for acquiring a job starting point, and an electronic device.
In a first aspect, an embodiment of the present application provides a method for acquiring a job starting point, where the method includes:
acquiring a breakpoint on an initial operation route when an unmanned equipment operation task is interrupted;
acquiring a residual operation section from the initial operation route based on the breakpoint;
and determining a work starting point based on the break point and an entering path between the end point of the residual work section and a set starting point respectively.
In a second aspect, an embodiment of the present application provides a path planning method, where the method includes:
and generating a target entry path according to the set starting point and the operation starting point, wherein the target entry path is used for guiding the unmanned equipment to enter a surplus operation section, the operation starting point is determined according to the acquisition method of the operation starting point provided by the first aspect, and the surplus operation section is an operation section where the operation task is not executed when the operation task is interrupted last time in the initial operation route.
In a third aspect, an embodiment of the present application provides an apparatus for acquiring a job starting point, where the apparatus includes:
the first acquisition module is used for acquiring a breakpoint on an initial operation route when an unmanned equipment operation task is interrupted;
the second acquisition module is used for acquiring a residual operation road section from the initial operation route based on the breakpoint;
and the determining module is used for determining a work starting point based on the break point and an entry path between the end point of the residual work section and a set starting point respectively.
In a fourth aspect, an embodiment of the present application provides a path planning apparatus, where the apparatus includes:
and a generating module, configured to generate a target entry path according to a set starting point and a job starting point, where the target entry path is used to guide an unmanned device to enter a remaining job segment, the job starting point is determined according to the method for obtaining a job starting point provided in the fourth aspect, and the remaining job segment is a job segment on which a job task is not executed when a last job task is interrupted in an initial job route.
In a fifth aspect, an embodiment of the present application provides an electronic device, including: a processor and a memory, the memory storing a computer program which, when executed by the processor, performs the method for acquiring a job start point provided by the first aspect and/or the method for planning a path provided by the second aspect.
In a sixth aspect, an embodiment of the present application provides a computer-readable storage medium, which stores a computer program, where the computer program, when executed on a processor, executes the method for obtaining a job starting point provided in the first aspect, and/or the method for planning a path provided in the second aspect.
The method, the device and the electronic equipment for acquiring the operation starting point acquire the breakpoint on the initial operation route when the operation task of the unmanned equipment is interrupted; acquiring a residual operation section from the initial operation route based on the breakpoint; and determining a work starting point based on the break point and an entering path between the end point of the residual work section and a set starting point respectively. Thus, the operation starting point is determined from the breakpoint and the end point of the surplus operation section, the operation starting point of the surplus operation section can be selectively determined, the energy loss of the surplus operation section can be reduced, and the operation efficiency of the unmanned aerial vehicle can be improved.
Drawings
In order to more clearly explain the technical solutions of the present application, the drawings needed to be used in the embodiments are briefly introduced below, and it should be understood that the following drawings only illustrate some embodiments of the present application and therefore should not be considered as limiting the scope of protection of the present application. Like components are numbered similarly in the various figures.
Fig. 1 is a flow chart illustrating a method for acquiring a job starting point according to an embodiment of the present application;
FIG. 2 is a schematic diagram illustrating an initial work route provided by an embodiment of the present application;
FIG. 3 illustrates a schematic path planning diagram of an unmanned aerial device provided by an embodiment of the present application;
fig. 4A illustrates another schematic path planning diagram of an unmanned aerial device provided by an embodiment of the present application;
fig. 4B illustrates another schematic path planning diagram of the unmanned aerial vehicle provided by the embodiment of the present application;
fig. 5A illustrates another schematic path planning diagram of an unmanned aerial device provided by an embodiment of the present application;
fig. 5B illustrates another schematic path planning diagram of the unmanned aerial vehicle provided by the embodiment of the present application;
fig. 6A illustrates another schematic path planning diagram of an unmanned aerial device provided by an embodiment of the present application;
fig. 6B illustrates another schematic path planning diagram of the unmanned aerial vehicle provided by the embodiment of the present application;
fig. 7 is a schematic diagram illustrating another path planning of an unmanned aerial device provided by an embodiment of the present application;
fig. 8 is a schematic structural diagram illustrating an acquisition apparatus for a job starting point according to an embodiment of the present application;
fig. 9 shows a schematic structural diagram of a path planning apparatus provided in an embodiment of the present application.
Detailed Description
The technical solutions in the embodiments of the present application will be clearly and completely described below with reference to the drawings in the embodiments of the present application, and it is obvious that the described embodiments are only a part of the embodiments of the present application, and not all of the embodiments.
The components of the embodiments of the present application, generally described and illustrated in the figures herein, can be arranged and designed in a wide variety of different configurations. Thus, the following detailed description of the embodiments of the present application, presented in the accompanying drawings, is not intended to limit the scope of the claimed application, but is merely representative of selected embodiments of the application. All other embodiments, which can be derived by a person skilled in the art from the embodiments of the present application without making any creative effort, shall fall within the protection scope of the present application.
Hereinafter, the terms "including", "having", and their derivatives, which may be used in various embodiments of the present application, are intended to indicate only specific features, numbers, steps, operations, elements, components, or combinations of the foregoing, and should not be construed as first excluding the existence of, or adding to, one or more other features, numbers, steps, operations, elements, components, or combinations of the foregoing.
Furthermore, the terms "first," "second," "third," and the like are used solely to distinguish one from another and are not to be construed as indicating or implying relative importance.
Unless otherwise defined, all terms (including technical and scientific terms) used herein have the same meaning as commonly understood by one of ordinary skill in the art to which the various embodiments of the present application belong. The terms (such as those defined in commonly used dictionaries) should be interpreted as having a meaning that is consistent with their contextual meaning in the relevant art and will not be interpreted in an idealized or overly formal sense unless expressly so defined herein in various embodiments.
Example 1
The embodiment of the disclosure provides a method for acquiring a job starting point.
Specifically, as shown in fig. 1, the method for acquiring the job starting point includes:
and step S101, acquiring a breakpoint on an initial operation route when the operation task of the unmanned equipment is interrupted.
In the present embodiment, the unmanned device includes an unmanned aerial vehicle, an unmanned vehicle, or a self-driving device, but is not limited thereto, and the self-driving device may include a self-driving device and a working device controlled by the self-driving device. When the unmanned aerial vehicle performs work according to the initial work route acquired in advance, the unmanned aerial vehicle may not complete the work at a time due to energy limitation, work time limitation, or an excessively large work area, and the like, and the work task on the initial work route may be interrupted and the set starting point may be returned from the breakpoint.
In this embodiment, the initial work route may include at least one work section. One embodiment of the following initial work route is described below with reference to fig. 2:
referring to fig. 2, the initial operation route 20 may include a plurality of operation sections 21, and the area where the plurality of operation sections 21 are located includes the obstacle C, and correspondingly, the initial operation route 20 further includes a plurality of transition paths 23 and obstacle avoidance paths 22, and the transition paths 23 and the obstacle avoidance paths 22 may be collectively referred to as non-operation paths. In fig. 2, obstacle avoidance end points B1, B2, B3, B4, B5, B6, B7, B8, B9, B10, and B10 are provided around an obstacle C, the obstacle avoidance paths 22 are B11B 10, B1B 10, B2B 10, B4B 10, B5B 10, B6B 10, B7B10, B8B 10, and B9B10, the end points of the operation segments of the initial operation route 20 include a10, a 3613, a10, and a 3613 a10, B10, a10, and B10. The obstacle avoidance path 22 includes: B11B1 → B1B2 → B2B3, B4B7 → B7B 10. The transition path 23 includes A2A3, A4a5, A6a7, A8a9, a10a11, a12a 13. In fig. 2, the unmanned aerial vehicle flies into the end point a1 of the initial working route 20 from the set starting point O and performs work according to the initial working route 20, for example, pesticide spraying work can be performed according to the initial working route 20.
Referring to fig. 3, if the unmanned aerial vehicle performs a work according to the initial work route 20 shown in fig. 2, the work is interrupted at a point D1 when the unmanned aerial vehicle reaches the work section A7B4 due to insufficient power or insufficient auxiliary materials for work operation, the work is interrupted at a break point D1, the start point O is set to fly back, and the unmanned aerial vehicle acquires the break point D1 and records the break point D1.
It should be noted that although the initial working path 20 is described above by taking the obstacle C existing in the initial working path 20 as an example, in practical applications, there may be a case where no obstacle exists in the initial working path 20, and in this case, the initial working path 20 may not include an obstacle avoidance path.
And step S102, acquiring a residual operation section from the initial operation route based on the breakpoint.
In this embodiment, the remaining operation section is an operation section where the operation task is not executed when the previous operation task is interrupted in the initial operation route. The remaining operation section may include at least one remaining operation section.
If the drone flies back from the break point D1 of fig. 3 to set the start point O, the remaining work links may refer to fig. 4A, where in fig. 4A, the remaining work links include D1B4, B10A8, A9B9, B5a10, a11B6, B8a12, a13a 14.
Step S103, determining a work start point based on the break point and the entry path between the end point of the remaining work segment and the set start point, respectively.
In this embodiment, the breakpoint or endpoint with the shortest entry path may be used as the job starting point, or there may be other determination manners, which is not limited herein. The set starting point may be an energy replenishment point or a safety departure point of the unmanned aerial vehicle determined based on the mapping data, or may be set autonomously by the user in accordance with actual demand. In the operation of different ranks performed by the unmanned aerial vehicle, the position of the set starting point may be unchanged or may be changed according to the requirements, which is not limited in the present application.
Referring to fig. 4A again, according to the entry paths between the set start point O and the break point D1 and the end points A8, a9, a10, a11, a12, a13, and a14 of the remaining work links, the end point A8 having the shortest entry path to the set start point O may be determined as the work start point from the break point D1, the end points A8, a9, a10, a11, a12, a13, and a 14.
In this embodiment, step S103 may include the following steps:
if the breakpoint is on a transition path or an obstacle avoidance path outside the surplus operation section, determining the operation starting point from the end point of the surplus operation section;
and if the breakpoint is on the residual operation section, determining the operation starting point from the breakpoint and the end point of the residual operation section.
In the present embodiment, if the breakpoint is on the transition path or the obstacle avoidance path other than the remaining operation segment, the operation starting point is directly determined from the end points of the remaining operation segment without considering the breakpoint, so that the amount of calculation can be reduced, and the efficiency can be improved. If the breakpoint is on the remaining operation section, the operation starting point is determined from the breakpoint and the end point of the remaining operation section, and the most appropriate breakpoint or end point can be selected comprehensively as the operation starting point, so that the accuracy of the operation starting point and the operation efficiency of the unmanned equipment are improved.
For example, referring to fig. 4B, the breakpoint D2 is on the obstacle avoidance path of the initial operation route, and the operation starting point may be determined directly from the end points of the remaining operation segments without considering the breakpoint D2.
Next, the remaining work links at the break point D1 and the break point D2 will be described with reference to fig. 5A and 5B. For the break point D1 in fig. 4A, the remaining work links are D1B4, B10A8, A9B9, B5A10, a11B6, B8a12, a13a14 shown in fig. 5A, and accordingly, since the break point D1 is on the work link, the end points of the remaining work links in fig. 5A include D1, A8, A9, a10, a11, a12, a13, a 14. For the break point D2 in fig. 4B, the remaining work links are B10A8, A9B9, B5A10, a11B6, B8a12, a13a14 shown in fig. 5B, and accordingly, since the break point D2 is not on the work link, the end points of the remaining work links in fig. 5A include A8, A9, a10, a11, a12, a13, a 14.
In the present embodiment, the end points of the remaining job path may be determined according to whether or not the break point is on the job segment, so that the job start point may be determined from the end points of the remaining job path according to the scheme provided by the present embodiment.
After the job start point is determined, a subsequent job path may be determined based on the job start point. Next, referring to fig. 6A and 6B, a description will be given of a work route following the operation start point identified as the end point A8 of the remaining work route in fig. 5A and 5B.
Referring to fig. 6A, in the case that the breakpoint is D1, the endpoint A8 of the remaining operation route is used as the operation starting point, and the subsequent operation processes may be performed according to the order of the remaining operation link A8B10, the obstacle avoidance route B10B7, the obstacle avoidance route B7B4, the remaining operation link B4D1, the transition route D1a10, the remaining operation link a10B5, the obstacle avoidance route B5B7, the obstacle avoidance route B7B9, the remaining operation link B9A9, the transition route A9a12, the remaining operation link a12B8, the obstacle avoidance route B8B7, the obstacle avoidance route B7B6, the remaining operation link B6A11, the transition route a11a14, and the remaining operation link a14a 13.
Referring to fig. 6B, in the case that the breakpoint is D2, with the end point A8 of the remaining operation route as the operation starting point, the subsequent operation processes may be performed in the order of the remaining operation link A8B10, the transition route B10A9, the remaining operation link A9B9, the obstacle avoidance route B9B7, the obstacle avoidance route B7B5, the remaining operation link B5a10, the transition route a10a11, the remaining operation link a11B6, the obstacle avoidance route B6B7, the obstacle avoidance route B7B8, the remaining operation link B8a12, the transition route a12a13, and the remaining operation link a13a 14.
In this embodiment, in order to reduce the amount of computation and improve the efficiency of the unmanned aerial vehicle for continuing the operation, in the determination process of the operation starting point, the end point used is an alternative end point, of the end points of the remaining operation section, where the length of an entry path between the end point and the set starting point is smaller than a preset path length.
It should be noted that the preset path length may be set by default, and may be determined according to an entry path between an end point of the remaining work segment and a set starting point. For example, the entry paths between the end points of the remaining operation sections and the set starting point may be sorted, the median of all the entry paths may be used as the preset distance threshold, the average of the entry paths between the end points of the remaining operation sections and the set starting point may be used as the preset path length, or the preset path length may be determined according to other setting rules, which is not limited herein.
For example, as shown in fig. 4A, the end points A8, a9, a12, a13 of the remaining work segments may be determined as alternative end points according to the entry paths between the end points A8, a9, a10, a11, a12, a13, a14 of the remaining work segments and the set starting point O, and the alternative end point set includes the end points A8, a9, a12, a13 of the work sub-route as alternative end points used in the work starting point determination process.
In this embodiment, the determining the work starting point from the end points of the remaining work segments includes:
if only one alternative endpoint exists, determining the alternative endpoint as a work starting point;
and if the number of the alternative endpoints is more than one, determining the alternative endpoint with the shortest entry path between the alternative endpoint and the set starting point as a work starting point.
Referring again to FIG. 4A, if the alternate endpoint includes only one alternate endpoint A8, then alternate endpoint A8 is used as the job start point. If the candidate endpoint set comprises candidate endpoints A8 and a9, the candidate endpoint A8 with the shortest entry path between the candidate endpoints A8 and a9 and the set starting point O is used as the work starting point.
In this way, by classifying the number of candidate end points, it is possible to directly determine a work start point when there is only one candidate end point, and the processing efficiency of determining a work start point from the end points of the remaining work segment is improved. When a plurality of candidate end points exist, the candidate end point with the shortest entering path is determined as the work starting point, the processing efficiency of determining the work starting point is improved, meanwhile, the traveling path of the unmanned equipment is reduced, the energy loss is reduced, and the work efficiency is improved.
In this embodiment, the determining the work starting point from the breakpoint and the end point of the remaining work segment includes:
and taking the breakpoint and the point with the shortest entering path between each alternative endpoint and the set starting point as a work starting point.
Referring to fig. 4A again, if the entry path between the break point D1 and the set starting point O is determined to be the line segment OB2 and the line segment B2D1, the entry paths between the candidate end points a8, a9 and the set starting point O are determined to be OA8 and OA9, and the entry path OA8 is determined to be the shortest entry path, the candidate end point a8 is used as the operation starting point.
In this way, the candidate end point or the breakpoint having the shortest entry path is determined as the work start point, so that the travel path of the unmanned aerial vehicle can be reduced, energy loss can be reduced, and work efficiency can be improved.
In an embodiment, the determining process of the break point and the entry path of the set starting point includes:
if an obstacle avoidance path exists between the breakpoint and the set starting point, determining an optimal obstacle avoidance point from the obstacle avoidance path; determining an access path between the breakpoint and the set starting point according to the optimal obstacle avoidance point, the breakpoint and the set starting point;
and if no obstacle avoidance path exists between the breakpoint and the set starting point, taking a straight line segment between the breakpoint and the set starting point as an entering path between the breakpoint and the set starting point.
It should be added that, when an obstacle avoidance path exists between the breakpoint and the set starting point, a straight line segment between the set starting point and the optimal obstacle avoidance point and a straight line segment between the optimal obstacle avoidance point and the breakpoint may be determined as the breakpoint, and determined as the entry path between the set starting point and the breakpoint.
For example, referring to fig. 4A again, an obstacle avoidance path B1B2, B2B3 exists between the break point D1 and the set starting point O, and a best obstacle avoidance point can be determined from the obstacle avoidance path B1B2, B2B3, wherein if the determined best obstacle avoidance point is B2, the line segment D1B2 and the line segment B2O can be determined as an entry path between the break point D1 and the set starting point O. If the obstacle avoidance path does not exist between the break point D1 and the set starting point O, a straight line D1O between the break point D1 and the set starting point O is used as an entry path between the break point and the set starting point.
It should be noted that, although the above embodiment determines the best obstacle avoidance point from the obstacle avoidance path, and then obtains the entry path based on the best obstacle avoidance point, the set starting point, and the breakpoint, in other embodiments, the entry path between the breakpoint and the set starting point may be generated directly by an obstacle avoidance path planning algorithm based on the breakpoint, the set starting point, and the obstacle information on the obstacle avoidance path. In the foregoing, the optimal obstacle avoidance point may be determined from the obstacle avoidance path through a path planning algorithm, but to further simplify the determination process of the optimal obstacle avoidance point and avoid the computational complexity caused by the path planning algorithm, in an embodiment, the optimal obstacle avoidance point may be directly determined from end points of the obstacle avoidance path, and accordingly, the determining the optimal obstacle avoidance point from the obstacle avoidance path includes:
determining the sum of linear distances between each obstacle avoidance end point on the obstacle avoidance path and the set starting point and the break point respectively;
and taking the obstacle avoidance end point corresponding to the minimum sum value as the optimal obstacle avoidance point.
For example, in fig. 4A, there are obstacle avoidance paths B1B2 and B2B3 between the break point D1 and the set start point O, and the sum of the straight distances between the obstacle avoidance end points B1, B2, B3 and the break point D1 and the set start point O is calculated, it can be understood that the lengths of OB1D1, OB2D1, and OB3D1 are calculated, that is, the end point corresponding to the minimum length can be selected as the optimal obstacle avoidance point, for example, assuming that the calculated length of OB2D1 is the minimum, the obstacle avoidance point B2 can be the optimal obstacle avoidance point.
It is to be noted that, as can be seen from the above example, an obstacle exists on OB1D1, and the line segment of OB3 in OB3D1 is very close to the obstacle, in this case, if the optimal obstacle avoidance point finally determined to be B1 or B3 is, it is likely that the unmanned device collides with the obstacle during entering the work starting point along the entering path OB1D1 or OB3D 1. Therefore, to solve this problem and to improve the safety of the operation of the unmanned aerial vehicle, in an embodiment, the determination strategy of the optimal obstacle avoidance point may be adjusted, for example, before determining the optimal obstacle avoidance point on the obstacle avoidance path, the method may further include; determining a straight line path between each obstacle avoidance end point on the obstacle avoidance path and the set starting point and the break point respectively; and for each straight line path, determining whether an obstacle exists in a preset range from the straight line path, if so, indicating that the unmanned equipment is likely to collide with the obstacle when entering along the straight line path, and discarding an obstacle avoidance end point corresponding to the straight line path. Therefore, the obstacle avoidance end points with potential safety hazards can be abandoned before the optimal obstacle avoidance point is determined, so that safe obstacle avoidance end points are obtained, and further the subsequent safe access of the unmanned equipment is ensured.
In another embodiment, the determination strategy of the optimal obstacle avoidance point may not be adjusted, but the entry path may be adjusted; for example, after determining a straight line segment between the set starting point and the optimal obstacle avoidance point and a straight line segment between the optimal obstacle avoidance point and the breakpoint as the entry path between the set starting point and the breakpoint, the method may further include: and determining whether an obstacle exists in the preset range of the access path, wherein if the obstacle exists, the obstacle is likely to collide with the obstacle when the unmanned equipment enters along the access path, so that the access path is required to be adjusted, the obstacle does not exist in the preset range of the adjusted access path, and the safe access of the unmanned equipment is further ensured.
The operation starting point is determined from the breakpoint and the end points of the remaining operation sections by comprehensively considering the situations of whether the breakpoint is located in the operation path, whether the obstacle avoidance path exists between the end points of the section point and the remaining operation sections and the set starting point, so that the proper operation starting point can be selected on the premise of ensuring safety, the energy loss is reduced, and the operation efficiency is improved. In the above process, the influence of the entry path on the job starting point is considered, and it can be understood that the path planning in the job process and the path planning in the return process also influence the determination of the job starting point. It is further added that, in an embodiment, the step S103 may include the following steps:
determining a corresponding candidate operation end point when the breakpoint and the end point of the residual operation section are taken as candidate operation starting points;
a job start point is determined from the candidate job start points based on an entry path between each candidate job start point and the set start point and a candidate return path between each candidate job end point and the set start point.
In this embodiment, the breakpoint and the end point of the remaining work section are used as candidate work start points, and further, a plurality of points may be selected from the breakpoint and the end point of the remaining work section by a preset selection rule to be used as candidate work start points.
Referring to fig. 4A and 5A again, a point D1, a point a8, and a point a9 may be selected from the break points and the end points of the remaining operation segments as candidate operation start points according to a preset selection rule. Due to the presence of the obstacle, it can be determined that the entry path between the break point D1 and the set start point O is the line segment OB2 and the line segment B2D1, that is, the entry path between the break point D1 and the set start point O is the line segment OB2D 1. Due to cruising ability or other work limitation conditions, the corresponding candidate work end point E1 when the breakpoint D1 is determined as the candidate work start point is on the work segment B8a12, and the candidate return path E1O between the candidate work end point E1 and the set start point O. Correspondingly, the point A8 and the point a9 may be used as the candidate job end point corresponding to the candidate job start point, and then the corresponding candidate return path is determined according to the determined candidate job end point and the set start point O, which is not described herein again.
Further, referring to fig. 6A, in fig. 6A, when the end point A8 of the remaining operation link is used as the candidate operation start point, the candidate operation end point E2 corresponding to the end point A8 of the remaining operation link is determined to be on the operation link B6A11 due to cruising ability or other operation limiting conditions. When the endpoint a9 of the remaining operation link is taken as the candidate operation starting point, the candidate operation endpoint E3 corresponding to the endpoint a9 of the remaining operation link is determined to be on the operation link a14a13 due to cruising ability or other operation limiting conditions.
In fig. 6A, the entry paths between the candidate work start points A8 and a9 and the set start point O are line segments OA8 and OA9, respectively, and the line segment OA9 is not shown in fig. 6A to simplify the connection relationship of fig. 6A. If there is no obstacle avoidance path between the candidate job end points E2, E3 and the set start point O, the candidate return paths are straight line segments E2O, E3O, respectively, and the line segments E2O, E3O are not shown in fig. 6A to simplify the connection relationship of fig. 6A. If an obstacle avoidance path exists between the candidate operation end points E2 and E3 and the set start point O, it is necessary to determine a candidate return path according to the obstacle avoidance end points, the candidate operation end points E2 and E3 and the set start point O on the obstacle avoidance path, or determine a corresponding candidate return path according to an obstacle avoidance path planning algorithm based on the candidate operation start points a8 and a9, the candidate operation end points E2 and E3, the set start point O and the obstacle information on the obstacle avoidance path. The specific process can refer to the description in the related above, and is not described herein again to avoid repetition.
It should be noted that, in the process of determining the candidate job end point corresponding to the candidate job start point, the estimated path between the candidate job start point and the break point may be determined first, and the estimated path between the candidate job start point and the break point may be completed first, and if the unmanned device still has the remaining electric quantity and/or the remaining job auxiliary materials, the remaining job may be continuously completed from the break point, so that the continuity of the job may be ensured, and the job omission may be avoided. This is explained below with reference to fig. 7.
Referring to fig. 7, line segments A1a2, A3A4, A5B3, B9A6, A7B4, B8A8, a10B7, and A5D3 represent operation links where the last operation is completed, obstacle avoidance points B1, B2, B3, B4, B5, B6, B7, B8, and B9 are located around the obstacle C, the remaining operation links are line segments D3a9, a11a12, a13a14, and a15a16, and accordingly, the end points of the remaining operation links are a9, a11, a12, a13, a14, a15, and a 16. If the end points A9, A11, A12, A13, A14 and A16 of the remaining work links are respectively taken as candidate work starting points. For each candidate job start point, its corresponding candidate job end point may be determined in the following manner, which is described below by taking end point a12 as an example: the predicted path S1 between the candidate job start point a12 and the break point D3 is determined. The maximum operation distance S2 of the unmanned aerial vehicle can be determined according to the electric quantity of the unmanned aerial vehicle and/or the amount of the operation auxiliary materials, and then the candidate operation end point corresponding to the candidate operation end point a12 is determined from the remaining operation section according to the estimated path S1 and the maximum operation distance S2. Wherein, the maximum travel distance may represent: and after the unmanned equipment runs for the maximum running distance, the unmanned equipment needs to return to the home.
Further, determining the candidate job end point corresponding to the candidate job end point a12 from the remaining job segments according to the estimated path S1 and the maximum travel distance S2 may include the following processes:
if the maximum travel distance S2 is less than or equal to the estimated path S1, the candidate job end point E4 is determined according to the maximum travel distance S2, the leading-segment job route a12a11 and the transition path, and in fig. 7, the candidate job end point E4 is located on the segment A9D 3.
If the maximum travel distance S2 is greater than the estimated path S1, the estimated path S1 is subtracted from the maximum travel distance S2 to obtain a remaining travel distance Δ S, and then a candidate job end point is determined from the remaining job sections other than the estimated path based on the remaining travel distance Δ S. The above process is illustrated by way of example in fig. 7: first, it should be noted that if the candidate job starting point is not a breakpoint, the candidate starting point is located after the breakpoint in the previous job, for example, the candidate job starting point a12 and the breakpoint D3, so that there may be a remaining job segment without a job between the candidate starting point and the breakpoint, and therefore, to ensure that the remaining job segment between the candidate job starting point and the breakpoint is continuously executed to avoid the job omission phenomenon, the estimated path S1 between the candidate job starting point a12 and the breakpoint D3 may be determined, and then the remaining operation distance Δ S for the unmanned aerial vehicle to continue to operate after the unmanned aerial vehicle walks the estimated path S1 may be determined. Then, candidate job end points can be determined from other remaining job segments outside the estimated path, such as a13a14 and a15a16, based on the remaining travel distance Δ S, wherein transition path lengths between the break point D3 and end points of other remaining job segments, such as distances of D3a13 and D3a14, respectively, can be calculated first, and then an end point corresponding to the shortest transition path length is selected as a job point after the break point, taking fig. 7 as an example, since the length of D3a13 is shortest, a13 can be taken as a job point after the break point D3, and then the remaining travel distance Δ S is differentiated from the length of D3a13, so that the candidate job end points can be determined on other remaining job segments outside the estimated path, as shown in E5 in fig. 7. In this way, the unmanned aerial vehicle can complete the work segment from the work starting point a12 to the break point D3, and then enter other remaining work segments along the transition path D3a13 until the unmanned aerial vehicle travels to the work end point E5, in which process, the work path and sequence of the unmanned aerial vehicle are as follows: a12 → A11 → A9 → D3 → A13 → A14 → A16 → E5.
The predicted path at least comprises a residual operation section, and on the basis, the predicted path can also comprise a transition path. In the following explanation, the predicted path only includes the remaining operation links, in this case, the break point and the candidate operation start point are both on the same remaining operation link, and taking fig. 7 as an example, assuming that the candidate operation start point is a9, the predicted path at this time is a9 → D3, that is, the predicted path at this time only includes the remaining operation links. Further, the predicted path includes a remaining operation link and a transition path, in which case the break point and the candidate operation start point are not on the same remaining operation link, and assuming that the candidate operation start point is a12, taking fig. 7 as an example, the predicted path at this time is a12 → a11 → A9 → D3, that is, the predicted path at this time includes the remaining operation link (a12a11, A9D3) and the transition operation path (a11 A9).
It should be noted that although an obstacle is shown in the drawing on the work path, in actual application, the determination principle of the candidate work start point, the candidate work end point, the work end point, and the like in the case where no obstacle is present may be the same as that in the case where an obstacle is present, but the obstacle information need not be considered in the implementation, and it can be understood that the steps related to the obstacle processing are not involved, and therefore, it should not be considered that the embodiment of the present application can be applied only in the case where an obstacle is present.
Considering the influence of the energy consumption of the equipment and the running distance of the equipment on the working efficiency during actual working, the starting point of the working can be determined based on the conditions of the energy consumption of the equipment, the running distance of the equipment and the like during working. Specifically, the determination of the job starting point includes:
acquiring the length sum/or equipment energy consumption sum of an entry path and a candidate return path corresponding to each candidate operation starting point;
and taking the candidate job starting point corresponding to the minimum length sum and/or the minimum equipment energy consumption sum as the job starting point.
For example, referring to fig. 4A again, if the breakpoint D1 is used as the candidate job start point, the breakpoint D1 is determined as the candidate job end point E1 of the candidate job start point according to the power of the unmanned aerial vehicle or the amount of the job auxiliary materials, and the candidate job end point E1 is located on the remaining job segment B8a 12. Correspondingly, when the end points A8, a9, a10, a11, a12 and a13 of the remaining work links are used as candidate work start points, the candidate work end points corresponding to the end points A8, a9, a12 and a13 can be determined according to the electric quantity of the unmanned equipment or the quantity of the auxiliary materials of the work, and the candidate work end points corresponding to the end points of the remaining work links are not marked in fig. 4A in order to avoid redundant diagram labels. And determining corresponding candidate return paths according to the candidate job end points corresponding to the break point D1, the end points A8, A9, A10, A11, A12 and A13, and respectively calculating the length sum and/or the equipment energy consumption sum of the entering path and the candidate return path corresponding to the break point D1, the end points A8, A9, A10, A11, A12 and A13. In the first aspect, if the sum of lengths is used as a condition for determining the job starting point, a candidate job starting point such as A8 having the smallest sum of lengths may be used as the job starting point; in the second aspect, if the sum of the device energy consumptions is used as a condition for determining the job starting point, a candidate job starting point having the smallest sum of the device energy consumptions, such as a9, may be used as the job starting point; in a third aspect, if the length sum and the device energy consumption sum are used as conditions for determining the job starting point, if there is a candidate job starting point (breakpoint or end point) having both the minimum length sum and the minimum device energy consumption sum, the candidate job starting point may be directly used as the job starting point, and if there is no point having both the minimum length sum and the minimum device energy consumption sum, the length sum and the device energy consumption sum corresponding to each candidate job starting point may be fused, weighted averaged, or normalized to obtain a target value capable of representing a comprehensive situation of the length sum and the device energy consumption sum of each candidate job starting point, and then the candidate job starting point having the minimum target value may be selected as the job starting point.
In this way, based on the entry path between each candidate work starting point and the set starting point and the candidate return path between each candidate work ending point and the set starting point, the candidate work starting point with the smallest entry path and return path sum value and/or the smallest equipment energy consumption sum can be selected as the work starting point, the most appropriate breakpoint or end point can be selected as the work starting point from various factors of path distance and equipment energy consumption, and the accuracy of the work starting point and the work efficiency of the unmanned equipment are improved.
In one embodiment, in addition to determining the job start point using the entry path of the candidate job start point and the candidate return path of the candidate job end point, the distance and energy consumption of the candidate job path between the candidate job start point and the candidate job end point may be considered in determining the job start point. Specifically, the job starting point is further determined based on a candidate job path between each candidate job starting point and its corresponding candidate job ending point, and the determination of the job starting point may further include:
for candidate operation paths containing non-operation paths, determining the length sum and/or the equipment energy consumption sum of the non-operation paths in the candidate operation paths, the entry paths and the candidate return paths corresponding to the candidate operation paths; wherein the non-job path includes at least one of: an obstacle avoidance path and a transition path;
for candidate operation paths which do not contain non-operation paths, determining the length sum and/or equipment energy consumption sum of the entry path and the candidate return path corresponding to the candidate operation paths;
and taking the candidate job starting point corresponding to the minimum length sum and/or the minimum equipment energy consumption sum as the job starting point.
In this embodiment, since the energy consumption of the equipment is related to the load of the equipment, the load of the equipment changes as the work progresses, and the total energy consumption of the equipment can be calculated according to a preset calculation formula. For example, the total device energy consumption of the incoming path and the candidate return path of the candidate job path that does not include the non-job path may be calculated using the following equation (1):
formula (1): si=α1×Li,1+α2×Li,2;
SiRepresents the sum of the energy consumptions of the devices, Li,1Represents the energy consumption of the equipment corresponding to the incoming path, Li,2Representing the energy consumption of the device corresponding to the candidate return path, α1And alpha2For presetting the energy consumption parameter, alpha1=K*α2,K>1. It should be noted that the device energy consumption corresponding to each path may be calculated by using a related technique, which is not described herein again.
It will be appreciated that at the start, the drone is operating fully, with a corresponding loss of operation, on the candidate return pathThe weight of the unmanned equipment is reduced, the corresponding operation loss is small, and therefore alpha is calculated when the flight loss is calculated1Greater than alpha2。
In one embodiment, α may be determined according to the weight or volume of the working auxiliary material carried on the unmanned equipment1And alpha2Determining K according to the ratio of the operation auxiliary material amount corresponding to the full-load unmanned equipment on the entering path to the operation auxiliary material of the unmanned equipment on the candidate returning path, and determining alpha according to K1And alpha2. For example, on the entry route, when the drone is fully loaded, the content of the corresponding work auxiliary material is 100%, when a part of the work auxiliary material on the candidate return route has been consumed, and when the content of the corresponding work auxiliary material is 50%, K is 100%/50% ═ 2, and α is corresponding to K ═ 21=1,α21/2; on the entering route, the content of the corresponding operation auxiliary material is 100% when the unmanned aerial vehicle is fully loaded, the operation auxiliary material of the unmanned aerial vehicle on the candidate returning route is already consumed, the content of the corresponding sprinkling irrigation water is 33.3%, then K is 100%/33.3% ≈ 3, and the corresponding alpha is1=1,α2=1/3。
It is further added that the following formula (2) can be used to calculate the total energy consumption of the devices of the non-job path, the incoming path and the candidate return path of the candidate job path including the non-job path:
formula (2): si=α1×Li,1+α2×Li,2+α3×Li,3;
SiRepresents the sum of the energy consumptions of the devices, Li,1Represents the energy consumption of the equipment corresponding to the incoming path, Li,2Represents the energy consumption of the equipment corresponding to the candidate return path, Li,3Device energy consumption corresponding to non-job path representing candidate job path, distance alpha of candidate return path1、α2And alpha3For presetting the energy consumption parameter, alpha1=K*α2,K>1,α1=H*α3K can be determined according to the ratio of the amount of the corresponding operation auxiliary materials when the unmanned equipment on the entering path is fully loaded to the operation auxiliary materials of the unmanned equipment on the candidate returning path, and the K can be determined according to the entering pathAnd determining H according to the ratio of the operation auxiliary material amount corresponding to the full-load unmanned equipment on the path to the operation auxiliary material amount of the unmanned equipment on the non-operation path, wherein the determination process of H is similar to the determination process of K, and the details are not repeated here.
Therefore, the candidate operation starting point corresponding to the minimum length sum is used as the operation starting point, the section of the unmanned equipment for performing invalid operation can be shortened, and meanwhile, the unmanned equipment can be ensured to quickly enter the operation starting point for performing operation or quickly return from the operation end point, so that the efficiency of the unmanned equipment for continuing operation and the return efficiency are improved; the candidate operation starting point corresponding to the minimum equipment energy consumption sum is used as the operation starting point, so that the power consumption of the invalid operation of the unmanned equipment can be reduced; meanwhile, the operation starting point is determined by considering the total length and the energy consumption of the equipment, so that the invalid operation section of the unmanned equipment can be shortened to a certain extent, the continuous operation efficiency and the return efficiency of the unmanned equipment are ensured, and meanwhile, the power consumption of the invalid operation of the unmanned equipment can be reduced to a certain extent.
It should be further added that, besides the job information such as the electric quantity of the unmanned device and the amount of the auxiliary materials of the job, the determination of the candidate job end point may also need to be adjusted accordingly due to other types of job information of the unmanned device, for example, even if the amount of the auxiliary materials of the job or the electric quantity of the unmanned device can support the unmanned device to reach a distant candidate job end point and even complete the job of the whole job area, there may be a case that the job of the whole job area is not needed to be completed, for example, a user only wants to use the unmanned device to complete the job of a certain part of the job area, and based on this, the candidate job end point may also be determined in consideration of other factors, and therefore, in an embodiment, the job information may further include but is not limited to: setting the working area, setting the working path length and setting the working time length. Correspondingly, the process for determining the candidate job end point comprises the following steps:
respectively determining candidate job end points corresponding to the candidate job starting points according to the job information of the unmanned equipment; wherein the job information includes at least one of: the method comprises the following steps of unmanned equipment electric quantity, operation auxiliary material quantity, operation area setting, operation path length setting and operation duration setting.
It is understood that in the actual operation, the operation may not be completed all at once for the remaining operation sections, depending on the actual operation time, the actual operation area, the provisional operation plan modification, and the like. Therefore, the candidate work end point corresponding to each candidate work start point can be directly determined according to the unmanned equipment power, the work auxiliary material amount, the set work area, the set work path length, the set work duration and other work information. The candidate job end point may be determined according to one parameter in the job information, or may be determined by combining multiple parameters in the job information, which is not limited herein.
It can be understood that the unmanned equipment has different operation information and different corresponding operation distances, and the corresponding operation end point can be flexibly set. In one embodiment, the determining candidate job end points corresponding to the candidate job start points respectively according to job information of the unmanned aerial vehicle includes:
determining the working distance of the unmanned equipment according to the working information of the unmanned equipment;
and determining candidate operation end points corresponding to the candidate operation starting points according to the operation distance and the residual operation sections.
For example, after determining the farthest traveling distance of the unmanned aerial vehicle according to the unmanned aerial vehicle electric quantity, half of the farthest traveling distance may be used as the work distance, and then a point reached by traveling the work distance along the remaining work section from the candidate work start point may be used as the candidate work end point. In addition, the set operation area, the set operation path length, and the set operation duration input by the user may be received, and the candidate operation end point may be determined according to the set operation area, the set operation path length, and the set operation duration, which is not limited herein.
In an embodiment, the determining a candidate work end point corresponding to each candidate work start point according to the work distance and the remaining work section may include:
for a candidate job starting point which is not a breakpoint, determining the length of an estimated path between the candidate job starting point and the breakpoint; the estimated path comprises a residual operation section between the candidate operation starting point and the breakpoint;
when the working distance is smaller than the length of the pre-estimated path, determining a candidate working end point from the pre-estimated path based on the working distance;
and when the working distance is greater than or equal to the length of the estimated path, determining a candidate working end point from the rest working road sections except the estimated path based on the working distance and the length of the estimated path.
The process of determining the candidate operation end point from the remaining operation sections except the estimated path may include:
determining to obtain a residual working distance based on the working distance and the length of the estimated path;
determining a connection transition path between a breakpoint and each connection end point based on two connection end points of a breakpoint operation section where the breakpoint is located and a target residual operation section which is operated adjacent to the breakpoint operation section;
and determining candidate operation end points from the residual operation sections except the estimated path based on the residual operation distance and the connection transition path.
For the understanding of the above, reference may be made to the above description about the "predicted path", which is not repeated herein. In determining the candidate work end point, the candidate work end point direction may also be determined based on the candidate start work direction of the candidate work segment corresponding to each candidate work start point. Specifically, the determining a candidate work end point corresponding to each candidate work start point according to the work distance and the remaining work link may include:
for each candidate operation starting point, taking the direction of the candidate operation starting point pointing to the other end point in the remaining operation section as a candidate initial operation direction;
and for each candidate operation starting point, determining a candidate operation end point from the residual operation sections according to the candidate starting operation direction and the operation distance corresponding to the candidate operation starting point.
It should be noted that, based on any of the above embodiments, if there is a need for the unmanned equipment to maintain operation on the transition path or the obstacle avoidance path, the unmanned equipment may be kept in a state of continuing operation, such as continuing spraying operation, or sowing operation, or mapping operation, while the unmanned equipment passes through the transition path or the obstacle avoidance path.
According to the method for acquiring the operation starting point, the breakpoint on the initial operation route when the operation task of the unmanned equipment is interrupted is acquired; acquiring a residual operation section from the initial operation route based on the breakpoint; and determining a work starting point based on the break point and an entering path between the end point of the residual work section and a set starting point respectively. Thus, the operation starting point is determined from the breakpoint and the end point of the surplus operation section, the operation starting point of the surplus operation section can be selectively determined, the energy loss of the surplus operation section can be reduced, and the operation efficiency of the unmanned aerial vehicle can be improved.
Example 2
The embodiment of the disclosure provides a path planning method.
Specifically, the path planning method of the present embodiment includes:
and generating a target entry path according to the set starting point and the operation starting point, wherein the target entry path is used for guiding the unmanned equipment to enter a surplus operation section, the operation starting point is determined by any one of the acquisition methods of the operation starting point provided in embodiment 1, and the surplus operation section is an operation section which does not execute the operation task when the last operation task is interrupted in the initial operation route.
In this embodiment, the job starting point is determined according to the method for acquiring the job starting point provided in embodiment 1, and related contents may be referred to in embodiment 1, and are not described herein again in order to avoid repetition.
Referring again to fig. 6A, in fig. 6A showing the set start point O, if it is determined that the end point A8 is the work start point according to the process of embodiment 1, a target entry path OA8 may be generated according to the set start point O and the work start point A8, and the target entry path OA8 may direct the unmanned aerial device to enter the remaining work segment.
Therefore, the target entering path can be generated according to the set starting point and the operation starting point, the unmanned equipment can conveniently and quickly enter the residual operation section, and the operation efficiency of the unmanned equipment is improved.
After determining the target entry path, a job direction may be further determined, which may include the following steps in an embodiment:
determining an initial operation direction corresponding to the starting point operation section according to the operation starting point and the other end point of the starting point operation section where the operation starting point is located;
and determining whether to adjust the operation direction of the surplus operation section and the transition path between the operation adjacent surplus operation sections according to the initial operation direction.
Here, the direction in which the work starting point points to the other end point of the starting point work link where the work starting point points is located may be taken as the initial work direction, and in the case of fig. 6B, assuming that the end point A8 is taken as the work starting point, the line segment A8B10 is taken as the starting point work link, and the other end point of the starting point work link is taken as B10, so that the direction of A8 → B10 may be taken as the initial work direction. After the initial operation direction is determined, the operation directions corresponding to the remaining operation sections can be sequentially determined according to the operation sequence between the remaining operation section to be executed next and the starting operation section, for example, still taking fig. 6B as an example, the operation directions of all the remaining operation sections shown in the figure can be: a8 → B10 → A9 → B9 → B7 → B5 → A10 → A11 → B6 → B7 → B8 → A12 → A13 → A14.
It is understood that when there are a plurality of remaining operation sections, the transition path between the operation-adjacent remaining operation sections may be a transition path connecting adjacent 2 sections, or may be a transition path between two remaining operation sections separated by several remaining operation sections. For example, taking fig. 4B as an example, assume that A1a2 and a13a14 are adjacent operation links, and the operation sequence is: a1 → A2 → A14 → A13, then the transition path between A1A2 and A13A14 is A2A 14; similarly, assume that A1a2 and A3a4 are adjacent work links and the work order is: a1 → A2 → A3 → A4, the transition path between A1A2 and A3A4 is A2A 3.
In this embodiment, when the operation direction of the remaining operation section and the transition path between the operation-adjacent remaining operation sections are adjusted, the operation direction of all the remaining operation sections and the transition path between all the adjacent remaining operation sections may be adjusted, or the operation direction and the transition path of the corresponding remaining operation section may be adjusted after the operation distance is determined according to the operation information.
It is understood that, since the change of the initial operation direction corresponding to the starting operation section may result in the change of the operation direction of the remaining operation section and the change of the transition path between the remaining operation sections adjacent to the operation, the operation direction of the remaining operation section and the transition path between the remaining operation sections adjacent to the operation may be further adjusted. In one embodiment, adjusting the operation direction of the remaining operation section and operating the transition path between the adjacent remaining operation sections includes:
determining an initial operation direction of the starting point operation section on the initial operation route;
and if the initial operation direction is different from the initial operation direction, adjusting the transition path between the operation direction of the residual operation section and the operation adjacent residual operation section.
For example, referring to fig. 2 and 6B again, it is assumed that fig. 2 shows an initial operation route of the unmanned aerial vehicle, and fig. 6B shows an operation route of the unmanned aerial vehicle performing the current operation when the unmanned aerial vehicle uses A8 as the operation starting point, so that the operation direction of the operation link B10A8 in fig. 2 is B10 → A8, and the operation direction of the operation link B10A8 in fig. 6B is adjusted to A8 → B10, so that the current operation direction of the remaining operation links may be changed from the previous operation direction based on the re-determined operation starting point. Therefore, in order to ensure smooth operation of the unmanned aerial vehicle, the operation direction of all or a part of the remaining operation sections and the transition path between the operation adjacent remaining operation sections can be adjusted accordingly, in the initial operation direction different from the initial operation direction.
The route planning method provided in this embodiment generates a target entry route according to a set starting point and a job starting point, where the target entry route is used to guide an unmanned device to enter a remaining job segment, the job starting point is determined according to the method for obtaining the job starting point provided in embodiment 1, and the remaining job segment is a job segment on which a job task is not executed when a previous job task is interrupted in an initial job route. Therefore, the target entering path can be generated according to the set starting point and the operation starting point, the unmanned equipment can conveniently and quickly enter the residual operation section, and the operation efficiency of the unmanned equipment is improved.
Example 3
Further, in accordance with embodiment 1, an embodiment of the present disclosure provides an acquisition apparatus of a job starting point.
Specifically, as shown in fig. 8, the job start point acquisition device 800 includes:
a first obtaining module 801, configured to obtain a breakpoint on an initial operation route when an unmanned device operation task is interrupted;
a second obtaining module 802, configured to obtain a remaining operation section from the initial operation route based on the breakpoint;
a determining module 803, configured to determine a work starting point based on the break point and an entry path between the end point of the remaining work segment and a set starting point, respectively.
The apparatus 800 for acquiring a job starting point of this embodiment can execute the method for acquiring a job starting point described in embodiment 1 to achieve the same technical effect, and is not described herein again to avoid repetition.
Example 4
In addition, corresponding to embodiment 2, the embodiment of the present disclosure provides a path planning apparatus.
Specifically, as shown in fig. 9, the path planning apparatus 900 includes:
a generating module 901, configured to generate a target entry path according to a set starting point and a job starting point, where the target entry path is used to guide an unmanned device to enter a remaining job segment, where the job starting point is determined according to the method for obtaining a job starting point provided in embodiment 1, and the remaining job segment is a job segment where a job task is not executed when a previous job task is interrupted in an initial job route.
The path planning apparatus 900 of this embodiment may execute the method for obtaining the operation starting point described in embodiment 2 to achieve the same technical effect, and is not described herein again to avoid repetition.
Example 5
Furthermore, an embodiment of the present disclosure provides an electronic device, including: a processor and a memory, the memory storing a computer program that, when executed by the processor, performs the method of acquiring a job start point provided in embodiment 1 and/or the method of path planning provided in embodiment 2.
The electronic device may be an unmanned device, or a terminal device, the unmanned device may be an unmanned aerial vehicle, an unmanned vehicle, or a self-driving device, and the terminal device may be a computer device, a mobile terminal, and the like, which is not limited herein. It should be noted that, for the specific implementation of the processor in this embodiment, reference may be made to the description of corresponding contents in the foregoing embodiments 1 and 2, which are not described herein again.
Example 6
The present application further provides a computer-readable storage medium, on which a computer program is stored, and when executed by a processor, the computer program implements the method for acquiring a job start point according to embodiment 1 and/or the method for planning a path according to embodiment 2.
It should be noted that, for the specific implementation steps of this embodiment, reference may be made to the description of corresponding contents in the foregoing embodiments 1 and 2, which are not described herein again.
In this embodiment, the computer-readable storage medium may be a Read-Only Memory (ROM), a Random Access Memory (RAM), a magnetic disk or an optical disk.
It is to be noted that, in this document, the terms "comprises," "comprising," or any other variation thereof, are intended to cover a non-exclusive inclusion, such that a process, method, article, or terminal that comprises a list of elements does not include only those elements but may include other elements not expressly listed or inherent to such process, method, article, or terminal. Without further limitation, an element defined by the phrase "comprising an … …" does not exclude the presence of other like elements in a process, method, article, or terminal that comprises the element.
Through the above description of the embodiments, those skilled in the art will clearly understand that the method of the above embodiments can be implemented by software plus a necessary general hardware platform, and certainly can also be implemented by hardware, but in many cases, the former is a better implementation manner. Based on such understanding, the technical solutions of the present application may be embodied in the form of a software product, which is stored in a storage medium (such as ROM/RAM, magnetic disk, optical disk) and includes instructions for enabling a terminal (such as a mobile phone, a computer, a server, an air conditioner, or a network device) to execute the method according to the embodiments of the present application.
While the present embodiments have been described with reference to the accompanying drawings, it is to be understood that the invention is not limited to the precise embodiments described above, which are meant to be illustrative and not restrictive, and that various changes may be made therein by those skilled in the art without departing from the spirit and scope of the invention as defined by the appended claims.
Claims (22)
1. A method for acquiring a starting point of a job, the method comprising:
acquiring a breakpoint on an initial operation route when an unmanned equipment operation task is interrupted;
acquiring a residual operation section from the initial operation route based on the breakpoint;
and determining a work starting point based on the break point and an entering path between the end point of the residual work section and a set starting point respectively.
2. The method according to claim 1, wherein determining a work start point based on the entry path between the break point and the end point of the remaining work segment and a set start point, respectively, comprises:
if the breakpoint is on a transition path or an obstacle avoidance path outside the surplus operation section, determining the operation starting point from the end point of the surplus operation section;
and if the breakpoint is on the residual operation section, determining the operation starting point from the breakpoint and the end point of the residual operation section.
3. The method according to claim 2, wherein the determination of the work start point is performed by using an end point that is an alternative end point, in which an incoming path length between the end point of the remaining work section and the set start point is smaller than a preset path length.
4. The method of claim 3, wherein the determining the work start point from the end points of the remaining work segments comprises:
if only one alternative endpoint exists, determining the alternative endpoint as a work starting point;
and if the number of the alternative endpoints is more than one, determining the alternative endpoint with the shortest entry path between the alternative endpoint and the set starting point as a work starting point.
5. The method of claim 3, wherein the determining the work start point from the break point and the end point of the remaining work segment comprises:
and taking the breakpoint and the point with the shortest entering path between each alternative endpoint and the set starting point as a work starting point.
6. The method according to any one of claims 1 to 5, wherein the determining process of the break point and the entry path of the set starting point comprises:
if an obstacle avoidance path exists between the breakpoint and the set starting point, determining an optimal obstacle avoidance point from the obstacle avoidance path; determining an access path between the breakpoint and the set starting point according to the optimal obstacle avoidance point, the breakpoint and the set starting point;
and if no obstacle avoidance path exists between the breakpoint and the set starting point, taking a straight line segment between the breakpoint and the set starting point as an entering path between the breakpoint and the set starting point.
7. The method of claim 6, wherein the determining an optimal obstacle avoidance point from the obstacle avoidance path comprises:
determining the sum of linear distances between each obstacle avoidance end point on the obstacle avoidance path and the set starting point and the break point respectively;
and taking the obstacle avoidance end point corresponding to the minimum sum value as the optimal obstacle avoidance point.
8. The method according to any one of claims 1 to 5, wherein the determining process of the break point and the entry path of the set starting point comprises:
if an obstacle avoidance path exists between the breakpoint and the set starting point, determining an access path between the breakpoint and the set starting point based on the breakpoint, the set starting point and obstacle information on the obstacle avoidance path through an obstacle avoidance path planning algorithm;
and if no obstacle avoidance path exists between the breakpoint and the set starting point, taking a straight line segment between the breakpoint and the set starting point as an entering path between the breakpoint and the set starting point.
9. The method according to claim 1, wherein determining a work start point based on the entry path between the break point and the end point of the remaining work segment and a set start point, respectively, comprises:
determining a corresponding candidate operation end point when the breakpoint and the end point of the residual operation section are taken as candidate operation starting points;
a job start point is determined from the candidate job start points based on an entry path between each candidate job start point and the set start point and a candidate return path between each candidate job end point and the set start point.
10. The method according to claim 9, wherein the determining of the job starting point comprises:
acquiring the length sum/or equipment energy consumption sum of an entry path and a candidate return path corresponding to each candidate operation starting point;
and taking the candidate job starting point corresponding to the minimum length sum and/or the minimum equipment energy consumption sum as the job starting point.
11. The method according to claim 9, wherein the job starting point is further determined based on a candidate job path between each candidate job starting point and its corresponding candidate job end point, and the determination of the job starting point comprises:
for candidate operation paths containing non-operation paths, determining the length sum and/or the equipment energy consumption sum of the non-operation paths in the candidate operation paths, the entry paths and the candidate return paths corresponding to the candidate operation paths; wherein the non-job path includes at least one of: an obstacle avoidance path and a transition path;
for candidate operation paths which do not contain non-operation paths, determining the length sum and/or equipment energy consumption sum of the entry path and the candidate return path corresponding to the candidate operation paths;
and taking the candidate job starting point corresponding to the minimum length sum and/or the minimum equipment energy consumption sum as the job starting point.
12. The method according to any one of claims 9 to 11, wherein the process of determining the candidate job end point comprises:
respectively determining candidate job end points corresponding to the candidate job starting points according to the job information of the unmanned equipment; wherein the job information includes at least one of: the method comprises the following steps of unmanned equipment electric quantity, operation auxiliary material quantity, operation area setting, operation path length setting and operation duration setting.
13. The method according to claim 12, wherein the determining candidate job end points corresponding to the candidate job start points respectively based on job information of the unmanned aerial vehicle comprises:
determining the working distance of the unmanned equipment according to the working information of the unmanned equipment;
and determining candidate operation end points corresponding to the candidate operation starting points according to the operation distance and the residual operation sections.
14. The method of claim 13, wherein determining candidate work end points corresponding to each candidate work start point according to the work distance and the remaining work segment comprises:
for a candidate job starting point which is not a breakpoint, determining the length of an estimated path between the candidate job starting point and the breakpoint; the estimated path comprises a residual operation section between the candidate operation starting point and the breakpoint;
when the working distance is smaller than the length of the pre-estimated path, determining a candidate working end point from the pre-estimated path based on the working distance;
and when the working distance is greater than or equal to the length of the estimated path, determining a candidate working end point from the rest working road sections except the estimated path based on the working distance and the length of the estimated path.
15. The method of claim 14, wherein determining a candidate job end point from the remaining job segments outside the estimated path comprises:
determining to obtain a residual working distance based on the working distance and the length of the estimated path;
determining a connection transition path between a breakpoint and each connection end point based on two connection end points of a breakpoint operation section where the breakpoint is located and a target residual operation section which is operated adjacent to the breakpoint operation section;
and determining candidate operation end points from the residual operation sections except the estimated path based on the residual operation distance and the connection transition path.
16. A method of path planning, the method comprising:
generating a target entry path for guiding the unmanned aerial vehicle to enter a surplus operation section according to the set starting point and the operation starting point, wherein the operation starting point is determined according to the method for acquiring the operation starting point of any one of claims 1 to 13, and the surplus operation section is an operation section on which an operation task is not executed when the operation task is interrupted last time in the initial operation route.
17. The method of claim 16, further comprising:
determining an initial operation direction corresponding to the starting point operation section according to the operation starting point and the other end point of the starting point operation section where the operation starting point is located;
and determining whether to adjust the operation direction of the surplus operation section and the transition path between the operation adjacent surplus operation sections according to the initial operation direction.
18. The method of claim 17, wherein said determining whether to adjust a transition path between the work direction of the remaining work section and a work adjacent remaining work section based on the initial work direction comprises:
determining an initial operation direction of the starting point operation section on the initial operation route;
and if the initial operation direction is different from the initial operation direction, adjusting the transition path between the operation direction of the residual operation section and the operation adjacent residual operation section.
19. An apparatus for acquiring a starting point of a job, the apparatus comprising:
the first acquisition module is used for acquiring a breakpoint on an initial operation route when an unmanned equipment operation task is interrupted;
the second acquisition module is used for acquiring a residual operation road section from the initial operation route based on the breakpoint;
and the determining module is used for determining a work starting point based on the break point and an entry path between the end point of the residual work section and a set starting point respectively.
20. A path planning apparatus, the apparatus comprising:
a generating module, configured to generate a target entry path according to a set starting point and a work starting point, where the target entry path is used to guide an unmanned device to enter a remaining work segment, the work starting point is determined according to the method for acquiring a work starting point according to any one of claims 1 to 15, and the remaining work segment is a work segment where a work task is not executed when a last work task is interrupted in an initial work route.
21. An electronic device, comprising: a processor and a memory, the memory storing a computer program which, when executed by the processor, performs the method of acquiring a job starting point according to any one of claims 1 to 15 and/or the method of path planning according to any one of claims 16 to 18.
22. A computer-readable storage medium, characterized in that it stores a computer program which, when run on a processor, performs the method of acquiring a job starting point according to any one of claims 1 to 15 and/or the method of path planning according to any one of claims 16 to 18.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111165082.1A CN113970927B (en) | 2021-09-30 | 2021-09-30 | Method and device for acquiring operation starting point and electronic equipment |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111165082.1A CN113970927B (en) | 2021-09-30 | 2021-09-30 | Method and device for acquiring operation starting point and electronic equipment |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113970927A true CN113970927A (en) | 2022-01-25 |
CN113970927B CN113970927B (en) | 2022-12-27 |
Family
ID=79587141
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111165082.1A Active CN113970927B (en) | 2021-09-30 | 2021-09-30 | Method and device for acquiring operation starting point and electronic equipment |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113970927B (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115226476A (en) * | 2022-07-21 | 2022-10-25 | 松灵机器人(深圳)有限公司 | Mowing method, mowing device, mowing robot and storage medium |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH05150832A (en) * | 1991-11-22 | 1993-06-18 | Nippon Yusoki Co Ltd | Control method for unattended work vehicle |
CN110297501A (en) * | 2019-07-31 | 2019-10-01 | 朱彬 | Unmanned aerial vehicle (UAV) control method, apparatus and equipment |
CN110837252A (en) * | 2019-10-23 | 2020-02-25 | 江苏大学 | Full-path planning and breakpoint endurance method for unmanned rice transplanter |
CN111325366A (en) * | 2018-12-13 | 2020-06-23 | 杭州海康机器人技术有限公司 | Method and device for searching map breakpoint of automatic guided vehicle |
CN111345734A (en) * | 2018-12-24 | 2020-06-30 | 珠海市一微半导体有限公司 | Sweeping robot operation method and device, storage medium and sweeping robot |
CN111752300A (en) * | 2019-12-30 | 2020-10-09 | 广州极飞科技有限公司 | Unmanned aerial vehicle route planning method, device and system and computer readable storage medium |
CN111766870A (en) * | 2020-05-29 | 2020-10-13 | 广州极飞科技有限公司 | Transition path and operation path planning method and related device |
CN111766864A (en) * | 2019-12-30 | 2020-10-13 | 广州极飞科技有限公司 | Path generation method and device, electronic equipment and computer readable storage medium |
CN112362065A (en) * | 2020-11-19 | 2021-02-12 | 广州极飞科技有限公司 | Obstacle detouring track planning method and device, storage medium, control unit and equipment |
CN112666971A (en) * | 2020-12-15 | 2021-04-16 | 广州极飞科技有限公司 | Unmanned aerial vehicle return method and device, unmanned aerial vehicle and storage medium |
CN112668792A (en) * | 2020-12-31 | 2021-04-16 | 广州极飞科技有限公司 | Replenishment planning method, operation method and related device |
-
2021
- 2021-09-30 CN CN202111165082.1A patent/CN113970927B/en active Active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH05150832A (en) * | 1991-11-22 | 1993-06-18 | Nippon Yusoki Co Ltd | Control method for unattended work vehicle |
CN111325366A (en) * | 2018-12-13 | 2020-06-23 | 杭州海康机器人技术有限公司 | Method and device for searching map breakpoint of automatic guided vehicle |
CN111345734A (en) * | 2018-12-24 | 2020-06-30 | 珠海市一微半导体有限公司 | Sweeping robot operation method and device, storage medium and sweeping robot |
CN110297501A (en) * | 2019-07-31 | 2019-10-01 | 朱彬 | Unmanned aerial vehicle (UAV) control method, apparatus and equipment |
CN110837252A (en) * | 2019-10-23 | 2020-02-25 | 江苏大学 | Full-path planning and breakpoint endurance method for unmanned rice transplanter |
CN111752300A (en) * | 2019-12-30 | 2020-10-09 | 广州极飞科技有限公司 | Unmanned aerial vehicle route planning method, device and system and computer readable storage medium |
CN111766864A (en) * | 2019-12-30 | 2020-10-13 | 广州极飞科技有限公司 | Path generation method and device, electronic equipment and computer readable storage medium |
CN111766870A (en) * | 2020-05-29 | 2020-10-13 | 广州极飞科技有限公司 | Transition path and operation path planning method and related device |
CN112362065A (en) * | 2020-11-19 | 2021-02-12 | 广州极飞科技有限公司 | Obstacle detouring track planning method and device, storage medium, control unit and equipment |
CN112666971A (en) * | 2020-12-15 | 2021-04-16 | 广州极飞科技有限公司 | Unmanned aerial vehicle return method and device, unmanned aerial vehicle and storage medium |
CN112668792A (en) * | 2020-12-31 | 2021-04-16 | 广州极飞科技有限公司 | Replenishment planning method, operation method and related device |
Non-Patent Citations (2)
Title |
---|
叶建平等: "动态环境下基于断点的移动机器人路径再规划研究", 《制造业自动化》 * |
黄小毛等: "含障碍物多田块下旋翼无人机作业返航补给规划研究", 《农业机械学报》 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115226476A (en) * | 2022-07-21 | 2022-10-25 | 松灵机器人(深圳)有限公司 | Mowing method, mowing device, mowing robot and storage medium |
Also Published As
Publication number | Publication date |
---|---|
CN113970927B (en) | 2022-12-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Han et al. | Mobile robot path planning with surrounding point set and path improvement | |
Jensen et al. | Coverage planning for capacitated field operations, part II: Optimisation | |
Smith et al. | Solving shortest path problems with a weight constraint and replenishment arcs | |
CN111750862A (en) | Multi-region-based robot path planning method, robot and terminal equipment | |
CN112612273A (en) | Routing inspection robot obstacle avoidance path planning method, system, equipment and medium | |
WO2022142858A1 (en) | Robot moving path planning method and apparatus, method and apparatus for determining degree of deviation of planned path point from history path, and robot and computer-readable storage medium | |
Yu et al. | USV path planning method with velocity variation and global optimisation based on AIS service platform | |
Zamani | An evolutionary implicit enumeration procedure for solving the resource‐constrained project scheduling problem | |
CN109432777A (en) | Path generating method and device, electronic equipment, storage medium | |
CN113970927B (en) | Method and device for acquiring operation starting point and electronic equipment | |
CN114745317A (en) | Computing task scheduling method facing computing power network and related equipment | |
KR100791748B1 (en) | Reduceing Method of Shortest Path Searching Area and Calculating Method of Minimal Expecting Load and Method of Searching Shortest Path | |
TWI810455B (en) | System and method for guiding vehicles | |
CN114089754A (en) | Autonomous path planning method and system based on artificial intelligence | |
CN109827584B (en) | Path planning method and device, electronic equipment and storage medium | |
US11138351B2 (en) | Estimated distance calculator, estimated distance calculation method, estimated distance calculation program, and automated planner | |
CN109087061A (en) | A kind of data task distribution method, device, equipment and medium | |
CN111338381A (en) | Unmanned aerial vehicle operation control method and device, remote controller and storage medium | |
EP4250198A1 (en) | Task assignment in autonomous mobile devices | |
CN116448095A (en) | Mobile robot, navigation method and device thereof, computer equipment and storage medium | |
Pillac et al. | A fast re-optimization approach for dynamic vehicle routing | |
Miloradovic et al. | Extended Colored Traveling Salesperson for Modeling Multi-Agent Mission Planning Problems. | |
CN113657636A (en) | Automatic planning and generating algorithm of power grid operation mode diagram | |
CN118083808B (en) | Dynamic path planning method and device for crown block system | |
Lager et al. | Task roadmaps: speeding up task replanning |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |