Position signal delay compensation method and device and computer readable storage medium

The construction of the position signal delay compensator through Kalman filtering technology solves the problem of position signal delay in the automatic control system, improves the real-time and performance of the system, and meets the needs of high precision and low cost.

CN118938654APending Publication Date: 2024-11-12SOUTH CHINA UNIV OF TECH
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202410983166.3
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-22
Publication Date
2024-11-12

AI Technical Summary

Technical Problem

In automatic control systems, the time delay problems caused by the sensor physical characteristics and signal processing delay affect the real-time performance and performance of the system. Existing solutions are difficult to meet the dual needs of high precision and low cost.

Method used

Using the position signal delay compensation method based on Kalman filtering, by obtaining the noise variance and delay of the position signal, a delay compensator is constructed, the process noise covariance matrix is ​​adjusted, and the data fusion and signal delay compensation are used for data fusion and signal delay compensation are calculated. .

Benefits of technology

It significantly improves the real-time and performance of the control system, simplifies system design, reduces costs, and is suitable for a variety of automation and positioning systems.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118938654A_ABST
    Figure CN118938654A_ABST
Patent Text Reader

Abstract

The invention relates to a position signal delay compensation method and device and a computer readable storage medium, and the position signal delay compensation method is used for solving the time delay problem of position data in a control system in the collection and processing process, thereby improving the real-time performance and control performance of the control system. The method is realized through the following steps: obtaining a position signal noise variance; acquiring a position signal delay value and converting the position signal delay value into a beat number corresponding to time delay; constructing a position signal delay compensator; adjusting a diagonal value of a process noise covariance matrix in the position signal delay compensator to enable the effect of the compensator to conform to expectation; a compensation value for the position signal is calculated using a position signal delay compensator.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the technical field of signal processing and automatic control, and in particular to a method, device and computer-readable storage medium for compensating position signal delay. Background Art

[0002] In modern industrial and technological applications, accurate position measurement is the basis for the normal operation of many systems and equipment. For example, in self-driving cars, drone navigation, robot control and industrial automation equipment, real-time position signals are essential for efficient and safe operation. However, in actual engineering, due to the physical characteristics of sensors, signal processing delays, and time-consuming execution of control algorithms, position signals are affected by time delays, resulting in insufficient response of feedback control systems, thus affecting the performance and safety of the entire system.

[0003] Currently, common methods for reducing position signal delays include using high-performance hardware devices to improve sensor response speed and processing power, or using complex algorithms to predict and compensate for these delays. However, these methods usually increase costs or have strict computational requirements and may not be suitable for all types of applications. In addition, as technology develops and application requirements increase, existing solutions often find it difficult to meet the dual demands for higher accuracy and lower costs.

[0004] Therefore, developing a new method for position signal delay compensation can not only effectively solve the real-time problem of position signals, but also simplify system design and reduce costs, which is of great significance to improving the performance of various automation and positioning systems. Summary of the invention

[0005] The present invention provides a position signal delay compensation method, device and computer-readable storage medium based on Kalman filtering, aiming to solve the time delay problem existing in the acquisition and processing of position data in a control system, thereby significantly improving the real-time and control performance of the control system.

[0006] The present application provides a position signal delay compensation method based on Kalman filtering, which is used to compensate for the lag in the acquisition and processing of position data in a control system. The method comprises:

[0007] Obtaining the position signal noise variance of the controlled object;

[0008] Obtain the position signal delay and convert it into the corresponding beat number of the delay;

[0009] Constructing a position signal delay compensator based on the position signal noise variance and the number of beats corresponding to the time delay;

[0010] Adjusting the diagonal value of the process noise covariance matrix in the position signal delay compensator so that the compensator effect meets expectations;

[0011] Obtain an estimated position based on the position signal and a delay compensator calculation;

[0012] In certain implementations of the position signal delay compensation method, the position signal delay compensation method needs to obtain relevant parameters of the position signal of the controlled object, including position signal noise variance and position signal delay.

[0013] In some implementations of the position signal delay compensation method, the first set of equations is:

[0014] S∈{S1,S2,...,S n}

[0015]

[0016]

[0017] Where S is the position signal of the control system under static conditions, is the mean value of the n-beat position signal, σ 2 is the position signal variance. 2 Used to build a position signal delay compensator.

[0018] In some implementations of the position signal delay compensation method, the second set of equations is:

[0019] K d =t d / t s

[0020] V(K)=S(K)-S(K-1)

[0021] A(K)=S(K)-2*S(K-1)+S(K-2)

[0022]

[0023] where t d is the position signal delay, t d The sources of include but are not limited to: sensor processing time; signal communication delay; signal processing and control algorithm execution time in the control system. s K is the sampling time of the control system. d Where S(K) is the position signal of the current beat of the control system, V(K) is the velocity signal obtained by the first-order difference of the position signal, and A(K) is the acceleration signal obtained by the second-order difference of the position signal. is the compensated position signal.

[0024] In some implementations of the position signal delay compensation method, the third set of equations is:

[0025]

[0026]

[0027]

[0028]

[0029]

[0030]

[0031]

[0032] in C=[K d 0.5K d 2 ],

[0033] Where Z(K) is the Kalman filter measurement matrix, is the prior estimated state, is the Kalman filter observation vector, i.e. the velocity observation value With the acceleration observation A is the state transfer matrix, H is the output matrix, R is the measurement noise covariance matrix, Q is the process noise covariance matrix, is the prior error covariance matrix, P(K) is the error covariance matrix, KF(K) is the Kalman filter gain matrix, and C is the position compensation matrix.

[0034] The position signal delay compensator first obtains the velocity signal and the acceleration signal by differentiating the position signal, then establishes a Kalman filter according to the variance of the position signal, uses the Kalman filter to perform data fusion to eliminate the velocity and acceleration signal noise, and finally performs signal delay compensation calculation according to the Taylor expansion to obtain the estimated position.

[0035] The position signal delay compensation method provided by the present invention solves the time delay problem commonly existing in position data in the control system, thereby improving the real-time performance and control performance of the control system.

[0036] An embodiment of the present invention also provides a position signal delay compensation device, including a storage unit and a processing unit, wherein the storage unit stores a computer program that can be executed by the processing unit, and when the processing unit executes the computer program, the steps of the position signal delay compensation method as described above are implemented.

[0037] An embodiment of the present invention further provides a computer-readable storage medium, on which a computer program is stored. When the computer program is executed by a processor, the steps of the position signal delay compensation method described above are implemented. BRIEF DESCRIPTION OF THE DRAWINGS

[0038] In order to more clearly illustrate the technical solutions in the embodiments of the present application, the drawings required for use in the embodiments will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative labor.

[0039] Figure 1 It is a flow chart of a position signal delay compensation method provided by an embodiment of the present invention.

[0040] Figure 2 It is a schematic diagram of the principle of the position signal delay compensation method of the present invention.

[0041] Figure 3 It is a schematic diagram of a position signal delay compensation device provided in an embodiment of the present invention.

[0042] Figure 4 This is a diagram of position feedback value changes when the system provided by an embodiment of the present invention is stationary.

[0043] Figure 5 It is a diagram of the adjustment filtering effect of the position signal delay compensation method provided by an embodiment of the present invention.

[0044] Figure 6 It is a test result diagram of the position signal delay compensation method provided by an embodiment of the present invention. DETAILED DESCRIPTION

[0045] In order to make the purpose, technical solution and advantages of the present invention more clearly understood, the present invention is further described in detail below in conjunction with the accompanying drawings and embodiments. The specific embodiments described herein are only used to explain the present invention and are not used to limit the present invention.

[0046] The main solution of the embodiment of the present invention is: Figure 1 , Figure 2 As shown, a position signal delay compensation method, the position signal delay compensation method comprising:

[0047] Obtaining the position signal noise variance of the controlled object;

[0048] Obtain the position signal delay and convert it into the corresponding beat number of the delay;

[0049] Constructing a position signal delay compensator based on the position signal noise variance and the number of beats corresponding to the time delay;

[0050] Adjusting the diagonal value of the process noise covariance matrix in the delay compensator so that the position delay compensation effect meets expectations;

[0051] Obtain an estimated position based on the position signal and a delay compensator calculation;

[0052] In servo control systems, due to the physical characteristics of position sensors, signal processing delays, and the time-consuming calculation and execution of real-time control systems, position signals are affected by time delays, resulting in untimely responses from feedback control systems, thus affecting the performance and safety of the entire system.

[0053] The present invention provides a position signal delay compensation method for compensating for the lag in the acquisition and processing of position data in a control system, thereby improving the real-time performance and control performance of the system.

[0054] Step S1: Obtain the position signal noise variance of the controlled object, obtain the position signal delay and convert it into the number of beats corresponding to the delay. In this embodiment, the position signal delay is obtained by adding the encoder processing time, signal communication delay and the execution time of the signal processing and control algorithm in the control system.

[0055] Step S1 includes:

[0056] The position signal of the control system under static conditions is collected, and the position signal noise variance of the controlled object is calculated, wherein the first set of equations can be configured as:

[0057] S∈{S1,S2,...,S n}

[0058]

[0059]

[0060] Where S is the position signal of the control system under static conditions, is the mean value of the n-beat position signal, σ 2 is the position signal variance. 2 Used to build a position signal delay compensator.

[0061] Obtain the position signal delay and convert it into the corresponding beat number of the delay, where the second set of equations can be configured as:

[0062] K d =t d / t s

[0063] where td is the position signal delay. s K is the sampling time of the control system. d is the number of beats corresponding to the delay. In this real-time example, t d =126us and t s =62.5us. Calculate K d ≈2.

[0064] Step S2: constructing a position signal delay compensator based on the position signal noise variance and the number of beats corresponding to the delay, Figure 4 is the position feedback value of the servo control system used in this embodiment when it is stationary. Based on this set of data, the position noise variance can be calculated, and the calculation result is σ 2 =1.688, such as Figure 5 As shown, the diagonal value of the process noise covariance matrix in the delay compensator is adjusted so that the position delay compensation effect meets expectations. In this embodiment, the diagonal value Q=0.01.

[0065] Step S2 includes: constructing a position signal delay compensator, wherein the third program group can be configured as:

[0066] V(K)=S(K)-S(K-1)

[0067] A(K)=S(K)-2*S(K-1)+S(K-2)

[0068]

[0069]

[0070]

[0071]

[0072]

[0073]

[0074] in

[0075] Where S(K) is the current position signal of the control system, V(K) is the velocity signal obtained by the first-order difference of the position signal, and A(K) is the acceleration signal obtained by the second-order difference of the position signal. Z(K) is the Kalman filter measurement signal, i.e., velocity and acceleration. is the prior estimated state, is the Kalman filter observation vector, i.e. the velocity observation value With acceleration observation A is the state transfer matrix, H is the output matrix, R is the measurement noise covariance matrix, Q is the process noise covariance matrix, is the prior error covariance matrix, P(K) is the error covariance matrix, and KF(K) is the Kalman filter gain matrix.

[0076] The diagonal value of the process noise covariance matrix in the delay compensator is adjusted to make the position delay compensation effect meet expectations. The smaller the diagonal value, the stronger the filtering effect, the smaller the observed speed and acceleration noise, but there is overshoot, and the larger the compensation error corresponding to the acceleration mutation period, such as Figure 5 As shown, in this embodiment, when the diagonal value is set to 0.01, the effect meets expectations.

[0077] Step S3: Calculate an estimated position based on the position signal and the delay compensator.

[0078] Step S3 includes: calculating an estimated position according to the position signal and a delay compensator, wherein the fourth set of equations can be configured as:

[0079]

[0080] C=[K d 0.5K d 2]

[0081] Where S(K) is the current position signal of the control system, is the position signal after compensation, is the velocity and acceleration observed by the Kalman filter, and C is the position compensation matrix. After the position signal delay compensation of the present invention, Figure 6 As shown, the compensated position is closer to the real position than the original feedback, indicating that the position signal delay compensation method of the present invention has a reliable compensation effect.

[0082] The embodiment of the present invention also provides a parameter self-adjusting device, such as Figure 3 As shown, the parameter self-adjusting device 200 includes a storage unit 210 and a processing unit 220. The storage unit 210 stores a computer program that can be executed by the processing unit 220, and the processing unit 220 implements the steps of the above-mentioned position signal delay compensation method when executing the computer program. The embodiment of the present invention also provides a computer-readable storage medium, on which a computer program is stored. When the computer program is executed by a processor, the steps of the above-mentioned position signal delay compensation method are implemented.

[0083] The above are only preferred embodiments of the present invention, and are not intended to limit the patent scope of the present invention. Any equivalent structure or equivalent process transformation made using the contents of the present invention specification and drawings, or directly or indirectly applied in other related technical fields, are also included in the patent protection scope of the present invention.

Claims

1. A method for compensating for position signal delay, used to compensate for the lag in the acquisition and processing of position data in a control system, characterized in that: The method comprises the following steps: Obtain the position signal noise variance of the controlled object; Obtaining the position signal delay and converting it into the number of beats corresponding to the delay; Constructing a position signal delay compensator based on the position signal noise variance and the number of beats corresponding to the time delay; Adjusting the diagonal value of the process noise covariance matrix in the position signal delay compensator so that the compensator effect meets expectations; The compensated estimated position is obtained according to the position signal and the delay compensator calculation.

2. The position signal delay compensation method according to claim 1, characterized in that: In obtaining the position signal noise variance, the source of the position signal includes but is not limited to: an incremental encoder, an absolute encoder, a sensorless position estimation algorithm, and laser ranging.

3. The position signal delay compensation method according to claim 2, characterized in that: The position signal noise variance calculation equation group is: S∈{S1,S2,…,S n } Where S is the position signal collected by the control system under static conditions, is the mean value of the n-beat position signal, σ 2 is the position signal noise variance, σ 2 Used to build a position signal delay compensator.

4. The method for compensating for position signal delay according to claim 3, characterized in that: Obtain the position signal delay and convert it into the corresponding beat number of the delay. According to the corresponding beat number of the delay and Taylor expansion, establish the position signal compensation equation group: K d =t d / t s V(K)=S(K)-S(K-1) A(K)=S(K)-2*S(K-1)+S(K-2) where t d is the position signal delay, t d By accumulating various delays in the control system, t d It is obtained by adding the sensor processing time, signal communication delay, and the execution time of the signal processing and control algorithm in the control system, t s is the control system sampling time, K d is the number of beats corresponding to the time delay, S(K) is the position signal of the current beat of the control system, V(K) is the velocity signal obtained by the first-order difference of the position signal, A(K) is the acceleration signal obtained by the second-order difference of the position signal, is the compensated position signal.

5. The method for compensating for position signal delay according to claim 4, characterized in that: Get the position signal variance σ 2 The number of beats K corresponding to the delay d After that, a position signal delay compensator is constructed, wherein the input of the position signal delay compensator is the position signal S(K), and the output is the compensated position signal 6. The position signal delay compensation method according to claim 5, characterized in that: The position signal delay compensator equation group is: in C=[K d 0.5K d 2 ], Where Z(K) is the Kalman filter measurement signal array, is the prior estimated state, is the Kalman filter observation vector, i.e. the velocity observation value With acceleration observation A is the state transfer matrix, H is the output matrix, R is the measurement noise covariance matrix, Q is the process noise covariance matrix, is the prior error covariance matrix, P(K) is the error covariance matrix, KF(K) is the Kalman filter gain matrix, and C is the position compensation matrix; The position signal delay compensator first obtains the velocity signal and the acceleration signal by differentiating the position signal, then establishes a Kalman filter according to the variance of the position signal, uses the Kalman filter to perform data fusion to eliminate the velocity and acceleration signal noise, and finally performs signal delay compensation calculation according to the Taylor expansion to obtain the estimated position.

7. The method for compensating for position signal delay according to claim 6, characterized in that: The diagonal value of the process noise covariance matrix is ​​not fixed. The smaller the diagonal value, the stronger the filtering effect. The observed speed and acceleration noise are smaller but there is overshoot. The compensation error corresponding to the acceleration mutation period is larger. The diagonal value of the process noise covariance matrix is ​​adjusted according to demand.

8. The method for compensating for position signal delay according to claim 6, characterized in that: The process variables calculated by the position signal delay compensation method include observed speed values ​​and observed acceleration values. The process variables can also be used to control speed and acceleration state feedback values ​​in the control system.

9. A parameter self-adjusting device, characterized in that: It comprises a storage unit and a processing unit, wherein the storage unit stores a computer program executable by the processing unit, and when the processing unit executes the computer program, the steps of the position signal delay compensation method as described in any one of claims 1 to 8 are implemented.

10. A computer-readable storage medium, characterized in that: The storage medium stores a computer program, and when the computer program is executed by the processor, the steps of the position signal delay compensation method according to any one of claims 1 to 8 are implemented.