METHOD FOR DYNAMIC OUTPUT FORCE DISTRIBUTION OF MULTI-DEGREE-OF-FREEDOM OVER-ACTUATED MOTION STAGE

Information

  • Patent Application
  • 20240202394
  • Publication Number
    20240202394
  • Date Filed
    August 16, 2023
    a year ago
  • Date Published
    June 20, 2024
    7 months ago
  • CPC
    • G06F30/20
    • G06F2111/10
  • International Classifications
    • G06F30/20
Abstract
A method for dynamic output force distribution of a multi-degree-of-freedom over-actuated motion stage includes: establishing a mathematical model G(s) of a motion stage based on a modal representation; setting a time delay interval parameter Δτ and an instruction shaper order nCS, and calculating each pulse time delay parameter τi; calculating matrices Tb and Vb; initializing q=1; defining Hq; calculating intermediate variable {tilde over (T)}jq, {tilde over (V)}, ΦHq, YHq, TΦHq, VΦHq, and βq; calculating an estimated value Ĥq of Hq; obtaining an amplitude Aikq of an instruction shaper; q=q+1, until calculation is completed for all logical axis channels; calculating α(s) by using Aikq; and obtaining a dynamic output force distribution matrix Tf(s). Zero-residue vibration suppression in all controllable flexible modalities can be realized with finite actuator redundancies.
Description
CROSS-REFERENCE TO RELATED APPLICATIONS

This application claims priority to Chinese Patent Application No. 202211575174.1 with a filing date of Dec. 8, 2022. The content of the aforementioned application, including any intervening amendments thereto, is incorporated herein by reference.


TECHNICAL FIELD

The present disclosure relates to a method for dynamic output force distribution of a motion stage, and in particular, to a method for dynamic output force distribution of a multi-degree-of-freedom over-actuated motion stage, and belongs to the technical field of vibration suppression for semiconductor manufacturing equipment and motion stages.


BACKGROUND

A multi-degree-of-freedom precision motion stage is an important component in semiconductor manufacturing equipment. The performance and accuracy of motion thereof have a direct influence on a yield of the equipment and the quality of products. Thus, the multi-degree-of-freedom precision motion stage is required to realize high-accuracy control when performing high dynamic motion. The multi-degree-of-freedom motion stage is designed with a larger size to further improve the yield of the equipment. A future motion stage will be designed and developed to be lightweight and flexible due to the limitation of finite output force from an actuator and a high acceleration requirement. Thus more flexible modal vibration will be introduced to the motion system. Therefore, an over-actuation strategy may be developed by increasing the number of actuators for solving this problem. However, the introduction of an over-actuator results in a problem of non-unique solutions to a non-square actuator output force distribution matrix. Meanwhile, restrained by a finite space and quality, it is difficult to realize zero-residue vibration suppression in all controllable flexible modalities with finite actuator redundancies.


Chinese patent publication No. CN107783378B filed on Aug. 30, 2016 discloses a vertical micromotion structure of a lithography machine and a control method, in which flexible modal shape parameters of some orders are introduced into an output force distribution matrix according to the number of actuator redundancies so that vibration suppression can be realized for the flexible modalities of respective orders. However, the method cannot meet the requirement of vibration suppression for all controllable flexible modalities under finite actuator redundancies and may even enlarge the flexible modal vibration of an uncontrolled order. In view of this, it is urgent to propose a suitable actuator output force distribution matrix.


SUMMARY OF PRESENT INVENTION

Aiming at the defects in the prior art, an objective of the present disclosure is to provide a method for dynamic output force distribution of a multi-degree-of-freedom over-actuated motion stage that can realize zero-residue vibration suppression in all controllable flexible modalities with finite actuator redundancies and is conducive to improving the distribution efficiency.


To achieve the above objective, the present disclosure adopts the following technical solution. A method for dynamic output force distribution of a multi-degree-of-freedom over-actuated motion stage includes the following steps:

    • Step 1: establishing a mathematical model G(s) of a motion stage based on a modal representation in accordance with a mechanical structure of the multi-degree-of-freedom over-actuated motion stage and a model identification result thereof:










G

(
s
)

=



[




C
1




C
2




]

[





Φ
1

(
s
)













Φ
2

(
s
)




]

[




B
1






B
2




]





(
1
)















Φ
1

(
s
)

=

[




1


m
1



s
2































1


m

n
R




s
2






]







Φ
2

(
s
)

=

[




1


s
2

+

2


ξ
1



ω
1


s

+

ω
1
2































1


s
2

+

2


ξ

n
L




ω

n
L



s

+

ω

n
L

2






]






(
2
)









    •  where B1 is a rigid modal input coupling matrix, and B2 is a flexible modal input coupling matrix; C1 a rigid modal output coupling matrix, and C2 is a flexible modal output coupling matrix; mq is a rigid modal quality parameter, and q is a serial number of a logical axis channel and q=1, 2, . . . , nR; nR is the number of rigid modalities, which is equal to a total number of logical axis channels; nL is the number of flexible modalities; ξj is flexible modal damping; and ωj is a flexible modal frequency parameter, with a flexible modal order j=1, 2, . . . , nL;

    • Step 2: setting a time delay interval parameter Δτ and an instruction shaper order nCS, and calculating each pulse time delay parameter τi=Δτ·(i−1) with an instruction shaper order i=1, 2, . . . , nCS;

    • Step 3: calculating matrices Tb and Vb:












{






T
b

=



B
1
T

(


B
1



B
1
T


)


-
1









V
b

=

ker

(

B
1

)





;





(
3
)









    • Step 4: initializing the serial number of a logical axis channel to q=1;

    • Step 5: defining a parameter vector Hq to be optimized in a qth column in α(s):









H
q
=[A
l
lq
. . . A
n

CS

lq
. . . A
l
n

V

q
. . . A
n

CS

n

V

q]T  (4)

    •  where Aikq is an amplitude of an instruction shaper that has a serial number q of a logical axis channel, a serial number k of a redundancy, and the instruction shaper order of i; the serial number k of the redundancy is k=1, 2, . . . , nV; nV is a redundancy of a motion stage actuator, nV=nA−nR; and nA is the number of motion stage actuators;
    • Step 6: optimizing an optimization indicator








min

β
q



J
q


=





Φ
0

·

(


T
M
q

+


V
M
q

·

β
q



)




2
2







    •  by using a method of least squares to calculate a parameter vector βq in Ĥq:








βq=(VMqTΦ0TΦ0VMq)−1(VMqTΦ0TΦ0TMq)  (5)


where











Φ
0

=

[




1
/

ω
1
2






























1
/

ω

n
L

2





]






T
M
q

=

[






T
~

1
q

+



V
~


V

1


·

T

Φ
H

q

·

Y
H
q















T
~


n
L

q

+



V
~


Vn
L


·

T

Φ
H

q

·

Y
H
q






]






(
6
)














V
M
q

=

[






V
~


V

1


·

V

Φ
H

q














V
~


Vn
L


·

V

Φ
H

q





]







V
~

Vj

=

[









V
~


j

1


,







n
CS









V
~


j

2


,





n
CS












V
~


jn
V


,





n
CS





]





{





T

Φ
H

q

=



Φ
H
qT

(


Φ
H
q

·

Φ
H
qT


)


-
1









V

Φ
H

q

=

ker

(

Φ
H
q

)










(
7
)













Φ
H
q

=

[




φ
111
C







φ


n
CS


11

C







φ

11


n
V


C







φ


n
CS


1


n
V


C





























φ

1


n
L


1

C







φ


n
CS



n
L


1

C







φ

1


n
L



n
V


C







φ


n
CS



n
L



n
V


C






φ
111
S







φ


n
CS


11

S







φ

11


n
V


S







φ


n
CS


1


n
V


S





























φ

1


n
L


1

S







φ


n
CS



n
L


1

S







φ

1


n
L



n
V


S







φ


n
CS



n
L



n
V


S




]





(
8
)












{





φ
ijk
C

=




V
~

jk

·

e


ξ
j



ω
j



τ
i






cos

(


ω
dj

·

τ
i


)









φ
ijk
S

=




V
~

jk

·

e


ξ
j



ω
j



τ
i






sin

(


ω
dj

·

τ
i


)









ω
dj

=


ω
j




1
-

ξ
j
2












(
9
)













Y
H
q

=


[




-


T
~

1
q








-


T
~

j
q








-


T
~


n
L

q




0





0



]

T





(
10
)







{tilde over (T)}jq=bjTbq, Tbq is a qth column of Tb, and bj is a jth column of B2; {tilde over (V)}j=bjVb; {tilde over (V)}jk is a kth element of {tilde over (V)}j;

    • Step 7: calculating an estimated value Ĥq of Hq:






Ĥ
q
=T
Φ

H

q
Y
H
q
+V
Φ

H

q·βq·YHq  (11);

    • Step 8: correspondingly obtaining the amplitude Aikq of the instruction shaper according to Hq defined in step 5 and Ĥq defined in step 7;
    • Step 9: letting q=q+1, determining whether q is greater than the total number of the logical axis channels; if yes, proceeding to step 10; and if no, skipping to step 5;
    • Step 10: calculating α(s) by using Aikq:











α

(
s
)

=

[







i
=
1


n
CS




A
i
11



e


-

τ
i



s










i
=
1


n
CS




A
i
12



e


-

τ
i



s













i
=
1


n
CS




A
i

1


n
R





e


-

τ
i



s


























i
=
1


n
CS




A
i


n
V


1




e


-

τ
i



s










i
=
1


n
CS




A
i


n
V


2




e


-

τ
i



s













i
=
1


n
CS




A
i


n
V



n
R





e


-

τ
i



s







]


;




(
12
)









    • Step 11: obtaining the dynamic output force distribution matrix T (s):









T
f(s)=Tb+Vb·α(s)  (13).


Compared with the prior art, the present disclosure achieves the following beneficial effects. The present disclosure can solve the problem of non-unique solutions to a non-square output force distribution matrix in an existing multi-degree-of-freedom over-actuation design. The dynamic output force distribution matrix is adopted so that zero-residue vibration suppression in all controllable flexible modalities can be realized with finite actuator redundancies. All calculation is explicit calculation without a numerical optimization process, leading to low time consumption in calculation. The method is conducive to improve the distribution efficiency.





BRIEF DESCRIPTION OF THE DRAWINGS


FIG. 1 is a block diagram showing a control system for a conventional multi-degree-of-freedom over-actuated motion stage.





DETAILED DESCRIPTION OF THE EMBODIMENTS

The technical solution of the present disclosure will be clearly and completely described below with reference to the accompanying drawings in the embodiments of the present disclosure. Apparently, the described embodiments are merely a part rather than all of the embodiments of the present disclosure. All other embodiments derived from the embodiments in the present disclosure by a person of ordinary skill in the art without creative efforts should fall within the protection scope of the present disclosure.



FIG. 1 is a block diagram showing a control system for a conventional multi-degree-of-freedom over-actuated motion stage. As shown, R is a reference trajectory input of the system, and Y is a tracking trajectory output of the system. u is a logical axis control quantity. f is an actuator control quantity. Kff(s) is a feedback controller, and Kfb(s) is a feedback controller. Tf(s) is an actuator output force distribution matrix, and Tcb is a sensor decoupling matrix. G(s) is a controlled object. B is an input coupling matrix, and C is an output coupling matrix. Φ(s) is a modal dynamic matrix.


An objective of the present embodiment is to design an actuator output force distribution matrix Tf(s) from u to f, and Tf(s) is a dynamic output force distribution matrix. Tf(s)=Tb+Vb·α(s), with α(s) being a dynamic matrix to be designed. Thus, a method for dynamic output force distribution of a multi-degree-of-freedom over-actuated motion stage is provided, including the following steps:

    • Step 1: establish a mathematical model G(s) of a motion stage based on a modal representation in accordance with a mechanical structure of the multi-degree-of-freedom over-actuated motion stage and a model identification result thereof:










G

(
s
)

=



[




C
1




C
2




]

[





Φ
1

(
s
)













Φ
2

(
s
)




]

[




B
1






B
2




]





(
1
)















Φ
1

(
s
)

=

[




1


m
1



s
2































1


m

n
R




s
2






]







Φ
2

(
s
)

=

[




1


s
2

+

2


ξ
1



ω
1


s

+

ω
1
2































1


s
2

+

2


ξ

n
L




ω

n
L



s

+

ω

n
L

2






]






(
2
)









    •  where B1 is a rigid modal input coupling matrix, and B2 is a flexible modal input coupling matrix; C1 a rigid modal output coupling matrix, and C2 is a flexible modal output coupling matrix; mq is a rigid modal quality parameter, where q is a serial number of a logical axis channel and q=1, 2, . . . , nR; nR is the number of rigid modalities, which is equal to a total number of logical axis channels, and nL is the number of flexible modalities; ξj is flexible modal damping, and ωj is a flexible modal frequency parameter, with a flexible modal order j=1, 2, . . . , nL;

    • Step 2: set a time delay interval parameter Δτ and an instruction shaper order nCS, and calculate each pulse time delay parameter τi=Δτ·(i−1) with an instruction shaper order i=1, 2, . . . , nCS;

    • Step 3: calculate matrices Tb and Vb according to the following formulas to enable that a dynamic output force distribution matrix Tf(s) is capable of guaranteeing that the rigid modalities are completely decoupled while suppressing flexible modal vibration:












{






T
b

=



B
1
T

(


B
1



B
1
T


)


-
1









V
b

=

ker

(

B
1

)





;





(
3
)









    • Step 4: initialize the serial number of a logical axis channel to q=1;

    • Step 5: define a parameter vector Hq to be optimized in a qth column in α(s):









H
q
=A
l
lq
. . . A
n

CS

lq
. . . A
l
n

V

q
. . . A
n

CS

n

V

q  (4)

    •  where Alkq is an amplitude of an instruction shaper that has a serial number q of a logical axis channel, a serial number k of a redundancy, and the instruction shaper order of i; the serial number k of the redundancy is k=1, 2, . . . , nV; nV is a redundancy of a motion stage actuator, nV=NA−NR, and nA is the number of motion stage actuators;
    • Step 6: optimize an optimization indicator








min

β
q



J
q


=





Φ
0

·

(


T
M
q

+


V
M
q

·

β
q



)




2
2







    •  by using a method of least squares to calculate a parameter vector βq in Ĥq:








βq=(VMqTΦ0TΦ0VMq)−1(VMqTΦ0TΦ0TMq)  (5)


where











Φ
0

=

[




1
/

ω
1
2






























1
/

ω

n
L

2





]






T
M
q

=

[






T
~

1
q

+



V
~


V

1


·

T

Φ
H

q

·

Y
H
q















T
~


n
L

q

+



V
~


Vn
L


·

T

Φ
H

q

·

Y
H
q






]






V
M
q

=

[






V
~


V

1


·

V

Φ
H

q














V
~


Vn
L


·

V

Φ
H

q





]







V
~

Vj

=

[








V
~


j

1


,





n
CS









V
~


j

2


,





n
CS












V
~


jn
V


,





n
CS





]






(
6
)












{





T

Φ
H

q

=



Φ
H
qT

(


Φ
H
q

·

Φ
H
qT


)


-
1









V

Φ
H

q

=

ker

(

Φ
H
q

)









(
7
)













Φ
H
q

=

[




φ
111
C







φ


n
CS


11

C







φ

11


n
V


C







φ


n
CS


1


n
V


C





























φ

1


n
L


1

C







φ


n
CS



n
L


1

C







φ

1


n
L



n
1


C







φ


n
CS



n
L



n
V


C






φ
111
S







φ


n
CS


11

S







φ

11


n
V


S







φ


n
CS


1


n
V


S





























φ

1


n
L


1

S







φ


n
CS



n
L


1

S







φ

1


n
L



n
V


S







φ


n
CS



n
L



n
V


S




]





(
8
)












{





φ
ijk
C

=




V
~

jk

·

e


ξ
j



ω
j



τ
i






cos

(


ω
dj

·

τ
i


)









φ
ijk
S

=




V
~

jk

·

e


ξ
j



ω
j



τ
i






sin

(


ω
dj

·

τ
i


)









ω
dj

=


ω
j




1
-

ξ
j
2












(
9
)













Y
H
q

=


[




-


T
~

1
q








-


T
~

j
q








-


T
~


n
L

q




0





0



]

T





(
10
)







{tilde over (T)}jq; =bjTbq, Tbq is a qth column of Tb, and bj is a jth column of B2; {tilde over (V)}j=bjVb, {tilde over (V)}jk is a kth element of

    • Step 7: calculate an estimated value Ĥq of Hq in order to obtain zero-residue vibration of the flexible modalities:






{tilde over (H)}
q
=T
Φ

H

q
·Y
H
q
+V
Φ

H

q·βq·YHq  (11);

    • Step 8: correspondingly obtain the amplitude Aikq of the instruction shaper according to Hq defined in step 5 and Ĥq defined in step 7;
    • Step 9: q=q+1, determine whether q is greater than the total number of the logical axis channels; if yes, proceed to step 10; and if no, skip to step 5;
    • Step 10: calculate α(s) by using Aikq










α

(
s
)

=

[







i
=
1


n
CS




A
i
11



e


-

τ
i



s










i
=
1


n
CS




A
i
12



e


-

τ
i



s













i
=
1


n
CS




A
i

1


n
R





e


-

τ
i



s


























i
=
1


n
CS




A
i


n
V


1




e


-

τ
i



s










i
=
1


n
CS




A
i


n
V


2




e


-

τ
i



s













i
=
1


n
CS




A
i


n
V



n
R





e


-

τ
i



s







]





(
12
)









    • Step 11: obtain the dynamic output force distribution matrix









T
f(s)=Tb+Vb·α(s)  (13).


The present disclosure is mainly applied to design an output force distribution matrix for a multi-degree-of-freedom over-actuated motion stage, including two parts, namely establishing a mathematical model of the over-actuated motion stage based on a modal representation and designing a dynamic output force distribution matrix based on instruction execution. The part of establishing the mathematical model of the over-actuated motion stage based on the modal representation needs to obtain parameters of the mathematical model of the motion stage based on the modal representation in accordance with a mechanical structure of the motion stage and a model identification result thereof. The part of designing the dynamic output force distribution matrix based on the instruction execution is to design a dynamic matrix of output force distribution with the instruction shaping idea and obtain an analytical solution to a non-square output force distribution matrix. Zero-residue vibration suppression in all controllable flexible modalities can be realized. Overall implementation of the present disclosure is simpler and more convenient.


It is apparent for those skilled in the art that the present disclosure is not limited to details of the above exemplary embodiments. The present disclosure may be implemented in other particular forms without departing from the spirit or essential features of the present disclosure. The embodiments should be regarded as exemplary and non-limiting in every respect. The protection scope of the present disclosure is defined by the appended claims rather than the above descriptions. Therefore, all changes falling within the meaning and scope of equivalent elements of the claims are intended to be included in the present disclosure. Any reference numeral in the claims should not be considered as limiting the claims involved.


In addition, it should be understood that although this specification is described in accordance with the implementations, not each implementation only contains an independent technical solution. The description in the specification is only for clarity. Those skilled in the art should take the specification as a whole. The technical solutions in the embodiments can also be properly combined to form other implementations that can be understood by those skilled in the art.

Claims
  • 1. A method for dynamic output force distribution of a multi-degree-of-freedom over-actuated motion stage, wherein the multi-degree-of-freedom over-actuated motion stage is formed of a mechanical structure and is operated in a control system that is a closed-loop feedback system that receives an input of a reference trajectory input and generates a tracking trajectory output in response to the reference trajectory input to control a motion of the multi-degree-of-freedom over-actuated motion stage, the method comprising the following steps: step 1: establishing a mathematical model G(s) of the multi-degree-of-freedom over-actuated motion stage based on a modal representation in accordance with the mechanical structure of the multi-degree-of-freedom over-actuated motion stage and a model identification result thereof:
Priority Claims (1)
Number Date Country Kind
202211575174.1 Dec 2022 CN national