簡易檢索 / 詳目顯示

研究生: 黃芃毓
Peng-Yu Huang
論文名稱: Delta機械手臂之最佳路徑規劃與運動控制研究
Study of Optimal Path Planning and Motion Control of a Delta Robot Manipulator
指導教授: 郭永麟
Yong-Lin Kuo
口試委員: 楊振雄
Cheng-Hsiung Yang
郭鴻飛
Hung-Fei Kuo
林沛群
none
學位類別: 碩士
Master
系所名稱: 工程學院 - 自動化及控制研究所
Graduate Institute of Automation and Control
論文出版年: 2015
畢業學年度: 103
語文別: 中文
論文頁數: 100
中文關鍵詞: Delta並聯式機械手臂路徑規劃運動控制PID控制
外文關鍵詞: Delta robot, path planning, motion control, PID control
相關次數: 點閱:564下載:1
分享至:
查詢本校圖書館目錄 查詢臺灣博碩士論文知識加值系統 勘誤回報
  • 本文藉由已發展成熟的各種理論,應用於 Delta並聯式機械手臂的運動學分析、路徑規劃、角度控制與扭力控制 。首先我們會對 Delta並聯式機械手臂進行正向運動學、逆向運動學、最大工作範圍及奇異點的分析,接著為機械手臂做具有平滑動作之路徑規劃,最後利用Lagrange equations方法計算扭矩來設計比例積分微分控制器(PID controller) ,以達到扭力控制之目的。
    進而建構出 Delta並聯式機械手臂之實驗機構,此機構由三顆直流馬達驅動,利用LabVIEW軟體,搭配控制器Compact-RIO、馬達驅動模組NI-9505、PWM驅動及角度感測器分別進行角度或扭力控制。實驗部分是利用PID控制加入系統對Delta並聯式機械手臂分別做直線、拋物線、圓三種運動路徑之角度控制與扭力控制,並分別附上實驗數據。
    針對 Delta並聯式機械手臂,本文於文末列出了角度控制與扭力控制的優缺點比較及重現性之探討並列舉出了幾項尚需改善的問題與未來發展之建議,本文詳細的分析與整理可為未來深入研究的基礎。


    Delta robot has been broadly applied in various industrial applications. Due to the requirements of high speed and high precision, this thesis emphasizes the study of the path planning, the position control and the torque control of the Delta robot based on its kinematics and dynamics. First of all, the forward kinematics, the inverse kinematics, the workspace, and the singularity analysis are studied. Secondly, to complete a specified task, the path planning is performed, and one requires that the initial and final points of the path have zero velocities and accelerations. Thirdly, to fulfill the tracking control, a PID controller is designed and implemented based on kinematics. Fourthly, to reach a high-precision positioning, a torque control is performed based on dynamics, where the relevant formulations are obtained by using the Lagrange’s equation. Finally, three illustrative examples are performed, which are a straight-line motion, a parabolic motion, and a circular motion. Furthermore, the numerical simulations and the experimental work are completed.
    Regarding to the experimental work, the entire control system of the Delta robot include three DC motors with encoders, a controller Compact-RIO, and three motor drive modules NI-9505. The controller is incorporated with the software LabVIEW, and the motor drive module includes the PWM drive.
    Based on the aforementioned study, this thesis compares the position control and the torque control of the Delta robot, and their advantages and disadvantages are listed. Besides, the end of this thesis highlights several issues to be concerned and some future work.

    目錄 摘要 Abstract 目錄 圖索引 表索引 第一章 緒論 1.1 前言 1.2 研究動機 1.3 論文架構 第二章 Delta Robot運動學與動力學 2.1 正向運動學 2.2 逆向運動學 2.3 工作空間分析 2.4 奇異點分析 2.5 路徑規劃 2.6 扭力分析 第三章 硬體架構 3.1 硬體架構說明 3.2 Delta robot平台介紹 3.3 控制器規格 3.4 馬達及編碼器規格 3.5 硬體流程說明 第四章 控制器設計 4.1 設計簡介 4.2 馬達系統模型 4.3 PID控制器 4.3.1 PID 控制理論 4.3.2 PID 參數特性 4.3.3 PID 參數調整 4.4 角速度與角加速度估測 4.5 控制軟體流程 4.5.1 系統模擬流程 4.5.2 系統實驗流程 第五章 模擬與實驗 5.1 運動學模擬 5.2 實驗步驟 5.3 問題與解決辦法 5.4 直線軌跡 5.4.1 角度控制結果 5.4.2 扭力控制結果 5.5 拋物線軌跡 5.5.1角度控制結果 5.5.2扭力控制結果 5.6 圓形軌跡 5.6.1 角度控制結果 5.6.2 扭力控制結果 5.6.3 軌跡重現性比較 5.7 實驗結果比較 第六章 結論與建議 6.1 結論 6.2 建議 參考文獻

    [1]Bricard, Raoul. "Mémoire sur la théorie de l'octaédre articulé," Journal de Mathématiques Pures et Appliquées, Liouville, vol. 3, pp. 113-148, 1987.
    [2]Stewart, Doug. "A platform with six degrees of freedom, " Proceedings of the Institution of Mechanical Engineers, vol. 180, no. 1, pp. 371-386, 1965.
    [3]McCallion, H., and P. D. Truong. "The analysis of a six degree of freedom work station for mechanized assembly." Proc. 5th World Congress on Theory of Machines and Mechanisms. Vol. 611, 1979.
    [4]Clavel, Reymond. "Conception d’un robot parallèle rapide à 4 degrés de liberté,", 1991.
    [5]Clavel, Reymond. "Device for the Movement and Positioning of an Element in Space," US Patent No. 4,976,582, Dec 11, 1990.
    [6]Brogårdh, Torgny. "Present and future robot control development—An industrial perspective," Annual Reviews in Control 31.1, 2007.
    [7]Hägele, Martin, Klas Nilsson, and J. Norberto Pires. "Industrial robotics." Springer handbook of robotics. Springer Berlin Heidelberg, 2008.
    [8]Lueth, T. C., Hein, A., Albrecht, J., Demirtas, M., Zachow, S., Heissler, E., and Bier, J. "A surgical robot system for maxillofacial surgery." Industrial Electronics Society, 1998. IECON'98. Proceedings of the 24th Annual Conference of the IEEE. Vol. 4. IEEE, 1998.
    [9]Miller, Karol. "Experimental verification of modeling of DELTA robot dynamics by direct application of Hamilton's principle." Robotics and Automation, 1995. Proceedings., 1995 IEEE International Conference on. Vol. 1. IEEE, 1995.
    [10]F. Pierrot, C. Reynaud and A. Fournier. "DELTA: a Simple and Efficient Parallel Robot," Robotica, vol .8, no. 2, pp. 105-109, Apr. 1990.
    [11]Irwin, J. L., Pearce, J. M., Anzolone, G., and Oppliger, D. E. "The RepRap 3-D Printer Revolution in STEM Education." 121st ASEE Annual Conference and Exposition, 2014.
    [12]Horvath, Joan. "The Desktop 3D Printer." Mastering 3D Printing. Apress, 2014. 11-20.
    [13]Olsson, André. Modeling and control of a Delta-3 robot. Department of Automatic Control, Lund University, 2009.
    [14]Staicu, St, and Daniela Craita Carp-Ciocardia. "Dynamic analysis of Clavel's delta parallel robot." Robotics and Automation, 2003. Proceedings. ICRA'03. IEEE International Conference on. Vol. 3. IEEE, 2003.
    [15]S. B. Park, H. S. Kim, C. Song, and K. Kim. "Dynamics Modeling of a Delta-type Parallel Robot (ISR 2013)," IEEE 44th International Symposium on Robotics, Oct. 2013.
    [16]García, Ubaldo, Daniel Ramírez, and Jorge García. "Torque Analysis of a Three Translational Degrees of Freedom Parallel Manipulator."
    [17]M.A. Laribi, L.Romdhane, and S.Zeghloul. “Analysis and dimensional synthesis of the DELTA robot for a prescribed workspace,” Mechanism and Machine Theory, vol. 42, no.7, pp. 859-870, 2005.
    [18]A. Codourey. “Dynamic Modelling and Mass Matrix Evaluation of DELTA parallel Robot for Axes Decoupling Control,” Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems, vol. 3, pp.1211-1218, 1996.
    [19]Hsu, K. S., Karkoub, M., Tsai, M. C., and Her, M. G."Modelling and index analysis of a Delta-type mechanism." Proceedings of the Institution of Mechanical Engineers, Part K: Journal of Multi-body Dynamics 218.3, 2004: 121-132.
    [20]Stock, Michael, and Karol Miller. "Optimal kinematic design of spatial parallel manipulators: application to linear delta robot." Journal of Mechanical Design 125.2, 2003: 292-301.
    [21]M. López, E. Castillo, G. García, and A. Bashir, A. “Delta robot: inverse, direct, and intermediate Jacobians,” Proceedings of the Institution of Mechanical Engineers, Part C: Journal of Mechanical Engineering Science, vol. 220, no. 1, pp. 103-109, 2005.
    [22]Carricato, Marco, and Vincenzo Parenti-Castelli. "Singularity-free fully-isotropic translational parallel mechanisms." The International Journal of Robotics Research 21.2, 2002: 161-174.
    [23]Lueth, T. C., Hein, A., Albrecht, J., Demirtas, M., Zachow, S., Heissler, E., and Bier, J. "A surgical robot system for maxillofacial surgery." Industrial Electronics Society, 1998. IECON'98. Proceedings of the 24th Annual Conference of the IEEE. Vol. 4. IEEE, 1998.
    [24]Gosselin, Clement, and Jorge Angeles. "Singularity analysis of closed-loop kinematic chains." Robotics and Automation, IEEE Transactions on 6.3, 1990: 281-290.
    [25]Di Gregorio, Raffaele. "Determination of singularities in delta-like manipulators." The International Journal of Robotics Research 23.1, 2004: 89-96.
    [26]A. Hourtash and M. Tarokh. "Manipulator Path Planning by Decomposition: Algorithm and Analysis," IEEE Transactions on Robotics and Automation, vol. 17, no. 6, pp. 842-856, Dec. 2001.
    [27]K. G. Shin and N. D. McKay. "Minimum-Time Control of Robotic Manipulators with Geometric Path Constraints," IEEE Transactions on Automatic Control, vol. 30, no. 6, pp. 531-541, Jun. 1985.
    [28]A. Visioli and G. Legnani. "On the Trajectory Tracking Control of Industrial SCARA Robot Manipulators," IEEE Transactions on Industrial Electronics, vol.49, no. 1, pp. 224-232, Feb. 2002.
    [29]H. Chaudhary, R. Prasad and N. Sukavanum. "Trajectory Tracking Control of Scorbot-ER-V Plus Robot Manipulator based on Kinematical Approach,"International Journal of Engineering Science and Technology, vol. 4, no. 3, pp.1174-1182, Mar. 2012.
    [30]Afroun, M., T. Chettibi, and S. Hanchi. "Planning optimal motions for a DELTA parallel Robot." Control and Automation, 2006. MED'06. 14th Mediterranean Conference on. IEEE, 2006.
    [31]Tsai, Lung-Wen. Robot analysis: the mechanics of serial and parallel manipulators. John Wiley & Sons, 1999.
    [32]Sugimoto, Koichi. "Kinematic and dynamic analysis of parallel manipulators by means of motor algebra." Journal of Mechanical Design 109.1, 1987: 3-7.
    [33]Cheng, Hui, Yiu-Kuen Yiu, and Zexiang Li. "Dynamics and control of redundantly actuated parallel manipulators." Mechatronics, IEEE/ASME Transactions on 8.4, 2003: 483-491.
    [34]Crampin, M. "On the differential geometry of the Euler-Lagrange equations, and the inverse problem of Lagrangian dynamics." Journal of Physics A: Mathematical and General 14.10, 1981: 2567.
    [35]Rao, Nalluri Mohan, and K. Mallikarjuna Rao. "Dimensional synthesis of a spatial 3-RPS parallel manipulator for a prescribed range of motion of spherical joints." Mechanism and Machine Theory 44.2, 2009: 477-486.
    [36]Lin, Tsu-pin. "Position Control of an RRR Planar Parallel Mechanism Using PID, Fuzzy Logic and Model Predictive Controls.", 2013.
    [37]Zhuang, Mang, and D. P. Atherton. "Automatic tuning of optimum PID controllers." Control Theory and Applications, IEE Proceedings D. Vol. 140. No. 3. IET, 1993.
    [38]Wang, Q. G., Lee, T. H., Fung, H. W., Bi, Q., and Zhang, Y. "PID tuning for improved performance." Control Systems Technology, IEEE Transactions on 7.4, 1999: 457-465.
    [39]Mitchell, Andrew Ronald, and David Francis Griffiths. The finite difference method in partial differential equations. John Wiley, 1980.
    [40]Goodwin, Paul, and Richard Lawton. "On the asymmetry of the symmetric MAPE." International journal of forecasting 15.4, 1999: 405-408.

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