Method for controlling a segment of an arm of a co-manipulator

Abstract

A method for controlling an actuator of a hinged segment including the steps of: estimating an inertia J of the segment and a minimum viscous hinge friction f; estimating or measuring a traveling speed {dot over (X)} of the segment and an internal deformation ΔX of the actuator; synthesizing a control law H.sub.∞ generating a control current (or torque) from the estimates or measurements and meeting a performance objective pertaining to a transfer function (I) between an acceleration {umlaut over (X)} of the segment and an external force F to which the segment is subjected: (II) with (III), ε being a mathematical artifact and s being the Laplace variable; and controlling the actuation of the hinged segment according to the control law thus synthesized.

Claims

1. A method for controlling an actuator of an articulated segment comprising the following steps: estimating an inertia J of the articulated segment and a minimum articulation viscous friction f; estimating or measuring a speed of movement {dot over (X)} of the articulated segment and an internal deformation ΔX of the actuator; synthesizing a control law of the H.sub.∞ type generating a control torque based on these estimations or measurements and meeting a performance objective relating to a transfer function $G\left(s\right)=\frac{\stackrel{\mathrm{.Math.}}{X}}{F}$ between an acceleration {umlaut over (X)} of the articulated segment and an external force F applied to the articulated segment: ∥G(s)W.sub.s(s)∥.sub.∞≦1 with $W_s\left(s\right)={\left(\frac{s+\mathrm{.Math.}}{Js+f}\right)}^{-1},$ ε being a mathematical artifact and s the Laplace variable; applying constraint to solve the performance objective relating to the transfer function; controlling the actuator of the articulated segment according to the control law thus synthesized.

2. The method for controlling the actuator as claimed in claim 1, in which, the synthesis of the control law is carried out under at least one of the following constraints: a constraint relating to the control torque of the motor which must not exceed a given threshold for all the admissible forces; a constraint relating to the positions of the poles of the control law which must all be situated below a threshold frequency lower than or equal to a Nyquist frequency; a passivity constraint according to which the force/speed transfer function must be a positive real number.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

(1) The invention will be better understood in the light of the description that follows of one particular non-limiting embodiment of the invention, with reference to the figures of the appended drawings amongst which:

(2) FIG. 1 is a schematic view of a segment of arm of a co-manipulator actuated by means of a cable-driven actuator;

(3) FIG. 2 is a graph showing the Bode diagram of the segment and the threshold function;

(4) FIG. 3 is a block diagram of the closed-loop control implemented by means of the invention.

DETAILED DESCRIPTION OF EMBODIMENT OF THE INVENTION

(5) With reference to the figures, the invention is applied here to the control of an articulated segment of a robot arm usable in co-manipulation mode. The robot comprises an actuator 1 displacing a cable 2 wound around a mule pulley 3 and an articulation pulley 4 driving a segment 5 articulated about an articulation axis 6. The actuator here comprises a motor 7 associated with a reducer 8 which drives the nut of a ball-screw transmission 9 whose socket head screw is hitched to the cable 2 which passes inside the screw.

(6) According to the invention, the inertia J of the articulated segment 5 about the articulation axis 6 is firstly estimated. Various methods are known for estimating this inertia. Starting from the definition of the segment, the specific inertias of all the elements composing the segment may, for example, be translated into an inertia about the articulation axis 6 and all these inertias summed.

(7) Then, a viscous friction at constant speed is estimated. This is done by measuring the torque f resisting the movement of the segment when the actuator 1 moves the latter at constant speed {circumflex over (θ)}.

(8) Finally, a stiffness k of the transmission between the motor 7 and the articulation pulley 4 (essentially determined by the stiffness of the cable 2) is estimated. For this, the torque exerted on the articulation pulley is traced while the latter is blocked as a function of the angular position of the drive shaft of the motor 7. A stiffness k is deduced from this.

(9) The method of the invention comprises the step for synthesizing a control law for the actuator 1 such that the articulated segment 5 behaves as if the transmission between the motor 7 and the articulation pulley 7 were infinitely rigid, which amounts for the user to eliminating any undesirable effect due to the flexibility of the transmission.

(10) For this purpose, the transfer function

(11) $G\left(s\right)=\frac{\stackrel{\mathrm{.Math.}}{X}}{F}$
is measured, where {tilde over (X)} the acceleration of the articulated segment 5, and F is the external force acting on the articulated segment 5 (for example, the weight of a load that the segment is lifting). The variable s is the Laplace variable. According to one important aspect of the invention, the acceleration is not measured directly, but recomposed by means of a model. For this purpose, a speed {dot over (X)} of movement of the segment, together with an internal deformation ΔX, is firstly measured or estimated. This deformation can for example be estimated by measuring the position X of the segment and by estimating, based on the angular position of the actuation motor, a position X which would be that of the segment if the transmission were infinitely rigid. The difference ΔX=X−X corresponds to the internal deformation. The multiplication of the internal deformation ΔX by the stiffness k, estimated beforehand, yields an estimation of the internal stress. It is accordingly then possible to estimate the transfer function G(s).

(12) Using the conventional tools of the H.sub.∞ synthesis, a control law K is determined whose inputs are the speed {dot over (X)} and the internal deformation ΔX and whose output is a control torque, here represented by a control current (or torque) I, as is shown schematically in FIG. 3. The synthesis meets the following objective: ∥G(s)W.sub.s∥.sub.∞≦1 with

(13) $W_s={\left(\frac{s+\mathrm{.Math.}}{Js+f}\right)}^{-1},$
ε being a mathematical artifact and s the Laplace variable. In other words, on a Bode diagram, the characteristic of the transfer function G(s) is underneath the characteristic of the threshold function W.sub.s(s). On the Bode diagram in FIG. 2, the fine lines illustrate the behavior of the articulated segment in the absence of the control according to the invention, and the thick dashed line the threshold function W.sub.s(s). One of the aims of the method of the invention is to eradicate the peaks due to the flexibility of the transmission, so as to obtain a behavior of the arm close to the threshold function W.sub.s(s).

(14) Furthermore, and according to one particular aspect of the invention, at least one of the following constraints is imposed: a constraint relating to the power supply current (or control torque) of the motor which must not exceed a given threshold for all the admissible forces. This constraint is met by imposing that

(15) ${.Math.\frac{I}{F}.Math.}_{\infty }\le S,$
where I is the intensity of the current powering the motor of the actuator (or the torque demand on the motor), and S a given threshold; a constraint relating to the positions of the poles of the control law which must all be situated below a threshold frequency F.sub.s lower than or equal to the Nyquist frequency; a passivity constraint according to which the force/speed transfer function

(16) $H=\frac{F}{X}$
must be a positive real number. It is recalled that a transfer function H is positive and real if

(17) ${.Math.\frac{\alpha -H}{\alpha +H}.Math.}_{\infty }<1,$
or α is a strictly positive real number.

(18) Then, once the control law has been synthesized as has just been stated, this control law is used for controlling the actuator.

(19) The invention is not limited to what has just been described but, on the contrary, encompasses any variant within the scope as defined by the claims. In particular, the inertial characteristics (position, speed acceleration) of the segment of arm may relate to both linear movements as well as to angular movements.