A method for evaluating the delay tolerance of UAV control systems
By evaluating the open-loop phase margin and hysteresis phase of the UAV control system, the maximum tolerable time delay is calculated, thus solving the instability problem of the UAV control system when the time delay exceeds the range and improving the system's safety and reliability.
Patent Information
- Application Number
- CN202210271062.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-03-18
- Publication Date
- 2024-11-12
- Estimated Expiration
- 2042-03-18
AI Technical Summary
Existing drone control systems are prone to instability when latency exceeds tolerable limits, and there is a lack of effective evaluation methods to improve safety.
By obtaining the open-loop phase margin of the UAV control system, calculating the lag phase, comparing the lag phase with the open-loop phase margin, evaluating the system's tolerance to delay, calculating the maximum tolerable delay value, and adjusting the delay to maintain system stability.
It enables the assessment of the latency tolerance of UAV control systems, improves the system's security and reliability, and provides guidance on acceptable latency ranges.
Smart Images

Figure CN114859851B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of aircraft flight control technology, and in particular to a method for evaluating the delay tolerance capability of a UAV control system, which is used to evaluate the delay tolerance capability of a UAV control system, thereby improving the safety of the UAV. Background Art
[0002] At present, with the development of drone technology, drone control systems have received more and more attention. In order to improve the safety and reliability of drones, drone control systems need to have a certain tolerance for delays. When designing drone controllers, delays caused by sensors and actuators are often ignored. For drones, if the delay exceeds the drone's tolerable range, the originally stable drone control system will become unstable. Therefore, it is necessary to propose a method to evaluate the delay tolerance of drone control systems, which can evaluate the delay tolerance of drone control systems and thus improve the safety of drones. Summary of the invention
[0003] The purpose of the present invention is to provide a method for evaluating the time delay tolerance capability of a UAV control system, thereby realizing the function of evaluating the time delay tolerance capability of a UAV control system and improving the safety of the UAV.
[0004] The present invention is implemented by the following technical solution: A method for evaluating the delay tolerance capability of a drone control system comprises the following steps:
[0005] Step S1. Obtaining the open-loop phase margin of the UAV control system;
[0006] Step S2. Calculate the lag phase of the UAV control system based on the relationship between bandwidth and delay;
[0007] Step S3. Compare the lag phase and open-loop phase margin of the UAV control system to determine whether the UAV control system has tolerance for time delay;
[0008] Step S4. Calculate the maximum tolerable delay value based on the relationship between the phase margin and the bandwidth of the UAV control system;
[0009] Step S5. Obtain the maximum tolerable delay in the entire flight control system according to the maximum tolerable delay value.
[0010] In order to better implement the present invention, further, step S1 includes:
[0011] Step S1.1. Obtain the open-loop phase margin Pm of the UAV control system;
[0012] Step S1.2. According to the cutoff frequency w of the UAV control systemc , the transfer function of the forward channel G(jw c ), the transfer function of the feedback channel H(jw c ) and the open-loop phase margin Pm to obtain the critical stability expression of the unmanned control system after reducing the open-loop phase margin Pm, and it is expressed as: ∠G(jw c )∠H(jw c )-Pm=-180°.
[0013] In order to better implement the present invention, further, step S2 includes:
[0014] The expression for calculating the lag phase φ of the UAV control system is φ=ωt, where ω is the bandwidth of the UAV control system in rad / s, and t is the time delay in s.
[0015] In order to better implement the present invention, further, step S3 includes:
[0016] Compare the lag phase φ of the UAV control system with the open-loop phase margin Pm;
[0017] When φ<Pm, it is judged that the UAV control system has the tolerance to the time delay under the current lag phase φ;
[0018] When φ=Pm, the UAV control system is judged to be in a critical stable state;
[0019] When φ>Pm, it is judged that the UAV control system has no tolerance for the time delay under the current lag phase φ.
[0020] In order to better implement the present invention, further, step S4 includes:
[0021] The maximum tolerable delay t of the UAV control system is calculated based on the open-loop phase margin and bandwidth. max The value of is expressed as:
[0022] Among them, t max The unit is milliseconds, and the delay t is adjusted so that t < t max .
[0023] In order to better implement the present invention, further, step S5 includes:
[0024] The maximum tolerable delay of each ring is obtained according to the controlled quantity of each ring channel in the UAV control system and the bandwidth of each ring;
[0025] The minimum value of the maximum tolerable delay of each link is taken as the maximum tolerable delay of the entire flight control system.
[0026] Compared with the prior art, the present invention has the following advantages and beneficial effects:
[0027] (1) The method of the present invention is simple, easy to implement, and has strong engineering practicability;
[0028] (2) The present invention utilizes the relationship between bandwidth, delay and phase margin to achieve delay tolerance evaluation and improve the safety and reliability of the UAV control system;
[0029] (3) The present invention can not only evaluate the rationality of the delay, but also provide a desirable range of the delay. BRIEF DESCRIPTION OF THE DRAWINGS
[0030] The present invention is further described in conjunction with the following drawings and embodiments, and all the concepts and innovations of the present invention should be regarded as the disclosed contents and the protection scope of the present invention.
[0031] Figure 1 A flowchart of a method for evaluating the delay tolerance capability of a drone control system provided by the present invention. DETAILED DESCRIPTION
[0032] In order to more clearly illustrate the technical solutions of the embodiments of the present invention, the technical solutions in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. It should be understood that the described embodiments are only part of the embodiments of the present invention, not all of the embodiments, and therefore should not be regarded as limiting the scope of protection. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technical personnel in this field without making creative work are within the scope of protection of the present invention.
[0033] In the description of the present invention, it should be noted that, unless otherwise clearly specified and limited, the terms "disposed", "connected", and "connected" 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 elements. For ordinary technicians in this field, the specific meanings of the above terms in the present invention can be understood according to specific circumstances.
[0034] Embodiment 1:
[0035] A method for evaluating the delay tolerance capability of a drone control system in this embodiment is as follows: Figure 1 As shown, this embodiment discloses: Step S1. Obtaining the open-loop phase margin of the UAV control system;
[0036] Step S2. Calculate the lag phase of the UAV control system based on the relationship between bandwidth and delay;
[0037] Step S3. Compare the lag phase and open-loop phase margin of the UAV control system to determine whether the UAV control system has tolerance for time delay;
[0038] Step S4. Calculate the maximum tolerable delay value based on the relationship between the phase margin and the bandwidth of the UAV control system;
[0039] Step S5. Obtain the maximum tolerable delay in the entire flight control system according to the maximum tolerable delay value.
[0040] In this embodiment, a method for evaluating the delay tolerance of the UAV control system is provided, which is not only simple and easy to implement, but also has strong engineering practicality. By using the relationship between bandwidth, delay and phase margin, the delay tolerance is evaluated, and the safety and reliability of the UAV control system are improved.
[0041] Embodiment 2:
[0042] This embodiment is further optimized on the basis of embodiment 1, and this embodiment discloses:
[0043] Step S1.1. Obtain the open-loop phase margin Pm of the UAV control system;
[0044] Step S1.2. According to the cutoff frequency w of the UAV control system c , the transfer function of the forward channel G(jw c ), the transfer function of the feedback channel H(jw c ) and the open-loop phase margin Pm to obtain the critical stability expression of the unmanned control system after reducing the open-loop phase margin Pm, and it is expressed as: ∠G(jw c )∠H(jw c )-Pm=-180°.
[0045] In this embodiment, G(jw c ) and H(jw c ) are open-loop transfer functions, which are the transfer functions of the control loop, G(jwc) is the transfer function of the forward channel, and H(jwc) is the transfer function of the feedback channel, which is common knowledge in the control theory in this field. In this embodiment, the open-loop phase margin of the drone control system is obtained by calculating the cutoff frequency through the amplitude of the system, and then calculating the open-loop phase margin according to the cutoff frequency. At the system cutoff frequency w c When the amplitude meets the system stability condition, the system will reach the critical stability condition after the open-loop phase margin is further reduced by Pm.
[0046] The other parts of this embodiment are the same as those of Embodiment 1, and thus will not be described in detail.
[0047] Embodiment 3:
[0048] This embodiment is further optimized on the basis of the above-mentioned embodiment 1 or 2, and this embodiment discloses:
[0049] The expression for calculating the lag phase φ of the UAV control system is φ=ωt, where ω is the bandwidth of the UAV control system in rad / s, and t is the time delay in s.
[0050] In this embodiment, by calculating the lag phase of the UAV control system, it is determined whether the lag phase of the UAV control system is less than the phase margin. When the lag phase of the UAV control system is less than the phase margin, the UAV control system has tolerance for the delay, and the control system's tolerance for delay can be evaluated subsequently. When the lag phase of the UAV control system is greater than or equal to the phase margin, the delay needs to be adjusted. The adjustment of the delay requires first calculating the maximum delay value, and then adjusting the delay so that the delay is less than the maximum delay value. At this time, the lag phase of the UAV control system is less than the phase margin, and then the control system's tolerance for delay is evaluated.
[0051] The other parts of this embodiment are the same as those of the above-mentioned embodiment 1 or 2, and thus will not be described in detail.
[0052] Embodiment 4:
[0053] This embodiment is further optimized on the basis of any one of the above embodiments 1-3. This embodiment discloses:
[0054] Compare the lag phase φ of the UAV control system with the open-loop phase margin Pm;
[0055] When φ<Pm, it is judged that the UAV control system has the tolerance to the time delay under the current lag phase φ;
[0056] When φ=Pm, the UAV control system is judged to be in a critical stable state;
[0057] When φ>Pm, it is judged that the UAV control system has no tolerance for the time delay under the current lag phase φ.
[0058] In this embodiment, by judging whether the lag phase of the UAV control system is less than the phase margin, the result of evaluating the delay tolerance capability of the UAV control system is obtained.
[0059] The other parts of this embodiment are the same as any one of the above embodiments 1-3, so they are not repeated here.
[0060] Embodiment 5:
[0061] This embodiment is further optimized on the basis of any one of the above embodiments 1-4, and step S4 includes:
[0062] The maximum tolerable delay t of the UAV control system is calculated based on the open-loop phase margin and bandwidth. max The value of is expressed as: Among them, t max The unit is milliseconds, and the delay t is adjusted so that t < t max .
[0063] This embodiment can not only evaluate the rationality of the delay, but also provide a desirable range of the delay.
[0064] The other parts of this embodiment are the same as any one of the above embodiments 1-4, so they are not repeated here.
[0065] Embodiment 6:
[0066] This embodiment is further optimized on the basis of any one of the above embodiments 1-5, and step S5 includes:
[0067] The maximum tolerable delay of each ring is obtained according to the controlled quantity of each ring channel in the UAV control system and the bandwidth of each ring;
[0068] The minimum value of the maximum tolerable delay of each link is taken as the maximum tolerable delay of the entire flight control system.
[0069] In this embodiment, taking the longitudinal channel of a certain UAV control system as an example, the controlled quantities are q, θ, H & , H, the maximum delay that the entire control system can tolerate can be expressed as:
[0070] Tmax=min(t max q , t maxθ , t max H K), where
[0071]
[0072]
[0073]
[0074]
[0075] Among them, ω q ,ω θ , ω H are the bandwidths of each ring respectively.
[0076] The other parts of this embodiment are the same as any one of the above embodiments 1-5, so they are not repeated here.
[0077] The above description is only a preferred embodiment of the present invention and does not limit the present invention in any form. Any simple modification or equivalent change made to the above embodiment based on the technical essence of the present invention shall fall within the protection scope of the present invention.
Claims
1. A method for evaluating the delay tolerance of a UAV control system, characterized in that: The following steps are involved: Step S1. Obtaining the open-loop phase margin of the UAV control system; Step S2. Calculate the lag phase of the UAV control system based on the relationship between bandwidth and delay; Step S3. Compare the lag phase and open-loop phase margin of the UAV control system to determine whether the UAV control system has tolerance for time delay; Step S4. Calculate the maximum tolerable delay value based on the relationship between the phase margin and the bandwidth of the UAV control system; Step S5. Obtain the maximum tolerable delay in the entire flight control system according to the maximum tolerable delay value; Step S2 includes: The expression for calculating the lag phase φ of the UAV control system is φ=ωt, where ω is the bandwidth of the UAV control system in rad / s, and t is the time delay in s; The step S3 comprises: Compare the lag phase φ of the UAV control system with the open-loop phase margin Pm; When φ<Pm, it is judged that the UAV control system has the tolerance to the time delay under the current lag phase φ; When φ=Pm, the UAV control system is judged to be in a critical stable state; When φ>Pm, it is judged that the UAV control system has no tolerance for the time delay under the current lag phase φ; The step S4 includes: calculating the maximum delay t that the UAV control system can tolerate based on the open-loop phase margin and bandwidth max The value of is expressed as: Among them, t max The unit is milliseconds, and the delay t is adjusted so that t < t max ; The step S5 includes: obtaining the maximum tolerable delay of each ring according to the controlled quantity of each ring channel in the UAV control system and the bandwidth of each ring.
2. The method for evaluating the delay tolerance capability of a UAV control system according to claim 1, characterized in that: The step S1 comprises: Step S1.
1. Obtain the open-loop phase margin Pm of the UAV control system; Step S1.
2. According to the cutoff frequency w of the UAV control system c , the transfer function of the forward channel G(jw c ), the transfer function H of the feedback channel (jw c ) and the open-loop phase margin Pm to obtain the critical stability expression of the unmanned control system after reducing the open-loop phase margin Pm, and it is expressed as: ∠G (jw c )∠H(jw c )-Pm=-180°.
3. The method for evaluating the delay tolerance of a UAV control system according to claim 1, characterized in that: The step S5 also includes: taking the minimum value of the maximum tolerable delay values of each loop as the maximum tolerable delay of the entire flight control system.
