WO2020258066A1

WO2020258066A1 - Method and device for controlling unmanned aerial vehicle, unmanned aerial vehicle and storage medium

Info

Publication number: WO2020258066A1
Application number: PCT/CN2019/092914
Authority: WO
Inventors: 钱明新; 林灿龙; 李罗川
Original assignee: 深圳市大疆创新科技有限公司
Priority date: 2019-06-26
Filing date: 2019-06-26
Publication date: 2020-12-30
Also published as: CN111742277A; CN111742277B

Abstract

A method and a device for controlling an unmanned aerial vehicle, an unmanned aerial vehicle and a storage medium thereof. The method comprises: according to current position information of an unmanned aerial vehicle and position information of a first waypoint and a second waypoint in a preset flight path, determining a target flight path from the current position of the unmanned aerial vehicle to the first waypoint, the direction of the unmanned aerial vehicle when entering the first waypoint along the target flight path being consistent with the direction of the unmanned aerial vehicle flying from the first waypoint to the second waypoint along the preset flight path (S101); and according to the target flight path, controlling the unmanned aerial vehicle to fly to the first waypoint (S102). The method can enable an unmanned aerial vehicle to smoothly enter a first waypoint of a preset flight path with a small deviation, thereby improving the tracking effect of the unmanned aerial vehicle on the preset flight path at an initial stage of the preset flight path.

Description

UAV control method, equipment, UAV and storage medium

Technical field

The embodiments of the present invention relate to the field of unmanned aerial vehicles, and in particular to a control method, equipment, unmanned aerial vehicle and storage medium of an unmanned aerial vehicle.

Background technique

Vertical take-off and landing UAV is a new type of aircraft that has developed rapidly in recent years. It also has the vertical take-off and landing of rotary-wing aircraft and the ability to hover in the air and fly at low speeds, and the ability of fixed-wing aircraft to fly at high speed with lower energy consumption. It has strong industry application value. The vertical take-off and landing drone can fly according to the pre-planned route by the user. For example, the vertical take-off and landing drone can receive multiple waypoint information sent by the ground control terminal, and automatically fly from the current position to the first waypoint, and Start flying along the pre-planned route from this first waypoint.

However, in the prior art, when the drone enters the first waypoint, it cannot meet the requirements of the first waypoint, resulting in the drone being unable to normally fly according to the pre-planned route after entering the first waypoint.

Summary of the invention

The embodiment of the present invention provides a control method, equipment, unmanned aerial vehicle and storage medium of an unmanned aerial vehicle, so that the unmanned aerial vehicle smoothly enters the first waypoint of a preset route with a small deviation and improves the unmanned aerial vehicle The tracking effect of the preset route in the initial stage of the preset route.

The first aspect of the embodiments of the present invention is to provide a control method of a drone, including:

According to the current position information of the drone and the position information of the first waypoint and the second waypoint in the preset route, determine the target route from the current position of the drone to the first waypoint , Wherein the direction when the drone enters the first waypoint along the target route is the same as the drone flies from the first waypoint to the second waypoint along the preset route The directions of all waypoints are the same;

According to the target route, the drone is controlled to fly to the first waypoint.

The second aspect of the embodiments of the present invention is to provide a drone control device, including: a memory and a processor;

The memory is used to store program codes;

The processor calls the program code, and when the program code is executed, is used to perform the following operations:

The third aspect of the embodiments of the present invention is to provide a drone, including:

body;

The power system is installed on the fuselage to provide flight power;

And the control device described in the second aspect.

The fourth aspect of the embodiments of the present invention is to provide a computer-readable storage medium having a computer program stored thereon, and the computer program is executed by a processor to implement the method described in the first aspect.

The control method, equipment, drone, and storage medium of the drone provided in this embodiment are based on the current location information of the drone and the location information of the first waypoint and the second waypoint in the preset route. , Determine the target route of the UAV from the current position to the first waypoint, because the target route refers to the position information of the first waypoint and the second waypoint in the preset route, and there is no The direction when the human machine enters the first waypoint is the same as the direction that the drone flies from the first waypoint to the second waypoint. Therefore, when the drone flies along the target route to the first waypoint It can make the UAV smoothly enter the first waypoint with a small deviation when the point is selected, which improves the tracking effect of the UAV on the preset route in the initial stage of the preset route.

Description of the drawings

In order to explain the technical solutions in the embodiments of the present invention more clearly, the following will briefly introduce the drawings used in the description of the embodiments. Obviously, the drawings in the following description are some embodiments of the present invention. For those of ordinary skill in the art, other drawings can be obtained based on these drawings without creative labor.

FIG. 1 is a flowchart of a method for controlling a drone provided by an embodiment of the present invention;

Figure 2 is a schematic diagram of an application scenario provided by an embodiment of the present invention;

FIG. 3 is a flowchart of a control method of a drone provided by another embodiment of the present invention;

4 is a schematic diagram of another application scenario provided by an embodiment of the present invention;

Figure 5 is a schematic diagram of multiple alternative routes provided by an embodiment of the present invention;

Figure 6 is a top view of an alternative route provided by an embodiment of the present invention;

Figure 7 is a side view of an alternative route provided by an embodiment of the present invention;

Figure 8 is a top view of another alternative route provided by an embodiment of the present invention;

Figure 9 is a side view of another alternative route provided by an embodiment of the present invention;

10 is a schematic diagram of another multiple alternative routes provided by an embodiment of the present invention;

FIG. 11 is a flowchart of a control method of a drone provided by another embodiment of the present invention;

FIG. 12 is a schematic diagram of the horizontal range and height change of an unmanned aerial vehicle according to an embodiment of the present invention;

FIG. 13 is a schematic diagram of the horizontal range and height change of another drone provided by an embodiment of the present invention;

Fig. 14 is a structural diagram of a UAV control device provided by an embodiment of the present invention.

Reference signs:

20: UAV; 21: the first waypoint; 22: the second waypoint;

23: Reverse extension line; 41: first starting circle; 42: second starting circle;

51: the first ending circle; 52: the second ending circle; 11: the first waypoint;

12: the second waypoint; 140: control equipment; 141: storage;

142: Processor.

Detailed ways

The technical solutions in the embodiments of the present invention will be clearly described below in conjunction with the accompanying drawings in the embodiments of the present invention. Obviously, the described embodiments are only a part of the embodiments of the present invention, rather than all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by those of ordinary skill in the art without creative work shall fall within the protection scope of the present invention.

It should be noted that when a component is said to be "fixed to" another component, it can be directly on the other component or a central component may also exist. When a component is considered to be "connected" to another component, it can be directly connected to the other component or there may be a centered component at the same time.

Unless otherwise defined, all technical and scientific terms used herein have the same meaning as commonly understood by those skilled in the technical field of the present invention. The terms used in the description of the present invention herein are only for the purpose of describing specific embodiments, and are not intended to limit the present invention. The term "and/or" as used herein includes any and all combinations of one or more related listed items.

Hereinafter, some embodiments of the present invention will be described in detail with reference to the accompanying drawings. In the case of no conflict, the following embodiments and features in the embodiments can be combined with each other.

The embodiment of the present invention provides a control method of a drone. Fig. 1 is a flowchart of a method for controlling a drone provided by an embodiment of the present invention. As shown in Figure 1, the method in this embodiment may include:

Step S101: Determine from the current position of the drone to the first waypoint according to the current position information of the drone and the position information of the first waypoint and the second waypoint in the preset route The target route, wherein the direction when the drone enters the first waypoint along the target route is the same as the drone flies from the first waypoint to the destination along the preset route The direction of the second waypoint is the same.

The execution subject of the method in this embodiment may be the control device of the drone, and the control device may be the flight controller of the drone, or other devices, components or equipment for controlling the flight of the drone.

Optionally, the direction when the drone enters the first waypoint along the target route is the same as the direction the drone flies from the first waypoint to the second waypoint along the preset route. The arc of the target route entering the first waypoint has the same curvature as the arc of the drone flying from the first waypoint to the second waypoint along the preset route.

Optionally, the direction when the drone enters the first waypoint along the target route is the same as the direction the drone flies from the first waypoint to the second waypoint along the preset route. The direction in which the target route enters the first waypoint is the same as the direction in which the first waypoint points to the second waypoint.

As shown in Figure 2, suppose that the UAV 20 needs to perform the flight mission of the preset route shown by the dotted line. Before executing the flight mission, the UAV 20 needs to fly from the current position to the first one of the preset route. Waypoint 21. It can be understood that this is only a schematic description, and does not limit the shape of the preset route, nor the number of waypoints included in the preset route. Optionally, the UAV 20 may pre-store relevant information of each waypoint among the multiple waypoints included in the preset route, and the relevant information of each waypoint may specifically include the altitude information and location of the waypoint. Information, the speed information of the drone at the waypoint, etc.

In this embodiment, when the drone 20 needs to fly from the current position to the first waypoint 21 of the preset route, the control device of the drone 20 first needs to determine from the current position to the first waypoint 21 The target route at point 21 is further controlled to control the drone 20 to fly from the current position to the first waypoint 21 of the preset route according to the target route. Specifically, the control device of the UAV 20 can determine from the current position to the position information of the first waypoint 21 and the second waypoint 22 of the preset route according to the current position information of the UAV 20 The target route of the first waypoint 21. For example, the control device of the drone 20 can determine the route segment between the first waypoint 21 and the second waypoint 22 according to the position information of the first waypoint 21 and the second waypoint 22, and further , Determine the reverse extension line 23 of the route segment, the length of the reverse extension line 23 can be determined by the control device, and the specific length value is not limited here. Further, the control device can determine a curve or straight line that smoothly transitions from the current position to the reverse extension line 23, and the curve or straight line and the reverse extension line 23 can constitute a target from the current position to the first waypoint 21 route. Since the target route includes the reverse extension line 23, the direction when the drone enters the first waypoint along the target route can be made to be the same as that of the drone flying along the preset route from the first waypoint to the second waypoint. The direction is the same.

Step S102: Control the drone to fly to the first waypoint according to the target route.

As shown in Figure 2, after the target route is determined, the control device can control the drone 20 to fly from the current position to the reverse extension line 23 according to the curve shown by the arrow, and further, control the drone according to the reverse extension line 23. The man-machine 20 flies to the first waypoint 21. Specifically, the flying height of the drone 20 on the reverse extension line 23 may be the height corresponding to the first waypoint 21, and the flying speed of the drone 20 on the reverse extension line 23 may be the first waypoint. For a preset speed of a waypoint 21, the flying direction of the drone 20 on the reverse extension line 23 is the direction of the route segment between the first waypoint 21 and the second waypoint 22.

In other embodiments, the control device of the drone may also be a control terminal corresponding to the drone. The control terminal may specifically be a ground control terminal. The ground control terminal may be, for example, a mobile phone, a tablet computer, a laptop, etc. .

The embodiment of the present invention provides a control method of a drone. Fig. 3 is a flowchart of a control method for a drone provided by another embodiment of the present invention. As shown in Figure 3, on the basis of the above-mentioned embodiment, according to the current location information of the drone and the location information of the first waypoint and the second waypoint in the preset route, it is determined from the none The target route from the current position of the man-machine to the first waypoint includes: according to the current position information of the drone and the position information of the first waypoint and the second waypoint in the preset route, Determine multiple alternative routes from the current position of the drone to the first waypoint; determine the target route from the multiple alternative routes.

As shown in Fig. 2, the control device of the UAV 20 determines from the current position information of the UAV 20 and the position information of the first waypoint 21 and the second waypoint 22 of the preset route. An example of the target route from the position to the first waypoint 21. In this embodiment, the control device can determine from the current position to the first waypoint based on the current position information of the drone 20 and the position information of the first waypoint 21 and the second waypoint 22 of the preset route. Multiple alternative routes for each waypoint 21, and further, the target route is determined from the multiple alternative routes.

Optionally, the method of the embodiment of the present invention can be applied to a vertical take-off and landing UAV. The vertical take-off and landing UAV includes a rotor power system and a fixed wing power system, which can be freely switched between the two modes of the rotor and the fixed wing. When the vertical take-off and landing UAV switches to the rotor mode, the rotor power system provides the power of the UAV, and when the vertical take-off and landing UAV switches to the fixed-wing mode, the fixed-wing power system provides the power of the UAV.

As a feasible implementation manner, according to the current location information of the drone and the location information of the first waypoint and the second waypoint in the preset route, it is determined from the current location of the drone. Multiple alternative routes from the location to the first waypoint, including:

Step S301: Determine a first starting circle and a second starting circle that are tangent to the speed direction of the drone at the current position according to the current position information of the drone.

As shown in Figure 4, point B represents the current location of the drone, and the arrow represents the speed direction of the drone at the current location. According to the current location information, that is, the location information of point B and the speed direction, it can be determined The two circles that are tangent to the speed direction of the drone at the current position are denoted as the first starting circle 41 and the second starting circle 42 respectively. This embodiment does not limit the radii of the first starting circle 41 and the second starting circle 42, and the radius may be specifically set by the user through the control terminal.

As shown in Figure 4, assuming that the speed direction of the UAV at the current position B is the forward direction, the starting circle on the left side of the speed direction can be marked as the first starting circle 41, and the starting circle on the right side of the speed direction The starting circle is marked as the second starting circle 42. In other embodiments, the starting circle on the left side of the speed direction may be recorded as the second starting circle 42, and the starting circle on the right side of the speed direction may be recorded as the first starting circle 41.

In this embodiment, the first starting circle 41 rotates counterclockwise and the second starting circle 42 rotates clockwise as an example for schematic illustration. In other embodiments, the first starting circle 41 can also rotate clockwise, and the second starting circle 42 can rotate counterclockwise.

Step S302: Determine a first ending circle and a second ending circle according to the route segment between the first waypoint and the second waypoint in the preset route, the first ending circle and the second ending circle The ending circles are respectively tangent to the reverse extension line of the route segment.

As shown in Figure 4, according to the location information of the first waypoint 21 and the second waypoint 22, the route segment between the first waypoint 21 and the second waypoint 22 can be determined. According to the route segment The reverse extension line 23 of the route segment can be determined, and further, two circles tangent to the reverse extension line 23 can be determined, and these two circles are marked as the first end circle 51 and the second end circle 52 respectively. In this embodiment, the length of the reverse extension line 23 and the radius of the first end circle 51 and the second end circle 52 can be set by the user through the control terminal.

Similarly, in this embodiment, the end circle on the left side of the reverse extension line 23 is recorded as the first end circle 51, and the end circle on the right side of the reverse extension line 23 is recorded as the second end circle 52. In other embodiments, the ending circle on the left side of the reverse extension line 23 may be recorded as the second ending circle 52, and the ending circle on the right side of the reverse extension line 23 may be recorded as the first ending circle 51.

In this embodiment, the first end circle 51 rotates counterclockwise and the second end circle 52 rotates clockwise as an example for schematic illustration. In other embodiments, the first end circle 51 can also rotate clockwise, and the second end circle 52 can rotate counterclockwise.

Step S303: According to the first starting circle or the second starting circle, and the first ending circle or the second ending circle, determine from the current position of the drone to the first Multiple alternative routes for waypoints.

Specifically, according to the first starting circle 41 or the second starting circle 42, and the first ending circle 51 or the second ending circle 52, a number of points from the current position B of the drone to the first waypoint 21 are determined Alternative routes.

As a feasible implementation, multiple alternative routes can be generated by tangent connection between the start circle and the end circle. In this way, two start circles and two end circles can be connected by tangent to generate 4 As shown in Figure 5, WP ₁ represents the first waypoint 21, WP ₂ represents the second waypoint 22, the left starting circle corresponds to the first starting circle 41 in this embodiment, The right starting circle corresponds to the second starting circle 42 in this embodiment, the left ending circle corresponds to the first ending circle 51 in this embodiment, and the right ending circle corresponds to the second ending circle 52 in this embodiment. In addition, if there is no tangent line between the two circles, the horizontal range marking the tangent line between the two circles is infinite.

Wherein, each of the multiple alternative routes includes a first route segment, a second route segment, and a third route segment that are sequentially connected; the first route segment may be projected on a first circle, The third route segment may be projected on a second circle, the second route segment is respectively tangent to the first circle and the second circle, and the first circle is the first starting circle or the A second starting circle, the second circle being the first ending circle or the second ending circle.

In this embodiment, an alternative route generated by connecting the left start circle and the right end circle through a tangent is taken as an example for schematic illustration. Figure 6 shows a plan view of the alternative route, and Figure 7 shows the alternative route. Side view of the selected route. The alternative route includes multiple route segments, as shown in Figures 6 and 7, the alternative route includes route segments numbered 2-5, that is, the alternative route is from the current position B to the first waypoint WP ₁ route. The route segment numbered 1 is the route for the drone to fly along the target direction to the current position B after rising from the starting point, such as the Home point, to the preset height.

Specifically, the route segment numbered 2 is recorded as the first route segment, the route segment numbered 3 is recorded as the second route segment, and the route segment numbered 4 is recorded as the third route segment. Among them, the first route segment, that is, the route segment numbered 2 can be projected on the left starting circle, which is the first starting circle 41, and the third route segment, that is the route segment numbered 4, can be projected on the right end circle, which is the second ending circle 52. . The second route segment, the route segment numbered 3, is tangent to the left start circle and the right end circle.

Similarly, when the right start circle and the left end circle are connected by a tangent to generate an alternative route, the first route segment can be projected on the right start circle, and the third route segment can be projected on the left end circle. The second route segment is respectively tangent to the right start circle and the left end circle.

In the same way, when the left start circle and the left end circle are connected by a tangent to generate an alternative route, the first route segment can be projected on the left start circle, and the third route segment can be projected on the left end circle. The second route segment is tangent to the left start circle and the left end circle respectively.

In the same way, when the right start circle and the right end circle are connected by a tangent to generate an alternative route, the first route segment can be projected on the right start circle, and the third route segment can be projected on the right end circle. The second route segment is tangent to the right start circle and right end circle respectively.

In this embodiment, the circle projected on the first route segment is recorded as the first circle, and the circle projected on the third route segment is recorded as the second circle. In summary, the first circle can be the first starting circle or the first circle. For the second starting circle, the second circle may be the first ending circle or the second ending circle.

As shown in Figure 8 and Figure 9, the user can also set a climbing circle between the start circle and the end circle. The position and radius of the climb circle can also be set by the user through the control terminal. For example, the climb circle can be set In a preset area with no obstacles. Similarly to the direction of rotation of the start circle and the end circle, the climb circle can also rotate counterclockwise or clockwise.

As another feasible implementation manner, according to the first starting circle or the second starting circle, and the first ending circle or the second ending circle, the Multiple alternative routes from the current position to the first waypoint, including: according to the first starting circle or the second starting circle, the climb circle, and the first ending circle or the The second end circle determines multiple alternative routes from the current position of the drone to the first waypoint.

For example, the start circle and the climb circle are connected by a tangent line and the climb circle and the end circle are connected by a tangent line to generate multiple alternative routes. In this way, two start circles, rotate counterclockwise or rotate clockwise The climb circle and the two end circles connected by tangents can generate 8 alternative routes, as shown in Figure 10, where 11 represents the first waypoint and 12 represents the second waypoint. In addition, if there is no tangent line between the two circles, the horizontal range marking the tangent line between the two circles is infinite.

Optionally, the second route segment includes a first sub-route, a second sub-route, and a third sub-route; wherein the first sub-route is connected to the first route segment, and the third sub-route is connected to the The third route segment is connected; the second sub route can be projected on a climb circle, the first sub route is tangent to the first circle and the climb circle, and the third sub route is connected to the climb circle. The second circle is tangent to the climbing circle. Optionally, the climb circle is set by the user through the user interface of the control terminal.

In this embodiment, the alternative route generated by the way that the left starting circle, the counterclockwise rotating climb circle and the right end circle are connected by a tangent line is used as an example to illustrate schematically, that is, taking the eight alternative routes shown in FIG. 10 Take one as an example for schematic illustration, and other alternative routes are similar.

Fig. 8 shows a top view of the alternative route, and Fig. 9 shows a side view of the alternative route. The alternative route includes multiple route segments, as shown in Figures 8 and 9, the alternative route includes route segments numbered 2-7, that is, the alternative route is from the current position B to the first waypoint WP ₁ route. The route segment numbered 1 is the route for the drone to fly along the target direction to the current position B after rising from the starting point, such as the Home point, to the preset height.

Specifically, the route segment numbered 2 is recorded as the first route segment, the route segment composed of

numbers

3, 4, and 5 is recorded as the second route segment, and the route segment numbered 6 is recorded as the third route segment. Among them, the first route segment, the route segment numbered 2 can be projected on the left starting circle, that is, the first starting circle 41, and the third route segment, the route segment numbered 6 can be projected on the right end circle, that is the second ending circle 52 . Mark the route segment numbered 3 in Figure 8 or Figure 9 as the first sub-route of the second route segment, record the route segment numbered 4 as the second sub-route of the second route segment, and the route numbered 5 The segment is recorded as the third sub-route of the second route segment. Among them, the route segment numbered 3 is the first sub-route connected with the route segment numbered 2 that is the first route segment, the route segment numbered 5 is the third sub-route and the route segment numbered 6 is the third route segment connection. The route segment numbered 4, that is, the second sub-route, can be projected on the climb circle, the route segment numbered 3 is tangent to the left starting circle and the counterclockwise rotation climbing circle, and the route segment numbered 5 is connected to the right end circle. Tangent to the climbing circle rotating counterclockwise.

In other embodiments, each of the alternative routes further includes: a fourth route segment, and the fourth route segment is respectively connected to the third route segment and the first waypoint.

As shown in FIG. 6 or FIG. 7, the alternative route further includes a fourth route segment, and the fourth route segment may be a route segment numbered 5. The fourth route segment is respectively connected with the third route segment, the route segment numbered 4 and the first waypoint WP ₁ . As shown in Figure 6 or Figure 7, the stage when the drone flies along the route segment numbered 1 is recorded as the forward transition stage, and the stage when the drone flies along the route segment numbered 2 is recorded as the start In the arc phase, the phase where the drone flies along the route segment numbered 3 is recorded as the end circle tangent phase, and the phase where the drone flies along the route segment numbered 4 is recorded as the end arc phase. The stage in which the drone flies along the route segment numbered 5 is recorded as the pre-planning stage for the preset route.

As shown in FIG. 8 or FIG. 9, the alternative route further includes a fourth route segment, and the fourth route segment may be a route segment numbered 7. The fourth route segment is respectively connected to the third route segment, the route segment numbered 6 and the first waypoint WP ₁ . As shown in Figure 8 or Figure 9, the stage where the drone flies along the route segment numbered 1 is recorded as the forward transition stage, and the stage where the drone flies along the route segment numbered 2 as the start In the arc phase, the phase where the drone flies along the route segment numbered 3 is recorded as the climb circle tangent phase, and the phase where the drone flies along the route segment numbered 4 is recorded as the arc of climb phase. The stage when the drone flies along the route segment numbered 5 is recorded as the end circle tangent stage, and the stage when the drone flies along the route segment numbered 6 is recorded as the end arc stage, and the drone travels along the The flight stage of the route segment numbered 7 is recorded as the pre-route preparation stage.

Optionally, the fourth route segment may be particularly mentioned above the first waypoint WP reverse route segment between the extended line _₂₁ and the second waypoints WP.

Optionally, the fourth route segment satisfies at least one of the following conditions: the height of the fourth route segment is the same as the height of the first waypoint; the drone is on the fourth route segment The flight speed is the same as the preset speed of the first waypoint; the direction of the fourth route segment is consistent with the direction of the route segment between the first waypoint and the second waypoint.

For example, taking the fourth route segment as shown in Fig. 6 or Fig. 7 as an example, the fourth route segment may satisfy at least one of the following conditions: the height of the fourth route segment is the same as the height of the first waypoint WP ₁ ; The flight speed of the man-machine on the fourth route segment is the same as the preset speed of the first waypoint WP ₁ ; the direction of the fourth route segment is between the first waypoint WP ₁ and the second waypoint WP ₂ The directions of the route segments are the same.

Optionally, the flying speed of the drone on the first route segment, the second route segment, and the third route segment is a preset speed of the first waypoint.

For example, taking the alternative route shown in Figure 6 or Figure 7 as an example, when the drone flies on the first route segment, the second route segment, and the third route segment of the alternative route, the drone can Use the preset speed of the first waypoint WP ₁ to fly, that is to say, starting from the current position of the drone at point B, the drone can follow the preset speed of the first waypoint WP ₁ The size of the speed to fly.

In this embodiment, according to the current position information of the drone, the first starting circle and the second starting circle that are tangent to the speed direction of the drone at the current position are determined, and according to the preset route For the route segment between the first waypoint and the second waypoint, the first ending circle and the second ending circle are determined, and based on the first starting circle or the second starting circle, and the first The ending circle or the second ending circle determines multiple alternative routes from the current position of the drone to the first waypoint, thereby realizing the diversity of alternative routes. In addition, by setting a climbing circle in a preset area with no obstacles, it can effectively prevent the drone from touching obstacles during the climbing process, thereby improving the flight safety of the drone. In addition, at least one of the following conditions is met through the fourth route segment: the height of the fourth route segment is the same as the height of the first waypoint; the flying speed of the drone on the fourth route segment is The preset speed of the first waypoint is the same; the direction of the fourth route segment is consistent with the direction of the route segment between the first waypoint and the second waypoint. The man-machine smoothly enters the first waypoint with a small deviation, which improves the tracking effect of the UAV in the initial stage of the preset route.

The embodiment of the present invention provides a control method of a drone. Fig. 11 is a flow chart of a control method of a drone provided by another embodiment of the present invention. As shown in FIG. 11, on the basis of the foregoing embodiment, the altitude of the drone gradually increases on at least one of the first route segment, the second route segment, and the third route segment. .

Fig. 12 is a schematic diagram of the horizontal range and height changes of the UAV when the UAV is flying along the alternative route shown in Fig. 6 or Fig. 7. As shown in Figure 12, the altitude of the drone gradually increases on the first route segment, the route segment numbered 2, the second route segment, the route segment numbered 3, and the third route segment, the route segment numbered 4. increase. Among them, the UAV repeated circling and climbing along the right end circle on the route segment numbered 4.

In other embodiments, the height of the drone may only gradually increase in the first route segment, the second route segment, or the third route segment, or the height of the drone is in the first route segment, the second route segment, or the third route segment. It gradually increases on any two of the route segment and the third route segment.

Fig. 13 is a schematic diagram of the horizontal range and altitude changes of the UAV when the UAV flies along the alternative route shown in Fig. 8 or Fig. 9. As shown in Figure 13, the altitude of the drone is in the first route segment, the route segment numbered 2, the first sub-route of the second route segment, the route segment numbered 3, and the second route segment. The second sub-route is gradually increasing on the route segment numbered 4. Among them, the UAV repeated circling and climbing along the climb circle on the route segment numbered 4.

As shown in Figure 5 or Figure 10, after determining multiple alternative routes from the current position of the UAV to point B to the first waypoint WP ₁ , it is necessary to further determine the target from the multiple alternative routes The route, for example, when the climb circle is not required to determine the multiple alternative routes, the target route is determined from the four alternative routes shown in FIG. 5. When the climb circle is required to determine the multiple alternative routes, the target route is determined from the eight alternative routes shown in FIG. 10.

The determining the target route from the multiple alternative routes includes:

Step S1101. In the process of determining that the drone flies from the current position to the first waypoint along each of the multiple alternative routes, the drone The horizontal voyage.

Take the alternative route shown in FIG. 6 or FIG. 7 as an example for schematic illustration, and the alternative route is one of the four alternative routes shown in FIG. 5. When the alternative route along the UAV illustrated in FIG. 6 or FIG. 7 flying height UAVs up from a current position of the point B to the height of the first height of a waypoint WP _1. I.e. the entire process UAV climb up from the current height position of the point B to the first waypoint WP during the initial height of _a circular arc in the stage, and a terminating stage Tangent circular arc terminating stages. Among them, the UAV can repeatedly circling and climb during the ending arc stage, and the horizontal range S of the UAV during the entire climbing process is equal to the sum of the horizontal range of these three stages. In the same way, the horizontal range of the drone during the entire climb process can be calculated when the drone is flying along the other alternative routes among the 4 alternative routes as shown in Figure 5, and then the drone's horizontal range can be obtained. The horizontal range of the UAV during the flight from the current position to the first waypoint for each alternative route.

In addition, the alternative route shown in FIG. 8 or FIG. 9 is one of the eight alternative routes shown in FIG. 10. When the alternative route along the UAV illustrated in FIG. 8 or FIG. 9 flight, UAV height raised from the current height position of the point B to the height of the first waypoint WP ₁ is. The entire climbing process of the drone, that is, the process of rising from the height of point B at the current position to the height of the first waypoint WP ₁ is completed in the initial arc phase, the climb circle tangent phase, and the climb arc phase. It is possible to repeat the circling climb during the arc of climb. The horizontal range S of the UAV during the entire climb is equal to the sum of the horizontal range of these three stages. In the same way, the horizontal range of the drone during the entire climb process can be calculated when the drone is flying along the other alternative routes among the 8 alternative routes as shown in Figure 10, and then the drone's horizontal range can be obtained. The horizontal range of the UAV during the flight from the current position to the first waypoint for each alternative route.

Step S1102: Determine the candidate route with the shortest horizontal range among the multiple candidate routes as the target route.

For example, when the climb circle is not required to determine the multiple alternative routes, the alternative route with the shortest horizontal range among the four alternative routes shown in FIG. 5 is determined as the target route. When the climb circle is required to determine the multiple alternative routes, the alternative route with the shortest horizontal range among the eight alternative routes shown in FIG. 10 is determined as the target route. For example, when the climb circle is not required to determine the multiple alternative routes, if the alternative route shown in Figure 6 or Figure 7 is the target route, the control device will control the drone to follow the route numbered 2-5 The segments fly to the first waypoint in sequence. When the climb circle is required to determine the multiple alternative routes, if the alternative route as shown in Figure 8 or Figure 9 is the target route, the control device will control the drone to follow the sequence of route segments numbered 2-7 Fly to the first waypoint.

Optionally, in the process of determining that the drone flies from the current position to the first waypoint along each of the multiple alternative routes, the The horizontal range of the drone includes: determining that the drone is flying along the alternative route according to the height of the drone at the current position and the height of the first waypoint. The number of laps that the drone needs to hover and climb on the second route segment and/or the third route segment; according to the drone's needs in the second route segment and/or the third route segment The number of circling and climbing laps on the segment to determine the level of the drone during the process of rising from the height of the current position to the height of the first waypoint along the alternative route voyage.

Taking the alternative route shown in Fig. 6 or Fig. 7 as an example, the altitude of point B at the current position of the drone is recorded as the initial altitude h ₀ , and the altitude of the first waypoint WP ₁ is recorded as the target altitude h _tgt . When the drone rises from the height of point B at the current position to the height of the first waypoint WP ₁ , the climb height of the drone is recorded as Δh, Δh=h _tgt -h ₀ , refer to Figure 6 or Figure 7 The tangent point between the route segment numbered 5 and the right end circle is marked as point D, that is, the altitude of the drone at point D reaches the height of the first waypoint WP ₁ . When the number of repeated circling and climbing cycles of the drone on the right end circle is 0, the horizontal range S of the drone during the entire climb is the horizontal range from point B to point D. When the number of cycles of the drone repeatedly circling and climbing on the right end circle is 1, the horizontal range S of the drone during the entire climb is the horizontal range from point B to point D plus a 2πR, where, R represents the radius of the right end circle. When the number of repeated circling and climbing cycles of the drone on the right end circle is 2, the horizontal range S of the drone during the entire climb is the horizontal range from point B to point D plus two 2πR. That is to say, whenever the number of cycles of repeated circling and climbing of the drone on the right end circle increases by one circle, the horizontal range S of the drone during the entire climb process increases by 2πR. Therefore, when calculating the horizontal range S of the UAV during the entire climb process, it is necessary to calculate the number of cycles that the UAV repeats hovering and climbing on the right end circle, and according to the UAV repeating hovering and climbing on the right end circle The number of laps to determine the drone's horizontal range S during the process of rising from the height of the current position to the height of the first waypoint along the alternative route shown in Figure 6 or Figure 7, and then Obtain the horizontal range of the drone during the flight from the current position to the first waypoint along each alternative route.

In the same way, when the drone is flying from the current position to the height of the first waypoint along the alternate route shown in Figure 8 or Figure 9, the drone can repeat the circling climb on the climb circle according to the drone. The number of laps to determine the drone's horizontal range S during the entire climb process, and then obtain the drone's level during the flight from the current position to the first waypoint along each alternative route voyage.

In some embodiments, the drone can also hover repeatedly on the climb circle and the end circle. At this time, the drone can be determined according to the number of cycles the drone has repeatedly hovered and climbed on the climb circle and the end circle. The horizontal range S during the entire climb process, and then obtain the horizontal range of the UAV during the process of flying from the current position to the first waypoint along each alternative route.

Optionally, when the drone is determined to fly along the alternative route according to the altitude of the drone at the current position and the altitude of the first waypoint, the unmanned The number of laps that the aircraft needs to hover and climb on the second route segment and/or the third route segment includes: according to the altitude of the drone at the current position and the altitude of the first waypoint When it is determined that the drone is flying along the alternate route, the drone needs to hover and climb on the second route segment and/or the third route segment, and the hover climb The trajectory inclination of is less than or equal to the preset climb trajectory inclination threshold. Wherein, the trajectory inclination of the drone hovering and climbing is determined according to the height difference between the height of the drone at the current position and the height of the first waypoint, and the horizontal range.

Taking the alternative route shown in Figure 6 or Figure 7 as an example, when the number of cycles of repeated circling and climbing on the right end circle of the drone is 0, the horizontal range S of the drone during the entire climb is from B Horizontal flight from point to point D. At this time, calculate the trajectory inclination θ of the UAV hovering and climbing according to the horizontal range S and the UAV's climb height Δ□,

Because when the UAV repeats circling and climbing on the right end circle, the horizontal range S of the UAV increases by 2πR during the entire climbing process. Therefore, when the UAV repeats on the right end circle Each time the number of circling and climbing circles increases, the inclination angle θ of the trajectory of the UAV circling and climbing will decrease. Therefore, one can gradually increase by 1 on the basis that the number of circling and climbing circles is 0, and the trajectory inclination θ of the circling and climbing of the UAV can be calculated every additional circle. The increase is stopped until the calculated trajectory inclination angle θ of the UAV hovering climb is less than or equal to the preset climb trajectory inclination angle threshold. Here, the preset climb trajectory inclination angle threshold is recorded as θ _max , and the preset climb trajectory inclination threshold θ _max may specifically be the maximum allowable climb trajectory inclination angle set by the user, that is, satisfy the condition

When, stop increasing. At this time, the number of times the UAV repeatedly circulates and climbs on the right termination circle is the final number of laps that the drone needs to circulate and climb on the right termination circle. In the same way, it can be calculated that when the drone is flying along the alternative route shown in Figure 8 or Figure 9, the number of cycles that the drone needs to circulate and climb repeatedly on the climb circle, or the drone needs to be climbing Repeat the number of circling climbs on the circle and the right end circle.

In this embodiment, by determining that the drone is flying from the current position to the first waypoint along each of the multiple alternative routes, the unmanned The horizontal voyage of the aircraft, the candidate route with the shortest horizontal voyage among the multiple alternative routes is determined as the target route, so that the UAV can maximize the flight from the current position to the first waypoint To save energy.

The embodiment of the present invention provides a control method of a drone. On the basis of the above-mentioned embodiment, according to the current position information of the drone and the position information of the first waypoint and the second waypoint in the preset route, it is determined from the current position of the drone to Before the target route of the first waypoint, the method further includes: controlling the drone to fly from the starting point to a preset height and then fly along the target direction to the current position.

As shown in Figure 7 or Figure 9, point A represents the starting point of the drone, such as the Home point. After the drone starts to take off from point A, the control device controls the drone to rise from point A to the preset height arrival point C, further, fly from point C to the current position point B along the target direction, that is, the forward transition stage numbered 1 as shown in FIG.

Optionally, the drone is a vertical take-off and landing drone, and controlling the drone to rise from a starting point to a preset height includes: controlling the drone to rise from the starting point to a preset height in a rotor mode Preset height. For example, after the drone starts to take off from point A, the control device controls the drone to rise from point A to a preset height in a rotor mode.

Optionally, the target direction is a direction indicated by a remote control instruction sent by a control terminal, or a direction when the drone rises to the preset height. For example, when the drone starts to take off from point A and rises to a preset height, the user can send a remote control instruction to the drone through the control terminal, and the remote control instruction can adjust the direction of the drone. The target direction may specifically be the direction indicated by the remote control instruction of the control terminal when the drone reaches the preset height. Alternatively, the target direction may be the direction of the drone when the drone reaches the preset height.

Optionally, during the process of the drone flying to the current position along the target direction, the flight mode of the drone is changed from the rotor mode to the fixed-wing mode.

For example, when the drone rises from the point A to the preset height h in the rotor mode, it hoveres at the point C, and further, flies from the point C to the current position point B along the target direction as described above. In the process of flying from point C to point B at the current position, the flight mode of the drone changes from rotor mode to fixed-wing mode, that is to say, when the flying mode of the drone at the current position point B is fixed-wing mode .

As a possible implementation manner, during the process of the drone flying to the current position along the target direction, the method further includes: when the rotor lift of the drone is less than a preset lift, and When the airspeed of the drone is greater than the first airspeed threshold, the drone is switched from the rotor mode to the fixed wing mode.

For example, in the process of flying from point C to point B at the current position, when the rotor lift of the drone is less than the preset lift, and the airspeed of the drone is greater than the first airspeed threshold, the drone can be Switch from rotor mode to fixed wing mode.

As another possible implementation manner, during the process of the drone flying to the current position along the target direction, the method further includes: when the airspeed of the drone is greater than a second airspeed When the threshold is reached, the drone is switched from the rotor mode to the fixed wing mode.

For example, in the process of flying from point C to point B at the current position, when the airspeed of the drone is greater than the second airspeed threshold, the drone can be switched from the rotor mode to the fixed wing mode. Among them, the second airspeed threshold is greater than the first airspeed threshold.

In this embodiment, the drone is controlled to fly to the current position along the target direction after rising from the starting point to a preset height, and when the drone flies along the target direction to the current position In the process, the flight mode of the drone is changed from the rotor mode to the fixed-wing mode, which further saves the energy of the drone.

In the following, an application scenario in which the climb circle is not required to determine the multiple alternative routes is taken as an example to schematically illustrate the process of determining the target route. For example, the position coordinates of the first waypoint in the preset route relative to the UAV Home point are (-500m, 550m), and the height of the first waypoint relative to the ground is 200 meters. The position coordinates of the second waypoint in the preset route relative to the UAV Home point are (-500m, 650m), and the height of the second waypoint relative to the ground is 200 meters. The maximum allowable climb trajectory inclination angle θ _max set by the user through the control terminal is 5 degrees. The radius of the starting circle and the ending circle are both 100 meters, and the length of the reverse extension of the route segment between the first waypoint 21 and the second waypoint 22 is 50 meters. The preset altitude for the drone to take off from the Home point is 60 meters. When the UAV needs to perform the flight mission of the preset route as shown by the dotted line shown in Figure 2, the UAV will automatically take off and lift off the ground in rotor mode from the Home point. During the ascent of the rotor mode, the user clicks The rod can change the heading of the drone, for example, so that the heading of the drone is aligned with the target direction. For example, the target direction can be the direction from the first waypoint to the second waypoint. When the UAV rises to a preset height of 60 meters, the UAV automatically triggers the flight route entry mission. The UAV first enters the forward transition process. During the forward transition, the flight mode of the UAV switches from rotor mode to fixed wing mode, and the moment when the UAV switches from rotor mode to fixed wing mode The height is 60m, and the instantaneous position relative to the home point is (0m, 100m). At this time, the speed direction of the drone is the target direction. The instantaneous position is specifically the current position point B as described above. Further, according to the position information of the current position of the drone, the speed direction, and the radius of the start circle and the end circle set by the user, two start points tangent to the speed direction are dynamically generated on the left and right sides of the speed direction. Starting circle, the coordinates of the center of the starting circle on the left are (-100m, 100m), and the coordinates of the center of the starting circle on the right are (100m, 100m); the opposite of the route segment between the first waypoint and the second waypoint Two end circles are dynamically generated to both sides of the extension line, the center position coordinates of the left end circle are (-600m, 500m), and the center position coordinates of the right end circle are (-400m, 500m). By tangentially connecting the two starting circles and the two ending circles, 4 alternative routes as shown in Figure 5 can be generated. Further, according to the above-mentioned limitation conditions of the maximum allowable climb trajectory inclination angle θ _max , the following four sets of results are calculated:

1) When the drone is flying along an alternate route consisting of a left starting circle and a left ending circle, the drone's horizontal range is 1896m, and the number of cycles the drone needs to circle and climb on the left end circle is 1 circle , The trajectory inclination angle of the UAV hovering and climbing is 4.22°.

2) When the drone is flying along an alternative route consisting of a left starting circle and a right ending circle, the drone's horizontal range is 1906m, and the number of times the drone needs to hover and climb on the right end circle is 2 times , The trajectory inclination angle of the UAV hovering and climbing is 4.20°.

3) When the drone flies along an alternate route consisting of a right start circle and a left end circle, the drone's horizontal range is 1713m, and the number of laps the drone needs to hover and climb on the left end circle is 0. , The trajectory inclination angle of the UAV hovering and climbing is 4.67°.

4) When the drone is flying along the alternate route consisting of the right starting circle and the right ending circle, the drone's horizontal range is 1896m, and the number of cycles the drone needs to hover and climb on the right end circle is 1 circle , The trajectory inclination angle of the UAV hovering and climbing is 4.22°.

According to the above four sets of results, when the drone flies along an alternative route consisting of a right start circle and a left end circle, the drone's horizontal range is the shortest. Therefore, the right start circle and left end circle The alternate route composed of circles serves as the target route of the UAV from the current position point B to the first waypoint. The UAV flies to the first waypoint in sequence according to the starting arc phase, the ending circle tangent phase, the ending arc phase, and the preparation phase before entering the preset route corresponding to the target route.

The embodiment of the present invention provides a control device for a drone. FIG. 14 is a structural diagram of a UAV control device provided by an embodiment of the present invention. As shown in FIG. 14, the control device 140 includes: a memory 141 and a processor 142; the memory 141 is used to store program codes; the processor 142, The program code is called, and when the program code is executed, it is used to perform the following operations: According to the current position information of the drone and the position information of the first waypoint and the second waypoint in the preset route, determine from The target route from the current position of the drone to the first waypoint, wherein the direction when the drone enters the first waypoint along the target route is the same as the direction along the drone The direction of the preset route from the first waypoint to the second waypoint is the same; according to the target route, the drone is controlled to fly to the first waypoint.

Optionally, the processor 142 determines from the current position of the drone to the first waypoint according to the current position information of the drone and the position information of the first waypoint and the second waypoint in the preset route. The target route of a waypoint is specifically used to: determine from the unmanned aircraft according to the current position information of the drone and the position information of the first waypoint and the second waypoint in the preset route. Multiple alternative routes from the current position of the aircraft to the first waypoint; determining the target route from the multiple alternative routes.

Optionally, the processor 142 determines from the current position of the drone to the current position of the drone according to the current position information of the drone and the position information of the first waypoint and the second waypoint in the preset route. When the multiple alternative routes of the first waypoint are described, it is specifically used to determine the first starting circle and the first starting circle tangent to the speed direction of the drone at the current position according to the current position information of the drone The second starting circle; according to the route segment between the first waypoint and the second waypoint in the preset route, the first ending circle and the second ending circle are determined, the first ending circle and the The second end circle is respectively tangent to the reverse extension line of the route segment; according to the first start circle or the second start circle, and the first end circle or the second end circle, Determine multiple alternative routes from the current position of the drone to the first waypoint.

Optionally, each of the multiple alternative routes includes a first route segment, a second route segment, and a third route segment that are sequentially connected; the first route segment may be projected on the first route segment. Circle, the third route segment can be projected on a second circle, the second route segment is respectively tangent to the first circle and the second circle, and the first circle is the first starting circle or The second starting circle, the second circle is the first ending circle or the second ending circle.

Optionally, the second route segment includes a first sub-route, a second sub-route, and a third sub-route; wherein the first sub-route is connected to the first route segment, and the third sub-route is connected to the The third route segment is connected; the second sub route can be projected on a climb circle, the first sub route is tangent to the first circle and the climb circle, and the third sub route is connected to the climb circle. The second circle is tangent to the climbing circle.

Optionally, the climb circle is set by the user through the user interface of the control terminal.

Optionally, the processor 142 determines from the current position of the drone to the current position of the drone according to the first starting circle or the second starting circle, and the first ending circle or the second ending circle. The multiple alternative routes of the first waypoint are specifically used to: according to the first starting circle or the second starting circle, the climb circle, and the first ending circle or the first Second, the termination circle is to determine multiple alternative routes from the current position of the drone to the first waypoint.

Optionally, each of the candidate routes further includes: a fourth route segment, and the fourth route segment is respectively connected to the third route segment and the first waypoint.

Optionally, the altitude of the drone gradually increases on at least one of the first route segment, the second route segment, and the third route segment.

Optionally, when the processor 142 determines the target route from the multiple alternative routes, it is specifically configured to: determine that the drone follows each of the multiple alternative routes. During the course of the route from the current position to the first waypoint, the horizontal range of the UAV; the candidate route with the shortest horizontal range among the multiple alternative routes is determined as the target route .

Optionally, the processor 142 determines that while the drone is flying from the current position to the first waypoint along each of the multiple alternative routes, When the horizontal range of the drone is described, it is specifically used to: determine that the drone is along the alternative route according to the height of the drone at the current position and the height of the first waypoint When flying, the drone needs to hover and climb the number of laps on the second route segment and/or the third route segment; according to the drone's needs in the second route segment and/or the third route segment The number of circling and climbing laps on the third route segment determines the level of the drone during the flight from the current position to the first waypoint along the alternative route voyage.

Optionally, the processor 142 determines that when the drone is flying along the alternative route according to the altitude of the drone at the current position and the altitude of the first waypoint, the When the man-machine needs to hover and climb the number of laps on the second route segment and/or the third route segment, it is specifically used to: according to the altitude of the drone at the current position and the first The altitude of the waypoint, determining the inclination of the trajectory at which the drone needs to hover and climb on the second route segment and/or the third route segment when the drone is flying along the alternative route, The trajectory inclination angle of the spiral climb is less than or equal to a preset climb trajectory inclination angle threshold.

Optionally, the trajectory inclination of the drone hovering and climbing is based on the altitude difference between the altitude of the drone at the current position and the altitude of the first waypoint, and the altitude of the drone while climbing The horizontal voyage in the process is determined.

Optionally, the processor 142 determines from the current position of the drone to the first waypoint according to the current position information of the drone and the position information of the first waypoint and the second waypoint in the preset route. Before the target route of a waypoint, it is also used to control the drone to fly along the target direction to the current position after ascending from the starting point to the preset height.

Optionally, the target direction is a direction indicated by a remote control instruction sent by a control terminal, or a direction when the drone rises to the preset height.

Optionally, when the processor 142 controls the drone to rise from the starting point to the preset height, it is specifically configured to control the drone to rise from the starting point to the preset height in the rotor mode.

Optionally, in the process of the drone flying to the current position along the target direction, the processor 142 is further configured to: when the rotor lift of the drone is less than a preset lift, and the When the airspeed of the man-machine is greater than the first airspeed threshold, the drone is switched from the rotor mode to the fixed wing mode.

Optionally, during the process of the drone flying to the current position along the target direction, the processor 142 is further configured to: when the airspeed of the drone is greater than a second airspeed threshold, The drone is switched from the rotor mode to the fixed wing mode.

The specific principles and implementation manners of the control device provided in the embodiment of the present invention are similar to those in the foregoing embodiment, and will not be repeated here.

The embodiment of the present invention provides a drone. The unmanned aerial vehicle includes a fuselage, a power system, and the above-mentioned control device, wherein the power system is installed on the fuselage to provide flight power. The power system includes at least one of the following: a motor, a propeller, and an electronic governor. The control device can execute the above-mentioned UAV control method, and the specific principle and implementation process of the method are as described above, and will not be repeated here.

In addition, this embodiment also provides a computer-readable storage medium on which a computer program is stored, and the computer program is executed by a processor to implement the drone control method described in the foregoing embodiment.

In the several embodiments provided by the present invention, it should be understood that the disclosed device and method may be implemented in other ways. For example, the device embodiments described above are only illustrative. For example, the division of the units is only a logical function division, and there may be other divisions in actual implementation, for example, multiple units or components can be combined or It can be integrated into another system, or some features can be ignored or not implemented. In addition, the displayed or discussed mutual coupling or direct coupling or communication connection may be indirect coupling or communication connection through some interfaces, devices or units, and may be in electrical, mechanical or other forms.

The units described as separate components may or may not be physically separated, and the components displayed as units may or may not be physical units, that is, they may be located in one place, or they may be distributed on multiple network units. Some or all of the units may be selected according to actual needs to achieve the objectives of the solutions of the embodiments.

In addition, the functional units in the various embodiments of the present invention may be integrated into one processing unit, or each unit may exist alone physically, or two or more units may be integrated into one unit. The above-mentioned integrated unit may be implemented in the form of hardware, or may be implemented in the form of hardware plus software functional units.

The above-mentioned integrated unit implemented in the form of a software functional unit may be stored in a computer readable storage medium. The above-mentioned software functional unit is stored in a storage medium and includes several instructions to make a computer device (which may be a personal computer, a server, or a network device, etc.) or a processor execute the method described in the various embodiments of the present invention. Part of the steps. The aforementioned storage media include: U disk, mobile hard disk, read-only memory (Read-Only Memory, ROM), random access memory (Random Access Memory, RAM), magnetic disk or optical disk and other media that can store program code .

Those skilled in the art can clearly understand that, for the convenience and conciseness of the description, only the division of the above-mentioned functional modules is used as an example. In practical applications, the above-mentioned functions can be allocated by different functional modules as required, namely, the device The internal structure is divided into different functional modules to complete all or part of the functions described above. For the specific working process of the device described above, reference may be made to the corresponding process in the foregoing method embodiment, which is not repeated here.

Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention, but not to limit it; although the present invention has been described in detail with reference to the foregoing embodiments, those of ordinary skill in the art should understand: It is still possible to modify the technical solutions described in the foregoing embodiments, or equivalently replace some or all of the technical features; these modifications or replacements do not make the essence of the corresponding technical solutions deviate from the technical solutions of the embodiments of the present invention range.

Claims

A control method of unmanned aerial vehicle, characterized in that it comprises:

According to the current position information of the drone and the position information of the first waypoint and the second waypoint in the preset route, determine the target route from the current position of the drone to the first waypoint , Wherein the direction when the drone enters the first waypoint along the target route is the same as the drone flies from the first waypoint to the second waypoint along the preset route The directions of all waypoints are the same;

According to the target route, the drone is controlled to fly to the first waypoint.
The method according to claim 1, characterized in that, according to the current position information of the drone and the position information of the first waypoint and the second waypoint in the preset route, it is determined from the unmanned aircraft The target route from the aircraft’s current position to the first waypoint includes:

According to the current position information of the drone and the position information of the first waypoint and the second waypoint in the preset route, determine the distance from the current position of the drone to the first waypoint Multiple alternative routes;

The target route is determined from the plurality of alternative routes.
The method according to claim 2, characterized in that, according to the current position information of the UAV and the position information of the first waypoint and the second waypoint in the preset route, it is determined from the Multiple alternative routes from the current position of the drone to the first waypoint include:

Determine the first starting circle and the second starting circle tangent to the speed direction of the drone at the current position according to the current position information of the drone;

According to the route segment between the first waypoint and the second waypoint in the preset route, a first end circle and a second end circle are determined, the first end circle and the second end circle are respectively Tangent to the reverse extension line of the route segment;

According to the first starting circle or the second starting circle, and the first ending circle or the second ending circle, determine the distance from the current position of the drone to the first waypoint Multiple alternative routes.
The method according to claim 3, wherein each of the plurality of alternative routes includes a first route segment, a second route segment, and a third route segment that are sequentially connected;

The first route segment can be projected on a first circle, the third route segment can be projected on a second circle, and the second route segment is tangent to the first circle and the second circle. The first circle is the first starting circle or the second starting circle, and the second circle is the first ending circle or the second ending circle.
The method according to claim 4, wherein the second route segment includes a first sub-route, a second sub-route, and a third sub-route; wherein the first sub-route and the first route segment Connected, the third sub-route is connected with the third route segment;

The second sub-course may be projected on a climb circle, the first sub-course is tangent to the first circle and the climb circle, and the third sub-course is respectively tangent to the second circle and the climb The circle is tangent.
The method according to claim 5, wherein the climb circle is set by a user through a user interface of a control terminal.
The method according to claim 5 or 6, characterized in that, according to the first starting circle or the second starting circle, and the first ending circle or the second ending circle, determining from Multiple alternative routes from the current position of the drone to the first waypoint include:

According to the first start circle or the second start circle, the climb circle, and the first end circle or the second end circle, determine from the current position of the drone to the first Multiple alternative routes for a waypoint.
The method according to any one of claims 4-7, wherein each of the alternative routes further comprises: a fourth route segment, and the fourth route segment is respectively connected to the third route segment and the The first waypoint is connected.
The method according to claim 8, wherein the fourth route segment satisfies at least one of the following conditions:

The height of the fourth route segment is the same as the height of the first waypoint;

The flying speed of the drone on the fourth route segment is the same as the preset speed of the first waypoint;

The direction of the fourth route segment is consistent with the direction of the route segment between the first waypoint and the second waypoint.
The method according to claim 4, wherein the flying speed of the drone on the first route segment, the second route segment, and the third route segment is the first route The preset speed of the point.
The method according to any one of claims 4-10, wherein the height of the drone is at least one of the first route segment, the second route segment, and the third route segment Gradually increase on the route.
The method according to any one of claims 4-11, wherein the determining the target route from the multiple alternative routes comprises:

In the process of determining that the drone flies from the current position to the first waypoint along each of the multiple alternative routes, the horizontal range of the drone ；

The candidate route with the shortest horizontal voyage among the plurality of candidate routes is determined as the target route.
The method according to claim 12, wherein the determining that the drone flies from the current position to the first one along each of the plurality of alternative routes During the course of three waypoints, the horizontal range of the UAV includes:

According to the altitude of the drone at the current position and the altitude of the first waypoint, it is determined that when the drone is flying along the alternate route, the drone needs to be in the first The number of circling climbs on the second course segment and/or the third course segment;

According to the number of laps the drone needs to circulate and climb on the second route segment and/or the third route segment, it is determined that the drone will fly from the current position to the The horizontal range of the drone during the first waypoint.
The method according to claim 13, wherein the determining that the drone is along the backup path according to the height of the drone at the current position and the height of the first waypoint When selecting a flight route, the number of laps that the UAV needs to hover and climb on the second route segment and/or the third route segment includes:

According to the altitude of the drone at the current position and the altitude of the first waypoint, it is determined that when the drone is flying along the alternate route, the drone needs to be in the first The trajectory inclination angle of the spiral climb on the second route segment and/or the third route segment, the trajectory inclination angle of the spiral climb is less than or equal to a preset climb trajectory inclination angle threshold.
The method according to claim 14, wherein the trajectory inclination of the drone hovering and climbing is based on the height difference between the height of the drone at the current position and the height of the first waypoint , And the horizontal range of the UAV in the climbing process is determined.
The method according to claim 1, characterized in that, according to the current position information of the drone and the position information of the first waypoint and the second waypoint in the preset route, it is determined from the unmanned aircraft Before the current position of the aircraft to the target route of the first waypoint, the method further includes:

The drone is controlled to rise from the starting point to the preset height and then fly along the target direction to the current position.
The method according to claim 16, wherein the target direction is a direction indicated by a remote control instruction sent by a control terminal, or a direction when the drone rises to the preset height.
The method according to claim 16 or 17, wherein the controlling the drone to rise from the starting point to a preset height comprises:

In the rotor mode, the drone is controlled to rise from the starting point to a preset height.
The method according to claim 16 or 17, wherein during the process of the drone flying to the current position along the target direction, the flight mode of the drone changes from a rotor mode to a fixed Wing pattern.
The method according to claim 19, characterized in that, during the process of the drone flying to the current position along the target direction, the method further comprises:

When the rotor lift of the drone is less than the preset lift, and the airspeed of the drone is greater than the first airspeed threshold, the drone is switched from the rotor mode to the fixed wing mode.
The method according to claim 19, characterized in that, during the process of the drone flying to the current position along the target direction, the method further comprises:

When the airspeed of the drone is greater than the second airspeed threshold, switch the drone from the rotor mode to the fixed wing mode.
A control device for an unmanned aerial vehicle, which is characterized by comprising: a memory and a processor;

The memory is used to store program codes;

The processor calls the program code, and when the program code is executed, is used to perform the following operations:

According to the current position information of the drone and the position information of the first waypoint and the second waypoint in the preset route, determine the target route from the current position of the drone to the first waypoint , Wherein the direction when the drone enters the first waypoint along the target route is the same as the drone flies from the first waypoint to the second waypoint along the preset route The directions of all waypoints are the same;

According to the target route, the drone is controlled to fly to the first waypoint.
The control device according to claim 22, wherein the processor determines from the current location information of the drone and the location information of the first waypoint and the second waypoint in the preset route. When the UAV’s current position to the target route of the first waypoint is specifically used for:

According to the current position information of the drone and the position information of the first waypoint and the second waypoint in the preset route, determine the distance from the current position of the drone to the first waypoint Multiple alternative routes;

The target route is determined from the plurality of alternative routes.
The control device according to claim 23, wherein the processor determines according to the current position information of the drone and the position information of the first waypoint and the second waypoint in the preset route When multiple alternative routes from the current position of the UAV to the first waypoint are specifically used for:

Determine the first starting circle and the second starting circle tangent to the speed direction of the drone at the current position according to the current position information of the drone;

According to the route segment between the first waypoint and the second waypoint in the preset route, a first end circle and a second end circle are determined, the first end circle and the second end circle are respectively Tangent to the reverse extension line of the route segment;

According to the first starting circle or the second starting circle, and the first ending circle or the second ending circle, determine the distance from the current position of the drone to the first waypoint Multiple alternative routes.
The control device according to claim 24, wherein each of the plurality of alternative routes includes a first route segment, a second route segment, and a third route segment that are sequentially connected;

The first route segment can be projected on a first circle, the third route segment can be projected on a second circle, and the second route segment is tangent to the first circle and the second circle. The first circle is the first starting circle or the second starting circle, and the second circle is the first ending circle or the second ending circle.
The control device according to claim 25, wherein the second route segment includes a first sub-route, a second sub-route, and a third sub-route; wherein the first sub-route and the first route Segment connection, the third sub-route is connected with the third route segment;

The second sub-course may be projected on a climb circle, the first sub-course is tangent to the first circle and the climb circle, and the third sub-course is respectively tangent to the second circle and the climb The circle is tangent.
The control device according to claim 26, wherein the climb circle is set by the user through the user interface of the control terminal.
The control device according to claim 26 or 27, wherein the processor is based on the first starting circle or the second starting circle, and the first ending circle or the second ending circle , When determining multiple alternative routes from the current position of the drone to the first waypoint, it is specifically used to:

According to the first start circle or the second start circle, the climb circle, and the first end circle or the second end circle, determine from the current position of the drone to the first Multiple alternative routes for a waypoint.
The control device according to any one of claims 25-28, wherein each of the alternative routes further comprises: a fourth route segment, and the fourth route segment is respectively connected to the third route segment and the third route segment. Describe the first waypoint connection.
The control device according to claim 29, wherein the fourth route segment satisfies at least one of the following conditions:

The height of the fourth route segment is the same as the height of the first waypoint;

The flying speed of the drone on the fourth route segment is the same as the preset speed of the first waypoint;

The direction of the fourth route segment is consistent with the direction of the route segment between the first waypoint and the second waypoint.
The control device according to claim 25, wherein the flying speed of the UAV on the first route segment, the second route segment, and the third route segment is the first one. The preset speed of the waypoint.
The control device according to any one of claims 25-31, wherein the height of the drone is at least in the first route segment, the second route segment, and the third route segment. Gradually increase on a route.
The control device according to any one of claims 25-32, wherein when the processor determines the target route from the multiple alternative routes, it is specifically configured to:

In the process of determining that the drone flies from the current position to the first waypoint along each of the multiple alternative routes, the horizontal range of the drone ；

The candidate route with the shortest horizontal voyage among the plurality of candidate routes is determined as the target route.
The control device according to claim 33, wherein the processor determines that the UAV flies from the current position to the current position along each of the plurality of alternative routes. In the process of describing the first waypoint, the horizontal range of the UAV is specifically used for:

According to the altitude of the drone at the current position and the altitude of the first waypoint, it is determined that when the drone is flying along the alternate route, the drone needs to be in the first The number of circling climbs on the second course segment and/or the third course segment;

According to the number of laps the drone needs to circulate and climb on the second route segment and/or the third route segment, it is determined that the drone will fly from the current position to the The horizontal range of the drone during the first waypoint.
The control device according to claim 34, wherein the processor determines that the drone is along the line according to the height of the drone at the current position and the height of the first waypoint. When flying on the alternate route, when the drone needs to hover and climb on the second route segment and/or the third route segment, it is specifically used for:

According to the altitude of the drone at the current position and the altitude of the first waypoint, it is determined that when the drone is flying along the alternate route, the drone needs to be in the first The trajectory inclination angle of the spiral climb on the second route segment and/or the third route segment, the trajectory inclination angle of the spiral climb is less than or equal to a preset climb trajectory inclination angle threshold.
The control device according to claim 35, wherein the trajectory inclination of the drone hovering and climbing is based on the height of the drone at the current position and the height of the first waypoint Difference, and the horizontal range is determined.
The control device according to claim 22, wherein the processor determines from the current location information of the drone and the location information of the first waypoint and the second waypoint in the preset route. Before the current position of the drone to the target route of the first waypoint, it is also used to:

The drone is controlled to rise from the starting point to the preset height and then fly along the target direction to the current position.
The control device according to claim 37, wherein the target direction is a direction indicated by a remote control instruction sent by a control terminal, or a direction when the drone rises to the preset height.
The control device according to claim 37 or 38, wherein when the processor controls the drone to rise from a starting point to a preset height, it is specifically configured to:

In the rotor mode, the drone is controlled to rise from the starting point to a preset height.
The control device according to claim 37 or 38, wherein when the drone is flying along the target direction to the current position, the flight mode of the drone changes from the rotor mode to Fixed-wing mode.
The control device according to claim 40, wherein during the process of the drone flying to the current position along the target direction, the processor is further configured to:

When the rotor lift of the drone is less than the preset lift, and the airspeed of the drone is greater than the first airspeed threshold, the drone is switched from the rotor mode to the fixed wing mode.
The control device according to claim 40, wherein during the process of the drone flying to the current position along the target direction, the processor is further configured to:

When the airspeed of the drone is greater than the second airspeed threshold, switching the drone from the rotor mode to the fixed wing mode.
An unmanned aerial vehicle, characterized in that it includes:

body;

The power system is installed on the fuselage to provide flight power;

And the control device of any one of claims 22-42.
A computer-readable storage medium, characterized in that a computer program is stored thereon, and the computer program is executed by a processor to implement the method of any one of claims 1-21.