WO2018094576A1

WO2018094576A1 - Unmanned aerial vehicle control method, flight controller, and unmanned aerial vehicle

Info

Publication number: WO2018094576A1
Application number: PCT/CN2016/106818
Authority: WO
Inventors: 王俊喜; 王春明; 邹尧; 吴旭民
Original assignee: 深圳市大疆创新科技有限公司
Priority date: 2016-11-22
Filing date: 2016-11-22
Publication date: 2018-05-31
Also published as: CN107074360B; CN107074360A

Abstract

Provided are a method for controlling an unmanned aerial vehicle (100), a flight controller (40), and the unmanned aerial vehicle (100). The method comprises: acquiring a first detection value of a first detection device (22) and a second detection value of a second detection device (23) (S101); and determining an altitude of the unmanned aerial vehicle (100) with respect to the ground below on the basis of the first detection value and the second detection value (S102). Two detection devices (22, 23) are provided on the unmanned aerial vehicle (100) to separately detect an altitude of the unmanned aerial vehicle (100) with respect to the ground exactly therebelow and a distance at an angle therefrom to the ground in front of the unmanned aerial vehicle (100), so as to determine the altitude of the unmanned aerial vehicle (100) with respect to the ground according to the altitude thereof with respect to the ground exactly therebelow and the distance at an angle therefrom to the ground in front of the unmanned aerial vehicle (100), and thereby the computing accuracy of the altitude of the unmanned aerial vehicle (100) with respect to the ground is improved, and the precision of terrain following of the unmanned aerial vehicle (100) is improved by performing terrain following according to the altitude.

Description

Unmanned aerial vehicle control method, flight controller and unmanned aerial vehicle

Technical field

Embodiments of the present invention relate to the field of drones, and in particular, to a control method for an unmanned aerial vehicle, a flight controller, and an unmanned aerial vehicle.

Background technique

In the prior art, a radar is installed on the unmanned aerial vehicle, and the radar is used to detect the ground around the unmanned aerial vehicle to prevent the UAV from colliding with the ground.

Usually, sensors such as radar, ultrasonic waves, etc. are disposed directly under the UAV to detect the distance between the ground directly below the UAV and the UAV, especially the agricultural unmanned aerial vehicle, directly below the agricultural unmanned aerial vehicle. The radar is set to detect the distance between the crop and the agricultural unmanned aerial vehicle, and to ensure that the agricultural unmanned aerial vehicle maintains a certain distance from the crop during the flight, so that the medicine is evenly sprayed on the surface of the crop.

However, when the local shape is large and the agricultural unmanned aerial vehicle is flying at a high speed or the agricultural unmanned aerial vehicle is flying and defending, the radar-sensed agricultural unmanned aerial vehicle is faster than the height of the crop, and the agricultural unmanned aerial vehicle The power system cannot adjust the flying height of the agricultural unmanned aerial vehicle in real time according to the height of the radar sensing, so that the power system always lags the flying height of the agricultural unmanned aerial vehicle, and the agricultural unmanned aerial vehicle cannot accurately follow the terrain.

Summary of the invention

Embodiments of the present invention provide a method for controlling an unmanned aerial vehicle, a flight controller, and an unmanned aerial vehicle, and the accuracy of terrain following by the unmanned aerial vehicle.

An aspect of an embodiment of the present invention provides a control method for an unmanned aerial vehicle, the unmanned aerial vehicle comprising a first detecting device and a second detecting device, wherein the first detecting device and the second detecting device are respectively used for Measuring a height of the UAV from the ground, a detection direction of the first detecting device is at a preset angle with a yaw axis direction of the UAV, and a detection direction of the second detecting device is along the unmanned The yaw axis direction of the aircraft is set;

The method includes:

Obtaining a first detection value of the first detecting device, and a second detection value of the second detecting device;

Determining, according to the first detection value and the second detection value, a height of the unmanned aerial vehicle from a ground below the unmanned aerial vehicle.

Another aspect of an embodiment of the present invention is to provide a flight controller including one or more processors that work separately or in cooperation, the processor being used to:

Determining, according to the first detection value and the second detection value, a height of the unmanned aerial vehicle from a ground below the unmanned aerial vehicle;

Wherein the unmanned aerial vehicle includes a first detecting device and a second detecting device, wherein the first detecting device and the second detecting device are respectively configured to measure a height of the unmanned aerial vehicle from the ground, the first detecting The detection direction of the device is at a predetermined angle with the yaw axis direction of the UAV, and the detection direction of the second detection device is set along the yaw axis direction of the UAV.

Another aspect of an embodiment of the present invention provides an unmanned aerial vehicle comprising:

body;

a power system mounted to the fuselage for providing flight power;

a first detecting device and a second detecting device are mounted on the body for measuring a height of the UAV from the ground, a detecting direction of the first detecting device and a yaw axis of the UAV The direction of the second detecting device is set along a yaw axis direction of the unmanned aerial vehicle;

a flight controller communicatively coupled to the power system for controlling the UAV flight; the flight controller includes one or more processors, the processor for:

The control method, the flight controller and the unmanned aerial vehicle of the unmanned aerial vehicle provided by the embodiment respectively detect the unmanned aerial vehicle from the front of the unmanned aerial vehicle through two detecting devices provided on the unmanned aerial vehicle The height of the square ground and the distance from the ground in front of it, according to the distance of the unmanned aerial vehicle from its oblique front ground, determine the vertical height of the UAV from its oblique front ground, according to the distance from the unmanned aerial vehicle to the ground directly below it. The height and the vertical height of the UAV from its oblique front ground determine the height of the UAV from the ground below it, ie the height of the UAV from the ground below it is not only related to the height of the UAV from the ground directly below it. It is also related to the vertical height of the UAV from its oblique front ground. The local shape is large, the UAV is flying at a high speed, or the UAV is flying and defending, according to the height of the UAV from the ground directly below it. The vertical height from the obliquely front ground determines the height from the ground below it. Compared with the detection height of a detecting device in the prior art, the calculation accuracy of the unmanned aerial vehicle from the ground height below is improved, and the detection result is avoided. With the terrain fluctuations or the speed of the UAV flight speed changes, Get real-time power system can adjust the altitude unmanned aircraft, thereby improving the accuracy of the unmanned aircraft to follow the terrain.

DRAWINGS

In order to more clearly illustrate the technical solutions in the embodiments of the present invention, the drawings used in the description of the embodiments will be briefly described below. It is obvious that the drawings in the following description are some embodiments of the present invention. Other drawings may also be obtained from those of ordinary skill in the art in view of the drawings.

1 is a flowchart of a method for controlling an unmanned aerial vehicle according to an embodiment of the present invention;

2 is a schematic structural diagram of an unmanned aerial vehicle according to an embodiment of the present invention;

3 is a schematic structural diagram of an unmanned aerial vehicle according to an embodiment of the present invention;

4 is a flowchart of a method for controlling an unmanned aerial vehicle according to another embodiment of the present invention;

FIG. 5 is a structural diagram of a joint Kalman filter of a fusion feedback mode according to an embodiment of the present disclosure;

6 is a schematic diagram of radar data fusion of an agricultural unmanned aerial vehicle according to an embodiment of the present invention;

FIG. 7 is a flowchart of a method for controlling an unmanned aerial vehicle according to another embodiment of the present invention; FIG.

FIG. 8 is a structural diagram of a flight controller according to an embodiment of the present invention; FIG.

FIG. 9 is a structural diagram of an unmanned aerial vehicle according to an embodiment of the present invention.

Reference mark:

21-Airframe of unmanned aerial vehicle 22-First detecting device 23-Second detecting device

24-UAV yaw axis 40-flight controller 41-processor

42-first sub-filter 43-second sub-filter 44-main filter

100-UAV 107-Motor 106-Propeller

117-Electronic governor 118-Flight controller 110-Communication system

102-Supporting equipment 104-Photographing equipment 112-Ground station

114-antenna 116-electromagnetic wave

detailed description

The technical solutions in the embodiments of the present invention will be clearly described with reference to the accompanying drawings in the embodiments of the present invention. It is obvious that the described embodiments are only a part of the embodiments of the present invention, and not all of the embodiments. All other embodiments obtained by those skilled in the art based on the embodiments of the present invention without creative efforts are within the scope of the present invention.

It should be noted that when a component is referred to as being "fixed" to another component, it can be directly on the other component or the component can be present. When a component is considered to "connect" another component, it can be directly connected to another component or possibly a central component.

All technical and scientific terms used herein have the same meaning as commonly understood by one of ordinary skill in the art to which this invention belongs, unless otherwise defined. The terminology used in the description of the present invention is for the purpose of describing particular embodiments and is not intended to limit the invention. The term "and/or" used herein includes any and all combinations of one or more of the associated listed items.

Some embodiments of the present invention are described in detail below with reference to the accompanying drawings. The features of the embodiments and examples described below can be combined with each other without conflict.

Embodiments of the present invention provide a method for controlling an unmanned aerial vehicle. 1 is a flowchart of a method for controlling an unmanned aerial vehicle according to an embodiment of the present invention; FIG. 2 is a schematic structural diagram of an unmanned aerial vehicle according to an embodiment of the present invention; and FIG. 3 is a schematic structural diagram of an unmanned aerial vehicle according to an embodiment of the present invention; . In this embodiment, the unmanned aerial vehicle includes a first detecting device and a second detecting device, where the first detecting device and the second detecting device are respectively used to measure the height of the unmanned aerial vehicle from the ground. The detection direction of the first detecting device and the yaw axis of the unmanned aerial vehicle The direction of the second detection device is set along the yaw axis of the UAV. As shown in FIG. 1 , the method in this embodiment may include:

Step S101: Acquire a first detection value of the first detecting device, and a second detection value of the second detecting device.

As shown in FIG. 2, 21 denotes a fuselage of an unmanned aerial vehicle, or a water tank representing an agricultural unmanned aerial vehicle, and the present embodiment does not limit the specific shape of the airframe and the water tank. This embodiment takes the fuselage of the unmanned aerial vehicle as an example. 22 and 23 are respectively two detecting devices disposed on the body 21. The detecting device may specifically be at least one of the following: a radar sensor, an ultrasonic sensor, a time of flight (TOF) ranging sensor, and a visual sensor. . The detecting device 22 and the detecting device 23 are respectively used for measuring the height of the unmanned aerial vehicle from the ground, except that the detecting direction of the detecting device 22 is different from the detecting direction of the detecting device 23, as shown in FIG. The yaw axis of the human aircraft, the detection direction of the detection device 22 is at a predetermined angle θ with the yaw axis 24 of the UAV, and the detection direction of the detection device 23 is set along the yaw axis 24 of the UAV. For example, if the UAV is flying over the terrace, the detection device 22 can detect the point A on the terrace, and the detection device 23 can detect the point B on the terrace. In actuality, the detection direction of the detection device 22 and the detection of the detection device 23 The direction may be scattered. As shown in FIG. 3, the detection direction of the detecting device 22 is scattered within a certain angular range, and the detecting direction of the detecting device 23 is also scattered within a certain angular range, and the detecting device 22 can detect the area A on the terrace. The detecting device 23 can detect the area B on the terrace.

The execution body of the embodiment may be a flight controller or other control module in the unmanned aerial vehicle. In this embodiment, the flight controller is used as the main body, and the first detecting device is the detecting device 22 as shown in FIG. 2 or FIG. The second detecting device is the detecting device 23 as shown in FIG. 2 or FIG. 3 . Specifically, the detecting value of the detecting device 22 that the flight controller can acquire is recorded as the first detected value, and the detected value of the detecting device 23 is recorded as the first detecting device. Two detection values. The first detection value may specifically be the distance between the UAV and the point A or the area A, and the second detection value may specifically be the distance between the UAV and the point B or the area B.

In the present embodiment, it is assumed that the centers of the detecting device 22 and the detecting device 23 are both recorded as point 0, so that the distance between the detecting device 22 and the point A or the area A, that is, the slanting distance OA, represents the unmanned aerial vehicle and the point A or the area A. The distance between the detection device 23 and the point B or the area B, OB, represents the distance between the UAV and the point B or the area B.

Step S102: Determine, according to the first detection value and the second detection value, a height of the unmanned aerial vehicle from a ground below the unmanned aerial vehicle.

After acquiring the first detection value of the detecting device 22 and the second detecting value of the detecting device 23, the flight controller calculates, according to the first detecting value and the second detecting value, the unmanned aerial vehicle from the ground below the unmanned aerial vehicle. Height, specifically, data fusion may be performed according to the first detection value and the second detection value to obtain a fusion height.

As shown in FIG. 2 or FIG. 3, the point A or the area A may be a ground or an obstacle obliquely ahead of the unmanned aerial vehicle when flying, and the point B or the area B may be directly below the unmanned aerial vehicle during flight. Ground or obstacles. The slant range OA can be decomposed into a horizontal component and a vertical component. As shown in FIG. 2, the vertical component of the slant range OA is OC, and the vertical component OC represents the vertical height of the UAV from the point A or the area A. In this embodiment, An achievable manner of data fusion according to the first detection value and the second detection value is: data fusion according to the vertical component OC of the slant range OA and the vertical height OB of the UAV distance point B or the area B After the data is fused, a fusion height is obtained, which can be used as the height of the unmanned aerial vehicle from the ground below the unmanned aerial vehicle.

In this embodiment, the two detecting devices provided on the UAV respectively detect the height of the UAV from the ground directly below and the distance from the ground in front of it, and determine the distance according to the distance of the UAV from the ground in front of it. The vertical height of the UAV from its oblique front ground, based on the height of the UAV from the ground directly below it and the vertical height of the UAV from its oblique front ground, determines the height of the UAV from the ground below it, ie The height of the human aircraft from the ground below it is not only related to the height of the unmanned aerial vehicle from the ground directly below it, but also related to the vertical height of the unmanned aerial vehicle from the ground in front of it. The local shape is large and the flying speed of the unmanned aerial vehicle is large. Or when the unmanned aerial vehicle performs the flying defense operation, the altitude of the ground below the unmanned aerial vehicle is determined according to the height of the ground directly below the ground and the vertical height of the ground from the oblique front, compared to a detecting device in the prior art. Detection height increases the height of the unmanned aerial vehicle from below it Accuracy, avoiding the detection result with the topography or unmanned aircraft flight speed of the change, so that the power system can instantly adjust the flying height of the unmanned aerial vehicle, thereby improving the accuracy of unmanned aircraft terrain following.

Embodiments of the present invention provide a method for controlling an unmanned aerial vehicle. Figure 4 is another embodiment of the present invention FIG. 5 is a structural diagram of a joint Kalman filter of a fusion feedback mode according to an embodiment of the present invention; FIG. 6 is an agricultural unmanned aerial vehicle provided by an embodiment of the present invention; Schematic diagram of radar data fusion. As shown in FIG. 4, on the basis of the embodiment shown in FIG. 1, the method in this embodiment may include:

Step S201: Acquire a first detection value of the first detecting device, and a second detection value of the second detecting device.

Step S201 is consistent with step S101, and the specific method is not described herein again.

Step S202: Determine, according to the first detection value, a first height, where the first height is a vertical height of the unmanned aerial vehicle from the first ground, and the first ground is in a detection direction of the first detecting device on.

In this embodiment, the first detecting device is the detecting device 22 as shown in FIG. 2, and the first ground is in the detecting direction of the first detecting device, that is, the detecting device 22, that is, the first ground is a point as shown in FIG. A, or the area A as shown in FIG. 3; the first height is the vertical component OC as shown in FIG. 2, that is, the vertical height of the UAV from the point A or the area A. In addition, the detecting device 22 can output the first time in real time. The detected value, the first detected value represents a measure of the distance between the UAV and point A or area A.

In this embodiment, according to the first detection value, the achievable manner of determining the first height is as follows:

The first one includes the following steps 11-13:

Step 11: Determine an estimated value of the first height at a current time according to the fusion height before the current time;

Since there is a certain error when the detecting device detects the distance, the error may be the error generated by the detecting device itself, or may be the error caused by the surrounding environment of the detecting device. In order to improve the accuracy of the detecting result, the first height may be estimated according to the current time. The value and the measured value of the first height of the current time, determining the actual value of the first height at the current time, and determining an estimated value of the first height at the current time is: determining according to the fusion height according to the current time The estimated value of the first height at the current time.

Step 12: Determine, according to the first detection value of the current moment, a measured value of the first height at the current moment;

The first detected value at the current time indicates that the current time detected by the detecting device 22 is unmanned. The distance between the device and the point A or the area A, that is, the measured value of the slanting distance OA, can be calculated based on the measured value of the slanting distance OA and the preset angle θ between the detecting direction of the detecting device 22 and the yaw axis. The measured value of the vertical component OC of the OA, specifically, in the present embodiment, the preset angle θ is an angle of 45 degrees, and according to the sine and cosine rule, the measured value of the vertical component OC of the slant range OA can be calculated.

Step 13. Determine, according to the estimated value of the first height and the measured value at the current time, a new spread of the first height at the current time.

According to the estimated value of the first height at the current time determined in the above step 11 and the measured value of the first height at the current time determined in step 12, the new interest difference of the first height at the current time may be determined, assuming that the current The time is k, the estimated value of the first height at the current time is X ₁ (k), the measured value of the first height at the current time is Z ₁ (k), and the new interest difference of the first height at the current time is g ₁ (k), then g ₁ (k)=Z ₁ (k)-X ₁ (k).

The second method includes the following steps 21-23:

Step 21: Determine an estimated value of the first height at the current time according to the estimated value of the first height at a previous moment of the current time;

In this embodiment, the estimated value of the first height is obtained by filtering the first detection value by using a first sub-filter.

In addition, another achievable manner of determining the estimated value of the first height at the current time is: determining the vertical component OC of the slant range OA at each time according to the measured value of the first detected value, that is, the slant range OA, which is output by the detecting device 22 in real time. The measured value of the vertical component OC is filtered by the first sub-filter to obtain a local optimal estimate of the first height at each moment, the first sub-filter is specifically Kalman filtering, and each time A height local optimum estimate can be used as an estimate of the first height at each moment, assuming that the estimated value of the first height at the current time is X ₁ (k), and the estimated value of the first height at the previous moment of the current time is X _{1 (k-1),} Example may be X _{1 (k-1)} based on the estimated value of the first time of the current height of the previous embodiment of the present time, determining a first estimate of the current time point height X ₁ (k), a particular The relationship between X ₁ (k) and X ₁ (k-1) can be expressed as formula (1):

X ₁ (k)=X ₁ (k-1)+W ₁ (k-1) (1)

Where W ₁ (k-1) represents the Gaussian white noise at the previous moment.

Step 22: Determine, according to the first detection value of the current moment, a measured value of the first height at the current moment;

Step 22 is the same as step 12, and the specific method is not described here.

Step 23: Determine, according to the estimated value of the first height and the measured value at the current time, a new interest rate difference of the first height at the current time.

Step 23 is the same as step 13. The specific method is not described here.

Step S203: Determine, according to the second detection value, a second height, where the second height is a vertical height of the UAV from the second ground, and the second ground is in a detection direction of the second detecting device. on.

In this embodiment, the second detecting device is the detecting device 23 as shown in FIG. 2; the second ground is in the detecting direction of the second detecting device, that is, the detecting device 23, that is, the second ground is a point as shown in FIG. B, or area B as shown in FIG. The second height is the vertical height OB as shown in FIG. 2, that is, the vertical height of the UAV from the point B or the area B. In addition, the detecting device 23 can output the second detection value in real time, and the second detection value indicates the unmanned aerial vehicle and A measure of the distance between point B or area B.

In this embodiment, according to the second detection value, the achievable manner of determining the second height is as follows:

The first one includes the following steps 31-33:

Step 31: Determine an estimated value of the second height at the current time according to the fusion height before the current time;

Since the detection device has a certain error when detecting the distance, the error may be an error generated by the detection device itself, or may be an error caused by the environment surrounding the detection device. In order to improve the accuracy of the detection result, the second height may be estimated according to the current time. The value and the measured value of the second height of the current time, determining the actual value of the second height at the current time, and determining an estimable value of the second height of the current time is: determining according to the fusion height according to the current time The estimated value of the second height at the current time.

Step 32: Determine, according to the second detection value at the current moment, a measured value of the second height at the current moment;

The second detected value of the current time represents the distance between the unmanned aerial vehicle and the point B or the area B at the current moment detected by the detecting device 23, that is, the measured value of the OB.

Step 33: Determine, according to the estimated value of the second height and the measured value at the current time, a new interest rate difference of the second height at the current time.

According to the estimated value of the second height at the current time determined in the above step 31, and the measured value of the second height at the current time determined in step 32, the new interest rate of the second height at the current time may be determined, assuming that the current The time is k, the estimated value of the second height at the current time is X ₂ (k), the measured value of the second height at the current time is Z ₂ (k), and the new spread of the second height at the current time is g ₂ (k), then g ₂ (k)=Z ₂ (k)-X ₂ (k).

The second type includes the following steps 41-43:

Step 41: Determine an estimated value of the second height at the current time according to the estimated value of the second height at a previous moment of the current time;

In this embodiment, the estimated value of the second height is obtained by filtering the second detection value by using a second sub-filter.

In addition, another achievable manner of determining the estimated value of the second height at the current time is: filtering the second detection value outputted by the detecting device 23 in real time by using the second sub-filter to obtain a local portion of the second height at each moment. The optimal estimation, the second sub-filter is specifically Kalman filtering, and the local optimum estimation of the second height at each moment can be used as an estimation value of the second height at each moment, assuming the estimated value of the second height at the current moment. For X ₂ (k), the estimated value of the second height at the previous moment of the current time is X ₂ (k-1), and the embodiment may be based on the estimated value of the second height at the previous moment of the current time X ₂ (k- 1), determining an estimated value X ₂ (k) of the second height at the current time, specifically, the relationship between X ₂ (k) and X ₂ (k-1) can be expressed as formula (2):

X ₂ (k)=X ₂ (k-1)+W ₂ (k-1) (2)

Where W ₂ (k-1) represents the Gaussian white noise at the previous moment; W ₂ (k-1) and W ₁ (k-1) may be the same and may be different.

Step 42: Determine, according to the second detection value of the current moment, a measured value of the second height at the current moment;

Step 42 is the same as step 32. The specific method is not described here.

Step 43: Determine, according to the estimated value of the second height and the measured value at the current time, a new interest rate difference of the second height at the current time.

Step 43 is the same as step 33. The specific method is not described here.

Step S204: Perform data fusion according to the first height and the second height.

Specifically, the fusion ratio of the estimated value of the first height is determined according to the new interest difference g ₁ (k) of the first height at the current time and the new interest difference g ₂ (k) of the second height at the current time. And a fusion weight of the estimated value of the second height; assuming that the fusion weight of the estimated value X ₁ (k) of the first height at the current time is w1(k), and the estimated value of the second height at the current time is X ₂ (k) The fusion weight is w2(k), then w1(k) can be determined according to formula (3), and w2(k) can be determined according to formula (4):

a fusion specific gravity w1(k) according to the measured value of the first height, an estimated value X ₁ (k) of the first height at the current time, a fusion specific gravity w2(k) of the estimated value of the second height, and a current The estimated value X ₂ (k) of the second height at the time is calculated as the fusion height of the current time. Assuming that the fusion height is X _g (k), then X _g (k) can be determined according to equation (5):

X _g (k)=w1(k)*X ₁ (k)+w2(k)*X ₂ (k) (5)

Specifically, in this embodiment, the fusion specific gravity w1(k) of the measured value of the first height by the main filter, the estimated value X ₁ (k) of the first height at the current time, and the second height may be used. The fusion calculation is performed by the fusion specific gravity w2(k) of the estimated value and the estimated value X ₂ (k) of the second height at the current time.

In some embodiments, the first sub-filter, the second sub-filter, and the main filter form a joint Kalman filter of a fusion feedback mode. As shown in FIG. 5, the radar sensor 1 may be the detecting device 22 in the above embodiment, the radar sensor 2 may be the detecting device 23 in the above embodiment, or the radar sensor 1 may be the detecting device 23 in the above embodiment. The radar sensor 2 may be the detecting device 22 in the above embodiment. In this embodiment, the radar sensor 1 is the detecting device 22, and the radar sensor 2 is the detecting device 23. The first detected value of the real-time output of the radar sensor 1 may be performed first. Data pre-processing, specifically, the measured value of the vertical component OC of the slant range OA at each time is determined according to the measured value of the first detected value, that is, the slant range OA, which is output in real time by the detecting device 22; the sub-filter 1 is in the above embodiment. The first sub-filter uses the sub-filter 1 to filter the measured value of the vertical component OC to obtain a local optimum estimate of the first height at each moment, such as a local optimum estimate X _{1 of the} first height at the current time ( k), and the new interest difference of the first height at the current time is g ₁ (k). Similarly, the second detection value of the real-time output of the radar sensor 2 is preprocessed to obtain the measured value of the vertical height OB at each moment; the sub-filter 2 is the second sub-filter in the above embodiment, and the sub-filter is adopted. 2 Filtering the measured values of the vertical height OB to obtain a local optimum estimate of the second height at each moment, such as a local optimal estimate X ₂ (k) of the second height at the current time, and a second height at the current time The new spread is g ₂ (k). The sub-filter 1 transmits the local optimum estimate X ₁ (k) of the first height at the current time, and the new spread of the first height at the current time, g ₁ (k), to the main filter, and the sub-filter 2 The local optimum estimate X ₂ (k) of the second height at the current time, and the new spread of the second height at the current time are g ₂ (k) are transmitted to the main filter, and the main filter is according to the above formula (3) ( 4) (5) Calculate the fusion height X _g (k) at the current time. The main filter feeds back the fusion height X _g (k) of the current time to the sub-filter 1 and the sub-filter 2. The sub-filter 1 determines the local optimum estimate X ₁ (k+1) of the first height at the next moment according to the fusion height X _g (k) of the current time, and the sub-filter 2 is based on the fusion height of the current time X _g (k) ), determining a local optimal estimate of the second height at the next moment, X ₂ (k+1), ie, X ₁ (k+1)=X _g (k)+W ₁ (k), X ₂ (k+1) =X _g (k) + W ₂ (k), where W ₁ (k) and W ₂ (k) represent Gaussian white noise at the current time.

For the formula (1), it is also possible to replace the estimated value X ₁ (k-1) of the first height at the previous moment of the current moment by the fusion height X _g (k-1) of the previous moment, that is, X ₁ (k) ) = X _g (k-1) + W ₁ (k-1).

For the formula (2), it is also possible to replace the estimated value X ₂ (k-1) of the second height at the previous moment of the current moment by the fusion height X _g (k-1) of the previous moment, that is, X ₂ (k) ) = X _g (k-1) + W ₂ (k-1).

In addition, the unmanned aerial vehicle described in the foregoing embodiment may be an agricultural unmanned aerial vehicle. As shown in FIG. 6, the radar sensor 1 is the detecting device 23 in the above embodiment, and the radar sensor 2 may be the detecting device in the above embodiment. 22, H1 represents the vertical height of the UAV from the point B or the area B, H2 represents the vertical height of the UAV from the point A or the area A, and the data is combined with the Kalman fusion to obtain the fusion height and the data fusion described in step S204 The method is the same, and will not be described in detail.

In this embodiment, the first detection value is filtered by the first sub-filter to obtain an estimated value of the first height and a new interest difference of the first height, and the second detection value is filtered by the second sub-filter. Processing to obtain an estimate of the second height and a new spread of the second height, A sub-filter sends an estimate of the first height and a new spread of the first height to the main filter, and the second sub-filter transmits the estimated value of the second height and the new spread of the second height to the main filter The main filter determines the fusion specific gravity of the estimated value of the first height and the fusion specific gravity of the estimated value of the second height according to the new spread of the first height and the new spread of the second height, and measures the first height The fusion weight of the value, the estimated value of the first height at the current time, the fusion weight of the estimated value of the second height, and the estimated value of the second height at the current time are fused, and the fusion height is obtained, and the fusion height is obtained. And feeding back to the first sub-filter and the second sub-filter, so that the first sub-filter and the second sub-filter determine an estimated value of the first height and an estimated value of the second height at the next moment according to the fusion height, based on The joint Kalman filter of the fusion feedback mode formed by the first sub-filter, the second sub-filter and the main filter improves the filter estimation accuracy of the first sub-filter and the second sub-filter Further improve the calculation accuracy fusion height.

Embodiments of the present invention provide a method for controlling an unmanned aerial vehicle. FIG. 7 is a flowchart of a method for controlling an unmanned aerial vehicle according to another embodiment of the present invention. As shown in FIG. 7, on the basis of the embodiment shown in FIG. 1, the method in this embodiment may include:

Step S301: Acquire a first detection value of the first detecting device, and a second detection value of the second detecting device.

Step S301 is the same as step S101. The specific method is not described here.

Step S302: Determine, according to the first detection value and the second detection value, a height of the unmanned aerial vehicle from a ground below the unmanned aerial vehicle.

Step S302 is consistent with the foregoing steps S202 and S203, and the specific method is not described herein again.

Step S303, performing terrain following according to the height of the unmanned aerial vehicle from the ground below the unmanned aerial vehicle.

In this embodiment, the flight controller may further control the unmanned aerial vehicle to follow the terrain according to the height of the unmanned aerial vehicle from the ground below the unmanned aerial vehicle, that is, the fusion height described in the above embodiment, that is, along the terrain. The height is increased, the flight controller controls the flying height of the unmanned aerial vehicle to increase. Specifically, the flight controller controls the flying height of the unmanned aerial vehicle according to the height of the unmanned aerial vehicle from the ground below the unmanned aerial vehicle, wherein the unmanned aerial vehicle The calculation method of the ground height below it is consistent with the method described in the above embodiment, and the specific process is not here. Let me repeat.

Embodiments of the present invention provide a flight controller. The flight controller includes one or more processors, which work separately or in cooperation, and the processor is configured to: acquire a first detection value of the first detection device, and a second detection value of the second detection device; Determining, by the first detection value and the second detection value, a height of the unmanned aerial vehicle from a ground below the unmanned aerial vehicle; wherein the unmanned aerial vehicle comprises a first detecting device and a second detecting device, The first detecting device and the second detecting device are respectively configured to measure a height of the unmanned aerial vehicle from the ground, and a detecting direction of the first detecting device is at a preset angle with a yaw axis direction of the unmanned aerial vehicle. The detecting direction of the second detecting device is disposed along a yaw axis direction of the unmanned aerial vehicle.

Determining, according to the first detection value and the second detection value, the height of the unmanned aerial vehicle from a ground below the unmanned aerial vehicle, according to the first detection value and the The second detected value is subjected to data fusion to obtain a fusion height, which is a height of the unmanned aerial vehicle from a ground below the unmanned aerial vehicle.

The specific principles and implementation manners of the flight controller provided by the embodiment of the present invention are similar to the embodiment shown in FIG. 1 and will not be further described herein.

Embodiments of the present invention provide a flight controller. FIG. 8 is a structural diagram of a flight controller according to an embodiment of the present invention; as shown in FIG. 8, the flight controller 40 includes the processor described in the foregoing embodiment. In this embodiment, the processor is 41, and the processor 41 And performing data fusion according to the first detection value and the second detection value, specifically, determining, according to the first detection value, a first height, where the first height is a distance from the first ground to the unmanned aerial vehicle a vertical height, the first ground is in a detecting direction of the first detecting device; and determining a second height according to the second detecting value, the second height is a distance from the second ground to the unmanned aerial vehicle a vertical height, the second ground is in a detection direction of the second detecting device; and data fusion is performed according to the first height and the second height.

The processor 41 is configured to determine, according to the first detection value, the first height, according to the fusion height before the current time, the estimated value of the first height at the current time; the first according to the current time And detecting a value, determining a measured value of the first height at the current time; determining a new interest difference of the first height at the current time according to the estimated value of the first height and the measured value at the current time.

Or determining, by the processor 41, the first height according to the first detection value, specifically: determining, according to the estimated value of the first height at a previous moment of the current moment, the first moment of the current moment An estimated value of the height; determining, according to the first detection value of the current time, the measured value of the first height at the current time; determining the first time of the current time according to the estimated value of the first height and the measured value at the current time High new interest margin.

The processor 41 is configured to determine, according to the second detection value, the second height, according to the fusion height before the current time, the estimated value of the second height at the current time; the second according to the current time And detecting a value, determining a measured value of the second height at the current time; determining a new interest rate of the second height at the current time according to the estimated value of the second height and the measured value at the current time.

Or determining, by the processor 41, the second height according to the second detection value, specifically: determining, according to the estimated value of the second height at a previous moment of the current moment, an estimated value of the second height at the current moment; Determining, according to the second detection value of the current time, the measured value of the second height at the current time; determining the new interest rate of the second height at the current time according to the estimated value of the second height and the measured value at the current time .

When the data fusion is performed by the processor 41 according to the first height and the second height, the method is specifically configured to: determine, according to the new interest rate difference of the first height at the current time and the new interest rate of the second height at the current time. a fusion specific gravity of the estimated value of the first height and a fusion specific gravity of the estimated value of the second height; a fusion specific gravity according to the measured value of the first height, an estimated value of the first height according to the current time, and a The fusion weight of the estimated value of the second height and the estimated value of the second height at the current time are calculated, and the fusion height of the current time is calculated.

In addition, the flight controller 40 further includes: a first sub-filter 42, a second sub-filter 43 and a main filter 44 communicatively coupled to the processor, the first sub-filter 42 for the first detection The value is filtered to obtain an estimated value of the first height; the second sub-filter 43 is configured to perform filtering processing on the second detected value to obtain an estimated value of the second height; the main filter 44 is used to The fusion specific gravity of the measured value of the first height, the estimated value of the first height at the current time, the fusion specific gravity of the estimated value of the second height, and the estimated value of the second height at the current time are subjected to fusion calculation.

Additionally, in some embodiments, the first sub-filter, the second sub-filter, and the main filter form a joint Kalman filter of a fusion feedback mode. At this time, the estimated value of the first height at the previous moment of the current time is the fusion height of the previous moment; the estimated value of the second height of the previous moment of the current moment is the fusion height of the previous moment. .

The specific principles and implementation manners of the flight controller provided by the embodiments of the present invention are similar to the embodiment shown in FIG. 4, and details are not described herein again.

In this embodiment, the first detection value is filtered by the first sub-filter to obtain an estimated value of the first height and a new interest difference of the first height, and the second detection value is filtered by the second sub-filter. Processing to obtain an estimated value of the second height and a new spread of the second height, the first sub-filter transmitting the estimated value of the first height and the new spread of the first height to the main filter, the second sub-filter Sending the estimated value of the second height and the new spread of the second height to the main filter, and the main filter determines the fusion of the estimated values of the first height according to the new spread of the first height and the new spread of the second height a specific gravity of the specific gravity and the estimated value of the second height, and a fusion weight of the measured value of the first height, an estimated value of the first height at the current time, a fusion weight of the estimated value of the second height, and a current time The estimated value of the second height is subjected to fusion calculation to obtain a fusion height, and the fusion height is fed back to the first sub-filter and the second sub-filter, so that the first sub-filter and the second sub-filter are based on the fusion height Determining an estimated value of the first height and an estimated value of the second height at the next moment, based on the combined Kalman filter of the fusion feedback mode formed by the first sub-filter, the second sub-filter, and the main filter The filter estimation accuracy of the first sub-filter and the second sub-filter is improved, and the calculation precision of the fusion height is further improved.

Embodiments of the present invention provide a flight controller. Based on the technical solution provided by the embodiment shown in FIG. 8, the processor 41 is further configured to: control the unmanned aerial vehicle to perform terrain following according to a height of the unmanned aerial vehicle from a ground below the unmanned aerial vehicle.

In addition, the detecting device includes at least one of a radar sensor, an ultrasonic sensor, a TOF ranging sensor, and a visual sensor.

Further, the preset angle is an angle of 45 degrees.

The specific principles and implementation manners of the flight controller provided by the embodiment of the present invention are similar to those of the embodiment shown in FIG. 7, and details are not described herein again.

In this embodiment, the two detecting devices provided on the UAV respectively detect the height of the UAV from the ground directly below and the distance from the ground in front of it, and determine the distance according to the distance of the UAV from the ground in front of it. The vertical height of the UAV from its oblique front ground, based on the height of the UAV from the ground directly below it and the vertical height of the UAV from its oblique front ground, determines the height of the UAV from the ground below it, ie People The height of the aircraft from the ground below it is not only related to the height of the unmanned aerial vehicle from the ground directly below it, but also to the vertical height of the unmanned aerial vehicle from the front of the slope. The local shape is large and the UAV is flying at a high speed or When the UAV is engaged in flight defense operations, the height of the unmanned aerial vehicle from the ground directly below it and the vertical height of the ground obliquely from the ground are determined according to the height of the ground below it, compared to a detecting device in the prior art. The detection height improves the calculation accuracy of the unmanned aerial vehicle from the ground level below it, and avoids the problem that the detection result changes rapidly with the terrain fluctuation or the UAV flight speed, so that the power system can instantly adjust the flying height of the UAV, thereby improving The accuracy of the unmanned aerial vehicle terrain following.

Embodiments of the present invention provide an unmanned aerial vehicle. FIG. 9 is a structural diagram of an unmanned aerial vehicle according to an embodiment of the present invention. As shown in FIG. 9, the unmanned aerial vehicle 100 includes: a fuselage, a power system, a first detecting device 22, a second detecting device 23, and a flight controller 118. . The power system includes at least one of a motor 107, a propeller 106, and an electronic governor 117, the power system being mounted to the fuselage for providing flight power. The first detecting device 22 and the second detecting device 23 are mounted on the body for measuring the height of the UAV 100 from the ground, and the detecting direction of the first detecting device 22 is opposite to the yaw axis direction of the UAV 100. The detection angle of the second detecting device 23 is set along the yaw axis direction of the unmanned aerial vehicle 100 at a preset angle. A flight controller 118 is communicatively coupled to the power system for controlling the UAV flight; wherein the flight controller 118 includes an inertial measurement unit and a gyroscope. The inertial measurement unit and the gyroscope are configured to detect an acceleration, a pitch angle, a roll angle, a yaw angle, and the like of the drone.

In addition, as shown in FIG. 9, the unmanned aerial vehicle 100 further includes: a communication system 110, a supporting device 102, and a photographing device 104, wherein the supporting device 102 may specifically be a pan/tilt, and the communication system 110 may specifically include a receiver, and the receiver The wireless signal transmitted at the antenna 114 of the receiving

ground station

112, 116, represents the electromagnetic waves generated during communication between the receiver and the antenna 114.

The specific principles and implementation manners of the flight controller in the unmanned aerial vehicle provided by the embodiments of the present invention are similar to the above embodiments, and are not described herein again.

In this embodiment, the two detecting devices provided on the UAV respectively detect the height of the UAV from the ground directly below and the distance from the ground in front of it, and determine the distance according to the distance of the UAV from the ground in front of it. The vertical height of the unmanned aerial vehicle from its obliquely forward ground, according to the height of the unmanned aerial vehicle from the ground directly below it and the distance of the unmanned aerial vehicle The vertical height of the front ground determines the height of the UAV from the ground below it, that is, the height of the UAV from the ground below it is not only related to the height of the unmanned aerial vehicle from the ground below it, but also to the unmanned aerial vehicle. The vertical height of the front ground is related to the vertical height of the ground, the flying speed of the unmanned aerial vehicle or the flying defense operation of the unmanned aerial vehicle. According to the height of the unmanned aerial vehicle and the vertical height of the ground in front of it Determining the height from the ground below it, compared with the detection height of a detection device in the prior art, improving the calculation accuracy of the UAV from the ground height below it, avoiding the detection result with terrain fluctuation or UAV flight The problem of rapid speed change enables the power system to instantly adjust the flying height of the unmanned aerial vehicle, thereby improving the accuracy of the UAV terrain following.

In the several embodiments provided by the present invention, it should be understood that the disclosed apparatus and method may be implemented in other manners. For example, the device embodiments described above are merely illustrative. For example, the division of the unit is only a logical function division. In actual implementation, there may be another division manner, for example, multiple units or components may be combined or Can be integrated into another system, or some features can be ignored or not executed. In addition, the mutual coupling or direct coupling or communication connection shown or discussed may be an indirect coupling or communication connection through some interface, device or unit, and may be in an electrical, mechanical or other form.

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, may be located in one place, or may be distributed to multiple network units. Some or all of the units may be selected according to actual needs to achieve the purpose of the solution of the embodiment.

In addition, each functional unit in each embodiment of the present invention may be integrated into one processing unit, or each unit may exist physically separately, or two or more units may be integrated into one unit. The above integrated unit can be implemented in the form of hardware or in the form of hardware plus software functional units.

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

A person skilled in the art can clearly understand that for the convenience and brevity of the description, only the division of each functional module described above is exemplified. In practical applications, the above function assignment can be completed by different functional modules as needed, that is, the device is installed. The internal structure is divided into different functional modules to perform all or part of the functions described above. For the specific working process of the device described above, refer to the corresponding process in the foregoing method embodiment, and details are not described herein again.

Finally, it should be noted that the above embodiments are merely illustrative of the technical solutions of the present invention, and are not intended to be limiting; although the present invention has been described in detail with reference to the foregoing embodiments, those skilled in the art will understand that The technical solutions described in the foregoing embodiments may be modified, or some or all of the technical features may be equivalently replaced; and the modifications or substitutions do not deviate from the technical solutions of the embodiments of the present invention. range.

Claims

A method for controlling an unmanned aerial vehicle, characterized in that the unmanned aerial vehicle comprises a first detecting device and a second detecting device, the first detecting device and the second detecting device respectively for measuring the unmanned a height of the aircraft from the ground, a detection direction of the first detecting device is at a predetermined angle with a yaw axis direction of the UAV, and a detection direction of the second detecting device is along a yaw axis of the UAV Direction setting

The method includes:

Obtaining a first detection value of the first detecting device, and a second detection value of the second detecting device;

Determining, according to the first detection value and the second detection value, a height of the unmanned aerial vehicle from a ground below the unmanned aerial vehicle.
The method according to claim 1, wherein the determining, according to the first detection value and the second detection value, a height of the unmanned aerial vehicle from a ground below the unmanned aerial vehicle comprises:

Data fusion is performed according to the first detection value and the second detection value to obtain a fusion height, which is a height of the unmanned aerial vehicle from a ground below the unmanned aerial vehicle.
The method according to claim 2, wherein the data fusion according to the first detection value and the second detection value comprises:

Determining, according to the first detection value, a first height, where the first height is a vertical height of the UAV from the first ground, and the first ground is in a detecting direction of the first detecting device;

Determining, according to the second detection value, a second height, where the second height is a vertical height of the UAV from the second ground, and the second ground is in a detection direction of the second detecting device;

Data fusion is performed according to the first height and the second height.
The method according to claim 3, wherein the determining the first height according to the first detection value comprises:

Determining an estimated value of the first height at a current time according to the fusion height before the current time;

Determining, according to the first detection value of the current moment, a measured value of the first height at the current moment;

And determining, according to the estimated value of the first height and the measured value at the current moment, a new spread of the first height at the current moment.
The method according to claim 3, wherein the determining the first height according to the first detection value comprises:

Determining an estimated value of the first height at the current time according to the estimated value of the first height at a previous moment of the current time;

Determining, according to the first detection value of the current moment, a measured value of the first height at the current moment;

And determining, according to the estimated value of the first height and the measured value at the current moment, a new spread of the first height at the current moment.
The method according to claim 3, wherein the determining the second height according to the second detection value comprises:

Determining an estimated value of the second height at the current time according to the fusion height before the current time;

Determining, according to the second detection value of the current moment, a measured value of the second height at the current moment;

The new interest rate of the second height at the current time is determined according to the estimated value of the second height and the measured value at the current time.
The method according to claim 3, wherein the determining the second height according to the second detection value comprises:

Determining an estimated value of the second height at the current time according to the estimated value of the second height at a previous moment of the current time;

Determining, according to the second detection value of the current moment, a measured value of the second height at the current moment;

The new interest rate of the second height at the current time is determined according to the estimated value of the second height and the measured value at the current time.
The method according to any one of claims 4 to 7, wherein the data fusion according to the first height and the second height comprises:

Determining a fusion weight of the estimated value of the first height and a fusion weight of the estimated value of the second height according to the new interest difference of the first height at the current time and the new interest difference of the second height at the current time ;

Calculating the current time according to the fusion specific gravity of the measured value of the first height, the estimated value of the first height at the current time, the fusion specific gravity of the estimated value of the second height, and the estimated value of the second height at the current time. The height of the fusion.
The method according to claim 5, wherein the estimated value of the first height is obtained by filtering the first detected value by using a first sub-filter.
The method according to claim 7, wherein the estimated value of the second height is obtained by filtering the second detected value by using a second sub-filter.
The method according to claim 8, wherein the fusion specific gravity according to the measured value of the first height, the estimated value of the first height at the current time, and the integrated weight of the estimated value of the second height The estimated value of the second height at the current time, and the fusion height of the current time is calculated, including:

a fusion specific gravity of the measured value of the first height by the main filter, an estimated value of the first height at the current time, a fusion specific gravity of the estimated value of the second height, and an estimated value of the second height at the current time Perform fusion calculations.
The method according to any one of claims 9-11, wherein the first sub-filter, the second sub-filter and the main filter constitute a joint Kalman filter of a fusion feedback mode.
The method according to claim 12, wherein the estimated value of the first height at a previous time of the current time is a fusion height of a previous time;

The estimated value of the second height at the previous moment of the current time is the fusion height of the previous moment.
The method of claim 1 further comprising:

Terrain following is performed according to the height of the unmanned aerial vehicle from the ground below the unmanned aerial vehicle.
The method according to claim 1, wherein the detecting device comprises at least one of the following:

Radar sensor, ultrasonic sensor, TOF distance measuring sensor, visual sensor.
The method of claim 1 wherein said predetermined angle is a 45 degree angle.
A flight controller, comprising one or more processors, operating separately or in cooperation, the processor for:

Obtaining a first detection value of the first detecting device, and a second detection value of the second detecting device;

Determining, according to the first detection value and the second detection value, a height of the unmanned aerial vehicle from a ground below the unmanned aerial vehicle;

Wherein the unmanned aerial vehicle includes a first detecting device and a second detecting device, wherein the first detecting device and the second detecting device are respectively configured to measure a height of the unmanned aerial vehicle from the ground, the first detecting The detection direction of the device is at a predetermined angle with the yaw axis direction of the UAV, and the detection direction of the second detection device is set along the yaw axis direction of the UAV.
The flight controller according to claim 17, wherein said processor determines, based on said first detected value and said second detected value, said unmanned aerial vehicle being located below said ground of said unmanned aerial vehicle The height is specifically used for:

Data fusion is performed according to the first detection value and the second detection value to obtain a fusion height, which is a height of the unmanned aerial vehicle from a ground below the unmanned aerial vehicle.
The flight controller according to claim 18, wherein the processor is specifically configured to: perform data fusion according to the first detection value and the second detection value:

Determining, according to the first detection value, a first height, where the first height is a vertical height of the UAV from the first ground, and the first ground is in a detecting direction of the first detecting device;

Determining, according to the second detection value, a second height, where the second height is a vertical height of the UAV from the second ground, and the second ground is in a detection direction of the second detecting device;

Data fusion is performed according to the first height and the second height.
The flight controller according to claim 19, wherein the processor is configured to: when determining the first height according to the first detection value:

Determining an estimated value of the first height at a current time according to the fusion height before the current time;

Determining, according to the first detection value of the current moment, a measured value of the first height at the current moment;

And determining, according to the estimated value of the first height and the measured value at the current moment, a new spread of the first height at the current moment.
The flight controller according to claim 19, wherein the processor is configured to: when determining the first height according to the first detection value:

Determining an estimated value of the first height at the current time according to the estimated value of the first height at a previous moment of the current time;

Determining, according to the first detection value of the current moment, a measured value of the first height at the current moment;

And determining, according to the estimated value of the first height and the measured value at the current moment, a new spread of the first height at the current moment.
The flight controller according to claim 19, wherein the processor is configured to determine the second height according to the second detection value:

Determining an estimated value of the second height at the current time according to the fusion height before the current time;

Determining, according to the second detection value of the current moment, a measured value of the second height at the current moment;

The new interest rate of the second height at the current time is determined according to the estimated value of the second height and the measured value at the current time.
The flight controller according to claim 19, wherein the processor is configured to determine the second height according to the second detection value:

Determining an estimated value of the second height at the current time according to the estimated value of the second height at a previous moment of the current time;

Determining, according to the second detection value of the current moment, a measured value of the second height at the current moment;

The new interest rate of the second height at the current time is determined according to the estimated value of the second height and the measured value at the current time.
The flight controller according to any one of claims 20 to 23, wherein the processor performs data fusion according to the first height and the second height, and is specifically used for:

Determining a fusion weight of the estimated value of the first height and a fusion weight of the estimated value of the second height according to the new interest difference of the first height at the current time and the new interest difference of the second height at the current time ;

Calculating the current time according to the fusion specific gravity of the measured value of the first height, the estimated value of the first height at the current time, the fusion specific gravity of the estimated value of the second height, and the estimated value of the second height at the current time. The height of the fusion.
The flight controller of claim 21, further comprising:

a first sub-filter connected in communication with the processor, the first sub-filter is configured to perform filtering processing on the first detection value to obtain an estimated value of the first height.
The flight controller of claim 23, further comprising:

a second sub-filter connected in communication with the processor, the second sub-filter is configured to perform filtering processing on the second detection value to obtain an estimated value of the second height.
The flight controller of claim 24, further comprising:

a main filter communicatively coupled to the processor, the main filter for modulating a specific gravity of the measured value of the first height, an estimated value of the first height at a current time, and an estimated value of the second height The fusion weight and the estimated value of the second height at the current time are combined and calculated.
The flight controller according to any one of claims 25-27, wherein the first sub-filter, the second sub-filter and the main filter constitute a joint Kalman filter of a fusion feedback mode Device.
The flight controller according to claim 28, wherein the estimated value of the first height at a previous time of the current time is a fusion height of a previous time;

The estimated value of the second height at the previous moment of the current time is the fusion height of the previous moment.
The flight controller of claim 17, wherein the processor is further configured to:

The UAV is controlled to perform terrain following according to the height of the UAV from the ground below the UAV.
A flight controller according to claim 17, wherein said detecting means It includes at least one of the following:

Radar sensor, ultrasonic sensor, TOF distance measuring sensor, visual sensor.
The flight controller of claim 17 wherein said predetermined angle is a 45 degree angle.
An unmanned aerial vehicle, comprising:

body;

a power system mounted to the fuselage for providing flight power;

a first detecting device and a second detecting device are mounted on the body for measuring a height of the UAV from the ground, a detecting direction of the first detecting device and a yaw axis of the UAV The direction of the second detecting device is set along a yaw axis direction of the unmanned aerial vehicle;

a flight controller communicatively coupled to the power system for controlling the UAV flight; the flight controller includes one or more processors, the processor for:

Obtaining a first detection value of the first detecting device, and a second detection value of the second detecting device;

Determining, according to the first detection value and the second detection value, a height of the unmanned aerial vehicle from a ground below the unmanned aerial vehicle.
The UAV according to claim 33, wherein said processor determines, based on said first detected value and said second detected value, said unmanned aerial vehicle being located below said ground of said unmanned aerial vehicle The height is specifically used for:

Data fusion is performed according to the first detection value and the second detection value to obtain a fusion height, which is a height of the unmanned aerial vehicle from a ground below the unmanned aerial vehicle.
The unmanned aerial vehicle according to claim 34, wherein the processor performs data fusion according to the first detection value and the second detection value, specifically for:

Determining, according to the first detection value, a first height, where the first height is a vertical height of the UAV from the first ground, and the first ground is in a detecting direction of the first detecting device;

Determining, according to the second detection value, a second height, wherein the second height is a vertical height of the UAV from the second ground, and the second ground is at a detecting side of the second detecting device up;

Data fusion is performed according to the first height and the second height.
The UAV according to claim 35, wherein the processor is configured to: when determining the first height according to the first detection value:

Determining an estimated value of the first height at a current time according to the fusion height before the current time;

Determining, according to the first detection value of the current moment, a measured value of the first height at the current moment;

And determining, according to the estimated value of the first height and the measured value at the current moment, a new spread of the first height at the current moment.
The UAV according to claim 35, wherein the processor is configured to: when determining the first height according to the first detection value:

Determining an estimated value of the first height at the current time according to the estimated value of the first height at a previous moment of the current time;

Determining, according to the first detection value of the current moment, a measured value of the first height at the current moment;

And determining, according to the estimated value of the first height and the measured value at the current moment, a new spread of the first height at the current moment.
The UAV according to claim 35, wherein the processor is specifically configured to: when determining the second height according to the second detection value:

Determining an estimated value of the second height at the current time according to the fusion height before the current time;

Determining, according to the second detection value of the current moment, a measured value of the second height at the current moment;

The new interest rate of the second height at the current time is determined according to the estimated value of the second height and the measured value at the current time.
The UAV according to claim 35, wherein the processor is specifically configured to: when determining the second height according to the second detection value:

Determining an estimated value of the second height at the current time according to the estimated value of the second height at a previous moment of the current time;

Determining, according to the second detection value of the current moment, a measured value of the second height at the current moment;

The new interest rate of the second height at the current time is determined according to the estimated value of the second height and the measured value at the current time.
The unmanned aerial vehicle according to any one of claims 36 to 39, wherein the processor performs data fusion according to the first height and the second height, and is specifically used for:

Determining a fusion weight of the estimated value of the first height and a fusion weight of the estimated value of the second height according to the new interest difference of the first height at the current time and the new interest difference of the second height at the current time ;

Calculating the current time according to the fusion specific gravity of the measured value of the first height, the estimated value of the first height at the current time, the fusion specific gravity of the estimated value of the second height, and the estimated value of the second height at the current time. The height of the fusion.
The UAV according to claim 37, wherein the flight controller further comprises:

a first sub-filter connected in communication with the processor, the first sub-filter is configured to perform filtering processing on the first detection value to obtain an estimated value of the first height.
The UAV according to claim 39, wherein the flight controller further comprises:

a second sub-filter connected in communication with the processor, the second sub-filter is configured to perform filtering processing on the second detection value to obtain an estimated value of the second height.
The UAV according to claim 40, wherein the flight controller further comprises:

a main filter communicatively coupled to the processor, the main filter for modulating a specific gravity of the measured value of the first height, an estimated value of the first height at a current time, and an estimated value of the second height The fusion weight and the estimated value of the second height at the current time are combined and calculated.
The UAV according to any one of claims 41 to 43 wherein said first sub-filter, said second sub-filter and said main filter form a combined Kalman filter of a fusion feedback mode Device.
The UAV according to claim 44, wherein the estimated value of the first height at a previous moment of the current time is a fusion height of a previous time;

The estimated value of the second height at the previous moment of the current time is the fusion height of the previous moment.
The UAV according to claim 33, wherein the processor is further configured to:

The UAV is controlled to perform terrain following according to the height of the UAV from the ground below the UAV.
The UAV according to claim 33, wherein said detecting device comprises at least one of the following:

Radar sensor, ultrasonic sensor, TOF distance measuring sensor, visual sensor.
The UAV according to claim 33, wherein said predetermined angle is an angle of 45 degrees.