This application is claims priority to Chinese Patent Application No. 201810966248.1 with a filing date of Aug. 23, 2018. The content of the aforementioned application, including any intervening amendments thereto, is incorporated herein by reference.
The disclosure relates to the technical field of automatic control, and particularly to a method for converting lime-varying system into time-invariant system.
More than 90% of the control systems in the industry adopt the PID (Proportional-Integral-Derivative) control algorithm. For time-varying systems, the PID control algorithm can obtain excellent control effects after adjusting parameter. However, when the model parameters change, the state changing rate will also change after the same control quantity acts on the control object, which makes the control system performance worse. Although the fuzzy, intelligent and robust control methods can improve the control system performance to a certain extent, it is difficult to apply them in high-speed precision motion control for the complexity of the algorithm.
The active disturbance rejection control algorithm is an effective method to eliminate the disturbance. By considering the model error and the external disturbance as a whole, the disturbance can be suppressed to some extent, hut the active disturbance rejection control algorithm will be affected by the bandwidth of the observer and the bandwidth of the control system, which leads to a lot of trouble in application.
For example, for the nth-order control system anX(n)+an−1x(n−1)+ . . . +a2x(2)+a1x(1)+a2x=u, where x is the state variable, the x(1) is the ith-order derivative of the state variable, the a1 is the coefficient of ith-order derivative, and u is the control quantity. When the model parameters change, the following formula will be obtained:
(an+Δan)x(n)+(an−+Δan−1)x(n−1)+ . . . +(a2+Δa2)x(2)+(a1+Δa1)x(1)−(a0+Δa0)x=u
The prior art mainly adopts the Taylor expansion to perform robust control on the model.
The main object of the disclosure is to provide a control method for converting a time-varying system into a time-invariant system, aiming to convert a time-varying system into a time-invariant system by means of compensation, eliminate the effects of parameters changes and improve the stability of the linear control system.
In order to realize above purposes, a control method for converting a time-varying system into a time-invariant system provided in this disclosure, comprising the following steps:
S1: using (n−1)th to 0th order signals of an nth-order time-varying system as feedback to set up a closed loop control for the time-varying system, wherein initial values of coefficients in each order an˜a0 are a′n˜a′0;
S2: acquiring real-time values of the coefficients in each order of anr˜a0r of the time-varying system through a sensor, and calculating variations Δan˜Δa0 between the real-time values and the initial values of the coefficients in each order through a controller.
S3: amplifying the nth-order coefficient an with
as a gain through the controller;
S4: amplifying the (n−1)th to 0th order coefficients an−1˜a0 respectively with
as a gain through the controller wherein I is an integer ranging from 0 to n−1. and then summing all resulting coefficients to obtain a measured disturbance;
S5: inputting the measured disturbance, a control signal from the controller and an nth-order signals into an extended state observer to estimate the rest disturbances;
S6: summing up the measured disturbance in step S4 and estimated disturbance in step S5 to obtain total disturbances, multiplying the total disturbances by a reciprocal of a transfer function transferring the nth-order coefficient to a control force to obtain a product, then figuring out a difference between the product and the nth-order coefficient amplified in step S3 to act on the time-varying system; and
S7: adjusting the above coefficients in each order through the controller to convert the time-varying system into the time-invariant system.
Preferably, a varying part of the time-varying system is compensated by the measured disturbance in step S4 and the estimated disturbance in step S5.
Preferably, the time-varying system is equivalent to the time-invariant system with time-invariant parameter.
Preferably, the (n−1)th to 0th order coefficients are measured or estimated by a model of the time-varying system.
Preferably, the extended state observer is adopted to estimate rest disturbance except the measured disturbance and the measured disturbance along with the rest disturbance compensates the total disturbances.
Preferably, if a total disturbances bandwidth is less than ⅓ of the measured bandwidth, the measured disturbance is set to be 0 and the estimated disturbance obtained from the extended state observer compensates the total disturbances directly.
The technical solution of the present disclosure has the following advantages over the prior art:
The technical solution of the present disclosure, aimed at the nth-order system, considers the nth derivative of the state variable as the quantity to be determined, and the (n−1)th order to the 0th derivative of the state variables are all known quantities. The technical solution of the disclosure adopts ideas of the disturbance estimation and compensation in the active disturbance rejection control, and by means of double compensation by measured and estimated disturbances, fully utilizes the measured disturbance to compensate most of the disturbances. The extended state observer (ESO) further compensates the uncertain part of the model, which not only fully compensates the disturbance error, but also avoids the noise interference caused by the observation bandwidth. After the compensation, the time-varying system is transformed into a time-invariant system and the control system is equivalent to a constant system with constant parameters. The change regulation between the equivalent control quantities to output remains constant eliminating the effects of parameter changes and improving the linear control system performance. When the total disturbance bandwidth is less than ⅓ of the measured disturbance bandwidth, which means the total disturbance amount is not particularly large, the measured disturbance is set to be 0, which simplifies original algorithm to the active disturbance rejection control algorithm of ESO disturbance estimation compensation.
In order to make the technical solutions in the disclosure or in the prior art described more clearly, the accompanying drawings needed in the embodiments or in the prior art will be introduced concisely as follows. Obviously, the drawings described below are only some embodiments according to the disclosure, and for one of ordinary skills, more drawings will be obtained in the art based on the structures described in the drawings without paying any creative work.
The realization of the objects of the disclosure, functional features and advantages of the present disclosure will be further described with reference to the accompanying drawings.
The technical solutions in present disclosure will now be described more clearly and fully with reference to the accompanying drawings in embodiments as following. Obviously, this disclosure may, however, be embodied in many different forms and should not be construed as limited to the embodiments set forth herein. It is appreciated that more embodiments will be obtained by one of ordinary skills in the art based, on the embodiments described herein without paying any creative work, and all these embodiments should fall in the scope of this invention.
It should be noted that any directional indications involved in the embodiments of the disclosure, such as “upper”, “lower”, “left”, “right”, “front”, “back”, etc., are only used to explain the relative positional relationship and the motion situation between components in a certain posture as shown in accompanying drawings. The directional indications will change accordingly if'the certain posture changes.
The block diagrams of the present invention are corresponding to the expressions. When the direction of the measured signal changes, it depends on the expressions that whether the expression in the extended state observer would standardize the estimation, namely divide by the highest order expression coefficient an expressed by a product factor b=1/an, whether the signs in the block diagrams would change and whether the scale factor, b or 1/b, would change. A completely equivalence can still be expressed through the formula.
In addition, any description involved “first” and “second” in the embodiments of the disclosure is merely for the purpose of description and can not be construed as indicating or implying a relative importance or the number of, technical features. Thus, features defined with “first” and “second” may comprise at least one feature expressly or impliedly. Moreover, the various embodiments in technical solutions can be combined with each other, which have to base on the precondition, that ordinary skills in the art can realize the combinations. When a combination of technical solution is in contradictory or is impossible to realize, the combination should be considered as not exist and should not fall in the scope of the claimed protection of the invention.
Referring to
S1: using (n−1)th to 0th order signals of an nth-order time-varying system as feedback to set up a closed loop control for the time-varying system, wherein initial values of coefficients in each order an˜a0 are a′n˜a′n;
S2: acquiring real-time values of the coefficients in each order anr˜a0r or the time-varying system through a sensor, and calculating variations Δan˜Δa0 between the real-time values and the initial values of the coefficients in each order through a controller,
S3: amplifying the nth-order coefficient an with
as a gain through the controller;
S4: amplifying the (n−1)th to 0th order coefficients an−1˜a0 respectively with
as a gain through the controller wherein I is an integer ranging from 0 to n−1, and then summing all resulting coefficients to obtain a measured disturbance;
S5: inputting the measured disturbance, a control signal from the controller and an nth-order signals into an extended state observer to estimate the rest disturbances z2;
S6: summing up the measured disturbance in step S4 and estimated disturbance in step S5 to obtain total disturbances, multiplying the total disturbances by a reciprocal of a transfer function transferring the nth-order coefficient to a control force by the total disturbances to obtain a product, then figuring out a difference between the product and the nth-order coefficient amplified in step S3 to act on the time-varying system; and
S7: adjusting the above coefficients in each order through the controller to convert the time-varying system into the time-invariant system.
Preferably, a varying part of the time-varying system in the present disclosure is compensated by the measured disturbance in step S4 and the estimated disturbance in step S5. After compensation by above method, the time-varying system is equivalent to the time-invariant system with time-invariant parameter. Coefficients from (n−1)th to 0th order can be measured or estimated according to a model of the time-varying system. The extended state observer is adopted to estimate the rest disturbance except the measured disturbance and the measured disturbance along with the rest disturbance compensates the total disturbances, if the total disturbance bandwidth is less than ⅓ of the measured bandwidth, the measured disturbance is set to be 0 and the estimated disturbance of the extended state observer compensates the total disturbances directly.
Referring to
m0{circumflex over (x)}(t)+c0x(t)+k0x(t)=u0(t) (1)
When a parameter of the controlled object (time-varying system) changes, the specific expression will become:
(m0+Δm){umlaut over (x)}(f)+(c0+Δc){dot over (x)}(t)+(k0+Δk)x(t)=u0(t) (2)
Since a control quantity u0(t) is obtained according to a deviation and is not directly related to the parameter of the controlled object, the changes of the parameter will lead to changes in the speed of the state change. In order to keep the speed of the state change unchanged, the control quantity needs to be compensated.
Multiply both sides of expression (1) by
to get the following expression:
Organize the above formula to get the following expression:
Equivalently exchange expression (3) to obtain the following expression:
Compared with the expression (3), the expression (4) increases the damping and stiffness changes on the left side of the expression, and increases the stiffness and damping force on both sides. Through the equivalent exchange from the expression (3) to the expression (4), an equivalent form after the parameter changes can be obtained from the original system.
Compared with the expression (2), the expression (4) needs to multiply the original control quantity by
subtract a product that multiply the other low-order quantities by the original parameter
and subtract the change amount of the parameter as feedback to finally eliminates the impact of each parameter changes.
Let
and the second order ESO which could estimates the speed and the disturbance is:
When the speed is in accurate measure, the ESO could be reduced-order. The first order ESO which could only estimate the disturbance is:
As the position tracking error -curve comparison shown in
When the stiffness damping parameter exists a deviation (−0.1 k, −0.1 c), the actual stiffness damping parameter is only 0.9 times as much as the design value. At this time, the extended state observer accurately estimates the disturbances caused by the deviation of the model parameters as shown in
The second order system of dual-mechanical arm is taken as an example in the present invention, the equation expression of specific joint control, is:
J1{umlaut over (θ)}1B1{dot over (θ)}=T1 (5)
The changes of the joint pose lead to the changes of the inertia of joint 1, the expression is:
(J1+ΔJ1){umlaut over (θ)}1+B1θ=T1 (6)
By multiplying both sides of the original model by
the following expression can be obtained:
Organize the expression (7) into a model with a parameter changed to obtain the following expression:
The value of ΔB in second order system model of dual-mechanical arm in the embodiment is 0.
As can be seen in expression (8), the compensation part of the measured disturbance is
By adopting extended state observer, assign b the value
to further compensate the disturbances.
The second order ESO which could estimates the speed and the disturbance is:
When the speed is in accurate measure, the ESO could be reduced-order.
The first order ESO which could only estimates the disturbance is:
Finally, multiply the sum of the measured disturbance plus the estimated disturbances by the reciprocal of transfer function transferring, the control quantity to the driving force, and the result of which can compensate the signals of the control system, thereby converting the time-varying system into the time-invariant system and handling the interference of the model and the external environment.
The above embodiments are only preferred embodiments of the present invention, and are not intended to limit the scope of the invention, and any equivalent structural transformations based on the present specification and the drawings or directly or indirectly utilized in other related technical fields fall in the scope of patent protection of the present invention.
Number | Name | Date | Kind |
---|---|---|---|
7487078 | Phillips et al. | Feb 2009 | B1 |
7529652 | Gahinet et al. | May 2009 | B1 |
8712753 | Gahinet et al. | Apr 2014 | B1 |
Entry |
---|
Sariyildiz et al. “On the Explicit Robust Force Control via Disturbance Observer” IEEE Transactions on Industrial Electronics, vol. 62, No. 3, Mar. 2015 [retrieved on Feb. 18, 2022] (Year: 2015). |
Bertoluzzo et al. “Performance analysis of a servo system with high-bandwidth torque disturbance observer” 7th International Workshop on Advanced Motion Control. Proceedings (Cat. No. 02TH8623), 2002, pp. 110-115, doi: 10.1109/AMC.2002.1026900 [retrieved on Feb. 19, 2022] (Year: 2002). |
Ohnishi et al. “Motion Control for Advanced Mechatronics” IEEWASME Transactions on Mechatronics, vol. 1, No. 1, Mar. 1996 [retrieved on Feb. 18, 2022] (Year: 1996). |
Madonski et al. “Method of Sensor Noise Attenuation in High-Gain Observers—Experimental Verification on Two Laboratory Systems” 2012 IEEE International Symposium on Robotic and Sensors Environments Proceedings, 2012, pp. 121-126, doi: 10.1109/ROSE.2012.6402616 [retrieved on Feb. 18, 2022] (Year: 2012). |
Benmansour et al. “Extended State Observer Based Control of Attitude Stabilization for Flexible Spacecraft with Solar Pressure and Slosh Disturbances” The 5th International Conference on Electrical Engineering—Boumerdes (ICEE-B) Oct. 29-31, 2017, Boumerdes, Algeria [retrieved on Feb. 19, 2022] (Year: 2017). |
Number | Date | Country | |
---|---|---|---|
20200065693 A1 | Feb 2020 | US |