A three-tiered signal delay compensation control method and system for ATP turntable tracking
By employing a three-tiered signal delay compensation control method in the photoelectric tracking system, combined with PAFP and a low-pass filter, the problems of image miss signal delay and noise were solved, thereby improving the tracking accuracy and servo control performance of UAV targets.
Patent Information
- Application Number
- CN202510350269.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2025-03-24
- Publication Date
- 2026-11-10
- Estimated Expiration
- 2045-03-24
AI Technical Summary
Existing technologies in photoelectric tracking systems struggle to effectively compensate for signal delays in image miss distance data, leading to lag in servo control system response and decreased tracking performance. Existing methods such as Smith predictors, Kalman predictive filters, and measurement filters have limited effectiveness in photoelectric tracking systems.
A three-tiered signal delay compensation control method is adopted. By combining a position lead feedback predictor (PAFP) and a first-order low-pass filter, delay compensation is performed first, then high-frequency noise is filtered out, and finally phase lag is eliminated, outputting a delay-free and noise-free signal to the servo control system.
It achieves accurate tracking under high noise and latency conditions, improves servo control accuracy and response performance, and is highly adaptable, robust, and independent of system models.
Smart Images

Figure CN119986611B_ABST
Abstract
Description
Technical Field
[0001] This invention relates to the field of aircraft monitoring, tracking and processing technology, and in particular to a three-tiered signal delay compensation control method and system for ATP turntable tracking. Background Technology
[0002] With the development of technology, drone technology is becoming increasingly mature, leading to a greater demand for monitoring and tracking drone flights, and a corresponding increase in the requirement for tracking accuracy, which in turn increases the requirements for servo control precision. Besides the structure and algorithm of the servo system itself, the most significant factor affecting servo control performance is the delay of the external input signal. In photoelectric tracking systems, the input signal to the servo system is the image miss distance. The acquisition, analysis, and transmission of this image miss distance data introduce a certain signal delay, which significantly impacts the response and tracking performance of the servo control system. Current technologies mostly employ Smith predictors, Kalman predictive filters, and... Filters such as the Smith predictor are used to compensate for image delay. However, the Smith predictor requires knowledge of the system model, which is difficult to obtain accurately for photoelectric tracking systems. Therefore, its prediction capability is limited and the compensation effect is generally poor. Although the Kalman predictor has a better prediction effect than the Smith predictor, its implementation is more complex. Although the measurement filter is relatively simple to implement, its prediction effect is very limited, and it is only suitable for systems with small delays or low tracking accuracy requirements. Summary of the Invention
[0003] The purpose of this invention is to overcome the shortcomings of existing ATP tracking technology and provide a three-tiered signal delay compensation control method and system for ATP turntable tracking.
[0004] The objective of this invention is achieved through the following technical solution:
[0005] A three-stage signal delay compensation control method for ATP turntable tracking, comprising the following steps:
[0006] S1. Input the image miss signal with delay to the position lead feedback predictor (PAFP) for the first delay compensation to obtain the original miss signal without delay;
[0007] S2. Input the original, delay-free miss signal into a first-order low-pass filter to remove high-frequency noise and obtain the filtered signal;
[0008] S3. The filtered signal is input again to the position lead feedback predictor (PAFP) for a second delay compensation to eliminate the phase lag caused by the first-order low-pass filter and obtain the final compensation signal.
[0009] S4. Output the final compensation signal to the servo control system.
[0010] Furthermore, in step S1, the position advance feedback predictor performs position compensation by using the difference between the current miss amount and the previous miss amount at the interval delay time through image delay compensation.
[0011] Furthermore, by currently obtaining off-target amounts With interval delay time The last time the off-target value was obtained The difference Position compensation is insufficient due to the limitations of simple position difference compensation and the lack of adjustment capability. Therefore, a closed-loop controller is introduced for adjustment control, with a set delay time. The position compensation difference is then:
[0012] ;
[0013] Right now:
[0014] ;
[0015] in, and For delay The delay process, For input values.
[0016] Furthermore, the output value after position compensation is The formula for its calculation is:
[0017] .
[0018] Furthermore, the transfer function in the position compensation process is:
[0019] ;
[0020] If the delay is fully compensated, then ,but:
[0021] .
[0022] Then closed-loop controller for:
[0023] .
[0024] Furthermore, in the position advance feedback predictor, by adjusting the delay time... Adaptation is required.
[0025] Furthermore, the cutoff frequency of the first-order low-pass filter is selected according to the high-frequency noise type of the image miss signal.
[0026] Furthermore, the step of determining the cutoff frequency of the first-order low-pass filter includes:
[0027] Spectral analysis was performed on the image miss signal to identify the main frequency range of high-frequency noise;
[0028] The cutoff frequency is set to the lowest frequency below the high-frequency noise.
[0029] A three-tiered signal delay compensation control system for ATP turntable tracking is provided, comprising:
[0030] The Position Advance Feedback Predictor (PAFP) module executes steps S1 and S3 as described in claim 1.
[0031] The low-pass filter module performs step S2 as described in claim 1;
[0032] The output module executes step S4 as described in claim 1.
[0033] The beneficial effects of this invention are:
[0034] (1) It can achieve more accurate tracking of targets such as drones; and it can achieve good compensation filtering performance under given signal source and noise and delay conditions.
[0035] (2) By using two PAFP compensations and one low-pass filter, the delay and noise problems were effectively solved, and the servo control accuracy was improved. Attached Figure Description
[0036] Figure 1 The flowchart shows the steps of the three-cascaded signal delay compensation control method.
[0037] Figure 2 This is a block diagram of the Position Advance Feedback Predictor (PAFP) control system.
[0038] Figure 3 This is a flowchart of the three-tiered signal delay compensation control system.
[0039] Figure 4 This is a diagram of the processing structure in this embodiment. Detailed Implementation
[0040] The technical solution of the present invention will be clearly and completely described below with reference to the embodiments. Obviously, the described embodiments are only some embodiments of the present invention, and not all embodiments. Based on the embodiments of the present invention, all other embodiments obtained by those skilled in the art without creative effort are within the scope of protection of the present invention.
[0041] This embodiment designs a Position Advance Feedback Predictor (PAFP) connected in series with a first-order low-pass filter to form a three-tiered control configuration. The miss signal with a delay component first passes through the first PAFP to compensate for the image delay, resulting in the original miss signal without delay. This signal is then fed into the first-order low-pass filter to filter out high-frequency noise. However, the first-order low-pass filter introduces a phase lag in the signal again, so the signal processed by the first-order low-pass filter is fed back into the PAFP for correction and compensation. Finally, a delay-free and noise-free signal is output to the servo control system. The system processing flow is as follows: Figure 1 As shown.
[0042] Based on this, a three-stage signal delay compensation control method for ATP turntable tracking is provided, the steps of which include:
[0043] S1. Input the image miss signal with delay to the position lead feedback predictor (PAFP) for the first delay compensation to obtain the original miss signal without delay;
[0044] S2. Input the original, delay-free miss signal into a first-order low-pass filter to remove high-frequency noise and obtain the filtered signal;
[0045] S3. The filtered signal is input again to the position lead feedback predictor (PAFP) for a second delay compensation to eliminate the phase lag caused by the first-order low-pass filter and obtain the final compensation signal.
[0046] S4. Output the final compensation signal to the servo control system.
[0047] See Figure 2 Position Advance Feedback Predictor (PAFP) Design: Utilizing the currently acquired miss distance With interval delay time The last time the off-target value was obtained The difference Position compensation is performed, but simple position difference compensation is not only insufficient in compensation capability, but also lacks adjustment capability. Therefore, a closed-loop controller is introduced for adjustment control, and a delay time is assumed. Given the information, the controller block diagram design is as follows: Figure 2 As shown.
[0048] in, Indicates a delay of The delay process, This is a delay time.
[0049] Therefore, the position compensation difference for:
[0050] ;
[0051] Right now:
[0052] ;
[0053] Output for:
[0054] ;
[0055] The system transfer function can be obtained by using the above equation:
[0056] ;
[0057] If system latency is completely compensated, then ,Right now:
[0058] ;
[0059] Finally, the closed-loop controller is obtained. for:
[0060] .
[0061] Delay time It is known, but in practical engineering applications, a delay time is assumed. It is difficult to know precisely, therefore adjustment parameters are used in the controller. To adapt to different engineering applications. The final PAFP control block diagram is as follows: Figure 2 As shown.
[0062] Compensation adjustment parameters The relationship between PAFP compensation capability and PAFP compensation capability is shown in Table 1.
[0063] Table 1 Compensation Adjustment Parameters Relationship with PAFP compensation capacity table
[0064]
[0065] Three-tiered signal delay compensation control design: In practical engineering applications, the image miss distance carries a certain amount of high-frequency noise, which needs to be filtered out. However, the filter itself introduces phase lag. If the miss distance is filtered first and then delay compensation is performed, the delay will be even greater if the system latency is already large, potentially significantly impacting the delay compensation at maneuvering points. Therefore, to avoid this, a three-tiered signal delay compensation control strategy is adopted: first, delay compensation is performed on the original miss distance; then, filtering is applied; and finally, delay compensation is performed on the filtered signal. This eliminates the phase lag effect of the filter, forming the system control block diagram shown below. Figure 3 As shown.
[0066] In the experiment, the signal source was given as y=sint, random noise with an amplitude of 0.01 was introduced, and a 30ms delay was given. The experimental results are as follows. Figure 4 As shown.
[0067] Depend on Figure 4 As can be seen, this strategy is not only simple to implement, but also does not depend on the system model. It has good compensation and filtering performance for delayed signals with high-frequency noise, which verifies the feasibility of this control strategy.
[0068] Example 2
[0069] Signal delay compensation in UAV electro-optical tracking systems is crucial. In these systems, image sensors acquire target miss distance signals in real time, but image transmission and processing delays (e.g., 30ms) cause lag in the servo control system response. Simultaneously, high-frequency interference (e.g., random noise above 100Hz) in the image noise affects tracking accuracy. A three-tiered control strategy is employed to achieve delay compensation and noise filtering.
[0070] System Configuration: 1. Sensor Module: CCD camera acquires target images in real time and outputs the miss distance signal (x(t)). 2. PAFP Module: Contains two identical position lead feedback predictors (PAFP1 and PAFP2). 3. Low-Pass Filter Module: First-order RC low-pass filter with a cutoff frequency set to 80Hz. 4. Servo Control System: Turntable drive unit, receiving the compensated signal (u(t)).
[0071] Parameter settings: Delay time: Initial setting is 30ms ( =0.03s); PAFP adjustment parameters: through experimental tuning, k=1.2 was selected to achieve full compensation (refer to Table 1); low-pass filter cutoff frequency: through spectrum analysis, it was determined that the high-frequency noise is mainly distributed in 100Hz~200Hz, so the cutoff frequency was set to 80Hz.
[0072] Implementation Step 1. First Delay Compensation (S1) Input: Miss signal x with a 30ms delay PAFP1 calculation: Current miss distance: x(t) Previous miss distance: x(t) Compensation difference: Δx = x(t)x( Output: No-delay signal x1(t) = x(t) + k·Δx2. High-frequency noise filtering (S2) Input: x1(t) First-order low-pass filter processing: Transfer function: G_f(s) = 1 / ( _fs+1), where _f=1 / (2πf_c)=1 / (2π×80)≈1.99ms Output: Filtered signal x2(t) 3. Second delay compensation (S3) Input: x2(t) (Phase lag caused by filtering) PAFP2 repeats the compensation logic of PAFP1 to eliminate the delay introduced by the filter. Output: Final compensation signal u(t); Servo control (S4) u(t) drives the turntable to track the target in real time.
[0073] Verification Process: Test Conditions: Signal Source: y = sin(2π × 10t) (10Hz sine wave); Superimposed Noise: Random noise with an amplitude of 0.01 (simulating high-frequency interference); Delay Time: 30ms. Result Analysis: Comparison of Input Signal and Delayed Signal: The delayed signal lags behind by approximately 90° (corresponding to a 30ms delay). The compensated signal u(t) almost coincides with the original input signal y(t), with a phase difference of less than 5°, verifying the delay compensation effect. The noise amplitude drops from 0.01 to below 0.002, indicating effective filtering.
[0074] Practical application advantages: High adaptability: By adjusting the PAFP parameters, it can be adapted to different delay times (such as 20ms~50ms); High robustness: No precise system model is required, making it suitable for UAV tracking in complex environments; Good real-time performance: The three-tiered structure has low computational cost, meeting the high bandwidth requirements of servo systems.
[0075] The example demonstrates the specific application of the three-tiered control strategy in an UAV photoelectric tracking system. Through two PAFP compensations and one low-pass filter, the delay and noise problems are effectively solved, and the servo control accuracy is improved.
[0076] The above description is merely a preferred embodiment of the present invention. It should be understood that the present invention is not limited to the forms disclosed herein and should not be construed as excluding other embodiments. It can be used in various other combinations, modifications, and environments, and can be altered within the scope of the concept described herein through the above teachings or related technologies or knowledge. Modifications and variations made by those skilled in the art that do not depart from the spirit and scope of the present invention should be within the protection scope of the appended claims.
Claims
1. A three-tiered signal delay compensation control method for ATP turntable tracking, characterized in that the steps include: include: S1. Input the unfiltered image miss signal with image acquisition and transmission delay to the position advance feedback predictor for the first delay compensation, eliminate the original time delay caused by image acquisition and transmission, and obtain the original miss signal without delay. In step S1, the position advance feedback predictor performs position compensation by using the difference between the current miss amount and the previous miss amount with the interval delay time through image delay compensation. S2. Input the original off-target signal without delay to a first-order low-pass filter to filter out high-frequency noise and obtain a filtered signal. The first-order low-pass filter will introduce a new phase lag into the signal while filtering out high-frequency noise. S3. The filtered signal is input again to the position lead feedback predictor for a second delay compensation to eliminate the new phase lag introduced by the first-order low-pass filter processing and obtain the final compensation signal. S4. Output the final compensation signal to the servo control system.
2. The three-tiered signal delay compensation control method for ATP turntable tracking according to claim 1, characterized in that, Obtain the current miss distance and interval delay time. The difference between the previous off-target value and the previous off-target value. Position compensation is performed, and adjustment and control are carried out through a closed-loop controller, with a set delay time. The position compensation difference is: ; in, and For delay The delay process, For input values, It is a closed-loop controller.
3. The three-tiered signal delay compensation control method for ATP turntable tracking according to claim 2, characterized in that, The output value after position compensation is The formula for its calculation is: 。 4. The three-tiered signal delay compensation control method for ATP turntable tracking according to claim 3, characterized in that, The transfer function during the position compensation process is: ; If the delay is fully compensated, then ,but: 。 5. The three-tiered signal delay compensation control method for ATP turntable tracking according to claim 3, characterized in that, In the position advance feedback predictor, by adjusting the delay time Adaptation is required.
6. The three-tiered signal delay compensation control method for ATP turntable tracking according to claim 1, characterized in that, The cutoff frequency of the first-order low-pass filter is selected based on the high-frequency noise type of the image miss signal.
7. The three-tiered signal delay compensation control method for ATP turntable tracking according to claim 1, characterized in that, The steps for determining the cutoff frequency of the first-order low-pass filter include: Spectral analysis was performed on the image miss signal to identify the main frequency range of high-frequency noise; The cutoff frequency is set to the lowest frequency below the high-frequency noise.
8. A three-tiered signal delay compensation control system for ATP turntable tracking, characterized in that, The system includes: The position advance feedback predictor module is used to receive the image miss signal with unfiltered wave processing and image acquisition and transmission delay, and to perform the first delay compensation in S1 and the second delay compensation in S3 as described in claim 1. The second delay compensation eliminates the new phase hysteresis introduced by the first-order low-pass filter. The low-pass filter module performs step S2 as described in claim 1; The output module executes step S4 as described in claim 1.
Citation Information
Patent Citations
Photoelectric tracking delay compensation system and method based on self-adaptive trap filter
CN105373146A
Tracking target-missing quality time-delay compensation control method of photoelectric equipment
CN106444386A
Photoelectric tracking system control method based on improved Smith estimator
CN109164709A
