Observer bandwidth adaptive friction compensation method for linear guides
Patent Information
- Application Number
- CN202311830213.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2023-12-27
- Publication Date
- 2024-11-19
- Estimated Expiration
- 2043-12-27
Smart Images

Figure CN117811447B_ABST
Abstract
Description
Technical Field
[0001] The invention relates to an observer bandwidth adaptive friction compensation method for a linear guide rail, and belongs to the technical field of linear motor friction compensation. Background Art
[0002] Due to the direct drive advantage, linear motors have been widely used in high-precision applications such as CNC machine tools and photolithography machines. However, the direct drive structure will cause the disturbance force to have a more significant impact on the mover, further deteriorating the position control performance.
[0003] Among various disturbances, friction is regarded as a major nonlinear disturbance, especially when the mover is in the reversal or startup stage of motion. In the process of friction force converting from static friction to dynamic friction, the disturbance effect is more significant.
[0004] like Figure 1 The figure shows the position error when the linear motor moves in an S-trajectory. It can be seen that there is a large peak error in the motor startup phase and a steady-state error in the positioning phase. Summary of the invention
[0005] In view of the problem of large peak position error caused by friction during the startup and positioning stages of a linear motor, the present invention provides an observer bandwidth adaptive friction compensation method for a linear guide.
[0006] An observer bandwidth adaptive friction compensation method for a linear guide rail of the present invention comprises:
[0007] Based on the existing friction force LuGre model, a simplified friction force model is obtained according to the mover velocity v in the pre-slip area being close to 0, which is used to calculate the average bristle deformation z; the friction force feedforward value F is calculated based on the average bristle deformation z f ;
[0008] Then the bandwidth adaptive variation law ω of the observer is calculated from the average shape variable z of the bristle: o ;
[0009] During the operation of the linear motor, the friction force feedforward value F is used. f The friction force is fed forward for compensation, and then the residual friction force after the feed forward compensation is quickly compensated by the observer. The observer is based on the bandwidth adaptive change law ω o Adaptive bandwidth adjustment.
[0010] According to the observer bandwidth adaptive friction compensation method for linear guide rails of the present invention, the existing friction LuGre model is:
[0011]
[0012] Where g(v) is the function describing the Stribeck effect, F c is the Coulomb friction force, F s is the maximum static friction, v s is the turning velocity of the mover, σ0 is the bristle stiffness, σ1 is the bristle damping, and σ2 is the viscous friction coefficient;
[0013] According to the mover speed v close to 0, the simplified friction model is obtained:
[0014]
[0015] Substituting formula (2) into formula (1), we can obtain the calculation formula for the average bristle deformation z:
[0016]
[0017] According to the observer bandwidth adaptive friction compensation method for linear guide rails of the present invention, based on formula (3), the friction feedforward value F is calculated. f :
[0018] F f =σ0z. (4)
[0019] According to the observer bandwidth adaptive friction compensation method for linear guide rail of the present invention, the bandwidth adaptive variation law ω o for:
[0020]
[0021] Where ω omin is the minimum bandwidth, ω omax is the maximum bandwidth, κ is a positive coefficient, and tanh is the hyperbolic sine function.
[0022] Beneficial effects of the present invention: The method of the present invention is applied to the nonlinear friction compensation of a linear motor.
[0023] The method of the present invention can adaptively adjust the bandwidth of the friction observer in real time during the operation of the linear motor, and calculate the friction feedforward value in real time, so as to form a robust friction compensation method combining the adaptive bandwidth observer and the friction feedforward. The bandwidth adaptive friction observer in the method of the present invention can quickly compensate the residual friction after the feedforward compensation, overcome the problems of inaccurate feedforward friction compensation and strong model dependence, and enhance the friction compensation performance.
[0024] Experimental verification shows that the method of the present invention can effectively reduce the position peak error in the startup phase and the positioning phase, and improve the position control accuracy of the linear motor. BRIEF DESCRIPTION OF THE DRAWINGS
[0025] Figure 1 It is a schematic diagram of the position error during the motion of the linear motor;
[0026] Figure 2 It is a schematic diagram of the relevant waveforms of the existing friction LuGre model and the simplified friction model;
[0027] Figure 3 It is a block diagram of friction force compensation based on the method of the present invention during the operation of the linear motor;
[0028] Figure 4 In the method of the present invention, the observer bandwidth varies with Adaptive changing waveform diagram;
[0029] Figure 5 It is a schematic diagram of the position control error using a fixed bandwidth observer to compensate for friction;
[0030] Figure 6 It is a schematic diagram of position control error of adaptively adjusting the bandwidth observer to compensate for friction using the method of the present invention. DETAILED DESCRIPTION
[0031] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.
[0032] It should be noted that, in the absence of conflict, the embodiments of the present invention and the features in the embodiments may be combined with each other.
[0033] The present invention will be further described below in conjunction with the accompanying drawings and specific embodiments, but they are not intended to limit the present invention.
[0034] Specific implementation method 1. Combination Figures 1 to 4 As shown, the present invention provides an observer bandwidth adaptive friction compensation method for a linear guide, comprising:
[0035] Based on the existing friction force LuGre model, according to the characteristic that the speed of the mover in the pre-slip area tends to 0, a simplified friction force model is obtained, and then a simplified formula for calculating the average bristle deformation is proposed, and then the average bristle deformation z is calculated; based on the average bristle deformation z, the friction force feedforward value F is calculated f ;
[0036] Then the bandwidth adaptive variation law ω of the observer is calculated from the average shape variable z of the bristle: o ;
[0037] During the operation of the linear motor, the friction force feedforward value F is used. f The friction force is fed forward for compensation, and then the residual friction force after the feed forward compensation is quickly compensated by the observer. The observer is based on the bandwidth adaptive change law ω o Adaptive bandwidth adjustment.
[0038] This implementation is based on a simplified formula for calculating the average bristle deformation, and further calculates the friction force feedforward value and the bandwidth adaptive variation law of the observer.
[0039] Furthermore, the existing friction LuGre model is:
[0040]
[0041] Where g(v) is the function describing the Stribeck effect, F c is the Coulomb friction force, F s is the maximum static friction, v s is the turning velocity of the mover, σ0 is the bristle stiffness, σ1 is the bristle damping, and σ2 is the viscous friction coefficient;
[0042] Where σ0 and σ1 are dynamic parameters, F c 、F s 、v s and σ2 are static friction model parameters;
[0043] In the pre-slip region, as the mover velocity v is close to 0, a simplified friction model is obtained:
[0044]
[0045] Substituting formula (2) into formula (1), we can obtain the calculation formula for the average bristle deformation z:
[0046]
[0047] Furthermore, based on formula (3), since the sliding friction is small in the pre-sliding area, only the elastic friction is considered to calculate the friction feedforward value F f :
[0048] F f =σ0z. (4)
[0049] Figure 2 The waveforms of the approximate model (simplified friction model) and the LuGre model (existing friction LuGre model) are shown. It can be seen that the simplified friction in the pre-slip region can approximate the existing LuGre model very well. At the same time, the derivative of the average deformation variable z of the bristle in the approximate model can be seen. The changing waveform, It can characterize the speed of friction change, that is, the speed of friction change in the pre-slip region. Therefore, the core of this embodiment is to use the simplified friction model to obtain It serves as the basis for adaptive changes in observer bandwidth.
[0050] ω o As an observer performance indicator, it is related to the observer's gain parameter. It can be said that the observer's bandwidth is linearly related to its gain. o for:
[0051]
[0052] Where ω omin is the minimum bandwidth, ω omax is the maximum bandwidth, κ is a positive coefficient, and tanh is the hyperbolic sine function.
[0053] In the formula Calculated by formula (3).
[0054] The friction compensation scheme of this embodiment is as follows Figure 3 As shown, it includes friction feedforward and observer compensation, wherein the friction feedforward compensation is implemented in formula (4), and the observer adopts a bandwidth adaptive strategy, using the average bristle deformation z in formula (3) to adaptively change the observer bandwidth ω o The observers involved can be extended state observer, Lemberg observer and sliding mode observer, etc.
[0055] For specific The corresponding bandwidth waveform can be obtained as follows Figure 4 As shown, Figure 4 It is shown in Figure 2 that when the friction force changes rapidly, the bandwidth of the observer will also increase to adapt to the change in friction force, thereby achieving more accurate friction force observation.
[0056] The method of the present invention is used in the operation process of the linear motor. Based on formulas (3) and (5), the friction observer bandwidth is adaptively adjusted in real time, and the friction feedforward value F is calculated using formula (4). f Finally, a robust friction compensation method combining an adaptive bandwidth observer and friction feedforward is formed. The bandwidth adaptive friction observer used in the method of the present invention can quickly compensate for the residual friction after feedforward compensation. Specific embodiment:
[0058] Build a linear motor experimental platform, using an S-shaped motion trajectory with a maximum velocity of 0.05m / s and a maximum acceleration of 0.05m / s 2The position error obtained by using the existing fixed bandwidth observer and the adaptive bandwidth observer in the present invention to perform friction compensation is as follows: Figure 5 and Figure 6 As shown in the figure, it can be seen that the bandwidth adaptive strategy proposed by the method of the present invention can effectively reduce the position peak error in the startup phase and improve the position control accuracy of the linear motor.
[0059] Although the present invention is described herein with reference to specific embodiments, it should be understood that these embodiments are merely examples of the principles and applications of the present invention. It should therefore be understood that many modifications may be made to the exemplary embodiments and that other arrangements may be devised without departing from the spirit and scope of the present invention as defined by the appended claims. It should be understood that the various dependent claims and features described herein may be combined in a manner different from that described in the original claims. It should also be understood that the features described in conjunction with a single embodiment may be used in other described embodiments.
Claims
1. An observer bandwidth adaptive friction compensation method for a linear guide, characterized in that include, Based on the existing friction force LuGre model, the simplified friction force model is obtained according to the mover velocity v in the pre-slip area being close to 0, which is used to calculate the average bristle deformation z; the friction force feedforward value F is calculated based on the average bristle deformation z. f ; Then the bandwidth adaptive variation law ω of the observer is calculated from the average shape variable z of the bristle: o ; During the operation of the linear motor, the friction force feedforward value F is used. f The friction force is fed forward for compensation, and then the residual friction force after the feed forward compensation is quickly compensated by the observer. The observer is based on the bandwidth adaptive change law ω o Adaptive bandwidth adjustment; The existing friction LuGre model is: Where g(v) is the function describing the Stribeck effect, F c is the Coulomb friction force, F s is the maximum static friction, v s is the turning velocity of the mover, σ0 is the bristle stiffness, σ1 is the bristle damping, and σ2 is the viscous friction coefficient; According to the mover velocity v close to 0, the simplified friction model is obtained: Substituting formula (2) into formula (1), we can obtain the calculation formula for the average bristle deformation z: Bandwidth adaptive change lawω o for: Where ω omin is the minimum bandwidth, ω omax is the maximum bandwidth, κ is a positive coefficient, and tanh is the hyperbolic sine function.
2. The observer bandwidth adaptive friction compensation method for a linear guide according to claim 1, characterized in that: Based on formula (3), calculate the friction force feedforward value F f : F f =σ0z(4)。
