Height detection method, device, terminal equipment and storage medium
Through the data fusion of multi-radar sensors and inertial sensors, the problems of instability and inaccuracy of altitude detection in traditional aircraft are solved by using height filtering and Kalman filtering algorithms, and the safety of the aircraft is improved.
Patent Information
- Application Number
- CN202310286206.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2023-03-21
- Publication Date
- 2024-11-05
- Estimated Expiration
- 2043-03-21
AI Technical Summary
During take-off and landing of traditional aircraft, GPS signal interference and barometer failure lead to instability and inaccuracy of altitude detection, reducing the safety of the aircraft.
By obtaining ground-off altitude data and accelerometer parameter values, using multi-radar sensors and inertial sensors for data fusion, applying a height filtering algorithm and a Kalman filtering algorithm to generate real-time height output values, improving the accuracy and stability of height detection.
It improves the accuracy and stability of the aircraft's altitude detection and enhances the safety of the aircraft, especially in complex terrain environments near the ground.
Smart Images

Figure CN116147578B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of flight control technology, and in particular to a height detection method, device, terminal equipment and storage medium. Background Art
[0002] With the rapid development of modern transportation, small manned aircraft are attracting more and more attention. Small manned aircraft are one of the important options for integrating into the future three-dimensional transportation network. The flight process of a manned aircraft is mainly divided into three stages: take-off, navigation, and landing. During take-off and landing, the relative height of the aircraft from the ground is one of the most important parameters, which requires the height sensor system on the aircraft to continuously provide accurate height information.
[0003] Traditional aircraft altitude data is usually obtained through GPS or barometers, but in scenarios close to the ground, GPS signals may be severely interfered with, and GPS can often only obtain altitude, but it is difficult to obtain the relative height of the aircraft and the ground, especially when there are obstacles on the ground. As the aircraft gets closer to the ground, the stability, accuracy, and continuity of altitude information become increasingly important to the safety of the aircraft's takeoff and landing. The strong ground effect of the aircraft near the ground can cause the barometer to fail in this situation, resulting in serious errors or large fluctuations in the height output by the barometer, which reduces the safety of the aircraft during takeoff and landing.
[0004] Therefore, it is necessary to propose a solution to improve the safety of aircraft by improving the accuracy, stability and continuity of aircraft altitude detection.
[0005] The above contents are only used to assist in understanding the technical solution of the present invention and do not constitute an admission that the above contents are prior art. Summary of the invention
[0006] The main purpose of the present invention is to provide a height detection method, device, terminal equipment and storage medium, aiming to improve the safety of the aircraft by improving the accuracy, stability and continuity of the height detection of the aircraft.
[0007] To achieve the above object, the present invention provides a height detection method, which comprises:
[0008] Get the height from the ground data and accelerometer parameter values;
[0009] fusing the height above the ground data to obtain target height data;
[0010] The accelerometer parameter value is fused with the target height data to obtain a real-time height output value.
[0011] Optionally, the step of obtaining the height above the ground data and the accelerometer parameter value comprises:
[0012] Acquire height-from-ground data corresponding to each radar sensor, wherein each radar sensor includes a first-type radar sensor and / or a second-type radar sensor;
[0013] The accelerometer parameter value is obtained through an inertial sensor.
[0014] Optionally, the step of fusing the height above the ground data to obtain target height data includes:
[0015] Determining the height interval of the height above the ground data;
[0016] If the height above the ground data is in the first height interval, the height above the ground data corresponding to the first type of radar sensor is fused based on a height filtering algorithm to obtain the target height data;
[0017] If the height above the ground data is in the second height interval, the height above the ground data corresponding to the first type of radar sensor and the second type of radar sensor are fused based on a height filtering algorithm to obtain the target height data.
[0018] Optionally, the first type of radar sensor includes a first sensor and a second sensor, and after the step of fusing the ground height data corresponding to the first type of radar sensor based on the height filtering algorithm to obtain the target height data, the step further includes:
[0019] Calculating a first height difference according to the height above the ground data corresponding to the first sensor and the second sensor;
[0020] Calculating a relative angle according to the distance between the first sensor and the second sensor in combination with the first height difference;
[0021] Determine the ground slope angle according to the relative angle, and judge whether the ground slope angle exceeds a first angle threshold;
[0022] If the ground slope angle exceeds a first angle threshold, a first prompt message is output.
[0023] Optionally, the second type of radar sensor includes a third sensor and a fourth sensor, and after the step of fusing the ground height data corresponding to the first type of radar sensor and the second type of radar sensor based on the height filtering algorithm to obtain the target height data, the step further includes:
[0024] Determining whether the ground topography is a plane according to the height above the ground data corresponding to the first sensor, the second sensor, the third sensor, and the fourth sensor;
[0025] If the ground topography is a plane, the slope angle of the plane is calculated, and when the slope angle of the plane exceeds a second angle threshold, a second prompt message is output;
[0026] If the ground topography is not a plane, a third prompt message is output.
[0027] Optionally, the step of judging whether the ground topography is a plane according to the height above the ground data corresponding to the first sensor, the second sensor, the third sensor and the fourth sensor comprises:
[0028] Determine the plane equation of the ground and the position of the fourth target point according to the height above the ground data corresponding to the first sensor, the second sensor, the third sensor and the fourth sensor;
[0029] Determining whether the fourth target point is located on the plane equation of the ground;
[0030] If the fourth target point is located on the plane equation of the ground, the ground topography is determined to be a plane;
[0031] If the position of the fourth target point is not located on the plane equation of the ground, it is determined that the ground topography is not a plane.
[0032] Optionally, after the step of fusing the accelerometer parameter value with the target height data to obtain a real-time height output value, the step further includes:
[0033] The real-time altitude output value is transmitted to a flight control system so that the flight control system generates corresponding flight action instructions according to the real-time altitude output value.
[0034] In addition, to achieve the above object, the present invention further provides a height detection device, the height detection device comprising:
[0035] An acquisition module is used to obtain the height above the ground data and the accelerometer parameter value;
[0036] A first fusion module is used to fuse the height above the ground data to obtain target height data;
[0037] The second fusion module is used to fuse the accelerometer parameter value with the target height data to obtain a real-time height output value.
[0038] In addition, to achieve the above-mentioned purpose, the present invention also provides a terminal device, which includes a memory, a processor, and a height detection program stored in the memory and executable on the processor, and the height detection program, when executed by the processor, implements the steps of the height detection method described above.
[0039] In addition, to achieve the above-mentioned purpose, the present invention also provides a computer-readable storage medium, on which a height detection program is stored, and when the height detection program is executed by a processor, the steps of the height detection method as described above are implemented.
[0040] An altitude detection method, apparatus, terminal device and storage medium proposed in an embodiment of the present invention obtain height data above the ground and accelerometer parameter values; fuse the height data above the ground to obtain target height data; fuse the accelerometer parameter values with the target height data to obtain a real-time altitude output value, and further fuse the target altitude data obtained by fusing the height data above the ground with the accelerometer parameter values to obtain a real-time altitude output value, thereby improving the accuracy of altitude detection, and at the same time improving the stability and continuity of aircraft altitude detection, thereby helping to improve the safety of the aircraft. BRIEF DESCRIPTION OF THE DRAWINGS
[0041] Figure 1 This is a schematic diagram of the functional modules of the terminal device to which the height detection device of the present invention belongs;
[0042] Figure 2 A schematic diagram of a flow chart of an exemplary embodiment of a height detection method of the present invention;
[0043] Figure 3 for Figure 2 A schematic diagram of a specific process of step S20 in the embodiment;
[0044] Figure 4 Schematic diagram of the height measurement sensor system architecture in an embodiment of the present invention;
[0045] Figure 5 is a schematic diagram of the architecture of an all-terrain take-off and landing system in an embodiment of the present invention;
[0046] Figure 6 It is a flowchart of the all-terrain automatic take-off and landing method in an embodiment of the present invention;
[0047] Figure 7 Schematic diagram of the height filter algorithm in an embodiment of the present invention.
[0048] The realization of the purpose, functional features and advantages of the present invention will be further explained in conjunction with embodiments and with reference to the accompanying drawings. DETAILED DESCRIPTION
[0049] It should be understood that the specific embodiments described herein are only used to explain the present invention, and are not used to limit the present invention.
[0050] The main solution of the embodiment of the present invention is: by acquiring height above the ground data and accelerometer parameter values; fusing the height above the ground data to obtain target height data; fusing the accelerometer parameter values with the target height data to obtain a real-time height output value, and further fusing the target height data obtained by fusing the height above the ground data with the accelerometer parameter values to obtain a real-time height output value, thereby improving the accuracy of height detection, and at the same time improving the stability and continuity of aircraft height detection, thereby helping to improve the safety of the aircraft.
[0051] Specifically, refer to Figure 1 , Figure 1 Schematic diagram of the functional modules of the terminal device to which the height detection device of the present invention belongs. The height detection device can be a device that is independent of the terminal device and can perform height detection, and it can be carried on the terminal device in the form of hardware or software. The terminal device can be a smart mobile terminal with data processing function such as a mobile phone or a tablet computer, or a fixed terminal device or server with data processing function.
[0052] In this embodiment, the terminal device to which the height detection apparatus belongs includes at least an output module 110 , a processor 120 , a memory 130 and a communication module 140 .
[0053] The memory 130 stores an operating system and a height detection program. The height detection device can obtain the height data from the ground and the accelerometer parameter values corresponding to each sensor, fuse the height data from the ground based on a preset height filtering algorithm, obtain the target height data, and fuse the accelerometer parameter value with the target height data to obtain the real-time height output value and other information in the memory 130; the output module 110 can be a display screen, etc. The communication module 140 can include a WIFI module, a mobile communication module, a Bluetooth module, etc., and communicate with an external device or server through the communication module 140.
[0054] When the height detection program in the memory 130 is executed by the processor, the following steps are implemented:
[0055] Get the height from the ground data and accelerometer parameter values;
[0056] fusing the height above the ground data to obtain target height data;
[0057] The accelerometer parameter value is fused with the target height data to obtain a real-time height output value.
[0058] Furthermore, when the height detection program in the memory 130 is executed by the processor, the following steps are also implemented:
[0059] Acquire height-from-ground data corresponding to each radar sensor, wherein each radar sensor includes a first-type radar sensor and / or a second-type radar sensor;
[0060] The accelerometer parameter value is obtained through an inertial sensor.
[0061] Furthermore, when the height detection program in the memory 130 is executed by the processor, the following steps are also implemented:
[0062] Determining the height interval of the height above the ground data;
[0063] If the height above the ground data is in the first height interval, the height above the ground data corresponding to the first type of radar sensor is fused based on a height filtering algorithm to obtain the target height data;
[0064] If the height above the ground data is in the second height interval, the height above the ground data corresponding to the first type of radar sensor and the second type of radar sensor are fused based on a height filtering algorithm to obtain the target height data.
[0065] Furthermore, when the height detection program in the memory 130 is executed by the processor, the following steps are also implemented:
[0066] Calculating a first height difference according to the height above the ground data corresponding to the first sensor and the second sensor;
[0067] Calculating a relative angle according to the distance between the first sensor and the second sensor in combination with the first height difference;
[0068] Determine the ground slope angle according to the relative angle, and judge whether the ground slope angle exceeds a first angle threshold;
[0069] If the ground slope angle exceeds a first angle threshold, a first prompt message is output.
[0070] Furthermore, when the height detection program in the memory 130 is executed by the processor, the following steps are also implemented:
[0071] Determining whether the ground topography is a plane according to the height above the ground data corresponding to the first sensor, the second sensor, the third sensor, and the fourth sensor;
[0072] If the ground topography is a plane, the slope angle of the plane is calculated, and when the slope angle of the plane exceeds a second angle threshold, a second prompt message is output;
[0073] If the ground topography is not a plane, a third prompt message is output.
[0074] Furthermore, when the height detection program in the memory 130 is executed by the processor, the following steps are also implemented:
[0075] Determine the plane equation of the ground and the position of the fourth target point according to the height above the ground data corresponding to the first sensor, the second sensor, the third sensor and the fourth sensor;
[0076] Determining whether the fourth target point is located on the plane equation of the ground;
[0077] If the fourth target point is located on the plane equation of the ground, the ground topography is determined to be a plane;
[0078] If the position of the fourth target point is not located on the plane equation of the ground, it is determined that the ground topography is not a plane.
[0079] Furthermore, when the height detection program in the memory 130 is executed by the processor, the following steps are also implemented:
[0080] The real-time altitude output value is transmitted to a flight control system so that the flight control system generates corresponding flight action instructions according to the real-time altitude output value.
[0081] This embodiment adopts the above scheme, specifically by acquiring height above the ground data and accelerometer parameter values; fusing the height above the ground data to obtain target height data; fusing the accelerometer parameter values with the target height data to obtain a real-time height output value, and further fusing the target height data obtained by fusing the height above the ground data with the accelerometer parameter values to obtain a real-time height output value, thereby improving the accuracy of height detection, and at the same time improving the stability and continuity of aircraft height detection, thereby helping to improve the safety of the aircraft.
[0082] Based on the above terminal device architecture but not limited to the above architecture, an embodiment of the method of the present invention is proposed.
[0083] The execution subject of the method of this embodiment may be a height detection device or a terminal device, etc. This embodiment takes a height detection device as an example.
[0084] Reference Figure 2 , Figure 2 1 is a flow chart of an exemplary embodiment of a height detection method of the present invention. The height detection method comprises:
[0085] Step S10, obtaining height data from the ground and accelerometer parameter values;
[0086] Specifically, an altitude sensor system is provided in an embodiment of the present invention, which includes various sensors. As one implementation, the altitude sensor system is composed of a millimeter wave radar, a single-point laser radar, and two ultrasonic radars. The altitude data of the aircraft above the ground can be obtained through each sensor. In addition, the accelerometer parameter value can be obtained through the inertial sensor, which is used to fuse with the altitude data to further improve the accuracy and stability of the altitude data output in real time.
[0087] Optionally, before the step of obtaining the height above the ground data and the accelerometer parameter value, the pilot or passenger may issue a take-off or landing instruction to enable the controller of the aircraft to start receiving data from the altimeter sensor system in real time.
[0088] Optionally, the pilot or passenger may issue a take-off or landing command through one or more of physical buttons, virtual buttons, voice control, and gesture commands.
[0089] Step S20, fusing the height above the ground data to obtain target height data;
[0090] Furthermore, after obtaining the height above the ground data corresponding to each sensor, the height above the ground data can be fused through a preset height filtering algorithm to obtain target height data. In this process, the height above the ground data to be used can be determined by judging the interval in which the height above the ground of the aircraft is located.
[0091] Optionally, when the height above the ground of the aircraft is in a first height interval, the height above the ground data corresponding to the first type of radar sensor with a range within the first height interval is selected and fused through an altitude filtering algorithm to calculate the target height data. In an embodiment of the present invention, the first type of radar sensor includes a first sensor and a second sensor.
[0092] Optionally, when the height above the ground of the aircraft is in the second height interval, since the second height interval in the embodiment of the present invention is smaller than the first height interval, the height above the ground at this time is also within the range of the first height interval. Therefore, while selecting the second type of radar sensor with a range within the second height interval, the height above the ground data corresponding to the first type of radar sensor can also be selected and fused through an altitude filtering algorithm to calculate the target height data. In the embodiment of the present invention, the sensors with a range within the second height interval include a third sensor and a fourth sensor.
[0093] Step S30, fusing the accelerometer parameter value with the target height data to obtain a real-time height output value.
[0094] Furthermore, after the height data above the ground is fused through the height filtering algorithm and the target height data is obtained, the data can be fused in combination with the accelerometer parameter value to obtain a real-time height output value.
[0095] Optionally, the step of fusing the accelerometer parameter value with the target height data to obtain a real-time height output value comprises:
[0096] The accelerometer parameter value and the target height data are input into a Kalman filter algorithm for real-time iteration to obtain the real-time height output value.
[0097] Specifically, after obtaining the radar altitude fusion value H_fusion, due to the characteristics of radar ranging and the complexity of the ground environment, the relative altitude obtained by multi-radar fusion may have large noise and jumps, which is not conducive to further flight control. The inertial sensor is only related to the aircraft's own state and is less affected by external interference and ground topography. Therefore, by fusing the accelerometer parameters and the altitude output by radar fusion, the stability and accuracy of the aircraft's relative altitude can be significantly improved, and accurate and stable altitude output can be achieved.
[0098] In the Kalman filter algorithm, let the state vector of the system be X(k), the state transfer matrix F, the observation value Z(k), the mapping matrix H, the sensor noise covariance matrix R, the noise covariance matrix Q, and the five formulas of the Kalman filter algorithm be as follows:
[0099]
[0100] P(k)=F*P(k-1)*F T +Q
[0101] K=P(k)*H T *(H*P(k)H T +R)-1
[0102]
[0103] P′(k)=P(k)-K*H*P(k)
[0104] Among them, the state vector X(k) = [h(k), v(k), a(k)]T. Here, the sampling interval T is assumed to be very short, and the acceleration can be approximately considered to be constant, so the following formula can be obtained;
[0105] h(k+1)=h(k)+v(k)*T+0.5*a(k)*T2
[0106] v(k+1)=0*h(k)+v(k)+a(k)*T
[0107] a(k+1)=0*h(k)+O*v(k)*T+a(k)
[0108] The state transfer matrix F = [1, T, 0.5T2; 0, 1, T; 0, 0, 1] can be obtained
[0109] From the perspective of the sensor, the observable value Z(k) = [h(k), a(k)], then the mapping matrix H = [1, 0, 0; 0, 0, 1], the observation error R = [10, 0; 0, 0.5], the process error Q = [0.00001, 0, 0; 0, 0.00001, 0; 0, 0, 0.00001], the initial value is provided by the height sensor and accelerometer, and the above matrix is brought into the five formulas of the Kalman filter algorithm and iterated. The filtered height output H_out can be obtained through real-time iteration of the Kalman filter.
[0110] Optionally, after the step of fusing the accelerometer parameter value with the target height data to obtain a real-time height output value, the method further includes:
[0111] The real-time altitude output value is transmitted to a flight control system so that the flight control system generates corresponding flight action instructions according to the real-time altitude output value.
[0112] Optionally, the real-time altitude output is transmitted to the flight control computer, and the flight control system feeds the altitude data back to the control of the aircraft's attitude and speed, and gives corresponding flight action instructions. The aircraft performs planned flight actions according to the instructions output by the flight control computer and completes the take-off or landing command, thereby improving the safety of the aircraft during flight or landing.
[0113] In this embodiment, by acquiring height above the ground data and accelerometer parameter values; fusing the height above the ground data to obtain target height data; fusing the accelerometer parameter values with the target height data to obtain a real-time height output value, the target height data obtained by fusing the height above the ground data is further fused with the accelerometer parameter values to obtain a real-time height output value, thereby improving the accuracy of height detection, and at the same time improving the stability and continuity of aircraft height detection, thereby helping to improve the safety of the aircraft.
[0114] Reference Figure 3 , Figure 3 for Figure 2 The specific flow chart of step S20 in the embodiment. Figure 2 In the embodiment shown, in this embodiment, the above step S20 includes:
[0115] Step S201, determining the height interval of the height above the ground data;
[0116] Specifically, each sensor includes a first sensor, a second sensor, a third sensor and a fourth sensor. In the embodiment of the present invention, the first sensor is a single-point laser radar, the second sensor is a millimeter-wave radar, and the third sensor and the fourth sensor are both ultrasonic radars. In the actual take-off and landing process of the aircraft, the ultrasonic radar can provide reliable aircraft height data from the ground during the take-off and landing phases near the ground based on its high precision and low blind spot distance at close range. When the aircraft rises beyond the range of the ultrasonic radar, the millimeter-wave radar and the single-point laser radar can continue to output accurate height from the ground for the aircraft. A variety of height-measuring radars with different working principles bring heterogeneous redundant security of devices. First, it can avoid the risk of simultaneous failure of the same multi-radar redundant system; second, different height-measuring radars can complement each other in take-off and landing scenes and ranging heights due to their different ranging principles, and truly realize automatic take-off and landing in all scenes. In addition, in areas where multiple radars are effective at the same time, the stability of the aircraft's height output from the ground and the judgment of the terrain below the aircraft and the reference for whether to take off and land can be further improved according to the multi-radar fusion algorithm.
[0117] In the embodiment of the present invention, two height thresholds are set, the first height threshold is H1, and the second height threshold is H2. When the height threshold is greater than the first height threshold H1, the maximum range of each radar sensor is exceeded, and the radar outputs an invalid value. The radar fusion height is defined as:
[0118] H_fusion = H_out = 65535;
[0119] Optionally, the first height interval is less than the first height threshold H1 and greater than the second height threshold H2. At this time, the distance relative to the ground exceeds the range of the ultrasonic radar, but is within the range of the single-point laser and millimeter-wave radar, and the radar outputs heights of H_lidar and H_radar respectively.
[0120] Optionally, the second altitude interval is less than the second altitude threshold H2 and greater than 0. At this time, the height of the aircraft relative to the ground is within the measurement range of the four radars, and the four radars simultaneously output the altitudes, which are H_lidar, H_radar, H_uss1 and H_uss2 respectively.
[0121] Step S202: If the height above the ground data is in the first height interval, the height above the ground data corresponding to the first type of radar sensor is fused based on a height filtering algorithm to obtain the target height data;
[0122] Optionally, if the height above the ground data is in the first height interval, that is, less than the first height threshold H1 and greater than the second height threshold H2, the distance relative to the ground is within the range of the single-point laser and millimeter-wave radar, and the radar outputs the heights H_lidar and H_radar respectively. According to the accuracy advantage of the radar, the weighted mean filter fusion algorithm is adopted, that is:
[0123] H_fusion=H_lidar*α+H_radar*(1-α)
[0124] Among them, the α value is segmented, and different weight values are assigned according to the accuracy characteristics of the two radars. The single-point laser radar maintains a measurement accuracy of 5% in the full range, and the closer the error, the smaller the error. The measurement accuracy of the millimeter-wave radar at long distances is basically the same as that at short distances, and can be maintained at about 10 cm. Therefore, as the ranging distance increases, the accuracy of the single-point laser radar will deteriorate. Therefore, the α value here is as follows:
[0125]
[0126] Optionally, after fusing the ground height data corresponding to the first type of radar sensor based on a height filtering algorithm to obtain the target height data, the method further includes:
[0127] Calculating a first height difference according to the height above the ground data corresponding to the first sensor and the second sensor;
[0128] Calculating a relative angle according to the distance between the first sensor and the second sensor in combination with the first height difference;
[0129] Determine the ground slope angle according to the relative angle, and judge whether the ground slope angle exceeds a first angle threshold;
[0130] If the ground slope angle exceeds a first angle threshold, a first prompt message is output.
[0131] Specifically, since the distance between the radars is fixed, set as L, then according to the distance L between the radars and the height difference ΔH, the angle of the aircraft relative to the ground at this time can be obtained through trigonometric relationship. During the landing process, the attitude of the aircraft always remains parallel to the horizontal plane, so the calculated angle can be considered as the angle between the ground slope and the water surface. Here, the angle can be calculated as:
[0132] Θ=arctan(ΔH / L)
[0133] In the embodiment of the present invention, an angle threshold Δθ1 is set in the system. When θ<Δθ1, it is determined that the slope angle of the ground is small and does not affect the landing safety. When θ≥Δθ1, it is determined that the slope angle of the ground is too large, and a first prompt message is generated. For example, the driver is reminded on the display screen that "the slope of the ground is too large, and you need to determine whether to continue landing, or choose other areas that meet the landing conditions to land."
[0134] Step S203: If the height above the ground data is in the second height interval, the height above the ground data corresponding to the first type of radar sensor and the second type of radar sensor are fused based on a height filtering algorithm to obtain the target height data.
[0135] Optionally, if the height above the ground data is in the second height interval, that is, less than the second height threshold H2 and greater than 0, at this time, the height of the aircraft relative to the ground is all within the range of the four radars, and the four radars simultaneously output the heights, namely H_lidar, H_radar, H_uss1 and H_uss2. At this time, the weighted mean filter fusion algorithm is also used, that is:
[0136] H_fusion=H_lidar*α1+(H_uss1+H_uss2) / 2*α2+H_radar*(1-α1-α2)
[0137] In the embodiment of the present invention, since ultrasonic radar has the highest accuracy at close range, followed by single-point laser radar, and millimeter wave accuracy is the worst, α1=0.4 and α1=0.5.
[0138] Optionally, based on a height filtering algorithm, the ground height data corresponding to the first type of radar sensor and the second type of radar sensor are fused to obtain the target height data, and the step further includes:
[0139] Determining whether the ground topography is a plane according to the height above the ground data corresponding to the first sensor, the second sensor, the third sensor, and the fourth sensor;
[0140] If the ground topography is a plane, the slope angle of the plane is calculated, and when the slope angle of the plane exceeds a second angle threshold, a second prompt message is output;
[0141] If the ground topography is not a plane, a third prompt message is output.
[0142] Optionally, the step of judging whether the ground topography is a plane according to the height above the ground data corresponding to the first sensor, the second sensor, the third sensor and the fourth sensor includes:
[0143] Determine the plane equation of the ground and the position of the fourth target point according to the height above the ground data corresponding to the first sensor, the second sensor, the third sensor and the fourth sensor;
[0144] Determining whether the fourth target point is located on the plane equation of the ground;
[0145] If the fourth target point is located on the plane equation of the ground, the ground topography is determined to be a plane;
[0146] If the position of the fourth target point is not located on the plane equation of the ground, it is determined that the ground topography is not a plane.
[0147] Specifically, since the height data of four radars are obtained, more topographic information about the landing ground can be obtained. The coordinates of three non-collinear points in space can uniquely determine a plane, and the plane equation of the landing ground in space can be obtained. Suppose this plane equation is a general formula:
[0148] A*x+B*y+C*z+D=0
[0149] Substituting the spatial positions of the target points measured by three of the radars, the coefficients of the plane equation can be obtained. Substituting the spatial position of the target point measured by the fourth radar into the plane equation, it can be determined whether this point is located in the plane equation where the ground is located. There are two cases here:
[0150] In the first case, the fourth target point is on the plane equation, and the angle of inclination of the ground can be calculated by the angle formula between this plane and the horizontal plane:
[0151]
[0152] Among them, n1 and n2 are the normal vectors of the ground and the horizontal plane respectively, n1=(A,B,C), n2=(0,0,1). Similarly, after calculating the angle Θ, when Θ<Δθ1, it is determined that the slope angle of the ground is small and does not affect the landing safety. When Θ≥Δθ1, it is determined that the slope angle of the ground is too large, and a second prompt message is generated. For example, the driver is reminded on the display screen that "the ground slope is too large, and you need to determine whether to continue landing, or choose other areas that meet the landing conditions to land."
[0153] In the second case, when the fourth target point is not on the required plane equation, it means that the ground topography is not a flat plane, but may be an uneven surface, which is not conducive to the landing of the aircraft, and a third prompt message is generated, for example, the display screen reminds the pilot that "the ground is uneven, and you need to determine whether to continue landing, or choose other areas that meet the landing conditions to land."
[0154] It should be noted that single-point laser radar, millimeter-wave radar and ultrasonic radar are selected in the embodiment of the present invention, and the types of each radar are not irreplaceable. Array laser radar, binocular camera, 3D structured light and other ranging sensors can also be used, but the premise is that it is necessary to balance long-range and short-range ranging, multi-scene coverage and heterogeneous redundancy design to ensure the stability, accuracy and security of the system. The weighted mean filtering algorithm and Kalman fusion algorithm mentioned in the embodiment of the present invention are both general algorithm models selected, on this basis, they can be expanded to more complex algorithm models to achieve different purposes.
[0155] This embodiment adopts the above scheme, specifically by judging the altitude interval in which the altitude data is located; if the altitude data is in the first altitude interval, then based on the altitude filtering algorithm, the altitude data corresponding to the first type of radar sensor is fused to obtain the target altitude data; if the altitude data is in the second altitude interval, then based on the altitude filtering algorithm, the altitude data corresponding to the first type of radar sensor and the second type of radar sensor are fused to obtain the target altitude data. Through the built-in sensors and altitude filtering algorithm, not only the full-range high-precision output of the aircraft altitude can be achieved, but also the terrain of the landing ground can be identified through the data of each sensor, providing real-time warning to the driver, assisting the flight control to accurately control the take-off and landing speed and state of the aircraft, improving accuracy and improving flight quality.
[0156] In addition, an embodiment of the present invention further provides a height detection device, the height detection device comprising:
[0157] An acquisition module is used to obtain the height above the ground data and the accelerometer parameter value;
[0158] A first fusion module is used to fuse the height above the ground data to obtain target height data;
[0159] The second fusion module is used to fuse the accelerometer parameter value with the target height data to obtain a real-time height output value.
[0160] Specifically, the embodiment of the present invention proposes an all-terrain automatic landing system solution and hardware device based on multi-sensor fusion, referring to Figure 4 , Figure 4 FIG. 1 is a schematic diagram of the architecture of the height measuring sensor system in an embodiment of the present invention. Figure 4As shown, S12 is a medium-long-range millimeter-wave radar, S13 is a medium-long-range single-point laser radar, and S14 and S15 are two close-range ultrasonic radars. They are arranged on the lower surface of the front and rear chassis of the aircraft. The arrangement in the front and rear areas is also based on the redundancy consideration of the position arrangement to increase the safety of the system. There are many types of height measurement sensors, such as array laser radar, binocular camera, 3D structured light sensor, etc. The radar in this system is not limited to the design in the figure, but it is necessary to ensure the matching of long and short ranges and different ranging principles. The sensors selected in the embodiment of the present invention are based on the overall consideration of system safety, functionality and economy. In the actual take-off and landing process of the aircraft, the ultrasonic radar can provide reliable aircraft height data from the ground during the near-ground stage of take-off and landing based on its high precision and low blind spot distance at close range. When the aircraft rises beyond the range of the ultrasonic radar, the millimeter-wave radar and single-point laser radar can continue to output accurate height from the ground for the aircraft. A variety of altitude radars with different working principles bring about heterogeneous redundant security of devices. First, it can avoid the risk of simultaneous failure of the same multi-radar redundant system. Second, different altitude radars can complement each other in take-off and landing scenarios and ranging heights due to their different ranging principles, truly realizing automatic take-off and landing in all scenarios.
[0161] In addition, in areas where multiple radars are effective at the same time, the stability of the aircraft's height above the ground output and the judgment of the terrain below the aircraft and the reference for whether to take off and land can be further improved according to the multi-radar fusion algorithm. Since the height measuring radar has certain distance jumps and noise-induced range fluctuations regardless of the principle it is based on, an altitude fusion algorithm of the height measuring radar and the accelerometer based on Kalman filtering is also proposed in the embodiment of the present invention, so as to improve the stability and accurate output of the aircraft's relative height to the ground.
[0162] Reference Figure 5 , Figure 5 FIG. 1 is a schematic diagram of the architecture of an all-terrain takeoff and landing system in an embodiment of the present invention. Figure 5 As shown, the all-terrain automatic landing system based on multi-sensor fusion proposed in the embodiment of the present invention mainly includes an input device, a controller, a ranging module, a display screen, and a memory, which specifically includes:
[0163] S21: Input device, which inputs a take-off or landing command. The input device here can be a physical button, a virtual button on the UI interface, a voice or gesture command, etc.;
[0164] S22: Controller, which is the control center system of the aircraft. When receiving the command input by the input device, the system starts to receive the altitude data from the ranging module, calculates the actual altitude of the aircraft from the ground according to the built-in altitude filter, and sends it to the memory and display screen;
[0165] S23: a distance measurement module, which is the height measurement sensor system composed of multiple sensors mentioned in the above embodiments of the present invention, and is composed of a millimeter wave radar, a single-point laser radar, and two ultrasonic radars. The distance measurement module continuously outputs the height of the aircraft above the ground since the aircraft is powered on. When the aircraft is stationary on the ground, the output height is 0. After leaving the ground, the actual height above the ground is output. The data is transmitted to the controller, and then enters the height filter to fuse and output the accurate height above the ground.
[0166] S24: Memory, this device is the storage unit of the aircraft, used to store the altitude data sent from the controller.
[0167] S25: Display screen. This device is a display device of the aircraft and is used to display the altitude data sent from the controller, so as to remind the pilot or the passenger of the actual altitude of the aircraft from the ground and the shape of the ground.
[0168] Reference Figure 6 , Figure 6 FIG. 1 is a flow chart of an all-terrain automatic takeoff and landing method according to an embodiment of the present invention. Figure 6 As shown, the implementation process of the all-terrain automatic take-off and landing method based on multi-sensor fusion proposed in the embodiment of the present invention specifically includes:
[0169] S31: The pilot or passenger issues a take-off or landing command, which may be a physical button, a virtual button, a voice or a gesture command;
[0170] S32: After the take-off or landing command is issued, the controller of the aircraft starts to receive the ground altitude data corresponding to each sensor of the altitude sensor system in real time, and transmits it to the altitude filter;
[0171] S33: When the data of each height measuring radar is transmitted to the height filter, the height data is output after being fused by the height filter algorithm. The algorithm of the height filter is referred to the above embodiment and will not be described in detail here.
[0172] S34: The fused output altitude information is transmitted to a storage device for backup and to a display screen for viewing by relevant personnel, so as to remind relevant personnel to pay attention to the altitude of the aircraft above the ground;
[0173] S35: The fused output altitude is transmitted to the flight control computer, and the flight control system feeds the altitude data back to the control of the aircraft's attitude and speed, and gives corresponding flight action instructions;
[0174] S36: The aircraft performs the planned flight maneuvers according to the instructions output by the flight control computer and completes the take-off or landing command.
[0175] Reference Figure 7 , Figure 7 Schematic diagram of the height filter algorithm in the embodiment of the present invention. Figure 7 As shown, the algorithm implementation process of the height filter in the embodiment of the present invention mainly includes:
[0176] S41: Continuously output the respective altitude data and confidence data through four altitude radars;
[0177] S42: Output a fused altitude data and prompt information through the radar altitude fusion algorithm module;
[0178] S43: Outputting the aircraft's own altitude, speed and acceleration information through the accelerometer for subsequent Kalman fusion algorithm use;
[0179] S44: When the radar altitude fusion value H_fusion is obtained, due to the characteristics of radar ranging and the complexity of the ground environment, the relative altitude obtained by fusion of multiple radars may have large noise and jumps, which is not friendly to flight control. Only accurate and stable altitude output can enable the flight control system to provide better flight quality. The inertial sensor is only related to the state of the aircraft itself and is less affected by external interference and ground topography. Therefore, by fusing the parameters of the accelerometer and the altitude output by radar fusion, the stability and accuracy of the relative altitude of the aircraft can be significantly improved.
[0180] S45: The filtered real-time height output H_out can be obtained through real-time iteration of Kalman filtering. The multi-sensor fusion height measurement sensor system proposed in the embodiment of the present invention can effectively realize the height measurement of aircraft in all terrains and weather conditions such as sandy roads, cement roads, metal surfaces, woods and grasslands, flooded roads and deep water environments, ensuring that the aircraft can take off and land stably and safely under any circumstances, greatly improving the safety and applicability of the aircraft.
[0181] In this embodiment, through the fusion of multi-source heterogeneous radar sensors, the possibility of radar failure in complex scenes can be reduced, and the automatic take-off and landing and height measurement of the aircraft can be realized in all-terrain and all-weather scenes such as sandy roads, cement roads, metal surfaces, forests and grasslands, flooded roads and deep water environments. It can achieve the same high ranging accuracy and continuity in the full range of long and short distances, and heterogeneous redundancy also brings higher safety to the system. Through the built-in radar height fusion module and Kalman filter module, not only can the full-range high-precision aircraft height output be achieved, but also the terrain of the landing ground can be identified through the data of each height measurement radar, providing real-time warning to the driver, assisting the flight control to accurately control the take-off and landing speed and state of the aircraft, improving accuracy and improving flight quality.
[0182] In addition, an embodiment of the present invention also proposes a terminal device, which includes a memory, a processor, and a height detection program stored in the memory and executable on the processor, wherein the height detection program implements the steps of the height detection method described above when executed by the processor.
[0183] Since all the technical solutions of all the aforementioned embodiments are adopted when the height detection program is executed by the processor, it has at least all the beneficial effects brought by all the technical solutions of all the aforementioned embodiments, which will not be described one by one here.
[0184] In addition, an embodiment of the present invention further proposes a computer-readable storage medium, on which a height detection program is stored. When the height detection program is executed by a processor, the steps of the height detection method described above are implemented.
[0185] Since all the technical solutions of all the aforementioned embodiments are adopted when the height detection program is executed by the processor, it has at least all the beneficial effects brought by all the technical solutions of all the aforementioned embodiments, which will not be described one by one here.
[0186] Compared with the prior art, the altitude detection method, apparatus, terminal device and storage medium proposed in the embodiments of the present invention obtain altitude data above the ground and accelerometer parameter values; fuse the altitude data above the ground to obtain target altitude data; fuse the accelerometer parameter values with the target altitude data to obtain a real-time altitude output value, and further fuse the target altitude data obtained by fusing the altitude data above the ground with the accelerometer parameter values to obtain a real-time altitude output value, thereby improving the accuracy of altitude detection, and at the same time improving the stability and continuity of aircraft altitude detection, thereby helping to improve the safety of the aircraft.
[0187] It should be noted that, in this article, the terms "include", "comprises" or any other variations thereof are intended to cover non-exclusive inclusion, so that a process, method, article or system including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, article or system. In the absence of further restrictions, an element defined by the sentence "comprises a ..." does not exclude the existence of other identical elements in the process, method, article or system including the element.
[0188] The serial numbers of the above-mentioned embodiments of the present application are for description only and do not represent the advantages or disadvantages of the embodiments.
[0189] Through the description of the above implementation methods, those skilled in the art can clearly understand that the above-mentioned embodiment methods can be implemented by means of software plus a necessary general hardware platform, and of course by hardware, but in many cases the former is a better implementation method. Based on such an understanding, the technical solution of the present application, or the part that contributes to the prior art, can be embodied in the form of a software product, which is stored in a storage medium (such as ROM / RAM, magnetic disk, optical disk) as above, and includes a number of instructions for a terminal device (which can be a mobile phone, a computer, a server, a controlled terminal, or a network device, etc.) to execute the method of each embodiment of the present application.
[0190] The above are only preferred embodiments of the present invention, and are not intended to limit the patent scope of the present invention. Any equivalent structure or equivalent process transformation made using the contents of the present invention specification and drawings, or directly or indirectly applied in other related technical fields, are also included in the patent protection scope of the present invention.
Claims
1. A height detection method, characterized in that: The altitude detection method is used for a manned aircraft and comprises the following steps: Get the height from the ground data and accelerometer parameter values; fusing the height above the ground data to obtain target height data; Fusing the accelerometer parameter value with the target height data to obtain a real-time height output value; The step of fusing the height above the ground data to obtain target height data comprises: Determining the height interval of the height above the ground data; If the height above the ground data is in the first height interval, the height above the ground data corresponding to the first type of radar sensor is fused based on a height filtering algorithm to obtain the target height data; If the height above the ground data is in the second height interval, the height above the ground data corresponding to the first type of radar sensor and the second type of radar sensor are fused based on a height filtering algorithm to obtain the target height data; The first type of radar sensor includes a first sensor and a second sensor. After the step of fusing the ground height data corresponding to the first type of radar sensor based on the height filtering algorithm to obtain the target height data, the step further includes: Calculating a first height difference according to the height above the ground data corresponding to the first sensor and the second sensor; Calculate the relative angle according to the distance between the first sensor and the second sensor and the first height difference; Determine a ground slope angle according to the relative angle, and judge whether the ground slope angle exceeds a first angle threshold; If the ground slope angle exceeds a first angle threshold, a first prompt message is output.
2. The height detection method according to claim 1, characterized in that: The step of obtaining the height above the ground data and the accelerometer parameter value comprises: Acquire height-from-ground data corresponding to each radar sensor, wherein each radar sensor includes a first-type radar sensor and / or a second-type radar sensor; The accelerometer parameter value is obtained through an inertial sensor.
3. The height detection method according to claim 1, characterized in that: The second type of radar sensor includes a third sensor and a fourth sensor. After the step of fusing the ground height data corresponding to the first type of radar sensor and the second type of radar sensor based on the height filtering algorithm to obtain the target height data, the step further includes: Determining whether the ground topography is a plane according to the height above the ground data corresponding to the first sensor, the second sensor, the third sensor, and the fourth sensor; If the ground topography is a plane, the slope angle of the plane is calculated, and when the slope angle of the plane exceeds a second angle threshold, a second prompt message is output; If the ground topography is not a plane, a third prompt message is output.
4. The height detection method according to claim 3, characterized in that: The step of judging whether the ground topography is a plane according to the height above the ground data corresponding to the first sensor, the second sensor, the third sensor and the fourth sensor comprises: Determine the plane equation of the ground and the position of the fourth target point according to the height above the ground data corresponding to the first sensor, the second sensor, the third sensor and the fourth sensor; Determining whether the fourth target point is located on the plane equation of the ground; If the fourth target point is located on the plane equation of the ground, the ground topography is determined to be a plane; If the position of the fourth target point is not located on the plane equation of the ground, it is determined that the ground topography is not a plane.
5. The height detection method according to claim 1, characterized in that: After the step of fusing the accelerometer parameter value with the target height data to obtain a real-time height output value, the method further includes: The real-time altitude output value is transmitted to a flight control system so that the flight control system generates corresponding flight action instructions according to the real-time altitude output value.
6. A height detection device, characterized in that: The altitude detection device is used for a manned aircraft, comprising: An acquisition module is used to obtain the height above the ground data and the accelerometer parameter value; A first fusion module is used to fuse the height above the ground data to obtain target height data; A second fusion module is used to fuse the accelerometer parameter value with the target height data to obtain a real-time height output value; The first fusion module is further used to: determine the height interval of the height above the ground data; if the height above the ground data is in the first height interval, then based on the height filtering algorithm, the height above the ground data corresponding to the first type of radar sensor is fused to obtain the target height data; if the height above the ground data is in the second height interval, then based on the height filtering algorithm, the height above the ground data corresponding to the first type of radar sensor and the second type of radar sensor is fused to obtain the target height data; The first type of radar sensor includes a first sensor and a second sensor, and the device also includes: calculating a first height difference based on the height data above the ground corresponding to the first sensor and the second sensor; calculating a relative angle based on the distance between the first sensor and the second sensor in combination with the first height difference; determining a ground slope angle based on the relative angle, and judging whether the ground slope angle exceeds a first angle threshold; if the ground slope angle exceeds the first angle threshold, outputting a first prompt message.
7. A terminal device, characterized in that: The terminal device includes a memory, a processor, and a height detection program stored in the memory and executable on the processor, wherein the height detection program, when executed by the processor, implements the steps of the height detection method as described in any one of claims 1 to 5.
8. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores a height detection program, and when the height detection program is executed by a processor, the steps of the height detection method according to any one of claims 1 to 5 are implemented.
