研究生: |
吳承洧 Cheng-Wei Wu |
---|---|
論文名稱: |
Hexa 機械手臂運動控制與阻抗控制之研究 Study on Motion Control and Impedance Control of a Hexa Robot 研 |
指導教授: |
郭永麟
Yong-Lin Kuo |
口試委員: |
蔡明忠
Ming-Jong Tsai 楊振雄 Cheng-Hsiung Yang 陳金聖 Chin-Sheng Chen |
學位類別: |
碩士 Master |
系所名稱: |
工程學院 - 自動化及控制研究所 Graduate Institute of Automation and Control |
論文出版年: | 2018 |
畢業學年度: | 106 |
語文別: | 中文 |
論文頁數: | 139 |
中文關鍵詞: | 六自由度並聯機械手臂 、運動控制 、阻抗控制 、類神經正向運動學 |
外文關鍵詞: | 6-DOF parallel manipulator, motion control, impedance control, Neural network forward kinematics |
相關次數: | 點閱:718 下載:3 |
分享至: |
查詢本校圖書館目錄 查詢臺灣博碩士論文知識加值系統 勘誤回報 |
目前在工業上拋光、去毛邊、焊接及插削等項目主要都是由串聯式機械手臂來完成,但是並聯式機械手臂相對於串聯式機械手臂來說,它有更佳的負重能力、低慣性,及高速運動能力,並且機械結構簡單卻不易變形等優勢。然而主流的並聯式機械手臂Delta robot只有三自由度,只能朝xyz方向移動,因此Delta robot在產業界上的大部分應用都只能集中在食物封裝、零件整列等用途上,對於需要高自由度的工作項目,產業界仍偏向採用串聯式機械手臂。本研究首先探討六自由度並聯式機械手臂(Hexa robot),並結合Hogan的阻抗控制理論,在基於位置控制的模式下,去設計整個手臂的控制系統,藉由架設在手臂終端器的力量感測器量測到的力量感測值,經阻抗控制法則,得到位置修正量,以此調整機械手臂的姿態,達到順應環境的能力,避免手臂在工作過程中,與工件有不當的碰撞,造成機械手臂或工件的損壞。本研究將六自由度並聯式機械手臂從傳統的位置控制模式下延升到能順應環境的阻抗控制,透過對傳統的機械手臂控制器的位置控制模式架構下發展出阻抗控制,使傳統機械手臂控制器在位置控制下也能完成阻抗控制之功能並且探討不同環境參數,會使阻抗控制器產生何種影響,以此完成阻抗實驗的參數調整。
本研究針對六自由度並聯式機械手臂透過向量法推導其逆向運動學,並利用倒傳遞類神經網路去擬合對於並聯式機械手臂來說,求解困難的正運動學,亦推導六自由度並聯式機械手臂的賈氏矩陣(Jacobian matrix)以求出正逆向奇異點,避免機械手臂在運動過程中,發生失去控制之情況。在Simulink環境下模擬六自由度並聯式機械手臂的阻抗控制,藉由調整環境參數來分析環境的變化對阻抗參數的影響,以確定在阻抗實驗時,如何調整參數使控制器穩定。在硬體架構方面搭建六自由度並聯式機械手臂的六軸運動控制系統,並搭配C#程式語言開發的電腦端的人機介面,讓使用者在電腦端能夠控制六自由度並聯式機械手臂,最後完成在C#的編譯環境下搭建出六自由度並聯式機械手臂的位置控制及阻抗控制的運動架構,並分析探討六自由度並聯式機械手臂應用阻抗控制於環境下的效能
At present, polishing, deburring, welding and bolting are mainly done by series mechanical arms in industrial, but the parallel-type robotic arm has advantages such as better load-bearing capacity, low inertia, high-speed movement ability, simple mechanical structure, and non-deformation, as compared with the serial-type robotic arm. However, the mainstream parallel robot (Delta robot) has only three degrees of freedom and can only move in the x-y-z direction. Therefore, most of the applications of Delta robot in the industry can only focus on food packaging, parts alignment. For work projects that require a high degree of freedom, the industry still prefers to use a series robot. This study first explores a six-degrees-of-freedom parallel robotic arm (Hexa robot) and combines Hogan's impedance control theory to design the entire arm control system in a position-based control mode, with a sensor of force built into the arm terminator.The force sensing value measured by the force sensor installed on the arm terminator is used to obtain the position correction amount through the impedance control law, adjust the posture of the robotic arm so as to achieve the ability to adapt to the environment, avoid improper collision of the arm with the workpiece during operation, resulting in damage to the robot arm or workpiece. In this study, the 6-DOF parallel manipulator is extended from the traditional position control mode to the impedance control that can adapt to the environment,through the development of impedance control under the position control mode of the traditional robotic arm controller,the traditional robotic arm controller can also complete the function of impedance control under the position control and discuss different environmental parameters, which will make the impedance controller produce what kind of influence, so as to complete the parameter adjustment of the impedance experiment.
This study derived the inverse kinematics of the 6-DOF parallel robotic arm through the vector method, and use neural network backpropagation to fit forward kinematics for Hexa robot. The Jacobian matrix of the six-degree-of-freedom parallel manipulator is also derived to find the forward and reverse singular points to avoid the loss of control of the robotic arm during the movement.Simulate the impedance control of a six-degree-of-freedom parallel manipulator in a Simulink environment, by adjusting the environmental parameters, analyze the influence of environmental changes on the impedance parameters to determine how to adjust the parameters to stabilize the controller during the impedance experiment. In the hardware architecture, a six-axis motion control system for a six-degrees-of-freedom parallel manipulator is built, and a computer-side of human-machine interface developed with the C# programming language is used. Allows the user to control the 6-DOF parallel robotic arm at the computer, and finally completes the motion control of the position control and impedance control of the 6-DOF parallel robotic arm in the C# compilation environment. Analyze the effectiveness of the six-degrees-of-freedom parallel manipulator applying impedance control to the environment.
[1] J. Brinker, B. Corves, Y. Takeda, Kinematic performance evaluation of high-speed Delta parallel robots based on motion/force transmission indices, Mechanism and Machine Theory on vol 125, 2018, pp.111-125.
[2] L. Angel, J. Viola, Fractional order PID for tracking control of a parallel robotic manipulator type delta, ISA Transactions ,2018, pp. 1-17.
[3] J.B. Cohen, A.L. Sparko, M. Bellman, Simulator motion literature pertinent to airline-pilot recurrent training and evaluation, In AIAA modeling and simulation technologies conference, 2011, pp. 187–203.
[4] I. Miletović, D.M. Pool, O. Stroosma, M.M. van Paassen, Q.P. Chu, Improved Stewart platform state estimation using inertial and actuator position measurements, Control Engineering Practice on vol 62, 2017, pp. 102-115.
[5] M.L. Husty, An algorithm for solving the direct kinematics of the general Stewart-Gough platforms, Mechanism and Machine Theory on vol 31, 1996, pp. 365–380.
[6] D. Jakobović, L. Budin, Forward kinematics of a stewart platform mechanism, IEEE Proc. of the 6th International Conference on Intelligent Engineering Systems (INES), 2002, pp.149–154.
[7] W.Au, H. Chung, C. Chen, Path planning and assembly mode-changes of 6-DOF, Mechanism and Machine Theory on vol 106, 2016, pp. 30-49.
[8] B. Achili , B. Daachi , Y. Amirat , A.A. cherif ,A robust adaptive control of a par- allel robot, International Journal of Control on vol 83, 2010, pp. 2107–2119.
[9] X. Lu, Y. Zhao, M. Liu, Self-learning interval type-2 fuzzy neural network controllers for trajectory control of a Delta parallel robot, Neurocomputing on vol 283, 2018, pp. 107-119.
[10] D.N. Nenchev. M. Uchiyama, Singularity-consistent path planning and control of parallel robot motion through instantaneous-self-motion type singularities, Robotics and Automation on vol 2, 1994, pp. 297-304.
[11] P. Last, C. Budde, C. Bier, HEXA-parallel-structure calibration by means of angular passive joint sensors, Mechatronics and Automation on vol 3, 2005, pp. 1300-1305.
[12] M. Dehghani, M. Ahmadi, A. Khayatian, M. Eghtesad, M. Farid, Neural network solution for forward kinematics problem of HEXA parallel robot, American Control Conference, 2008, pp. 4214 – 4219.
[13] C. Vaida, D. Pisla, F. Covaciu, B. Gherman, Development of a control system for a HEXA Parallel Robot, Conference on Automation Quality and Testing, Robotics, 2016, pp. 1- 6.
[14] X. Wang, Y. Tian, Inverse dynamics of Hexa parallel robot based on the Lagrangian equations of first type, Mechanic Automation and Control Engineering, 2010, pp. 3712 – 3716.
[15] N. Hogan, Impedance control:An approach to manipulation, ASME Journal of Dynamic System, Measurement,and Control on vol 107, 1985, pp.1-24.
[16] R. Paul, B.Shimano, Compliance and control, Proceedings of Joint Automatic Control Conference, 1976, pp. 694-699 [17] M.M. Fateh, R. Babaghasabha, Impedance control of robots using voltage control strategy, Nonlinear Dynamics on vol 74, 2013, pp. 277–286.
[18] Y. Fu, X. Han, N. Sepehri, G. Zhou, J. Fu, L. Yu, R. Yang, Design and performance analysis of position-based impedance control for an electrohydrostatic actuation system, Chinese Journal of Aeronautics on vol 31, 2017, pp. 1-13.
[19] M.Sharifi, S. Behzadipour, G. Vossoughi, Nonlinear model reference adaptive impedance control for human–robot interactions, Control Engineering Practice on
vol 32, 2014, pp. 9-27.
[20] H.N. Rahimi, I. Howard, L. Cui, Neural impedance adaption for assistive human–robot interaction, Neurocomputing on vol 290, 2018, pp. 50-59. [21] S. Kizir, Z. Bingul, Fuzzy impedance and force control of a Stewart platform, Turkish Journal of Electrical Engineering & Computer Sciences on vol 22, 2014, pp. 924 – 939.
[22] X. Wang, Y. Wang, Y. Xue, Intelligent compliance control for robotic deburring using fuzzy logic, Industrial Informatics, 2006, pp. 91 – 96.
[23] J. Li, L. Liu, Y. Wang, W. Liang, Adaptive hybrid impedance control of robot manipulators with robustness against environment's uncertainties, IEEE international conference on mechatronics and automation, 2015, pp. 1846-1851.
[24] A. Par, I. Tornai, F. Szalay, Adaptive hybrid impedance control of robotic manipulators, Annual Conference on IEEE Industrial Electronics Society, 2010, pp. 1442–1446.
[25] S. Xianjun, Z. Xi, Fuzzy adaptive hybrid impedance control for mirror milling system, Mechatronics on vol 53, 2018, pp. 20-27.
[26] S.C.T. Filho, E.L.L. Cabral, Kinematics and workspace analysis of a parallel architecture robot: the hexa, ABCM symposium in Mechatronica on vol 2, 2006, pp. 158-165.
[27] 柯丞唐,“六自由度Delta 型並聯式機器人之等向性設計及動力分析”, 國立台灣科技大學,碩士論文,2014年。
[28] I.A. Bonev, M. Gosselin, A genetic algorithm for the computation of the constant orientation workspace of 6 RUS parallel manipulator, DETC’00 ASME , 2000, pp. 1-10.
[29] L. Medsker, J. Liebowitz, Design and development of expert systems and neural networks 1st edition, Macmillan,1994.
[30] Q. Shi, J.Xie, research on inverse kinematics solution of 6-DOF robot with offset-wrist based on Adaboost neural network, Cybernetics and Intelligent Systems, 2017, pp. 70-375. [31] N. Zhang, Y. Zhang, J. Cheng, C. Ma, Inverse kinematics solution for six-DOF serial robots based on BP neuralnetwork, 2017 Chinese Automation Congress (CAC), 2017, pp. 1154 – 1157.
[32] P. Srisuk, A. Sento, Yuttana, Kitjaidure, Forward kinematic like neural network for solving the 3D reaching inverse kinematics problems, Conference on Electronics, Computer, Telecommunications and Information Technology (ECTI-CON), 2017, pp. 214 – 217.
[33] A. Hourtash, M. Tarokh, Manipulator path planning by decomposition: algorithm and analysis, IEEE Transactions on Robotics and Automation on vol 17, 2001, pp. 842-856.
[34] K.G. Shin, N.D. McKay, Minimum time control of robotic manipulators with geometric path constraints, IEEE Transactions on Automatic Control on vol 30, 1985, pp. 531-541.
[35] A. Visioli, G. Legnani, On the trajectory tracking control of industrial SCARA robot manipulators, IEEE Transactions on Industrial Electronics on vol 49, 2002, pp. 224-232.
[36] H. Chaudhary, R. Prasad, N. Sukavanum, Trajectory Tracking Control of Scorbot-ER-V Plus Robot Manipulator based on Kinematical Approach, International Journal of Engineering Science and Technology on vol 4, 2012, pp. 1174-1182.
[37] M. Afroun, T. Chettibi, S. Hanchi, Planning optimal motions for a DELTA parallel Robot, Mediterranean Conference on Control and Automation, 2006, pp. 1-6.
[38] M. Zhuang, D.P. Atherton, Automatic tuning of optimum PID controllers, Control Theory and Applications IEEE Proceedings on vol 140, 1993,pp. 216-224.
[39] Q.G. Wang, T.H. Lee, H.W. Fung, Q. Bi, Y. Zhang, PID tuning for improved performance, IEEE Transactions on Control Systems Technology on vol 7, 1999, pp. 457-465.