簡易檢索 / 詳目顯示

研究生: 唐世謙
Shih-Chien Tang
論文名稱: 應用分解加速度法於平面並聯式機械臂之運動控制研究
Study on Motion Control of Planar Parallel Manipulator Using Resolved Acceleration Method
指導教授: 郭永麟
Yong-Lin Kuo
口試委員: 郭永麟
Yong-Lin Kuo
楊振雄
Cheng-Hsiung Yang
郭鴻飛
Hung-Fei Kuo
陳亮光
Liang-kuang Chen
學位類別: 碩士
Master
系所名稱: 工程學院 - 自動化及控制研究所
Graduate Institute of Automation and Control
論文出版年: 2019
畢業學年度: 107
語文別: 中文
論文頁數: 145
中文關鍵詞: RRR平面並聯式機構PID控制計算力矩控制分解加速度控制影像伺服控制卷積神經網路
外文關鍵詞: 3-RRR parallel manipulator, PID, computed torqued control, resolved acceleration control, visual servoing control, convolutional neural network
相關次數: 點閱:256下載:0
分享至:
查詢本校圖書館目錄 查詢臺灣博碩士論文知識加值系統 勘誤回報
  • 本論文的研究主旨為運用五種不同的控制方法,針對三自由度平面並聯式機械手臂(3-RRR PPM)做運動控制,根據其比較結果找出較佳的控制方案,並探討未來的可行性與改進目標。
    本論文首先介紹三自由度平面並聯式機械手臂的模型,接著推導其運動學與動力學方程式,並針對此種機械手臂的工作空間與奇異點做分析,防止機械手臂超出工作空間造成硬體的損壞。在控制理論部分,本論文使用五種不同的控制器做位置控制,分別為比例-積分-微分控制(PID)、計算力矩控制(CTC)、分解加速度控制(RAC) 、影像伺服分解加速度控制(VSRAC)、卷積神經網路分解加速度控制(CNN-RAC),其中後兩者為新型控制方法。VSRAC是RAC的變形,其目的是要降低RAC的運算量與提升追蹤軌跡的精準度,因而加入影像資訊做修正,但是影像處理仍需一定的運算時間。為了解決此問題,本文提出CNN-RAC的控制方法,藉由卷積神經網路學習影像與終端點之間的關係,該方法除了可以有效降低影像處理所需時間,亦改善影像處理中雜訊影像無法抓取問題。
    硬體與實驗部分,本論文使用無刷直流馬達(BLDC)作為機械手臂的致動器,藉由德州儀器(TI)的數位訊號處理器(DSP)做馬達控制並搭配開發軟體CCS做程式的撰寫,採用RS485做為電腦與DSP之間的通訊架構,電腦端則是使用C#開發工具運算控制器的輸出命令。而模擬部分則是使用MATLAB數學軟體,由推得的動力學做為系統模型,帶入實際硬體之數據,根據模擬結果找出可收斂的Kp與Kd參數以此做為實驗架構的基礎。
    最後根據比例-積分-微分控制、計算力矩控制、分解加速度控制、影像伺服分解加速度控制、卷積神經網路分解加速度控制五種控制理論的模擬與實驗結果做比較與分析,並根據其結果提出較適合的三自由度的平面並聯式機械手臂的控制方法以及未來可深入研究之方向。


    The main purposes of this thesis are to use five different control methods to position the three-degree-of-freedom planar parallel manipulator (3-RRR PPM),to find out the better control scheme based on the comparison results, and to explore the feasibility of the future and improve the goal.
    This thesis first introduces the model of three-degree-of-freedom planar parallel manipulator, derives its kinematics and dynamics equations, and analyzes the working space and singular points of the robot arm to prevent the manipulator from exceeding the working space and causing the damage of hardware. In the control theory, this thesis uses five different controllers for position control, proportional-integral-derivative (PID) control, computed torque control (CTC), resolved acceleration control (RAC), visual servoing resolved acceleration control (VSRAC), and convolutional neural network resolved acceleration control (CNN-RAC), where the latter two controllers are proposed. The VSRAC is a variant of the RAC and the VSRAC reduces the computational complexity of the RAC and improves the accuracy of the tracking trajectory, where the image information is added for correction. However the image processing still requires much computing time. In order to solve this problem, this thesis proposes the control method of CNN-RAC, which learns the relationship between an image and the end-effector by convolutional neural network. This method can effectively reduce the time required for image processing and reduce the noise in image processing. The image could not be crawled.
    In the hardware and experimental part, this thesis uses a brushless DC motor (BLDC) as the actuator of the robot arm, which is controlled by Texas Instruments' digital signal processor (DSP) for motor control and programmed with the development software CCS. RS485 is used as the communication architecture between the computer and the DSP, and the computer is the output command of the C# development tool computing controller. The simulation part for manipulator uses the MATLAB mathematics software, and the derived dynamics is used as the system model, which brings the data of the actual hardware. Finding the convergence and parameters based on the simulation results as the basis of the experimental architecture.
    Finally, the simulation and experimental results of five control theories of proportional-integral-derivative control, computed torque control, resolved acceleration control and visual servoing resolved acceleration control, convolutional neural network resolved acceleration control are compared and analyzed. According to the results, a suitable three-degree-of-freedom planar parallel manipulator control method is proposed and the future can be further studied.

    摘要 I Abstract III 致謝 V 目錄 VI 圖目錄 IX 表目錄 XVI 第1章 緒論 1 1.1 研究背景 1 1.2 文獻回顧 2 1.2.1 並聯式機械手臂 2 1.2.2 控制理論 2 1.3 研究動機 4 1.4 研究方法 5 1.5 論文架構 6 第2章 3-RRR PPM運動學與動力學模型 7 2.1 3-RRR PPM模型分析 7 2.2 3-RRR PPM運動學分析 9 2.2.1 逆向運動學 9 2.2.2 正向運動學 12 2.2.3 工作空間分析 14 2.2.4 奇異點分析 15 2.2.5 速度轉換 17 2.2.6 加速度轉換 18 2.3 3-RRR PPM動力學分析 18 2.3.1 逆向動力學 18 2.3.2 正向動力學 20 第3章 控制架構與理論 21 3.1 比例-積分-微分控制 21 3.2 計算力矩控制 22 3.3 分解加速度控制 24 3.4 影像伺服分解加速度控制 25 3.4.1 相機模型 26 3.4.2 影像處理 28 3.5 卷積神經網路分解加速度控制 32 3.5.1 卷積神經網路理論 32 第4章 實驗規劃 37 4.1 硬體架構說明 37 4.1.1 3-RRR PPM平台介紹 37 4.1.2 控制器規格 41 4.1.3 馬達規格 45 4.1.4 電源供應器規格 47 4.1.5 通訊架構 48 4.1.6 相機規格與參數 50 4.2 系統流程說明 52 4.2.1 系統硬體流程 52 4.2.2 系統軟體流程 53 4.3 理論驗證 54 4.3.1 運動學驗證 54 4.3.2 工作空間驗證 57 4.3.3 速度、加速度轉換驗證 57 4.3.4 動力學驗證 67 4.4 馬達控制 73 4.4.1 電流控制 73 4.4.2 位置控制 76 4.4.3 速度控制 77 4.5 機械手臂影像處理方法 78 4.6 卷積神經網路設計 80 4.6.1 生成訓練資料 81 4.6.2 卷積神經網路架構 82 4.6.3 訓練結果 83 4.7 人機介面 86 第5章 模擬與實驗 87 5.1 實驗步驟 87 5.2 PID控制實驗架構 88 5.2.1 PID收斂情況 89 5.2.2 PID模擬與實驗結果 90 5.3 CTC控制實驗架構 95 5.3.1 CTC收斂情況 95 5.3.2 CTC模擬與實驗結果 97 5.4 RAC控制實驗架構 101 5.4.1 RAC收斂情況 101 5.4.2 RAC模擬與實驗結果 103 5.5 VSRAC控制實驗架構 107 5.5.1 VSRAC模擬與實驗結果 108 5.6 CNN-RAC控制實驗架構 112 5.6.1 CNN-RAC模擬與實驗結果 113 5.7 控制器比較 117 第6章 結論與未來展望 121 6.1 結論 121 6.2 未來展望 122 參考文獻 123

    [1] Gwinnett J.E, Amusement devices, No. 1789680, U.S. Patent, 1931 Jan 20.
    [2] Clavel R, Device for the movement and positioning of an element in space, No. 4976582, U.S. Patent, 1990.
    [3] 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.
    [4] F. Behi, M. Mehregany, K. Gabriel, A microfabricated three degree of freedom parallel mechanism, Proc. IEEE Microelectron. Mech. Syst, 1990, 159–165.
    [5] C. Gosselin, Kinematic analysis, Optimization and programming of parallel robotic manipulators, Mech. Eng., McGill University, Montréal, Qc., Canada, 1988.
    [6] C.M. Gosselin and J. Sefrioui, Polynomial solutions for the direct kinematic problem of planar three-degree-of freedom parallel manipulators, IEEE Intl Conference on Advanced Robotics, Pisa, Italy, 19-22 June, 1991, pp. 1124-1129.
    [7] T. Geike, J. McPhee, Inverse dynamic analysis of parallel manipulators with full mobility, Mechanism and Machin Theory, 38(6), 2003, pp. 549–562.
    [8] W.A. Khan, V.N. Krovi, S.K. Saha, J. Angeles, Recursive kinematics and inverse dynamics for a planar 3R parallel manipulator, ASME J Dyn. Syst. Meas. Control, 127(4), 2005, pp. 529–36.
    [9] LIU Shanzeng, and YU Yueqing, Dynamic design of a planar 3-DOF parallel manipulator, Chinese Journal Of Mechanical Engineering, 44(4), Apr 2008, pp. 47–53.
    [10] S. Bennett, A history of control engineering, 1930-1955, IET, 1993.
    [11] J.G. Ziegler and N.B. Nichols, Optimum settings for automatic controllers, Transactions of the American Society of Mechanical Engineers, Vol. 64, 1942, pp. 759-768.
    [12] O. Hernández, P. Ortiz, J. Herrera, Fractional PID controller with LQR proportional action applied to fractional model of cement rotary kiln, IEEE Latin America Transactions, 13(1), JAN. 2015, pp. 37-42.
    [13] A. Marín, J. A. Hernández R., J. A. Jiménez, Tuning multivariable optimal PID controller for a continuous stirred tank reactor using an evolutionary algorithm, IEEE Latin America Transactions, 16(2), FEB. 2018, pp. 422-427.
    [14] W.K. Ho, C.C. Hang and J. Zhou, Self-tuning PID control of a plant with under-damped response with specifications on gain and phase margins, IEEE Transactions on Control Systems Technology, Vol. 5, 1997, pp. 446-452.
    [15] Y. Lee, J. Lee and S. Park, PID controller tuning for integrating and unstable processes with time delay, Chemical Engineering Science, Vol. 55, 2000, pp. 3481-3493.
    [16] B.R. Markiewicz, Analysis of computed torque drive method and comparison with conventional position servo for a computer controlled manipulator, J. P. L., NASA, Tech Memo (1973), pp. 33-601
    [17] R. Kellly, V. Santibanez, A. Loria, Control of robot manipulators in joint space, Springer, London, 2005.
    [18] J.Y.S. Luh, M.W. Walker, R.P. Paul, Resolved acceleration control of mechanical manipulators, IEEE Trans. Autom. Control, 25 (3), 1980, pp. 468–474.
    [19] Y. Umetani, K. Yoshida, Resolved motion rate control of space manipulators with generalized Jacobian matrix, IEEE Transactions on Robotics and Automation, 5(3), 1989, pp. 303-314.
    [20] B. Dariush, G. Bin Hammam, D. Orin, Constrained resolved acceleration control for humanoids, inIntelligent robots and systems, 2010 IEEE/RSJ International Conference on, OCT. 2010, pp. 710 –717.
    [21] H. H. Fakhry, W. J. Wilson, A modified resolved acceleration controller for position-based visual servoing, Mathl. Comput. Modelling, 24(5),1996, pp.1-9 .
    [22] A. Noshadi, M. Mailah, A. Zolfagharian, Intelligent active force control of a 3-RRR parallel manipulator incorporating fuzzy resolved acceleration control, Applied Mathematical Modelling, 36(6), 2012, pp. 2370-2383.
    [23] S. Hutchinson, G.D. Hager and P.I. Corke, A tutorial on visual servo control, IEEE Transactions on Robotics and Automation, 12(5), 1996, pp. 651-670.
    [24] C.Y. Tsai, C.C. Wong, C.J. Yu, C.C. Liu, and T.Y. Liu, A hybrid switched reactive-based visual servo control of 5-DOF robot manipulators for pick-and-place tasks, IEEE Systems Journal, 9(1), 2015, pp. 119-130.
    [25] H. Wang, B. Yang, Y. Liu, W. Chen, X. Liang, and R. Pfeifer, Visual servoing of soft robot manipulator in constrained environments with an adaptive controller, IEEE/ASME Transactions on Mechatronics, 22(1), 2017, pp. 41-50.
    [26] D. Silver, et al., Mastering the game of Go with deep neural networks and tree search, Nature, vol. 529, 2016, pp. 484–489.
    [27] S. Akcay, et al., Using deep convolutional neural network architectures for object classification and detection within X-Ray baggage security imagery. IEEE Transactions on Information Forensics and Security, 13(9), 2018, pp. 2203-2215
    [28] D. Bardou, K. Zhang, and S. M. Ahmad, Classification of breast cancer based on histology images using convolutional neural networks, IEEE Access, vol. 6, 2018, pp. 24680–24693.
    [29] Lung-Wen Tsai, Robot analysis the mechanics of serial and parallel manipulators, 1999, pp. 124–129.
    [30] 林子鑌,“應用 PID 控制、模糊邏輯控制和模型預測控制實現RRR 平面並聯式機構之定位控制”, 國立台灣科技大學,碩士論文,2013年。
    [31] Y.D. Patel, Workspace and singularity analysis of 3-RRR planar parallel manipulator, In: Proceedings of the 1st international and 16th national conference on machines and mechanisms, 2013, pp. 1071–1077.
    [32] M.G. Mikkola, M. Tuomala, and H. Sinisalo, Comparison of numerical integration methods in the analysis of impulsively loaded elastoplastic and viscoplastic structures. Int. J. Comput. Struct., 1981, 14, pp. 469–476.
    [33] R. V. Dukkipati, MATLAB for Mechanical Engineers, 2009.
    [34] 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.
    [35] S. Khan1, R.M. Botez, and T.L. Grigorie, A new method for tuning PI gains position control of BLDC motor based wing morphing actuators, American Institute of Aeronautics and Astronautics, JUN. 2015.

    無法下載圖示 全文公開日期 2024/07/20 (校內網路)
    全文公開日期 本全文未授權公開 (校外網路)
    全文公開日期 本全文未授權公開 (國家圖書館:臺灣博碩士論文系統)
    QR CODE