WO2017211029A1

WO2017211029A1 - Method and device for planning flight path for unmanned aerial vehicle

Info

Publication number: WO2017211029A1
Application number: PCT/CN2016/102115
Authority: WO
Inventors: 兰功金; 郝祁; 胡晨旭
Original assignee: 南方科技大学
Priority date: 2016-06-07
Filing date: 2016-10-14
Publication date: 2017-12-14
Also published as: CN106054920A

Abstract

A method and device for planning a flight path for an unmanned aerial vehicle. The method comprises: receiving a user input waypoint (101); determining, according to a coordinate of the waypoint, a function of a curved path including the waypoint, wherein the coordinate comprises latitude and longitude (102); subdividing, according to the function of the curved path, and the coordinate of the waypoint, the waypoint, to obtain coordinates of subdivided waypoints (103); and employing the coordinates of the waypoint and the subdivided waypoints to determine a flight path of the unmanned aerial vehicle (104).

Description

UAV flight path planning method and device

Technical field

The present disclosure relates to drone technology, for example, to a drone flight path planning method and apparatus.

Background technique

With the development of drone technology, drones have been applied to many fields. For example, use a drone to scan a building in three dimensions. At present, UAVs generally use a straight-line flight method when flying on a route, that is, after selecting GPS waypoints on the route (such as A, B, C, D, E, etc.), the drone starts from A, and then Go to B, then to C, and so on, to complete the automatic flight of all marked waypoints by way of a straight flight between waypoints and waypoints.

In the related art, many designers further simplify the steps of the UAV flight for safety reasons, that is, let the drone fly to a predetermined height, and then consider the flight in the two-dimensional plane of the height. For example, the drone should fly from point A to point B. The height of A is 15m and the height of B is 20m. The unmanned opportunity first rises 5m to a height of 20m, and then executes the instruction to fly to B in a two-dimensional plane. This situation is essentially a straight flight between waypoints.

The drawback of the above-mentioned drone's straight flight mode between waypoints is that it is only suitable for open space and cannot be used in complex environments; in the process of building a building using a drone, if the shape of the building is round The shape or irregular shape is limited by the working distance of the scanning device. It cannot realize the scanning of the building within the effective range, and the flying distance is long during the flight of the drone, and the electric energy consumed is too much, resulting in the drone. The effective working hours for performing tasks are greatly reduced.

Summary of the invention

The present disclosure provides a UAV flight path planning method and apparatus, so that the UAV can complete the flight task more safely and efficiently, and improve the adaptability of the UAV to perform tasks in a complex environment.

In a first aspect, an embodiment of the present disclosure provides a method for planning a flight path of a drone, including:

Receiving a waypoint entered by the user;

Determining an equation including an arc of the waypoint according to coordinate information of the waypoint, the coordinate information including longitude information and latitude information;

And segmenting the waypoint according to the equation of the arc and the coordinate information of the waypoint to obtain coordinate information of the segmented waypoint;

The coordinate information of the waypoint and the subdivided waypoint is taken as a flight path of the drone.

Optionally, after receiving the waypoint input by the user, the method further includes: receiving height information corresponding to the waypoint input by the user;

Correspondingly, the coordinate information includes longitude information, latitude information, and altitude information.

Optionally, determining an equation including an arc of the waypoint according to coordinate information of the waypoint includes:

The waypoints are grouped in order, wherein each group includes three waypoints, and the equations of the arcs corresponding to the waypoints corresponding to each group of waypoints are respectively determined according to the coordinate information of the waypoints in each group.

Optionally, the method further includes:

The user's selection operation is monitored, and the waypoint selected by the user is set as the connected waypoint, and the flight paths of the two adjacent connected waypoints are set as straight lines.

A coordinate system in which the takeoff point of the drone is zero is established, the coordinate information of the waypoint is mapped to a point in the coordinate system, and an equation of the arc including the waypoint is determined in the coordinate system.

In a second aspect, an embodiment of the present disclosure further provides a UAV flight path planning apparatus, including:

a waypoint receiving module, configured to receive a waypoint input by the user;

An arc calculation module, configured to determine an equation including an arc of the waypoint according to coordinate information of the waypoint, where the coordinate information includes longitude information and latitude information;

a waypoint subdivision module is configured to subdivide the waypoint according to the equation of the arc and the coordinate information of the waypoint to obtain coordinate information of the subdivided waypoint;

The flight path determining module is configured to use coordinate information of the waypoint and the subdivided waypoint as a flight path of the drone.

Optionally, the waypoint receiving module is further configured to: receive height information corresponding to the waypoint input by the user;

Optionally, the arc calculation module is set to:

Optionally, the waypoint receiving module is further configured to:

Optionally, the arc calculation module is set to:

The present disclosure determines an equation including an arc of the waypoint according to the coordinate information of the waypoint by receiving a waypoint input by the user, the coordinate information including longitude information and latitude information, according to the equation and the arc of the arc The coordinate information of the waypoint is subdivided to obtain the coordinate information of the subdivided waypoint, and the coordinate information of the waypoint and the subdivided waypoint is taken as the flight path of the drone, and the correlation is solved. The technical UAV flight path planning scheme is only applicable to the open space, can not be applied to complex environments and has a long flight distance during the flight of the drone, consumes more electric energy, and has a short effective working time. The realization of the drone's safer and more efficient completion of the mission, improving the adaptability of the drone to perform tasks in a complex environment.

DRAWINGS

1 is a flowchart of a method for planning a flight path of a drone according to Embodiment 1 of the present disclosure;

2 is a schematic diagram showing a flight path planning method in the prior art;

3 is a schematic diagram of a method for planning a flight path of a drone according to Embodiment 1 of the present disclosure;

4 is a schematic diagram of a UAV flight path planning method according to Embodiment 2 of the present disclosure;

5 is a flowchart of a method for planning a flight path of a drone according to Embodiment 3 of the present disclosure;

6 is a schematic diagram of a UAV flight path planning method according to Embodiment 3 of the present disclosure;

7 is a flowchart of a method for planning a flight path of a drone according to Embodiment 4 of the present disclosure;

8 is a schematic diagram of a UAV flight path planning method according to Embodiment 4 of the present disclosure;

FIG. 9 is a structural diagram of an unmanned aerial vehicle flight path planning apparatus according to Embodiment 5 of the present disclosure.

detailed description

The present disclosure will be further described in detail below in conjunction with the accompanying drawings and embodiments. It will be understood that the features of the following embodiments and embodiments may be combined with each other without conflict.

Embodiment 1

1 is a flowchart of a method for planning a flight path of a drone according to Embodiment 1 of the present disclosure. The present embodiment is applicable to a situation in which an aerial camera or a building is scanned during a take-off flight of a drone, and the method may be A computing device, such as a tablet, mobile phone, or computer, is executed, including the following steps. Step:

Step 101: Receive a waypoint input by a user.

Among them, the waypoint represents the point that the drone needs to pass during the flight, and the flight path of the drone can be set by setting the waypoint. For example, in the prior art, a plurality of waypoints are first set, and then the drone performs a straight flight along each waypoint. Illustratively, FIG. 2 shows a schematic diagram of a flight path planning method in the prior art. As shown in Figure 2, suppose the drone needs to fly around the circular area on the way. First, the user inputs three waypoints A, B, and C. Then the drone has A straight line to B, and then B straight line to C. Then fly straight from C to A. Exemplarily, the manner in which the user inputs the waypoint may be directly marked in the software on the ground side, and the ground end software is dedicated software developed for the drone, and the software integrates the Google Earth database plug-in, such as in Google. In the map plug-in, by clicking the location in the map as the waypoint of the drone, the user can manually input the location information of the waypoint, such as inputting latitude and longitude.

Step 102: Determine an equation including an arc of the waypoint according to coordinate information of the waypoint, where the coordinate information includes longitude information and latitude information.

Illustratively, according to the principle that three points can uniquely determine a circle, an arc containing the waypoint can be determined according to three waypoints. FIG. 3 is a schematic diagram of a UAV flight path planning method according to Embodiment 1 of the present disclosure. As shown in Figure 3, three waypoints A1, B1 and C1 are marked in the figure. The circular area in the middle is the area where the drone needs to be photographed by flying. The arc determined according to A1, B1 and C1 is the circle of the outer ring. Specifically, the coordinate information includes longitude information and latitude information, that is, the arcs of the A1 to B1, B1 and then C1, C1 and then A1 can be obtained by the respective longitude and latitude coordinates of A1, B1 and C1.

Step 103: Subdivide the waypoint according to the equation of the arc and the coordinate information of the waypoint to obtain coordinate information of the segmented waypoint.

Wherein, according to the waypoints input by the user, the arcs covering the waypoints are added, and the segmentation waypoints are added between the waypoints. As shown in FIG. 3, a plurality of navigations are subdivided between A1, B1 and C1. point. Specific, subdivided The point spacing size depends on the size of the specific arc radians. Optionally, the larger the radius of the circle, the smaller the number of waypoints to be subdivided, that is, the larger the interval between the subdivided waypoints. Since the radius of the circle where the waypoint arc is larger means that the arc between the two waypoints is closer to a straight line, the fewer waypoints need to be subdivided, on the contrary, the more subdivided waypoints are It can meet the purpose of flying along a circular path during the flight of the drone. The coordinates of the subdivided waypoints a-e can be obtained according to the coordinates of the waypoints A1, B1 and C1 and the equation of the arc determined by it.

Step 104: The coordinate information of the waypoint and the subdivided waypoint is used as a flight path of the drone.

Wherein, the flight control unit of the drone acquires the flight information of the current drone (such as longitude, latitude, etc.) in real time, and calibrates the flight parameters in real time during flight to perform a predetermined flight path, the predetermined flight The path is composed of several waypoints originally input by the user obtained in this step and the latitude and longitude coordinates of a large number of subdivided waypoints subdivided by the small number of waypoints.

The working principle of the UAV flight path planning method is to use three points to confirm the unique circle of the space, and then automatically subdivide the arc, and subdivide into a plurality of subdivided waypoints to form a flight path of the UAV.

In the technical solution of the embodiment, by receiving a waypoint input by a user, determining an equation of an arc including the waypoint according to coordinate information of the waypoint, the coordinate information includes longitude information and latitude information, according to the circle The equation of the arc and the coordinate information of the waypoint subdivide the waypoint to obtain coordinate information of the subdivided waypoint, and use the coordinate information of the waypoint and the subdivided waypoint as the flight of the drone path. The unmanned aerial vehicle flight path planning scheme that solves the related technology is only applicable to an open space, cannot be applied to a complicated environment, and has a long flight distance during the flight of the drone, consumes more electric energy, and has a short effective working time. The realization of the drone's safer and more efficient completion of the mission, improving the adaptability of the drone to perform tasks in a complex environment.

Embodiment 2

FIG. 4 is a schematic diagram of a UAV flight path planning method according to Embodiment 2 of the present disclosure. This embodiment further increases the height information of the waypoint based on the first embodiment.

On the basis of the foregoing technical solution, after receiving the waypoint input by the user, the method further includes: receiving height information corresponding to the waypoint input by the user; correspondingly, the coordinate information includes longitude information, latitude information, and altitude information.

Exemplarily, the scene switching can be performed in the map software, and the plane view is switched to the stereoscopic view, thereby directly selecting the point in the stereo space, and the point has the height information. Optionally, the user can also manually enter the size of the height information value. As shown in FIG. 4, using the principle of three points to confirm the space unique circle, according to the waypoints A2, B2, and C2, an arc passing through the three points can be uniquely determined. Since the height information of the waypoint is introduced in this embodiment, That is, the arcs passing through A2, B2, and C2 also have height values, and the coordinate information of the corresponding subdivided waypoints also includes longitude information, latitude information, and altitude information.

Based on the foregoing embodiments, determining an equation including an arc of the waypoint according to coordinate information of the waypoint includes: establishing a coordinate system with a takeoff point of the drone as a zero point, and setting coordinates of the waypoint The information is mapped to points in a coordinate system in which an equation containing the arc of the waypoint is determined. As shown in Figure 4, the spatial coordinate system x, y, z is established. Where o is the zero point coordinate, the coordinate information of the waypoint is mapped into the coordinate system, and the equation of the arc passing through A2, B2 and C2 is obtained according to the coordinates of the waypoint.

Embodiment 3

FIG. 5 is a flowchart of a UAV flight path planning method according to Embodiment 3 of the present disclosure. On the basis of the foregoing embodiments, a path planning method for a UAV to fly around a single object is provided. include:

Step 201: Receive a waypoint input by a user.

Step 202: Group the waypoints in order, wherein each group includes three waypoints, according to each group The coordinate information of the waypoints in the respective points determines the equation of the arc corresponding to the waypoint corresponding to each set of waypoints.

Illustrative, as shown in Figure 6. 6 is a schematic diagram of a method for planning a flight path of a drone according to a third embodiment of the present disclosure. The waypoints input by the user are A3, B3, C3, D3, ..., according to the principle of uniquely determining a circle according to three points, Three of the user-defined waypoints are determined as a group, that is, A3, B3, and C3 are a group, and C3, D3, and E3 are a group (the mark of E3 is hidden in the figure). A unique circle equation is determined by three waypoints in each group, thus achieving a continuous curve flight path with a height difference.

Step 203: Subdivide the waypoint according to the equation of the arc and the coordinate information of the waypoint to obtain coordinate information of the segmented waypoint.

Step 204: The coordinate information of the waypoint and the subdivided waypoint is used as a flight path of the drone.

In the technical solution of the embodiment, after grouping a series of waypoints input by the user, the arc flight path is determined by three waypoints in each group, and the curve path planning for a single target is completed to perform 3D aerial photography or scanning.

Embodiment 4

FIG. 7 is a flowchart of a UAV flight path planning method according to Embodiment 4 of the present disclosure. On the basis of the foregoing embodiments, a path planning method for a UAV to fly around multiple objects is presented. ,include:

Step 301: Receive a waypoint input by a user.

Step 302: The waypoints are grouped in order, wherein each group includes three waypoints, and the equations of the arcs corresponding to the waypoints corresponding to each group of waypoints are respectively determined according to the coordinate information of the waypoints in each group. The user's selection operation is monitored, and the waypoint selected by the user is set as the connection waypoint, and the flight paths of the two adjacent connected waypoints are set as straight lines.

Illustratively, as shown in FIG. 8 is a UAV flight path provided by Embodiment 4 of the present disclosure A schematic diagram of a planning method in which target 1, goal 2, and goal three are three independent target objects. Among them, A4 to B4, C4 to D4 are straight paths. That is, A4, B4, C4 and D4 are the connected waypoints selected by the user. In this solution, in the flight path planning, in order to adapt to the continuous aerial photography or scanning of multiple targets, a connecting waypoint is adopted between the targets, and the planned path corresponds to a straight path to complete the drone in multiple targets. Switch between.

Step 303: Subdivide the waypoint according to the equation of the arc and the coordinate information of the waypoint to obtain coordinate information of the segmented waypoint.

Step 304: The coordinate information of the waypoint and the subdivided waypoint is used as a flight path of the drone.

In the technical solution of the embodiment, by recording a series of waypoints input by the user, the connected waypoints selected by the user are recorded, the arcs are determined by three waypoints in each group, and the plurality of objects are determined by connecting the waypoints. The switching path between the two completes the curve path planning for multiple targets for 3D aerial photography or scanning.

Embodiment 5

FIG. 9 is a structural diagram of a UAV flight path planning apparatus according to Embodiment 5 of the present disclosure, including:

The waypoint receiving module 1 is configured to receive a waypoint input by the user;

The arc calculation module 2 is configured to determine an equation including an arc of the waypoint according to coordinate information of the waypoint, the coordinate information including longitude information and latitude information;

The waypoint subdivision module 3 is configured to subdivide the waypoint according to the equation of the arc and the coordinate information of the waypoint to obtain coordinate information of the subdivided waypoint;

The flight path determining module 4 is configured to use coordinate information of the waypoint and the subdivided waypoint as a flight path of the drone.

The technical solution provided by this embodiment receives the user-entered waypoint according to the waypoint The target information determines an equation including an arc of the waypoint, the coordinate information includes longitude information and latitude information, and the waypoint is subdivided according to the equation of the arc and the coordinate information of the waypoint, The coordinate information of the waypoint is subdivided, and the coordinate information of the waypoint and the subdivided waypoint is used as the flight path of the drone, and the unmanned aerial vehicle flight path planning scheme for solving the related technology is only applicable to the empty space, and cannot It is applied to complex environments and has a long flight distance during the flight of the drone. It consumes more electric energy and has a shorter effective working time. It realizes that the drone can complete the flight mission safely and efficiently, and improve the drone. Adaptability of complex environments.

On the basis of the foregoing technical solution, the waypoint receiving module is further configured to: receive height information corresponding to the waypoint input by the user;

Based on the above technical solution, the arc calculation module is set as:

Based on the foregoing technical solution, the waypoint receiving module is further configured to:

Based on the above technical solution, the arc calculation module is set as:

A coordinate system in which the takeoff point of the drone is zero is established, the coordinate information of the waypoint is mapped to a point in the space coordinate system, and an equation of the arc including the waypoint is determined in the space coordinate system.

The above product can perform the method provided by any embodiment of the present disclosure, and has the corresponding functional modules and beneficial effects of the execution method.

Embodiments of the present disclosure also provide a non-transitory storage medium containing computer executable instructions for performing any of the above embodiments when executed by a computer processor Aircraft flight path planning method.

Embodiments of the present disclosure also provide a computer program product comprising a computer program stored on a non-transitory computer readable storage medium, the computer program comprising program instructions when the program instructions are When executed, the computer is caused to perform the drone flight path planning method of any of the above embodiments.

Embodiments of the present disclosure also provide an electronic device including: one or more processors and a memory.

The electronic device may further include: an input device and an output device.

The processor, memory, input device, and output device in the electronic device can be connected by a bus or other means.

As a non-volatile computer readable storage medium, the memory can be used to store a non-volatile software program, a non-volatile computer executable program, and a module, as in the UAV flight path planning method in the embodiment of the present application. Program instructions/modules. The processor executes various functional applications of the server and data processing by running non-volatile software programs, instructions, and modules stored in the memory, that is, implementing a drone flight path planning method. Note that the above are only the preferred embodiments of the present disclosure and the technical principles applied thereto. A person skilled in the art will understand that the present disclosure is not limited to the specific embodiments described herein, and that various modifications, changes and substitutions may be made by those skilled in the art without departing from the scope of the disclosure. Therefore, the present disclosure has been described in detail by the above embodiments, but the present disclosure is not limited to the above embodiments, and the present disclosure may include more other equivalent embodiments without departing from the present disclosure. The scope is determined by the scope of the appended claims.

Industrial applicability

The UAV flight path planning method and apparatus of the present disclosure can be applied to a complicated environment and consume The power is small, the effective working time is long, the flight task can be completed more safely and efficiently, and the adaptability of the drone to perform tasks in a complex environment is improved.

Claims

A method for planning a flight path of a drone, comprising:

Receiving a waypoint entered by the user;

Determining an equation including an arc of the waypoint according to coordinate information of the waypoint, the coordinate information including longitude information and latitude information;

And subdividing the waypoint according to the equation of the arc and the coordinate information of the waypoint to obtain coordinate information of the subdivided waypoint;

The coordinate information of the waypoint and the subdivided waypoint is taken as a flight path of the drone.
The method according to claim 1, wherein after receiving the waypoint input by the user, the method further comprises: receiving height information corresponding to the waypoint input by the user;

Correspondingly, the coordinate information includes longitude information, latitude information, and altitude information.
The method according to claim 1 or 2, wherein determining an equation including an arc of the waypoint according to coordinate information of the waypoint comprises:

The waypoints are grouped in order, wherein each group includes three waypoints, and the equations of the arcs corresponding to the waypoints corresponding to each group of waypoints are respectively determined according to the coordinate information of the waypoints in each group.
The method of claim 1 or 2, further comprising:

The user's selection operation is monitored, and the waypoint selected by the user is set as the connected waypoint, and the flight paths of the two adjacent connected waypoints are set as straight lines.
The method according to claim 1 or 2, wherein determining an equation including an arc of the waypoint according to coordinate information of the waypoint comprises:

A coordinate system in which the takeoff point of the drone is zero is established, the coordinate information of the waypoint is mapped to a point in the coordinate system, and an equation of the arc including the waypoint is determined in the coordinate system.
A UAV flight path planning device includes:

a waypoint receiving module, configured to receive a waypoint input by the user;

An arc calculation module, configured to determine an equation including an arc of the waypoint according to coordinate information of the waypoint, where the coordinate information includes longitude information and latitude information;

a waypoint subdivision module is configured to subdivide the waypoint according to the equation of the arc and the coordinate information of the waypoint to obtain coordinate information of the subdivided waypoint;

The flight path determining module is configured to use coordinate information of the waypoint and the subdivided waypoint as a flight path of the drone.
The device according to claim 6, wherein the waypoint receiving module is further configured to: receive height information corresponding to the waypoint input by a user;

Correspondingly, the coordinate information includes longitude information, latitude information, and altitude information.
The apparatus according to claim 6 or 7, wherein said arc calculation module is configured to:

The waypoints are grouped in order, wherein each group includes three waypoints, and the equations of the arcs corresponding to the waypoints corresponding to each group of waypoints are respectively determined according to the coordinate information of the waypoints in each group.
The device according to claim 6 or 7, wherein the waypoint receiving module is further configured to:

The user's selection operation is monitored, and the waypoint selected by the user is set as the connected waypoint, and the flight paths of the two adjacent connected waypoints are set as straight lines.
The apparatus according to claim 6 or 7, wherein said arc calculation module is configured to:

A coordinate system in which the takeoff point of the drone is zero is established, the coordinate information of the waypoint is mapped to a point in the coordinate system, and an equation of the arc including the waypoint is determined in the coordinate system.
A non-transitory storage medium storing computer executable instructions, the computer executable instructions being arranged to perform the drone flight path planning method of any one of claims 1 to 5.
A computer program product comprising a computer program stored on a non-transitory computer readable storage medium, the computer program comprising program instructions that, when executed by a computer, cause the computer to execute The drone flying according to any one of claims 1 to 5 Line path planning method.
An electronic device comprising at least one processor and a memory communicatively coupled to the at least one processor, the memory for storing instructions executable by the at least one processor, the instructions being processed by the at least one When executed, the at least one processor is caused to perform the drone flight path planning method according to any one of claims 1 to 5.