Small unmanned aerial vehicle parachute landing recovery control method, device and equipment and storage medium
Through segmented control and modal call, the problem of insufficient safety and control strategies in the drone parachute recovery technology is solved, and the automatic and fast parachute recovery process is realized, which improves the success rate and safety.
Patent Information
- Application Number
- CN202410968788.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-19
- Publication Date
- 2024-11-08
AI Technical Summary
The existing drone parachute recovery technology has shortcomings in terms of safety and control strategies, which makes it difficult to ensure the recovery success rate and safety.
Through segmented control and control law modal call, the parachute recovery process is divided into five stages, including recycling preparation, attitude adjustment and vehicle shutdown, parachute opening, airbag inflation and ground cutting stages, using vertical and horizontal call modes. Carry out altitude and track tracking control, combine the engine meter speed closed loop and attitude control to achieve automated parachute recovery.
It improves the success rate and safety of drone parachute recovery, reduces the degree of damage of drones, realizes automatic and fast recycling, and improves the landing accuracy and reliability of control logic.
Smart Images

Figure CN118907495A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of aviation flight control technology, and more specifically, the present invention is a small unmanned aerial vehicle parachute recovery control method, device, equipment and storage medium. Background Art
[0002] Among the many recovery methods, parachute recovery is the most common recovery method for drones. Parachute recovery of drones has the advantage of simple operation. After receiving the recovery command, the drone changes from flight state to safe landing. The entire recovery process is completed automatically, and the operator only needs simple training to be competent. In addition, parachute recovery of drones has a wide range of applications, low site requirements, no need for a special runway, and no special requirements for ground conditions. Parachute recovery is not only suitable for drones that require multiple non-taxi landings, but can also be used as an emergency recovery method for drones that use taxiing to land.
[0003] The research on parachute recovery technology in China has been relatively short and the foundation is relatively weak. Most of the current theoretical research needs to be further deepened before it can be transformed into practical applications that can achieve safe recovery. Theoretical research on UAV landing control mainly focuses on the stability of the recovery process, cone angle swing, etc., while there is less research on the parachute recovery control strategy of UAVs. Although the parachute recovery technology of UAVs has been widely used in the civil and military fields, the recovery safety problem has not been completely solved. Summary of the invention
[0004] In order to overcome the problem of realizing quick parachute recovery of small UAV in the existing technology, a small UAV parachute recovery control method, device, equipment and storage medium are now proposed.
[0005] In order to achieve the above technical effects, the technical solution of this application is as follows:
[0006] A small UAV parachute recovery control method comprises the following steps:
[0007] Through segmented control and control law mode call; the parachute recovery process is divided into five stages, namely, recovery preparation stage, attitude adjustment and shutdown stage, parachute opening stage, airbag inflation stage and grounding and parachute cutting stage;
[0008] Recovery preparation stage: vertically call the altitude hold mode, and the altitude control target is the same as the recovery preparation stage; horizontally call the track tracking control mode, and the track tracking target is the line connecting the current position of the aircraft and the preset recovery point;
[0009] Attitude adjustment and shutdown phase: longitudinally call the altitude holding mode, and the altitude control target is the same as the recovery preparation phase; laterally call the track tracking control mode and limit the roll angle; shut down the engine;
[0010] During the parachute opening phase: the pitch angle control mode is called vertically, and the control target is 0°; the roll angle hold mode is called horizontally, and the roll angle control target is 0°; the parachute is opened when the engine reports that it is in the parking state;
[0011] Airbag inflation stage: When the timing reaches or the measured relative height is lower than a certain value, an airbag inflation command is issued, and all rudder surface commands are softened to 0°;
[0012] Touchdown and parachute cutting stage: The aircraft touches down by measuring the overload value or the vertical speed, and then the parachute is cut, and all the control surface instructions are kept at 0°.
[0013] Furthermore, the engine speed closed-loop control mode is specifically: the speed is controlled by the automatic throttle, with the given value of the speed To control the target, a feedforward + proportional + integral control structure is adopted, and a proportional integral control method is used to control the speed indicator;
[0014]
[0015] In the formula, δ T is the engine throttle opening, is the given value of the speed indicator, V IAS is the measured value of the speed indicator, is the feedforward of the engine throttle, is the controller gain.
[0016] Furthermore, the altitude hold control mode is specifically: using vertical speed hold as an inner loop to control and hold the altitude, its input signal includes the altitude command and the current altitude, vertical velocity, pitch angle, pitch angle rate, angle of attack and vertical angular velocity, and the output is the elevator deflection;
[0017]
[0018] Δα=(α-α0)+q;
[0019] In the formula, δ ε is the elevator deflection, q is the pitch rate, q g is the pitch rate, θ is the pitch angle, θ g is the pitch angle, ΔA Z is the vertical acceleration, α is the angle of attack, α0 is the angle of attack protection value, is the angle of attack protection term, is the overload protection term, θ ref is the pitch angle feedforward, is the lifting speed given, is a controller gain, For the filter.
[0020] Furthermore, the pitch angle control mode is specifically to adopt a proportional integral differential control structure, with the pitch angle rate as the inner loop to control the pitch angle, its input signals include the pitch angle rate, pitch angle, angle of attack, roll angle, indicated airspeed, and the output is the elevator deflection;
[0021]
[0022] In the formula, δ ε is the elevator deflection, q is the pitch rate, q g is the pitch rate, θ is the pitch angle, θ g is the pitch angle, α is the angle of attack, α0 is the angle of attack protection value, is the angle of attack protection term, V IAS is the measured value of the speedometer, g is the acceleration due to gravity, is the controller gain.
[0023] Furthermore, the roll angle control mode is specifically: mainly adopting a proportional plus integral control method, with the roll angle The roll angular rate (ROR) is introduced as the lateral main control outer loop to increase the lateral damping, and the yaw angular rate is the inner loop to track the given roll angle target value. Achieve attitude control of the drone to roll left, flat wings, and roll right;
[0024]
[0025] In the formula, δ a is the aileron deflection, φ g is the given value of the roll angle, φ is the roll angle, p is the roll angle rate, are the gains of each controller.
[0026] Furthermore, the track tracking control mode is specifically: adopting a proportional-integral-differential control method, taking the side offset as the lateral main control outer loop, introducing the side deviation rate to increase the lateral damping, and the rolling angle rate as the inner loop to eliminate the side offset and realize track tracking control;
[0027]
[0028]
[0029] in,
[0030] In the formula, δ a is the aileron deflection, φ g is the given value of the roll angle, φ is the roll angle, p is the roll angle rate, Y is the side offset, is the lateral deviation velocity, ψk is the track heading angle, is the track angle target, are the gains of each item in the controller.
[0031] A small UAV parachute recovery control device, characterized by comprising:
[0032] The recovery preparation unit is used to call the altitude holding mode vertically, and the altitude control target is the same as that of the recovery preparation unit; the track tracking control mode is called horizontally, and the track tracking target is the line connecting the current position of the aircraft and the preset recovery point;
[0033] The attitude adjustment and shutdown unit is used to call the altitude holding mode longitudinally, and the altitude control target is the same as the recovery preparation unit; to call the track tracking control mode laterally and limit the roll angle; and to shut down the engine;
[0034] The parachute opening unit is used to call the pitch angle control mode longitudinally, with the control target being 0°; to call the roll angle hold mode laterally, with the roll angle control target being 0°; and to open the parachute when the engine reports that it is in the parking state;
[0035] The airbag inflation unit is used to issue an airbag inflation command when the timing reaches or the relative altitude is lower than a certain value, and all the control surface commands are softened to 0°;
[0036] The touchdown parachute cutting unit is used to determine the aircraft touchdown by measuring the overload value or the vertical speed, and then cut the parachute, and all the control surface instructions are kept at 0°.
[0037] An electronic device comprises a memory, a processor and a computer program stored in the memory and executable on the processor, wherein the processor implements a small unmanned aerial vehicle parachute recovery control method when executing the program.
[0038] A non-transitory computer-readable storage medium having a computer program stored thereon, characterized in that when the computer program is executed by a processor, a small unmanned aerial vehicle parachute recovery control method is implemented.
[0039] The advantages of this application are:
[0040] 1. The present invention can realize automatic and fast recovery, maximize its recovery success rate while ensuring a certain recovery accuracy, and minimize the damage to the UAV. By designing specific logic to call the conventional flight control law mode, the trajectory and attitude control of the recovery stage can be realized; the timing of parachute opening and airbag inflation is determined according to parameters such as engine status, relative altitude, and indicated speed, thereby realizing safe recovery of the UAV.
[0041] 2 The control logic of the parachute recovery system of the present invention is clear, reliable, and does not require manual operation, with high landing point accuracy. The function of quick / emergency recovery can be realized on a drone equipped with a parachute recovery system.
[0042] 3. This application realizes fixed-altitude level flight by calling the altitude holding control mode and the track tracking control mode in stages, realizes fixed attitude by calling the pitch angle control mode and the roll angle control mode, and realizes fixed speed by calling the engine speed indicator closed-loop control mode, and shuts down the engine when the recovery parachute is opened in the area, altitude, speed, attitude, etc. to complete the parachute recovery process of the UAV. The present invention can realize the parachute recovery of the UAV by reasonable automatic control of the engine, control surface, parachute opening mechanism, airbag inflation mechanism, etc. BRIEF DESCRIPTION OF THE DRAWINGS
[0043] Figure 1 It is a parachute recovery control logic flow chart of the present invention.
[0044] Figure 2 It is a modal block diagram of the engine speed closed-loop control of the present invention.
[0045] Figure 3 It is a block diagram of the altitude holding control mode of the present invention.
[0046] Figure 4 It is a pitch angle control modal block diagram of the present invention.
[0047] Figure 5 It is a roll angle control modal block diagram of the present invention.
[0048] Figure 6 It is the track tracking control modal block diagram of the present invention. DETAILED DESCRIPTION
[0049] In order to make the purpose, technical solution and advantages of the embodiments of the present application clearer, the technical solution in the embodiments of the present application will be clearly and completely described below in conjunction with the drawings in the embodiments of the present application. Obviously, the described embodiments are part of the embodiments of the present application, rather than all the embodiments. The components of the embodiments of the present application described and shown in the drawings here can be arranged and designed in various different configurations.
[0050] Therefore, the following detailed description of the embodiments of the present application provided in the accompanying drawings is not intended to limit the scope of the present application for which protection is sought, but merely represents selected embodiments of the present application. Based on the embodiments in the present application, all other embodiments obtained by ordinary technicians in the field without creative work are within the scope of protection of the present application.
[0051] It should be noted that similar reference numerals and letters denote similar items in the following drawings, and therefore, once an item is defined in one drawing, further definition and explanation thereof is not required in subsequent drawings.
[0052] In the description of the present application, it should be noted that the terms "upper", "vertical", "inner", "outer", etc. indicate the orientation or position relationship based on the orientation or position relationship shown in the drawings, or the orientation or position relationship in which the product of the application is usually placed when in use, or the orientation or position relationship commonly understood by those skilled in the art. They are only for the convenience of describing the present application and simplifying the description, and do not indicate or imply that the device or element referred to must have a specific orientation, be constructed and operated in a specific orientation, and therefore cannot be understood as a limitation on the present application. In addition, the terms "first", "second", etc. are only used to distinguish the description, and cannot be understood as indicating or implying relative importance.
[0053] In the description of this application, it should also be noted that, unless otherwise clearly specified and limited, the terms "set", "install", and "connect" should be understood in a broad sense, for example, it can be a fixed connection, a detachable connection, or an integral connection; it can be a mechanical connection or an electrical connection; it can be a direct connection, or it can be an indirect connection through an intermediate medium, or it can be the internal communication of two components. For ordinary technicians in this field, the specific meanings of the above terms in this application can be understood according to specific circumstances.
[0054] Example 1
[0055] A small UAV parachute recovery control method comprises the following steps:
[0056] Through segmented control and control law mode call; the parachute recovery process is divided into five stages, namely, recovery preparation stage, attitude adjustment and shutdown stage, parachute opening stage, airbag inflation stage and grounding and parachute cutting stage;
[0057] Recovery preparation stage: vertically call the altitude hold mode, and the altitude control target is the same as the recovery preparation stage; horizontally call the track tracking control mode, and the track tracking target is the line connecting the current position of the aircraft and the preset recovery point;
[0058] Attitude adjustment and shutdown phase: longitudinally call the altitude holding mode, and the altitude control target is the same as the recovery preparation phase; laterally call the track tracking control mode and limit the roll angle; shut down the engine;
[0059] During the parachute opening phase: the pitch angle control mode is called vertically, and the control target is 0°; the roll angle hold mode is called horizontally, and the roll angle control target is 0°; the parachute is opened when the engine reports that it is in the parking state;
[0060] Airbag inflation stage: When the timing reaches or the measured relative height is lower than a certain value, an airbag inflation command is issued, and all rudder surface commands are softened to 0°;
[0061] Touchdown and parachute cutting stage: The aircraft touches down by measuring the overload value or the vertical speed, and then the parachute is cut, and all the control surface instructions are kept at 0°.
[0062] Example 2
[0063] A small UAV parachute recovery control method comprises the following steps:
[0064] Through segmented control and control law mode call, the parachute recovery process is divided into five stages, namely, recovery preparation stage, attitude adjustment and shutdown stage, parachute opening stage, airbag inflation stage and grounding and parachute cutting stage.
[0065] Recovery preparation stage: vertically call the altitude hold mode, and the altitude control target is the same as the recovery preparation stage; horizontally call the track tracking control mode, and the track tracking target is the line connecting the current position of the aircraft and the preset recovery point;
[0066] Attitude adjustment and shutdown phase: longitudinally call the altitude holding mode, and the altitude control target is the same as the recovery preparation phase; laterally call the track tracking control mode and limit the roll angle; shut down the engine;
[0067] During the parachute opening phase: the pitch angle control mode is called vertically, and the control target is 0°; the roll angle hold mode is called horizontally, and the roll angle control target is 0°; the parachute is opened when the engine reports that it is in the parking state;
[0068] Airbag inflation stage: When the timing reaches or the measured relative height is lower than a certain value, an airbag inflation command is issued, and all rudder surface commands are softened to 0°;
[0069] Touchdown and parachute cutting stage: The aircraft touches down by measuring the overload value or the vertical speed, and then the parachute is cut, and all the control surface instructions are kept at 0°.
[0070] Furthermore, the engine speed closed-loop control mode is specifically: the speed is controlled by the automatic throttle, with the given value of the speed To control the target, a feedforward (throttle trim) + proportional + integral control structure is adopted, and a proportional-integral control method is used to control the speed indicator;
[0071]
[0072] In the formula, δ T is the engine throttle opening, is the given value of the speed indicator, V IAS is the measured value of the speed indicator, is the feedforward of the engine throttle, is the controller gain.
[0073] Further, the altitude hold control mode is specifically: this control mode uses vertical speed hold as an inner loop to control and hold the altitude, its input signal includes the altitude command and the current altitude, vertical rate, pitch angle, pitch angle rate, angle of attack and vertical angular velocity, and the output is the elevator deflection;
[0074]
[0075] Δα=(α-α0)+q;
[0076] In the formula, δ ε is the elevator deflection, q is the pitch rate, q g is the pitch rate, θ is the pitch angle, θ g is the pitch angle, ΔA Z is the vertical acceleration, α is the angle of attack, α0 is the angle of attack protection value, is the angle of attack protection term, is the overload protection term, θ ref is the pitch angle feedforward, is the lifting speed given, is a controller gain, For the filter.
[0077] Furthermore, the pitch angle control mode is specifically a control structure using proportional integral differential, the control mode uses the pitch angle rate as an inner loop to control the pitch angle, its input signals include the pitch angle rate, pitch angle, angle of attack, roll angle, indicated airspeed, and the output is the elevator deflection;
[0078]
[0079] In the formula, δ ε is the elevator deflection, q is the pitch rate, q g is the pitch rate, θ is the pitch angle, θ g is the pitch angle, α is the angle of attack, α0 is the angle of attack protection value, is the angle of attack protection term, V IAS is the measured value of the speedometer, g is the acceleration due to gravity, is the controller gain.
[0080] Furthermore, the roll angle control mode is specifically: mainly adopting a proportional plus integral control method, with the roll angle The roll angular rate (ROR) is introduced as the lateral main control outer loop to increase the lateral damping, and the yaw angular rate is the inner loop to track the given roll angle target value. Achieve attitude control of the drone to roll left, flat wings, and roll right;
[0081]
[0082] In the formula, δ a is the aileron deflection, φ g is the given value of the roll angle, φ is the roll angle, p is the roll angle rate, are the gains of each controller.
[0083] Furthermore, the track tracking control mode is specifically: adopting a proportional-integral-differential control method, taking the side offset as the lateral main control outer loop, introducing the side deviation rate to increase the lateral damping, and the rolling angle rate as the inner loop to eliminate the side offset and realize track tracking control;
[0084]
[0085] in,
[0086] In the formula, δ a is the aileron deflection, φ g is the given value of the roll angle, φ is the roll angle, p is the roll angle rate, Y is the side offset, is the lateral deviation velocity, ψ k is the track heading angle, is the track angle target, are the gains of each item in the controller.
[0087] Example 3
[0088] A small UAV parachute recovery control device, characterized by comprising:
[0089] The recovery preparation unit is used to call the altitude holding mode vertically, and the altitude control target is the same as that of the recovery preparation unit; the track tracking control mode is called horizontally, and the track tracking target is the line connecting the current position of the aircraft and the preset recovery point;
[0090] The attitude adjustment and shutdown unit is used to call the altitude holding mode longitudinally, and the altitude control target is the same as the recovery preparation unit; to call the track tracking control mode laterally and limit the roll angle; and to shut down the engine;
[0091] The parachute opening unit is used to call the pitch angle control mode longitudinally, with the control target being 0°; to call the roll angle hold mode laterally, with the roll angle control target being 0°; and to open the parachute when the engine reports that it is in the parking state;
[0092] The airbag inflation unit is used to issue an airbag inflation command when the timing reaches or the relative altitude is lower than a certain value, and all the control surface commands are softened to 0°;
[0093] The touchdown parachute cutting unit is used to determine the aircraft touchdown by measuring the overload value or the vertical speed, and then cut the parachute, and all the control surface instructions are kept at 0°.
[0094] Example 4
[0095] An electronic device comprises a memory, a processor and a computer program stored in the memory and executable on the processor, wherein the processor implements the small unmanned aerial vehicle parachute recovery control method of Embodiment 1 and Embodiment 2 when executing the program.
[0096] Example 5
[0097] A non-transitory computer-readable storage medium having a computer program stored thereon, wherein when the computer program is executed by a processor, the small unmanned aerial vehicle parachute recovery control method as described in Embodiment 1 and Embodiment 2 is implemented.
[0098] Example 6
[0099] The present invention will now be further described with reference to the accompanying drawings:
[0100] Before and after the UAV is recovered, the longitudinal control mode, lateral control mode, and engine control mode need to be called simultaneously.
[0101] like Figure 1 As shown, the main process of modal scheduling logic is:
[0102] ① Recovery preparation stage: vertically call the altitude control mode, and the control target is the preset parachute opening altitude;
[0103] The engine control calls the airspeed control mode, and the control target is the indicated airspeed allowed for the parachute to be opened. The indicated airspeed target value is determined by the recovery parachute and the performance of the aircraft itself, that is, the minimum indicated airspeed for level flight < the indicated airspeed target value.
[0104] <Maximum parachute opening speed; call the track tracking control mode laterally, the control target is determined by the current position of the aircraft and the position of the preset recovery point, usually the line connecting the two positions; judge that the aircraft's altitude and speed enter a small range near the control target and the distance to be flown is less than a certain value (the current flight speed, the time interval between the computer issuing the shutdown command and receiving the shutdown status report, and the aircraft's body deceleration characteristics, such as GS*5~GS*7) to enter the next stage.
[0105] ② Attitude adjustment and shutdown phase: To enter this phase, the current state must be converted to a level flight state, that is, the pitch angle control mode is called longitudinally, and the control target is 0° (or a value close to the pitch angle to ensure the aircraft's level flight, but it cannot exceed the pitch angle range allowed by the parachute opening); the engine is shut down; the track tracking control mode is called laterally, and the control target is consistent with the recovery preparation phase, and the roll angle is limited, which cannot exceed the roll angle range allowed by the parachute opening; the computer determines that the engine has been shut down and enters the next phase;
[0106] ③ Parachute opening stage: The computer sends the parachute opening command, and the control targets and rudder surface commands are consistent with the "attitude adjustment and shutdown" stage; when the relative altitude is lower than a certain value (this value is determined by the steady descent speed of the aircraft after the parachute is opened and the time for the airbag to be filled, and should be greater than the product of the two), or the parachute opening stage exceeds a certain time (depending on the parachute opening altitude, the time for the parachute to descend during the opening process and the time for the airbag to be filled)
[0107] Then enter the next stage;
[0108] ④ Airbag inflation stage: The computer sends an airbag inflation command, all control surface commands are 0°, and it enters the next stage after it is judged to be touching the ground;
[0109] ⑤ Parachute cutting stage: The computer sends a parachute cutting command, and all rudder surface commands are 0°.
[0110] like Figure 2 As shown in the figure, the engine speed closed-loop control mode mainly realizes: ① receiving the airspeed given value from the flight control computer ② Receive the airspeed signal (V IAS );③ and introduce the feedforward Compensate for the influence of attitude change on speed; ④ Through the proportional integral differential controller closed-loop control loop, solve the control law and output the control signal to the UAV engine throttle, thereby realizing the UAV's speed closed-loop control.
[0111] like Figure 3 As shown in the figure, the altitude hold control mode consists of a guidance loop and a control loop. The outer loop of the guidance loop is the altitude, and the inner loop is the ascent and descent speed; the outer loop of the control loop is the pitch angle, and the inner loop is the pitch angle rate. The main functions are: ① Receive the altitude given value (H) from the flight control computer g ), receiving the altitude signal (H) and the lifting speed signal from the sensor output Receive the normal overload output from the sensor and subtract it from the protection value to obtain the normal overload error ΔA Z , to protect against normal overload, is the overload protection item; the proportional integral differential controller is used to obtain θ NAV; ② Receive the angle of attack output from the sensor, and subtract it from the protection value to get Δα, and protect the angle of attack. is the angle of attack protection term, superposition, θ NAV Feedforward value θ ref And the angle of attack protection term to get the target pitch angle θ g ; ③ Receive the pitch angle θ, roll angle φ, and pitch angle rate q output from the sensor, The longitudinal compensation amount after the aircraft establishes the bank is calculated to obtain q g ④ Based on the above signals, the proportional-integral-differential controller is used to output the control target of the equivalent elevator, thereby achieving the height control of the UAV.
[0112] like Figure 4 As shown in the figure, the roll angle control mode mainly realizes: ① receiving the pitch angle given value (φ) from the flight control computer g ) ; ② Receive the pitch angle signal (θ) and pitch rate signal (q) from the sensor; ③ Combine the above signals, solve the control law and output the deflection δ of the elevator through the proportional integral controller closed loop longitudinal control loop e , to achieve the control of the pitch angle of the drone.
[0113] like Figure 5 As shown in the figure, the roll angle control mode mainly realizes: ① receiving the roll angle given value (φ) from the flight control computer g ) ; ② Receive the roll angle signal (φ) and roll rate signal (p) from the sensor; ③ Combine the above signals, solve the control law through the proportional integral controller closed loop lateral control loop and output the aileron rudder deflection δ a , to achieve the control of the UAV's roll angle.
[0114] like Figure 6 As shown in Figure 2, the track tracking control mode mainly realizes: ① receiving the roll angle given value (φ) from the flight control computer g ) ; ② Receive the roll angle signal (p) and roll angular rate signal (p) from the sensor, and calculate the side offset distance (Y) and side deviation speed ③ Based on the above signals, the proportional-integral controller closes the lateral and heading control loop, solves the control law and outputs the control signal to the actuator (aileron rudder) of the UAV system, thereby realizing the track tracking control of the UAV.
Claims
1. A small UAV parachute recovery control method, characterized in that: The steps include: Through segmented control and control law mode call; the parachute recovery process is divided into five stages, namely, recovery preparation stage, attitude adjustment and shutdown stage, parachute opening stage, airbag inflation stage and grounding and parachute cutting stage; Recovery preparation stage: vertically call the altitude hold mode, and the altitude control target is the same as the recovery preparation stage; horizontally call the track tracking control mode, and the track tracking target is the line connecting the current position of the aircraft and the preset recovery point; Attitude adjustment and shutdown phase: longitudinally call the altitude holding mode, and the altitude control target is the same as the recovery preparation phase; laterally call the track tracking control mode and limit the roll angle; shut down the engine; During the parachute opening phase: the pitch angle control mode is called vertically, and the control target is 0°; the roll angle hold mode is called horizontally, and the roll angle control target is 0°; the parachute is opened when the engine reports that it is in the parking state; Airbag inflation stage: When the timing reaches or the measured relative height is lower than a certain value, an airbag inflation command is issued, and all rudder surface commands are softened to 0°; Touchdown and parachute cutting stage: The aircraft touches down by measuring the overload value or the vertical speed, and then the parachute is cut, and all the control surface instructions are kept at 0°.
2. The small UAV parachute recovery control method according to claim 1 is characterized in that: The engine speed closed-loop control mode is specifically: the speed indicator is controlled by the automatic throttle, with the given value of the speed indicator To control the target, a feedforward + proportional + integral control structure is adopted, and a proportional integral control method is used to control the speed indicator; In the formula, δ T is the engine throttle opening, is the given value of the speed indicator, V IAS is the measured value of the speed indicator, is the feedforward of the engine throttle, is the controller gain.
3. The small UAV parachute recovery control method according to claim 1 is characterized in that: The altitude hold control mode is specifically: using vertical speed hold as an inner loop to control and hold the altitude, its input signals include altitude command and current altitude, vertical velocity, pitch angle, pitch angle rate, angle of attack and vertical angular velocity, and the output is elevator deflection; Δα=(α-α0)+q; In the formula, δ ε is the elevator deflection, q is the pitch rate, q g is the pitch rate, θ is the pitch angle, θ g is the pitch angle, ΔA Z is the vertical acceleration, α is the angle of attack, α0 is the angle of attack protection value, is the angle of attack protection term, is the overload protection term, θ ref is the pitch angle feedforward, is the lifting speed given, is a controller gain, For the filter.
4. The small UAV parachute recovery control method according to claim 1 is characterized in that: The pitch angle control mode is specifically to adopt a proportional integral differential control structure, with the pitch angle rate as the inner loop to control the pitch angle, its input signals include the pitch angle rate, pitch angle, angle of attack, roll angle, indicated airspeed, and the output is the elevator deflection; In the formula, δ ε is the elevator deflection, q is the pitch rate, q g is the pitch rate, θ is the pitch angle, θ g is the pitch angle, α is the angle of attack, α0 is the angle of attack protection value, is the angle of attack protection term, V IAS is the measured value of the speedometer, g is the acceleration due to gravity, is the controller gain.
5. The small UAV parachute recovery control method according to claim 1 is characterized in that: The roll angle control mode is specifically: using a proportional plus integral control method, with the roll angle The lateral main control outer loop introduces the roll angle rate to increase the lateral damping, and the yaw angle rate is the inner loop to track the given roll angle target value. Achieve attitude control of the drone to roll left, flat wings, and roll right; In the formula, δ a is the aileron deflection, φ g is the given value of the roll angle, φ is the roll angle, p is the roll angle rate, are the gains of each controller.
6. The small UAV parachute recovery control method according to claim 1 is characterized in that: The track tracking control mode is specifically: adopting a proportional-integral-differential control method, taking the side deviation as the lateral main control outer loop, introducing the side deviation rate to increase the lateral damping, and the rolling angle rate as the inner loop to eliminate the side deviation and realize track tracking control; in, In the formula, δ a is the aileron deflection, φ g is the given value of the roll angle, φ is the roll angle, p is the roll angle rate, Y is the side offset, is the lateral deviation velocity, ψ k is the track heading angle, is the track angle target, are the gains of each item in the controller.
7. A small UAV parachute recovery control device, characterized in that: include: The recovery preparation unit is used to call the altitude holding mode vertically, and the altitude control target is the same as that of the recovery preparation unit; the track tracking control mode is called horizontally, and the track tracking target is the line connecting the current position of the aircraft and the preset recovery point; The attitude adjustment and shutdown unit is used to call the altitude holding mode longitudinally, and the altitude control target is the same as the recovery preparation unit; to call the track tracking control mode laterally and limit the roll angle; and to shut down the engine; The parachute opening unit is used to call the pitch angle control mode longitudinally, with the control target being 0°; to call the roll angle hold mode laterally, with the roll angle control target being 0°; and to open the parachute when the engine reports that it is in the parking state; The airbag inflation unit is used to issue an airbag inflation command when the timing reaches or the relative altitude is lower than a certain value, and all the control surface commands are softened to 0°; The touchdown parachute cutting unit is used to determine the aircraft touchdown by measuring the overload value or the vertical speed, and then cut the parachute, and all the control surface instructions are kept at 0°.
8. An electronic device comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein: When the processor executes the program, the small unmanned aerial vehicle parachute recovery control method as described in any one of claims 1 to 6 is implemented.
9. A non-transitory computer-readable storage medium having a computer program stored thereon, characterized in that: When the computer program is executed by a processor, the small UAV parachute recovery control method as described in any one of claims 1 to 6 is implemented.
Citation Information
Cited By
Large wingspan unmanned aerial vehicle landing control method, electronic equipment and medium
CN119806184A
