The invention relates to a method for controlling an electric motor, particularly a planar motor, wherein a magnet is positioned with respect to j coils, j=1 . . . N, wherein currents Ij can flow through the coils such that a force and a moment are generated that interact with the magnet, a control unit for controlling an electric motor and an electric motor.
Electric motors are used in a variety of electrical equipment, especially equipment for high precision positioning. One field of application is for example the positioning of wafers during photolithography and other semiconductor processing with the help of linear or planar electric motors.
US 2003/0085676 A1 describes a system and method for independently controlling planar motors to move and position in six degrees of freedom. The electric planar motor comprises a moving magnet array and a coil array. The current supplied to the coils of the coils array interacts with the magnetic field of the magnets of the magnet array to generate forces between the magnet and coil arrays. The generated forces provide motion of the magnet array relative to the coil array in a first, second and third directions generally orthogonal to each other, as well as rotation about the first, second and third directions.
The method according to US 2003/0085676 A1 comprises the steps of determining the currents to be applied to the coils to generate forces between the magnet array and the coil array in a first, second, and third directions; determining the resultant torque about the first, second and third directions between the magnet array and the coil array generated by the forces generated by the determined currents; determining current adjustments to compensate for or cancel out the resultant torque; and applying a sum of the determined currents and determined current adjustments to the coils to interact with the magnetic fields of the magnetic array.
It is desirable to provide the possibility to control an electric motor, wherein a magnet is positioned with respect to one or more coils, wherein currents Ij, j=1 . . . N can flow through the coils such that a force and a moment are generated that interact with the magnet with high precision with respect to positioning and path to follow.
In a first aspect of the present invention, a method for controlling an electric motor, particularly a planar motor, wherein a magnet is positioned with respect to j coils, j=1 . . . N, wherein currents Ij can flow through the coils such that a force and a moment are generated that interact with the magnet, with the steps of determining the present relative position of magnet and coils; determining the force {right arrow over (F)}prescr and moment {right arrow over (M)}prescr needed to change the relative position of magnet and coils from the present position to a desired position; determining the necessary currents Ijnec for generating the force {right arrow over (F)}prescr and moment {right arrow over (M)}prescr, wherein a further constraint concerning the system magnet-coils is taken into account for determining the currents Ijnec; and applying the determined currents Ijnec to the j coils.
The fact of considering from the beginning both force and moment necessary for a desired relative movement between magnet and coils allows for a very accurate control of the movement. By also taking into account a further constraint concerning the system magnet-coils, the system as a whole is optimized, and it provides the possibility of determining unique currents, thus enhancing the accuracy of the control.
The method according to the invention is especially advantageous, if the number N of current Ij is larger than the number of degrees of freedom of the electric motor, leading to unique currents Ijnec. The number of degrees of freedom is equivalent to the number of independent variables of {right arrow over (F)}prescr and {right arrow over (M)}prescr.
In preferred embodiments, the further constraint taken into account is the minimization of total power dissipation of the electric motor, leading to an electric motor optimized with respect to efficiency, or the constraint of having a prescribed distribution of force and moment in space, which can lead to a minimal deformation of the magnet plate during motion.
In most preferred embodiments of the present invention, the method of Lagrange is utilized for determining the unique currents Ijnec. A functional depending of currents Ij and Lagrange multipliers λi and taking into account the force and moment needed for changing the relative position between magnet and coils form the present position to a desired position as well as the chosen constraint is minimized, giving the currents Ijnec.
Advantageously, the force and moment needed for changing the relative position between magnet and coils from the present position to a desired position are not individually determined after every new position through computing, but a set of different forces {right arrow over (F)}prescr and moments {right arrow over (M)}prescr, each needed to change the relative position of magnet and coils from a present position to a desired position is computed beforehand and provided as database. This reduces the required computing resources and increases the reaction time during the control.
In a further aspect of the present invention, a control unit for controlling an electric motor, particularly a planar motor, wherein a magnet is positioned with respect to j coils, j=1 . . . N, wherein currents Ij can flow through the coils such that a force and a moment are generated that interact with the magnet, is provided with first input means to receive information on the present relative position of magnet and coils; second input means to receive information on force {right arrow over (F)}prescr and moment {right arrow over (M)}prescr needed to change the relative position of magnet and coils from the present position to a desired position; computing means for computing the necessary currents Ijnec for generating the force {right arrow over (F)}prescr and moment {right arrow over (M)}prescr, wherein a further constraint the system magnet-coils is taken into account for defining Ijnec; and regulating means for regulating the currents Ij to apply the computed currents Ijnec to the j coils.
The second input means of the control unit may be arranged as storing means for storing a set of forces {right arrow over (F)}prescr and moments {right arrow over (M)}prescr, each needed to change the relative position of magnet and coils from a present position to a desired position, or may be arranged as computing means for computing the {right arrow over (F)}prescr and moment {right arrow over (M)}prescr needed to change the relative position of magnet and coils from the present position to a desired position.
In a last aspect of the invention, an electric motor is provided, comprising a magnet and j coils j=1 . . . N, wherein currents Ij, can flow through the coils such that a force and a moment are generated that interact with the magnet, a control unit according to the invention.
In preferred embodiments, the motor is a planar motor, in most preferred embodiments a planar motor with six degrees of freedom.
It is possible to have the coils move with respect to the magnet or both the coils and the magnet moving. But it is preferred to have the magnet move with respect to the coils. This avoids hoses and cables impeding the free motion of the coils.
Advantageously, the motor has means for measuring the relative position of magnet and coils, thus improving the accuracy of control and positioning.
A detailed description of the invention is provided below. Said description is provided by way of a non-limiting example to be read with reference to the attached drawings in which:
In order to generate a required force and moment, the currents through the coils have to be prescribed. If a force and moment act at the plate, the plate will move and attains a new position. This position is measured with respect to position {right arrow over (x)} and orientation {right arrow over (ω)} of the magnet plate. The control loop takes care that the force and moment and therefore the currents are prescribed such that the plate follows the prescribed path with the prescribed velocity.
The starting point, i.e. the first relative position of magnet and coils, is given as set point in step 101. The magnet has to move along a path to a position {right arrow over (x)} and orientation {right arrow over (ω)} with a prescribed velocity. The necessary force and moment that have to act on the magnet are determined in step 102. It is possible to look the values up in a predetermined database as well as to punctually compute the values. In the next step 103, the necessary currents Ij are determined with the constraints, that the determined force and moment have to be generated, and a further constraint, e.g. minimal power dissipation or a prescribed distribution of force and moment. Examples on how to determine the currents will be given below.
Once the currents have been determined, they are applied to the one or more coils, thus moving the magnet with respect to the coils to position {right arrow over (x)} and orientation {right arrow over (ω)} with the prescribed velocity (step 104). Then the present relative position and orientation are measured (step 105) and taken as starting point for a new loop.
In
The electric motor 1 is controlled by control unit 4. Through a first input means 41, the computing means 43 gets information on present relative position of magnet 2 and coils 3. This information can be provided by a measuring means 5, e.g. based on optical measurements with lasers. This information can also stored as first set point, corresponding to the last present position. But accuracy is improved, if the present position is at least from time to time measured independently.
The information on the prescribed force and momentum is provided to the computing means 43 through the second input means 42. This can be, for example, a storage means, where a database containing a set of forces and moments needed for changing the relative position from a present position to a desired position. It can also be a further computing means for computing the actual force and moment, and then even be integrated into the computing means 43.
Having all the information needed, the computing means 43 can compute the necessary currents for generating the determined force and moment. Examples on how to do the computing will be given below. The regulating means 44 then regulates the coil currents such that the computed currents are applied, thus moving the magnet 2 with respect to the coils 3 to position {right arrow over (x)} and orientation {right arrow over (ω)} with the prescribed velocity.
Possible ways of determining currents Ijnec are explained in the following with respect to the example of a planar motor with a moving plate and a number of fixed coils and having six degrees of freedom.
Currents flow through the coils such that a force and moment are applied to the magnet. Each current Ij causes a force {right arrow over (F)}j and moment {right arrow over (M)}j acting on the magnet. Hence, the total force {right arrow over (F)} and moment {right arrow over (M)} acting on the magnet are
where N is the number of currents contributing to the exerted load on the magnet. The problem is to determine the currents Ij, (j=1, . . . N) such that a prescribed force {right arrow over (F)}presc and moment {right arrow over (M)}presc are applied to the magnet.
Consider a unit current Ij=1. This unit current through the coil exerts a force {right arrow over (F)}j1 and moment {right arrow over (M)}j1 on the magnet. A current with value Ij will exert a force {right arrow over (F)}j={right arrow over (F)}j1Ij and moment {right arrow over (M)}j={right arrow over (M)}j1Ij (no summation over j). Superposition of all current Ij, (j=1, . . . N) yields that the currents have to satisfy
To simplify the notations we introduce the vector {right arrow over (T)}presc=({right arrow over (F)}presc,{right arrow over (M)}presc)T, the influence matrix
and current vector {right arrow over (I)}=(I1, . . . , IN)T. Then the constraint (2) is rewritten as
If N=6 and the matrix of influence factors is not singular, the currents follow from (2) and are
{right arrow over (I)}=F−1{right arrow over (T)}presc. (4)
If N<6 and the rank of the matrix of influence factors F equals N, only unique currents Ij (j=1 . . . N) exist, if the prescribed force and moment ({right arrow over (F)}presc,{right arrow over (M)}presc)T are in the space spanned by ({right arrow over (F)}j1,{right arrow over (M)}j1)T (j=1 . . . N). These currents are determined by the least squares solution of (3)
{right arrow over (I)}=(FTF)−FT{right arrow over (T)}presc. (5)
If the prescribed force and moment are not in the space spanned by ({right arrow over (F)}j1,{right arrow over (M)}j1)T (j=1 . . . N) no combination of currents exist that can generate the prescribed force and moment.
If N<6, the rank of the matrix of influence factors is smaller than N and if ({right arrow over (F)}presc,{right arrow over (M)}presc)T is in the space spanned by ({right arrow over (F)}j1,{right arrow over (M)}j1)T (j=1 . . . N), the currents Ij (j=1 . . . N) to generate the prescribed force {right arrow over (F)}presc and moment {right arrow over (M)}presc are not unique. In this case and in the case that N>6 additional demands have to be imposed on the currents to obtain unique values Ij to generate the prescribed force and moment.
Generally speaking, the required force and moment represent 6 constraints concordant with the six degrees of freedom of the motor. In general, the number N of coils that influence the force and moment acting at the plate is greater than 6. A typical number for the number of currents is between 20 and 30, e.g. 27. Then the problem is how to prescribe the currents in order that a required force and moment on the plate are generated. Hence, N>6 variables have to be determined, such that 6 constraints are satisfied.
The currents are the solution of an optimization/minimization problem with the constraint that the required force {right arrow over (F)}required and moment {right arrow over (M)}required are generated. Hence, if one uses the method of Lagrange, the currents are the variables at which the functional
has its minimum. The index i in the expression for J indicates components of the vectors {right arrow over (T)}
and {right arrow over (λ)}, λ1, . . . , 6 being Lagrange multipliers. The function {right arrow over (T)}(I1, . . . , IN) defines the relation between the currents I1, . . . , IN and the generated force {right arrow over (P)} and moment {right arrow over (M)}. In this case the force and moment are linear dependent on the currents, hence {right arrow over (T)}=A({right arrow over (x)},{right arrow over (ω)}){right arrow over (I)}, where the tensor A({right arrow over (x)},{right arrow over (ω)}) depends on the position {right arrow over (x)} and the orientation {right arrow over (ω)} of the magnet plate with respect to the fixed coils. The function G(I1, . . . , IN) defines the function to be minimized, with the constraint that the required force and moment
are generated, and is equivalent to the further constraint to be taken into account for determining Ijnecc. This function G(I1, . . . , IN) has to be chosen. Then, the condition that the function J has to be minimal generates sufficient extra conditions to determine uniquely the currents I1, . . . , IN (and it determines uniquely the extra introduced so called Lagrange multipliers λ1, . . . , λ6). Hence, unique currents I1, . . . , IN are determined that minimize some function G(I1, . . . , IN) with the constraint that the required force {right arrow over (F)}required and moment {right arrow over (M)}required are generated.
1. Minimal Power Dissipation
The function G(I1, . . . , IN) to be optimized has to be chosen. A suitable choice is the total power dissipation in the coils, hence
where the Ri are the resistances of the coils and the power dissipation caused by a current Ij is Pj=RjIj2 (no summation). If N>6 an additional demand on the currents Ij can be that the total power dissipation of the currents is minimal.
Next, the currents through the coils are determined by minimizing the total power dissipation with the constraint (3), hence the currents are determined by minimizing the functional
where λi are Lagrange multipliers.
This functional has a minimum if
To simplify the solution of the equations (3) and (9), the currents are written as
Substitution of (10) in (9) yields
Hence solving (11) yields
The Lagrange multipliers λi follow from the constraint (3). Substitution of (10) and (12) in (3) yields
Hence the Lagrange multipliers have to be solved from (13) and are given by
{right arrow over (λ)}=A−1{right arrow over (T)}presc. (14)
To obtain the currents Ij, (12) and (14) are substituted in (10), then
Hence, the currents given by (15) are the currents that deliver the prescribed force {right arrow over (F)}presc and moment {right arrow over (M)}presc with minimal power dissipation.
As example, consider the case that all resistances of the coils are equal, hence Rj=R (j=1 . . . N). Then the matrices A (13) and I (12) are
and the currents are given by
Hence, as expected the currents are independent of the resistance of the coils.
2. Prescribed Force and Moment Distribution
Another requirement can be a desired force and moment per unit area distribution over the plate, hence a desired distribution {right arrow over (T)}disdesired({right arrow over (x)}). Then the function G(I1, . . . IN) becomes
where the integration has to be carried out over the area D of the plate and {right arrow over (T)}dis({right arrow over (x)}) represents the generated force and moment per unit area of the plate at a location {right arrow over (x)} of the plate. For practical reasons in general a numerical method (e.g. discretization) is used to calculate the surface integral. The area D of the plate can be divided into M sub-areas Dk, then the integral over D can be approximated by
where {right arrow over (T)}dis,kdesired represents the desired force and moment acting at the part Dk of the total area D of the magnet plate and {right arrow over (T)}dis,k=Ak{right arrow over (I)} represents the force and moment acting at Dk due to the currents through the coils. The total force and moment are given by
This total force and moment have to be equal to the required force and moment {right arrow over (T)}required acting at the magnet plate. Hence, the functional to be optimized becomes
More in detail, one has to divide the magnet plate into a number of area elements. These area elements are not necessarily equal. Consider a unit current Ij=1. This unit current through the coil exerts a force {right arrow over (A)}jk and moment {right arrow over (B)}jk on area element k, if this area element is considered to be decoupled from all other area elements. A current with value Ij will exert a force {right arrow over (K)}jk={right arrow over (A)}jkIj and moment {right arrow over (L)}jk={right arrow over (B)}jkIj (no summation over j) on area element k. Superposition of all current Ij, (j=1 . . . N) yields the following force {right arrow over (F)}k and moment {right arrow over (M)}k on area element k
{right arrow over (F)}k=Ak{right arrow over (I)},{right arrow over (M)}k=Bk{right arrow over (I)},k=1, . . . , M, (20)
where M is the number of area elements. The total force and moment acting at the magnet plate follows from the coupling of all area elements, hence the total force {right arrow over (F)}tot and total moment {right arrow over (M)}tot are
where {right arrow over (x)}k is the vector from the point at which the total force and moment act to the location on the area element at which the force {right arrow over (F)}k and moment {right arrow over (M)}k act.
The distribution of force and moment over the magnet plate can be prescribed. If the magnet plate is discretized in area elements, this means that the distribution of force {right arrow over (F)}k and moment {right arrow over (M)}k acting on the area elements can be prescribed. Then the problem is to determine the currents trough the coils which deliver (approximately) these force and moment distributions. However, the currents through the coils have to generate a prescribed total force and total moment acting on the magnet plate. Hence, the following optimization problem has to be solved.
Determine the currents {right arrow over (I)} such that the prescribed distribution of forces {right arrow over (F)}k and moments {right arrow over (M)}k are satisfied in a least squares sense, with the constraint that the required total force {right arrow over (F)}tot and moment {right arrow over (M)}tot are generated. Hence the currents follow from minimizing the functional
where {right arrow over (λ)} and {right arrow over (μ)} are Lagrange multipliers.
In order to determine the conditions for which the functional (22) has a minimum, we write it as a function of the components of the vectors {right arrow over (I)}, {right arrow over (λ)} and {right arrow over (μ)}, hence
where
εsqt=1, if sqt is 123, 312, 231,
εsqt=−1, if sqt is 132, 321, 213,
εsqt=0, otherwise.
Note, that in the expression of the function (23), the Einstein summation convention is used for the indices n, p, q, r, s and t (i.e. summation over these indices if they appear twice in a term). Differentiation with respect to Ii, λj and μk and setting the result to zero, yields
The functional (22) has a minimum, if (25), (26) and (27) are fulfilled. In vector and matrix notation these expressions become
where the components of matrix Dk are Dijk=εipqxpkAqjk, with
εipq=1, if ipq is 123, 312, 231,
εipq=−1, if ipq is 132, 321, 213, (31)
εipq=0 otherwise.
Next the following definitions are introduced
Then the conditions (28)-(30) for a minimum of the functional (22) become
C{right arrow over (I)}={right arrow over (E)}−A
T{right arrow over (λ)}−(B+D)T{right arrow over (μ)} (32)
{right arrow over (F)}tot=A{right arrow over (I)} (33)
{right arrow over (M)}
tot=(B+D){right arrow over (I)} (34)
From (32) it follows that
{right arrow over (I)}=C
−1
{right arrow over (E)}−C
−1
A
T{right arrow over (λ)}−C−1(B+D)T{right arrow over (μ)} (35)
that can be rewritten as
Substitution of (35) in (33) and (34) yields, respectively,
{right arrow over (F)}
tot
=AC
−1
{right arrow over (E)}−AC
−1
A
T
{right arrow over (λ)}−AC
−1(B+D)T{right arrow over (μ)}, (37)
{right arrow over (M)}
tot=(B+D)C−1{right arrow over (E)}−(B+D)C−1AT{right arrow over (λ)}−(B+D)C−1(B+D)T{right arrow over (λ)}. (38)
Combining (37) and (38) gives the following set of linear equations for the Lagrange multipliers {right arrow over (λ)} and {right arrow over (μ)}
Hence the solution for {right arrow over (λ)} and {right arrow over (μ)} is
Substitution of (40) into equation (36) gives the closed expression for the currents, directly as a function of prescribed force and moment.
The prescribed force distribution and moment distribution can be, for example, uniform. In the case that the total force and moment are prescribed with the condition of a uniform force and moment distribution on the area elements and with the condition that the area elements are equal in size, the force {right arrow over (F)}k and moment {right arrow over (M)}k acting at a surface element k are
In the case that the area elements are not equal and have size Ok, with
the total area of the magnet plate, the forces {right arrow over (F)}k and moments {right arrow over (M)}k belonging to a uniform distribution are
Although having described several preferred embodiments of the invention, those skilled in the art would appreciate that various changes, alterations, and substitutions can be made without departing from the spirit and concepts of the present invention. The invention is, therefore, claimed in any of its forms or modifications with the proper scope of the appended claims. For example various combinations of the features of the following dependent claims could be made with the features of the independent claim without departing from the scope of the present invention. Furthermore, any reference numerals in the claims shall not be construed as limiting scope.
Number | Date | Country | Kind |
---|---|---|---|
04105941.1 | Nov 2004 | EP | regional |
Filing Document | Filing Date | Country | Kind | 371c Date |
---|---|---|---|---|
PCT/IB2005/053766 | 11/15/2005 | WO | 00 | 5/15/2007 |