Disturbance-Rejection High-Precision Motion Control of A Stewart Platform
Disturbance-Rejection High-Precision Motion Control of A Stewart Platform
Disturbance-Rejection High-Precision Motion Control of A Stewart Platform
3, MAY 2004
(5)
with
(10)
(12)
(14)
and represent the radii of the base plate and mobile plate, re-
where is a preset constant.
spectively. stands for the splaying angle between the adjacent
Empirically, the design parameters may be determined ac-
joints on the base plate and mobile plate, respectively, repre-
cording to the following guidelines: –
sents the angle between the center of the two pair joints, and
– , and can be adjusted using the many
is the initial vertical distance of the two plates while they are
PD tuning rules available for linear PD control.
parallel and symmetrical. This parallel manipulator was initial
designed to serve as a virtual-axis machining tool [30]. At the
IV. EXPERIMENTAL RESULTS present stage, it is temporarily used as the fine tuning platform
The prototype of the experiment is shown in Fig. 2. The struc- of the feed tracking system for the scaled model experiment of
tural parameters can be listed as follows. mm, the SKA [29]. The modified hardware configuration of this con-
mm, , and mm, in which trol system is shown in Fig. 6. PCL-726 is a six-channel D/A
SU et al.: DISTURBANCE-REJECTION HIGH-PRECISION MOTION CONTROL OF A STEWART PLATFORM 369
output card, PCL-833 is a three-axis quadrature encoder card, ments of the coarse-fine cooperation control of the feed tracking
and HY-6220 is a timer to provide external interrupt signal and system for the scaled model experiment [4], [5], [29], at present,
sampling. The extendable actuator is comprised of an AC ser- the sampling period is determined as ms.
vomotor & drive unit, compliant timing belt and screwball. The The systematic parameters for this control system are listed
servomotor and driver used is Panasonic Minas A series (low in- in Table I.
ertial moment) MSM042A1F AC servomotor and the matching After several tests, the parameters of the ADRC for this ap-
driver. The ADRC algorithms were implemented in C on an plication are determined as shown in Table II.
Advantech industrial computer with a Pentium-233. Due to the In order to verify the effectiveness of the developed ADRC,
limitation of the serial-port communication in the future experi- the following experiments are carried out. Because of the high
370 IEEE TRANSACTIONS ON CONTROL SYSTEMS TECHNOLOGY, VOL. 12, NO. 3, MAY 2004
Fig. 10. Experimental result of a step command by 25% variation of the controller parameters.
Fig. 11. Length increment and tracking error of the first actuator.
robustness of ADRC and the same selected servomotor systems, error for mm is less than mm. The
the parameters for all the six extendable actuators are deter- large tracking error results from the sampling period of
mined as identical primarily, and then make the necessary small ms, which is large compared to the time constant of the used
tuning according to the respective experimental results. So, the servomotor. For this reason, the peak current has been lowered
first test examines the tracking performance of one of the ex- to 1 A in order to reduce the motor speed. The tracking error is
tendable actuators for a step command and a periodical sinu- expected to be lower with the reduction of the sampling period
soidal signal, as shown in Figs. 7 and 8, respectively. It can be or tracking a low velocity signal, just as shown in Fig. 8(b) for
seen that the error is significant only in the transition period with mm. The tracking error is less than mm.
a fast convergence and no overshoot. The steady-state tracking The result is quite favorable.
SU et al.: DISTURBANCE-REJECTION HIGH-PRECISION MOTION CONTROL OF A STEWART PLATFORM 371
Fig. 12. Length increment and tracking error of the second actuator.
Fig. 13. Length increment and tracking error of the third actuator.
Fig. 14. Length increment and tracking error of the fourth actuator.
To address the effectiveness of friction compensation, the variation of the above selected parameters. The experimental
third experiment of the tracking performance to a low slope result is shown in Fig. 10.
command is carried out. Friction, being the dominant, error-in- Compared Figs. 7 and 10, it can be seen that the tracking per-
ducing nonlinearity, will make the dominant contribution to the formance is no degradation with the variation of the selected
tracking with low velocity [18]. The experimental results are parameters by 25%. The developed ADRC has high robustness
shown in Fig. 9. It can be seen that the tracking error is only to the variation of the parameters, which makes it is very con-
mm, which is a superior performance for low velocity. venient to apply in practice.
To test the performance robustness of the developed ADRC, After the above experiments of one of the extendable actua-
the tracking performance of the same extendable actuator as the tors, the Stewart platform is reassembled together, and the mo-
first test for a step command is concerned, with 25% increased bile plate is desired to track an - planar circle with the radius
372 IEEE TRANSACTIONS ON CONTROL SYSTEMS TECHNOLOGY, VOL. 12, NO. 3, MAY 2004
Fig. 15. Length increment and tracking error of the fifth actuator.
Fig. 16. Length increment and tracking error of the sixth actuator.
It can be seen that, once entered into the steady tracking, the
tracking error of the actuator is less than mm, and the
tracking errors in coordinates are less than mm.
From the above experimental results, it may be concluded
that high tracking precision can be achieved. Furthermore, the
ADRC controller has high robustness with the variation in the
range of 25% of the selected parameters.
V. CONCLUSION
A high robust ADRC controller in linkspace is proposed to re-
alize the high precision trajectory tracking of a general 6 DOF
Stewart platform. The ADRC uses a nonlinear tracking differen-
tiator (TD) to yield a high-quality differential signal in the pres-
ence of disturbances and measurement noise in the feedforward
path, and an ESO in the feedback path to serve as a soft sensor
of general unknown disturbances arising in the control system,
Fig. 17. Trajectory of the X -Y planar circle. including nonlinear friction. The N-PD scheme is used to syn-
thesize the control action. This design is carried on directly in
of 12 cm at the linear velocity of 17 mm/s. The length increment discrete-time and the structure chosen for the realization per-
of the actuators and its tracking error is shown in Figs. 11–16, mits fast computation and avoids parameter sensitivity prob-
respectively. With the measurement of the center of the mobile lems. The experimental results show that high precision tracking
plate using Leica TC1101 total station [29], [31], the tracking for a general 6 DOF Stewart platform can be guaranteed. Fur-
of the mobile plate is shown in Fig. 17. The tracking errors of thermore, minor prior knowledge of the system is required; the
position in coordinates is shown in Fig. 18. ADRC controller can be applied to other servo system requiring
SU et al.: DISTURBANCE-REJECTION HIGH-PRECISION MOTION CONTROL OF A STEWART PLATFORM 373
high tracking precision. Above all, the structure of the controller [10] C. C. Nguyen, S. S. Antrazi, and Z.-L. Zhou, “Adaptive control of a
is simple and directly intuitive to the practitioners. stewart platform-based manipulator,” J. Robot. Syst., vol. 10, no. 5, pp.
657–687, 1993.
[11] B. Armstrong-Helouvry, P. Dipont, and C. C. de Wit, “A survey of
models, analysis, tools and compensation methods for the control of
ACKNOWLEDGMENT machines with friction,” Automatica, vol. 30, no. 6, pp. 1083–1138,
1994.
The authors would like to express their sincere gratitude to [12] J. T. Teeter, M.-Y. Chow, and J. J. Brickley Jr., “A novel fuzzy friction
Prof. J. Q. Han at Academy of Mathematics and System Sci- compensation approach to improve the performance of a DC motor con-
trol system,” IEEE Trans. Industr. Electron., vol. 43, pp. 113–120, 1996.
ences, Chinese Academy of Sciences, China, for his excellent [13] R. H. A. Hensen, M. J. G. van de Molengraft, and M. Steinbuch, “Fre-
guidance and detailed helps in the determination of the param- quency domain identification of dynamic friction model parameters,”
eters of the controller. They would also like to thank Prof. H. S. IEEE Trans. Contr. Syst. Technol., vol. 10, pp. 191–196, Mar. 2002.
[14] K. K. Tan, T. H. Lee, and H. X. Zhou, “Micro-position of linear-piezo-
Ding, Dr. J. Hao, and Ph.D. candidates C. G. Li, J. Q. Li, and electric motors based on a learning nonlinear PID controller,” Trans.
T. Fu at Beijing Institute of Technology, for their help in the Mechatron., vol. 6, no. 4, pp. 428–436, 2001.
experiment. Also, they would like to express their appreciation [15] G. Otten, T. J. A. de Vries, J. van Amerongen, A. M. Rankers, and E.
W. Gaal, “Linear motor motion control using a learning feedforward
to Prof. Y. Zheng, Prof. Z. G. Xia and Master candidate Y. B. controller,” Trans. Mechatron., vol. 2, pp. 179–187, 1997.
Luo for their help in the measurement of the experiments. They [16] G.-J. Wang, C.-T. Fong, and K. J. Chang, “Neural-network-based self-
are also grateful to the anonymous reviewers for the numerous tuning PI controller for precise motion control of PMAC motors,” IEEE
Trans. Industr. Electron., vol. 48, pp. 408–415, Feb. 2001.
comments and suggestions, which have lead to significant im- [17] K. J. Astrom and T. Hagglund, PID Controllers: Theory, Design, and
provements of this paper. Tuning, 2nd ed, NC: Instrument Society of America, 1995.
[18] B. Armstrong, D. Neevel, and T. Kusik, “New results in NPID control:
Tracking, integral control, friction compensation and experimental re-
REFERENCES sults,” IEEE Trans. Contr. Syst. Technol., vol. 9, pp. 399–406, Mar. 2001.
[19] W.-H. Chen, D. J. Balance, P. J. Gawthrop, J. J. Gribble, and J. O’Reilly,
[1] D. Stewart, “A platform with six degrees of freedom,” in Proc. Institu- “Nonlinear PID predictive controller,” in Inst. Elect. Eng. Proc.–Contr.
tion of Mechanical Engineers, vol. 180, 1965, pp. 371–386. Theory Applicat., vol. 146, 1999, pp. 603–611.
[2] J.-P. Merlet, Parallel Robots. Dordrecht, The Netherlands: Kluwer [20] Y. Xu, J. M. Hollerbach, and D. Ma, “A nonlinear PD controller for
Academic, 2000. force and contact transient control,” IEEE Contr. Syst. Mag., vol. 15, pp.
[3] J. Kim, F. C. Park, S. J. Ryu, J. Kim, J. C. Hwang, C. Park, and C. C. 15–21, 1995.
Iurascu, “Design and analysis of a redundantly actuated parallel mech- [21] J. Q. Han, “Nonlinear PID controller,” Acta Automatica Sinica, vol. 20,
anism for rapid machining,” IEEE Trans. Robot. Automat., vol. 17, pp. no. 4, pp. 487–490, 1994. In Chinese.
423–434, 2001. [22] C. J. Kempf and S. Kobayashi, “Disturbance observer and feedforward
[4] Y. X. Su and B. Y. Duan, “The mechanical design and kinematics accu- design for a high-speed direct-drive positioning table,” IEEE Trans.
racy analysis of a fine tuning stable platform for the large spherical radio Contr. Syst. Technol., vol. 7, pp. 513–526, Sept. 1999.
telescope,” Mechatronics, vol. 10, no. 7, pp. 819–834, 2000. [23] L. Xu and B. Yao, “Output feedback adaptive robust precision motion
[5] Y. X. Su, B. Y. Duan, and C. H. Zheng, “Genetic design of kinematically control of linear motors,” Automatica, vol. 37, no. 7, pp. 1029–1039,
optimal fine tuning Stewart platform for large spherical radio telescope,” 2001.
Mechatronics, vol. 11, no. 7, pp. 821–835, 2001. [24] J. Q. Han and W. Wang, “Nonlinear tracking differentiator,” J. Syst. Sci.
[6] D. H. Kim, J.-Y. Kang, and K.-I. Lee, “Robust tracking control design Math. Sci., vol. 14, no. 2, pp. 177–183, 1994. In Chinese.
for a 6 DOF parallel manipulator,” J. Robot. Syst., vol. 17, no. 10, pp. [25] J. Q. Han, “The “extended state observer” of a class of uncertain
527–547, 2000. system,” Contr. Decision, vol. 10, no. 1, pp. 85–88, 1995. In Chinese.
[7] R. Boudreau, S. Darenfed, and C. M. Gosselin, “On the computation [26] J. Q. Han and L. L. Yuan, “The discrete form of tracking-differentiator,”
of the direct kinematics of parallel manipulators using polynomial J. Syst. Sci. Math. Sci., vol. 19, no. 3, pp. 268–273, 1999. In Chinese.
networks,” IEEE Trans. Syst., Man, Cybern., pt. A, vol. 28, no. 2, pp. [27] J. Q. Han, “Auto-disturbance-rejection controller and its applications,”
213–220, 1998. Contr. Decision, vol. 13, no. 1, pp. 19–23, 1998. In Chinese.
[8] L. Baron and J. Angles, “The direct kinematics of parallel manipulators [28] Y. Huang and J. Q. Han, “Analysis and design for the second order non-
under joint-sensor redundancy,” IEEE Trans. Robot. Automat., vol. 16, linear continuous extended states observer,” Chinese Sci. Bull., vol. 45,
pp. 12–19, 2000. no. 21, pp. 1938–1944, 2000.
[9] D. Xiu, “Trajectory Control of a New Class of CNC Machine Tools,” [29] Y. X. Su, “Optimization, Analysis, and Control of the Stewart Platform
Ph.D. dissertation, Faculty of the College of Engineering, Florida At- for the SKA,” Ph.D. disertation, School of Electro-Mechanical Engi-
lantic University, 1998. neering, Xidian University, China, 2002. In Chinese.
374 IEEE TRANSACTIONS ON CONTROL SYSTEMS TECHNOLOGY, VOL. 12, NO. 3, MAY 2004
[30] H. S. Ding, D. H. Wang, and H. L. Liu, “Kinematic simulation modeling C. H. Zheng was born in Xi’an, China, in 1969. She
and its implementation in BKX-I variable-axes NC machine tool,” J. received the B.S. degree in electrical engineering
Beijing Inst. Technol., vol. 21, no. 4, pp. 434–439, 2001. In Chinese. from Xidian University, Xi’an, China, in 1991 and
[31] Guidelines to Leica TC1101 Total Station, 2001. the M.S. degree in automatic control and application
from Gansu University of Technology, Lanzhou,
China, in 1996. She is currently working toward the
Ph.D. degree in signal processing in the National
Key Laboratory of Radar Signal Processing at
Xidian University.
Y. X. Su (M’03) was born in Liaoning, China, in From June 1996 to January 2000, she was a
1969. He received the B.S. and M.S. degrees in Teaching and Researching Assistant in Xi’an
mechanical engineering from Gansu University of Petroleum Institute, Xi’an, China. From February 2000 to present, she has been
Technology, Lanzhou, China, in 1992, and 1995, a Lecturer in Xidian University. Her research interests include automation,
respectively, and the Ph.D. degree in mechatronics fuzzy signal processing, and support vector machine.
from Xidian University, Xi’an, China, in 2002.
From April 1996 to June 1998, he was a Teaching
and Researching Assistant in Xidian University.
Y. F. Zhang was born in Inner Mongolia, China. She received the B.S. degree in
From July 1998 to June 2000, he was a Lecturer in
mechanical engineering from Gansu University of Technology, Lanzhou, China,
Xidian University, where he has been an Associate
in 1998, and the M.S. degree in mechatronics from Xidian University, Xi’an,
Professor in the School of Electro-Mechanical En-
China, in 2003.
gineering, since July 2000. He has been a Research Fellow in City University
Her research interests include automation.
of Hong Kong, Hong Kong, since March 2003. His research interests include
mechatronics, motion control, robotics, and design optimization.