The present invention relates to a precision positioning system for the control or regulation of non-electric variables, and more particularly to a six-degree-of-freedom precision positioning system that utilizes feedback to control position or direction.
A high-precision positioning system plays more and more important role in nowadays high technological fields, such as IC manufacturing process, home entertainment systems, including DVD and VCD players, etc. Currently, there are already developed many precision positioning technologies that adopt, for example, a piezoelectric actuator, which not only enables a definition as high as 10 nanometers within a travel distance of only 10 micrometers, but also has fast response. However, the piezoelectric actuator allows only a limited travel distance, and is therefore not suitable for the applications that require a relatively large travel distance. To meet the requirement for long travel distance, a traditional way is to use a servo motor and a cooperating lead screw, or to use a linear motor. However, since the lead screw is subject to the backlash phenomenon and the friction between bearings, the overall positioning precision is obviously lowered. On the other hand, the linear motor is subject to the ripple effects and the end-effects to thereby cause lowered positioning precision.
To overcome the above system problems, the use of a non-contact force is apparently a somewhat good solution. Among others, the pneumatic levitation system, the electrostatic levitation system, and the magnetic levitation system are the most common examples of utilization of non-contact force. However, the first two systems are not suitable for use in some special environments, such as dust-free room, vacuum environment, etc. Therefore, for the purpose of developing a high precision positioning system usable in a variety of environments, the present invention provides a system employing the magnetic levitation principle to construct its basic configuration. In recent years, more and more researches have been conducted to develop magnetic levitation systems. With the superior characteristics of the non-contact force, some of the technologies that have been considered as being unable to have further breakthrough could have remarkable development now. Some examples of such technologies include the wind tunnel system employed in aerospace and automobile industries, high-precision positioning system, big-scale speedy transiting system, bearings, and shock-absorbing system.
In the past, the inventors of the present invention had already developed a single-layer and single-axis magnetic levitation system as well as a dual-layer and dual-axis six-degree-of-freedom magnetic levitation system. While these two systems are theoretically and experimentally excellent, they still have some inherent defects that could not be easily overcome, such as low structural strength, complicated mechanism design, and relatively high power consumption. A currently available and relatively matured dual-axis magnetic levitation technology is the six-degree-of-freedom magnetic levitation positioning platform developed by Dr. Trumper of Massachusetts Institute of Technology in 1996 (referring to Won-jong Kim, David L. Trumper., “Active Multivariable Optimal Control of a Planar Magnetic Levitator.”, Proc. of th IEEE Int. Conf on Control Application, October 1997., and Trumper, D. L. and Kim, W.-J., “Magnetic Positioner Having a Single Moving Part”, US PTO, U.S. Pat. No. 6,003,230, Dec. 21, 1999.) The system of Dr. Trumper uses a linear motor as its basic configuration to simultaneously provide the vertical levitation force and the lateral driving force needed by the magnetic levitation system. However, this system involves in complicated and highly difficult fabricating procedures, and is therefore not easily widely accepted by related industrial fields.
Mr. Won-jong Kim, a student of Dr. Trumper, has also developed at University of Texas a new model of six-degree-of-freedom micro-actuator, which is now still in the research and development stage (referring to Won-jong Kim, “Precision Dynamics, Stochastic Modeling, and Multivariable Control of Planar Magnetic Levitator.” Proc. of the American Control Conf, May 2002, and S. Verma, K. Won-jong, and H. Shakir, “Multi-axis maglev nanopositioner for precision manufacturing and manipulation applications.” Industry Applications, IEEE Transactions on, vol. 41, pp. 1159-1167, 2005). The system developed by Kim uses the magnetic effect between coils and permanent magnets to achieve motions in six degrees of freedom. While it is expected this system would be able to meet the requirement of high precision, the hardware mechanism design for this system is restricted by the inherent limitation in travel distance, and is therefore not suitable for applications involving a large travel distance.
Finally, Professor Menq of Ohio University also has developed a magnetic levitation positioning system (referring to S. Ximin, K. Shih-Kang, Z. Jihua, and M. Chia-Hsiang, “Ultra precision motion control of a multiple degrees of freedom magnetic suspension stage,” Mechatronics, IEEE/ASME Transactions on, vol. 7, pp. 67-78, 2002). The system of Professor Menq utilizes the principle of linear motor to generate the lateral force and the large-scale electromagnetic coil to generate the vertical force. However, a biggest disadvantage of this system is its relatively complicated mechanism design and high manufacturing cost. Moreover, the system of Professor Menq has higher power consumption compared to the other two systems, and is therefore not economical for use.
In summary, the magnetic levitation positioning systems of prior art have one or more of the disadvantages of limited travel distance, complicated structural design, high manufacturing cost, and high power consumption. It is therefore tried by the inventor to develop a six-degree-of-freedom precision positioning system that has simple configuration, low manufacturing cost, low power consumption, and the ability of achieving long travel distance while providing high-precision positioning performance.
A primary object of the present invention is to provide a six-degree-of-freedom precision positioning system that utilizes the properties of fluid to enhance the controllability of a platform and largely reduce the power consumption by electromagnetic coils, and thereby achieves the purpose of low power loss in the system.
Another object of the present invention is to provide a six-degree-of-freedom precision positioning system that has large travel distance, precise positioning ability, and simplified as well as economical structural design.
To achieve the above and other objects, the six-degree-of-freedom precision positioning system according to the present invention includes a controller and a platform. The platform includes a hollow tank being filled with a type of fluid; a base being disposed above the hollow tank and having at least four through bores symmetrically formed thereon around a center of the base; at least four cylindrical electromagnets and at least four rectangular electromagnets being symmetrically disposed on the base around the center of the base; a carrier being located above a plurality of hollow columns that are supported by the fluid in the hollow tank, and the number of the hollow columns being the same as that of the through bores on the base; and at least eight permanent magnets being mounted to a lower surface of the carrier at positions corresponding to the cylindrical electromagnets and the rectangular electromagnets.
The structure and the technical means adopted by the present invention to achieve the above and other objects can be best understood by referring to the following detailed description of the preferred embodiments and the accompanying drawings, wherein
a shows the acting force between a rectangular electromagnet and a rectangular magnet;
b is a curve showing the distribution of magnetic forces in a horizontal direction;
a shows the acting force between a cylindrical electromagnet and a round magnet;
b is a curve showing the distribution of magnetic forces in a vertical direction;
a and 9b show the forces acted on the carrier in the present invention; and
Please refer to
where, {right arrow over (r)} is the position vector of an observation point; {right arrow over (r)}′ is the surface current position vector; {right arrow over (J)}({right arrow over (r)}′) is the density of current flowed through the coil; and {right arrow over (i)}r′r is the position vector of the observation point relative to the surface current.
The above equation (1) may be applied to a cylindrical electromagnet as that shown in
where, h1 is the coil height; N is the number of coil turns; r2 and r1 represent the coil inner and outer diameters, respectively; and Icyl is the amount of current input to the coil. As can be easily found from the above, {right arrow over (H)}cyl is the product of a spatial position function and the magnitude of current, and may be otherwise expressed as below:
{right arrow over (H)}
cyl
={right arrow over (h)}
cyl(x,y,z)Icyl (3)
Similarly, the magnetic field produced by a rectangular electromagnet may be expressed as below:
{right arrow over (H)}
rec
={right arrow over (h)}
rec(x,y,z)Irec (4)
Please refer to
{right arrow over (F)}=(m·∇){right arrow over (B)} (5)
where, {right arrow over (m)} is the magnetic dipole vector of the magnet.
From the above equations (3) and (4), it can be easily found the magnetic force of the magnet in the magnetic field produced by the electromagnet can be expressed as below:
{right arrow over (F)}={right arrow over (g)}(x,y,z)I (6)
where, {right arrow over (g)}(x,y,z) is a function of the relative position of the magnet to the electromagnet.
To efficiently obtain the relational expression of the {right arrow over (g)}(x,y,z), the complicated theoretical derivation or the Finite Element Method (FEM) that requiring large amount of calculation is not adopted in the present invention to obtain the magnitude of force acted on the magnet in the coil. Instead, a high-precision load cell is used to measure the magnitude of force acted on the magnet in the coil. The measured force is then divided by the current value to obtain a distribution curve of the {right arrow over (g)}(x,y,z).
a shows the acting force between a rectangular electromagnet and a rectangular magnet, and
where,
k
18=3.296×104, k17=−6.8966×103, k16=5.9341×102, k15=−2.7023×101, k14=6.9848×10−1, k13=−1.0247, k12=8.2791×10−1, k11=−5.5795×10−4, k10=1.517.
Therefore, the relational expression of {right arrow over (g)}(x,y,z), which is the function of the relative position of the rectangular electromagnet to the rectangular magnet, is obtained.
a shows the acting force between a cylindrical electromagnet and a round magnet; and
where,
k
25=1.4002×10−4, k24=−3.3606×10−3, k23=2.1592×10−2, k22=−1.9082×10−3, k21=−4.2105×101, k20=1.8927.
The objects to be achieved by the present invention and the strategies adopted by the present invention to achieve the objects are now briefly described as below:
Using buoyancy to counterbalance 90% weight of a platform of the system to thereby achieve the effect of low power consumption; and
The present invention will now be described in more details as below. Please refer to
According to another embodiment of the present invention, as shown in
Through Newton's second law, the eight magnetic forces shown in
ΣFx:M{umlaut over (x)}=fx1+fx2−4bx{dot over (x)}
ΣFy:Mÿ=fy1+fy2−4by{dot over (y)}
ΣFz:M{umlaut over (z)}=fz1+fz2+fz3+fz4−4bzż−Mg
Στψ:Ixx{umlaut over (ψ)}=(fz4−fz3)db−bψ{dot over (ψ)}+4by{dot over (y)}dcouple
Στφ:Iyy{umlaut over (φ)}=(fz2−fz1)db−bφ{dot over (φ)}+4bx{dot over (x)}dcouple
Στθ:Izz{umlaut over (θ)}=(fx1+fy1)da−(fx2+fy2)da−bθ{dot over (θ)}. (9)
where, M is the mass of the motion platform; g is the gravitational acceleration; and Ixx, Iyy, and Izz are the rotational inertia of the motion platform along X-axis, Y-axis, and Z-axis, respectively. The above equations may be rewritten in the form of matrix equation as follows:
d
D+B
u
U−G. (10)
where,
Since some factors, such as errors in hardware fabrication, influences of temperature changes on coil impedance, etc., are ignored in the process of system modeling, there would be errors and variations in the parameters of the derived system dynamic model. Therefore, an adaptive controller is adopted in the present invention to compensate the influences from the errors and variations of the parameters of the dynamic model. Moreover, for the purpose of increasing the system response speed, the Sliding Mode is employed in designing the controller of the present invention to increase the system ability to respond, as shown in
To facilitate convenient design of the controller, the system dynamic model is first linearized and it is defined that the error variable E≡X−Xd, so that the above Equation (10) may be rewritten as below:
d
D+B
u
U
Ctrl
−
d, (11)
where, Xd is the intended positional trajectory, and Wl represents the uncertain factors in the system.
The above equation (11) may be then further formulated as follows:
d
D+B
u
U
Ctrl
−
d
+W. (12)
Wherein, the defined W is further divided into two parts, one of which is the constant fluctuation Wc and defined as mechanical errors in manufacture, and the other part is the time-varying fluctuation Wv and defined as external noises. Thus, the above equation (12) may be further rewritten as below:
d
D+B
u
U
AS
−
d
+W
c
+W
v (13)
wherein, it is assumed the varying uncertain factors Wv is within a limited range, that is, ∥Wv∥≦Wmax.
To increase the system ability to response, the sliding surface S is defined as below:
S=Ė+ΛE (14)
wherein, Λ≡diag[λ1, λ2, λ3, λ4, λ5, λ6]T, and ∀λi>0.
Thereafter, the control input is designed as below:
U
AS
={circumflex over (B)}
u0
−1
[−Â
0
{dot over (X)}−{circumflex over (B)}
d0
D+{umlaut over (X)}
d
−Ŵ
c0
−ΛĖ−KS−Nsat(S)] (15)
where, K≡diag[k1, k2, k3, k4, k5, k6]T; ∀ki>0; N≡diag[η1, η2, η3, η4, η5, η6]T; ∀ηi>0; ∥N∥≧Wmax; Â0,{circumflex over (B)}u0,{circumflex over (B)}d0 and Ŵc0 are the estimated values of A0,Bu0,Bd0 and Wc0 respectively; and finally, sat(.) is saturation function defined as below:
sat(S)≡[sat(s1),sat(s2),sat(s3),sat(s4),sat(s5),sat(s6)]T (16)
wherein,
is a margin setting parameter.
To obtain the estimation rules for parameter estimation, the Lyapunov Stability Analysis [24] is used. First, the Lyapunov function candidate Vis designed to be:
where, both of Γ1−1 and Γ2−1 are positive definite diagonal matrixes. Then, differentiate the above equation (17) with respect to time to obtain the following:
{dot over (V)}=S
T
{dot over (S)}+tr(Ã0TΓ1−1{tilde over ({dot over (A)}0)+tr({tilde over (B)}d0TΓ2−1{tilde over ({dot over (B)}d0)+tr({tilde over (B)}u0TΓ3−1{tilde over ({dot over (B)}u0)+tr({tilde over (W)}c0TΓ4−1{tilde over ({dot over (W)}c0), (18)
Then, substitute the above equations (14) and (15) into the equation (18). After a large quantity of matrix operation, a simplified result as follows is obtained:
Based on the theory of Lyapunov Stability Analysis, the above equation (19) must be smaller than zero or equal to zero for the system to be stable. Therefore, the estimation rule for parameter estimation in the present invention may be derived as below:
−{tilde over ({dot over (A)}0={circumflex over ({dot over (A)}0=Γ1S{dot over (X)}T−Γ1Σ1Â0,
−{tilde over ({dot over (B)}d0={circumflex over ({dot over (B)}d0=Γ2SDT−Γ2Σ2{circumflex over (B)}d0,
−{tilde over ({dot over (B)}u0={circumflex over ({dot over (B)}u0=Γ3SUAST−Γ3Σ3{circumflex over (B)}u0,
−{tilde over ({dot over (W)}c0={circumflex over ({dot over (W)}c0=Γ4S−Γ4Σ4Ŵc0. (20)
Therefore, with the system parameter estimation rule and the controller design derived from the above theory, it is able to prove according to BarBalat's Lemma that the state variables of the system may be converged to zero.
Since the carrier 30 is connected with the hollow columns 32, the carrier 30 is acted not only by magnetic force, but also by the buoyancy of the fluid 12. There are two advantages in utilizing the properties of fluid. First, the fluid provides buoyancy that counterbalances 90% of the weight of the platform. Therefore, small-scale coils may be used to generate sufficient force for driving the platform to move, and the system can be low power consumption. Second, with the properties of fluid, the whole system may have enhanced damping capacity, making the system more easily controllable. As a result, the problems of high power consumption and uneasy to control in the conventional magnetically levitated positioning platform can be overcome.
Finally, with the adaptive sliding controller particularly derived for the positioning system of the present invention, the positioning system of the present invention is able to satisfy the requirements of high precision positioning and fast response. When it is desired to expand the motion range of the platform, a user needs only to install sensors with increased measuring range and to properly increase the inner diameter of the coils and the size of the permanent magnets. Therefore, the mechanism design for the present invention is highly flexible to allow system upgrade and application in different fields.
Number | Date | Country | Kind |
---|---|---|---|
97110468 | Mar 2008 | TW | national |