Summary of the invention
Disadvantages described above or Improvement requirement for prior art, the invention provides a kind of method for reducing lathe servo feed system tracking error, it realizes estimating frictional force by Kalman's observer, and pass through the compensation to frictional force thus reaching the purpose of accurately control, enable the system to real-time observation and estimate frictional force real-time change, and in the controls it is compensated, for reducing compensation control when servosystem tracking error is particularly slided in advance, there is remarkable result。
For achieving the above object, the present invention proposes a kind of method for reducing lathe servo feed system tracking error, it is characterised in that the method comprises the steps:
1) lathe servo feed system is modeled, it is thus achieved that the system model of servo feed system;
2) frictional force mathematical model the identified parameters of lathe servo feed system are set up;
3) utilize Kalman observer that the change in location of servo feed system is estimated, the compensation frictional force of servo feed system is calculated according to the change in location estimated, the frictional force of servo feed system is carried out Real-time and Dynamic compensation by the compensation frictional force according to calculating, and then realizes reducing the tracking error of lathe servo feed system。
As it is further preferred that described lathe servo feed system is modeled, it is thus achieved that the system model of servo feed system includes:
The system model setting up servo feed system isWherein, MtRepresent the quality that the mechanical part of servo feed system is total, BmRepresent the damping of servomotor, FqRepresent the driving force of servo feed system,Representing the frictional force of servo feed system, x represents servo feed system feed shaft displacement, and z represents mane average deformation。
As it is further preferred that described mane average deformation z adopts following expression to express:
Wherein,δ0Represent mane rigidity, fcRepresent coulomb frictional force, fsRepresent maximum static friction force, vsRepresent the characteristic velocity of Stribeck effect。
As it is further preferred that the described frictional force mathematical model setting up lathe servo feed system identified parameters include:
2.1) the frictional force mathematical model of lathe servo feed system is set up:
Wherein, δ0Represent mane rigidity, δ1Represent microcosmic damped coefficient, μvRepresent servo feed system feed shaft viscous friction coefficient;
2.2) parameter δ in identification frictional force mathematical model0、δ1、μv、fc、fsAnd vsValue。
As it is further preferred that parameter δ in described identification frictional force mathematical model0、δ1、μv、fc、fsAnd vsValue include:
Select to optimize cost function Js, and minimize it, calculate and obtain parameter δ0、δ1、μv、fc、fsAnd vsValue, described JsEmploying following expression represents:
In formula, NsIt is the number of composition Stribeck effect point,Represent workbench steady-state error at various speeds respectively, wherein DescribedWithRepresenting the frictional force under stable state, it is by actually measured, described inWithRepresent estimation stable state under frictional force, it is by step 2.1) in frictional force mathematical model express。
As it is preferred that, described utilize Kalman observer that the change in location of servo feed system is estimated, the compensation frictional force of servo feed system is calculated according to the change in location estimated, the frictional force of servo feed system is carried out Real-time and Dynamic compensation by the compensation frictional force according to calculating, and then the tracking error realizing reducing lathe servo feed system includes:
3.1) expression formula that frictional force is associated is set up with state variable X:
Wherein,
3.2) the kinetic model discrete form of servo feed system is set up:
X (k+1)=AX (k)+Bu (k)+v (k);
Y (k+1)=CX (k)+n (k);
In formula, X (k+1), X (k) represent the state variable X position in k+1, k moment respectively, Represent that state variable X is in the estimation position in k+1, k moment respectively, Y (k), Y (k+1) represent the servo feed system output state variable in k+1, k moment respectively, v (k), n (k) are k moment white noise signal, u (k) represents servo feed system action function, K is yield value C=[100],
3.3) covariance of state variable error is set upAnd calculate covariance forecast P (k+1), make covariance forecast P (k+1) converge to zero, calculate and obtain yield value K, this yield value K-band is entered formulaIn, calculate and obtain state variable in the position in k+1 moment
3.4) by step 3.3) middle acquisitionValue brings expression formula into as the input value of XIn, calculate the compensation frictional force obtaining servo feed system;
3.5) according to the compensations frictional force calculated, the frictional force of servo feed system carried out Real-time and Dynamic compensation, and then realize the tracking error of minimizing lathe servo feed system。
As it is further preferred that the covariance of described state variable errorEmploying following expression is expressed:
In formula, E is covariance matrix。
As it is further preferred that described covariance forecast P (k+1) adopts following expression to express:
In formula, I is vector matrix, and V, N represent the covariance matrix of white noise signal v (k), n (k) respectively。
As it is further preferred that described white noise signal v (k), n (k) covariance matrix particularly as follows:
As it is further preferred that covariance forecasts that P (k+1) obtains yield value K when converging to zero and is: K=PCT[CPCT+N]-1, wherein P is the covariance matrix of covariance forecast P (k+1)。
In general, by the contemplated above technical scheme of the present invention compared with prior art, mainly possess following technological merit:
1. in the present invention, the state variable of Frictional model is observed by introducing state observer, realize real-time monitored change in location thus realizing estimating in real time change in friction force, the frictional force moment of the servo feed system estimated is added in torque signals as compensation, by the frictional force torque compensation of the servo feed system of estimation to the moment after PID controller regulates realizing the accurate control to servo feed system so that feed shaft tracking error is obviously improved。
2. in the present invention, introduce dynamic friction model and not only describe the static characteristic of frictional force, dynamic characteristic such as the sudden change power of change, frictional force hysteresis phenomenon, stopping-sliding motion etc. are also presented, the real-time monitored to dynamic friction is realized by design point observer, and in the controls it being compensated, the tracking error for reducing servo feed axle compensates control when particularly sliding in advance and has remarkable result。
3. design con-trol device process of the present invention is easy, it is possible to system parameter is estimated;By on semi-physical simulation platform, the real-time adjustment to design parameter can be realized, frictional force being compensated with simple and flexible, it is achieved control the tracking error of servo feed system, has the accuracy of higher motility, stability, observability and tracking error。
Detailed description of the invention
In order to make the purpose of the present invention, technical scheme and advantage clearly understand, below in conjunction with drawings and Examples, the present invention is further elaborated。Should be appreciated that specific embodiment described herein is only in order to explain the present invention, is not intended to limit the present invention。As long as just can be mutually combined additionally, technical characteristic involved in each embodiment of invention described below does not constitute conflict each other。
A kind of method for reducing lathe servo feed system tracking error of the present invention, it is regulated by PID and realizes controlling based on the Friction Compensation of Kalman observer, as shown in Figure 1, its ultimate principle is: the servo parameter of PID regulable control device, the motor making drive system rotates in a predetermined manner, thus driving feed system (such as workbench) according to predetermined orbiting motion, working table movement process is measured its actual frictional force, the positional information of workbench is obtained by semi-physical simulation platform, Kalman observer is utilized to realize estimating of the change in location to workbench, and utilize frictional force estimator to realize estimating in real time change in friction force according to the change in location of the workbench estimated, according to the change in friction force estimated, frictional force is carried out real-Time Compensation, in general, it reduces the purpose of servo feed system tracking error by the monitoring of change in friction force is achieved。
As in figure 2 it is shown, the described method for reducing lathe servo feed system tracking error, mainly comprise the steps:
1) lathe servo feed system is modeled, it is thus achieved that the system model of servo feed system so that it is be prone to design and the stability analysis of Friction Compensation, itself particularly as follows:
The servo feed system of the present embodiment adopts the control system of closed-loop structure, output is the displacement of lathe, the closed-loop control system of design is broadly divided into Kalman observer, frictional force estimator and three parts of system model, and its topology layout is as shown in Figure 1。
The system model setting up servo feed system is as follows:
Wherein, MtRepresent the quality that the mechanical part of servo feed system is total, BmRepresent the damping of servomotor, FqRepresent the driving force of servo feed system,Representing the frictional force of servo feed system, x represents servo feed system feed shaft displacement,For the first derivative of x, it is relative sliding velocity v, z and represents mane average deformation。
Further, described mane average deformation z adopts following expression to express:
Wherein,This functionDescribe Stribeck (this Trebek) effect (frictional force phasic Chang), δ0Represent mane rigidity, fcRepresent coulomb frictional force, fsRepresent maximum static friction force, vsRepresent the characteristic velocity of Stribeck effect。
2) frictional force mathematical model the identified parameters of lathe servo feed system are set up:
2.1) setting up the frictional force mathematical model of lathe servo feed system, it is (frictional force is produced by the flexure of mane) that the present embodiment specifically sets up the frictional force mathematical model at platen rail plate place:
Wherein, δ0Represent mane rigidity, δ1Represent microcosmic damped coefficient, μvRepresent servo feed system feed shaft viscous friction coefficient;
2.2) parameter δ in identification frictional force mathematical model0、δ1、μv、fc、fsAnd vsValue:
Select to optimize cost function Js, and minimize it, calculate and obtain parameter δ0、δ1、μv、fc、fsAnd vsValue, the present embodiment calculate obtain δ0=2.79 × 107(N/m), δ1=4.32 × 103(N s/m), μv=2.45 × 103(N s/m), fc=64.2 (N), fs=86.2 (N), vs=6.04 × 10-4(m/s)。
Further, described JsEmploying following expression represents:
In formula, NsIt is the number of composition Stribeck effect point,Represent the speed under corresponding each effect point i,Represent workbench steady-state error at various speeds respectively, wherein DescribedWithRepresenting the frictional force under stable state, it is by actually measured, described inWithRepresent estimation stable state under frictional force, it is by step 2.1) in frictional force mathematical model and formula (3) express, for instance
3) utilize Kalman observer that the change in location of servo feed system is estimated, the compensation frictional force of servo feed system is calculated according to the change in location estimated, the frictional force of servo feed system is carried out Real-time and Dynamic compensation by the compensation frictional force according to calculating, and then realizing reducing the tracking error of lathe servo feed system: the Kalman observer and the frictional force estimation module that the simulink module inside Matlab7.0 are designed by semi-physical simulation platform download on semi-physical simulation platform, realized the driving of servomotor and the reading to lathe displacement signal by semi-physical simulation platform, the purpose introducing Kalman observer is in that to export the estimation making state vector X (k) based on Y (k) measurement。
It comprises the following steps:
3.1) expression formula that frictional force is associated is set up with state variable X
First, the state-space expression of this system is set up:
Y=CX=[100] X (7)
Wherein, X represents that system state variables, Y represent output state variable, u=Fq, A, B are matrix;
Bring formula (6) into formula (5) to draw:
In formula (8),
According to formula (8), utilize trial and error procedure obtain A, B matrix be:
In formula (9), matrix element a22,a23,a33It is respectively as follows:
According to formula (1)And formula (11)-(13), set up the expression formula that frictional force is associated with state variable X:
3.2) the kinetic model discrete form of servo feed system is set up:
X (k+1)=AX (k)+Bu (k)+v (k) (15)
Y (k+1)=CX (k)+n (k) (16)
In formula, X (k+1), X (k) represent the state variable X position in k+1, k moment respectively, Represent that state variable X is in the estimation position in k+1, k moment respectively, Y (k), Y (k+1) represent the servo feed system output state variable in k+1, k moment respectively, v (k), n (k) are k moment white noise signal, u (k) represents servo feed system action function, K is yield value C=[100],
3.3) in estimation procedure, there is noise, in order to eliminate influence of noise, set up the covariance of state variable errorAnd calculate covariance forecast P (k+1), make covariance forecast P (k+1) converge to zero, calculate and obtain yield value K, this yield value K-band is entered formulaIn, calculate and obtain state variable in the position in k+1 moment
Further, the covariance of described state variable errorEmploying following expression is expressed:
In formula, E is covariance matrix。
More specifically, described covariance forecast P (k+1) adopts following expression to express:
In formula, I is vector matrix, and V, N represent the covariance matrix of white noise signal v (k), n (k) respectively。
It is further preferred that described white noise signal v (k), n (k) covariance matrix particularly as follows:
Concrete, covariance forecast P (k+1) obtains yield value K when converging to zero and is:
K=PCT[CPCT+N]-1;
Wherein, P is the covariance matrix of covariance forecast P (k+1)。
3.4) by step 3.3) middle acquisitionValue brings expression formula into as the input value of X Namely, in formula (14), calculate the compensation frictional force obtaining servo feed system, frictional force is estimated;
3.5) according to the compensation frictional force calculated, the frictional force of servo feed system is carried out Real-time and Dynamic compensation, and then realizing reducing the tracking error of lathe servo feed system: the frictional force moment of the servo feed system of estimation is added in torque signals as compensation, and this Friction Compensation control algolithm realizes the also drive motor of downloading of algorithm is driven the acquisition of working table movement and data by Dspace semi-physical simulation platform;By the frictional force torque compensation of the servo feed system of estimation to the moment after PID controller regulates realizing the accurate control to servo feed system, feed shaft tracking error is obviously improved, as shown in Fig. 3 (a) and (b)。
Those skilled in the art will readily understand; the foregoing is only presently preferred embodiments of the present invention; not in order to limit the present invention, all any amendment, equivalent replacement and improvement etc. made within the spirit and principles in the present invention, should be included within protection scope of the present invention。