簡易檢索 / 詳目顯示

研究生: 鍾永利
Yuddy - Syaifudin
論文名稱: 微手掌的建模與控制器設計
Modeling and Controller Design of a Micro-Hand
指導教授: 劉添華
Tian-Hua Liu
口試委員: 許源浴
Yuan-Yih Hsu
廖聰明
Chang-Ming Liaw
林法正
Faa-Jeng Lin
劉益華
Yi-Hua Liu
學位類別: 碩士
Master
系所名稱: 電資學院 - 電機工程系
Department of Electrical Engineering
論文出版年: 2014
畢業學年度: 102
語文別: 英文
論文頁數: 109
中文關鍵詞: 微手掌微型永磁同步電動機建模双自由度比例-積分-微分控制器壓力控制
外文關鍵詞: micro-hand, micro-permanent magnet synchronous motor, modeling, two-degree-of-freedom PID controller, force controller
相關次數: 點閱:374下載:3
分享至:
查詢本校圖書館目錄 查詢臺灣博碩士論文知識加值系統 勘誤回報
  • 本文提出建模和控制器設計微手掌系統,一個五隻手指的微手掌系統。提出兩個新的運動學模型,並推導手指指尖的運動軌跡追蹤,各別稱為maximum angle model和differential angle model。每個手指,有四個關節,僅透過一個微永磁同步電動機來驅動腱機構。双自由度的比例-積分-微分控制器,用來獨立地和同時控制各微型永磁同步電動機。因此,每隻手指被獨立地控制,以控制手指移動位置。此外,手指的指尖有壓力感測器,透過使用兩種方法來控制。第一個是力傳輸信號的測量方法,第二個是q軸電流的測量方法。執行壓力的控制,以避免損壞抓取物。微手掌能精確地握住雞蛋、球、剃須膏、標記筆、瓶罐,和滑鼠。實驗結果證明双自由度的PID控制器的性能比PI控制器更好。


    This paper proposes the modeling and the controller design of a micro-hand, an under-actuated five fingered robot hand. Two new general kinematic models are proposed and used to derive the micro-hand fingertip trajectory, which are called the maximum angle model and differential angle model. Each finger, which is consisted of four joints, is driven only by a micro-permanent magnet synchronous motor with using tendon driven mechanism. The two-degree-of-freedom proportional-integral-derivative controller is used to control each micro-permanent magnet synchronous motor independently and simultaneously. Therefore, each micro-finger is controlled independently to define the micro-hand behavior. In addition, the contact force of each fingertip of the micro-hand is measured online and controlled by using the combination of two methods. The first one is the force sensor signal measurement method and the second one is the q-axis current measurement method. The force control is executed to avoid damaging the grasped object. The micro-hand can precisely hold an egg, a ball, a container of shaving cream, a marking pen, a can, and a computer mouse. Experimental results given to validate the theoretical analysis show that the two-degree-of-freedom PID controller performs better than the common PI controller.

    MASTER’S THESIS RECOMMENDATION FORM ii QUALIFICATION FORM BY MASTER’S DEGREE EXAMINATION COMMITTEE iii ABSTRACT vi 中文摘要 vii DEDICATION viii ACKNOWLEDGEMENT ix TABLE OF CONTENTS x LIST OF FIGURES xii LIST OF TABLES xv CHAPTER 1 INTRODUCTION 1 1.1 Background 1 1.2 Literature Review 2 1.3 Organization of the Thesis 4 CHAPTER 2 MATHEMATICAL MODEL OF MICRO-PMSM 6 2.1 Introduction 6 2.2 Mathematical Model 7 CHAPTER 3 DYNAMIC MODEL OF THE PROPOSED MICRO-HAND 10 3.1 Introduction 10 3.2 The Mechanisms of the Micro-Hand and the Micro-Finger 10 3.3 Maximum Angle Model 20 3.4 Differential Angle Model 22 3.5 The Model of the Proposed Micro-Hand 24 CHAPTER 4 CONTROLLER DESIGN 31 4.1 Introduction 31 4.2 PID Controller Design 32 4.3 Two-Degree-of-Freedom PID Controller Design 34 4.4 Stability Analysis and Controller Tuning 41 CHAPTER 5 IMPLEMENTATION 45 5.1 Introduction 45 5.2 Hardware 46 5.3 Software 57 CHAPTER 6 EXPERIMENTAL RESULTS 66 6.1 Introduction 66 6.2 Measured Results 66 CHAPTER 7 CONCLUSIONS 88 7.1 Conclusion Remarks 88 7.2 Future Work 88 REFERENCES 90

    [1] R. Mohammdi-Milasi, C. Lucas, and B. Nadjar-Arrabi, "Speed control of an interior permanent magnet synchronous motor using belbic (brain emotional learning based intelligent controller)," IEEE Proceedings World Automation Congress 2004, Albuquerque, NM, USA, July 2004, pp. 280-286, vol. 18.
    [2] R. A. McCann and S. R. Damugatla, "Analysis of an interior permanent magnet synchronous motor with MEMS based rotor flux sensing," IEEE Industry Applications Conference IAS-2005, Kowloon, Hong Kong, October 2005, pp. 993-998, vol. 2.
    [3] M. J. Melfi, S. D. Rogers, S. Evon, and B. Martin, "Permanent-magnet motors for energy savings in industrial applications," IEEE Transactions on Industry Applications 2008, vol. 44, no. 5, pp. 1360-1366, September 2008.
    [4] G. Nansha and Y. Lie, "Research on loss and electromagnetic heat coupling of high speed permanent magnet synchronous motor," IEEE International Conference on Mechatronics and Automation ICMA-2013, Takamatsu, Japan, August 2013, pp. 81-86.
    [5] Y.-H. Chang, T.-H. Liu, and C.-C. Wu, "A novel micro permanent magnet synchronous motor drive system without using a rotor position," IEEE Conference on Industrial Electronics and Applications ICIEA-2006, Singapore, May 2006, pp. 1-6.
    [6] Y.-H. Chang, T.-H. Liu, and D.-F. Chen, "Design and implementation of a robust controller for a micro permanent magnet synchronous speed control systems," IEEE International Conference on Innovative Computing, Information and Control ICICIC-2007, Kumamoto, Japan, September 2007, pp. 99-99.
    [7] W.-C. Wang, T.-H. Liu, and K.-Y. Fan, "Design and implementation of a wavelet speed controller with application to micro-permanent magnet synchronous motor drives," Electric Power Applications IET-2013, vol. 7, no. 4, pp. 245-255, April 2013.
    [8] W.-C. Wang, T.-H. Liu, Y. Syaifudin, and T.-K. Wang, "Implementation of position and force controllers for a micro-hand based on adaptive inverse control," IEEE International Future Energy Electronics Conference IFEEC-2013, Tainan, Taipei, November 2013, pp. 205-210.
    [9] W.-C. Wang, T.-H. Liu, and K.-Y. Fan, "Wavelet controller design for a micro-PMSM control system," IEEE International Symposium on Industrial Electronics ISIE-2013, Taipei, Taiwan, May 2013, pp. 1-6.
    [10] T.-Y. Chou, T.-H. Liu, and T.-T. Cheng, "Design and implementation of an adaptive inverse controller for a micro-permanent magnet synchronous motor control system," Electric Power Applications IET-2009, vol. 3, no. 5, pp. 471-481, September 2009.
    [11] T.-Y. Chou and T.-H. Liu, "Implementation of a motion control system using micro-permanent magnet synchronous motors," Electric Power Applications IET-2012, vol. 6, no. 6, pp. 362-374, July 2012.
    [12] L.-R. Lin and H.-P. Huang, "Integrating fuzzy control of the dexterous National Taiwan University (NTU) hand," IEEE/ASME Transactions on Mechatronics 1996, vol. 1, no. 3, pp. 216-229, September 1996.
    [13] Z. Libin, W. Zhiheng, Y. Qinghua, B. Guanjun, and Q. Shaoming, "Development and simulation of ZJUT hand based on flexible pneumatic actuator FPA," IEEE International Conference on Mechatronics and Automation ICMA-2009, Changchun, China, August 2009, pp. 1634-1639.
    [14] R. Oshima, T. Takayama, T. Omata, K. Kojima, K. Takase, and N. Tanaka, "Assemblable three-fingered nine-degrees-of-freedom hand for laparoscopic surgery," IEEE/ASME Transactions on Mechatronics 2010, vol. 15, no. 6, pp. 862-870, December 2010.
    [15] L. U. Odhner, R. R. Ma, and A. M. Dollar, "Open-loop precision grasping with underactuated hands inspired by a human manipulation strategy," IEEE Transactions on Automation Science and Engineering 2013, vol. 10, no. 3, pp. 625-633, July 2013.
    [16] J. Jaafar and R. L. A. Shauri, "Three-fingered robot hand for assembly works," IEEE International Conference on System Engineering and Technology ICSET-2013, Shah Alam, Malaysia, August 2013, pp. 237-241.
    [17] T. Nakamura and I. Ando, "Design of micro-hand with two magnetic levitated fingers," IEEE Proceedings International Symposium on Micromechatronics and Human Science 1997, Nagoya, Japan, October 1997, pp. 137-142.
    [18] T. Nakamura, K. Shimamura, and T. Ando, "A magnetic suspension parallel motion hand and its application to micro processes," IEEE Proceedings International Symposium on Micromechatronics and Human Science MHS-2000, Nagoya, Japan, October 2000, pp. 157-162.
    [19] S. Ohno, L. Zhiqi, and T. Nakamura, "Wire-in-hole operation using a magnetic suspension parallel motion hand," IEEE Proceedings International Symposium on Micromechatronics and Human Science MHS-2002, Nagoya, Japan, October 2002, pp. 111-115.
    [20] T. Tanikawa and T. Arai, "Development of a micro-manipulation system having a two-fingered micro-hand," IEEE Transactions on Robotics and Automation 1999, vol. 15, no. 1, pp. 152-162, February 1999.
    [21] A. A. Ramadan, K. Inoue, T. Arai, and T. Takubo, "New hybrid two-fingered micro-nano manipulator hand: optimization and design," IEEE International Conference on Mechatronics and Automation ICMA-2007, Harbin, China, August 2007, pp. 2524-2529.
    [22] A. A. Ramadan, K. Inoue, T. Arai, T. Takubo, and I. Hatta, "Micro-nano two-fingered hybrid manipulator hand," IEEE International Symposium on Micro-Nanomechatronics and Human Science MHS-2007, Nagoya, Japan, November 2007, pp. 32-37.
    [23] I. Hatta, K. Ohara, T. Arai, Y. Mae, T. Takubo, and K. Inoue, "Cell analysis system using two-fingered micro hand - fine adjustment mechanism for end-effector," IEEE International Symposium on Micro-Nanomechatronics and Human Science MHS-2008, Nagoya, Japan, November 2008, pp. 108-113.
    [24] A. A. Ramadan, T. Arai, T. Takubo, and K. Inoue, "Optimization of a hybrid two-fingered micro hand using genetic algorithms," IEEE International Symposium on Micro-Nanomechatronics and Human Science MHS-2008, Nagoya, Japan, November 2008, pp. 103-107.
    [25] I. Hatta, K. Ohara, T. Arai, Y. Mae, and T. Takubo, "Automated initial setup method for two-fingered micro hand system," IEEE/RSJ International Conference on Intelligent Robots and System IROS-2009, St. Louis, MO, USA, October 2009, pp. 3271-3276.
    [26] K. Suzumori, T. Miyagawa, M. Kimura, and Y. Hasegawa, "Micro inspection robot for 1-in pipes," IEEE/ASME Transactions on Mechatronics 1999, vol. 4, no. 3, pp. 286-292, September 1999.
    [27] L. Xiao, C. Taeyoung, C. Hanyong, G. Suhyeon, L. Soojun, K. Sungchul, et al., "Active cannula robot with misorientation auto-recovery camera: a method to improve hand-eye coordination in minimally invasive surgery," IEEE International Conference on Control, Automation, and Systems ICCAS-2013, Gwangju, South Korea, October 2013, pp. 276-280.
    [28] T. Tanikawa, T. Arai, and N. Koyachi, "Development of small-sized 3 DOF finger module in micro hand for micro manipulation," IEEE/RSJ Proceedings International Conference on Intelligent Robots and Systems IROS-1999, Kyongju, South Korea, October 1999, pp. 876-881, vol.2.
    [29] T.-Y. Chou, T.-H. Liu, and T.-T. Cheng, "Adaptive controller design for a micro-permanent magnet synchronous motor control system," IEEE International Conference on Power Electronics and Drive Systems PEDS-2009, Taipei, Taiwan, November 2009, pp. 90-95.
    [30] T.-Y. Chou, T.-H. Liu, and T.-T. Cheng, "Sensorless micro-permanent magnet synchronous motor control system with a wide adjustable speed range," Electric Power Applications IET-2012, vol. 6, no. 2, pp. 62-72, February 2012.
    [31] T.-Y. Chou and T.-H. Liu, "Implementation of a motion control system using micro-permanent magnet synchronous motors," IEEE Conference on Industrial Electronics Society IECON-2011, Melbourne, VIC, Australia, November 2011, pp. 1885-1890.
    [32] K. Kawanishi, H. Hashizumi, Y. Oki, Y. Nakano, T. Fukuda, G. Vachkov, et al., "Position and elasticity control for biomimetic robot finger," IEEE Conference on Industrial Electronics Society IECON-2000, Nagoya, Japan, October 2000, pp. 870-875 vol.2.
    [33] W. Friedl, M. Chalon, J. Reinecke, and M. Grebenstein, "FAS A flexible antagonistic spring element for a high performance over," IEEE/RSJ International Conference on Intelligent Robots and Systems IROS-2011, San Fransisco, CA, USA, September 2011, pp. 1366-1372.
    [34] J. Hyunhwan, P. Jongwoo, C. Youngsu, and C. Joono, "Tendon-driven multi-DOFs mini manipulation system with micro camera," IEEE International Conference on Control, Automation and Systems ICCAS-2011, Gyeonggi-do, South Korea, October 2011, pp. 1064-1067.
    [35] E. Rombokas, M. Malhotra, E. A. Theodorou, E. Todorov, and Y. Matsuoka, "Reinforcement learning and synergistic control of the ACT hand," IEEE/ASME Transactions on Mechatronics 2013, vol. 18, no. 2, pp. 569-577, April 2013.
    [36] M. P. Dinca, M. Gheorghe, and P. Galvin, "Design of a PID controller for a PCR micro reactor," IEEE Transactions on Education 2009, vol. 52, no. 1, pp. 116-125, February 2009.
    [37] X. Ping, W. Haichao, H. Juanjuan, and L. Wenchao, "Based on the fuzzy PID brushless DC motor control system design," IEEE International Conference on Measurement, Information and Control MIC-2012, Harbin, China, May 2012, pp. 703-706, vol. 2.
    [38] R. Wang, F. Luo, X. Huang, and P. Li, "New elevator energy feedback control system design based on fuzzy PID controller," IEEE Power Engineering and Automation Conference PEAM-2012, Wuhan, China, September 2012, pp. 1-6.
    [39] H.-P. Huang and C.-C. Chen, "Control-system synthesis for open-loop unstable process with time delay," IEE Proceedings-Control Theory and Applications 1997, vol. 144, no. 4, pp. 334-346, July 1997.
    [40] A. Kiam Heong, G. Chong, and L. Yun, "PID control system analysis, design, and technology," IEEE Transactions on Control Systems Technology 2005, vol. 13, no. 4, pp. 559-576, July 2005.
    [41] S. Parasuraman, A. W. Oyong, and V. Ganapathy, "Development of robot assisted stroke rehabilitation system of human upper limb," IEEE International Conference on Automation Science and Engineering CASE-2009, Bangalore, India, August 2009, pp. 256-261.
    [42] C. Yao, Z. Qiang, M. Ceccarelli, G. Carbone, Y. Shuangji, and L. Zhen, "Design and simulation of a DSP controller for a LARM Hand," IEEE International Conference on Informatics in Control, Automation and Robotics CAR-2010, Wuhan, China, March 2010, pp. 361-364.
    [43] W. Xuelin, Z. Yongguo, F. Xinjian, and W. Hao, "Active gripping impedance force control with dual fingers hand," IEEE International Conference on Electronic and Mechanical Engineering and Information Technology EMEIT-2011, Harbin, Heilongjiang, China, August 2011, pp. 4531-4534, vol. 9.
    [44] N. Araki, K. Inaya, Y. Konishi, and K. Mabuchi, "An artificial finger robot motion control based on finger joint angle estimation from EMG signals for a robot prosthetic hand system," IEEE International Conference on Advanced Mechatronic Systems ICAMechS-2012, Tokyo, Japan, September 2012, pp. 109-111.
    [45] V. H. Mendez-Salas, M. A. Oliver-Salazar, D. Szwedowicz-Wasik, and G. Silva-Navarro, "Design and control of a robot with two fingers," IEEE International Conference on Electrical Engineering, Computing Science and Automatic Control CCE-2012, Mexico City, Mexico, September 2012, pp. 1-5.
    [46] A. Khodayari, M. M. Kheirikhah, and M. Talari, "Fuzzy PID controller design for artificial finger based SMA actuators," IEEE International Conference on Fuzzy Systems FUZZ-2011, Taipei, Taiwan, June 2011, pp. 727-732.
    [47] Y.-T. Lai, Y.-M. Chen, C.-T. Chen, and Y.-J. Yang, "Development of shear sensing system for a three-finger robot hand," IEEE International Conference on Robotics and Biomimetics ROBIO-2011, Karon Beach, Phuket, Thailand, December 2011, pp. 1183-1187.
    [48] N. Karnati, B. A. Kent, and E. D. Engeberg, "Bioinspired sinusoidal finger joint synergies for a dexterous robotic hand to screw and unscrew objects with different diameters," IEEE/ASME Transactions on Mechatronics 2013, vol. 18, no. 2, pp. 612-623, April 2013.
    [49] M. Araki and H. Taguchi, "Two-degree-of-freedom PID controllers," International Journal of Control, Automation, and Systems, vol. 1, no. 4, pp. 401-411, December 2003.
    [50] F. Yongling, L. Hesong, P. Yao, and Q. Haitao, "Active disturbance rejection control for the airborne pmsm in direct drive ema application," IEEE International Conference on Electronic Measurement & Instruments ICEMI-2009, Beijing, China, August 2009, pp. 2-346-2-351.
    [51] B. S. K. K. Ibrahim, R. Ngadengon, and M. N. Ahmad, "Genetic algorithm optimized integral sliding mode control of a direct drive robot arm," IEEE International Conference on Control, Automation and Information Sciences ICCAIS-2012, Ho Chi Minh City, Vietnam, November 2012, pp. 328-333.
    [52] Maxon Motor, ESCON Module 50/5 Servo Controller P/N 438725 Hardware Reference, March 2013, pp. 4-30;5-33.
    [53] Maxon Motor, Program 2012/13 High Precision Drives and Systems, May 2012, pp. 138.
    [54] Maxon Motor, Maxon Sensor, May 2009, pp.256.
    [55] Tekscan, Inc., FlexiForceR A201 Standard Force & Load Sensors, pp. 1.

    QR CODE