WO2018077593A1 - Method for determining a deadzone angle of a backlash in a mechanical drive-train system, method for controlling a drive motor controller as well as drive-train system - Google Patents
Method for determining a deadzone angle of a backlash in a mechanical drive-train system, method for controlling a drive motor controller as well as drive-train system Download PDFInfo
- Publication number
- WO2018077593A1 WO2018077593A1 PCT/EP2017/075476 EP2017075476W WO2018077593A1 WO 2018077593 A1 WO2018077593 A1 WO 2018077593A1 EP 2017075476 W EP2017075476 W EP 2017075476W WO 2018077593 A1 WO2018077593 A1 WO 2018077593A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- drive
- deadzone
- backlash
- angle
- train system
- Prior art date
Links
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/404—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by control arrangements for compensation, e.g. for backlash, overshoot, tool offset, tool wear, temperature, machine construction errors, load, inertia
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1641—Programme controls characterised by the control loop compensation for backlash, friction, compliance, elasticity in the joints
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/41—Servomotor, servo controller till figures
- G05B2219/41032—Backlash
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/41—Servomotor, servo controller till figures
- G05B2219/41077—Self tuning, test run, detect, compute optimal backlash, deformation compensation
Definitions
- the present invention relates to a method for determining a deadzone angle of a backlash in a mechanical drive-train system, wherein the drive-train system comprises a drive motor, a load and a shaft for connecting the drive motor with the load. Furthermore, the present invention relates to a method for controlling a drive motor of a drive train system. Moreover, the present invention relates to a controller for a drive-train system. Finally, the present invention relates to a drive train system.
- Backlash is a common positioning-degrading phenomenon that shows up frequently in industrial machines.
- High-performance machine tools use backlash compensation algorithms to ensure accurate positioning of the tool. As such, estimation of the developing deadzones in gearing and other power transmission components is essential.
- online estimation method may facilitate an automatic compensation solution for developing backlash.
- the backlash in a gearing system can indirectly estimated by calculating the bounce, i.e. the change of the speed of the driving part of the gear due to the backlash impact upon exiting the
- EKF Extended Kalman Filter
- Minimization of a quadratic prediction error is known using position, velocity and torque measurements for offline identification of backlash torques in a vehicle driveline system.
- this object is solved by a method for determining a deadzone angle, by a method for controlling a drive motor, by a controller and by a drive-train system having the features according to the respective independent claims.
- Advantageous embodiments of the invention are the subject matter of the dependent claims.
- a method according to the invention serves for determining a deadzone angle of a backlash in a mechanical drive-train system, wherein the drive train-system comprises a drive motor, a load and a shaft for connecting the drive motor with the load.
- the method comprising the steps: estimating an interconnection torque in the deadzone and determining the deadzone angle depending on the interconnecting torque by means of an adaptive estimator, wherein in the adaptive estimator the backlash is modelled in terms of a variable stiffness of the shaft.
- Backlash shows up as the loss of engagement between the motor and the load due to the developing deadzone or gap in the coupling mechanism. A certain amount of backlash is required in mating gears in order to compensate for any thermal expansion, allow the incorporation of lubricants and
- the clearance between the non-working flanks of a gear pair is referred to as the backlash. It is formed when the load flanks are touching. Backlash can describe the loss of engagement between the motor and the load.
- the interconnecting torque can be the torque of the load.
- the deadzone angle is determined by means of an adaptive estimator, wherein in the adaptive estimator the backlash is modelled in terms of a variable stiffness of the shaft. In comparison to known deadzone models, in which the interconnecting torque is zero inside the deadzone and has a predetermined value outside the deadzone, the backlash can be estimated in a more reliable manner.
- the method can be performed during operation of the drive-train system.
- the interconnecting torque is determined
- the velocity of the load and in particular the angular velocity of the load can be
- the angular position of the load and the load or backlash friction can be measured.
- the angular velocity and/or the angular position of the motor can be measured.
- a load inertia and a load friction an error is determined and the interconnection torque is determined based on the error.
- the dynamic of a state estimation error can be determined.
- an injection signal can be determined, which reaches a sliding manifold and remains thereafter.
- the interconnecting torque is determined by means of a sliding mode observer.
- a sliding mode observer Preferably, a second-order sliding mode observer (SMO) is used.
- SMO second-order sliding mode observer
- a super-twisting sliding mode observer (STSMO) is used for estimating the backlash torque. This value is used in an adaptive estimator design for finding the deadzone angle .
- the deadzone angle is determined by means of an adaptive estimator.
- variable stiffness is modelled depending on a predetermined function.
- a function can be used, which is based on an arctan-function .
- This function can include a parameter to adapt the slope for the change in the stiffness.
- a further method according to the invention serves for controlling a drive motor of mechanical drive-train system, wherein the drive motor is controlled depending on the deadzone angle, which is determined by means of a method for determining the deadzone angle.
- a controller according to the invention for a mechanical drive-train system is adapted for performing a method for determining the deadzone angle and/or a method for
- a drive-train system comprises a controller according to the invention.
- the drive- train system is a single axis mechanical drive-train system.
- the preferred embodiments presented with respect to the method for determining the deadzone angle according to the invention and the advantages thereof correspondingly apply to the method for controlling the drive motor according to the invention, to the controller according to the invention as well as to the drive-train system according to the invention.
- FIG 1 in a schematic drawing, a drive-train system
- FIG 2 a block diagram of an open-loop mechanical drive train system
- FIG 3 in a schematic drawing a deadzone angle of a
- FIG 4 a stiffness of the shaft varying between two
- FIG 5 a backlash torque using a deadzone model and a
- FIG 6 a real and an estimated backlash torque scaled by load inertia
- FIG 7 a real and an estimated change of a deadzone angle
- FIG 8 an estimation error of the deadzone angle.
- FIG 1 shows a drive-train system 1 that comprises a drive motor 2, a load 3 and a shaft 4.
- the drive-train system 1 is designed as a single axis drive train system.
- the angular velocities of the motor 2 and the load a denoted by ⁇ ⁇ , ⁇ , respectively, while v T is the tool linear velocity.
- the box 5 describes the gearing and shaft dynamics and the box 6 describes the linear axis dynamics.
- a typical single-axis machine tool consists of a linear axis, which positions the tool on a line.
- the axis is actuated by the drive motor 2, which is typically connected to an
- the drive motor 2 can be a permanent magnet synchronous motor (PMSM) , typically used for actuating linear axes in machine tools, especially for highly dynamic tasks.
- the motor is position-controlled with a controller 7.
- the controller 7 can comprise a cascade of a proportional (P) and a proportional- integral (PI) controller, used for the position and the velocity loops, respectively.
- the electrical closed-loop dynamics is much faster than this the mechanical system. Moreover, since the focus of this work is on the identification of backlash, i.e. on the level of the accelerations, and since the torque produced by the motor 2 is measured, the closed-loop
- ⁇ m is the motor angular velocity
- ⁇ m is the motor angular position
- ⁇ l is the load angular velocity
- ⁇ l is the load angular position
- u is the torque command
- T Fm is the motor friction
- T Fi is the load friction or the backlash friction
- T t is the load torque.
- J m is the motor inertia
- J t is the load inertia
- N is the gearing ratio.
- K s is the shaft stiffness
- D s is the shaft damping
- T Fm comes mostly from the contacting surfaces of the motor bearings while T Fi describes the total Coulomb and viscous friction in the load.
- Tc,m is the Coulomb friction on the motor and T ci is the
- T Cm , T cl , ⁇ m and ⁇ l are considered known and constant.
- sgn(.) is the signum function defined as:
- FIG 2 illustrates a block diagram of the drive-train system in open loop.
- the block labelled "DZ" represents the backlash zone .
- Backlash shows up as a loss of engagement between two moving parts (e.g. motor 2 and load 3) due to a developing gap
- the backlash phenomenon can be interpreted as either a sudden change in the load inertia or even in the shaft stiffness.
- the backlash torque is modelled after the restoring and damping torques in a mass-spring- damper system. While in the deadzone, these two torques are either vanishing or becoming very small, nearly zero.
- the proposed model is based on a factorization of the
- a is a large positive real number that parametrizes how stiff the change in the stiffness is. For it is clear that This can also be seen in FIG 4, where the stiffness and the corresponding backlash torques are
- FIG 5 shows the backlash torque for a sinusoidal using a
- the deadzone angle ⁇ should be estimation for dive- train system 1. This can be summarised in the following problem formulation: Given the single-axis drive-train system described in equations (1) to (7) and the backlash model in equations (12) and (13), design an online dynamic estimator for the deadzone angle ⁇ with the following requirements: Maximum estimation error smaller than 10 ⁇ 3 rad and asymptotic convergence to the real parameter value.
- the estimation of the deadzone angle ⁇ belongs to the family of problems of online parameter estimation in systems with nonlinear parametrization .
- the approach followed here is based on a method for parameter estimation in nonlinearly parametrized systems presented in H. F. Grip, T. A. Johansen, L. Imsland, and G.-o. Kaasa: "Parameter estimation and compensation in systems with nonlinearly parameterized perturbations" Automatica, vol. 46, no. 1, pp. 19-28, 2010.
- the basic idea relates to estimating a perturbation of the system dynamics that depends on the unknown parameter and then finding an adaptation law for estimating the parameter itself .
- the method pertains to finding an estimation of the perturbation
- the method is divided in two parts: estimation of the perturbation ⁇ and derivation of the adaptation law
- a second-order sliding mode observer is used for finding an estimate of ⁇ .
- SMOs can offer finite- time estimation of unmeasured states by using high-frequency injection signals in their design, which depend on the observer innovation term. By doing so, the estimation error dynamics reaches the sliding manifold, i.e. a manifold on which the error is zero, and remains thereafter. This provides at the same time an estimation of any unknown perturbations that affect the system dynamics. This can become clearer in the following:
- the estimator design is inspired by the method proposed in Grip et al . for the estimation of unknown parameters. For the rest of the analysis it is considered that the unknown parameter 5 lies in a compact set and the backlash angle estimation error is defined as For
- the Lyapunov function candidate is defined as where ⁇ is a real positive number to be defined.
- the function is positive definite since
- a STSMO for the load velocity is designed according to equations (17) and (19) is designed.
- the backlash torque according to equation (20) is estimated.
- the adaptive estimator for the deadzone angle ⁇ according to equations (33) to (36) is designed.
- controller is used to regulate the drive motor velocity into following a sinusoidal profile
- a 5% change in the deadzone angle ⁇ is considered for the evaluation of the algorithm.
- the velocity measurements are afflicted with white Gaussian noise High precision absolute
- the compact set 9 is the real axis interval [0, 1] , the estimator is initialized at is chosen to
- the sampling time is 2 ms .
- FIG 6 shows the real torque applied in the system
- the real deadzone angle ⁇ and estimated deadzone angle as well as the estimation error ⁇ are shown in FIG 7 and 8, respectively. It can be seen from the plots that the deadzone angle ⁇ is estimated in less that 1 s (200-400 ms) and in sufficient accuracy. Specifically, the average steady state estimation error is less than 2 ⁇ 10 -6 rad, which is smaller than the order of magnitude for positioning precision in machine tool applications (10 -3 rad) . Larger sensor noise has a direct impact on the speed of convergence and the steady state deviation.
- a method for deadzone angle estimation in a single-axis drive-train with backlash has been presented. After the interconnecting torque acting on both motor and load is estimated using a STSMO, an adaptive algorithm is designed for estimating the deadzone angle 5.
- the method was tested in a simulation framework, where the adaptive estimator was able to track the real value of the deadzone angle 5, as well as a 5% increase in the backlash.
- the parameter convergence was achieved in less than 1 s and with precision in the order of 2 ⁇ 10 -6 rad. Such precision allows for use of the estimated parameter in backlash compensation algorithms, typically present in machine-tool applications.
- detection of changes in the deadzone angle ⁇ can infer a measure of wear assessment in the mechanical components (i.e. gearing, coupling mechanisms etc.) of the system.
Landscapes
- Engineering & Computer Science (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Control Of Electric Motors In General (AREA)
- Control Of Position Or Direction (AREA)
- Feedback Control In General (AREA)
Abstract
The invention relates to a method for determining a deadzone angle (δ) of a backlash in a mechanical drive-train system (1), wherein the drive train-system (1) comprises a drive motor (2), a load (3) and a shaft (4) for connecting the drive motor (2) with the load (3), the method comprising the steps: estimating an interconnection torque (T
l ) in the deadzone, determining the deadzone angle (δ) depending on the interconnecting torque (T
l ) by means of an adaptive estimator, wherein in the adaptive estimator the backlash is modelled in terms of a variable stiffness (K
BL ) of the shaft (4).
Description
Description
Method for determining a deadzone angle of a backlash in a mechanical drive-train system, method for controlling a drive motor controller as well as drive-train system
The present invention relates to a method for determining a deadzone angle of a backlash in a mechanical drive-train system, wherein the drive-train system comprises a drive motor, a load and a shaft for connecting the drive motor with the load. Furthermore, the present invention relates to a method for controlling a drive motor of a drive train system. Moreover, the present invention relates to a controller for a drive-train system. Finally, the present invention relates to a drive train system.
Backlash is a common positioning-degrading phenomenon that shows up frequently in industrial machines. High-performance machine tools use backlash compensation algorithms to ensure accurate positioning of the tool. As such, estimation of the developing deadzones in gearing and other power transmission components is essential.
Developing backlash in coupling equipment due to wear is one of the main reasons for performance degradation in machine tool systems. Since high precision tool positioning is fundamental for obtaining the required quality of the
machined end-products, backlash compensation solutions are used in nearly all modern Computer Numerical Control (CNC) algorithms. This necessitates the knowledge of the backlash offset angle in advance so that it can be used in the
position controllers actuating the machine axes' motors.
Under this prism, online estimation method may facilitate an automatic compensation solution for developing backlash. A substantial amount of research has been conducted on
estimation of the backlash phenomenon for various systems over the past three decades. For example, the backlash in a gearing system can indirectly estimated by calculating the
bounce, i.e. the change of the speed of the driving part of the gear due to the backlash impact upon exiting the
deadzone. Extended Kalman Filter (EKF) are used for
estimating the backlash torque in a two-mass motor arm, based on torque and position measurements. The modelling of the backlash torque using a differentiable function is known, where a nonlinear observer is used for estimation of the backlash amplitude. This method was also validated
experimentally, wherein a sliding mode observer is used for the estimation of the backlash torque. The backlash function parameters are identified offline based on this estimation. The effect of the deadband due to backlash in a closed loop motion system was studied using describing functions. Here, the functions parameters are calculated online using a static relation for the controller gains. Backlash in automotive powertrains can be described based on the position difference between drive motor and load. Kalman filter is used for backlash estimation with 10% error. A four-parameter model for describing backlash effect for generic linear cascade systems is also known. The backlash identification is treated as a quasi-linear problem using iterative algorithms.
Minimization of a quadratic prediction error is known using position, velocity and torque measurements for offline identification of backlash torques in a vehicle driveline system.
In the previous approaches, the backlash phenomenon is described in terms of the resulting torque upon contact of the two moving parts of the coupling. In the cases where the deadzone angle is identified directly, this is done offline or around a linearization point of the system. The results show accuracy that prohibits the use of the estimates in any backlash compensation algorithms for systems where high precision is required.
It is an object of the present invention to provide a
solution, how a deadzone angle in a drive-train system can be estimated in a more reliable manner.
According to the invention this object is solved by a method for determining a deadzone angle, by a method for controlling a drive motor, by a controller and by a drive-train system having the features according to the respective independent claims. Advantageous embodiments of the invention are the subject matter of the dependent claims.
A method according to the invention serves for determining a deadzone angle of a backlash in a mechanical drive-train system, wherein the drive train-system comprises a drive motor, a load and a shaft for connecting the drive motor with the load. The method comprising the steps: estimating an interconnection torque in the deadzone and determining the deadzone angle depending on the interconnecting torque by means of an adaptive estimator, wherein in the adaptive estimator the backlash is modelled in terms of a variable stiffness of the shaft. Backlash shows up as the loss of engagement between the motor and the load due to the developing deadzone or gap in the coupling mechanism. A certain amount of backlash is required in mating gears in order to compensate for any thermal expansion, allow the incorporation of lubricants and
compensate for any potential tolerances as regards
installation inaccuracies. In particular, the clearance between the non-working flanks of a gear pair is referred to as the backlash. It is formed when the load flanks are touching. Backlash can describe the loss of engagement between the motor and the load. The interconnecting torque can be the torque of the load. Here, the deadzone angle is determined by means of an adaptive estimator, wherein in the adaptive estimator the backlash is modelled in terms of a variable stiffness of the shaft. In comparison to known deadzone models, in which the interconnecting torque is zero inside the deadzone and has a predetermined value outside the deadzone, the backlash can be estimated in a more reliable
manner. Furthermore, the method can be performed during operation of the drive-train system.
Preferably, the interconnecting torque is determined
depending on the load velocity. The velocity of the load and in particular the angular velocity of the load can be
measured. Therefore, the interconnecting torque can
determined in a simple manner. Furthermore, the angular position of the load and the load or backlash friction can be measured. Moreover, the angular velocity and/or the angular position of the motor can be measured.
According to a further embodiment, depending on the load velocity, a load inertia and a load friction an error is determined and the interconnection torque is determined based on the error. Depending on the load velocity the dynamic of a state estimation error can be determined. Here, an injection signal can be determined, which reaches a sliding manifold and remains thereafter.
It is further advantageous, if the interconnecting torque is determined by means of a sliding mode observer. Preferably, a second-order sliding mode observer (SMO) is used. In
particular, a super-twisting sliding mode observer (STSMO) is used for estimating the backlash torque. This value is used in an adaptive estimator design for finding the deadzone angle .
According to a further embodiment, the deadzone angle is determined by means of an adaptive estimator. For the
estimation of the deadzone angle is based on a method for parameter estimation in nonlinearity parameterized systems. This method is presented in H. F. Grip, T. A. Johansen, L. Imsland, and G.-o. Kaasa: "Parameter estimation and
compensation in systems with nonlinearly parameterized perturbations" Automatica, vol. 46, no. 1, pp. 19-28, 2010. The basic idea relates to estimating a perturbation of the system dynamics that depends on the unknown parameter and
then finding an adaptation law for estimating the parameter itself .
According to a further embodiment, the variable stiffness is modelled depending on a predetermined function. For example, a function can be used, which is based on an arctan-function . This function can include a parameter to adapt the slope for the change in the stiffness. A further method according to the invention serves for controlling a drive motor of mechanical drive-train system, wherein the drive motor is controlled depending on the deadzone angle, which is determined by means of a method for determining the deadzone angle.
A controller according to the invention for a mechanical drive-train system is adapted for performing a method for determining the deadzone angle and/or a method for
controlling the drive motor.
A drive-train system according to the invention comprises a controller according to the invention. Preferably, the drive- train system is a single axis mechanical drive-train system. The preferred embodiments presented with respect to the method for determining the deadzone angle according to the invention and the advantages thereof correspondingly apply to the method for controlling the drive motor according to the invention, to the controller according to the invention as well as to the drive-train system according to the invention.
Further features of the invention are apparent from the claims, the figures and the description of figures. The features and feature combinations mentioned above in the description as well as the features and feature combinations mentioned below in the description of figures and/or shown in the figures alone are usable not only in the respectively
specified combination, but also in other combinations or alone without departing from the scope of the invention
Now, the invention is explained in more detail based on preferred embodiments as well as with reference to the attached drawings .
These show in:
FIG 1 in a schematic drawing, a drive-train system
comprising a drive motor, a shaft and a load;
FIG 2 a block diagram of an open-loop mechanical drive train system;
FIG 3 in a schematic drawing a deadzone angle of a
backlash between a drive motor and the load;
FIG 4 a stiffness of the shaft varying between two
values ;
FIG 5 a backlash torque using a deadzone model and a
varying stiffness model;
FIG 6 a real and an estimated backlash torque scaled by load inertia;
FIG 7 a real and an estimated change of a deadzone angle and
FIG 8 an estimation error of the deadzone angle.
In the figures, identical or functionally identical elements are provided with the same reference characters.
FIG 1 shows a drive-train system 1 that comprises a drive motor 2, a load 3 and a shaft 4. The drive-train system 1 is designed as a single axis drive train system. The angular
velocities of the motor 2 and the load a denoted by ωγη, ω, respectively, while vT is the tool linear velocity. The box 5 describes the gearing and shaft dynamics and the box 6 describes the linear axis dynamics.
A typical single-axis machine tool consists of a linear axis, which positions the tool on a line. The axis is actuated by the drive motor 2, which is typically connected to an
angular-to-linear motion conversion system (e.g. a ball-screw axis) . The combined elasticity, friction, damping and total mass of all the mechanical components that connect to the drive shaft 4 motivate a collective description of the single-axis machine tool as a mechanical drive train. The latter consists of the drive motor 2, one flexible shaft 4 with damping and backlash and a generalised load 3 with friction. The correspondence between the single-axis machine tool and the abstraction of the mechanical drive-train can be seen in FIG 1. The drive motor 2 can be a permanent magnet synchronous motor (PMSM) , typically used for actuating linear axes in machine tools, especially for highly dynamic tasks. The motor is position-controlled with a controller 7. The controller 7 can comprise a cascade of a proportional (P) and a proportional- integral (PI) controller, used for the position and the velocity loops, respectively.
In general, the electrical closed-loop dynamics is much faster than this the mechanical system. Moreover, since the focus of this work is on the identification of backlash, i.e. on the level of the accelerations, and since the torque produced by the motor 2 is measured, the closed-loop
electrical dynamics of the motor will not be considered here. This does not affect he design or the estimation algorithms as it will become clearer later in the analysis.
The dynamics of the mechanical drive-train system 1 reads:
ωm is the motor angular velocity, θm is the motor angular position, ωl is the load angular velocity and θl is the load angular position, u is the torque command, TFm is the motor friction, TFi is the load friction or the backlash friction and Tt is the load torque. Jm is the motor inertia, Jt is the load inertia and N is the gearing ratio.
Ks is the shaft stiffness, Ds is the shaft damping
coefficient. Ks, Ds and N and are assumed to be known. The friction torques acting on the drive motor and the load express different frictional phenomena. TFm comes mostly from the contacting surfaces of the motor bearings while TFi describes the total Coulomb and viscous friction in the load. The two friction torques are modelled as described in the following equations:
Tc,m is the Coulomb friction on the motor and Tci is the
Coulomb friction on the load. βm is the motor viscous
friction coefficient and βι is the load viscous friction coefficient . TCm, Tcl, βm and βl are considered known and constant. sgn(.) is the signum function defined as:
FIG 2 illustrates a block diagram of the drive-train system in open loop. The block labelled "DZ" represents the backlash zone .
Backlash shows up as a loss of engagement between two moving parts (e.g. motor 2 and load 3) due to a developing gap
(deadzone) in the coupling mechanisms as shown in FIG 3. Alternatively, the backlash phenomenon can be interpreted as either a sudden change in the load inertia or even in the shaft stiffness. In general, the backlash torque is modelled after the restoring and damping torques in a mass-spring- damper system. While in the deadzone, these two torques are either vanishing or becoming very small, nearly zero. A number of studies have been carried out regarding the
description of the torques due to backlash. The most
intuitive and common one is the so-called deadzone model, in which the interconnection torque becomes zero inside the deadzone. Outside the deadzone the angle difference is offset by the width of the deadzone angle 5. An approach is known, where the ratio of the angle differences over the deadzone width is considered. Dynamical models are known, which pertain to expressing the backlash torque as a sudden impact. The torque is again given by a mass-spring-damper system, where the elastic linear relative deformation of the two colliding coupling parts has its own stiff dynamics. A different dynamical model is known, in which a backlash angle δ is defined and its dynamics is used for calculating the impact torque. Most of the above-mentioned backlash models are effectively describing the phenomenon but they typically become difficult to use for control and estimation purposes due to their heavy discontinuities that often create
numerical issues. This problem becomes even more apparent for non-constant deadzone, i.e. when the backlash angle δ
increases over time due to wear.
A model for backlash, based on changing shaft stiffness, which is suitable for deadzone estimation and monitoring will be presented and will be compared to the deadzone model.
The proposed model is based on a factorization of the
backlash torque with respect to the shaft stiffness. The latter is very small, virtually zero, inside the deadzone and assumes its nominal value outside of it. The transition between the two extreme values of the stiffness is steep but smooth. The corresponding torque reads:
a is a large positive real number that parametrizes how stiff the change in the stiffness is. For
it is clear that
This can also be seen in FIG 4, where the stiffness and the corresponding backlash torques are
plotted for different values of the parameter a. FIG 5 shows the backlash torque for a sinusoidal using a
deadzone model and the varying stiffness models for different values of the parameter a.
Here, the deadzone angle δ should be estimation for dive- train system 1. This can be summarised in the following
problem formulation: Given the single-axis drive-train system described in equations (1) to (7) and the backlash model in equations (12) and (13), design an online dynamic estimator for the deadzone angle δ with the following requirements: Maximum estimation error smaller than 10~3 rad and asymptotic convergence to the real parameter value.
The estimation of the deadzone angle δ belongs to the family of problems of online parameter estimation in systems with nonlinear parametrization . The approach followed here is based on a method for parameter estimation in nonlinearly parametrized systems presented in H. F. Grip, T. A. Johansen, L. Imsland, and G.-o. Kaasa: "Parameter estimation and compensation in systems with nonlinearly parameterized perturbations" Automatica, vol. 46, no. 1, pp. 19-28, 2010. The basic idea relates to estimating a perturbation of the system dynamics that depends on the unknown parameter and then finding an adaptation law for estimating the parameter itself .
are the unforced system dynamics and time-varying input gain, respectively, which can be evaluated from the measurements.
is the unknown parameter,
is the control input and
is a known matched disturbance vector, which can be evaluated if δ is known. The method pertains to finding an estimation of the perturbation
Regarding the drive-train system 1, since all the states are measured and the unknown parameter δ affects the dynamics of both the motor and the load in the same way, i.e. through the torque Tlr either of the subsystems in equations (1) , (3) can be chosen to apply the method on. For simplicity, the load velocity dynamics is chosen. The system can be written in the form of equation {14) with
where has been defined in equations (12), (13) and
1. The method is divided in two parts: estimation of the perturbation φ and derivation of the adaptation law
A second-order sliding mode observer (SMO) is used for finding an estimate of φ. In general SMOs can offer finite- time estimation of unmeasured states by using high-frequency injection signals in their design, which depend on the observer innovation term. By doing so, the estimation error dynamics reaches the sliding manifold, i.e. a manifold on which the error is zero, and remains thereafter. This provides at the same time an estimation of any unknown perturbations that affect the system dynamics. This can become clearer in the following:
error and v is an appropriate high frequency term depending on the innovation signal . Define the sliding manifold
error reads :
If the error dynamics reach the sliding manifold, then
for all future times, which means that In other
words, if the injection signal v is designed such that the estimation error dynamics reaches the sliding manifold S and remains thereafter, then the unknown perturbation is
estimated by v. The design of v is given in:
where klr k2 are positive gains. The resulting observer is called the STSMO and it was proven that for appropriate gains klr k2 the term v brings the observer error dynamics on the sliding manifold S. Hence, the unknown perturbation can be estimated by equation (19), where
The choice of a second order SMO for a system of relative degree 1 (the subsystem is scalar) was made due to the property of higher order SMOs of alleviating the chattering in the injection and estimation signals.
The estimator design is inspired by the method proposed in Grip et al . for the estimation of unknown parameters. For the rest of the analysis it is considered that the unknown parameter 5 lies in a compact set
and the backlash angle estimation error is defined as
For
determining the backlash error angle estimator three
assumptions and one theorem are used:
Theorem 1: Consider the dynamics of the load velocity expressed m the form of equation (14) with and
ά(χ,δ) = Τι χ,δ) defined in equations (11) and (13). The adaptive estimator
with γ > 0 being the adaptation gain, an asymptotic
in V-A, ensures that the estimation error
asymptotically converges to 0, uniformly in x if assumptions 1 to 3 are satisfied . Inspired by Grid et al . and assuming constant deadzone angle δ, the dynamics of the parameter estimation error can be written as
Substituting the asymptotic estimate with the real
The Lyapunov function candidate is defined as
where κ is a real positive number to be defined. The function is positive definite since
The time derivate of V along the trajectory of the
estimation error reads:
Using assumptions 1 to 3 in the inequality above and
introducing M, ∑ as upper bounds for |μ(χ,5)|, |σ(χ)|,
From inequality (29) it can be seen that
is negative definite if κ is chosen as
and by Lasalle-Yoshizawa theorem the equilibrium point
is uniformly asymptotically stable, which completes the proof .
The final steps of the design concern satisfying assumptions 1 to 3. Selecting as
Since x and σ(χ) are bounded and
is compact, it is easy to show that there exits L > 0, such that condition (22) holds. The inequality expresses a type of
persistence of excitation (PE) condition. From equations (32) to (34) it can be seen that this condition does not hold if during the time interval [t,t + T] the system is always within the deadzone. This, however, is expected, since in that case there is no engagement between motor and load, hence no information about the stiffness of the shaft connecting them. The adaptation law for the parameter estimate
is finally given by:
where
It is interesting to note that the selection of the specific μ(χ, 5) function results into a gradient-type adaptation law, which is very common in the literature of adaptive
techniques. Although for nonlinearly parametrized systems it does not always guarantee parameter convergence as it does for linear-in-the-parameters systems, it is a natural first choice for the adaptation law.
In the algorithm for the backlash angle estimation, ω?η, 9mr (ύι, θι and TFi are measured. The output is the deadzone angle
5. In a first step, a STSMO for the load velocity is designed
according to equations (17) and (19) is designed. In a second step, the backlash torque according to equation (20) is estimated. In a third step, the adaptive estimator for the deadzone angle δ according to equations (33) to (36) is designed.
The drive-train system was simulated so that the performance of the estimation algorithm could be assessed. A PI
controller is used to regulate the drive motor velocity into following a sinusoidal profile
A 5% change in the deadzone angle δ is considered for the evaluation of the algorithm. The velocity measurements are afflicted with white Gaussian noise High precision absolute
position encoders are used and the error due to quantization is ignored. The compact set 9 is the real axis interval [0, 1] , the estimator is initialized at is chosen to
be 0.1 and the sampling time is 2 ms .
FIG 6 shows the real torque applied in the system
according to the deadzone model and its estimation by the STSMO. A small lag can be observed in the estimation of
which, however, does not affect the performance of the algorithm. Increasing the gains / ,k2 of the observer reduces the delay in estimation but makes the method more sensitive to measurement noise.
The real deadzone angle δ and estimated deadzone angle
as well as the estimation error δ are shown in FIG 7 and 8, respectively. It can be seen from the plots that the deadzone angle δ is estimated in less that 1 s (200-400 ms) and in sufficient accuracy. Specifically, the average steady state estimation error is less than 2■ 10-6 rad, which is smaller than the order of magnitude for positioning precision in machine tool applications (10-3 rad) . Larger sensor noise has a direct impact on the speed of convergence and the steady state deviation.
A method for deadzone angle estimation in a single-axis drive-train with backlash has been presented. After the interconnecting torque acting on both motor and load is estimated using a STSMO, an adaptive algorithm is designed for estimating the deadzone angle 5. The method was tested in a simulation framework, where the adaptive estimator was able to track the real value of the deadzone angle 5, as well as a 5% increase in the backlash. The parameter convergence was achieved in less than 1 s and with precision in the order of 2 · 10-6 rad. Such precision allows for use of the estimated parameter in backlash compensation algorithms, typically present in machine-tool applications. Moreover, detection of changes in the deadzone angle δ can infer a measure of wear assessment in the mechanical components (i.e. gearing, coupling mechanisms etc.) of the system.
Claims
1. Method for determining a deadzone angle (δ) of a backlash in a mechanical drive-train system (1) , wherein the drive train-system (1) comprises a drive motor (2) , a load (3) and a shaft (4) for connecting the drive motor (2) with the load (3), the method comprising the steps:
- estimating an interconnection torque (Tt) in the deadzone,
- determining the deadzone angle (δ) depending on the interconnecting torque (Tt) by means of an adaptive
estimator,
- wherein in the adaptive estimator the backlash is modelled in terms of a variable stiffness (KBL) of the shaft (4) .
2. Method according to claim 1, characterized in that, the interconnecting torque (Tt) is determined depending on the angular load velocity (ω∑) .
3. Method according to claim 2, characterized in that, depending on the angular load velocity (ω∑) , a load inertia (Ji) and a load friction (TFii) an error is determined and the interconnection torque (Tt) is determined based on the error.
4. Method according to 2 or 3, characterized in that, the interconnecting torque (Tt) is determined by means of a sliding mode observer.
5. Method according to any one of the preceding claims, characterized in that, the deadzone angle (δ) is determined by means of an adaptive estimator.
6. Method according to any one of the preceding claims, characterized in that, the variable stiffness (KBL) is modelled depending on a predetermined function.
7. Method for controlling a drive motor (2) of drive-train system (1) , wherein the drive motor (2) is controlled
depending on the deadzone angle (δ) , which is determined by means of a method according to claims 1 to 6.
8. Controller (7) for a mechanical drive-train system (1), which is adapted for performing a method according to claims 1 to 6 and/or a method according to claim 7.
9. Drive-train system (1) comprising a controller (7) according to claim 8.
10. Drive-train system (1) according to claim 9,
characterized in hat, the drive-train system (1) is a single axis mechanical drive-train system.
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
EP16195975 | 2016-10-27 | ||
EP16195975.4 | 2016-10-27 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2018077593A1 true WO2018077593A1 (en) | 2018-05-03 |
Family
ID=60182529
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/EP2017/075476 WO2018077593A1 (en) | 2016-10-27 | 2017-10-06 | Method for determining a deadzone angle of a backlash in a mechanical drive-train system, method for controlling a drive motor controller as well as drive-train system |
Country Status (1)
Country | Link |
---|---|
WO (1) | WO2018077593A1 (en) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112149274A (en) * | 2020-08-19 | 2020-12-29 | 浙江工业大学 | Online modeling method for multi-axis engraving machine system with dead zone input nonlinearity |
CN114006557A (en) * | 2021-09-30 | 2022-02-01 | 湖南科技大学 | Permanent magnet synchronous motor mechanical parameter identification method based on extended sliding-mode observer |
CN114362626A (en) * | 2022-01-28 | 2022-04-15 | 同济大学 | Prediction control method and system for supercoiled sliding-mode observer of permanent magnet synchronous motor |
-
2017
- 2017-10-06 WO PCT/EP2017/075476 patent/WO2018077593A1/en active Application Filing
Non-Patent Citations (4)
Title |
---|
DIMITRIOS PAPAGEORGIOU, MOGENS BLANKE, HANS HENRIK NIEMANN, JAN H. RICHTER: "Backlash estimation for industrial drive-train systems", IFAC-PAPERSONLINE, vol. 50, no. 1, 14 July 2017 (2017-07-14), pages 3281 - 3286, XP002777194, ISSN: 2405-8963 * |
H. F. GRIP; T. A. JOHANSEN; L. IMSLAND; G.-O. KAASA: "Parameter estimation and compensation in systems with nonlinearly parameterized perturbations", AUTOMATICA, vol. 46, no. 1, 2010, pages 19 - 28, XP026825081 |
LAGERBERG A ET AL: "Estimation of backlash with application to automotive powertrains", 42ND. IEEE CONFERENCE ON DECISION AND CONTROL.(CDC). MAUI, HI, DEC. 9 - 12, 2003; [IEEE CONFERENCE ON DECISION AND CONTROL], NEW YORK, NY : IEEE, US, vol. 5, 9 December 2003 (2003-12-09), pages 4521 - 4526, XP010686407, ISBN: 978-0-7803-7924-4, DOI: 10.1109/CDC.2003.1272259 * |
MING YANG ET AL: "Study of on-line backlash identification for PMSM servo system", IECON 2012 - 38TH ANNUAL CONFERENCE ON IEEE INDUSTRIAL ELECTRONICS SOCIETY, IEEE, 25 October 2012 (2012-10-25), pages 2036 - 2042, XP032281099, ISBN: 978-1-4673-2419-9, DOI: 10.1109/IECON.2012.6388745 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112149274A (en) * | 2020-08-19 | 2020-12-29 | 浙江工业大学 | Online modeling method for multi-axis engraving machine system with dead zone input nonlinearity |
CN114006557A (en) * | 2021-09-30 | 2022-02-01 | 湖南科技大学 | Permanent magnet synchronous motor mechanical parameter identification method based on extended sliding-mode observer |
CN114006557B (en) * | 2021-09-30 | 2023-11-10 | 湖南科技大学 | Permanent magnet synchronous motor mechanical parameter identification method based on extended sliding mode observer |
CN114362626A (en) * | 2022-01-28 | 2022-04-15 | 同济大学 | Prediction control method and system for supercoiled sliding-mode observer of permanent magnet synchronous motor |
CN114362626B (en) * | 2022-01-28 | 2024-04-09 | 同济大学 | Prediction control method and system for supercoiled sliding mode observer of permanent magnet synchronous motor |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Kamalzadeh et al. | Robust compensation of elastic deformations in ball screw drives | |
Hoseinnezhad et al. | Calibration of resolver sensors in electromechanical braking systems: A modified recursive weighted least-squares approach | |
TWI716390B (en) | Servo motor control device and conflict detection method | |
Duchaine et al. | Computationally efficient predictive robot control | |
Garrido et al. | DC servomechanism parameter identification: A closed loop input error approach | |
Yang et al. | Neural network based output feedback control for DC motors with asymptotic stability | |
Shi et al. | Analysis of the transient backlash error in CNC machine tools with closed loops | |
Papageorgiou et al. | Robust backlash estimation for industrial drive-train systems—Theory and validation | |
US10591876B2 (en) | Method and system for adaptive compensation of dry friction | |
WO2018077593A1 (en) | Method for determining a deadzone angle of a backlash in a mechanical drive-train system, method for controlling a drive motor controller as well as drive-train system | |
Papageorgiou et al. | Backlash estimation for industrial drive-train systems | |
CN112549030B (en) | Anti-interference filtering-based flexible joint pose estimation method for space manipulator | |
Yao et al. | Output feedback robust control of direct current motors with nonlinear friction compensation and disturbance rejection | |
Weigand et al. | Flatness based control of an industrial robot joint using secondary encoders | |
CN111070203B (en) | Control system, control method, and control program | |
Yuan et al. | Error-bounded reference tracking MPC for machines with structural flexibility | |
Papageorgiou et al. | Online friction parameter estimation for machine tools | |
Prévost et al. | Feed drive modelling for the simulation of tool path tracking in multi-axis high speed machining | |
Li et al. | Identification and adaptive robust precision motion control of systems with nonlinear friction | |
WO2020217597A1 (en) | Servo control device | |
Papageorgiou et al. | Friction-resilient position control for machine tools—adaptive and sliding-mode methods compared | |
Verdonck et al. | Experimental robot identification: Advantages of combining internal and external measurements and of using periodic excitation | |
JP4789067B2 (en) | System identification apparatus and motor control apparatus including the same | |
JP7020200B2 (en) | Speed / position control system | |
Chen et al. | Robust indirect adaptive control of electromechanical servo systems with uncertain time-varying parameters |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
DPE1 | Request for preliminary examination filed after expiration of 19th month from priority date (pct application filed from 20040101) | ||
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 17790688 Country of ref document: EP Kind code of ref document: A1 |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 17790688 Country of ref document: EP Kind code of ref document: A1 |