CN117369493A - 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
- CN117369493A CN117369493A CN202311322573.1A CN202311322573A CN117369493A CN 117369493 A CN117369493 A CN 117369493A CN 202311322573 A CN202311322573 A CN 202311322573A CN 117369493 A CN117369493 A CN 117369493A
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 40
- 238000011282 treatment Methods 0.000 claims abstract description 47
- 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
- 239000011159 matrix material Substances 0.000 claims description 9
- 230000009466 transformation Effects 0.000 claims description 9
- 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
- 229940060587 alpha e Drugs 0.000 description 2
- 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 description 2
- 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 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, 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 control method can comprehensively judge the airspeed information and the attack angle information of the unmanned aerial vehicle, and can pertinently develop autonomous treatment methods such as ground speed information control emergency treatment, rotational speed and pitch angle control emergency treatment, manual correction emergency return treatment and the like for the unmanned aerial vehicle at each stage, so that the emergency treatment success rate is improved to the greatest extent, and important military and social benefits are achieved.
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 aerial vehicle is a unmanned aerial vehicle operated by using radio remote control equipment and a self-provided program control device, can perform military combat 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 that the airspeed exceeds the boundary to cause the unmanned aerial vehicle to stall exists, so that the ground speed needs to be analyzed to judge whether the unmanned aerial vehicle is available.
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 the transformation matrix is a transformation matrix of an airflow coordinate system and a machine body coordinate system; l (L) bg The transformation matrix is a ground coordinate system and a collective coordinate system; alpha, beta, V t The method comprises the steps of measuring an attack angle, a sideslip angle and a vacuum speed for an atmosphere data measuring unit; θ, φ, ψ are pitch angle, roll angle and yaw angle measured by the attitude sensor respectively; v (V) E 、V N The east speed and the north speed are respectively measured by the navigation attitude sensor;
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 ≤K 0 *(V max -V min ) The ground speed is available;
b)V W >K 0 *(V max -V min ) The ground speed is not available.
Wherein V is max 、V min Respectively representing the maximum flying speed and the minimum flying speed of the unmanned aerial vehicle at the current altitude; k (K) 0 Representing 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 E [ alpha ] min +α 0 α max -α 0 ]The flight state is safe; otherwise, the flight is in an unsafe state; wherein alpha is min 、α max And alpha 0 The minimum available attack angle, the maximum available attack angle and the attack angle safety margin in the current state are respectively adopted.
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 rotation speed is the maximum allowable rotation speed, and the pitch angle is givenθ climb ;
b) And (3) a flat flight stage: the rotation speed is rev cruise Pitch angle given θ cruise ;
c) The descending stage: the rotating speed is the rotating speed of the slow vehicle, and the pitch angle is given by theta descent 。
Wherein θ climb 、θ descent Respectively the pitch angles when the climbing and the sliding are carried out at a favorable speed; rev cruise 、θ cruise The balance rotating speed and the pitch angle are respectively carried out when the flying is stabilized straight and flat at the long-term navigational 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, ground speed information and attack angle information of the unmanned aerial vehicle are comprehensively judged, the unmanned aerial vehicle is pertinently subjected to autonomous treatment methods such as ground speed information control emergency treatment, rotational speed and pitch angle control emergency treatment, manual correction emergency return treatment and the like at each stage, the emergency treatment success rate is improved to the greatest extent, and important military and social benefits are achieved.
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 that the airspeed exceeds the boundary to cause the unmanned aerial vehicle to stall exists, so that the ground speed needs to be analyzed to judge whether the unmanned aerial vehicle is available.
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 the transformation matrix is a transformation matrix of an airflow coordinate system and a machine body coordinate system; l (L) bg The transformation matrix is a ground coordinate system and a collective coordinate system; alpha, beta, V t The method comprises the steps of measuring an attack angle, a sideslip angle and a vacuum speed for an atmosphere data measuring unit; θ, φ, ψ are pitch angle, roll angle and yaw angle measured by the attitude sensor respectively; v (V) E 、V N The east speed and the north speed are respectively measured by the navigation attitude sensor;
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 ≤K 0 *(V max -V min ) The ground speed is available;
b)V W >K 0 *(V max -V min ) The ground speed is not available.
Wherein V is max 、V min Respectively representing the maximum flying speed and the minimum flying speed of the unmanned aerial vehicle at the current altitude; k (K) 0 Representing 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 E [ alpha ] min +α 0 α max -α 0 ]The flight state is safe; otherwise, the flight is in an unsafe state; wherein alpha is min 、α max And alpha 0 The minimum available attack angle, the maximum available attack angle and the attack angle safety margin in the current state are respectively adopted.
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 rotation speed is the maximum allowable rotation speed, and the pitch angle is given by theta climb ;
b) And (3) a flat flight stage: the rotation speed is rev cruise Pitch angle given θ cruise ;
c) The descending stage: the rotating speed is the rotating speed of the slow vehicle, and the pitch angle is given by theta descent 。
Wherein θ climb 、θ descent Respectively the pitch angles when the climbing and the sliding are carried out at a favorable speed; rev cruise 、θ cruise The balance rotating speed and the pitch angle are respectively carried out when the flying is stabilized straight and flat at the long-term navigational 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. angle of attack alpha e alpha min +3 α max -3]And in the allowable range, the flying state is safe, 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 rotation speed is the maximum allowable rotation speed, and the pitch angle is given by theta climb ;
b) And (3) a flat flight stage: the rotation speed is rev cruise Pitch angle given θ cruise ;
c) The descending stage: the rotating speed is the rotating speed of the slow vehicle, and the pitch angle is given by theta descent 。
Wherein θ climb 、θ descent Respectively the pitch angles when the climbing and the sliding are carried out at a favorable speed; rev cruise 、θ cruise The balance rotating speed and the pitch angle are respectively carried out when the flying is stabilized straight and flat at the long-term navigational speed.
4. Judging the flight state through the attack angle data measured by the atmospheric data measuring unit;
5. angle of attack alpha e alpha min +3 α max -3]And in the allowable range, the flying state is safe, 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 that the airspeed exceeds the boundary to cause the stall of the unmanned aerial vehicle 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 the transformation matrix is a transformation matrix of an airflow coordinate system and a machine body coordinate system; l (L) bg The transformation matrix is a ground coordinate system and a collective coordinate system; alpha, beta, V t The method comprises the steps of measuring an attack angle, a sideslip angle and a vacuum speed for an atmosphere data measuring unit; θ, φ, ψ are pitch angle, roll angle and yaw angle measured by the attitude sensor respectively; v (V) E 、V N The east speed and the north speed are respectively measured by the navigation attitude sensor;
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 ≤K 0 *(V max -V min ) The ground speed is available;
b)V W >K 0 *(V max -V min ) The ground speed is not available.
Wherein V is max 、V min Respectively representing the maximum flying speed and the minimum flying speed of the unmanned aerial vehicle at the current altitude; k (K) 0 Representing 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: in the fourth step, the atmospheric data is used for measuring the sheetThe attack angle data measured by the element judges whether the flight state is safe or not; if alpha is E [ alpha ] min +α 0 α max -α 0 ]The flight state is safe; otherwise, the flight is in an unsafe state; wherein alpha is min 、α max And alpha 0 The minimum available attack angle, the maximum available attack angle and the attack angle safety margin in the current state are respectively adopted.
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 rotation speed is the maximum allowable rotation speed, and the pitch angle is given by theta climb ;
b) And (3) a flat flight stage: the rotation speed is rev cruise Pitch angle given θ cruise ;
c) The descending stage: the rotating speed is the rotating speed of the slow vehicle, and the pitch angle is given by theta descent 。
Wherein θ climb 、θ descent Respectively the pitch angles when the climbing and the sliding are carried out at a favorable speed; rev cruise 、θ cruise The balance rotating speed and the pitch angle are respectively carried out when the flying is stabilized straight and flat at the long-term navigational 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 true CN117369493A (en) | 2024-01-09 |
CN117369493B 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 (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100070112A1 (en) * | 2008-09-17 | 2010-03-18 | Couey Lyle M | Progressive takeoff thrust ramp for an aircraft |
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 |
-
2023
- 2023-10-13 CN CN202311322573.1A patent/CN117369493B/en active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100070112A1 (en) * | 2008-09-17 | 2010-03-18 | Couey Lyle M | Progressive takeoff thrust ramp for an aircraft |
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, 13 August 2016 (2016-08-13), pages 212 - 223 * |
李阳;孔毅;赵现斌;: "气象无人机风速解算新模型的设计及仿真研究", 气象科技进展, no. 01, 15 February 2016 (2016-02-15), pages 31 - 36 * |
蒙文跃;杨延平;温阳;户艳鹏;马晓平;: "一种临近空间太阳能无人机自主故障诊断及应急处理策略", 航天控制, no. 02, 15 April 2020 (2020-04-15), pages 56 - 61 * |
Also Published As
Publication number | Publication date |
---|---|
CN117369493B (en) | 2024-06-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US8527118B2 (en) | Automated safe flight vehicle | |
CN109900300B (en) | A combination navigation integrity monitoring system for unmanned aerial vehicle | |
US11619953B2 (en) | Three dimensional aircraft autonomous navigation under constraints | |
CN104246641A (en) | Safe emergency landing of a UAV | |
CN110908405B (en) | Control method for concentric circle flight of fixed wing unmanned aerial vehicle | |
CN111123973A (en) | Unmanned aerial vehicle line tower patrol guiding system and guiding method | |
CN105468024B (en) | Unmanned aerial vehicle control method and device | |
CN111874256A (en) | Fault emergency processing method and device for solar unmanned aerial vehicle | |
CN112068539A (en) | Unmanned aerial vehicle automatic driving inspection method for blades of wind turbine generator | |
CN112068601A (en) | Navigation control system for fixed-wing unmanned aerial vehicle | |
CN105366059A (en) | Fixed-point parachuting method of fixed-wing unmanned aerial vehicle | |
Stojcsics et al. | Fixed-wing small-size UAV navigation methods with HIL simulation for AERObot autopilot | |
CN105892289A (en) | Unmanned aerial vehicle parachute landing recovery method based on accurate measurement of wind field | |
KR20110066401A (en) | Design and implementation of uav auto navigation systems using f28335 dsp | |
Mejias et al. | Controlled emergency landing of an unpowered unmanned aerial system | |
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 | |
Trindade et al. | A layered approach to design autopilots | |
CN117369493B (en) | Unmanned aerial vehicle autonomous emergency disposal method after airspeed information failure | |
CN116301003B (en) | Unmanned aerial vehicle flight regulation control method aiming at wind shear of wind field | |
US20200132841A1 (en) | Systems and methods for controlling aircraft based on sensed air movement | |
CN114384938B (en) | Unmanned aerial vehicle take-off and landing course correction method and system | |
CN114779804B (en) | Unmanned aerial vehicle special situation handling method based on state estimation rule | |
CN110136298A (en) | A kind of unmanned aerial vehicle monitoring system and method |
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 |