WO2022099803A1 - Return control method and apparatus, electronic device, and storage medium - Google Patents
Return control method and apparatus, electronic device, and storage medium Download PDFInfo
- Publication number
- WO2022099803A1 WO2022099803A1 PCT/CN2020/132137 CN2020132137W WO2022099803A1 WO 2022099803 A1 WO2022099803 A1 WO 2022099803A1 CN 2020132137 W CN2020132137 W CN 2020132137W WO 2022099803 A1 WO2022099803 A1 WO 2022099803A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- point
- return
- segment
- home
- unmanned
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims abstract description 59
- 238000003860 storage Methods 0.000 title claims abstract description 15
- 238000004590 computer program Methods 0.000 claims description 13
- 238000010586 diagram Methods 0.000 description 7
- 238000005265 energy consumption Methods 0.000 description 3
- 230000006870 function Effects 0.000 description 3
- 230000000694 effects Effects 0.000 description 2
- 238000005507 spraying Methods 0.000 description 2
- 102100035475 Blood vessel epicardial substance Human genes 0.000 description 1
- 101001094636 Homo sapiens Blood vessel epicardial substance Proteins 0.000 description 1
- 101000608194 Homo sapiens Pyrin domain-containing protein 1 Proteins 0.000 description 1
- 101000595404 Homo sapiens Ribonucleases P/MRP protein subunit POP1 Proteins 0.000 description 1
- 206010034719 Personality change Diseases 0.000 description 1
- 230000002159 abnormal effect Effects 0.000 description 1
- 230000005856 abnormality Effects 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 238000005452 bending Methods 0.000 description 1
- 238000004422 calculation algorithm Methods 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 239000003814 drug Substances 0.000 description 1
- 239000007788 liquid Substances 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 238000009331 sowing Methods 0.000 description 1
- 239000000126 substance Substances 0.000 description 1
- 230000007704 transition Effects 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/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
Definitions
- the present application relates to the technical field of drone operations, for example, to a return-to-home control method, device, electronic device, and storage medium.
- unmanned control equipment such as Unmanned Aerial Vehicle (UAV) is widely used in actual production to improve work efficiency.
- UAV Unmanned Aerial Vehicle
- it is often necessary to return to the landing point for subsequent operations due to insufficient power or abnormality.
- the return point closest to the landing point is generally determined by changing the flight operation path.
- the UAV after the flight operation path is changed cannot continue to operate on the crops in a fixed position, resulting in Low work efficiency.
- the return point of the shortest path from the landing point cannot be determined, that is, the purpose of returning the drone cannot be achieved through the shortest path, which makes the return of the drone inefficient. .
- the present application provides a return-to-home control method, device, electronic device and storage medium. By determining the return-to-home point closest to the landing point on the original planned path, and to predict whether the unmanned operation equipment can reach the return-to-home in the next operation segment point, shorten the return route, improve operational efficiency, and avoid energy loss in non-operational segments.
- a return-to-home control method is provided, which is applied to unmanned operation equipment, and the unmanned operation equipment operates along continuous operation segments, and the method includes:
- the unmanned operation equipment Until the unmanned operation equipment is operating at the first home point or far from the first home point, and when it is judged that the unmanned operation equipment cannot reach the second home point, it returns from the current position. the target landing point.
- a return-to-home control device is also provided, which is applied to unmanned operation equipment, and the unmanned operation equipment operates along continuous operation segments, and the device includes:
- the determining module is configured to continuously determine the return point of the current operation segment as the first return point and the return point of the next operation segment as the second return point according to the target landing point of the unmanned operation equipment, wherein all the The return point is the closest position between the operation segment and the target landing point;
- Judging module set to until when the unmanned operation equipment is at the first home point or far from the first return point, when it is judged that the unmanned operation equipment cannot reach the second home point , return to the target landing point from the current position.
- Embodiments of the present application further provide an electronic device, including a memory, a processor, and a computer program stored in the memory and running on the processor.
- the processor executes the computer program, the return-to-home control method provided by the above embodiments is implemented.
- Embodiments of the present application further provide a computer-readable storage medium, where a computer program is stored on the computer-readable storage medium, and when the computer program is run by a processor, the return-to-home control method provided by the foregoing embodiment is executed.
- Fig. 1 is a kind of application schematic diagram of unmanned operation equipment returning home
- Fig. 2 is another application schematic diagram of unmanned operation equipment returning home
- FIG. 3 is a schematic flowchart of a return-to-home control method provided by an embodiment of the present application.
- FIG. 4 is an application schematic diagram of a return-to-home control method provided by an embodiment of the present application.
- FIG. 5 is an application schematic diagram of another return-to-home control method provided by an embodiment of the present application.
- FIG. 6 is an application schematic diagram of another return-to-home control method provided by an embodiment of the present application.
- FIG. 7 is an application schematic diagram of still another return-to-home control method provided by an embodiment of the present application.
- FIG. 8 is a functional block diagram of a return-to-home control device provided by an embodiment of the present application.
- the return-to-home control method changes the flight operation path of the unmanned operation equipment, so that the return point is closer to the starting point (landing point) and reaches the starting point through a shorter flight distance.
- the UAV operating equipment normally flies according to the planned path in the early stage.
- the flight operation path of the unmanned operating equipment is changed to form the second planned path (as shown in the figure). 1), and obtained two first and second return points that are relatively close to the starting point.
- the unmanned operation equipment can choose the first return point that is closer to the starting point as the return point to achieve return, but The path of the first home point does not cover the original plot, and a changeable flight path needs to be formed for subsequent operations, as shown in the upper right side of Figure 1.
- the unmanned operation equipment Even if the unmanned operation equipment is about to return, it needs to retain the original planned path.
- the reasons include the following two points: (1) Considering the entire plot environment and the given take-off/landing position, the planned path is usually The result of global optimization; (2) Some plots require the planned path to follow the direction of the plant row direction/plot geometry, and changing the path direction will easily reduce the operation effect.
- the present application provides a return-to-home control method without changing the operation path.
- the power status and flight position of the unmanned operation equipment are monitored.
- the flight reaches the W1 point of the operation segment P0P1, when it is detected that the battery level is less than the first battery level threshold, it will return to the home directly.
- the return home The point is W1
- the return path is W1H.
- the return path will be very long (for example, W1 is extremely close to the P1 point), and the drone cannot be guaranteed to return according to the shortest path, that is Operational energy efficiency cannot be guaranteed to be optimal.
- a return-to-home control method, device, electronic device, and storage medium provided by the embodiments of the present application determine the return-home point closest to the landing point on the original planned path, and predict whether the unmanned operation equipment can reach the next home point.
- the method of returning to the home point in the operation segment can realize the shortest return path, improve the operation efficiency, and avoid the energy loss of the non-operation segment.
- FIG. 3 is a schematic flowchart of a return-to-home control method provided by an embodiment of the present application.
- the return-to-home control method is applied to unmanned operation equipment, the unmanned operation equipment operates according to a planned path, the planned path of the unmanned operation equipment includes continuous operation segments, and the operation segments include the current operation segment and the next operation segment , the current operation segment and the next operation segment are connected by the flight segment, and various operation operations (including sowing, spraying, shooting and picking, etc.) are performed on the operation segment, and the adjacent operation segment is realized on the flight segment.
- the transition of the operation segment generally, no operation is required, but in some embodiments, the operation can also be performed), so as to realize the operation covering all the land parcels. Therefore, generally speaking, compared with the flight segment, the operation segment is relatively long, which can reduce the path length of the segment with attitude changes such as turning, reduce energy consumption, and improve operational efficiency.
- Step S102 continue to respectively determine the return point of the current operation segment as the first return point and the return point of the next operation segment as the second return point according to the target landing point of the unmanned operation equipment, wherein the return point The point is the closest position to the target landing point on the operation segment.
- Unmanned operation equipment includes unmanned control equipment such as drones and unmanned vehicles.
- the target landing point is a position set by the unmanned operation equipment in advance according to the take-off point, the planned path and the actual situation and other factors for the return landing, that is, the unmanned operation equipment reaches the target landing point to land and land after returning from the return point.
- Step S104 when the unmanned operation equipment is at the first return point of the current operation segment or is operating away from the first return point, determine whether the unmanned operation equipment can reach the first return point of the next operation segment. Second home point.
- Step S106 until when the unmanned operation equipment is operating at the first home point or far from the first return point, it is determined that the unmanned operation equipment cannot reach the second return point and returns to the target from the current position landing point.
- step S108 if it is determined that the unmanned operation equipment can reach the second home point, the operation is continued, and the process returns to step S102 to continue to determine the home point.
- the embodiment of the present application provides a return-to-home control method, wherein the return point on the current operation segment and the next operation segment is determined according to the target landing point, wherein the shortest distance between the return point on the operation segment and the landing point is Return path; when it reaches the first return point on the current operation segment or is far away from the first return point, judge whether the unmanned operation equipment can reach the second return point of the next operation segment, and if it can reach it, continue to follow the planned path If the operation cannot be achieved, it will return from the current position to the landing point, so as to achieve the shortest return path and improve the operation efficiency.
- the return point on the current operation segment and the next operation segment is determined according to the target landing point, wherein the shortest return path is between the return point on the operation segment and the landing point; when When it reaches the first return point on the current operating segment or is far away from the first return point, judge whether the unmanned operation equipment can reach the second return point of the next operation segment. If it can reach the second return point, continue to follow the plan. If the second home point cannot be reached, it will return to the target landing point from the current position, so as to achieve the shortest return path and improve energy efficiency. In some embodiments, when it is determined that it is necessary to return home, it is at the first return point, and returns to the target landing point from the first return point. To the target landing point, avoid returning to the first home point and then returning, saving energy and improving efficiency.
- the target landing point includes a flight landing point and a flight safety point, wherein the unmanned operation equipment passes through the flight safety point to reach the flight landing point, and the flight safety point is used to determine the flight landing point. home point.
- the safety point is the point that must be passed before reaching the landing point.
- the path between the safety point and the landing point is a safe path without obstacles. Setting the safety point can improve the safety of flight and avoid hitting obstacles. At this time, take the safety point as the target landing point to set the return point, so as to realize the shortest path return.
- the target landing point is the flight landing point X
- POP1, P2P3, and P4P5 are longer operating segments
- P1P2 and P3P4 are shorter flight segments.
- the flight segment realizes operations covering the entire land area. Determine the return points R0, R1, R2, etc. on multiple operation segments according to the flight landing point X, and the unmanned operation equipment predicts whether it can reach the next operation segment when it is at or away from the first return point on the operation segment to determine the shortest return path between the return point and the flight landing point X. For example, after continuous judgment, the unmanned operation equipment determines that it can reach the return points R0, R1 and R2, but cannot reach R3, that is, from the return point R2 Return nearby.
- Figure 4 shows the planned path, the take-off point location and the landing point location of the planned path are marked with X off the field.
- the safety point can be a function selected by the operator
- the unmanned operation equipment will go from the take-off point position to the first waypoint of P0P1 and start operation.
- the takeoff point position (equal to the landing point position) is the target landing point.
- the unmanned operation equipment when the unmanned operation equipment flies from P2 to R1, it will continue to fly as it gets closer and closer to the target landing point and return point.
- the unmanned equipment When the unmanned equipment reaches or moves away from R1, it will determine if there is enough energy to reach R2, if so, it will continue to fly; otherwise, it will return to the landing point X from its current position.
- the unmanned operation equipment travels to the following several routes (not shown in the figure), which is similar to the return process of the above-mentioned return point R1, and will not be repeated here.
- step S102 when the unmanned operation equipment is continuously traveling, when the unmanned operation equipment enters the current operation segment, the return point of the current operation segment is determined according to the target landing point of the unmanned operation equipment and Update the return point of the current operation segment to the first return point, and determine the return point of the next operation segment according to the target landing point of the unmanned operation equipment and update the return point of the next operation segment to the second return point home point.
- the steps of continuously updating the first return point of the current operation segment and the second return point of the next operation segment it is continuously judged whether the second return point of the next operation segment can be reached, and the subsequent operation situation is predicted. When reaching the second return point, return directly from the current position.
- This method achieves the shortest return path and saves energy to the greatest extent, avoids the return of the unmanned operation equipment when the operation reaches a long distance, and saves energy so as to reduce the subsequent storage. time and improve work efficiency.
- it is not necessary to continuously judge whether the unmanned operation equipment is in the current operation segment, and it is only necessary to update the first return point and the second return point once when entering the current operation route, so as to realize the optimized judgment method and improve the operation efficiency.
- the unmanned operation equipment When the unmanned operation equipment travels along the planned route, it will update the first return point and the second return point when entering different operation segments.
- the first home point and the second home point should be updated to improve the computing efficiency.
- the unmanned operation equipment When the unmanned operation equipment reaches P4, it will update the first home point from R1 to R2 and the second home point from R2 to R3.
- the unmanned operation equipment reaches P6
- it will update the first and second home points again, update the first home point from R2 to R3, and update the second home point from R3 to R4.
- the target landing point can be set to the landing point (if the flight safety point is not enabled) or the flight safety point point (if activated).
- the path between the flight safety point S and the take-off point/landing point x is a safe path, so that the aircraft can safely enter and exit the field operation area.
- the unmanned operation equipment will fly from the take-off point to the flight safety point before reaching the first waypoint of the path P0P1.
- the unmanned equipment will first reach the flight safety point and then the landing site.
- the target landing point is the flight safety point S.
- the unmanned operation equipment determines the return points R0, R1, R2, etc. with the shortest distances from the operation segment, and returns from the return point to the flight safety point S, and then flies from the flight safety point S.
- the landing point can be the same as the take-off point.
- the above method further includes the following steps:
- the unmanned operation equipment When the unmanned operation equipment operates in a direction close to the first home point, the unmanned operation equipment continues to operate.
- the unmanned operation equipment when the unmanned operation equipment travels in the direction of the first home point on the current operation segment, the unmanned operation equipment will continue to travel because it is getting closer and closer to the home point and the target landing point. close.
- the unmanned equipment When the unmanned equipment is operating at or away from the first home point on the current operating segment, it will determine whether there is still enough energy to reach the next home point. If it is, it will continue to fly; otherwise, it will determine to return and land.
- the unmanned operation equipment in the embodiment of the present application always returns to the landing point from the vicinity of the return point, so that the path is the shortest, so that the battery usage efficiency is the highest, and the operation path does not need to be changed to affect the operation energy consumption and efficiency.
- the home point is determined by the projection of the target landing point to the operation segment or the tangent of the operation segment.
- step S102 includes:
- the first return point on the current operation segment and the second return point on the next operation segment are determined.
- the unmanned operation equipment finds the return point closest to the target landing point on the operation segment according to the type of the operation segment. If the operating segment is a straight segment, the return point closest to the target landing point can be found by finding the projection of the target landing point on the operating segment.
- the return point closer to the target landing point is the endpoints P0 and P3 on the side of the operating segment close to the target landing point or P4, as shown in Figure 5.
- the closest home point can be found by a minimization problem of the distance between the target landing point and the tangent of the curved segment.
- the planned path to which the return-to-home control method provided by the present application can be applied includes straight line segments, curved segments, and various paths composed of two types of straight line segments and curved segments.
- the operation area may include two plots to be operated, and the landing point of the unmanned operation equipment is X.
- the positional relationship is not fixed, and it is necessary to project to the two plots to be operated separately to determine different home points of the two plots to be operated.
- the method in this embodiment of the present application further includes:
- Step 1.1 if the first return point is a point R2 of the current operation segment P5P4, then when reaching the return point R2 of the current operation segment or far away from the return point R2, determine whether the unmanned operation equipment can reach the next operation segment.
- Step 1.2 if the return point R3 of the next operation segment cannot be reached, return to the target landing point x from the current position.
- Step 1.3 if the return point R3 of the next operation segment can be reached, continue the operation to the next operation segment according to the planned path.
- the position closest to the takeoff/landing point is the end point of the operational segment. Therefore, when the unmanned equipment flies towards P4 on P5P4, it will continue to fly as it gets closer and closer to the target landing point. When the unmanned operation equipment reaches P3 or moves away from P3, it will determine whether it can reach P0, if so, it will continue to fly; otherwise, it will return to the landing position from the current position.
- the step of judging that the unmanned operation equipment cannot reach the second home point in step S106 includes:
- Step 2.1 based on the allowable operation time and required operation time of the unmanned operation equipment, determine whether the unmanned operation equipment can reach the second home point.
- the allowable operation time is determined by the operation demand current information, current power information and landing power information of the unmanned operation equipment; the required operation time is determined by the remaining operation distance and operation speed of the unmanned operation equipment.
- the step of judging that the unmanned operation equipment cannot reach the second home point further includes:
- Step 2.2 if the allowable operation time is greater than or equal to the required operation time, it is judged that the unmanned operation equipment can reach the second return point; if the allowable operation time is less than the required operation time, it is judged that the unmanned operation equipment cannot reach the second return point.
- the embodiments of the present application can determine whether the unmanned operation equipment can reach the second return point of the next operation segment, that is, the distance between the current position and the next operation segment to the target landing point and the power information.
- the algorithm is simpler, and it can predict whether it can return to the home in advance, thus ensuring that the return path is shortened and the energy utilization rate is improved.
- the method for judging that the unmanned operation equipment cannot reach the second home point includes:
- Step 3.1) determine the allowable operation time of the unmanned operation equipment based on the operation demand current information, current power information and landing power information of the unmanned operation equipment, and the power information is the remaining battery capacity and/or charging state information.
- the allowable working time is determined by the remaining battery capacity, and the allowable working time allowed by the battery is determined based on the current remaining battery capacity of the battery, the landing battery capacity when reaching the landing site, and the working demand current;
- the minimum allowable operating time is determined based on the remaining battery capacity and state-of-charge information to improve calculation accuracy.
- Step 3.2 according to the remaining operation distance and operation speed of the unmanned operation equipment, determine the required operation time of the unmanned operation equipment, wherein the remaining operation distance includes reaching the destination from the current position of the unmanned operation equipment along the operation segment. the second return point and the distance from the second return point to the target landing point; in one embodiment, the target landing point includes a flight landing point and a flight safety point, and the remaining operating distance includes the distance from the The distance from the current position of the human work equipment to the second home point along the work segment, from the second home point to the flight safety point, and from the flight safety point to the flight landing point.
- the working speed is fitted according to the constant change of working direction, acceleration of working speed and deceleration of working speed.
- Step 3.3 judge whether the unmanned operation equipment can reach the second return point according to the allowable operation time and the required operation time.
- the allowable operation time is greater than or equal to the required operation time, the unmanned operation equipment can reach the second return point. If the operation time is less than the required operation time, it is determined that the unmanned operation equipment cannot reach the second home point.
- the allowable operation time is (40%-20%)*total capacity/operation demand current.
- the step of judging that the unmanned operation equipment cannot reach the second home point further includes:
- Step 2.3) If the battery voltage is lower than the battery voltage threshold, control the unmanned operation equipment to return to the target landing point.
- unmanned equipment can also determine a return-to-home strategy purely based on battery status or voltage. For example, even if the unmanned equipment is flying in the direction of the first home point, as long as the voltage is below a warning threshold, the unmanned equipment will still control the return. This approach facilitates increased safety against abnormal battery conditions (eg, the battery creates a voltage difference between cells).
- the step of returning to the target landing point from the current position includes:
- the unmanned operation equipment is controlled to return to the target landing point from the current position.
- step S102 further includes:
- the current operation segment is the last operation segment of the continuous operation segment, the current operation segment is determined as the next operation segment, and the end point of the current operation segment or the current operation segment is determined.
- the end point of the connected flight segment is the second home point.
- the current operation segment is the last operation segment of the continuous operation segment, when the unmanned operation equipment is at the first return point of the current operation segment or is far away from the first operation segment
- an embodiment of the present application further provides a return-to-home control device, which is applied to unmanned operation equipment.
- the unmanned operation equipment operates along continuous operation segments according to a planned path, so The device includes:
- the determining module 802 is configured to continuously determine the return point of the current operation segment as the first return point and the return point of the next operation segment as the second return point according to the target landing point of the unmanned operation equipment, wherein, The home point is the position with the closest distance to the target landing point on the operation segment;
- the judging module 804 is set to determine that the unmanned operation equipment cannot reach the second return point until the unmanned operation equipment is at the first return point or is operating away from the first return point, and returns from the current position the target landing point.
- the return-to-home control device provided by the embodiment of the present application has the same technical features as the return-to-home control method provided by the above-mentioned embodiment, so it can also solve the same technical problem and achieve the same technical effect.
- the computer program product of the return-to-home control method and device provided by the embodiments of the present application includes a computer-readable storage medium storing program codes, and the instructions included in the program codes can be used to execute the methods described in the foregoing method embodiments to achieve For the process, reference may be made to the method embodiment, which will not be repeated here.
- the functions, if implemented in the form of software functional units and sold or used as independent products, may be stored in a computer-readable storage medium.
- the present application may be embodied in the form of a software product.
- the computer software product is stored in a storage medium, and includes a plurality of instructions for enabling a computer device (which may be a personal computer, a server, or a network device, etc.) to execute the multiple functions of the present application. All or part of the steps of the method described in each example.
- the aforementioned storage medium includes: Universal Serial Bus flash disk (U disk), mobile hard disk, read-only memory (ROM, Read-Only Memory), random access memory (RAM, Random Access Memory) , disk or optical disk and other media that can store program code.
- Embodiments of the present application further provide an electronic device, including a memory, a processor, and a computer program stored in the memory and running on the processor, where the processor implements the return-to-home control method provided by the above embodiments when the computer program is executed.
- Embodiments of the present application further provide a computer-readable storage medium, where a computer program is stored on the computer-readable storage medium, and when the computer program is run by a processor, the return-to-home control method provided by the foregoing embodiment is executed.
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)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Navigation (AREA)
Abstract
A return control method and apparatus, an electronic device, and a storage medium, relating to the technical field of unmanned operations, and applied in an unmanned operation device. An unmanned operation device operates along consecutive operation route segments. The method comprises: continuously and respectively determining a return point of a current operation route segment as a first return point and a return point of the next operation route segment as a second return point according to a target landing point of the unmanned operation device (S102), the return point being a position point on the operation route segment closest to the target landing point; and when the unmanned operation device operates at the first return point or distant from the first return point, and it is determined that the unmanned operation device cannot reach the second return point, returning from the current position to the target landing point (S106).
Description
本申请要求在2020年11月11日提交中国专利局、申请号为202011257408.9的中国专利申请的优先权,该申请的全部内容通过引用结合在本申请中。This application claims the priority of the Chinese Patent Application No. 202011257408.9 filed with the China Patent Office on November 11, 2020, the entire contents of which are incorporated herein by reference.
本申请涉及无人机作业技术领域,例如涉及一种返航控制方法、装置、电子设备和存储介质。The present application relates to the technical field of drone operations, for example, to a return-to-home control method, device, electronic device, and storage medium.
当前如无人机(Unmanned Aerial Vehicle,UAV)的无人控制设备在实际作业生产中广泛应用,以提高作业效率。但类似的无人控制设备在实际应用中,经常由于自身电量不足或出现异常等情况,需要返航到降落点,以便后续作业。At present, unmanned control equipment such as Unmanned Aerial Vehicle (UAV) is widely used in actual production to improve work efficiency. However, in practical applications of similar unmanned control equipment, it is often necessary to return to the landing point for subsequent operations due to insufficient power or abnormality.
然而在返航控制中,一般通过更改飞行作业路径来确定距离降落点最近的返航点,但对于植保作业领域来说,飞行作业路径更改后的无人机无法对固定位置的作物行继续作业,造成作业效率较低的情况。而在保持飞行作业路径不变的前提下,虽然保证了作业效率,但无法确定距离降落点最短路径的返航点,即无法通过最短路径实现无人机返航的目的,使得无人机返航效率低下。However, in the return-to-home control, the return point closest to the landing point is generally determined by changing the flight operation path. However, for the field of plant protection operations, the UAV after the flight operation path is changed cannot continue to operate on the crops in a fixed position, resulting in Low work efficiency. On the premise of keeping the flight operation path unchanged, although the operation efficiency is guaranteed, the return point of the shortest path from the landing point cannot be determined, that is, the purpose of returning the drone cannot be achieved through the shortest path, which makes the return of the drone inefficient. .
发明内容SUMMARY OF THE INVENTION
本申请提供一种返航控制方法、装置、电子设备和存储介质,通过确定原有的规划路径上距离着陆点最近的返航点,并预测无人作业设备能否到达下一作业航段中的返航点,实现缩短返航路径,提高作业效率,避免非作业航段的能源损耗。The present application provides a return-to-home control method, device, electronic device and storage medium. By determining the return-to-home point closest to the landing point on the original planned path, and to predict whether the unmanned operation equipment can reach the return-to-home in the next operation segment point, shorten the return route, improve operational efficiency, and avoid energy loss in non-operational segments.
提供了一种返航控制方法,应用于无人作业设备,所述无人作业设备沿着连续的作业航段作业,所述方法包括:A return-to-home control method is provided, which is applied to unmanned operation equipment, and the unmanned operation equipment operates along continuous operation segments, and the method includes:
持续根据所述无人作业设备的目标着陆点分别确定当前作业航段的返航点为第一返航点、以及下一作业航段的返航点为第二返航点,其中,所述返航点为在所述作业航段上与所述目标着陆点之间距离最近的位置点;Continuously determine the return point of the current operation segment as the first return point and the return point of the next operation segment as the second return point according to the target landing point of the unmanned operation equipment, wherein the return point is at The closest position point on the operating flight segment to the target landing point;
直至在所述无人作业设备处于第一返航点或远离所述第一返航点作业的情况下,在判断所述无人作业设备无法达到所述第二返航点的情况下,从当前位置返回所述目标着陆点。Until the unmanned operation equipment is operating at the first home point or far from the first home point, and when it is judged that the unmanned operation equipment cannot reach the second home point, it returns from the current position. the target landing point.
还提供一种返航控制装置,应用于无人作业设备,所述无人作业设备沿着连续的作业航段作业,所述装置包括:A return-to-home control device is also provided, which is applied to unmanned operation equipment, and the unmanned operation equipment operates along continuous operation segments, and the device includes:
确定模块,设置为持续根据所述无人作业设备的目标着陆点分别确定当前作业航段的返航点为第一返航点、以及下一作业航段的返航点为第二返航点,其中,所述返航点为在所述作业航段上与所述目标着陆点之间距离最近的位置点;The determining module is configured to continuously determine the return point of the current operation segment as the first return point and the return point of the next operation segment as the second return point according to the target landing point of the unmanned operation equipment, wherein all the The return point is the closest position between the operation segment and the target landing point;
判断模块,设置为直至在所述无人作业设备处于第一返航点或远离所述第一返航点作业的情况下,在判断所述无人作业设备无法达到所述第二返航点的情况下,从当前位置返回所述目标着陆点。Judging module, set to until when the unmanned operation equipment is at the first home point or far from the first return point, when it is judged that the unmanned operation equipment cannot reach the second home point , return to the target landing point from the current position.
本申请实施例还提供一种电子设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,处理器执行计算机程序时实现上述实施例提供的返航控制方法。Embodiments of the present application further provide an electronic device, including a memory, a processor, and a computer program stored in the memory and running on the processor. When the processor executes the computer program, the return-to-home control method provided by the above embodiments is implemented.
本申请实施例还提供一种计算机可读存储介质,计算机可读存储介质上存储有计算机程序,计算机程序被处理器运行时执行上述实施例提供的返航控制方法。Embodiments of the present application further provide a computer-readable storage medium, where a computer program is stored on the computer-readable storage medium, and when the computer program is run by a processor, the return-to-home control method provided by the foregoing embodiment is executed.
图1为一种无人作业设备返航的应用示意图;Fig. 1 is a kind of application schematic diagram of unmanned operation equipment returning home;
图2为另一种无人作业设备返航的应用示意图;Fig. 2 is another application schematic diagram of unmanned operation equipment returning home;
图3为本申请实施例提供的一种返航控制方法的流程示意图;3 is a schematic flowchart of a return-to-home control method provided by an embodiment of the present application;
图4为本申请实施例提供的一种返航控制方法的应用示意图;4 is an application schematic diagram of a return-to-home control method provided by an embodiment of the present application;
图5为本申请实施例提供的另一种返航控制方法的应用示意图;FIG. 5 is an application schematic diagram of another return-to-home control method provided by an embodiment of the present application;
图6为本申请实施例提供的又一种返航控制方法的应用示意图;FIG. 6 is an application schematic diagram of another return-to-home control method provided by an embodiment of the present application;
图7位本申请实施例提供的再一种返航控制方法的应用示意图;FIG. 7 is an application schematic diagram of still another return-to-home control method provided by an embodiment of the present application;
图8为本申请实施例提供的一种返航控制装置的功能模块图。FIG. 8 is a functional block diagram of a return-to-home control device provided by an embodiment of the present application.
下面将结合附图对本申请的技术方案进行描述,所描述的实施例是本申请一部分实施例,而不是全部的实施例。The technical solutions of the present application will be described below with reference to the accompanying drawings, and the described embodiments are part of the embodiments of the present application, but not all of the embodiments.
返航控制方法通过改变无人作业设备的飞行作业路径,以使得返航点距离起点(着陆点)较近,通过较短飞行距离到达起点。如图1所示,无人机作业设备前期正常按照规划路径飞行作业,当剩余电量不适宜在当前第一规划路径飞行时,改变无人作业设备的飞行作业路径形成第二规划路径(如图1右侧所示),得到了两个相对距离起点较近的第一返航点和第二返航点,无人作业设备可选择距离起点更近的第一返航点作为返航点,实现返航,但是第一返航点的路径并未覆盖原来地块,后续需要形成多变的飞行路径进行作业,如图1右上侧所示。The return-to-home control method changes the flight operation path of the unmanned operation equipment, so that the return point is closer to the starting point (landing point) and reaches the starting point through a shorter flight distance. As shown in Figure 1, the UAV operating equipment normally flies according to the planned path in the early stage. When the remaining power is not suitable for flying on the current first planned path, the flight operation path of the unmanned operating equipment is changed to form the second planned path (as shown in the figure). 1), and obtained two first and second return points that are relatively close to the starting point. The unmanned operation equipment can choose the first return point that is closer to the starting point as the return point to achieve return, but The path of the first home point does not cover the original plot, and a changeable flight path needs to be formed for subsequent operations, as shown in the upper right side of Figure 1.
此种返航方式,在图1中所示的场景中,即起点在地块左侧,无人机作业设备向右飞行作业,通过在地块未作业区域中规划第二条路径生成一条靠近起点的路径。为了能够确定出向左侧起点靠近的返航点,无人作业设备需要规划出越来越多的弯折段飞行路径,导致飞行作业段越来越短,而转弯段会增加总飞行时长,会大大影响作业效率,同时增加能耗。This way of returning home, in the scenario shown in Figure 1, that is, the starting point is on the left side of the plot, the drone operation equipment flies to the right, and a second path is planned in the unoperated area of the plot to generate a path close to the starting point. path of. In order to determine the return point close to the starting point on the left, the unmanned operation equipment needs to plan more and more flight paths in the bending section, resulting in shorter and shorter flight operation sections, and the turning section will increase the total flight time, which will greatly Affect work efficiency and increase energy consumption at the same time.
另外,由于无人作业设备飞行路径的更改,无法对固定种植在地块中的作物行进行高效作业。如图1所示,在从第一返航点再次启动继续作业时,负载满箱药液的情况下,电池电量充足,却优先选择朝向起点区域的方向进行作业,此时飞行路径与作物行位置不匹配,药液喷洒效率低下的同时会浪费大量的电池电量。In addition, due to the change of the flight path of the unmanned operation equipment, the efficient operation of crop rows that are fixedly planted in the plot cannot be carried out. As shown in Figure 1, when the operation is resumed from the first home point, and the tank is full of chemicals, the battery is sufficient, but the direction toward the starting point is preferred to operate. At this time, the flight path and the position of the crop row are If it does not match, the spraying efficiency of the liquid medicine will be low and a lot of battery power will be wasted.
在此基础上,无人作业设备即使即将返航,也需保留原有的规划路径,原因包括以下两点:(1)考虑到整个地块环境和给定的起飞/着陆位置,规划路径通常是全局优化的结果;(2)一些地块要求规划路径遵循植物行方向/地块几何形状的方向,改变路径方向容易降低作业效果。On this basis, even if the unmanned operation equipment is about to return, it needs to retain the original planned path. The reasons include the following two points: (1) Considering the entire plot environment and the given take-off/landing position, the planned path is usually The result of global optimization; (2) Some plots require the planned path to follow the direction of the plant row direction/plot geometry, and changing the path direction will easily reduce the operation effect.
因此,本申请提供一种无需改变作业路径的返航控制方法,如图2所示,对无人作业设备的电量状态和飞行位置进行监控,当向远离R0点方向飞行(其中R0,R1,R2...是每条作业航段中距离着陆点H最近的点),如飞行到作业航段P0P1的W1点时,检测到电量小于第一电量阈值时,则会直接返航,此时的返航点为W1,返航路径为W1H,由于返航点W1距离着陆点H较远,会造成返航路径非常长的情况(例如W1极端靠近P1点),无法保证无人机按照最短的路径进行返航,即作业能耗效率无法保证最佳。Therefore, the present application provides a return-to-home control method without changing the operation path. As shown in Figure 2, the power status and flight position of the unmanned operation equipment are monitored. When flying away from the point R0 (where R0, R1, R2 ...is the point closest to the landing point H in each operation segment), if the flight reaches the W1 point of the operation segment P0P1, when it is detected that the battery level is less than the first battery level threshold, it will return to the home directly. At this time, the return home The point is W1, and the return path is W1H. Since the return point W1 is far from the landing point H, the return path will be very long (for example, W1 is extremely close to the P1 point), and the drone cannot be guaranteed to return according to the shortest path, that is Operational energy efficiency cannot be guaranteed to be optimal.
基于此,本申请实施例提供的一种返航控制方法、装置、电子设备和存储介质,通过确定原有的规划路径上距离着陆点最近的返航点,并预测无人作业 设备能否到达下一作业航段中的返航点的方法,实现返航路径最短,提高作业效率,避免非作业航段的能源损耗。Based on this, a return-to-home control method, device, electronic device, and storage medium provided by the embodiments of the present application determine the return-home point closest to the landing point on the original planned path, and predict whether the unmanned operation equipment can reach the next home point. The method of returning to the home point in the operation segment can realize the shortest return path, improve the operation efficiency, and avoid the energy loss of the non-operation segment.
为便于对本实施例进行理解,首先对本申请实施例所公开的一种返航控制方法进行介绍。In order to facilitate the understanding of this embodiment, a return-to-home control method disclosed in the embodiment of the present application is first introduced.
图3为本申请实施例提供的一种返航控制方法的流程示意图。FIG. 3 is a schematic flowchart of a return-to-home control method provided by an embodiment of the present application.
该返航控制方法应用于无人作业设备,所述无人作业设备按照规划路径作业,无人作业设备的规划路径包括连续的作业航段,作业航段包括当前作业航段和下一作业航段,当前作业航段和下一作业航段通过飞行航段连接,在作业航段上执行多种作业操作(包括播种、撒药、拍摄和采摘等等),而在飞行航段上实现相邻作业航段的过渡(一般无需作业,但在一些实施例中,也可以进行作业),从而实现覆盖全部地块的作业。故一般来说作业航段与飞行航段相比,作业航段相对较长,可减少转弯等姿态变化航段的路径长度,减少能源损耗,提高作业效率。The return-to-home control method is applied to unmanned operation equipment, the unmanned operation equipment operates according to a planned path, the planned path of the unmanned operation equipment includes continuous operation segments, and the operation segments include the current operation segment and the next operation segment , the current operation segment and the next operation segment are connected by the flight segment, and various operation operations (including sowing, spraying, shooting and picking, etc.) are performed on the operation segment, and the adjacent operation segment is realized on the flight segment. The transition of the operation segment (generally, no operation is required, but in some embodiments, the operation can also be performed), so as to realize the operation covering all the land parcels. Therefore, generally speaking, compared with the flight segment, the operation segment is relatively long, which can reduce the path length of the segment with attitude changes such as turning, reduce energy consumption, and improve operational efficiency.
本实施例的方法参照图3所示,步骤如下:The method of this embodiment is shown with reference to FIG. 3, and the steps are as follows:
步骤S102,持续根据所述无人作业设备的目标着陆点分别确定当前作业航段的返航点为第一返航点、以及下一作业航段的返航点为第二返航点,其中,所述返航点为在所述作业航段上与所述目标着陆点距离最近的位置点。Step S102, continue to respectively determine the return point of the current operation segment as the first return point and the return point of the next operation segment as the second return point according to the target landing point of the unmanned operation equipment, wherein the return point The point is the closest position to the target landing point on the operation segment.
无人作业设备包括无人机和无人车等无人控制设备。目标着陆点为无人作业设备预先根据起飞点、规划路径和实际情况等因素设定的一个用于返航着陆的位置点,即无人作业设备从返航点返航后到达该目标着陆点降落着陆。Unmanned operation equipment includes unmanned control equipment such as drones and unmanned vehicles. The target landing point is a position set by the unmanned operation equipment in advance according to the take-off point, the planned path and the actual situation and other factors for the return landing, that is, the unmanned operation equipment reaches the target landing point to land and land after returning from the return point.
步骤S104,当所述无人作业设备处于所述当前作业航段的第一返航点或远离所述第一返航点作业时,判断无人作业设备是否能够到达所述下一作业航段的第二返航点。Step S104, when the unmanned operation equipment is at the first return point of the current operation segment or is operating away from the first return point, determine whether the unmanned operation equipment can reach the first return point of the next operation segment. Second home point.
步骤S106,直至在所述无人作业设备处于第一返航点或远离所述第一返航点作业时,判断所述无人作业设备无法达到所述第二返航点而从当前位置返回所述目标着陆点。Step S106, until when the unmanned operation equipment is operating at the first home point or far from the first return point, it is determined that the unmanned operation equipment cannot reach the second return point and returns to the target from the current position landing point.
步骤S108,若判断所述无人作业设备能到达所述第二返航点,则继续作业,并返回至步骤S102继续确定返航点。In step S108, if it is determined that the unmanned operation equipment can reach the second home point, the operation is continued, and the process returns to step S102 to continue to determine the home point.
本申请实施例提供了一种返航控制方法,根据目标着陆点确定当前作业航段和下一作业航段上的返航点,其中,该作业航段上的返航点与着陆点之间即为最短返航路径;当到达当前作业航段上的第一返航点或远离第一返航点时,判断无人作业设备是否能够到达下一作业航段的第二返航点,若能到达则继续 按照规划路径作业,若无法达到,则从当前位置返回到着陆点,进而实现返航路径最短,提高作业效率的目的。The embodiment of the present application provides a return-to-home control method, wherein the return point on the current operation segment and the next operation segment is determined according to the target landing point, wherein the shortest distance between the return point on the operation segment and the landing point is Return path; when it reaches the first return point on the current operation segment or is far away from the first return point, judge whether the unmanned operation equipment can reach the second return point of the next operation segment, and if it can reach it, continue to follow the planned path If the operation cannot be achieved, it will return from the current position to the landing point, so as to achieve the shortest return path and improve the operation efficiency.
在实际应用的实施例中,根据目标着陆点确定当前作业航段和下一作业航段上的返航点,其中,该作业航段上的返航点与着陆点之间即为最短返航路径;当到达当前作业航段上的第一返航点或远离第一返航点时,判断无人作业设备是否能够到达下一作业航段的第二返航点,若能到达第二返航点,则继续按照规划路径作业,并继续根据目标着陆点确定返航点,若无法达到第二返航点,则从当前位置返回到目标着陆点,进而实现返航路径最短,提高能效的目的。在一些实施例中,当判断需要返航时处于第一返航点,从第一返航点返回目标着陆点,在其他实施例中,当判断需要返航时已经过第一返航点,则从当前位置返回至目标着陆点,避免返回至第一返航点再返航,节约能耗提高效率。In practical application embodiments, the return point on the current operation segment and the next operation segment is determined according to the target landing point, wherein the shortest return path is between the return point on the operation segment and the landing point; when When it reaches the first return point on the current operating segment or is far away from the first return point, judge whether the unmanned operation equipment can reach the second return point of the next operation segment. If it can reach the second return point, continue to follow the plan. If the second home point cannot be reached, it will return to the target landing point from the current position, so as to achieve the shortest return path and improve energy efficiency. In some embodiments, when it is determined that it is necessary to return home, it is at the first return point, and returns to the target landing point from the first return point. To the target landing point, avoid returning to the first home point and then returning, saving energy and improving efficiency.
在一些实施例中,所述目标着陆点包括飞行着陆点和飞行安全点,其中,所述无人作业设备经过所述飞行安全点到达所述飞行着陆点,通过所述飞行安全点确定所述返航点。安全点是达到着陆点之前必须经过的位置点,安全点与着陆点之间的路径为安全路径,没有障碍物,设置安全点可提高飞行的安全性,避免撞击障碍物。此时,将安全点作为目标着陆点以设置返航点,从而实现最短路径的返航。In some embodiments, the target landing point includes a flight landing point and a flight safety point, wherein the unmanned operation equipment passes through the flight safety point to reach the flight landing point, and the flight safety point is used to determine the flight landing point. home point. The safety point is the point that must be passed before reaching the landing point. The path between the safety point and the landing point is a safe path without obstacles. Setting the safety point can improve the safety of flight and avoid hitting obstacles. At this time, take the safety point as the target landing point to set the return point, so as to realize the shortest path return.
作为一种实施例,如图4所示,目标着陆点为飞行着陆点X,P0P1、P2P3、P4P5为较长的作业航段,P1P2、P3P4为较短的飞行航段,通过规划相邻的航段实现覆盖整体地块的作业。根据飞行着陆点X确定多个作业航段上的返航点R0、R1和R2等等,无人作业设备在处于或远离作业航段上的第一返航点时预测是否能够到达下一作业航段的返航点,从而确定返航点到飞行着陆点X之间的最短返航路径,例如无人作业设备经过不断判断,确定能够到达返航点R0、R1和R2,但不能到达R3,即从返航点R2附近返航。As an example, as shown in FIG. 4 , the target landing point is the flight landing point X, POP1, P2P3, and P4P5 are longer operating segments, and P1P2 and P3P4 are shorter flight segments. The flight segment realizes operations covering the entire land area. Determine the return points R0, R1, R2, etc. on multiple operation segments according to the flight landing point X, and the unmanned operation equipment predicts whether it can reach the next operation segment when it is at or away from the first return point on the operation segment to determine the shortest return path between the return point and the flight landing point X. For example, after continuous judgment, the unmanned operation equipment determines that it can reach the return points R0, R1 and R2, but cannot reach R3, that is, from the return point R2 Return nearby.
图4显示了规划路径,规划路径的起飞点位置和着陆点位置在场外均标记为X。当没有安全点时(安全点可以是操作员选择的功能),无人作业设备将从起飞点位置转到P0P1的第一个航点并开始操作。同样,当在第一返航点或远离第一返航点判断需要返回时,直接从当前位置进入起飞点位置。因此,起飞点位置(等于着陆点位置)是目标着陆点。当无人作业设备进入作业航段P2P3时,更新当前作业航段上的第一返航点是R1,下一个作业航段P4P5上的第二返航点是R2。此时无人作业设备从P2飞向R1时,由于它越来越接近目标着陆点以及返航点,它将继续飞行。当无人作业设备到达R1或远离R1时,它将确定是否有足够的能源达到R2,如果是,它将继续飞行;否则,它将从当前位置返回到着陆点X。Figure 4 shows the planned path, the take-off point location and the landing point location of the planned path are marked with X off the field. When there is no safety point (the safety point can be a function selected by the operator), the unmanned operation equipment will go from the take-off point position to the first waypoint of P0P1 and start operation. Similarly, when it is determined that it is necessary to return at the first home point or away from the first home point, directly enter the take-off point position from the current position. Therefore, the takeoff point position (equal to the landing point position) is the target landing point. When the unmanned operation equipment enters the operation segment P2P3, the first return point on the current operation segment is updated to be R1, and the second return point on the next operation segment P4P5 is R2. At this time, when the unmanned operation equipment flies from P2 to R1, it will continue to fly as it gets closer and closer to the target landing point and return point. When the unmanned equipment reaches or moves away from R1, it will determine if there is enough energy to reach R2, if so, it will continue to fly; otherwise, it will return to the landing point X from its current position.
无人作业设备行进到后面几条航线(图中未示出)与上述返航点R1返回过程类似,在此不再赘述。The unmanned operation equipment travels to the following several routes (not shown in the figure), which is similar to the return process of the above-mentioned return point R1, and will not be repeated here.
在步骤S102中,当无人作业设备在不断行进过程中,当所述无人作业设备进入当前作业航段时,根据所述无人作业设备的目标着陆点确定当前作业航段的返航点并将当前作业航段的返航点更新为第一返航点,并根据所述无人作业设备的目标着陆点确定下一作业航段的返航点并将下一作业航段的返航点更新为第二返航点。通过不断更新当前作业航段的第一返航点、以及下一作业航段的第二返航点的步骤,持续判断能否达到下一作业航段的第二返航点,预测后续作业情况,如果无法达到第二返航点,则直接从当前位置返航,通过该方法实现最短返航路径和最大程度节约能耗,避免无人作业设备在作业到较远距离时返航,节约的能耗以便减小后续蓄能时间,提高作业效率。此处,无需持续判断无人作业设备是否处于当前作业航段,仅需在进入当前作业航线时,更新一次第一返航点和第二返航点即可,实现优化判断方法,提高作业效率。In step S102, when the unmanned operation equipment is continuously traveling, when the unmanned operation equipment enters the current operation segment, the return point of the current operation segment is determined according to the target landing point of the unmanned operation equipment and Update the return point of the current operation segment to the first return point, and determine the return point of the next operation segment according to the target landing point of the unmanned operation equipment and update the return point of the next operation segment to the second return point home point. Through the steps of continuously updating the first return point of the current operation segment and the second return point of the next operation segment, it is continuously judged whether the second return point of the next operation segment can be reached, and the subsequent operation situation is predicted. When reaching the second return point, return directly from the current position. This method achieves the shortest return path and saves energy to the greatest extent, avoids the return of the unmanned operation equipment when the operation reaches a long distance, and saves energy so as to reduce the subsequent storage. time and improve work efficiency. Here, it is not necessary to continuously judge whether the unmanned operation equipment is in the current operation segment, and it is only necessary to update the first return point and the second return point once when entering the current operation route, so as to realize the optimized judgment method and improve the operation efficiency.
当无人作业设备沿着规划路线行驶时,它将在进入不同的作业航段时更新第一返航点和第二返航点。在一种实施例中,如图4所示,飞行器在到达P0,P2和P4等时应更新第一返航点和第二返航点,以提高运算效率。当无人作业设备到达P4时,它将把第一返航点从R1更新为R2,将第二返航点从R2更新为R3。同样,当无人作业设备到达P6时,它将再次更新第一返航点和第二返航点,将第一返航点从R2更新为R3,将第二返航点从R3更新为R4。When the unmanned operation equipment travels along the planned route, it will update the first return point and the second return point when entering different operation segments. In an embodiment, as shown in FIG. 4 , when the aircraft reaches P0, P2 and P4, etc., the first home point and the second home point should be updated to improve the computing efficiency. When the unmanned operation equipment reaches P4, it will update the first home point from R1 to R2 and the second home point from R2 to R3. Similarly, when the unmanned operation equipment reaches P6, it will update the first and second home points again, update the first home point from R2 to R3, and update the second home point from R3 to R4.
一旦无人作业设备具有飞行的规划路径,着陆点(默认与起飞点相同)和飞行安全点(如果启用),则可以将目标着陆点设置为着陆点(如果飞行安全点未启用)或飞行安全点(如果已激活)。作为一种实施例,如图6所示,飞行安全点S和起飞点/着陆点x之间的路径为安全路径,以使飞行器安全地进入和退出地块操作区域。换句话说,无人作业设备在到达路径P0P1的第一个航点之前会从起飞点飞行到飞行安全点。类似地,当返回到着陆点时,无人作业设备会先到达飞行安全点,然后再到达着陆点。在这种情况下,目标着陆点为飞行安全点S。无人作业设备基于该飞行安全点S确定与作业航段之间距离最短的返航点R0、R1和R2等等,并从返航点返回到该飞行安全点S,再从该飞行安全点S飞到无人作业设备的起飞点/着陆点x(着陆点可以与起飞点相同)。Once the drone has a planned path to fly, the landing point (same as the takeoff point by default) and the flight safety point (if enabled), the target landing point can be set to the landing point (if the flight safety point is not enabled) or the flight safety point point (if activated). As an example, as shown in FIG. 6 , the path between the flight safety point S and the take-off point/landing point x is a safe path, so that the aircraft can safely enter and exit the field operation area. In other words, the unmanned operation equipment will fly from the take-off point to the flight safety point before reaching the first waypoint of the path P0P1. Similarly, when returning to the landing site, the unmanned equipment will first reach the flight safety point and then the landing site. In this case, the target landing point is the flight safety point S. Based on the flight safety point S, the unmanned operation equipment determines the return points R0, R1, R2, etc. with the shortest distances from the operation segment, and returns from the return point to the flight safety point S, and then flies from the flight safety point S. To the take-off point/landing point x of the unmanned operation equipment (the landing point can be the same as the take-off point).
在一些实施例中,上述方法还包括以下步骤:In some embodiments, the above method further includes the following steps:
当所述无人作业设备沿靠近所述第一返航点的方向作业时,则所述无人作业设备继续作业。When the unmanned operation equipment operates in a direction close to the first home point, the unmanned operation equipment continues to operate.
作为一种可选的实施例,当无人作业设备朝着当前作业航段上的第一返航点方向行进时,无人作业设备将继续行进,因为它离返航点以及目标着陆点越 来越近。当无人作业设备处于或远离当前作业航段上的第一返航点作业时,它将确定是否仍有足够的能源到达下一个返航点。如果是,它将继续飞行;否则,它将确定返回并降落。为保证返航路径始终是最短,本申请实施例无人作业设备始终从返航点附近返回着陆点位置,使路径最短,从而使电池使用效率最高,同时无需更改作业路径以影响作业能耗和效率。As an optional embodiment, when the unmanned operation equipment travels in the direction of the first home point on the current operation segment, the unmanned operation equipment will continue to travel because it is getting closer and closer to the home point and the target landing point. close. When the unmanned equipment is operating at or away from the first home point on the current operating segment, it will determine whether there is still enough energy to reach the next home point. If it is, it will continue to fly; otherwise, it will determine to return and land. In order to ensure that the return path is always the shortest, the unmanned operation equipment in the embodiment of the present application always returns to the landing point from the vicinity of the return point, so that the path is the shortest, so that the battery usage efficiency is the highest, and the operation path does not need to be changed to affect the operation energy consumption and efficiency.
所述返航点通过所述目标着陆点到作业航段或作业航段切线的投影确定。The home point is determined by the projection of the target landing point to the operation segment or the tangent of the operation segment.
在一些实施例中,步骤S102,包括:In some embodiments, step S102 includes:
通过所述目标着陆点到所述作业航段或所述作业航段切线的投影,确定所述当前作业航段上的第一返航点和下一作业航段上的第二返航点。Through the projection of the target landing point to the operation segment or the tangent of the operation segment, the first return point on the current operation segment and the second return point on the next operation segment are determined.
无人作业设备根据作业航段的类型找到作业航段上最接近目标着陆点的返航点。如果作业航段是直线航段,则可以通过找到目标着陆点在作业航段上的投影来找到最接近目标着陆点的返航点。The unmanned operation equipment finds the return point closest to the target landing point on the operation segment according to the type of the operation segment. If the operating segment is a straight segment, the return point closest to the target landing point can be found by finding the projection of the target landing point on the operating segment.
作为一种可选的实施例,如果目标着陆点向作业航段的投影方向与作业航段平行,则更接近目标着陆点的返航点是作业航段靠近目标着陆点一侧的端点P0、P3或P4,如图5所示。如果作业航段是曲线段,则可以通过目标着陆点和曲线段的切线之间的距离的最小化问题来找到最接近的返航点。As an optional embodiment, if the projection direction of the target landing point to the operating segment is parallel to the operating segment, the return point closer to the target landing point is the endpoints P0 and P3 on the side of the operating segment close to the target landing point or P4, as shown in Figure 5. If the operating segment is a curved segment, the closest home point can be found by a minimization problem of the distance between the target landing point and the tangent of the curved segment.
因此,本申请提供的返航控制方法可以适用于的规划路径包括直线段、曲线段以及直线段和曲线段两种类型组成的多种路径。Therefore, the planned path to which the return-to-home control method provided by the present application can be applied includes straight line segments, curved segments, and various paths composed of two types of straight line segments and curved segments.
作为一种可选的实施例,如图7所示,作业区域可能包括两个待作业地块,无人作业设备的着陆点为X,在实际应用过程中,由于两个待作业地块的位置关系不固定,需要向两个待作业地块分别投影,以确定两个待作业地块不同的返航点。As an optional embodiment, as shown in Fig. 7, the operation area may include two plots to be operated, and the landing point of the unmanned operation equipment is X. In the actual application process, due to the difference between the two plots to be operated The positional relationship is not fixed, and it is necessary to project to the two plots to be operated separately to determine different home points of the two plots to be operated.
在一些实施例中,以图6为例,本申请实施例中方法还包括:In some embodiments, taking FIG. 6 as an example, the method in this embodiment of the present application further includes:
步骤1.1),若第一返航点为当前作业航段P5P4的一点R2,则当到达当前作业航段的返航点R2或远离该返航点R2时,判断无人作业设备是否能够到达下一作业航段的返航点R3。Step 1.1), if the first return point is a point R2 of the current operation segment P5P4, then when reaching the return point R2 of the current operation segment or far away from the return point R2, determine whether the unmanned operation equipment can reach the next operation segment. The segment's home point R3.
步骤1.2),若不能到达下一作业航段的返航点R3,则从当前位置返回所述目标着陆点x。Step 1.2), if the return point R3 of the next operation segment cannot be reached, return to the target landing point x from the current position.
步骤1.3),若能到达下一作业航段的返航点R3,则按照规划路径继续作业至下一作业航段。Step 1.3), if the return point R3 of the next operation segment can be reached, continue the operation to the next operation segment according to the planned path.
参照图5,其中最接近起飞点/着陆点的位置是作业航段的端点。因此,当无人作业设备在P5P4上朝P4飞行时,由于它越来越接近目标着陆点,它将继 续飞行。当无人作业设备到达P3或远离P3时,它将确定是否可以到达P0,如果是,它将继续飞行;否则,它将从当前位置返回到着陆位置。Referring to Figure 5, the position closest to the takeoff/landing point is the end point of the operational segment. Therefore, when the unmanned equipment flies towards P4 on P5P4, it will continue to fly as it gets closer and closer to the target landing point. When the unmanned operation equipment reaches P3 or moves away from P3, it will determine whether it can reach P0, if so, it will continue to fly; otherwise, it will return to the landing position from the current position.
步骤S106中判断无人作业设备无法达到所述第二返航点的步骤,包括:The step of judging that the unmanned operation equipment cannot reach the second home point in step S106 includes:
步骤2.1),基于所述无人作业设备的允许作业时间和需求作业时间判断无人作业设备是否能够到达所述第二返航点。Step 2.1), based on the allowable operation time and required operation time of the unmanned operation equipment, determine whether the unmanned operation equipment can reach the second home point.
允许作业时间通过所述无人作业设备的作业需求电流信息、当前电量信息和着陆电量信息确定;需求作业时间通过所述无人作业设备的剩余作业距离和作业速度确定。The allowable operation time is determined by the operation demand current information, current power information and landing power information of the unmanned operation equipment; the required operation time is determined by the remaining operation distance and operation speed of the unmanned operation equipment.
判断无人作业设备无法达到所述第二返航点的步骤还包括:The step of judging that the unmanned operation equipment cannot reach the second home point further includes:
步骤2.2),若允许作业时间大于或等于需求作业时间,则判断无人作业设备能达到第二返航点,若允许作业时间小于需求作业时间,则判断无人作业设备无法达到第二返航点。Step 2.2), if the allowable operation time is greater than or equal to the required operation time, it is judged that the unmanned operation equipment can reach the second return point; if the allowable operation time is less than the required operation time, it is judged that the unmanned operation equipment cannot reach the second return point.
在一些实施例中,本申请实施例可通过当前位置至下一作业航段到目标着陆点之间路程以及电量信息,判断无人作业设备是否能够达到下一作业航段的第二返航点即可,在继续作业的过程中,无需实时检测无人作业设备的状态数据如返航电量,算法更加简单,能够提前预测是否能返航,从而确保缩短返航路径,提高了能源利用率。In some embodiments, the embodiments of the present application can determine whether the unmanned operation equipment can reach the second return point of the next operation segment, that is, the distance between the current position and the next operation segment to the target landing point and the power information. However, in the process of continuing the operation, there is no need to detect the status data of the unmanned operation equipment in real time, such as the return power, the algorithm is simpler, and it can predict whether it can return to the home in advance, thus ensuring that the return path is shortened and the energy utilization rate is improved.
在一些实施例中,判断无人作业设备无法达到所述第二返航点的方法包括:In some embodiments, the method for judging that the unmanned operation equipment cannot reach the second home point includes:
步骤3.1),基于所述无人作业设备的作业需求电流信息、当前电量信息和着陆电量信息,确定无人作业设备的允许作业时间,电量信息为剩余电池容量和/或充电状态信息。Step 3.1), determine the allowable operation time of the unmanned operation equipment based on the operation demand current information, current power information and landing power information of the unmanned operation equipment, and the power information is the remaining battery capacity and/or charging state information.
一种实施例中,通过剩余电池容量确定允许作业时间,基于电池的当前剩余电池容量,以及到达着陆点位置时的着陆电池容量以及作业需求电流来确定电池允许的允许作业时间;或者,可以使用电池的当前充电状态信息和到达目标着陆点时的着陆充电状态信息,以及作业需求电流来确定允许作业时间,例如:允许作业时间=(当前充电状态信息-着陆充电状态信息)/作业需求电流;或者,同时基于剩余电池容量和充电状态信息,来确定最小允许作业时间,以提高计算准确性。In one embodiment, the allowable working time is determined by the remaining battery capacity, and the allowable working time allowed by the battery is determined based on the current remaining battery capacity of the battery, the landing battery capacity when reaching the landing site, and the working demand current; The current state of charge information of the battery, the information of the state of charge of the landing when reaching the target landing point, and the operation demand current are used to determine the allowable operation time, for example: allowable operation time = (current state of charge information - information of the state of charge of the landing) / operation demand current; Alternatively, the minimum allowable operating time is determined based on the remaining battery capacity and state-of-charge information to improve calculation accuracy.
步骤3.2),根据无人作业设备的剩余作业距离和作业速度,确定无人作业设备的需求作业时间,其中,剩余作业距离包括从所述无人作业设备的当前位置沿着作业航段到达所述第二返航点并从所述第二返航点到达所述目标着陆点的距离;在一种实施例中,目标着陆点包括飞行着陆点和飞行安全点,则剩余作业距离包括从所述无人作业设备的当前位置沿着作业航段到达所述第二返航 点,从所述第二返航点到达飞行安全点,并从飞行安全点到达飞行着陆点的距离。Step 3.2), according to the remaining operation distance and operation speed of the unmanned operation equipment, determine the required operation time of the unmanned operation equipment, wherein the remaining operation distance includes reaching the destination from the current position of the unmanned operation equipment along the operation segment. the second return point and the distance from the second return point to the target landing point; in one embodiment, the target landing point includes a flight landing point and a flight safety point, and the remaining operating distance includes the distance from the The distance from the current position of the human work equipment to the second home point along the work segment, from the second home point to the flight safety point, and from the flight safety point to the flight landing point.
作业速度根据作业方向的不断改变、作业速度的加速和作业速度的减速进行拟合。The working speed is fitted according to the constant change of working direction, acceleration of working speed and deceleration of working speed.
步骤3.3),根据允许作业时间与需求作业时间判断无人作业设备是否能够达到第二返航点,当允许作业时间大于或等于需求作业时间,则无人作业设备可以达到第二返航点,若允许作业时间小于需求作业时间,则判断无人作业设备无法到达第二返航点。Step 3.3), judge whether the unmanned operation equipment can reach the second return point according to the allowable operation time and the required operation time. When the allowable operation time is greater than or equal to the required operation time, the unmanned operation equipment can reach the second return point. If the operation time is less than the required operation time, it is determined that the unmanned operation equipment cannot reach the second home point.
例如,如果到达目标着陆点时的着陆充电状态信息为20%,而当前充电状态信息为40%。允许作业时间为(40%-20%)*总容量/作业需求电流。给定20Ah电池且作业需求电流为100A,允许作业时间为:20%*20/100小时=0.04小时=2.4分钟=144秒。可以根据从当前无人作业设备沿着规划路径在作业航段和飞行航段各自的作业速度、当前无人作业设备位置和目标着陆点位置,以及规划路径,计算出到达第二返航点以及从第二返航点到达目标着陆点所需的需求作业时间。如果需求作业时间少于144秒,则可以达到第二返航点;否则,将无法达到第二返航点。For example, if the landing state of charge information when reaching the target landing point is 20%, and the current state of charge information is 40%. The allowable operation time is (40%-20%)*total capacity/operation demand current. Given a 20Ah battery and a working demand current of 100A, the allowable working time is: 20%*20/100 hours=0.04 hours=2.4 minutes=144 seconds. According to the operation speed of the current unmanned operation equipment along the planned path in the operation segment and the flight segment, the current position of the unmanned operation equipment and the target landing point position, and the planned path, it can be calculated to reach the second home point and from The required operation time required for the second home point to reach the target landing point. If the required operation time is less than 144 seconds, the second home point can be reached; otherwise, the second home point cannot be reached.
在一些实施例中,判断无人作业设备无法达到所述第二返航点的步骤,还包括:In some embodiments, the step of judging that the unmanned operation equipment cannot reach the second home point further includes:
步骤2.3)若电池电压低于电池电压阈值,则控制所述无人作业设备返回到所述目标着陆点。Step 2.3) If the battery voltage is lower than the battery voltage threshold, control the unmanned operation equipment to return to the target landing point.
除了前述基于电量的返航决策外,无人作业设备还可以纯粹基于电池状态或电压来确定返航策略。例如,即使无人作业设备朝第一返航点方向飞行,只要电压低于一个警告阈值,无人作业设备仍将控制返回。该方法有利于增加安全性以应对异常电池情况(例如电池在电池单元之间产生电压差)。In addition to the aforementioned power-based return-to-home decision, unmanned equipment can also determine a return-to-home strategy purely based on battery status or voltage. For example, even if the unmanned equipment is flying in the direction of the first home point, as long as the voltage is below a warning threshold, the unmanned equipment will still control the return. This approach facilitates increased safety against abnormal battery conditions (eg, the battery creates a voltage difference between cells).
在一些实施例中,从当前位置返回所述目标着陆点的步骤,包括:In some embodiments, the step of returning to the target landing point from the current position includes:
按照当前位置与所述目标着陆点之间的最短路径,控制所述无人作业设备从当前位置返回所述目标着陆点。According to the shortest path between the current position and the target landing point, the unmanned operation equipment is controlled to return to the target landing point from the current position.
在一些实施例中,步骤S102还包括:In some embodiments, step S102 further includes:
若当前作业航段为连续的作业航段的最后一个作业航段,则将当前作业航段确定为所述下一作业航段,确定当前作业航段的终点或与所述当前作业航段相连接的飞行航段的终点为第二返航点。If the current operation segment is the last operation segment of the continuous operation segment, the current operation segment is determined as the next operation segment, and the end point of the current operation segment or the current operation segment is determined. The end point of the connected flight segment is the second home point.
在一些实施例中,若当前作业航段为所述连续的作业航段最后一个作业航段,当所述无人作业设备处于所述当前作业航段的第一返航点或远离所述第一返航点作业时,判断无人作业设备是否能够到达当前作业航段的终点或与所述当前作业航段相连接的飞行航段的终点;若能到达,则从所述终点返回所述目标着陆点;若不能到达,则从当前位置返回所述目标着陆点。In some embodiments, if the current operation segment is the last operation segment of the continuous operation segment, when the unmanned operation equipment is at the first return point of the current operation segment or is far away from the first operation segment When operating at the home point, determine whether the unmanned operation equipment can reach the end point of the current operation segment or the end point of the flight segment connected to the current operation segment; if it can be reached, return to the target landing from the end point If it cannot be reached, return to the target landing point from the current position.
以图4为例,如果当前作业航段P4P5是最后一个作业航段,则R3不存在,则此时下一作业航段仍旧为P4P5,确定第二返航点为P5,判断无人作业设备是否可以到达当前作业航段的终点P5。若无法完整完成作业任务,则通过当前位置确定最短返航路径以返回目标着陆点。Taking Figure 4 as an example, if the current operation segment P4P5 is the last operation segment, then R3 does not exist, then the next operation segment is still P4P5, and the second return point is determined to be P5, and it is determined whether the unmanned operation equipment can be used. Reach the end point P5 of the current operation segment. If the operation task cannot be completed completely, the shortest return route is determined by the current position to return to the target landing point.
在一些实施例中,如图8所示,本申请实施例还提供一种返航控制装置,应用于无人作业设备,所述无人作业设备按照规划路径沿着连续的作业航段作业,所述装置包括:In some embodiments, as shown in FIG. 8 , an embodiment of the present application further provides a return-to-home control device, which is applied to unmanned operation equipment. The unmanned operation equipment operates along continuous operation segments according to a planned path, so The device includes:
确定模块802,设置为持续根据所述无人作业设备的目标着陆点分别确定当前作业航段的返航点为第一返航点、以及下一作业航段的返航点为第二返航点,其中,所述返航点为在所述作业航段上与所述目标着陆点之间距离最近的位置点;The determining module 802 is configured to continuously determine the return point of the current operation segment as the first return point and the return point of the next operation segment as the second return point according to the target landing point of the unmanned operation equipment, wherein, The home point is the position with the closest distance to the target landing point on the operation segment;
判断模块804,设置为直至在所述无人作业设备处于第一返航点或远离所述第一返航点作业时,判断所述无人作业设备无法达到所述第二返航点,从当前位置返回所述目标着陆点。The judging module 804 is set to determine that the unmanned operation equipment cannot reach the second return point until the unmanned operation equipment is at the first return point or is operating away from the first return point, and returns from the current position the target landing point.
本申请实施例提供的返航控制装置,与上述实施例提供的返航控制方法具有相同的技术特征,所以也能解决相同的技术问题,达到相同的技术效果。The return-to-home control device provided by the embodiment of the present application has the same technical features as the return-to-home control method provided by the above-mentioned embodiment, so it can also solve the same technical problem and achieve the same technical effect.
本申请实施例所提供的返航控制方法和装置的计算机程序产品,包括存储了程序代码的计算机可读存储介质,所述程序代码包括的指令可用于执行前面方法实施例中所述的方法,实现过程可参见方法实施例,在此不再赘述。The computer program product of the return-to-home control method and device provided by the embodiments of the present application includes a computer-readable storage medium storing program codes, and the instructions included in the program codes can be used to execute the methods described in the foregoing method embodiments to achieve For the process, reference may be made to the method embodiment, which will not be repeated here.
上述描述的系统和装置的工作过程,可以参考前述方法实施例中的对应过程,在此不再赘述。For the working process of the system and apparatus described above, reference may be made to the corresponding process in the foregoing method embodiments, and details are not described herein again.
所述功能如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。本申请可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括多个指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本申请多个实施例所述方法的全部或部分步骤。而前述的存储介质包括:通用串行总线闪存盘(Universal Serial Bus flash disk,U盘)、移动硬盘、只读存储器(ROM, Read-Only Memory)、随机存取存储器(RAM,Random Access Memory)、磁碟或者光盘等多种可以存储程序代码的介质。The functions, if implemented in the form of software functional units and sold or used as independent products, may be stored in a computer-readable storage medium. The present application may be embodied in the form of a software product. The computer software product is stored in a storage medium, and includes a plurality of instructions for enabling a computer device (which may be a personal computer, a server, or a network device, etc.) to execute the multiple functions of the present application. All or part of the steps of the method described in each example. The aforementioned storage medium includes: Universal Serial Bus flash disk (U disk), mobile hard disk, read-only memory (ROM, Read-Only Memory), random access memory (RAM, Random Access Memory) , disk or optical disk and other media that can store program code.
本申请实施例还提供一种电子设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,处理器执行计算机程序时实现上述实施例提供的返航控制方法。Embodiments of the present application further provide an electronic device, including a memory, a processor, and a computer program stored in the memory and running on the processor, where the processor implements the return-to-home control method provided by the above embodiments when the computer program is executed.
本申请实施例还提供一种计算机可读存储介质,计算机可读存储介质上存储有计算机程序,计算机程序被处理器运行时执行上述实施例提供的返航控制方法。Embodiments of the present application further provide a computer-readable storage medium, where a computer program is stored on the computer-readable storage medium, and when the computer program is run by a processor, the return-to-home control method provided by the foregoing embodiment is executed.
Claims (13)
- 一种返航控制方法,应用于无人作业设备,所述无人作业设备沿着连续的作业航段作业,所述方法包括:A return-to-home control method is applied to unmanned operation equipment, the unmanned operation equipment operates along continuous operation segments, and the method includes:持续根据所述无人作业设备的目标着陆点分别确定当前作业航段的返航点为第一返航点、以及下一作业航段的返航点为第二返航点,其中,所述返航点为在所述作业航段上与所述目标着陆点之间距离最近的位置点;Continuously determine the return point of the current operation segment as the first return point and the return point of the next operation segment as the second return point according to the target landing point of the unmanned operation equipment, wherein the return point is at The closest position point on the operating flight segment to the target landing point;直至在所述无人作业设备处于所述第一返航点或远离所述第一返航点作业的情况下,在判断所述无人作业设备无法达到所述第二返航点的情况下,从当前位置返回所述目标着陆点。Until the unmanned operation equipment is operating at the first home point or far away from the first home point, when it is judged that the unmanned operation equipment cannot reach the second return point, from the current The position returns to the target landing point.
- 根据权利要求1所述的返航控制方法,其中,所述持续根据所述无人作业设备的目标着陆点分别确定当前作业航段的返航点为第一返航点、以及下一作业航段的返航点为第二返航点,包括:The return-to-home control method according to claim 1, wherein the continuous determination of the return-to-home point of the current operation segment as the first return-to-home point and the return-to-home of the next operation segment according to the target landing point of the unmanned operation equipment respectively point is the second home point, including:在所述无人作业设备进入所述当前作业航段时,根据所述无人作业设备的目标着陆点确定所述当前作业航段的返航点并将所述当前作业航段的返航点更新为第一返航点,并根据所述无人作业设备的目标着陆点确定所述下一作业航段的返航点并将所述下一作业航段的返航点更新为第二返航点。When the unmanned operation equipment enters the current operation segment, the return point of the current operation segment is determined according to the target landing point of the unmanned operation equipment and the return point of the current operation segment is updated as The first return point is determined, and the return point of the next operation segment is determined according to the target landing point of the unmanned operation equipment, and the return point of the next operation segment is updated to the second return point.
- 根据权利要求1所述的返航控制方法,还包括:在所述无人作业设备沿靠近所述第一返航点的方向作业的情况下,所述无人作业设备继续作业。The return-to-home control method according to claim 1, further comprising: when the unmanned operation equipment operates in a direction close to the first return point, the unmanned operation equipment continues to operate.
- 根据权利要求1所述的返航控制方法,其中,所述判断所述无人作业设备无法达到所述第二返航点,包括:The return-to-home control method according to claim 1, wherein the judging that the unmanned operation equipment cannot reach the second return-to-home point comprises:基于所述无人作业设备的允许作业时间和需求作业时间判断所述无人作业设备是否能够到达所述第二返航点;Determine whether the unmanned operation equipment can reach the second return point based on the allowable operation time and the required operation time of the unmanned operation equipment;其中,所述允许作业时间通过所述无人作业设备的作业需求电流信息、当前电量信息和着陆电量信息确定;所述需求作业时间通过所述无人作业设备的剩余作业距离和作业速度确定,所述剩余作业距离包括从所述无人作业设备的当前位置沿着作业航段到达所述第二返航点并从所述第二返航点到达所述目标着陆点的距离。Wherein, the allowable operation time is determined by the operation demand current information, current power information and landing power information of the unmanned operation equipment; the required operation time is determined by the remaining operation distance and operation speed of the unmanned operation equipment, The remaining operating distance includes the distance from the current position of the unmanned operation equipment to the second home point along the operating segment and from the second home point to the target landing point.
- 根据权利要求4所述的返航控制方法,其中,所述判断所述无人作业设备无法达到所述第二返航点,还包括:The return-to-home control method according to claim 4, wherein the judging that the unmanned operation equipment cannot reach the second return-to-home point further comprises:在所述允许作业时间大于或等于所述需求作业时间的情况下,判断所述无人作业设备能达到所述第二返航点,在所述允许作业时间小于所述需求作业时间的情况下,判断所述无人作业设备无法达到所述第二返航点。In the case that the allowable operation time is greater than or equal to the required operation time, it is determined that the unmanned operation equipment can reach the second return point, and in the case that the allowable operation time is less than the required operation time, It is determined that the unmanned operation equipment cannot reach the second return point.
- 根据权利要求4所述的返航控制方法,其中,所述判断所述无人作业设备无法达到所述第二返航点,还包括:The return-to-home control method according to claim 4, wherein the judging that the unmanned operation equipment cannot reach the second return-to-home point further comprises:在电池电压低于电池电压阈值的情况下,控制所述无人作业设备返回到所述目标着陆点。When the battery voltage is lower than the battery voltage threshold, the unmanned operation equipment is controlled to return to the target landing site.
- 根据权利要求1所述的返航控制方法,其中,所述从当前位置返回所述目标着陆点,包括:The return-to-home control method according to claim 1, wherein the returning from the current position to the target landing point comprises:按照所述当前位置与所述目标着陆点之间的最短路径,控制所述无人作业设备从所述当前位置返回所述目标着陆点。According to the shortest path between the current position and the target landing point, the unmanned operation equipment is controlled to return to the target landing point from the current position.
- 根据权利要求1所述的返航控制方法,其中,所述持续根据所述无人作业设备的目标着陆点分别确定当前作业航段的返航点为第一返航点、以及下一作业航段的返航点为第二返航点,包括:The return-to-home control method according to claim 1, wherein the continuous determination of the return-to-home point of the current operation segment as the first return-to-home point and the return-to-home of the next operation segment according to the target landing point of the unmanned operation equipment respectively point is the second home point, including:在所述当前作业航段为所述连续的作业航段的最后一个作业航段的情况下,将所述当前作业航段确定为所述下一作业航段,确定所述当前作业航段的终点或与所述当前作业航段相连接的飞行航段的终点为所述第二返航点。When the current operation segment is the last operation segment of the continuous operation segment, the current operation segment is determined as the next operation segment, and the current operation segment is determined as the next operation segment. The end point or the end point of the flight segment connected with the current operation segment is the second home point.
- 根据权利要求1所述的返航控制方法,其中,所述返航点通过所述目标着陆点到所述作业航段或所述作业航段切线的投影确定。The return-to-home control method according to claim 1, wherein the return-to-home point is determined by the projection of the target landing point to the operation segment or the tangent of the operation segment.
- 根据权利要求1所述的返航控制方法,其中,所述目标着陆点包括飞行着陆点和飞行安全点,其中,所述无人作业设备经过所述飞行安全点到达所述飞行着陆点,通过所述飞行安全点确定所述返航点。The return-to-home control method according to claim 1, wherein the target landing point includes a flight landing point and a flight safety point, wherein the unmanned operation equipment passes through the flight safety point to reach the flight landing point, and passes through the flight safety point. The flight safety point determines the return point.
- 一种返航控制装置,应用于无人作业设备,所述无人作业设备沿着连续的作业航段作业,所述装置包括:A return-to-home control device is applied to unmanned operation equipment, and the unmanned operation equipment operates along continuous operation segments, and the device includes:确定模块,设置为持续根据所述无人作业设备的目标着陆点分别确定当前作业航段的返航点为第一返航点、以及下一作业航段的返航点为第二返航点,其中,所述返航点为在所述作业航段上与所述目标着陆点之间距离最近的位置点;The determining module is configured to continuously determine the return point of the current operation segment as the first return point and the return point of the next operation segment as the second return point according to the target landing point of the unmanned operation equipment, wherein all the The return point is the closest position between the operation segment and the target landing point;判断模块,设置为直至在所述无人作业设备处于所述第一返航点或远离所述第一返航点作业的情况下,在判断所述无人作业设备无法达到所述第二返航点的情况下,从当前位置返回所述目标着陆点。The judging module is set to until when the unmanned operation equipment is operating at the first home point or far away from the first home point, when it is judged that the unmanned operation equipment cannot reach the second home point. case, return to the target landing point from the current position.
- 一种电子设备,包括存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现如权利要求1-10中任一项所述的返航控制方法。An electronic device, comprising a memory, a processor, and a computer program stored on the memory and running on the processor, when the processor executes the computer program, any one of claims 1-10 is implemented The return-to-home control method described in item.
- 一种计算机可读存储介质,计算机可读存储介质上存储有计算机程序, 所述计算机程序被处理器运行时执行如权利要求1-10中任一项所述的返航控制方法。A computer-readable storage medium, on which a computer program is stored, and when the computer program is run by a processor, the return-to-home control method according to any one of claims 1-10 is executed.
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011257408.9 | 2020-11-11 | ||
CN202011257408.9A CN112379691A (en) | 2020-11-11 | 2020-11-11 | Return control method and device |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2022099803A1 true WO2022099803A1 (en) | 2022-05-19 |
Family
ID=74582832
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/CN2020/132137 WO2022099803A1 (en) | 2020-11-11 | 2020-11-27 | Return control method and apparatus, electronic device, and storage medium |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN112379691A (en) |
WO (1) | WO2022099803A1 (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117270577A (en) * | 2023-11-22 | 2023-12-22 | 华东交通大学 | Operation method and system of agricultural unmanned equipment based on path planning |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114442657B (en) * | 2021-12-22 | 2023-12-05 | 广州极飞科技股份有限公司 | Unmanned equipment operation method, unmanned equipment operation device, unmanned equipment operation equipment and storage medium |
CN114326809A (en) * | 2021-12-29 | 2022-04-12 | 广州极飞科技股份有限公司 | Method and device for determining backsight point, electronic equipment and readable storage medium |
CN118151670B (en) * | 2024-05-11 | 2024-07-16 | 长龙(杭州)信息技术有限公司 | Control method and system for emergency return of flight equipment |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106403954A (en) * | 2016-09-28 | 2017-02-15 | 深圳高科新农技术有限公司 | Automatic track generating method for unmanned aerial vehicle |
CN106774404A (en) * | 2016-12-29 | 2017-05-31 | 哈密创动科技有限公司 | The control method of making a return voyage of unmanned plane, device and unmanned plane |
CN108124471A (en) * | 2017-12-11 | 2018-06-05 | 深圳市道通智能航空技术有限公司 | Unmanned vehicle makes a return voyage method, apparatus, storage medium and unmanned vehicle |
US20190114929A1 (en) * | 2017-10-12 | 2019-04-18 | Topcon Corporation | Data processing device, drone, and control device, method, and processing program therefor |
CN111324144A (en) * | 2020-02-28 | 2020-06-23 | 广州极飞科技有限公司 | Return control method, device and equipment of unmanned operation equipment and nonvolatile storage medium |
CN111752296A (en) * | 2019-09-30 | 2020-10-09 | 广州极飞科技有限公司 | Unmanned aerial vehicle air route control method and related device |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105929846A (en) * | 2016-06-08 | 2016-09-07 | 深圳高科新农技术有限公司 | Spraying method and device based on unmanned aerial vehicle |
CN108549409A (en) * | 2018-06-04 | 2018-09-18 | 成都天麒科技有限公司 | A kind of plant protection drone flight control method |
CN109090076B (en) * | 2018-06-14 | 2020-11-13 | 华南农业大学 | Spraying planning method for unmanned aerial vehicle |
-
2020
- 2020-11-11 CN CN202011257408.9A patent/CN112379691A/en active Pending
- 2020-11-27 WO PCT/CN2020/132137 patent/WO2022099803A1/en active Application Filing
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106403954A (en) * | 2016-09-28 | 2017-02-15 | 深圳高科新农技术有限公司 | Automatic track generating method for unmanned aerial vehicle |
CN106774404A (en) * | 2016-12-29 | 2017-05-31 | 哈密创动科技有限公司 | The control method of making a return voyage of unmanned plane, device and unmanned plane |
US20190114929A1 (en) * | 2017-10-12 | 2019-04-18 | Topcon Corporation | Data processing device, drone, and control device, method, and processing program therefor |
CN108124471A (en) * | 2017-12-11 | 2018-06-05 | 深圳市道通智能航空技术有限公司 | Unmanned vehicle makes a return voyage method, apparatus, storage medium and unmanned vehicle |
CN111752296A (en) * | 2019-09-30 | 2020-10-09 | 广州极飞科技有限公司 | Unmanned aerial vehicle air route control method and related device |
CN111324144A (en) * | 2020-02-28 | 2020-06-23 | 广州极飞科技有限公司 | Return control method, device and equipment of unmanned operation equipment and nonvolatile storage medium |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117270577A (en) * | 2023-11-22 | 2023-12-22 | 华东交通大学 | Operation method and system of agricultural unmanned equipment based on path planning |
CN117270577B (en) * | 2023-11-22 | 2024-02-27 | 华东交通大学 | Operation method and system of agricultural unmanned equipment based on path planning |
Also Published As
Publication number | Publication date |
---|---|
CN112379691A (en) | 2021-02-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2022099803A1 (en) | Return control method and apparatus, electronic device, and storage medium | |
CN109090076B (en) | Spraying planning method for unmanned aerial vehicle | |
CN110440811B (en) | Universal autonomous navigation control method, device and equipment terminal | |
CN108363407B (en) | Collaborative cloud control system for autonomous navigation of unmanned ship | |
CN107368072A (en) | A kind of AGV operation control systems and paths planning method that can configure based on map | |
Ma et al. | Improved ant colony algorithm for global optimal trajectory planning of UAV under complex environment. | |
CN108170146B (en) | Path planning method based on known environment | |
CN107797568A (en) | The optimal cruise that fuel consumption is reduced using vertically and laterally navigation is climbed tracking | |
CN113358116B (en) | Aircraft, route planning method and route planning algorithm thereof | |
CN105739531A (en) | Unmanned plane control system based on unmanned plane air management platform | |
CN112344945B (en) | Indoor distribution robot path planning method and system and indoor distribution robot | |
WO2022032443A1 (en) | Transport method for multi-intelligent agent formation, system, and computer-readable storage medium | |
CN115146882B (en) | Air-ground cooperative inspection method and system | |
CN109115220B (en) | Method for parking lot system path planning | |
CN111103897A (en) | Multi-robot formation control method and system in obstacle environment | |
CN111998858B (en) | Unmanned aerial vehicle route planning method based on improved A-algorithm | |
WO2022036863A1 (en) | Spraying path planning method and apparatus | |
CN110673594A (en) | Scheduling and routing method and system for AMR cluster | |
JP2023000132A (en) | Route planning device for traffic control system | |
CN114594788A (en) | Four-rotor unmanned aerial vehicle track planning method and system in unknown environment | |
CN112313594B (en) | Unmanned aerial vehicle control method, device, equipment and storage medium | |
CN114740883B (en) | Coordinated point reconnaissance task planning cross-layer joint optimization method | |
KR20210142851A (en) | Apparatus for managing delivery of unmaned aerial vehicle and method for the same | |
CN117007046A (en) | Path planning method and system for power inspection robot | |
CN110412984A (en) | One cluster safety compliance controller and its control method |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 20961357 Country of ref document: EP Kind code of ref document: A1 |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 20961357 Country of ref document: EP Kind code of ref document: A1 |