研究生: |
簡國華 Kuo-Hua Chien |
---|---|
論文名稱: |
即時-NURBS-運動插值器於六軸正三角構型並聯機器人之控制分析 Control of a Slide Equilateral Triangle Parallel Manipulator by Real-Time NURBS Motion Interpolator |
指導教授: |
莊華益
Hua-Yi Chuang |
口試委員: |
成維華
Wei-Hua Chieng 劉祖華 Thu-Hua Liu 楊勝明 Sheng-Ming Yang 劉昌煥 Chang-Huan Liu 唐永新 Yeong-Shin Tarng 黃安橋 An-Chyau Huang |
學位類別: |
博士 Doctor |
系所名稱: |
工程學院 - 機械工程系 Department of Mechanical Engineering |
論文出版年: | 2008 |
畢業學年度: | 96 |
語文別: | 英文 |
論文頁數: | 128 |
中文關鍵詞: | 並聯機器人 、工作空間 、奇異點 、即時NURBS運動插值器 、適應性控制 |
外文關鍵詞: | Workspace, Singularity, SETPM, Real-Time NURBS Motion Interpolator, Adaptive control |
相關次數: | 點閱:220 下載:3 |
分享至: |
查詢本校圖書館目錄 查詢臺灣博碩士論文知識加值系統 勘誤回報 |
即時NURBS運動插值器於六軸正三角構型並聯機器人之控制分析
研 究 生:簡 國 華
指 導 教 授:莊 華 益 博士
日 期:96 年 12 月
論 文 摘 要
近來,隨著半導體、光電、資訊、生物科技與奈米技術的蓬勃發展,產品外觀朝向輕薄、短小與多曲面的自由造型,其在製造上需要提供一響應速度快、定位精度高與多自由度運動的操作平台,方能符合生產上的需求。並聯機構所構成的並聯機器人具有上述的特性與優於傳統的串聯機構所構成的機器人,故並聯機器人被廣泛的應用於各種需求響應速度快、定位精度高與多自由度運動的場合。因此,本論文的研究目的是設計一新的六軸正三角構型的並聯機器人,並應用即時NURB運動插值器,產生曲線的速度及加速度命令,設計控制器控制此並聯機器人,以符合上述的問題。
本論文包含理論分析與實驗兩部份。首先,推導此並聯機器人的正(反)向運動學與正(反)向動力學,並由求得之運動學探討其運動特性,包括工作空間及奇異點。經由數值模擬結果,可知此機器人在工作空間內並不存在奇異點及比傳統的並聯機器人具有體積小與較高的載重比等優點。其次,一般傳統是使用近似的方法,求得曲線的速度及加速度,雖然其方法簡單,但因其並不是真實的曲線速度及加速度,故在實際應用上會損失其精確度。有別於傳統的方法,本論文使用即時NURB運動插值器方法,獲得曲線的真實速度及加速度,並利用此速度與加速度設計控制器,構成一即時PC-based控制系統。
此外,經由所獲得之系統動態方程式及即時NURB運動插值器所產生的速度與加速度命令,本論文提出兩種不同的控制器,控制此六軸正三角構型的並聯機器人。第一個方法,是設計一順向(feedforward)補償控制與比例-微分控制器(PD),此方法可減少計算反向動力學的時間與軌跡的追蹤誤差,進而實現即時控制系統。第二個方法,是藉由參數適應性律(adaptive law)方法,估測系統的動態參數如平台質量、慣性與摩擦等參數,並結合回授控制器,以減少其軌跡的追蹤誤差,提高其精確度。另外,此控制器滿足李亞譜諾(Lyapunov)的不確定系統的穩定性理論。
依據理論分析與實驗結果,本論文所提出的藉由即時NURB運動插值器所構成的PC-based控制系統,成功的應用於此新設計的六軸正三角構型的並聯機器人。本研究的結果,提供一響應速度快、定位精度高與多自由度運動的操作平台,可實際應用於各領域的工程上。
Abstract
Title of Dissertation: Control of a Slide Equilateral Triangle Parallel Manipulator by Real-Time NURBS Motion Interpolator
Kuo-Hua Chien , Doctor of Philosophy, 2007
Dissertation directed by: Professor Hua-Yi Chuang
Department of Mechanical Engineering
There are an increasing number of biotechnology, photoelectric, information, semiconductor and nanotechnology industrial applications where the profile of products is light and thin, short and small with freeform surface, it needs to offer a fast response and a very complex motion with many degrees of freedom system to fabricate. The parallel manipulators have high rigidity and accuracy, and high load capacity. The advantage of parallel manipulators over serial manipulators mean that the parallel manipulators have been used in any filed. The advantages of parallel manipulators over serial manipulators that parallel manipulators can be overcome the problem. This study was motivated by the problem of the trajectory generation method for control of a novel slide equilateral triangle parallel manipulator (SETPM) to provide a fast response and a very complex motion with many degrees of freedom system.
This dissertation consists of the theoretical development and experiments. First of all, the kinematics and dynamics solutions consist of inverse and forward are derived and its singularity and workspace of the manipulator are analyzed. The parallel manipulator has compact configuration and no singularities in the workspace. Secondary, the conventional method utilizes the approximate method to obtain the characteristics of curves of the velocity and acceleration for control of manipulator in the joint space. The conventional method is simple. However, it cannot get the true velocity and true acceleration of the curve, but create a loss in accuracy. This study utilizes the differential geometry to obtain the true velocity and true acceleration of the curve, to develop the real-time NURBS motion interpolator command generation, to the motion dynamics of the SETPM including position, velocity and acceleration for control of the manipulator on a PC-based system.
Also, this study presents two different types of controllers for controlling the parallel manipulator. The first method is a feedforward compensation scheme with proportional- derivate control based on the real-time NURBS motion interpolator command generation to replace inverse dynamic control, it reduces both the time to compute the inverse dynamic and the tracking error. The second method is an adaptive feedforward part with the inverse dynamic and nonlinear feedback loop based on the real-time NURBS motion interpolator command generation. The adaptive feedforward control algorithm ensures a parameter adaptation law that satisfies the Lyapunov-based stability theory of uncertain systems.
On the basis of the experimental results, we can conclude that the proposed real-time NURBS motion interpolator command generation for the two types of feedforward compensation with feedback PD controllers has also been successfully applied to a novel slide equilateral triangle parallel manipulator on a personal computer to achieve fast and precise motion. The results of this research provide a fast response and a very complex motion with many degrees of freedom system which can apply to various kinds of engineering applications.
References
[1] V. E. Gough, and S. G. Whitehall, “Universal tire test machine,” Proc. 9th International Tech. Congress FISITA, pp.117-137, 1962.
[2] D. Stewart, “A platform with six degrees of freedom”, Proc. Instn. Mech. Engrs., Part 180-1 (15), pp.371-386, 1965.
[3] S. E. Salcudean, P. A. Drexel, D. Ben-Dov, A. J. Tayor, and P. D. Lawrence, “A six degree-of-freedom, hydraulic, one person motion simulator,” Proceedings of the IEEE International Conference on Robotics and Automation, Vol. 3, pp.2437-2443,1994.
[4] K. Cleary, and T. Brooks, “Kinematic analysis of a novel 6-DOF parallel manipulator,” Proceedings of the IEEE International Conference on Robotics and Automation, Vol. 1, pp.708-713, 1993.
[5] M. Uchiyama, K. Imura, F. Pierrot, P. Dauchez, K. Unno, and O. Toyama, “A New Design of a Very Fast 6-DOF Parallel Robot,” Proc. of 23rd International Symp. On Industrial Robots, pp.771-776, 1992.
[6] C. S. Han, J. C. Hudgens, D. Tesar, and A. E. Traver, “Modeling, synthesis, analysis, and design of high resolution micromanipulator to enhance robot accuracy,” Proceedings of the IEEE/RSJ International Workshop on Intelligent Robots and Systems, Vol. 2, pp.1157-1162 , 1991
[7] T. Fukuda, and F. Arai, “Prototyping design and automation of micro/nano manipulation system,” Proceedings of the IEEE International Conference on Robotics and Automation, Vol. 1, pp.192-197, 2000.
[8] K. W. Grace, J. E. Colgate, M. R. Glucksberg, and J.H. Chun, “A six degree of freedom micromanipulator for ophthalmic surgery,” Proceedings of the IEEE International Conference on Robotics and Automation, Vol. 1, pp.630-635, 1993.
[9] R. T. Faroukia, C. Manni, and A. Sestini, “Real-time interpolator for Bezier conic,” Computer Aided Geometric Design, Vol. 18, pp.639-655, 2001.
[10] B. Bahr, X. Xiao, and K. Krishnan, “A real scheme of cubic parametric curve interpolations for CNC systems,” Computer in Industry, Vol. 45, pp.309-317, 2001.
[11] C. Lartigue, F. Thiebaut, and T. Maekawa, “ CNC tool path in terms of B-spline curves,” Computer-Aided Design, Vol. 33, pp.307-319, 2001.
[12] S. S. Yeh, and P. L. Hsu, “The speed-controlled interpolator for machining parametric curves,” Computer-Aided Design, Vol. 31, pp.349-357, 1999.
[13] M. Y. Cheng, M. C. Tsai, and J. C. Kuo, “Real-time NURBS command generators for CNC servo controllers,” International Journal of Machine Tools & Manufacture, Vol. 42, pp.801-813, 2002.
[14] M. C. Tsai, C. W. Cheng, and M. Y. Cheng, “A real-time NURBS surface interpolator for precision three-axis CNC machining,” International Journal of Machine Tools & Manufacture, Vol. 43, pp.1217-1227, 2003.
[15] C. W. Cheng, and M. C. Tsai,“ Real-time variable feed rate NURBS curve interpolator for CNC machining,” International Journal of Advanced Manufacturing Technology, Vol. 23, pp.865-873, 2004.
[16] M. Tikhon, T. J. Ko, S. H. Lee, and H. S. Kim,“ NURBS interpolator for constant material removal rate in open NC machine tools,” International Journal of Machine Tools & Manufacture, Vol. 44, pp.237-245, 2004.
[17] Q. Zhang, and R. B. Greenway, “Development and implementation of a NURBS curve motion interpolator,” Robotics and Computer-Integrated Manufacturing, Vol. 14, pp27-36, 1998.
[18] J. J. Craig, Adaptive control of mechanical manipulators. Addison-Wesley, 1988.
[19] J. J. Craig, P. Hsu, and S. Sastry, “Adaptive control of mechanical manipulators,” Proceedings of the IEEE International Conference Robotics and Automation, pp.190-195, 1986.
[20] J. J. E. Slotine, and W. Li, “On the Adaptive Control of Robot Manipulators,” International Journal of Robotic Research, Vol. 6, No. 3, pp.49-59, 1987.
[21] N. Sadegh, and R. Horowitz, “Stability and Robustness analysis of a Class of Adaptive Controllers for Robotic Manipulators,” International Journal of Robotic System, Vol. 9, No. 3, pp.74-92, 1990.
[22] G. Niemeyer, and J. J. E. Slotine, “Performance in Adaptive Control,” International Journal of Robotic Research, Vol. 10, No. 2, pp.149-161, 1991.
[23] L. L. Whitcomb, A. A. Rizzi, and D. E. Koditschek, “Comparative experiments with a new adaptive controller for robot arms,” IEEE Transactions on Robotics and Automation, Vol. 9, No. 1, pp.59-70, 1993.
[24] K. Kim, and Y. Hori, “Experimental Evaluation of Adaptive and Robust Schemes for Robot Manipulator Control,” IEEE Transactions on Industrial Electronics, Vol. 42, No. 6, pp.653-662, 1995.
[25] E. Burdet, A. Codourey, and L. Rey, “Experimental Evaluation of Nonlinear Adaptive Controllers,” Control Systems Magazine, IEEE Vol. 18, Issue 2, pp.39-47, 1997.
[26] M. Honegger, A. Codourey, and E. Burdet, “adaptive Control of the Hexaglide, a 6 dof Parallel Manipulator,” Proceedings of the IEEE International Conference on Robotics and Automation, pp.546-548, 1997.
[27] H. Asada, and J. J. E. Slotine, Robot analysis and control, John Wiley and Sons; 1985.
[28] S. H. Lee, J. B. Song, W. C. Chun, and D. Hong, “Position control of a Stewart platform using inverse dynamics control with approximate dynamics,” Mechatronics, Vol. 13, Issue 6, pp.605-619, 2003.
[29] T. Geike, and J. McPhee, “Inverse dynamics analysis of parallel manipulators with full mobility,” Mechanism and Machine Theory, Vol. 38, pp.549-562, 2003.
[30] M. Ragahavan, and B. Roth, “Inverse Kinematics of the6R Manipulator of General Geometry,” ASME Journal of Mechanical Design, Vol. 115, No. 3, pp.502-508, 1993.
[31] C. Zhang, and S. Song, “Forward Position Analysis of Nearly General Stewart Platforms,” ASME Journal of Mechanical Design, Vol. 114, pp.444-450, 1994.
[32] L. W. Tsai, Robot Analysis: The Mechanics of Serial and Parallel Manipulators, John Wiley & SONS, INC., 1999.
[33] C. S. Yee, and K. B. Lim, “Forward kinematics solution of Stewart platform using neural networks,” Neurocomputing, Vol. 16, pp.333-349, 1997.
[34] R. Boundreau, G. Levesque, and S. Darenfed, “ Parallel Manipulators kinematics learning Using holographic neural network models,” Robotics and Computer-Integrated Manufacturing, Vol. 14, pp.37-44, 1998.
[35] R. Boundreau, S. Darenfed, and C. M. Gosselin, “On the Compution of the Direct Kinematics of Parallel Manipulators Using Polynomial Networks,” IEEE Transactions on Systems, Man, And Cybernetics-Part A: Systems And Humans, Vol. 28, No. 2, pp.213-220, 1998.
[36] V. Parenti-Castelli, and C. Innocenti, “Forward displacement analysis of parallel mechanisms: Closed form solution of PRR-3S and PPR-3S structures,” ASME Journal of Mechanical Design, Vol. 114, pp.68-73, 1992.
[37] C. M. Gosselin, and J. Sefrioui, “Polynomial solutions for the direct kinematic problem of planar three-degree-of-freedom parallel manipulators,” ICAR, Fifth International Conference on Advanced Robotics, Vol. 2, pp.1124-1129, 1991.
[38] J. H. Shim, D. S. Kwon, and H. S. Cho, “Kinematic analysis and design of a six D.O.F. 3-PRPS in-parallel manipulator,” Robotica, Vol. 17, pp.269-281, 1999.
[39] H. Y. Chuang, and Y. C. Chang, “Evaluation of an Adaptive Weighting Cross-Coupled Controller for a 3-PRPS platform,” JSME International Journal Series C, Vol. 44, No.1, pp.164 - 170, 2001.
[40] E. Ottaviano, C. M. Gosselin, and M. Ceccarelli, “Singularity Analysis of CaPaMan: A Three-Degree of Freedom Spatial Parallel Manipulator,” Proceeding of the IEEE international Conference on Robotics & Automation, pp.1295-1300, 2001.
[41] C. M. Gosselin, “Determination of the Workspace of 6-DOF Parallel Manipulators,” ASME Journal of Mechanical Design, Vol. 112, pp.331-336, 1990.
[42] V. Kumar, “Characterization of Workspaces of Parallel Manipulators,” ASME Journal of Mechanical Design, Vol. 114, No.3, pp. 368-375, 1992.
[43] O. Masory, and J. Wang, “Workspace Evaluation of Stewart Platforms,” Proceedings of the ASME 22nd Biennial Mechanism Conference, Scottsdale, Arizona, Vol. 45, pp. 337-346, 1992.
[44] T. Huang, J. Wang, C. M. Gosselin, and D. Whitehouse, “Determination of Closed Form Solution to the 2-D-Orientation Workspace of Gough-Stewart Parallel Manipulators,” IEEE Transactions on Robotics and Automation, Vol. 15, No. 6, pp.561-565, 1999.
[45] I. A. Bonev, and J. Ryu, “A new approach to orientation workspace analysis of 6-DOF parallel manipulators,” Mechanism and Machine Theory 36, pp.15-28, 2001.
[46] M. Z. A. Majid, Z. Huang, and Y. L. Yao, “Workspace Analysis of a Six-Degrees of Freedom, Three-Prismatic-Prismatic- Spheric-Revolute Parallel Manipulator, ” International Journal of Advanced Manufacturing Technology, Vol. 16, pp.441-449,2000.
[47] C. Gosselin, and J. Angeles, “Singularity Analysis of Closed-Loop Kinematic Chains,” IEEE Transactions on Robotics and Automation, Vol. 6, No.3, pp.281-290, 1990.
[48] W. Q. D. Do, and D. C. H. Yang, “Inverse Dynamic Analysis and Simulation of a Platform Type of Robot,” Journal of Robotic Systems, Vol. 5, No. 53, pp. 209-227, 1988.
[49] P. Guglielmetti, and R. Longchamp, “A Closed Form Inverse Dynamics Model of the Delta Parallel Robot,” Proceedings of the International Federation of Automatic Control Conference on Robot Control, pp.39-44, 1994.
[50] K. Y. Tsai, and D. Kohli, “Modified Newton-Euler Computational Scheme for Dynamic Analysis and Simulation of Parallel Manipulators with Applications to Configuration Based on R-L Actuators,” Proceedings of the ASME Design Engineering Technical Conferences, pp.111-117, 1990.
[51] G. Lebret, K. Liu, and F. L. Lewis, “Dynamic Analysis and Control of a Stewart Platform Manipulator,” Journal of Robotic Systems, Vol. 10, No. 5, pp. 629-655, 1993.
[52] K. Miller, and R. Clavel, “The Lagrange-Based Model of Delta-4 Robot Dynamics,” Robotersysteme, Vol. 8, pp.49-54, 1992.
[53] H. Pang, and M. Shahingpoor, “Inverse Dynamics of a Parallel Manipulator,” Journal of Robotic Systems, Vol. 1, No. 8, pp.693-702, 1994.
[54] J. Angeles, Fundamentals of Robotic Mechanical Systems, Springer-Verlag, New York, N.Y, 1997.
[55] A. Codourey, and E. Burdet, “A Body-Oriented Method for Finding a Linear Form of the Dynamic Equation of Fully Parallel Robots,” Proceedings of the IEEE International Conference on Robotics and Automation, pp.1612-1618, 1997.
[56] K. Etemadi Zanganeh, R. Sinatra, and J. Angeles, “Kinematics and Dynamics of a Six-Degree-of-Freedom Parallel Manipulator with Revolute Legs,” Robotica, Vol. 15, pp.385-394, 1997.
[57] K. Miller, “Experimental Verification of Modeling of Delta Robot Dynamics by Application of Hamilton’s Principle,” Proceedings of the IEEE International Conference on Robotics and Automation, pp.532-537, 1995.
[58] J. Wang, and C. M. Gosselin, “Dynamic Analysis of Spatial Four- Degree-of-Freedom Parallel Manipulators,” Proceedings the ASME Design Engineering Technical Conferences, Paper No. DETC97/DAC3759, 1997.
[59] C. D. Zhang, and S. M. Song, “An Efficient Method for Inverse Dynamics of Manipulators Based on the Virtual Work Principle,” Journal of Robotic Systems, Vol. 10, No. 5, pp. 605-627, 1993.
[60] I. J. Baiges, and J. Duffy, “Dynamic Modeling of Parallel Manipulators,” Proceedings of the ASME Design Engineering Technical Conferences, Paper No. 96-DETC/MECH-1136, 1996.
[61] R. A. Freeman, and D. Tesar, “Dynamic Modeling of Serial and Parallel Mechanisms/Robotic Systems, part I-Methodology, part II Applications,” Proceedings of the ASME Mechanisms Conference, Trends and Developments in Mechanisms, Machines, and Robotics, pp.7-27, 1988.
[62] J. Y. S. Luh, and Y. F. Zheng, “Computation of Input Generalized Forces for Robots with Closed Kinematic Chain Mechanisms,” IEEE Journal of Robotics and Automation, Vol. 1, pp.95-103, 1985.
[63] J. J. Murray, and G. H. Lovell, “Dynamic Modeling of Closed-Chain Robotic Manipulators and Implications for Trajectory Control,” IEEE Transactions on Robotics and Automation, Vol. 5, pp.522-528, 1989.
[64] K. Sugimoto, “Kinematic and Dynamic Analysis of Parallel Manipulators by Means of Motor Algebra,” ASME Journal of Mechanisms, Transmissions, and Automation in Design, Vol. 109, No. 1, pp3-5, 1987.
[65] Y. J. Lin, and S.M. Song, “A Comparative Study of Inverse Dynamics of Manipulators with Closed-Chain Geometry,” Journal of Robotic Systems, Vol. 7, pp. 507-534, 1990.
[66] L. W. Tsai, “Solving the Inverse Dynamics of a Stewart-Gough Manipulator by the Principle of Virtual Work,” ASME Journal of Mechanical Design Engineering, Vol. 122, pp.3-9, 2000.
[67] L. Piegl, and W. Tiller, The NURBS book, Springer, 1997.
[68] D. M. Tsay, and C. O. Huey Jr., “Application of Rational B-Splines to the Synthesis of Cam-Follower Motion Programs,” Journal of Mechanical Design, Transactions of the ASME, Vol. 115, No. 3, pp621-626, 1993.
[69] FANUC Corp., FANUC AC Servo Amplifier-Maintenance Manual, 1991.
[70] J. J. Chou, and D. C. H. Yang, “Command Generation for Three-Axis CNC Machining, ”ASME Journal of Engineering for Industry, Vol. 113, pp.305-310, 1991.
[71] F. Yamaguchi, Curves and Surfaces in Computer Aided Geometric Design, Springer- Verlag, New York, N.Y. 1988,
[72] R. Kelly, and R. Salgado, “PD Control with Computed Feedforward of Robot Manipulators: A Design Procedure,” IEEE Transactions on Robotics and Automation, Vol. 10, No. 4, pp.566-571, 1994.
[73] A. Burns, and A. Wellings, Real-Time Systems and Programing Languages, Assison-Wesley, 2001.
[74] B. Armstrong, “On Finfing ’Exciting’ Trajectories for Identification Experiments Involving Systems with Non-Linear Dynamics,” Proceedings of the IEEE International Conference on Robotics and Automation, pp.1131-1139, 1987.