Advanced Precision Linear Stage For Industrial Automation Application
Advanced Precision Linear Stage For Industrial Automation Application
Advanced Precision Linear Stage For Industrial Automation Application
III. DYNAMIC MODEL OF THE LINEAR STAGE IV. DESIGN OF THE CONTROL SYSTEM
The linear drive of the stage uses a typical cascaded loop con- In developing the precision stage, a predictive controller that
trol structure. For the inner current control loops, two PI con- incorporates the future reference information has been used for
trollers have been used based on the well known vector con- the system design. Since the task in our present integrated cir-
trol concept. Fig. 2 shows the simplified block diagram of the cuit’s leads inspection application is repetitive and the desired
system. In the figure, and are the motor winding resistance motion profile can be predetermined, it is advantageous to in-
and inductance. is the viscous coefficient. is the mass corporate them into the controller as it improves the tracking
of the moving coil secondary plus the nominal weight of the performance and reduces the actuator requirements. The con-
camera system. , are the force constant and back emf trol law is formulated as
constant.
To model the precision stage, we define the following vectors: (8)
Fitness
(9)
For a relatively short move that is less than 1mm, the distur-
bance caused by the friction becomes significant in the system
response. This leads to deterioration in the performance. Thus,
the friction is modeled in our system and the estimated value is
used for the compensation. To model the friction accurately, we
use the LuGre friction model [4], [5] instead of the commonly
used static friction-speed map. Let , be the frictional force
and the speed, respectively, then the friction dynamics is mod-
eled as
(10)
(11)
(13)
(14)
by specifying a higher gradient reference trajectory but at the
expense of higher control signal.
Next, we show another set of the experimental results with the
VI. EXPERIMENTAL RESULTS required move distance reduced to 2 cm at a settling time of 0.5
Various experiments have been conducted to evaluate the seconds. The position response and the motor current response
performance of the prototype system. Fig. 5 shows the ex- are shown in Figs. 7 and 8, respectively. It is clear from the
perimental results of a 30-cm position move with a settling results that the tracking performance is good. The inset of Fig. 7
time of one second. We observe from Fig. 5 that the actual shows a close up view of the tracking with a position resolution
position response follows the position reference trajectory of 0.5 mm per division. The current response in Fig. 8 shows that
accurately. Furthermore, it reaches the desired final position there is distortion around 0.15 s due to the changes of friction.
at the specified settling time. The inset of the figure shows To study the problem due to the friction, performance degra-
a close up view of the tracking with a position resolution of dation for a short move of 500 m is presented in Fig. 9. A
2 mm per division. The speed versus position curve in Fig. 6 settling time of 0.2 s is used in this test. The results show that
shows that the actual motion trajectory follows very well with the position response has a long settling time. The stick-slip phe-
the desired motion profile. From both Figs. 5 and 6, we observe nomenon of friction causes the position response to distort when
that the achievable peak speed reaches 1.127 m/s at half the the motor reaches around the final 50- m position and degrades
move time (i.e., 0.5 s). This peak speed can be further increased the system performance. With the friction compensation scheme
LOW AND KECK: ADVANCED PRECISION LINEAR STAGE 789
REFERENCES
Fig. 10. Position response for 500-m setpoint with friction compensation.
[1] A. Hace, K. Jezernik, B. Curk, and M. Terbuc, “Robust motion control
of XY table for laser cutting machine,” in Proc. IECON, vol. 2, 1998,
TABLE I pp. 1097–1102.
SUMMARIZATION OF EXPERIMENTAL RESULTS [2] K. K. Tan, S. N. Huang, and H. L. Seet, “Geometrical error compensation
of precision motion systems using radial basis function,” IEEE Trans.
Instrum. Meas., vol. 49, pp. 984–991, Oct. 2000.
[3] K. S. Low, Y. Z. Deng, M. T. Keck, and C. W. Koh, “A high performance
linear motor drive for integrated circuit’s leads inspection system,” in
Proc. IECON, vol. 3, 1998, pp. 1321–1325.
[4] B. Armstrong-Helouvry, P. Dupont, and C. Canudas de Wit, “A survey
of models, analysis tools and compensation methods for the control of
machines with friction,” Automatica, vol. 30, no. 7, pp. 1083–1138, July
1994.
in place, Fig. 10 shows that the tracking performance is signifi- [5] C. Canudas de Wit and P. Lischinsky, “Adaptive friction compensation
with partially known dynamic friction model: Low velocities,” Int. J.
cantly improved. Moreover, the stick-slip phenomenon is dimin- Adaptive Contr. Signal Processing, vol. 11, no. 1, pp. 65–80, February
ished and the settling time is much reduced. Table I summarizes 1997.
the results of the experiments for Figs. 5–10. In general, large [6] D. E. Goldberg, Genetic Algorithms in Search, Optimization and Ma-
chine Learning. Reading, MA: Addison-Wesley, 1989.
position reference command results in faster average and peak
speeds. This leads to larger tracking errors during the transient.
However, the steady error remains zero due to the integrator in Kay-Soon Low (SM’00) received the B.Eng. degree
the controller. in electrical engineering from the National Univer-
Fig. 11 shows the performance of the linear stage using the sity of Singapore, Singapore, and the Ph.D. degree
in electrical engineering from the University of New
linear step cycle based on the machine calibration standard South Wales, Sydney, Australia.
BS3800. In the figure, there are three forward targets, an He joined the School of Electrical and Electronic
overrun of half target, three reverse targets followed by a final Engineering, Nanyang Technological University,
Singapore, in 1994, as a Lecturer and subsequently
overrun of half target. For each target, the s-shape position became an Associate Professor. During 2001 and
profile of 10- m distance is used. The experimental results 2002, he worked with various technology startup
show that the actual motion follows the reference profile very companies to pioneer the R&D work in high data
rate ultra wide-band (UWB) radio systems and to develop enterprise software.
well. Due to the short distance commanded in this test, the His funded projects are in the area of advanced motion control system, power
quantization step of 1 m of the linear encoder can be clearly electronics, and UWB radio. His research interests are in control of power
observed. A Kalman filter has been implemented in the experi- electronics and drive systems, precision servo, and UWB radio. He has served
as a consultant to many companies and holds several patents.
mentally system (Fig. 3) to provide smooth estimated position Dr. Low is a Committee Member in the Industry Applications Society of the
and speed. The solid line that passes through the discrete steps Singapore Chapter.
in Fig. 11 is the estimated position from the Kalman filter.
Meng-Teck Keck received the B.Eng. and M.S. degrees in electrical engi-
VII. CONCLUSION neering from the Nanyang Technological University of Singapore, Singapore.
He has been a Lecturer at the School of Information and Communications
A precision linear stage has been successfully developed for Technology, Ngee Ann Polytechnic, Singapore, since 2000. He teaches internet
the industrial automation applications. High closed loop perfor- computing, internetworking, systems programming, and wireless technology.
mance has been demonstrated experimentally. The results have He is the author of the book Systems Programming and Internet Computing
(Englwood Cliffs, NJ: Prentice-Hall). His research interests include genetic al-
shown that the system has good tracking and steady state per- gorithm, fuzzy logic, neural network, linear motor drive, and mobile and wire-
formance for both short and long distance moves. less communication systems.