1. Field of the Invention
The present invention relates to a process and a device for displacing a moveable unit on a base.
Said device is of the type comprising a controllable actuator, for example an electric motor, intended to give rise to a linear displacement of the moveable unit on the base, as well as a system which is formed of a plurality of elements which are brought into motion upon the displacement of said moveable unit.
Within the context of the present invention, said system exhibits at least two different motions and comprises as elements which may be brought into motion, in particular:
When the moveable unit is set into motion, said elements of the system begin to move. However, especially by reason of the aforesaid elastic link, these elements still continue to move when the displacement of the moveable unit has terminated and when the latter comes to a stop.
Such a continuance of the motions of said system is generally undesirable, since it may entail numerous drawbacks. In particular, it may disturb measurements, especially positioning measurements, which are made on the moveable unit or on these elements.
Also, an object of the present invention is to control the moveable unit in such a way that all the moving elements of said system, for example the base and/or auxiliary masses, are stationary at the end of the displacement of the moveable unit.
As regards said base, if it is mounted elastically with respect to the floor, it is known that, when the moveable unit is set into motion, during the acceleration and deceleration phases, it is subjected to the reaction of the force applied to the moveable unit by the actuator. This reaction load excites the base which then oscillates on its supports. This disturbs the relative positioning of the moveable unit with respect to the base, and greatly impedes the accuracy of the device.
This relative position error persists after the end of the displacement of the moveable unit and disappears only after the stabilization (which takes place much later) of the base.
Various solutions for remedying this drawback are known. Some of these solutions make provision in particular:
However, none of these known solutions is satisfactory, since their effectivenesses are restricted and since they all require supplementary means (disabling system, additional actuator, additional moveable unit) which increase in particular the complexity, the cost and the bulkiness of the device.
Moreover, above all, these solutions implement an action which acts only on the base and not on the other elements of the system which, for their part, continue to move when the moveable unit is stationary.
The object of the present invention is to remedy these drawbacks. It relates to a process for displacing, in an extremely accurate manner and at restricted cost, a moveable unit on a base mounted for example on the floor, whilst bringing all the motions to which this displacement gives rise to a stop at the end of the displacement, said moveable unit being displaced linearly according to a displacement which is predetermined in terms of distance and time, under the action of a controllable force.
Accordingly, said process is noteworthy according to the invention in that:
Thus, the force applied to the moveable unit enables the latter to carry out the predetermined displacement envisaged, especially in terms of time and distance, whilst rendering the elements brought into motion by this displacement immobile at the end of the displacement so that they do not oscillate and, in particular, do not disturb the relative positioning between themselves and the moveable unit.
It will be noted moreover that, by reason of this combined control of said moveable unit and of said moving elements, one obtains an extremely accurate displacement of the moveable unit in a reference frame independent of the base and tied for example to the floor.
It will be noted that the implementation of the process in accordance with the invention is not limited to a displacement along a single axis, but can also be applied to displacements along several axes which can be regarded as independent.
Advantageously, in step a), the following operations are carried out: the variables of the system are denoted xi, i going from 1 to p, p being an integer greater than or equal to 2, and the balance of the forces and of the moments is expressed, approximating to first order if necessary, in the so-called polynomial matrix form:
A(s)X=bF
with:
Thus, a fast and general method of calculation is obtained for calculating the relations between the variables of the system and said intermediate variable, in the form of linear combinations of the latter and of its derivatives with respect to time.
Advantageously, in step d), a polynomial expression for the intermediate variable y is used to determine the value of the latter.
In this case, preferably, the initial and final conditions of the different variables of the system, together with the expressions defined in step b), are used to determine the parameters of this polynomial expression.
In a first embodiment, for displacing a moveable unit on a base which is mounted elastically with respect to the floor and which may be subjected to linear and angular motions, advantageously, the variables of the system are the linear position x of the moveable unit, the linear position xB of the base and the angular position θz of the base, which satisfy the relations:
in which:
This first embodiment makes it possible to remedy the aforesaid drawbacks (inaccurate displacement, etc) related to the setting of the base into oscillation during the displacement of the moveable unit.
In a second embodiment, for displacing on a base a moveable unit on which are elastically mounted a number p of auxiliary masses MAi, p being greater than or equal to 1, i going from 1 to p, advantageously, the variables of the system are the position x of the moveable unit and the (linear) positions zi of the p auxiliary masses MAi, which satisfy the relations:
in which:
In a third embodiment, for displacing a moveable unit on a base which is mounted elastically with respect to the floor and on which is elastically mounted an auxiliary mass, advantageously, the variables of the system are the positions x, xB and zA respectively of the moveable unit, of the base and of the auxiliary mass, which satisfy the relations:
in which:
In a fourth embodiment, for displacing on a base mounted elastically with respect to the floor, a moveable unit on which is elastically mounted an auxiliary mass, advantageously, the variables of the system are the positions x, xB and zC respectively of the moveable unit, of the base and of the auxiliary mass, which satisfy the relations:
in which:
The present invention also relates to a device of the type comprising:
According to the invention, said device is noteworthy in that it furthermore comprises means, for example a calculator:
Thus, over and above the aforesaid advantages, the device in accordance with the invention does not require any additional mechanical means, thereby reducing its cost and its bulkiness and simplifying its embodiment, with respect to the known and aforesaid devices.
The figures of the appended drawing will elucidate the manner in which the invention may be embodied. In these figures, identical references designate similar elements.
FIGS. 3 to 7 represent graphs which illustrate the variations over time of variables of the system, for a first embodiment of the device in accordance with the invention.
FIGS. 8 to 13 represent graphs which illustrate the variations over time of variables of the system, for a second embodiment of the device in accordance with the invention.
The device 1 in accordance with the invention and represented diagrammatically in
This device 1 can for example be applied to fast XY tables used in microelectronics, to machine tools, to conveyors, to robots, etc.
In a known manner, said device 1 comprises, in addition to the base 2 and to the moveable unit 4:
Within the context of the present invention, the device 1 comprises a system S1, S2 which is formed of various elements specified hereinbelow and variables according to the embodiment contemplated, which are brought into motion upon the displacement of the moveable unit 4.
According to the invention, said device 1 is improved in such a way as to obtain directly at the end of a displacement of the moveable unit 4:
To do this, the device 1 moreover comprises, according to the invention, calculation means 6 which calculate a particular force F, which is intended to be transmitted in the form of a control command to the actuator 5, as illustrated by a link 7, and which is such that, applied to said moveable unit 4, it produces a combined effect (and hence combined control):
Accordingly, said calculation means 6 implement the process in accordance with the invention, according to which:
Thus, by virtue of the invention, the force F applied to the moveable unit 4 enables the latter to carry out the predetermined displacement envisaged, especially in terms of time and distance, whilst rendering the elements (specified hereinbelow) which are brought into motion by this displacement immobile at the end of the displacement so that they do not oscillate and, in particular, do not disturb the relative positioning between themselves and the moveable unit 4.
It will be noted moreover that, by reason of this combined effect or control of said moveable unit 4 and of said moving elements, one obtains an extremely accurate displacement of the moveable unit 4 in a reference frame independent of the base 2 and tied for example to the floor S.
Of course, the implementation of the present invention is not limited to a displacement along a single axis, but can also be applied to displacements along several axes which can be regarded as independent.
According to the invention, in step d), a polynomial expression for the intermediate variable y is used to determine the value of the latter, and the initial and final conditions of the different variables of the system, together with the expressions defined in step b) are used to determine the parameters of this polynomial expression.
The process in accordance with the invention will now be described in respect of four different systems (of moving elements).
In a first embodiment (not represented), the supports 3 are of elastic type and make it possible to isolate the base 2 from the vibrations originating from said floor S. The natural frequency of the base 2 on said elastic supports 3 is generally a few Hertz. Furthermore, in addition to the translational motion of the moveable unit 4 controlled by the force F, an angular motion is created between the base 2 and the moveable unit 4. Specifically, in this case, the axis of the moveable unit 4 does not pass through its center of mass, the force produced by the actuator 5 creates a moment about the vertical axis. The rail is assumed to be slightly flexible and thus allows the moveable unit 4 small rotational motions about the vertical axis, which corresponds to the aforesaid relative angular motion between the base 2 and the moveable unit 4.
Consequently, in this first embodiment, to displace the moveable unit 4 on the base 2 which is mounted elastically with respect to the floor and which may be subjected to a (relative) angular motion, the variables of the system are the linear position x of the moveable unit 4, the linear position xB of the base 2 and the angular position θz of the base 2, which satisfy the relations:
in which
Specifically, in this first embodiment, the balance of the forces and of the moments, the angle θz being approximated to first order, may be written:
It will be noted that, within the context of the present invention, α(β) is the derivative of order β with respect to time of the parameter α, regardless of α. Thus, for example, x(1) is the first derivative of x with respect to time.
The calculation of the intermediate variable y is achieved by putting
From these expressions, we immediately deduce:
The expression for y as a function of x, x(1), xB, xB(1), θz and θz(1) is obtained by inversion. However, this formula is not necessary in order to plan the trajectories of x, xB and θz. Specifically, since we want a stop-stop displacement of the moveable unit 4 between x0 at the instant t0 and x1 at the instant t1, with
x(1)(t0)=0=x(1)(t1) and xB(t0)=0=xB(t1), xB(1)(t0)=0=xB(1)(t1) and θz(t0)=0=θz(t1), θz(1)(t0)=0=θz(1)(t1), with in addition F(t0)=0=F(t1),
we deduce therefrom through the aforesaid expressions (2) that y(t0)=x0,y(t1)=x1 and
y(1)(ti)=y(2)(ti)=y(3)(ti)=y(4)(ti)=y(5)(ti)=y(6)(ti)=0, i=0.1
i.e. 14 initial and final conditions.
It is sufficient to choose y as a polynomial with respect to time of the form:
with
and α≧7 and β≧6. The coefficients a0, . . . , aβ are then obtained, according to standard methods, by solving a linear system.
The reference trajectory sought for the displacement of the moveable unit 4 is then given by expressions (2) with y(t) given by expression (3).
Moreover, the force F as a function of time to be applied to the means 5 is obtained by integrating the value of y obtained via expression (3) in the expression F(t)=M.x(2)(t).
In this first embodiment, we obtain:
with y(t) given by expression (3).
Thus, since by virtue of the device 1 the base 2 is immobilized at the end of the displacement, it does not disturb the positioning of the moveable unit 4 in the aforesaid reference frame so that said moveable unit 4 is positioned in a stable manner as soon as its displacement ends. Moreover, since its displacement is carried out in an accurate manner, its positioning corresponds exactly in said reference frame to the sought-after positioning.
Represented in FIGS. 3 to 7 are the values respectively of said variables y (in meters m), x (in meters m), xB (in meters m), θz (in radians rd) and F (in Newtons N) as a function of time t (in seconds s) for a particular exemplary embodiment, for which:
The moveable unit 4 is displaced from the position x0 at rest (x0(1)=0) at the instant t0, to the position x1 at rest (x1(1)=0) at the instant t1. It is therefore displaced over a distance of 25 mm in 0.4 s. To obtain this displacement, as well as the immobilization (at the end of said displacement) of the various motions to which the displacement gives rise, the force F represented in
In a second embodiment represented in
In this case, the variables of the system are the position x of the moveable unit 4 and the positions zi of the p auxiliary masses MAi, which satisfy the relations:
in which:
Specifically, the dynamic model of the system S1 may be written:
As in the foregoing, we wish to find laws of motion which ensure the desired displacement of the moveable unit 4, the auxiliary masses MAi (for example measurement devices and/or loads) being immobilized as soon as the moveable unit 4 stops.
Accordingly, the intermediate variable y is calculated by the same approach as earlier and the trajectory of the moveable unit 4 is planned by way thereof.
The intermediate variable y being required to satisfy x=P(s)y, zi=Pi(s)y, i=1, . . . , p, with
we must have, substituting these relations into the system (5):
(mis2+ris+ki)Pi=(ris+ki)P, i=1, . . . , p
From this expression, we immediately derive:
thereby proving the aforesaid formulae (4).
In this case, it may be demonstrated that the force F to be applied satisfies the relation:
The aforesaid formulae are verified and specified hereinbelow for two and three auxiliary masses MAi respectively.
In the case of two auxiliary masses (p=2), the model may be written:
From this we immediately deduce:
i.e, putting
and
The expression for y, or more precisely the expressions for y, y(1), y(2), y(3), y(4) and y(5) are deduced therefrom by inverting the system obtained on the basis of x, z1, z2, x(1), z1(1), z2(1).
We deduce therefrom that, to perform a displacement from x0 at the instant t0 to x1 at the instant t1, with the auxiliary masses at rest at t0 and t1, it is sufficient to construct a reference trajectory for y with the initial and final conditions
In this case, the force F satisfies the relation:
Furthermore, the model for three auxiliary masses MAi (p=3) [see
From this we immediately deduce:
We proceed as earlier in order to determine the values as a function of time of the different variables and in particular of the force F, the latter satisfying the expression:
Represented in FIGS. 8 to 13 are the values respectively of the variables y, x, z1, z2, z3 and F as a function of time t for a particular example of the embodiment of
This example is such that:
Additionally, in a third embodiment represented in
In this case, the variables of the system are the positions x, xB and zA of the moveable unit 4, of the base B and of the auxiliary mass MA, which satisfy the relations:
in which:
Specifically, the dynamic model of the system S2 may be written:
The intermediate variable must satisfy: x=P(s)y, xB=PB(s)y and zA=Pz(s)y with
Substituting these expressions into (9), we obtain:
On eliminating Pz from the last equation, it follows that:
[(mAs2+rAs+kA)(mBs2+(rA+rB)s+(kA+kB))−(rAs+kA)2]PB=−(mAs2+rAs+kA)Ms2P
from which we derive:
thus making it possible to obtain the aforesaid expressions (8).
The values as a function of time of the different variables, and in particular the force F, are then obtained as before.
In this case, said force F satisfies the expression:
F(t)=M[(mAs2+rAs+kA)(mBs2+(rA+rB)s+(kA+kB))−(rAs+kA)2]y(2).
In a fourth and last embodiment (not represented), the system is formed of the moveable unit 4, of the base 2 and of an auxiliary mass MC which is tied elastically to said moveable unit 4.
In this case, the variables of the system are the positions x, xB and zC respectively of the moveable unit 4, of the base 2 and of the auxiliary mass MC, which satisfy the relations:
in which:
Specifically, the dynamic model of this system may be written:
By using, as in the foregoing, the polynomial representation of the variable
the system (10) becomes:
which, together with the expressions for each of the variables as a function of the intermediate variable (and of its derivatives) x=P(s)y, xB=PB(s)y, zC=Pz(s)y, finally gives:
The construction of the reference trajectories of y, and then of x, xB, zC and F is done as indicated earlier.
In this case, the force F satisfies:
F(t)=−(mBs2+rBs+kB)[(mCs2+rCs+kC)(Ms2+rCs+kC)−(rCs+kC)2]y.
A method in accordance with the invention will now be described which makes it possible to determine in a general and fast manner the expressions defined in the aforesaid step b) of the process in accordance with the invention, for linear systems of the form:
Accordingly, according to the invention, in step b), the following operations are carried out:
The aforesaid method is now justified.
Let us denote by A(s) the matrix of size pxp whose coefficients are the polynomials Ai, j(s), i, j=1, . . . , p, i.e.:
Without loss of generality, it can be assumed that the rank of A(s) is equal to p (otherwise, the system is written together with its redundant equations and it is sufficient to eliminate the dependent equations) and that bp≠0. There then exists a matrix B of size px(p−1) and of rank p−1such that:
BTb=0p−1
where T represents transposition and 0p−1 the vector of dimension p−1, all of whose components are zero. The system (11) premultiplied by BT then becomes:
As indicated earlier, an intermediate variable y is characterized in that all the components of the vector X can be expressed as a function of y and of a finite number of its derivatives. For a controllable linear system, such an output always exists and the components of X can be found in the form of linear combinations of y and of its derivatives, i.e.:
where y(j) is the derivative of order j of y with respect to time and where the pi,j are real numbers which are not all zero, or alternatively:
We shall calculate the vector
by replacing X by its value P(s)y in (12):
Consequently, P belongs to the kernel of the matrix BTA(s) of dimension 1, since B is of rank p−1 and A(s) of rank p. To calculate P, let us denote by A1(s), . . . , Ap(s) the columns of the matrix A(s) and Â(s) the matrix of size (p−1)×(p−1) defined by:
Â(s)=(A2(s), . . . , Ap(s)).
Let us also denote by P(s) the vector of dimension p−1 defined by:
Let us rewrite (13) in the form BTA1(s)P1(s)+BTÂ(s){circumflex over (P)}(s)=0p−1 or alternatively BTÂ(s){circumflex over (P)}(s)=−BTA1(s)P1(s). Since the matrix BTÂ(s) is invertible, we have:
{circumflex over (P)}(s)=−(BTÂ(s))−1BTA1(s)P1(s)
i.e.:
where co(BTÂ(s)) is the matrix of the cofactors of BTÂ(s).
From this we immediately deduce that it is sufficient to choose:
this completing the calculation of the vector P(s).
It will be observed that if the Ai,j(s) are polynomials of degree less than or equal to m, the degree of each of the components of P is less than or equal to mp. Specifically, in this case, the degree of the determinant det (BTÂ(s)) is less than or equal to (p−1)m and the degree of each of the rows of (co (BTÂ(s)))TBT A1(s), using the fact that the degree of a product of polynomials is less than or equal to the sum of the degrees, is less than or equal to (p−1)m+m=pm, hence the aforesaid result.
In all the examples presented earlier, which model mechanical subsystems, we have m=2.
It may easily be verified that this general method yields the same calculations for P as in each of the examples already presented hereinabove.
We shall return to certain of the examples dealt with earlier and show how the calculation of the variable y makes it possible to achieve passive isolation of the elastic modes.
In all these examples, the trajectories are generated on the basis of polynomial trajectories of the intermediate value y, which are obtained through interpolation of the initial and final conditions. Furthermore, we are interested only in the particular case where the system is at rest at the initial and final instants, thereby making it possible to establish simple and standard formulae which depend only on the degree of the polynomial.
In the simplest case, where the initial and final derivatives of y are zero up to order 4, the sought-after polynomial is of degree 9:
which gives:
y(t)=y0+(y1−y0)σ5(126−420σ+540σ2−315σ3+70σ4),
If we ask for a polynomial such that the initial and final derivatives are zero up to order 5, the sought-after polynomial is of degree 11:
y(t)=y0+(y1−y0)σ6(462−1980σ+3465σ2−3080σ3+1386σ4−252σ5)
still with σ defined as in (16).
If we ask for a polynomial such that the initial and final derivatives are zero up to order 6, the sought-after polynomial is of degree 13:
y(t)=y0+(y1−y0)σ7(1716−9009σ+20020σ2−24024σ3+16380σ4−6006σ5+924σ6).
Number | Date | Country | Kind |
---|---|---|---|
00 11584 | Sep 2000 | FR | national |
99 02224 | Feb 1999 | FR | national |
Number | Date | Country | |
---|---|---|---|
0079198 A1 | Jun 2002 | US |
Number | Date | Country | |
---|---|---|---|
Parent | 09362643 | Jul 1999 | US |
Child | 09805598 | Mar 2001 | US |