MOTION SYSTEM WITH A CONFIGURABLE FEEDFORWARD CONTROL
20240194512 ยท 2024-06-13
Inventors
Cpc classification
G05B19/404
PHYSICS
F16F15/002
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
International classification
Abstract
A motion system includes a motion hardware system and a motion control system configured to control the movement of the motion hardware system. The hardware system includes a motion stage, a platform supporting the motion stage, and a machine frame resting on a ground surface. The platform includes a base and an active vibration isolation system arranged between the base and the machine frame. The active vibration isolation system includes actuators to provide together at least three degrees-of-freedom actuation of the base. The motion control system includes a feedforward control having a vibration isolation system controller for controlling the at least three DOF actuation of the active vibration isolation system to compensate, by exerting a counteracting force on the base, for expected reactions forces exerted by the motion stage on the base when operating. The feedforward control includes a memory for storing a string of characters defining the motion equations based on the topology of the motion stage, and a processing unit for processing the string of characters to compute the counteracting force.
Claims
1. A motion system, comprising: a motion hardware system including a motion stage, a support assembly supporting the motion stage, and a machine frame adapted to rest on a ground surface, the support assembly including a base and an active vibration isolation system arranged between the base and the machine frame, the active vibration isolation system including actuators adapted to provide at least three degrees-of-freedom (DOF) actuation of the base; and a motion control system configured to control movement of the motion hardware system and including a feedforward control, the feedforward control including a vibration isolation system controller adapted to control the at least three DOF actuation of the active vibration isolation system to compensate, by exerting a counteracting force on the base, for expected reactions forces exerted by the motion stage on the base when operating; wherein the feedforward control includes a memory adapted to store a string of characters defining motion equations based on a topology of the motion stage and a processing unit adapted to process the string of characters to compute the counteracting force.
2. The motion system according to claim 1, wherein the motion control system includes at least one position controller to acquire a position and an acceleration of a motion axis of the motion stage, a master controller adapted to receive and process data relative to the position and the acceleration of the motion axis of the motion stage corresponding to the motion equations, and a digital bus linking the position controller to the master controller and the master controller to the active vibration isolation system controller, the master controller being adapted to compute, in real-time, the counteracting force based on the string of characters and to send the computed counteracting forces to the active vibration isolation system controller.
3. The motion system according to claim 2, wherein the master controller is configured to provide a user interface to enter and/or edit the stored string of characters.
4. The motion system according to claim 3, wherein the user interface is connected to the master controller through a wired and/or wireless network.
5. The motion system according to claim 3, wherein the user interface includes a computer, a portable computer, a tablet, a smartphone, and/or a touch screen.
6. The motion system according to claim 2, further comprising another memory adapted to store predetermined strings of characters defining the motion equations of the motion stage corresponding to different topologies of the motion stage, the predetermined strings being selectable by dedicated software.
7. The motion system according to claim 1, wherein the string of characters includes mathematical expressions for equations in the following form:
F=?({right arrow over (x)},{right arrow over ({umlaut over (x)})},{right arrow over (p)}) in which F=(F.sub.x, F.sub.y, F.sub.z, T.sub.x, T.sub.y, T.sub.z).sup.T represents a vector of the counteracting forces in at least three DOF, {right arrow over (x)}, {right arrow over ({umlaut over (x)})} represent vectors of respectively motion stage axes positions and accelerations, {right arrow over (p)} represents a vector of tunable parameters, and ? represents a function defining the motion equations for a given motion stage topology.
8. The motion system according to claim 7, wherein the vector of tunable parameters includes components representing a mass, a dimension, an angular momentum, and/or an inertia.
9. The motion system according to claim 7, wherein the motion control system is configured to provide a user interface to edit values of the vector of tunable parameters.
10. The motion system according to claim 7, wherein the active vibration isolation system includes sensors adapted to provide together three or six DOF measurements of motions of the base, the motion system further comprising a feedback damping system including a damping controller adapted to control three or six DOF actuation of the active vibration isolation system based on outputs of the sensors to dampen vibrations caused by seismic forces transmitted the ground surface.
11. The motion system according to claim 10, wherein software of the motion system is adapted to perform the tuning of the vector of tunable parameters by executing a grid search tuning of the vector of tunable parameters to find a set of parameters allowing for reduction of energy of an output signal generated by the damping controller.
12. The motion system according to claim 10, wherein the motion system is adapted to perform the tuning of the vector of tunable parameters by executing a grid search tuning of the vector of tunable parameters to find a set of parameters allowing to reduce an energy of an output signal generated by the damping controller.
13. The motion system according to claim 10, wherein the motion system includes software adapted to perform the tuning of the vector of tunable parameters by executing a model-based sensitivity analysis tuning of the vector of tunable parameters based on derivatives of the motion equations allowing for reduction of energy of an output signal generated by the damping controller.
14. The motion system according to claim 10, wherein the motion system is adapted to perform the tuning of the vector of tunable parameters by executing a model-based sensitivity analysis tuning of the vector of tunable parameters based on derivatives of the motion equations allowing for reduction of energy of an output signal generated by the damping controller.
15. The motion system according to claim 1, wherein the memory is adapted to store the string of characters in a text file.
16. The motion system according to claim 3, wherein the user interface includes a graphical programming language and/or graphical system modeling adapted to generate the string of characters.
17. The motion system according to claim 1, wherein the base includes a granite slab.
18. The motion system according to claim 1, wherein the active vibration isolation system includes actuators adapted to provide at least DOF actuation of the base.
19. The motion system according to claim 18, wherein the actuators include linear actuators.
20. The motion system according to claim 19, wherein the motion control system includes a position controller corresponding to each actuator and adapted to drive the corresponding actuator along a respective linear axis.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0024]
[0025]
[0026]
[0027]
DETAILED DESCRIPTION
[0028] Referring to
[0029] Referring to
[0030] A stationary part of the motion stage 102 is fixed to the base 112. The active vibration isolation system 114 includes actuators to provide together at least three degrees-of-freedom (DOF) actuation of the base 112. As illustrated in
[0031] Referring to
[0032] The feedforward control 210 includes a memory 224 for storing a string of characters defining the motion equations based on the topology of the motion stage 102, and a processing unit 222 for processing the string of characters to compute the counteracting force vector F.
[0033] For example, the string of characters determining the counteracting force vector F does not need to be provided in a particular programming language as it does not need to be compiled prior to its use. This feature allows a significant level of flexibility regarding the topologies of the motion stage.
[0034] For example, a user may provide a text file containing the string of characters to be interpreted by the processing unit 222 to compute the counteracting force F.
[0035] A user may use a graphical programming language or graphical system modelling to generate the string of characters to be interpreted by the processing unit 222 to compute the counteracting force F.
[0036] Referring again to
[0037] The master controller 220 is configured to receive and process data relative to the position x, y and acceleration {umlaut over (x)}, ?x of the first and second linear motion axes 103a, 103b of the motion stage 102 when operating using the digital bus 260 as a transmission device and according to the string of characters to compute the counteracting force vector F. The computational power of the master controller 220 allows the interpretation of the string of characters to derive mathematical expressions and a sequence of mathematical operations every time the string of characters is modified by the user. The computational power of the master controller 220 also allows the computation of the counteracting force vector F in near real-time using the sequence of mathematical operations. The computed counteracting force vector F is transmitted to the active vibration isolation system controller 230 using the digital bus 260 to control the actuators of the support assembly 110 of the motion hardware stage 100 to counteract the reactions forces generated by the motion stage.
[0038] For example, the master controller 220 includes a user interface allowing an operator to enter and/or edit the motion equations determining the counteracting force F. The user interface allows a user to enter strings of characters corresponding to the topology of the motion stage.
[0039] For example, the user interface may be integrated in the master controller or connected to the master controller via a wired network. Alternatively, the user interface may be connected to the master controller via a wireless network, allowing its use from a remote device.
[0040] The user interface may for example be a simple bus for data transfer, such as a USB port allowing the user to transfer a file containing the string of characters. Alternatively or complementarily, the user interface may provide for the user to directly enter (write) the string of characters into the master controller 220. The user interface may include a computer, a remotely connected computer, a tablet, a smartphone, or any other such type of electronic device allowing to share data with the master controller.
[0041] Each of the first and second position controllers 250a, 250b includes a delayed circuit to delay the signal, by a few milliseconds, for driving the first and second linear motion axes 103a, 103b of the motion stage 102 in order to take into consideration the computing time of the master controller and the digital bus latency. This ensures that actuators of the active vibration isolation system 114 are controlled by the active vibration isolation system controller 230 in synchronization with the reactions forces exerted by the motion stage 102 on the base 112.
[0042] For example, the active vibration isolation system 114 further includes inertial sensors, e.g., seismic sensors, to provide together three or six DOF measurements of the motions of the base 112. The support assembly includes a feedback damping system 240 transmitting measurements from the inertial sensors to a damping controller 245 for controlling, at each sampling period, the actuators of the active vibration isolation system 114 based on the inertial sensors' outputs to dampen any vibrations caused for example by seismic forces transmitted from the ground surface 300. The force vector output of damping controller 245 is added to the computed counteracting force F and used as force reference for the actuators that provide at least three degrees-of-freedom (DOF) actuation of the base 112. The motion system 10 can therefore counteract the reaction forces of the motion stage while being isolated from vibrations from the ground surface 300.
[0043] The string of characters may be retrieved from a configuration file which may include a configurable set of motion equations corresponding to different predefined motion stage topologies. This file may be downloaded in the memory 224 of the master controller 220.
[0044] The equations used by the master controller 220 to compute the counteracting force F can be expressed as F=?({right arrow over (x)},{right arrow over ({umlaut over (x)})},{right arrow over (p)}), in which F=(F.sub.x, F.sub.y, F.sub.z, T.sub.x, T.sub.y, T.sub.z).sup.T represents the vector of the counteracting forces in at least three DOF, {right arrow over (x)}, {right arrow over ({umlaut over (x)})} represent the vectors of respectively motion stage axes positions and accelerations, {right arrow over (p)} represents a vector of tunable parameters, and ? represents a function defining the motion equations for the given motion stage topology.
[0045] The motion equations are given in the form of at least three expressions for calculating, at each sampling period, the three forces F.sub.x, F.sub.y, F.sub.z, and three torques T.sub.x, T.sub.y, T.sub.z, for a 6DOF system to compensate for the motion stage reaction forces. The calculation of the forces uses Newton's second law of motion F=m.Math.a and its counterpart for rotary motions. The expressions for the values of torque may include gravity compensation to maintain the base horizontal when the motion stage moves in the plane.
[0046] The vector of tunable parameters {right arrow over (p)} includes items representing a mass, a dimension, such as a length, a width, a height, a diameter, an angular momentum, an inertia of the motion stage, etc. Any other relevant physical quantity for the determination of the counteracting force F can be included in the vector of tunable parameters.
[0047] The motion control system may provide a user interface to edit the values of these tunable parameters.
[0048] One or more parameters of the vector of tunable parameters {right arrow over (p)} can be tuned using dedicated software to increase the performances of the control motion system. The string of characters can be provided to the software, allowing an evaluation of the equations determining the counteracting force which makes possible to perform parameter-tuning experiments.
[0049] For example, a grid search parameter tuning can be performed by the software so as to optimize one or more parameters simultaneously. Typically, a couple of parameters (p, p) of the vector of tunable parameters {right arrow over (p)} are to be tuned simultaneously. For each pair of test parameters (p.sub.i, p.sub.j), a stage motion of the motion stage is repeated. For each experiment, the motion of the base 112 is measured. A dimension reduction algorithm such as a PCA (Principal Component Analysis) can be used to define a cost function. The minimum of this cost function provides the best couple of parameters that can be used to compute the counteracting force F. The cost function can be defined as the energy of an output signal generated by the damping controller.
[0050] For example, a model-based sensitivity analysis tuning may be performed allowing a fast-converging tuning scheme. Model-based refers, for example, the analysis taking into account the particular motion equations corresponding to the topology of the motion stage and therefore the counteracting force to be applied. Referring to
[0051] The model-based sensitivity analysis relies on an estimation of the variation of {right arrow over (Q)} with respect to the parameters p.sub.i forming the vector of tunable parameters {right arrow over (p)} around a given starting point. In other words, the partial derivatives of {right arrow over (Q)} with respect to {right arrow over (p)} are estimated around a measurement signal. Then, an update of the components of {right arrow over (p)} are computed so as to reduce the cost function derived from the signal {right arrow over (Q)}. This method is based on the theory of online parameter tuning, optimal control, repetitive control, and iterative learning control.
[0052] Alternatively or complementarily, a delay tuning to compensate for communication-bus transmission time and/or various accumulated phase-delay within the whole control loop can be applied.
[0053] For example, this delay to be applied is considered as one additional parameter t for every motion stage axis. The sensitivity is defined as the variation of the output signal {right arrow over (Q)} with respect to this parameter ? and can be estimated by finite differences using an additional measurement performed with a slightly different stage delay. This approach can be used in conjunction with both the described tuning techniques.
[0054]
[0055] In more complex examples, the user may introduce intermediate temporary variables to reduce the overall number of operations. The above motion equations, which correspond to a rigid-body model of the motion stage, may be extended with some internal dynamics of input or output filters, thereby covering more detailed modelling of the motion stage and motion stage control.
LIST OF REFERENCE NUMERALS
[0056] 10 Motion system [0057] 100 Motion hardware system [0058] 102 Motion stage [0059] 103a, 103b First and second linear motion axes [0060] 110 Support assembly [0061] 112 Base (e.g. granite slab) [0062] 114 Active vibration isolation system [0063] 116 Machine frame [0064] 200 Motion control system [0065] 210 Feedforward control [0066] 220 Master controller [0067] 222 Processing unit [0068] 224 Memory [0069] 230 Vibration isolation system controller [0070] 240 Feedback damping system [0071] 245 Damping controller [0072] 250a, 250b Position controllers [0073] 252 Delay timer [0074] 260 Digital bus [0075] 300 Ground surface