Servo system control method based on Kalman filtering

By using Kalman filters to filter and differentiate the instruction signal in the servo system, the new instruction signal is calculated to overcome the feedback controller delay, and the problem of insufficient tracking performance of the servo system is solved, achieving more efficient instruction tracking and smoothness .

CN118938749AActive Publication Date: 2024-11-12XIAN MODERN CONTROL TECH RES INST
View PDF 8 Cites 0 Cited by

Patent Information

Application Number
CN202411102463.9
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-12
Publication Date
2024-11-12
Estimated Expiration
2044-08-12

AI Technical Summary

Technical Problem

The existing servo system control methods have contradictions between tracking speed and overshooting, and cannot effectively overcome the inherent delay problem of feedback controllers, resulting in insufficient instruction tracking performance.

Method used

Using Kalman filtering method, by obtaining the command signal and feedback signal, using the Kalman filter to filter the command signal and differentially calculate the new command signal, and calculate the control amount with tracking error, overcoming the delay characteristics of the feedback controller .

Benefits of technology

It achieves better instruction tracking performance and smoothness, reduces high-frequency shock and oscillation in the instruction signal, and improves the system's tracking accuracy.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118938749A_ABST
    Figure CN118938749A_ABST
Patent Text Reader

Abstract

The invention discloses a servo system control method based on Kalman filtering. The method comprises the following steps: 1, acquiring an instruction signal at the current moment; 2, acquiring a feedback signal at the current moment; 3, acquiring two paths of output signals of the Kalman filter at the last moment; 4, filtering the instruction signal by using a Kalman filter to obtain the filtered instruction signal and the differential of the instruction signal; 5, calculating a new instruction signal by using the filtered instruction signal and the differential of the instruction signal; 6, calculating a tracking error by using the new command signal and the feedback signal; and 7, calculating the output of the controller by using the tracking error. The method overcomes the inherent delay of the feedback controller, and has better instruction tracking performance.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention belongs to the field of control technology, and in particular relates to a servo system control method based on Kalman filtering. Background Art

[0002] The servo system control method is the core of the servo system to achieve high-performance tracking of instructions. The existing servo system control method generally improves the tracking performance of the servo system from the idea of ​​improving the feedback controller. However, due to the inherent delay characteristics of the feedback controller, the contradiction between the tracking speed and the overshoot cannot be avoided in the existing method. Summary of the invention

[0003] In order to overcome the shortcomings of the prior art, the present invention provides a servo system control method based on Kalman filtering, comprising the following steps: 1. obtaining the command signal at the current moment; 2. obtaining the feedback signal at the current moment; 3. obtaining the two output signals of the Kalman filter at the previous moment; 4. filtering the command signal using the Kalman filter to obtain the filtered command signal and the differential of the command signal; 5. calculating a new command signal using the filtered command signal and the differential of the command signal; 6. calculating the tracking error using the new command signal and the feedback signal; 7. calculating the output of the controller using the tracking error. The present invention overcomes the inherent delay of the feedback controller itself and has better command tracking performance.

[0004] The technical solution adopted by the present invention to solve the technical problem is as follows:

[0005] Step 1: Get the current time t = kT s The command signal s(k) at the time, where T s is the duration of the control cycle, k is the sequence number of the time, the value range is k=1,2,3…, s(k) is t=kT s command signals at all times;

[0006] Step 2: Get the current time t = kT s The feedback signal f(k) at time ;

[0007] Step 3: Obtain the two output signals of the Kalman filter at the previous moment, which are the filtered command signals x1(k-1) and v1(k-1);

[0008] When k=1, there is no signal at the previous moment, so let x1(k-1)=0, v1(k-1)=0;

[0009] Get the update matrix P(k-1) of the previous moment. When k=1, there is no update matrix of the previous moment. At this time, let:

[0010]

[0011] Step 4: Use a Kalman filter to filter the acquired command signal s(k), and output the filtered command signal x1(k) and the differential v1(k) of the command signal;

[0012] Step 5: Calculate the new command signal s using the filtered command signal x1(k) and the differential of the command signal v1(k) ′ (k);

[0013] Step 6: Utilize s ′ (k) and the feedback signal f(k) to calculate the tracking error e(k);

[0014] Step 7: Using e(k) as input, use the controller to calculate the control variable u(k).

[0015] Furthermore, the Kalman filter comprises the following steps:

[0016] Step 4-1: Calculate the auxiliary matrix Q according to the following formula:

[0017] Q=FP(k-1)F T

[0018] in, F T is the transpose of the matrix F;

[0019] Step 4-2: Calculate the auxiliary variable y according to the following formula:

[0020]

[0021] Where H = [1 0];

[0022] Step 4-3: Calculate the auxiliary matrix K according to the following formula:

[0023] K=QH T (HQH T +1) -1

[0024] Among them, (HQH T +1) -1 for (HQH T +1) inverse;

[0025] Step 4-4: Calculate the output x1(k) and v1(k) of the Kalman filter according to the following formula:

[0026]

[0027] Furthermore, the new command signal s ′ k (k) is calculated according to the following formula:

[0028] s ′ (k) = x1(k) + k s v1(k).

[0029] Furthermore, the tracking error e(k) is calculated as follows:

[0030] e(k)=s ′ (k)-f(k).

[0031] The beneficial effects of the present invention are as follows:

[0032] (1) Different from the existing methods of improving the feedback controller, the method provided by the present invention constructs a new command signal based on Kalman filtering, overcomes the inherent delay of the feedback controller itself, and has better command tracking performance.

[0033] (2) The differential of the command signal is estimated using Kalman filtering, which has better smoothness. BRIEF DESCRIPTION OF THE DRAWINGS

[0034] Figure 1 It is a block diagram of a servo system control method based on Kalman filtering of the present invention;

[0035] Figure 2 It is a flow chart of the servo system control method based on Kalman filtering of the present invention. DETAILED DESCRIPTION

[0036] The present invention is further described below in conjunction with the accompanying drawings and embodiments.

[0037] The present invention provides a servo system control method based on Kalman filtering, comprising the following steps:

[0038] S1. Get the current time t=kT s The command signal s(k) at time T s is the duration of the control cycle, k is the sequence number of the time, the value range is k=1,2,3…, s(k) is t=kT s command signals at all times;

[0039] S2. Get the current time t=kT s The feedback signal f(k) at time ;

[0040] S3. Obtain the two output signals of the Kalman filter at the previous moment, which are the filtered command signals x1(k-1) and v1(k-1). When k=1, there is no signal at the previous moment, so x1(k-1)=0, v1(k-1)=0. Obtain the update matrix P(k-1) at the previous moment. When k=1, there is no update matrix at the previous moment, so:

[0041]

[0042] S4, use the Kalman filter to perform s(k) filtering on the acquired command signal, and output the filtered command signal x1(k) and the differential v1(k) of the command signal;

[0043] S5. Calculate the new command signal s using the filtered command signal x1(k) and the differential of the command signal v1(k) ′ (k);

[0044] S6. Utilize s ′ (k) and the feedback signal f(k) to calculate the tracking error e(k);

[0045] S7. Take e(k) as input and use the controller to calculate the control quantity u(k).

[0046] Furthermore, the Kalman filter in step S4 has the following steps:

[0047] First, calculate the auxiliary matrix Q according to the following formula:

[0048] Q=FP(k-1)F T

[0049] in, F T is the transpose of the matrix F.

[0050] Then the auxiliary variable y is calculated as follows:

[0051]

[0052] Where H = [1 0];

[0053] Then the auxiliary matrix K is calculated as follows:

[0054] K=QH T (HQH T +1) -1

[0055] Among them, (HQH T +1) -1 for (HQH T +1) is the inverse of.

[0056] Then the output x1(k) and v1(k) of the Kalman filter are calculated as follows:

[0057]

[0058] Furthermore, in step S5, the new command signal s ′k (k) is calculated according to the following formula:

[0059] s ′ (k) = x1(k) + k s v1(k);

[0060] Furthermore, the tracking error e(k) in step S6 is calculated according to the following formula:

[0061] e(k)=s ′ (k)-f(k);

[0062] Example:

[0063] The block diagram of a servo system control method based on Kalman filtering provided by the present invention is as follows: Figure 1 As shown. As can be seen from the figure, the servo system method based on the Kalman filter provided by the present invention uses the Kalman filter to process the original command signal. The Kalman filter realizes two functions. One is to smooth the command signal, reduce the impact of the high-frequency components in the command signal on the system, and reduce the oscillation that may be generated during the command tracking process. The second is to estimate the differential of the command signal. Then the two outputs of the Kalman filter are algebraically combined, that is, the differential signal is multiplied by a gain and then added to the filtered command signal to form a new command signal. The new command signal is subtracted from the collected feedback signal to obtain a tracking error signal. The controller uses the error signal to calculate the control quantity, and finally drives the servo system to track the command signal.

[0064] The process of the servo system control method based on Kalman filtering provided by the present invention is as follows: Figure 2 As shown, the specific steps are as follows:

[0065] First, get the current time t = kT s The command signal s(k) at time t is the current time, T s is the duration of the control cycle, k is the sequence number of the time, the value range is k=1,2,3…, s(k) is t=kT s command signals at all times;

[0066] Further, obtain the current time t = kT s The feedback signal f(k) at time ;

[0067] Further, the two output signals of the Kalman filter at the previous moment are obtained, which are the filtered command signals x1(k-1) and v1(k-1). When k=1, there is no signal at the previous moment, so x1(k-1)=0, v1(k-1)=0. Obtain the update matrix P(k-1) at the previous moment. When k=1, there is no update matrix at the previous moment, so

[0068]

[0069] Further, the Kalman filter is calculated as follows:

[0070] First, calculate the auxiliary matrix Q according to the following formula:

[0071] Q=FP(k-1)F T

[0072] in, F T is the transpose of the matrix F;

[0073] Then the auxiliary variable y is calculated as follows:

[0074]

[0075] Where H = [1 0];

[0076] Then the auxiliary matrix K is calculated as follows:

[0077] K=QH T (HQH T +1) -1

[0078] Among them, (HQH T +1) -1 for (HQH T +1) is the inverse of.

[0079] Then the output x1(k) and v1(k) of the Kalman filter are calculated as follows:

[0080]

[0081] Further, the acquired command signal is filtered by s(k) using a Kalman filter, and the filtered command signal x1(k) and the differential v1(k) of the command signal are output;

[0082] Furthermore, the new command signal s is calculated using the filtered command signal x1(k) and the differential of the command signal v1(k) according to the following formula: ′ (k):

[0083] s ′ (k) = x1(k) + k s v1(k)

[0084] Further, using s ′ (k) and the feedback signal f(k) are used to calculate the tracking error e(k) as follows:

[0085] e(k)=s ′(k)-f(k)

[0086] Furthermore, taking e(k) as input, the control quantity u(k) is calculated using a feedback controller. The feedback controller is not limited to its specific form, and only requires that its input signal is the tracking error e(k), such as a proportional controller, a proportional-integral-differential controller, etc. Taking the proportional controller as an example, the output of the controller is:

[0087] u(k)=k p e(k)

[0088] where k p is the proportional gain.

Claims

1. A servo system control method based on Kalman filtering, It is characterized in that The steps include: Step 1: Get the current time t = kT s The command signal s(k) at time T s is the duration of the control cycle, k is the sequence number of the time, the value range is k=1,2,3…, s(k) is t=kT s command signals at all times; Step 2: Get the current time t = kT s The feedback signal f(k) at time ; Step 3: Get the two output signals of the Kalman filter at the previous moment, which are the filtered command signal x 1 (k-1) and v 1 (k-1); When k = 1, there is no signal at the previous moment. Let x 1 (k-1)=0, v 1 (k-1)=0; Get the update matrix P(k-1) of the previous moment. When k=1, there is no update matrix of the previous moment. At this time, let: Step 4: Use the Kalman filter to filter the acquired command signal s(k) and output the filtered command signal x 1 (k) and the differential of the command signal v 1 (k); Step 5: Use the filtered command signal x 1 (k) and the differential of the command signal v 1 (k) Calculate the new command signal s ′ (k); Step 6: Utilize s ′ (k) and the feedback signal f(k) to calculate the tracking error e(k); Step 7: Using e(k) as input, use the controller to calculate the control variable u(k).

2. A servo system control method based on Kalman filtering according to claim 1, It is characterized in that The Kalman filter comprises the following steps: Step 4-1: Calculate the auxiliary matrix Q according to the following formula: Q=F P(k-1)F T in, F T is the transpose of the matrix F; Step 4-2: Calculate the auxiliary variable y according to the following formula: Where H = [1 0]; Step 4-3: Calculate the auxiliary matrix K according to the following formula: K=QH T (HQH T +1) -1 Among them, (HQH T +1) -1 for (HQH T +1) inverse; Step 4-4: Calculate the output x of the Kalman filter according to the following formula 1 (k), v 1 (k) is:

3. A servo system control method based on Kalman filtering according to claim 2, It is characterized in that New command signal ′ k (k) is calculated according to the following formula: s ′ (k)=x 1 (k)+k s v 1 (k)。 4. A servo system control method based on Kalman filtering according to claim 3, It is characterized in that The tracking error e(k) is calculated as follows: e(k)=s ′ (k)-f(k)。

Citation Information

Patent Citations

  • Method for controlling servo system of active disturbance rejection control technology

    CN102799113A

  • A moving object tracking method based on switch Kalman filter

    CN109003292A

  • Variable-pitch stable-rotating-speed control system for wind turbine generator, and control method

    CN113847202A

  • High-reliability safe flight control method for enhancing system stability reserve

    CN117930632A

  • Servo controller

    JP2017041248A