Method and system for adaptive compensation of dry friction
AssigneeIxblue
InventorBernard Vau
Life of this patent
Estimating the term…
Abstract
A dry friction compensation method for at least one mass or inertia M mobile under the effect of at least one effector element controlled by a force or torque control signal U, the motion of the mass or inertia being characterized by a motion signal Y chosen among one or several of the position X, the speed V and the acceleration, the method includes: defining an ideal model of the closed loop; defining a dry friction compensation control law; the dry friction compensation control law being based on the following friction model: P = min ( max ( VM τ + U , - S ) , S ) , where V is the speed of the mobile mass or inertial subjected to the friction and τ a minor time constant, and S is a parameter of dry friction.
Claims17
A dry friction compensation method for a mechanical system of an apparatus that includes a mass or inertia M that is mobile under effect of an effector element controlled by a force or torque control signal U, the mass or inertia M having to move according to instructions of a setpoint signal Cr chosen among at least one of a position Xr, a speed Vr, and an acceleration, a motion of the mass or inertia being characterized by a motion measurement signal Y chosen among at least one of the position X, the speed V, and the acceleration, the method comprising:
- defining an ideal model of a closed loop, by receiving as an input the setpoint signal Cr, and producing as an output an ideal motion signal Ym relating to the motion of the mass or inertia according to an ideal model of the mechanical system;
- and
- defining a dry friction compensation control law, by receiving as an input the setpoint signal Cr and producing as an output the control signal U for the effector element that puts the mass or inertia in motion and whose motion is measured by a motion measurement sensor, said sensor producing a motion measurement signal Y, the dry friction compensation control law being adaptive as a function of a parameter of a dry friction value S,
- said dry friction compensation control law being based on the following friction model:
- P
- =
- min
-
- (
- max
-
- (
- VM
- τ
- +
- U
- ,
- -
- S
- )
- ,
- S
- )
- ,
- where V is the speed of the mobile mass or inertia subjected to the friction and τ a minor time constant;
- comparing the ideal motion signal Ym and the motion measurement signal Y with each other to produce an error signal s(t);
- calculating the estimation Ŝ of the dry friction S as a function of the error signal s(t);
- and
- using said estimation {umlaut over (S)} as a parameter of dry friction value in the dry friction compensation control law in order to correct the control signal as a function of the estimation Ŝ of the dry friction value.
A device, comprising:
- a calculator;
- a motion measurement sensor configured to produce a mass or inertia motion measurement signal Y corresponding to a motion of a mass or inertia M that is mobile under effect of an effector element and moving according to instructions of a setpoint signal Cr chosen among at least one of a position Xr, a speed Vr, and an acceleration, said motion measurement signal Y corresponding to at least one of the position X, the speed V, and the acceleration of the mass or inertia;
- and
- means for real time calculation in the calculator according to an adaptive dry friction compensation control law to produce a control signal U for the effector element,
- the calculator and means for real time calculation being configured to define the dry friction compensation control law by receiving the setpoint signal Cr as input and producing as an output the control signal U for the effector element that puts the mass or inertia in motion and whose motion is measured by the motion measurement sensor to produce the motion measurement signal Y, the dry friction compensation control law being adaptive as a function of a parameter of dry friction value S,
- said dry friction compensation control law being based on the following friction model:
- P
- =
- min
-
- (
- max
-
- (
- VM
- τ
- +
- U
- ,
- -
- S
- )
- ,
- S
- )
- ,
- where V is the speed of the mobile mass or inertia subjected to the friction and τ a minor time constant,
- the calculator and means for real time calculation configured to:
- compare an ideal motion signal Ym and the motion measurement signal Y with each other to produce an error signal s(t), the ideal motion signal Ym relating to the motion of the mass or inertia according to an ideal model of a closed loop of the mechanical system based on the setpoint signal Cr as input,
- calculate the estimation Ŝ of the dry friction S as a function of the error signal s(t), and
- use said estimation Ŝ as a parameter of dry friction value in the dry friction compensation control law in order to correct the control signal as a function of the estimation Ŝ of the dry friction value.
An apparatus, comprising:
- a mechanical system including at least one mass or inertia M that is mobile under the effect of an effector element controlled by a control signal U, the mass or inertia having to move according to the instructions of a setpoint signal Cr chosen among at least one of a position Xr, a speed Vr, and an acceleration;
- a motion measurement sensor that measures a motion of the mass or inertia and produces a motion measurement signal Y corresponding to at least one of the position X, the speed V and the acceleration of the mass or inertia;
- and
- a calculator, including means for adaptive compensation calculation according to an adaptive dry friction compensation control law to produce the control signal U,
- the calculator and means for adaptive compensation calculation configured to define the dry friction compensation control law by receiving the setpoint signal Cr as input and producing as an output the control signal U for the effector element that puts the mass or inertia in motion and whose motion is measured by the motion measurement sensor to produce the motion measurement signal Y, the dry friction compensation control law being adaptive as a function of a parameter of dry friction value S,
- said dry friction compensation control law being based on the following friction model:
- P
- =
- min
-
- (
- max
-
- (
- VM
- τ
- +
- U
- ,
- -
- S
- )
- ,
- S
- )
- ,
- where V is the speed of the mobile mass or inertia subjected to the friction and τ a minor time constant,
- the calculator and means for adaptive compensation calculation configured to:
- compare an ideal motion signal Ym and the motion measurement signal Y with each other to produce an error signal s(t), the ideal motion signal Ym relating to the motion of the mass or inertia according to an ideal model of a closed loop of the mechanical system based on the setpoint signal Cr as input,
- calculate the estimation Ŝ of the dry friction S as a function of the error signal s(t), and
- use said estimation Ŝ as a parameter of dry friction value in the dry friction compensation control law in order to correct the control signal as a function of the estimation Ŝ of the dry friction value.
Dependencies are inferred from the claim text.