CN112504320B

CN112504320B - Data validity detection method and device

Info

Publication number: CN112504320B
Application number: CN202011335156.7A
Authority: CN
Inventors: 梁宇恒
Original assignee: Guangzhou Xaircraft Technology Co Ltd
Current assignee: Guangzhou Xaircraft Technology Co Ltd
Priority date: 2017-08-01
Filing date: 2017-08-01
Publication date: 2022-11-08
Anticipated expiration: 2037-08-01
Also published as: CN112504320A; CN109323714B; CN109323714A

Abstract

The embodiment of the invention provides a method and a device for detecting data validity, wherein the method comprises the following steps: when the measurement opportunity is reached, acquiring measurement data measured by a designated sensor in the unmanned aerial vehicle; acquiring flight parameters of the unmanned aerial vehicle; and judging whether the measurement data is valid or not based on the flight parameters. The embodiment of the invention can avoid the influence of invalid data on the measurement precision, and improve the measurement precision, thereby improving the operation quality of the unmanned aerial vehicle.

Description

Data validity detection method and device

The application is a divisional application of a patent application with the application number of 201710648651.5, the application date of 2017/08/01 and the name of the invention of a method and a device for detecting data validity.

Technical Field

The present invention relates to the field of unmanned aerial vehicle technology, and in particular, to a method for data validity detection, a device for data validity detection, an aerial vehicle, and a computer-readable storage medium.

Background

An Unmanned Aerial Vehicle (Unmanned Aerial Vehicle, UAV for short) is an Unmanned Aerial Vehicle. The unmanned aerial vehicle has wide application and is often applied to industries such as plant protection, city management, geology, meteorology, electric power, emergency and disaster relief, video shooting and the like.

In addition to knowing the current altitude of the drone, the height of the drone relative to the ground (i.e., the altitude to the ground) is also known to the drone in order to achieve autonomous flight at low altitudes, particularly near the ground. The altitude information of the unmanned aerial vehicle is generally obtained by measuring through a barometer, a GPS and the like, and the ground altitude can be measured in a sonar ranging mode, a laser ranging mode, a microwave radar ranging mode, a machine vision measuring method and the like. However, since the laser ranging scheme is easily affected by light and has a high price cost, the machine vision measuring method is complex and is also easily affected by light, radar ranging and sonar ranging are not affected by light, and can be used in all weather, and the price cost is relatively low and the system complexity is low. Therefore, radar ranging and sonar ranging are relatively common ranging methods.

The existing radar sensor and sonar sensor are mostly installed on a moving robot or in a fixed space, and the like, so that the data measured by the radar sensor or sonar sensor in the environment is accurate, and complex filtering operation is not needed. However, in unmanned aerial vehicle's application environment, owing to have the high-speed fuselage high-frequency vibration that causes that rotates of unmanned aerial vehicle screw, the air current disturbance that the screw rotation arouses, unmanned aerial vehicle is at the quick slope change that relapses of the gesture of flight in-process, comparatively complicated factors such as the power unstability that the screw arouses at high-speed rotation in-process, sonar range finding or the radar range finding that lead to the unmanned aerial vehicle machine to carry introduce comparatively serious noise, can make the range finding failure even, influence measuring accuracy, thereby influence the quality of unmanned aerial vehicle operation.

Disclosure of Invention

In view of the above, embodiments of the present invention are proposed in order to provide a method of data validity detection and a corresponding apparatus of data validity detection, an aircraft and a computer-readable storage medium that overcome the above-mentioned problems or at least partially solve the above-mentioned problems.

In order to solve the above problem, an embodiment of the present invention discloses a method for detecting data validity, which is applied to an unmanned aerial vehicle, and the method includes:

when the measurement opportunity is reached, acquiring measurement data measured by a designated sensor in the unmanned aerial vehicle;

acquiring flight parameters of the unmanned aerial vehicle;

and judging whether the measurement data is valid or not based on the flight parameters.

Preferably, the step of determining whether the measurement data is valid based on the flight parameter comprises:

judging whether the measurement data meet preset basic conditions or not;

if not, judging that the measurement data is invalid;

if yes, acquiring a jump variable of the measurement data based on the flight parameters, and judging whether the measurement data is valid or not based on the jump variable.

Preferably, the step of judging whether the measurement data meets a preset basic condition includes:

judging whether the measurement data is larger than a preset design range of the specified sensor or not;

if so, judging that the measurement data does not meet the basic condition;

if not, acquiring M previous measurement data measured at N moments before the specified sensor, and if the measurement data is the same as the M previous measurement data, judging that the measurement data does not meet the basic condition; and if the measured data and the M previous measured data are different, judging that the measured data meet the basic condition, wherein N is larger than 1, and M is larger than 1.

Preferably, the flight parameters include an altitude at which the drone is located; the step of obtaining the jump variable of the measurement data based on the flight parameter comprises:

determining the altitude variation between the altitude of the unmanned aerial vehicle at the current moment and the altitude of the unmanned aerial vehicle at the previous moment;

determining a measurement change value between the measurement data at the current moment and the previous measurement data at the previous moment;

and compensating the altitude variation quantity for the measurement variation value to obtain the jump variable of the measurement data.

Preferably, the designated sensor has a valid counter, and the step of determining whether the measurement data is valid based on the jump variable includes:

if the jumping amount is smaller than or equal to a first preset threshold value, when the measured data at the current moment is judged to be different from the previous measured data at the previous moment, the effective counter is automatically increased by a preset step length;

and when the count in the effective counter is greater than a preset count threshold value, judging that the measurement data is effective.

Preferably, the designated sensors include at least a first sensor and a second sensor, and the measurement data includes first measurement data measured by the first sensor and second measurement data measured by the second sensor; the jump variables comprise a first jump quantity corresponding to first measurement data and a second jump quantity corresponding to second measurement data;

the step of judging whether the measurement data is valid or not based on the jump variable comprises the following steps:

for first measurement data, when the first jump amount is larger than a first preset threshold value, if the second measurement data does not meet the basic condition, judging that the first measurement data is invalid;

and if the second measurement data meets the basic condition, judging whether the first measurement data is valid or not based on the first measurement data and the second measurement data.

Preferably, the step of determining whether the first measurement data is valid based on the first measurement data and the second measurement data includes:

calculating a first difference value of the first measurement data and the second measurement data and a variation trend corresponding to the first difference value;

if the first difference value is smaller than a second preset threshold value and the change trend is smaller than a third preset threshold value, judging that the first measurement data is valid;

and if the first difference is larger than or equal to a second preset threshold value and/or the variation trend is larger than or equal to a third preset threshold value, judging that the first measurement data is invalid.

Preferably, the method further comprises:

and when the first measurement data is judged to be valid due to the fact that the first jump amount is larger than the first preset threshold value, if the previous second measurement data at the previous moment is judged to be invalid due to the fact that the second jump amount is larger than the first preset threshold value, the previous second measurement data is judged to be valid.

Preferably, the method further comprises:

and if the previous measurement data at the previous moment is valid but the measurement data at the current moment is invalid, clearing the valid counter.

The embodiment of the invention also discloses a device for detecting the validity of data, which is applied to an unmanned aerial vehicle, and the device comprises:

the measurement data acquisition module is used for acquiring measurement data measured by a designated sensor in the unmanned aerial vehicle when the measurement opportunity is reached;

the flight parameter acquisition module is used for acquiring flight parameters of the unmanned aerial vehicle;

and the effective judgment module is used for judging whether the measurement data is effective or not based on the flight parameters.

Preferably, the validity judging module includes:

a basic condition judgment sub-module, configured to judge whether the measurement data meets a preset basic condition; if not, calling an invalid judgment sub-module; if yes, calling a jump quantity judgment submodule;

an invalidity determination submodule for determining that the measurement data is invalid;

and the jump quantity judgment submodule is used for acquiring jump quantity of the measurement data based on the flight parameters and judging whether the measurement data is effective or not based on the jump quantity.

Preferably, the basic condition judgment sub-module includes:

the design range judging unit is used for judging whether the measurement data is larger than the preset design range of the specified sensor or not; if so, judging that the measurement data does not meet the basic condition; if not, calling a continuous data judgment unit;

a continuous data judgment unit, configured to acquire M pieces of previous measurement data measured at N times before the specified sensor, and if the measurement data is the same as the M pieces of previous measurement data, determine that the measurement data does not satisfy the basic condition; and if the measured data is different from the M previous measured data, judging that the measured data meets the basic condition, wherein N is more than 1, and M is more than 1.

Preferably, the flight parameters include an altitude at which the drone is located; the jump amount judgment submodule includes:

the altitude variation determining unit is used for determining the altitude variation between the altitude of the unmanned aerial vehicle at the current moment and the altitude of the unmanned aerial vehicle at the previous moment;

a measurement change value determination unit for determining a measurement change value between the measurement data at the current time and the previous measurement data at the previous time;

and the jump variable determining unit is used for compensating the altitude variation quantity by the measurement variation value to obtain the jump variable of the measurement data.

Preferably, the designated sensor has a valid counter, and the jump amount determination submodule includes:

a counter self-increment unit, configured to, if the jump amount is smaller than or equal to a first preset threshold, self-increment the effective counter by a preset step length when it is determined that measurement data at a current time is different from previous measurement data at a previous time;

and the validity judging unit is used for judging that the measurement data is valid when the count in the validity counter is greater than a preset count threshold value.

the jump amount judgment submodule includes:

an invalidity determining unit, configured to determine, for first measurement data, that the first measurement data is invalid if the second measurement data does not satisfy the basic condition when the first transition amount is greater than a first preset threshold;

and the validity judging unit is used for judging whether the first measurement data is valid or not based on the first measurement data and the second measurement data if the second measurement data meets the basic condition.

Preferably, the validity judging unit includes:

the difference value calculating subunit is used for calculating a first difference value between the first measurement data and the second measurement data and a variation trend corresponding to the first difference value;

the validity judging subunit is configured to judge that the first measurement data is valid if the first difference is smaller than a second preset threshold and the variation trend is smaller than a third preset threshold;

and the invalidity judging subunit is used for judging that the first measurement data is invalid if the first difference is greater than or equal to a second preset threshold and/or the change trend is greater than or equal to a third preset threshold.

Preferably, the apparatus further comprises:

and the judging module is used for judging that the prior second measurement data is valid if the prior second measurement data at the previous moment is judged to be invalid due to the fact that the second jumping amount is larger than the first preset threshold value when the first measurement data is judged to be valid due to the fact that the first jumping amount is larger than the first preset threshold value.

Preferably, the apparatus further comprises:

and the counter zero clearing module is used for clearing the effective counter if the previous measured data at the last moment is effective but the measured data at the current moment is invalid.

The embodiment of the invention also discloses an aircraft, which comprises a memory, a processor and a computer program which is stored on the memory and can run on the processor, wherein the processor executes the program to realize the steps of the method.

The embodiment of the invention also discloses a computer readable storage medium, wherein a computer program is stored on the computer readable storage medium, and the computer program realizes the steps of the method when being executed by a processor.

The embodiment of the invention has the following advantages:

in the embodiment of the invention, when the measurement opportunity is reached, the flight controller of the unmanned aerial vehicle can acquire the measurement data measured by the designated sensor in the unmanned aerial vehicle, and the effectiveness judgment can be carried out on the measurement data by combining the acquired real-time flight parameters of the unmanned aerial vehicle, so that the influence of invalid data on the measurement precision is avoided, the measurement precision is improved, and the operation quality of the unmanned aerial vehicle is improved.

Drawings

FIG. 1 is a flowchart illustrating a first embodiment of a method for data validity checking according to the present invention;

FIG. 2 is a flowchart illustrating steps of a second embodiment of a method for data validity detection according to the present invention;

FIG. 3 is a flow chart of the steps of one type of data filtering of the present invention;

FIG. 4 is a flow chart of the data fusion steps of the present invention;

fig. 5 is a block diagram of an apparatus for data validity detection according to an embodiment of the present invention.

Detailed Description

In order to make the aforementioned objects, features and advantages of the present invention more comprehensible, the present invention is described in detail with reference to the accompanying drawings and the detailed description thereof.

In the unmanned aerial vehicle plant protection operation process, can control unmanned aerial vehicle through flight control system (fly control for short) and accomplish whole flight processes such as take-off, air flight, execution operation task and return journey, fly to control to unmanned aerial vehicle be equivalent to the driver to there being the effect of man-machine, be one of unmanned aerial vehicle most core technique.

This flight control system can include the ground satellite station, and the ground satellite station can communicate with unmanned aerial vehicle through communication module, and in the realization, this ground satellite station can be for handing the ground satellite station, and wherein can embed high accuracy GPS, support the quick survey and drawing on irregular block boundary, when using this ground satellite station, need not to connect the computer, can directly adjust unmanned aerial vehicle flight parameter. The ground station has an intelligent air route planning function, supports the presetting of a spray point switch, and can effectively avoid the phenomenon of heavy spray or missed spray in the operation process. In the spraying process, the user can also monitor the flight and spraying state in real time through the ground station, so that the spraying is more accurate and efficient.

A sensor for distance measurement can be installed in the unmanned aerial vehicle, so that the unmanned aerial vehicle can acquire the height of the unmanned aerial vehicle in real time. According to the embodiment of the invention, the measurement data can be obtained through the designated sensor in the unmanned aerial vehicle, and the validity of the measurement data is judged, so that the influence of invalid data on the measurement precision is avoided, the measurement precision is improved, and the operation quality of the unmanned aerial vehicle is improved.

Referring to fig. 1, a flowchart of a first step of a first method embodiment of data validity detection of the present invention is shown, where the method may be applied to an unmanned aerial vehicle, and the embodiment of the present invention may include the following steps:

step 101, when a measurement opportunity is reached, acquiring measurement data measured by a specified sensor in the unmanned aerial vehicle;

102, acquiring flight parameters of the unmanned aerial vehicle;

and 103, judging whether the measurement data is valid or not based on the flight parameters.

Referring to fig. 2, a flowchart of steps of a second embodiment of the data validity detection method according to the present invention is shown, where the method may be applied to an unmanned aerial vehicle, and the embodiment of the present invention may include the following steps:

step 201, when a measurement opportunity is reached, acquiring measurement data measured by a specified sensor in the unmanned aerial vehicle;

in an embodiment of the present invention, the designated sensor may include at least one of a sonar sensor, a radar sensor, and the like.

The sonar sensor sends out a sound wave signal, can reflect back when meeting object, can calculate unmanned aerial vehicle distance and position from the object according to reflection time and wave pattern.

The radar sensor can sense the existence, the moving speed, the static distance, the angle of the object and the like by transmitting and receiving microwaves.

This measured data can be the unmanned aerial vehicle's that the sensor measurement obtained to ground distance value.

In practice, if the designated sensors include a first sensor and a second sensor, the corresponding measurement data may include first measurement data measured by the first sensor and second measurement data measured by the second sensor.

For example, when the first sensor is a sonar sensor, the first measurement data may be a ground distance value hs of the drone measured by the sonar sensor. When the second sensor is a radar sensor, the second measurement data may be a ground distance value hr of the drone measured by the radar sensor, and the first measurement data may be denoted by hs and the second measurement data may be denoted by hr.

In a specific implementation, the measurement interval and the measurement lifecycle can be preset by the flight controller, for example, 20 times per second is set, and the measurement timing can be determined according to the time interval, for example, the measurement timing can be 1/20s, 1/10s, 3/20s, \ 8230;, and 1s, respectively.

Step 202, acquiring flight parameters of the unmanned aerial vehicle;

in a specific implementation, the flight controller may further obtain real-time flight parameters of the drone, and as an example, the flight parameters may include but are not limited to: the real-time altitude, horizontal flight speed, flight course angle and the like of the unmanned aerial vehicle.

Step 203, judging whether the measurement data meet preset basic conditions or not; if not, go to step 204; if yes, go to step 205;

step 204, judging that the measurement data is invalid;

the embodiment of the invention can preset basic conditions as a first judgment program for effectiveness judgment.

In a preferred embodiment of the present invention, step 203 further comprises the following sub-steps:

step S11, judging whether the measurement data is larger than a preset design range of the specified sensor; if yes, executing substep S12, otherwise, executing substep S13;

substep S12, determining that the measurement data does not satisfy the basic condition;

for example, if the preset design range of the sensor is 4 meters and the echo of the measurement data is 5 meters, the measurement data exceeds the design range, and at this time, it may be determined that the measurement data does not satisfy the basic condition, and it may be determined that the measurement data is invalid.

Substep S13, acquiring M previous measurement data measured at N previous times of the specified sensor, and if the measurement data is the same as the M previous measurement data, determining that the measurement data does not satisfy the basic condition; and if the measured data and the M previous measured data are different, judging that the measured data meets the basic condition, wherein N is more than 1, and M is more than 1.

If the measurement data does not exceed the design range of the designated sensor, substep S13 is continued.

In specific implementation, since the ground distance of the unmanned aerial vehicle in the flight process can be changed or fluctuated, if M data measured in a period of time are equal, the measured data measured by the sensor does not satisfy the basic condition, and then the measured data can be judged to be invalid.

In practice, N and M may be an appropriate value selected according to the measurement accuracy and the measurement frequency of the sensor and the moving speed of the unmanned aerial vehicle carrier, and in practice, N and M may have the same value, for example, N and M may be set to 5.

If the measurement data measured at the current time and the previous M previous measurement data are different, it may be determined that the measurement data at the current time satisfies the basic condition (i.e., the measurement data does not exceed the preset design range, and is different from the previous M previous measurement data), and at this time, step 205 may be continuously performed.

Step 205, acquiring a jump variable of the measurement data based on the flight parameter, and judging whether the measurement data is valid based on the jump variable.

In a preferred embodiment of the present invention, the step of obtaining the jump variable of the measurement data based on the flight parameter may include the following sub-steps:

a substep S21 of determining an altitude variation between the altitude of the unmanned aerial vehicle at the current moment and the altitude of the unmanned aerial vehicle at the previous moment;

a substep S22 of determining a measurement variation value between the measurement data at the current time and the previous measurement data at the previous time;

and a substep S23, compensating the altitude variation by the measurement variation value to obtain a jump variable of the measurement data.

In this embodiment of the present invention, the jump amount may include a first jump variable corresponding to the first measurement data, and a second jump variable corresponding to the second measurement data.

For example, for hr, the corresponding measurement variation value dr = | hr-hr _ o |, where hr is the measurement data at the current time and hr _ o is the previous measurement data at the previous time.

And hr corresponds to a second jump variable dr1= | hr-hr _ o + hg _ o-hg |, wherein hg _ o-hg is an altitude variation calculated according to the altitude of the unmanned aerial vehicle at the current moment and the altitude at the previous moment.

For hs, the corresponding measurement variation ds = | hs-hs _ o |, where hs is the measurement data at the current time and hs _ o is the previous measurement data at the previous time.

And the first hop variable ds1 corresponding to hs is = | hs-hs _ o + hg _ o-hg |.

It should be noted that when the altitude precision is poor or there is no altitude data, dr, ds may be used to replace dr1, ds1, i.e. no compensation for the altitude variation of the carrier is performed.

In specific implementation, N1 and T1 may select an appropriate value according to the measurement frequency of the sensor and the moving speed of the unmanned aerial vehicle, for example, N1 may take the value of 10, and T1 may take the value of 0.3m.

In a preferred embodiment of the present invention, the designated sensor has a corresponding valid counter, and step 205 may further comprise the sub-steps of:

step S31, if the jumping amount is less than or equal to a first preset threshold, when the measured data at the current moment is judged to be different from the previous measured data at the previous moment, the effective counter is increased by a preset step length;

and a substep S32, determining that the measurement data is valid when the count in the valid counter is greater than a preset count threshold.

For example, if ds1< = T2, when hs! If = hs _ o, the corresponding valid counter Tc _ s + +, and if Tc _ s > the preset count threshold, the hs is determined to be valid, and at this time, the state of hs at the current time may be set to be a valid state, i.e., true _ s =1.

In a specific implementation, the first preset threshold T2 may be set according to specific characteristics of the sensor, for example, the first preset threshold T2 is set to 1m.

The fourth preset threshold may be a value according to a measurement frequency of the sensor and a characteristic of the actual sensor, for example, the fourth preset threshold may be 3.

In a preferred embodiment of the present invention, when the designated sensors include at least a first sensor and a second sensor, step 205 may further include the sub-steps of:

substep S41, for a first measurement data, when the first jump amount is greater than a first preset threshold, if the second measurement data does not satisfy the basic condition, determining that the first measurement data is invalid;

for example, if the sensor currently performing validity determination is a sonar sensor, if ds1 > T2, and if data hr measured by the radar sensor is invalid due to exceeding the design range of the radar sensor or if M consecutive data are equal (that is, hr does not satisfy the basic condition), it may be determined that hs at the current time is also invalid.

And a substep S42, determining whether the first measurement data is valid based on the first measurement data and the second measurement data if the second measurement data satisfies the basic condition.

For example, if hr satisfies the base condition, it can be determined whether hs is valid based on hr and hs.

In a preferred embodiment of the present invention, the sub-step S42 further comprises the following sub-steps:

substep S421, calculating a first difference between the first measurement data and the second measurement data, and a variation trend corresponding to the first difference;

substep S422, if the first difference is smaller than a second preset threshold and the variation trend is smaller than a third preset threshold, determining that the first measurement data is valid;

in the sub-step S423, if the first difference is greater than or equal to a second preset threshold and/or the variation trend is greater than or equal to a third preset threshold, it is determined that the first measurement data is invalid.

Specifically, when ds1 > T2, if data hr measured by the radar sensor is not invalid due to exceeding the design range of the radar sensor or the fact that M consecutive data are equal, a first difference between hr and hs at the current time and a variation trend corresponding to the first difference can be calculated.

In one embodiment, the first difference drs = | hr-hs |, representing the difference in measured distance of the two sensors.

The variation trend ddrs = | hr-hs | - | hr _ o-hs _ o |, which corresponds to the first difference value, i.e., the current distance difference minus the distance difference at the previous moment.

If drs is smaller than a second preset threshold and ddrs is smaller than a third preset threshold, the first measurement data at the current moment can be judged to be valid; otherwise, if drs is greater than or equal to the second preset threshold and/or ddrs is greater than or equal to the third preset threshold, it may be determined that the first measurement data at the current time is invalid.

In a specific implementation, the second preset threshold may be set to T3, which may be set according to specific characteristics of the sensor, typically the threshold T2>2 × threshold T3, for example, the second preset threshold T3 is set to 0.4m.

The third threshold value may be set to a value of 0.

In a preferred embodiment of the present invention, the method may further include the following steps:

For example, if the measurement data at the previous time is valid, i.e., true _ s =1, and the measurement data at the current time is invalid, i.e., true _ s =0, the corresponding validity counter Tc _ s is cleared, i.e., tc _ s =0.

In the embodiment of the present invention, the data validity judgment of one sensor in the unmanned aerial vehicle may also affect the data validity judgment result of another sensor, and then the embodiment of the present invention may further include the following steps:

For example, if True _ s =1, if the hr _ o state at the previous time is invalid and is determined to be invalid because the corresponding second transition amount at the previous time or before is greater than the first preset threshold, that is, drs is greater than or equal to the second preset threshold and/or ddrs is greater than or equal to the third preset threshold when dr1 > T2, the result of hr _ o is determined to be invalid.

In the embodiment of the invention, the effectiveness judgment can be carried out on the measurement data measured by the designated sensor based on the flight parameters of the unmanned aerial vehicle, so that the influence of invalid data on the measurement precision can be avoided, the measurement precision is improved, and the operation quality of the unmanned aerial vehicle is improved.

In a preferred embodiment of the present invention, after the validity judgment is performed on the measurement data, the initial ground-to-ground distance may be determined based on the valid measurement data.

In a specific implementation, for the latest N1 measurement data obtained at the time, the number of valid measurement data therein and the hop-variant of the valid measurement data may be determined. If the measured data of the N1 moments are not invalid at the same time, the number of the effective measured data is not less than N1, and the jump variables of the effective measured data are less than a threshold value T1, the invalid measured data can be eliminated, and the rest effective measured data are added and averaged to obtain the initial ground distance.

In the embodiment of the present invention, a data filtering process may also be included

Referring to fig. 3, a flow chart of steps of data filtering is shown, which may include the steps of:

step 301, determining a filter coefficient corresponding to the measured data based on the flight parameter;

in an embodiment of the invention, the filter coefficients may be determined based on flight parameters.

In a preferred embodiment of the present invention, step 301 further comprises the following sub-steps:

step 301-1, determining a first attenuation parameter corresponding to the measurement data based on the flight parameter;

in a preferred embodiment of the present invention, step 301-1 may comprise the following sub-steps:

step 301-1-1, obtaining a measurement difference value between the measurement data of the unmanned aerial vehicle at the current moment and the target measurement data at the previous moment;

specifically, if one sensor is designated, the measurement difference is a measurement difference between the measurement data at the current time and the target measurement data at the previous time.

For example, the measurement difference ds2= | hs-hsf | corresponding to hs, and the measurement difference dr2= | hr-hrf | corresponding to hr, where hsf and hrf are target measurement data obtained by filtering the measurement data at the previous time.

In practice, if more than two sensors are specified, the measurement difference may be a measurement difference between the measurement data at the current time and the data subjected to the fusion processing at the previous time.

For example, the measurement difference ds4= | hs-hout | corresponding to hs, and the measurement difference dr4= | hr-hout | corresponding to hr, where hout is data obtained by filtering and fusing the measurement data at the previous time.

Step 301-1-2, when the attenuation parameter corresponding to the previous time is smaller than the jump amount corresponding to the measurement data, if the jump amount is smaller than or equal to a preset jump amount threshold value, setting the attenuation parameter as the jump amount, and taking the jump amount as a first attenuation parameter; if the jumping amount is larger than a preset jumping amount threshold value, setting the first attenuation parameter as the jumping amount adjusted according to the change trend;

if the measured data is hs, the corresponding first attenuation parameter can be represented as Epfs, if Epfs at the previous moment is smaller than the jump variable ds1, it is determined whether the measured data hr measured by another sensor is valid and ds1 is larger (e.g. larger than a preset jump variable threshold value fds 1), if hr is valid and ds1 > fds1, epfs = ds1+ ddrs is calculated, and if hr is invalid or jump variable dr 1< = fds1, epfs = ds1 is calculated.

In a specific implementation, fds1 may be set according to actual conditions such as the measurement frequency and the measurement accuracy of the sensor, for example, fds1 may be set to 0.5m.

After obtaining the Epfs, the Epfs may be limited, and in one embodiment, one of the limiting processing modes is as follows: if Epfs > threshold EP1, then Epfs = EP1; if Epfs < value 0, then Epfs = value 0.

In a specific implementation, EP1 may be set according to actual conditions of characteristics such as measurement frequency and measurement accuracy of the sensor, for example, EP1 may be set to 1m.

In practice, the designated sensor also has a corresponding transition counter Cpfs, which can be cleared after Epfs is limited, i.e., cpfs =0.

301-1-3, when the attenuation parameter corresponding to the previous moment is greater than or equal to the jump quantity, if the jump quantity is greater than a preset jump quantity threshold, clearing the jump counter, and if the jump quantity is less than or equal to the preset jump quantity threshold, self-increasing the jump counter by a first preset step length; if the count in the jump counter is larger than a preset delay coefficient threshold value, attenuation calculation is carried out on the attenuation parameter corresponding to the previous moment according to a preset attenuation factor to obtain a first attenuation parameter;

specifically, if Epfs at the previous time is greater than or equal to the jump variable ds1, if ds1 > fds1, the jump counter is cleared, i.e., cpfs =0, and if ds1< = fds1, the jump counter is self-incremented by a first preset step, i.e., cpfs + +.

And if Cpfs is larger than a preset delay coefficient threshold value J _ R, performing attenuation calculation on the attenuation parameter corresponding to the last moment according to a preset attenuation factor to obtain a first attenuation parameter. For example, epfs = Epfs × SJR, where SJR is the attenuation factor.

In concrete implementation, the larger the SJR, the slower the attenuation speed, the larger the Epfs, the stronger the corresponding filtering, the SJR can be set according to the actual filtering bandwidth, and the value range of the setting can be as follows: 0-SJR-1, for example, SJR =0.8 may be set.

J _ R can be set according to actual conditions such as the measurement frequency and the measurement accuracy of the sensor, for example, J _ R is set to 5.

If Cpfs < J _ R, then Epfs is kept unchanged, i.e. Epfs = Epfs.

Step 301-1-5, if the first attenuation parameter is greater than the measurement difference, setting the first attenuation parameter as the measurement difference.

After determining the first attenuation parameter each time, the first attenuation parameter Epfs may be compared with the above measurement difference ds2 or ds4, and if Epfs is greater than ds2 or ds4, it indicates that the accuracy of the current measurement result is high, and in this case, in order to speed up the convergence condition, epfs = ds2 or ds4.

Step 301-2, performing normalization transformation on the first attenuation parameter to obtain a second attenuation parameter;

after the first attenuation parameter is finally determined, the first attenuation parameter may be subjected to normalization transformation to obtain a normalized second attenuation parameter Kpfs, where the normalization procedure transforms the data Epfs from 0 to EP1 to a 0 to 1 region.

In one embodiment, a process for normalizing a transform is as follows:

if Epfs < threshold EP2, kpffs =0; if not, then the mobile terminal can be switched to the normal mode,

if Epfs > = EP2, kpfs = 1/(EP 1-EP 2). Times.Epfs-EP 2/(EP 1-EP 2).

In a specific implementation, EP2 may be set according to the actual condition of the characteristics of the sensor, such as the measurement frequency and the measurement accuracy, for example, EP2 may be set to 0.1m.

Step 301-3, determining a filter coefficient based on the second attenuation parameter, wherein the filter coefficient increases with decreasing second attenuation parameter.

For example, after determining the second attenuation parameter Kpfs for the initial measurement data hs obtained by the sonar sensor, the filter coefficient KS may be calculated from Kpfs, and it may be set such that the larger Kpfs, the smaller KS.

In one embodiment, KS may be calculated using a non-linear transformation method, e.g.,

KS＝1.0-Kpfs*Kpfs。

in the embodiment of the present invention, after determining the filter coefficient, the filter coefficient may be further subjected to a limiting process, for example, for KS, one limiting process method is as follows:

KS = K1 if KS > threshold K1;

KS = K2 if KS < threshold K2.

The threshold K1 and the threshold K2 may be set according to the actual low-pass filtering bandwidth requirement, for example, K1=0.5, and K2=0.05.

And step 302, filtering the measurement data by using the filter coefficient to obtain target measurement data.

In one embodiment, the filtering process may include a low-pass filtering process, for example, for hs, the formula of low-pass filtering calculation based on the filter coefficient to obtain the target measurement data is as follows:

hsf＝hsf+KS*(hs-hsf)。

it should be noted that, besides the low-pass filtering method, other filtering methods may be used to perform filtering processing, for example, median filtering, kalman filtering, and the embodiment of the present invention is not limited to this.

In the embodiment of the present invention, if the designated sensors at least include the first sensor and the second sensor, the first measurement data hs corresponds to the first target measurement data hsf, and the second measurement data hr corresponds to the second target measurement data hrf according to the filtering process.

The embodiment of the present invention may further include the following steps: and correcting the first target measurement data and/or the second target measurement data.

For example, if hsf is greater than both hr and hs, let hsf equal the larger of the two data, hr and hs; if hsf is less than both hr and hs, let hsf equal the smaller of the two data, hr and hs.

Similarly, if hrf is greater than both hr and hs, let hrf equal the larger of the two data, hr and hs; if hrf is less than both hr and hs, let hrf equal the smaller of the two data, hr and hs.

In a preferred embodiment of the present invention, when the first measurement data and the second measurement data are both valid, the embodiment of the present invention may further include a data fusion process, and referring to a flow chart of data fusion steps shown in fig. 4, the data fusion process may include the following steps:

step 401, determining a first weight value corresponding to the first measurement data and a second weight value corresponding to the second measurement data based on the flight parameter;

in a preferred embodiment of the present invention, step 401 may further include the following sub-steps:

step 401-1, calculating a difference between the first target measurement data and the second target measurement data, and recording the difference as a target data difference;

for example, the target data difference value drfsf = | hrf-hsf |.

Step 401-2, if the target data difference is smaller than a preset filter difference threshold, calculating a first sum of a first filter coefficient and a second filter coefficient, setting a first weighted value as a proportion of the first filter coefficient occupying the first sum, and setting a second weighted value as a proportion of the second filter coefficient occupying the first sum;

in a specific implementation, if drfsf is less than a preset filtering difference threshold drsf, which indicates that the filtering results of the two sensors are very close to each other, at this time, a nonlinear polynomial may be used to calculate the first weight value ksh and the second weight value KR based on KS (a first filtering coefficient, i.e., a filtering coefficient of a first designated sensor) and KR (a second filtering coefficient, i.e., a filtering coefficient of a second designated sensor).

In one embodiment, ksh = KS × KS/(KS × KS + KR × KR); krh = KR/(KS + KR).

In a specific implementation, drsf may be set according to the measurement accuracy of the sensor and the actual use environment, for example, drsf =0.3m may be set.

Step 401-3, if the target data difference is greater than or equal to a preset filtering difference threshold, calculating a second difference between the fused measured data at the first moment and the first target measured data at the current moment, and calculating a third difference between the fused measured data at the first moment and the second target measured data at the current moment, calculating a second sum of the second difference and the third difference, setting the first weight value as a proportion that the second difference accounts for the second sum, and setting the second weight value as a proportion that the third difference accounts for the second sum.

In a specific implementation, if drfsf > = the preset filtering difference threshold drsf, it is indicated that the difference between the filtering results of the two sensors is relatively large, and at this time, a second difference ds3 between the fused measurement data at the previous time and the target measurement data of the first specified sensor at the current time may be calculated, and a third difference dr3 between the fused measurement data at the previous time and the target measurement data of the second specified sensor at the current time may be calculated.

That is, ds3= | Hout-hsf |, dr3= | Hout-hrf |.

Then, based on ds3 and dr3, a nonlinear polynomial may be used to calculate the first weight value ksh and the second weight value krh.

In one embodiment, ksh = ds 3/(dr 3+ ds 3); krh = dr 3/(dr 3+ ds 3).

Step 402, performing fusion processing on the first measurement data and the second measurement data by using the first weight value and the second weight value to obtain fusion measurement data.

In a preferred embodiment of the present invention, step 402 may comprise the following sub-steps:

step 402-1, determining a correction factor corresponding to the flying speed at the current moment;

in a particular implementation, the greater the speed of movement, the smaller the correction factor.

For example, when the moving speed is greater than or equal to 0.5m/s, the correction factor K _ O =0.5; otherwise, when the moving speed is less than 0.5m/s, the correction factor K _ O =0.8.

Step 402-2, performing weighting operation on the first target measurement data and the second target measurement data based on the first weight value and the second weight value to obtain calibration measurement data;

specifically, calibration measurement data = krh hrf + ksh hsf.

And 402-3, performing fusion calculation on the calibration measurement data and the fusion measurement data at the previous moment based on the correction factor to obtain the fusion measurement data at the current moment.

In one embodiment, the fused measurement data Hout = K _ O _ Hout + (1.0 f-K _ O) (-krh _ hrf + ksh _ hsf).

It should be noted that the above fusion formula may also adopt a variance weight fusion mode, which is not limited in the embodiment of the present invention.

In another embodiment of the present invention, when hr is valid and hs is invalid, krh =1.0f, ksh =0.0f, and the following formula is used for performing the fusion calculation:

Hout＝K_O*Hout+(1.0f-K_O)*(krh*hrf+ksh*hsf)。

in this case, the sonar filter may also be corrected such that KS is equal to a small fixed value (for example, setting KS = 0.1), and the equation for calculating the sonar filter correction is as follows: hsf = hsf + KS [ ((Hout-hsf)).

In another embodiment of the present invention, when hr is invalid and hs is valid, ksh =1.0f, krh =0.0f, and the fusion calculation is performed using the following formula:

Hout＝K_O*Hout+(1.0f-K_O)*(krh*hrf+ksh*hsf)。

in this case, the radar filter may be modified such that KR is equal to a small fixed value (for example, KR =0.1 is set), and the formula for performing the modification calculation on the radar filter is as follows: hrf = hrf + KR [ (. Hout-hrf) ].

And when hr is invalid and hs is also invalid, maintaining the data at the previous moment, giving a judgment result that the data at the current moment are invalid, and re-performing the initialization process if the data of the two sensors are invalid at the same time for a long time.

In the embodiment of the invention, the characteristics of continuous change of the altitude and the lifting speed of the unmanned aerial vehicle in the moving process are combined, the effectiveness judgment, the filtering and the fusion are carried out on the measurement data of two or more appointed sensors in the unmanned aerial vehicle, the fused measurement data are obtained, the noise and the measurement error of the measurement data of the two or more appointed sensors in the unmanned aerial vehicle environment can be effectively filtered, the filtering and fusion effect is good, the phase delay is small, the response is sensitive, and the accuracy and the stability of the measurement of the ground clearance data of the unmanned aerial vehicle are improved.

It should be noted that, for simplicity of description, the method embodiments are described as a series of acts or combination of acts, but those skilled in the art will recognize that the present invention is not limited by the illustrated order of acts, as some steps may occur in other orders or concurrently in accordance with the embodiments of the present invention. Further, those skilled in the art will appreciate that the embodiments described in the specification are presently preferred and that no particular act is required to implement the invention.

Referring to fig. 5, a block diagram of an embodiment of the apparatus for detecting data validity in the present invention is shown, and the apparatus is applied to an unmanned aerial vehicle, and may include the following modules:

a measurement data obtaining module 501, configured to obtain measurement data measured by a specified sensor in the unmanned aerial vehicle when a measurement opportunity is reached;

a flight parameter obtaining module 502, configured to obtain flight parameters of the unmanned aerial vehicle;

and an effective judgment module 503, configured to judge whether the measurement data is effective based on the flight parameter.

In a preferred embodiment of the present invention, the validity determination module 503 may include the following sub-modules:

a basic condition judgment sub-module, configured to judge whether the measurement data meets a preset basic condition; if not, calling an invalid judgment submodule; if yes, calling a jump quantity judgment submodule;

and the jump quantity judging submodule is used for acquiring the jump quantity of the measurement data based on the flight parameters and judging whether the measurement data is valid or not based on the jump quantity.

In a preferred embodiment of the present invention, the basic condition judgment sub-module may include the following units:

a continuous data judgment unit, configured to acquire M previous measurement data measured N times before the designated sensor, and if the measurement data is the same as the M previous measurement data, judge that the measurement data does not satisfy the basic condition; and if the measured data is different from the M previous measured data, judging that the measured data meets the basic condition, wherein N is more than 1, and M is more than 1.

In a preferred embodiment of the present invention, the flight parameters include an altitude at which the drone is located; the jump amount judgment submodule may include the following units:

an altitude variation determining unit, configured to determine an altitude variation between an altitude of the unmanned aerial vehicle at a current time and an altitude at a previous time;

In a preferred embodiment of the present invention, the designated sensor has an effective counter, and the jump amount determination submodule may include the following units:

In a preferred embodiment of the present invention, the designated sensors at least include a first sensor and a second sensor, and the measurement data includes a first measurement data measured by the first sensor and a second measurement data measured by the second sensor; the jump variables comprise a first jump quantity corresponding to first measurement data and a second jump quantity corresponding to second measurement data;

the jump amount judgment sub-module may include the following units:

In a preferred embodiment of the present invention, the validity judging unit may include the following sub-units:

the effective judgment subunit is configured to judge that the first measurement data is effective if the first difference is smaller than a second preset threshold and the variation trend is smaller than a third preset threshold;

In a preferred embodiment of the present invention, the apparatus may further include the following modules:

and the counter zero clearing module is used for clearing the effective counter if the previous measured data at the previous moment is effective but the measured data at the current moment is invalid.

For the apparatus embodiment of fig. 5, since it is basically similar to the method embodiment described above, the description is simple, and for the relevant points, reference may be made to part of the description of the method embodiment.

In addition, the embodiment of the invention also discloses an aircraft, which comprises a memory, a processor and a computer program stored on the memory and capable of running on the processor, wherein the processor executes the program to realize the steps of the method of the embodiment.

In addition, the embodiment of the invention also discloses a computer readable storage medium, on which a computer program is stored, and the program is executed by a processor to realize the steps of the method of the embodiment.

The embodiments in the present specification are all described in a progressive manner, and each embodiment focuses on differences from other embodiments, and portions that are the same and similar between the embodiments may be referred to each other.

As will be appreciated by one skilled in the art, embodiments of the present invention may be provided as a method, apparatus, or computer program product. Accordingly, embodiments of the present invention may take the form of an entirely hardware embodiment, an entirely software embodiment or an embodiment combining software and hardware aspects. Furthermore, embodiments of the present invention may take the form of a computer program product embodied on one or more computer-usable storage media (including, but not limited to, disk storage, CD-ROM, optical storage, and the like) having computer-usable program code embodied therein.

Embodiments of the present invention are described with reference to flowchart illustrations and/or block diagrams of methods, terminal devices (systems), and computer program products according to embodiments of the invention. It will be understood that each flow and/or block of the flowchart illustrations and/or block diagrams, and combinations of flows and/or blocks in the flowchart illustrations and/or block diagrams, can be implemented by computer program instructions. These computer program instructions may be provided to a processor of a general purpose computer, special purpose computer, embedded processor, or other programmable data processing terminal to produce a machine, such that the instructions, which execute via the processor of the computer or other programmable data processing terminal, create means for implementing the functions specified in the flowchart flow or flows and/or block diagram block or blocks.

These computer program instructions may also be stored in a computer-readable memory that can direct a computer or other programmable data processing terminal to function in a particular manner, such that the instructions stored in the computer-readable memory produce an article of manufacture including instruction means which implement the function specified in the flowchart flow or flows and/or block diagram block or blocks.

These computer program instructions may also be loaded onto a computer or other programmable data processing terminal to cause a series of operational steps to be performed on the computer or other programmable terminal to produce a computer implemented process such that the instructions which execute on the computer or other programmable terminal provide steps for implementing the functions specified in the flowchart flow or flows and/or block diagram block or blocks.

While preferred embodiments of the present invention have been described, additional variations and modifications of these embodiments may occur to those skilled in the art once they learn of the basic inventive concepts. Therefore, it is intended that the appended claims be interpreted as including preferred embodiments and all such alterations and modifications as fall within the scope of the embodiments of the invention.

Finally, it should also be noted that, herein, relational terms such as first and second, and the like may be used solely to distinguish one entity or action from another entity or action without necessarily requiring or implying any actual such relationship or order between such entities or actions. Also, the terms "comprises," "comprising," or any other variation thereof, are intended to cover a non-exclusive inclusion, such that a process, method, article, or terminal that comprises a list of elements does not include only those elements but may include other elements not expressly listed or inherent to such process, method, article, or terminal. Without further limitation, an element defined by the phrases "comprising one of \ 8230; \8230;" does not exclude the presence of additional like elements in a process, method, article, or terminal device that comprises the element.

The method and the device for detecting data validity provided by the invention are introduced in detail, a specific example is applied in the text to explain the principle and the implementation mode of the invention, and the description of the above embodiment is only used for helping to understand the method and the core idea of the invention; meanwhile, for a person skilled in the art, according to the idea of the present invention, the specific embodiments and the application range may be changed, and in summary, the content of the present specification should not be construed as a limitation to the present invention.

Claims

1. A method for detecting data validity is applied to an unmanned aerial vehicle, and is characterized in that the method comprises the following steps:

when the measurement opportunity is reached, acquiring measurement data measured by a specified sensor in the unmanned aerial vehicle;

acquiring flight parameters of the unmanned aerial vehicle;

judging whether the measurement data is valid or not based on the flight parameters;

wherein the step of determining whether the measurement data is valid based on the flight parameter comprises:

judging whether the measurement data meet preset basic conditions or not;

if not, judging that the measurement data is invalid;

if yes, acquiring a jump variable of the measurement data based on the flight parameter, and judging whether the measurement data is valid or not based on the jump variable;

wherein the designated sensor has a valid counter, and the step of determining whether the measurement data is valid based on the jump variable comprises:

and when the count in the effective counter is greater than a preset count threshold value, judging that the measurement data are effective.

2. The method of claim 1, wherein the flight parameters include an altitude at which the drone is located; the step of obtaining the jump variable of the measurement data based on the flight parameter comprises:

3. The method of claim 1, wherein the designated sensors include at least a first sensor and a second sensor, and the measurement data includes a first measurement data measured by the first sensor and a second measurement data measured by the second sensor; the jump variables comprise a first jump quantity corresponding to first measurement data and a second jump quantity corresponding to second measurement data;

4. The method of claim 3, wherein the step of determining whether the first measurement data is valid based on the first measurement data and the second measurement data comprises:

if the first difference value is smaller than a second preset threshold value and the variation trend is smaller than a third preset threshold value, judging that the first measurement data is valid;

5. The method of claim 3 or 4, further comprising:

when the first measurement data is determined to be valid due to the fact that the first jump amount is larger than the first preset threshold, if the previous second measurement data at the previous moment is determined to be invalid due to the fact that the second jump amount is larger than the first preset threshold, the previous second measurement data is determined to be valid.

6. The method according to any one of claims 3 or 4, further comprising:

7. A device that data validity detected is applied to unmanned aerial vehicle, its characterized in that, the device includes:

the effective judgment module is used for judging whether the measurement data is effective or not based on the flight parameters;

wherein, the effective judgment module comprises:

a basic condition judgment sub-module, configured to judge whether the measurement data meets a preset basic condition; if not, calling an invalid judgment submodule; if yes, calling a jump quantity judging submodule;

the jump quantity judgment submodule is used for acquiring jump quantity of the measurement data based on the flight parameters and judging whether the measurement data is valid or not based on the jump quantity;

wherein the designated sensor has a valid counter, and the jump amount judgment submodule includes:

and the effective judging unit is used for judging that the measurement data is effective when the count in the effective counter is greater than a preset count threshold value.

8. The apparatus of claim 7, wherein the flight parameters include an altitude at which the drone is located; the jump amount judgment submodule includes:

9. The apparatus of claim 7, wherein the designated sensors comprise at least a first sensor and a second sensor, and the measurement data comprises first measurement data measured by the first sensor and second measurement data measured by the second sensor; the jump variable comprises a first jump variable corresponding to first measurement data and a second jump variable corresponding to second measurement data;

the jump amount judgment submodule includes:

10. The apparatus according to claim 9, wherein the validity judging unit includes:

11. The apparatus of claim 9 or 10, further comprising:

and the judging module is used for judging that the prior second measuring data is valid if the prior second measuring data at the previous moment is judged to be invalid due to the fact that the second jumping quantity is larger than the first preset threshold value when the first measuring data is judged to be valid due to the fact that the first jumping quantity is larger than the first preset threshold value.

12. The apparatus of any one of claims 9 or 10, further comprising:

13. An aircraft comprising a memory, a processor and a computer program stored on the memory and executable on the processor, characterized in that the processor implements the steps of the method according to any one of claims 1 to 6 when executing the program.

14. A computer-readable storage medium, on which a computer program is stored which, when being executed by a processor, carries out the steps of the method according to any one of claims 1 to 6.