CN117369493B - Unmanned aerial vehicle autonomous emergency disposal method after airspeed information failure - Google Patents
Unmanned aerial vehicle autonomous emergency disposal method after airspeed information failure Download PDFInfo
- Publication number
- CN117369493B CN117369493B CN202311322573.1A CN202311322573A CN117369493B CN 117369493 B CN117369493 B CN 117369493B CN 202311322573 A CN202311322573 A CN 202311322573A CN 117369493 B CN117369493 B CN 117369493B
- Authority
- CN
- China
- Prior art keywords
- speed
- aerial vehicle
- unmanned aerial
- airspeed
- pitch angle
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 39
- 238000011282 treatment Methods 0.000 claims abstract description 42
- 238000012937 correction Methods 0.000 claims abstract description 11
- 238000005259 measurement Methods 0.000 claims description 31
- 230000009194 climbing Effects 0.000 claims description 20
- PMGQWSIVQFOFOQ-YKVZVUFRSA-N clemastine fumarate Chemical compound OC(=O)\C=C\C(O)=O.CN1CCC[C@@H]1CCO[C@@](C)(C=1C=CC(Cl)=CC=1)C1=CC=CC=C1 PMGQWSIVQFOFOQ-YKVZVUFRSA-N 0.000 claims description 8
- 239000011159 matrix material Substances 0.000 claims description 6
- 230000009466 transformation Effects 0.000 claims description 6
- 230000002349 favourable effect Effects 0.000 claims description 4
- 230000007774 longterm Effects 0.000 claims description 4
- 238000004088 simulation Methods 0.000 abstract description 4
- 238000004364 calculation method Methods 0.000 abstract description 3
- 230000001939 inductive effect Effects 0.000 description 2
- 238000011835 investigation Methods 0.000 description 2
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 description 1
- 230000004888 barrier function Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 238000007689 inspection Methods 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000000926 separation method Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 238000011269 treatment regimen Methods 0.000 description 1
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The application belongs to the technical field of airplane flight informatization, and particularly relates to an unmanned aerial vehicle autonomous emergency disposal method after airspeed information failure, which comprises the following steps: and (3) judging airspeed failure faults, judging ground speed information, controlling emergency treatment according to the ground speed information, judging the attitude of the unmanned aerial vehicle, controlling emergency treatment of rotating speed and pitch angle, judging the attitude of the unmanned aerial vehicle, manually correcting, and carrying out emergency return. Simulation calculation and semi-physical simulation experiments prove that after the airspeed information of the unmanned aerial vehicle is invalid, the unmanned aerial vehicle automatic handling method can comprehensively judge the ground speed information and the attack angle information of the unmanned aerial vehicle, and pertinently carries out autonomous handling methods such as ground speed information control emergency handling, rotation speed and pitch angle control emergency handling, manual correction emergency return handling and the like on the unmanned aerial vehicle at each stage, so that the emergency handling success rate is improved to the greatest extent, and the unmanned aerial vehicle automatic handling method has important significance.
Description
Technical Field
The invention belongs to the technical field of airplane flight informatization, and particularly relates to an unmanned aerial vehicle autonomous emergency disposal method after airspeed information failure.
Background
The unmanned plane is a unmanned plane operated by using radio remote control equipment and a self-provided program control device, can perform tasks such as rapid monitoring and investigation, relay communication, target guidance, damage evaluation, bee colony investigation and the like, can also complete civil tasks such as electric power line inspection, border patrol, ocean law enforcement, disaster area search and rescue and the like, and has wide development prospect. The unmanned aerial vehicle obtains real-time state parameters by using an airborne sensor, and controls the unmanned aerial vehicle to fly by means of control instructions and control law calculation by an aircraft management computer.
Airspeed is one of the most important state parameters and control targets, representing the velocity of the aircraft relative to air, as measured by airspeed sensors. If the airspeed sensor fails, the airspeed information of the unmanned aerial vehicle fails, and the unmanned aerial vehicle performs flight control according to the incorrect airspeed information, so that serious consequences such as asset loss of equipment of the unmanned aerial vehicle are caused.
Because unmanned aerial vehicle has man-machine separation's characteristics, the operator can't synthesize the state condition of judging unmanned aerial vehicle in real time through self observation and impression, is difficult to and timely effectual adoption appropriate treatment measure after airspeed information inefficacy, and artifical emergent treatment success rate is low, therefore the unmanned aerial vehicle autonomous emergent treatment method after the airspeed inefficacy of urgent needs.
However, due to confidentiality, technical barriers and the like, related researches are not available at home and abroad. In view of the above, the invention provides an unmanned aerial vehicle autonomous emergency disposal strategy after the airspeed information with high reliability is invalid, which can furthest ensure that the unmanned aerial vehicle completes the flight task or minimize the loss.
Disclosure of Invention
In order to cope with flight risks faced by unmanned aerial vehicles after airspeed information failure, the invention provides a high-reliability unmanned aerial vehicle autonomous emergency disposal method after airspeed information failure.
In order to achieve the technical effects, the invention is realized by the following technical scheme:
an unmanned aerial vehicle autonomous emergency disposal method after airspeed information failure comprises the following steps:
Step one: judging airspeed failure faults, reading airspeed data reported by an atmospheric data measuring unit through an aircraft management computer, determining that airspeed failure faults occur, and entering emergency treatment;
Step two: judging the ground speed information, reading the ground speed data reported by the attitude sensor through an aircraft management computer, judging that the ground speed is within the allowable range of the unmanned aerial vehicle, and turning to the third step; the ground speed is outside the allowable range, and the step five is performed;
Step three: controlling emergency treatment according to the ground speed information, and selecting ground speed data of the navigation attitude sensor by a speed signal source;
step four: judging the attitude of the unmanned aerial vehicle, namely reading the attack angle data reported by the atmospheric data measuring unit through an aircraft management computer to judge, wherein the attack angle is within the allowable range of the unmanned aerial vehicle, and turning to the step eight; the attack angle is outside the allowable range, and the step five is performed;
step five: the emergency treatment is controlled by the rotating speed and the pitch angle, the speed is opened, the speed is not controlled in a closed loop in the longitudinal direction, and the control mode is switched into fixed rotating speed and fixed pitch angle control;
Step six: judging the attitude of the unmanned aerial vehicle, namely reading the attack angle data reported by the atmospheric data measuring unit through an aircraft management computer to judge, wherein the attack angle is within the allowable range of the unmanned aerial vehicle, and turning to the step eight; the attack angle is outside the allowable range, and the step seven is performed;
Step seven: manually correcting, wherein if the attack angle is out of the allowable range, an unmanned plane ground operator sends a rotating speed and pitch angle correction instruction through a measurement and control link, and adjusts an unmanned plane control target;
step eight: and (3) the emergency return voyage, wherein the aircraft management computer controls the unmanned aerial vehicle to fly to the nearest waypoint of the emergency return voyage, and then the unmanned aerial vehicle returns according to the emergency return voyage to complete emergency treatment.
Further, in the first step, the airspeed failure fault occurs according to that the airspeed information failure occurs when the airspeed information is confirmed by the fact that the data bit in the air data frame is not valid data after the air data measurement unit continuously receives 5 beats of the air data measurement unit report data.
In the second step, aiming at unmanned aerial vehicles with small flight speed envelope such as solar unmanned aerial vehicles, the speed range of safe flight is only 8-12 m/s, and the unmanned aerial vehicle is easily influenced by an air wind field; if the airspeed fails, the control is performed according to the ground speed, and the risk of stall of the unmanned aerial vehicle caused by the fact that the ground speed exceeds the boundary exists, so that the ground speed needs to be analyzed to judge whether the unmanned aerial vehicle is available or not.
Still further, the judging method is as follows:
1) The horizontal wind speed before airspeed failure is solved, and the solving method is as follows:
Simultaneous formulas (1) - (4) give:
wherein: L ab is a transformation matrix of the air flow coordinate system and the machine body coordinate system; l bg is a transformation matrix of a ground coordinate system and a collective coordinate system; alpha, beta and V t are respectively the attack angle, sideslip angle and vacuum speed measured by the atmospheric data measuring unit; θ, φ, ψ are pitch angle, roll angle and yaw angle measured by the attitude sensor respectively; v E、VN is the east speed and the north speed measured by the navigation attitude sensor respectively;
2) Judging whether the ground speed is available at the failure moment according to the wind speed information calculated in real time before the airspeed fails, and if so:
a) V W≤K0*(Vmax-Vmin), the ground speed is available;
b) V W>K0*(Vmax-Vmin), the ground speed is not available.
V max、Vmin respectively represents the maximum flight speed and the minimum flight speed of the unmanned aerial vehicle at the current altitude; k 0 denotes a safety factor.
In the third step, the speed signal source selects the ground speed data of the attitude sensor, and the speed control mode is pitch angle-speed closed-loop control.
In the fourth step, whether the flight state is safe or not is judged according to the attack angle data measured by the atmospheric data measuring unit; if alpha is epsilon [ alpha min+α0αmax-α0 ], the flight state is safe; otherwise, the flight is in an unsafe state; wherein, alpha min、αmax and alpha 0 are respectively the minimum available attack angle, the maximum available attack angle and the attack angle safety margin in the current state.
In the fifth step, the rotation speed and the pitch angle are controlled, the longitudinal control target is switched from the speed to the rotation speed and the pitch angle in the climbing and descending stage, the control mode is switched from the pitch angle-speed closed-loop control to the fixed rotation speed and the fixed pitch angle, and the speed is controlled in an open loop; in the plane flight stage, the longitudinal control target is switched from speed to rotating speed and pitch angle, the control mode is switched from rotating speed-speed closed loop to fixed rotating speed and fixed pitch angle, and the height and speed are controlled in an open loop.
Still further, the individual stage control targets are as follows:
a) Climbing stage: the rotating speed is the maximum allowable rotating speed, and the pitch angle is given by theta climb;
b) And (3) a flat flight stage: the rotation speed is rev cruise, and the pitch angle is given by theta cruise;
c) The descending stage: the rotating speed is the slow car rotating speed, and the pitch angle is given by theta descent.
Wherein, theta climb、θdescent is the pitch angle when the steady climbing and the downslide are carried out at the favorable speed respectively; rev cruise、θcruise is the balanced rotation speed and pitch angle when the helicopter flies straight and flat at a long-term speed.
In the sixth step, the flight state is judged according to the method provided in the fourth step, and if the attack angle is out of the allowable range, the unmanned plane ground operator sends a rotating speed and pitch angle correction instruction through the measurement and control link to adjust the unmanned plane control target.
Further, in step seven, if it is determined in step six that the flight is in an unsafe state and the attack angle is too large, then:
a) Climbing and sliding stages: an unmanned plane ground operator sends a pitch angle reducing instruction through a measurement and control link, adjusts a pitch angle control target and improves the flying speed;
b) And (3) a flat flight stage: and an unmanned plane ground operator sends a rotating speed adding instruction through a measurement and control link, adjusts a rotating speed control target and improves the flying speed.
Further, if the step six determines that the flight is in an unsafe state and the attack angle is smaller, then:
a) Climbing and sliding stages: an unmanned plane ground operator sends a pitch angle adding instruction through a measurement and control link, adjusts a pitch angle control target, and reduces the flying speed;
b) And (3) a flat flight stage: and an unmanned plane ground operator sends a rotating speed reducing instruction through a measurement and control link, adjusts a rotating speed control target and reduces the flying speed.
In the eighth step, an emergency return route is designed, and if the unmanned aerial vehicle fails in airspeed information, the unmanned aerial vehicle returns along the emergency return route. The emergency return route is a route designed in consideration of avoiding an important target inducing a secondary disaster when the unmanned aerial vehicle fails and needs to return. Binding by ground stations prior to flight.
The application has the advantages that:
According to the method, simulation calculation and semi-physical simulation tests prove that after the airspeed information of the unmanned aerial vehicle fails, the ground speed information and the attack angle information of the unmanned aerial vehicle are comprehensively judged, so that autonomous treatment methods such as ground speed information control emergency treatment, rotation speed and pitch angle control emergency treatment, manual correction emergency return treatment and the like are pertinently carried out on the unmanned aerial vehicle at each stage, and the emergency treatment success rate is improved to the greatest extent, so that the method has important significance.
Drawings
FIG. 1 is a flow chart of an embodiment of the present invention.
The marks in the figures are respectively: 1. the emergency treatment strategy comprises 11, the emergency treatment is started, 12, the emergency treatment is ended, 21, the ground speed control emergency treatment, 22, the fixed rotating speed and the fixed pitch angle control emergency treatment, 23, the manual correction, 24, the emergency return navigation treatment, 31, the airspeed failure fault judgment, 32, the ground speed information judgment, 33, the attack angle information judgment, 321, the ground speed available, 322, the ground speed unavailable, 331, the attack angle overrun, 332 and the attack angle safety.
Detailed Description
In order to more clearly illustrate the technical solutions provided by the present invention, the present invention will be further described below with reference to the accompanying drawings and examples. It should be noted that the embodiments provided are only some embodiments of the present invention, but not all embodiments, and therefore should not be construed as limiting the scope of protection. All other embodiments, which are obtained by a worker of ordinary skill in the art without creative efforts, are within the protection scope of the present invention based on the embodiments of the present invention.
Example 1
An unmanned aerial vehicle autonomous emergency disposal method after airspeed information failure comprises the following steps:
Step one: judging airspeed failure faults, reading airspeed data reported by an atmospheric data measuring unit through an aircraft management computer, determining that airspeed failure faults occur, and entering emergency treatment;
Step two: judging the ground speed information, reading the ground speed data reported by the attitude sensor through an aircraft management computer, judging that the ground speed is within the allowable range of the unmanned aerial vehicle, and turning to the third step; the ground speed is outside the allowable range, and the step five is performed;
Step three: controlling emergency treatment according to the ground speed information, and selecting ground speed data of the navigation attitude sensor by a speed signal source;
step four: judging the attitude of the unmanned aerial vehicle, namely reading the attack angle data reported by the atmospheric data measuring unit through an aircraft management computer to judge, wherein the attack angle is within the allowable range of the unmanned aerial vehicle, and turning to the step eight; the attack angle is outside the allowable range, and the step five is performed;
step five: the emergency treatment is controlled by the rotating speed and the pitch angle, the speed is opened, the speed is not controlled in a closed loop in the longitudinal direction, and the control mode is switched into fixed rotating speed and fixed pitch angle control;
Step six: judging the attitude of the unmanned aerial vehicle, namely reading the attack angle data reported by the atmospheric data measuring unit through an aircraft management computer to judge, wherein the attack angle is within the allowable range of the unmanned aerial vehicle, and turning to the step eight; the attack angle is outside the allowable range, and the step seven is performed;
Step seven: manually correcting, wherein if the attack angle is out of the allowable range, an unmanned plane ground operator sends a rotating speed and pitch angle correction instruction through a measurement and control link, and adjusts an unmanned plane control target;
step eight: and (3) the emergency return voyage, wherein the aircraft management computer controls the unmanned aerial vehicle to fly to the nearest waypoint of the emergency return voyage, and then the unmanned aerial vehicle returns according to the emergency return voyage to complete emergency treatment.
Further, in the first step, the airspeed failure fault occurs according to that the airspeed information failure occurs when the airspeed information is confirmed by the fact that the data bit in the air data frame is not valid data after the air data measurement unit continuously receives 5 beats of the air data measurement unit report data.
In the second step, aiming at unmanned aerial vehicles with small flight speed envelope such as solar unmanned aerial vehicles, the speed range of safe flight is only 8-12 m/s, and the unmanned aerial vehicle is easily influenced by an air wind field; if the airspeed fails, the control is performed according to the ground speed, and the risk of stall of the unmanned aerial vehicle caused by the fact that the ground speed exceeds the boundary exists, so that the ground speed needs to be analyzed to judge whether the unmanned aerial vehicle is available or not.
Still further, the judging method is as follows:
1) The horizontal wind speed before airspeed failure is solved, and the solving method is as follows:
Simultaneous formulas (1) - (4) give:
wherein: L ab is a transformation matrix of the air flow coordinate system and the machine body coordinate system; l bg is a transformation matrix of a ground coordinate system and a collective coordinate system; alpha, beta and V t are respectively the attack angle, sideslip angle and vacuum speed measured by the atmospheric data measuring unit; θ, φ, ψ are pitch angle, roll angle and yaw angle measured by the attitude sensor respectively; v E、VN is the east speed and the north speed measured by the navigation attitude sensor respectively;
2) Judging whether the ground speed is available at the failure moment according to the wind speed information calculated in real time before the airspeed fails, and if so:
a) V W≤K0*(Vmax-Vmin), the ground speed is available;
b) V W>K0*(Vmax-Vmin), the ground speed is not available.
V max、Vmin respectively represents the maximum flight speed and the minimum flight speed of the unmanned aerial vehicle at the current altitude; k 0 denotes a safety factor.
In the third step, the speed signal source selects the ground speed data of the attitude sensor, and the speed control mode is pitch angle-speed closed-loop control.
In the fourth step, whether the flight state is safe or not is judged according to the attack angle data measured by the atmospheric data measuring unit; if alpha is epsilon [ alpha min+α0αmax-α0 ], the flight state is safe; otherwise, the flight is in an unsafe state; wherein, alpha min、αmax and alpha 0 are respectively the minimum available attack angle, the maximum available attack angle and the attack angle safety margin in the current state.
In the fifth step, the rotation speed and the pitch angle are controlled, the longitudinal control target is switched from the speed to the rotation speed and the pitch angle in the climbing and descending stage, the control mode is switched from the pitch angle-speed closed-loop control to the fixed rotation speed and the fixed pitch angle, and the speed is controlled in an open loop; in the plane flight stage, the longitudinal control target is switched from speed to rotating speed and pitch angle, the control mode is switched from rotating speed-speed closed loop to fixed rotating speed and fixed pitch angle, and the height and speed are controlled in an open loop.
Still further, the individual stage control targets are as follows:
a) Climbing stage: the rotating speed is the maximum allowable rotating speed, and the pitch angle is given by theta climb;
b) And (3) a flat flight stage: the rotation speed is rev cruise, and the pitch angle is given by theta cruise;
c) The descending stage: the rotating speed is the slow car rotating speed, and the pitch angle is given by theta descent.
Wherein, theta climb、θdescent is the pitch angle when the steady climbing and the downslide are carried out at the favorable speed respectively; rev cruise、θcruise is the balanced rotation speed and pitch angle when the helicopter flies straight and flat at a long-term speed.
In the sixth step, the flight state is judged according to the method provided in the fourth step, and if the attack angle is out of the allowable range, the unmanned plane ground operator sends a rotating speed and pitch angle correction instruction through the measurement and control link to adjust the unmanned plane control target.
Further, in step seven, if it is determined in step six that the flight is in an unsafe state and the attack angle is too large, then:
a) Climbing and sliding stages: an unmanned plane ground operator sends a pitch angle reducing instruction through a measurement and control link, adjusts a pitch angle control target and improves the flying speed;
b) And (3) a flat flight stage: and an unmanned plane ground operator sends a rotating speed adding instruction through a measurement and control link, adjusts a rotating speed control target and improves the flying speed.
Further, if the step six determines that the flight is in an unsafe state and the attack angle is smaller, then:
a) Climbing and sliding stages: an unmanned plane ground operator sends a pitch angle adding instruction through a measurement and control link, adjusts a pitch angle control target, and reduces the flying speed;
b) And (3) a flat flight stage: and an unmanned plane ground operator sends a rotating speed reducing instruction through a measurement and control link, adjusts a rotating speed control target and reduces the flying speed.
In the eighth step, an emergency return route is designed, and if the unmanned aerial vehicle fails in airspeed information, the unmanned aerial vehicle returns along the emergency return route. The emergency return route is a route designed in consideration of avoiding an important target inducing a secondary disaster when the unmanned aerial vehicle fails and needs to return. Binding by ground stations prior to flight.
Example 2
The method for emergency disposal after the airspeed of the unmanned aerial vehicle fails at a certain high altitude and long endurance comprises the following steps of:
1. And judging airspeed failure faults. The aircraft management computer continuously receives the air data measurement unit in 5 beats, returns that the air speed data bit in the data frame is not effective data, confirms that airspeed information failure occurs, and starts emergency treatment;
2. and judging the ground speed information. Firstly, reading the east speed and the north speed of the navigation attitude sensor and the attitude angle of the unmanned aerial vehicle, and solving the horizontal wind speed. Then judging whether the ground speed is available at the failure moment according to the wind speed information calculated in real time before the airspeed fails;
3. The ground speed is in the allowable range, emergency treatment is controlled according to the ground speed information, and the ground speed data of the attitude sensor is selected by the speed signal source.
4. Judging the flight state through the attack angle data measured by the atmospheric data measuring unit;
5. The attack angle alpha epsilon [ alpha min+3αmax -3] is safe in flight state within the allowable range, and the aircraft returns along the emergency return route to complete emergency treatment.
Example 3
The embodiment is further defined in embodiment 2, and when the ground speed obtained by judging the ground speed information is not in the allowable range, emergency treatment is performed after the airspeed of the unmanned aerial vehicle is invalid when the object is still a certain high altitude long-endurance unmanned aerial vehicle. The emergency operation method comprises the following steps:
1. And judging airspeed failure faults. The aircraft management computer continuously receives the air data measurement unit in 5 beats, returns that the air speed data bit in the data frame is not effective data, confirms that airspeed information failure occurs, and starts emergency treatment;
2. and judging the ground speed information. Firstly, reading the east speed and the north speed of the navigation attitude sensor and the attitude angle of the unmanned aerial vehicle, and solving the horizontal wind speed. Then judging whether the ground speed is available at the failure moment according to the wind speed information calculated in real time before the airspeed fails;
3. The ground speed is not in the allowable range, and the emergency treatment is controlled according to the rotating speed and the pitch angle. In the climbing and descending stage, the longitudinal control target is switched from speed to rotating speed and pitch angle, the control mode is switched from pitch angle-speed closed-loop control to fixed rotating speed and fixed pitch angle, and the speed is controlled in an open loop mode; in the plane flight stage, the longitudinal control target is switched from speed to rotating speed and pitch angle, the control mode is switched from rotating speed-speed closed loop to fixed rotating speed and fixed pitch angle, and the height and speed are controlled in an open loop. The control targets of each stage are as follows:
a) Climbing stage: the rotating speed is the maximum allowable rotating speed, and the pitch angle is given by theta climb;
b) And (3) a flat flight stage: the rotation speed is rev cruise, and the pitch angle is given by theta cruise;
c) The descending stage: the rotating speed is the slow car rotating speed, and the pitch angle is given by theta descent.
Wherein, theta climb、θdescent is the pitch angle when the steady climbing and the downslide are carried out at the favorable speed respectively; rev cruise、θcruise is the balanced rotation speed and pitch angle when the helicopter flies straight and flat at a long-term speed.
4. Judging the flight state through the attack angle data measured by the atmospheric data measuring unit;
5. The attack angle alpha epsilon [ alpha min+3αmax -3] is safe in flight state within the allowable range, and the aircraft returns along the emergency return route to complete emergency treatment.
Example 4:
This embodiment is further defined in embodiments 2 and 3, where the unmanned aerial vehicle is unsafe in controlling emergency treatment and failure of rotational and pitch control emergency treatment according to ground speed information. The implementation object is still emergency treatment after the airspeed of the unmanned aerial vehicle fails at a certain high altitude and long endurance. The emergency operation method comprises the following steps:
1. And judging airspeed failure faults. The aircraft management computer continuously receives the air data measurement unit in 5 beats, returns that the air speed data bit in the data frame is not effective data, confirms that airspeed information failure occurs, and starts emergency treatment;
2. developing ground speed information-based emergency treatment and rotational speed and pitch angle control emergency treatment;
3. Judging that the unmanned aerial vehicle is in an unsafe flight state according to the attack angle data measured by the atmospheric data measuring unit;
4. The manual correction is started. If the attack angle is out of the allowable range, the unmanned plane ground operator sends a rotating speed and pitch angle correction instruction through a measurement and control link, and adjusts the unmanned plane control target;
5. and (5) emergency return. The aircraft management computer controls the unmanned aerial vehicle to fly to the nearest waypoint of the emergency return route, and then returns according to the emergency return route to complete emergency treatment
Further, the unmanned aerial vehicle is judged to be in an unsafe flight state according to the attack angle data measured by the atmospheric data measurement unit, and if the attack angle is larger, the following steps are:
a) Climbing and sliding stages: an unmanned plane ground operator sends a pitch angle reducing instruction through a measurement and control link, adjusts a pitch angle control target and improves the flying speed;
b) And (3) a flat flight stage: and an unmanned plane ground operator sends a rotating speed adding instruction through a measurement and control link, adjusts a rotating speed control target and improves the flying speed.
If the further attack angle data measured by the atmospheric data measuring unit judges that the unmanned aerial vehicle is in an unsafe flight state and the attack angle is smaller, the following steps are performed:
a) Climbing and sliding stages: an unmanned plane ground operator sends a pitch angle adding instruction through a measurement and control link, adjusts a pitch angle control target, and reduces the flying speed;
b) And (3) a flat flight stage: and an unmanned plane ground operator sends a rotating speed reducing instruction through a measurement and control link, adjusts a rotating speed control target and reduces the flying speed.
5. And (5) emergency return. The aircraft management computer controls the unmanned aerial vehicle to fly to the nearest waypoint of the emergency return route, and then returns according to the emergency return route to complete emergency treatment
The foregoing is a further detailed description of the invention in connection with specific preferred embodiments, and it is not intended that the invention be limited to these descriptions. Other embodiments of the invention, which are apparent to those skilled in the art to which the invention pertains without departing from its technical scope, shall be covered by the protection scope of the invention.
Claims (12)
1. An unmanned aerial vehicle autonomous emergency disposal method after airspeed information failure is characterized in that:
The method comprises the following steps:
Step one: judging airspeed failure faults, reading airspeed data reported by an atmospheric data measuring unit through an aircraft management computer, determining that airspeed failure faults occur, and entering emergency treatment;
Step two: judging the ground speed information, reading the ground speed data reported by the attitude sensor through an aircraft management computer, judging that the ground speed is within the allowable range of the unmanned aerial vehicle, and turning to the third step; the ground speed is outside the allowable range, and the step five is performed;
Step three: controlling emergency treatment according to the ground speed information, and selecting ground speed data of the navigation attitude sensor by a speed signal source;
step four: judging the attitude of the unmanned aerial vehicle, namely reading the attack angle data reported by the atmospheric data measuring unit through an aircraft management computer to judge, wherein the attack angle is within the allowable range of the unmanned aerial vehicle, and turning to the step eight; the attack angle is outside the allowable range, and the step five is performed;
step five: the emergency treatment is controlled by the rotating speed and the pitch angle, the speed is opened, the speed is not controlled in a closed loop in the longitudinal direction, and the control mode is switched into fixed rotating speed and fixed pitch angle control;
Step six: judging the attitude of the unmanned aerial vehicle, namely reading the attack angle data reported by the atmospheric data measuring unit through an aircraft management computer to judge, wherein the attack angle is within the allowable range of the unmanned aerial vehicle, and turning to the step eight; the attack angle is outside the allowable range, and the step seven is performed;
Step seven: manually correcting, wherein if the attack angle is out of the allowable range, an unmanned plane ground operator sends a rotating speed and pitch angle correction instruction through a measurement and control link, and adjusts an unmanned plane control target;
step eight: and (3) the emergency return voyage, wherein the aircraft management computer controls the unmanned aerial vehicle to fly to the nearest waypoint of the emergency return voyage, and then the unmanned aerial vehicle returns according to the emergency return voyage to complete emergency treatment.
2. The unmanned aerial vehicle autonomous emergency disposal method after airspeed information failure according to claim 1, wherein: in the first step, airspeed failure fault occurs according to that the airspeed data bit in the data frame reported by the air data measuring unit is not valid data after the aircraft management computer continuously receives 5 beats of air data, and airspeed information failure is confirmed.
3. The unmanned aerial vehicle autonomous emergency disposal method after airspeed information failure according to claim 1, wherein: in the second step, for the unmanned aerial vehicle with small flight speed envelope, if the airspeed fails, the unmanned aerial vehicle is controlled according to the ground speed, and the risk of stall of the unmanned aerial vehicle caused by the ground speed exceeding the boundary exists, so that the ground speed needs to be analyzed to judge whether the unmanned aerial vehicle is available.
4. A method of autonomous emergency handling of a drone after airspeed information failure according to claim 3, wherein: the judging method comprises the following steps:
1) The horizontal wind speed before airspeed failure is solved, and the solving method is as follows:
Simultaneous formulas (1) - (4) give:
wherein: L ab is a transformation matrix of the air flow coordinate system and the machine body coordinate system; l bg is a transformation matrix of a ground coordinate system and a collective coordinate system; alpha, beta and V t are respectively the attack angle, sideslip angle and vacuum speed measured by the atmospheric data measuring unit; θ,/> The phi is a pitch angle, a roll angle and a yaw angle which are measured by the navigation attitude sensor respectively; v E、VN is the east speed and the north speed measured by the navigation attitude sensor respectively;
2) Judging whether the ground speed is available at the failure moment according to the wind speed information calculated in real time before the airspeed fails, and if so:
a) V W≤K0*(Vmax-Vmin), the ground speed is available;
b) V W>K0*(Vmax-Vmin), ground speed is not available;
V w is ground speed, and V max、Vmin respectively represents the maximum flying speed and the minimum flying speed of the unmanned aerial vehicle at the current altitude; k 0 denotes a safety factor.
5. The unmanned aerial vehicle autonomous emergency disposal method after airspeed information failure according to claim 1, wherein: in the third step, the speed signal source selects the ground speed data of the attitude sensor, and the speed control mode is pitch angle-speed closed-loop control.
6. The unmanned aerial vehicle autonomous emergency disposal method after airspeed information failure according to claim 1, wherein: judging whether the flight state is safe or not according to the attack angle data measured by the atmospheric data measuring unit; if alpha is epsilon [ alpha min+α0 αmax-α0 ], the flight state is safe; otherwise, the flight is in an unsafe state; wherein, alpha min、αmax and alpha 0 are respectively the minimum available attack angle, the maximum available attack angle and the attack angle safety margin in the current state.
7. The unmanned aerial vehicle autonomous emergency disposal method after airspeed information failure according to claim 1, wherein: in the fifth step, the rotation speed and the pitch angle are controlled, the longitudinal control target is switched from the speed to the rotation speed and the pitch angle in the climbing and descending stage, the control mode is switched from the pitch angle-speed closed-loop control to the fixed rotation speed and the fixed pitch angle, and the speed is controlled in an open loop; in the plane flight stage, the longitudinal control target is switched from speed to rotating speed and pitch angle, the control mode is switched from rotating speed-speed closed loop to fixed rotating speed and fixed pitch angle, and the height and speed are controlled in an open loop.
8. The unmanned aerial vehicle autonomous emergency handling method after airspeed information failure according to claim 7, wherein: the control targets of each stage are as follows:
a) Climbing stage: the rotating speed is the maximum allowable rotating speed, and the pitch angle is given by theta climb;
b) And (3) a flat flight stage: the rotation speed is rev cruise, and the pitch angle is given by theta cruise;
c) The descending stage: the rotating speed is the slow vehicle rotating speed, and the pitch angle is given by theta descent;
Wherein, theta climb、θdescent is the pitch angle when the steady climbing and the downslide are carried out at the favorable speed respectively; rev cruise、θcruise is the balanced rotation speed and pitch angle when the helicopter flies straight and flat at a long-term speed.
9. The unmanned aerial vehicle autonomous emergency disposal method after airspeed information failure according to claim 1, wherein: and step six, judging the flight state according to the method provided in the step four, and if the attack angle is out of the allowable range, sending a rotating speed and pitch angle correction instruction by an unmanned aerial vehicle ground operator through a measurement and control link, and adjusting an unmanned aerial vehicle control target.
10. The unmanned aerial vehicle autonomous emergency disposal method after airspeed information failure according to claim 1, wherein: in the seventh step, if the flight is determined to be in an unsafe state and the attack angle is larger in the sixth step, then:
a) Climbing and sliding stages: an unmanned plane ground operator sends a pitch angle reducing instruction through a measurement and control link, adjusts a pitch angle control target and improves the flying speed;
b) And (3) a flat flight stage: and an unmanned plane ground operator sends a rotating speed adding instruction through a measurement and control link, adjusts a rotating speed control target and improves the flying speed.
11. The unmanned aerial vehicle autonomous emergency disposal method after airspeed information failure according to claim 1, wherein: if the step six is that the flight is in an unsafe state and the attack angle is smaller, the following steps are:
a) Climbing and sliding stages: an unmanned plane ground operator sends a pitch angle adding instruction through a measurement and control link, adjusts a pitch angle control target, and reduces the flying speed;
b) And (3) a flat flight stage: and an unmanned plane ground operator sends a rotating speed reducing instruction through a measurement and control link, adjusts a rotating speed control target and reduces the flying speed.
12. The unmanned aerial vehicle autonomous emergency disposal method after airspeed information failure according to claim 1, wherein: in the eighth step, an emergency return route is designed, and if the unmanned aerial vehicle fails in airspeed information, the unmanned aerial vehicle returns to the emergency along the emergency return route.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202311322573.1A CN117369493B (en) | 2023-10-13 | 2023-10-13 | Unmanned aerial vehicle autonomous emergency disposal method after airspeed information failure |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202311322573.1A CN117369493B (en) | 2023-10-13 | 2023-10-13 | Unmanned aerial vehicle autonomous emergency disposal method after airspeed information failure |
Publications (2)
Publication Number | Publication Date |
---|---|
CN117369493A CN117369493A (en) | 2024-01-09 |
CN117369493B true CN117369493B (en) | 2024-06-11 |
Family
ID=89390465
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202311322573.1A Active CN117369493B (en) | 2023-10-13 | 2023-10-13 | Unmanned aerial vehicle autonomous emergency disposal method after airspeed information failure |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN117369493B (en) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106324643A (en) * | 2016-10-19 | 2017-01-11 | 山东科技大学 | Method for estimating airspeed of unmanned aerial vehicle and detecting failures of airspeed head |
CN109425754A (en) * | 2017-08-22 | 2019-03-05 | 成都飞机工业(集团)有限责任公司 | A method of it is abnormal to judge that unmanned plane slows down |
CN110941287A (en) * | 2019-12-13 | 2020-03-31 | 航天神舟飞行器有限公司 | Autonomous special situation handling method for small fixed-wing unmanned aerial vehicle cluster |
CN114924581A (en) * | 2022-07-21 | 2022-08-19 | 成都飞机工业(集团)有限责任公司 | Method for judging failure of pitch angle of single-redundancy unmanned aerial vehicle |
CN114964366A (en) * | 2022-05-20 | 2022-08-30 | 中国商用飞机有限责任公司 | Method and system for aircraft airspeed indication and source selection |
CN115783329A (en) * | 2023-01-04 | 2023-03-14 | 中国科学院长春光学精密机械与物理研究所 | Double-flying-wing unmanned aerial vehicle airspeed measuring device and measuring method thereof |
CN116203931A (en) * | 2023-03-29 | 2023-06-02 | 西北工业大学 | Flight fault-tolerant control and reconstruction system under airspeed meter failure |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8615335B2 (en) * | 2008-09-17 | 2013-12-24 | The Boeing Company | Progressive takeoff thrust ramp for an aircraft |
-
2023
- 2023-10-13 CN CN202311322573.1A patent/CN117369493B/en active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106324643A (en) * | 2016-10-19 | 2017-01-11 | 山东科技大学 | Method for estimating airspeed of unmanned aerial vehicle and detecting failures of airspeed head |
CN109425754A (en) * | 2017-08-22 | 2019-03-05 | 成都飞机工业(集团)有限责任公司 | A method of it is abnormal to judge that unmanned plane slows down |
CN110941287A (en) * | 2019-12-13 | 2020-03-31 | 航天神舟飞行器有限公司 | Autonomous special situation handling method for small fixed-wing unmanned aerial vehicle cluster |
CN114964366A (en) * | 2022-05-20 | 2022-08-30 | 中国商用飞机有限责任公司 | Method and system for aircraft airspeed indication and source selection |
CN114924581A (en) * | 2022-07-21 | 2022-08-19 | 成都飞机工业(集团)有限责任公司 | Method for judging failure of pitch angle of single-redundancy unmanned aerial vehicle |
CN115783329A (en) * | 2023-01-04 | 2023-03-14 | 中国科学院长春光学精密机械与物理研究所 | Double-flying-wing unmanned aerial vehicle airspeed measuring device and measuring method thereof |
CN116203931A (en) * | 2023-03-29 | 2023-06-02 | 西北工业大学 | Flight fault-tolerant control and reconstruction system under airspeed meter failure |
Non-Patent Citations (3)
Title |
---|
Maciejowski,et al..A longitudinal flight control law to accommodate sensor loss in the RECONFIGURE benchmark.Annual Reviews in Control.2016,第212-223页. * |
一种临近空间太阳能无人机自主故障诊断及应急处理策略;蒙文跃;杨延平;温阳;户艳鹏;马晓平;;航天控制;20200415(第02期);第 56-61页 * |
气象无人机风速解算新模型的设计及仿真研究;李阳;孔毅;赵现斌;;气象科技进展;20160215(第01期);第31-36页 * |
Also Published As
Publication number | Publication date |
---|---|
CN117369493A (en) | 2024-01-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105389988B (en) | A kind of express highway intelligent cruising inspection system of multiple no-manned plane collaboration | |
CN103051373B (en) | Self-rotor unmanned aerial vehicle-based air emergency communication system | |
US8527118B2 (en) | Automated safe flight vehicle | |
US11619953B2 (en) | Three dimensional aircraft autonomous navigation under constraints | |
CN104246641A (en) | Safe emergency landing of a UAV | |
CN111123973A (en) | Unmanned aerial vehicle line tower patrol guiding system and guiding method | |
CN111874256A (en) | Fault emergency processing method and device for solar unmanned aerial vehicle | |
CN208873047U (en) | A kind of inspection device based on multi-rotor unmanned aerial vehicle | |
CN105678946B (en) | Fire Long Range Detecting and Ranging and its detection method based on unmanned plane | |
CN105235895A (en) | Multi-rotor unmanned aerial vehicle with emergency braking device and emergency braking method thereof | |
CN112068601A (en) | Navigation control system for fixed-wing unmanned aerial vehicle | |
CN105366059A (en) | Fixed-point parachuting method of fixed-wing unmanned aerial vehicle | |
CN213276373U (en) | Unmanned aerial vehicle automatic cruise system based on meteorological information guarantee | |
CN105892289A (en) | Unmanned aerial vehicle parachute landing recovery method based on accurate measurement of wind field | |
CN112148029A (en) | Unpowered full-automatic forced landing method for sliding-off and landing type unmanned aerial vehicle | |
Stojcsics et al. | Fixed-wing small-size UAV navigation methods with HIL simulation for AERObot autopilot | |
CN205113687U (en) | Many rotors unmanned vehicles with emergency brake arrangement | |
CN115793705A (en) | Ground wire overlap joint line health detection and defect diagnosis system based on unmanned aerial vehicle | |
CN116880565A (en) | Intelligent cruise control system and method for low-altitude aircraft | |
CN110011032B (en) | Retraction control device and method for airborne emergency communication system antenna | |
CN117369493B (en) | Unmanned aerial vehicle autonomous emergency disposal method after airspeed information failure | |
CN114384938B (en) | Unmanned aerial vehicle take-off and landing course correction method and system | |
CN112987794A (en) | Flight cluster simulator | |
CN116301003B (en) | Unmanned aerial vehicle flight regulation control method aiming at wind shear of wind field | |
CN114779804B (en) | Unmanned aerial vehicle special situation handling method based on state estimation rule |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |