簡易檢索 / 詳目顯示

研究生: 陳奕廷
YI-TING CHEN
論文名稱: 利用FPGA實現機械臂三維影像伺服追蹤控制系統
An FPGA Implementation of a 3D Vision Servo Tracking Control System for a Robot Manipulator
指導教授: 施慶隆
Ching-Long Shih
口試委員: 黃志良
Chih-Lyang Hwang
李文猶
Wen-Yo Lee
學位類別: 碩士
Master
系所名稱: 電資學院 - 電機工程系
Department of Electrical Engineering
論文出版年: 2014
畢業學年度: 102
語文別: 中文
論文頁數: 109
中文關鍵詞: FPGA立體影像視覺機械臂運動控制影像伺服控制
外文關鍵詞: Robot Manipulator, Visual Servo Motion Control, 3D Visual Servo Control
相關次數: 點閱:336下載:5
分享至:
查詢本校圖書館目錄 查詢臺灣博碩士論文知識加值系統 勘誤回報
  • 本論文旨在應用FPGA實現結合雙眼影像視覺與機械臂的影像伺服追蹤控制。本FPGA系統分為三個模組,第一個模組為影像處理模組;第二個模組為控制機械臂各軸馬達位置控制的伺服控制模組;以及第三個模組為上層的系統控制模組。前兩模組皆為利用硬體方式實現,設計程式為Verilog語言。系統控制模組為在FPGA環境下產生NIOS II微處理器,以C語言軟體程式的方式實現。此三個模組皆在單一顆FPGA晶片下實現,首先由兩顆影像感測器感測到目標物經由影像處理模組將其特徵檢出,然後經由系統控制模組利用雙眼視覺演算法將影像空間座標轉換成系統空間的三維座標,再將此座標經由機械臂反運動學運算及經由動作決策後,最後利用伺服控制模組來控制各軸馬達所需的旋轉量以完成機械臂三維影像伺服追蹤控制。


    The thesis aims to utilize a FPGA chip for the implementation of the stereo vision and the 3D visual servo tracking control of a robot manipulator. The FPGA system described herein includes three modules: one is the image processing module, another is the servo position control module for controlling the robot manipulator with six axes,and the third module is the upper system control module. The first and second modules are realized on the hardware digital logic circuit programed by the Verilog hardware description language (HDL),and the system control module is executed in the FPGA-based embedded NIOS II within the same FPGA chip and realized using C programming language. In additions, the three modules are implemented based on the same FPGA chip. First, two CMOS image sensors are used to detect the target motion and then obtain its characteristics through the image processing algorithms. Next, the system control module converts image coordinate into 3D coordinate in the world frame by means of the stereo vision algorithms. Hence, after the path planning and the calculation of the inverse kinematics of the robot manipulator, the servo control module manipulates the rotation angles of each axis to desired ones such that 3D visual servo tracking control of the robot manipulator is achieved.

    第一章 緒論 1 1.1 文獻回顧 1 1.2 研究目的與動機 3 1.3 論文大綱 4 第二章 系統架構 6 2.1簡介 6 2.2 Altera DE2發展板 10 2.3機械臂及線性滑軌平台 12 2.4 馬達驅動電路 14 2.5 CMOS影像感測器 16 2.6 開發環境介紹 17 第三章 影像處理模組 20 3.1 Line Buffer模組 21 3.2 影像前置處理區塊 23 3.2.1 RAW 轉 RGB模組 24 3.2.2 低通濾波器模組 26 3.2.3 RGB轉YCbCr模組 29 3.2.4 色彩過濾二值化模組 32 3.2.5 侵蝕模組與膨脹模組 33 3.2.6 排序濾波器模組 39 3.3 影像後處理區塊 42 3.3.1重心點計算模組 42 3.4 VGA控制器模組 46 第四章 伺服控制模組 48 4.1 數位低通濾波器模組 49 4.2 馬達光編碼器解碼模組 51 4.3數位PID控制器模組 55 4.4脈波寬度調變模組 58 第五章 系統控制模組 61 5.1基於三維空間物體的空間座標計算 62 5.1.1 雙眼視覺演算法 62 5.1.2 物體高度運算 66 5.2 正向運動學 68 5.3 反向運動學 70 5.4系統動作決策 73 第六章 實驗結果 75 6.1 馬達暫態響應實驗 75 6.2等速曲線軌跡追蹤控制實驗 78 6.3 影像處理結果 79 6.4 立體視覺深度量測實驗 81 6.5 機械臂影像伺服控制系統實驗 83 6.5.1 量測深度與機械臂終端器位置實驗 83 6.5.2 影像命令與影像回授實驗 85 6.5.3 影像回授誤差命令與馬達位置之驗證 86 6.6 目標物追蹤實驗 87 6.7 FPGA資源分配 92 第七章 結論與建議 93 7.1結論 93 7.2 建議 94

    [1] A.C. Sanderson and L.E. Weiss, “Image-based Visual Servo Control Using Relational Graph Error Signal,” IEEE Int. Conf. Cybernetics and Society, pp. 1074-1077, 1980.
    [2] D. Saqui, C. S. Fernando, R. R. K. Edilson and C. P. Emerson, “Mathematical Morphology Applid in Object Tracking on Position-based Vistual Servoing,” IEEE Int. Conf. Systems, Man and Cybernetics, 2013.
    [3] E. Malis, F. Chaumette and S. Boudet, “2-1/2-D Visual Servoing,” IEEE Trans. on Robotics and Automation, vol. 15, pp. 238-250, 1999.
    [4] I. Ohmura, T. Mitamura, H. Takauji, S. Kaneko, “A Real-time Stereo Vision Sensor Based on FPGA Realization of Orientation Code Matching,” IEEE Int. Conf. Optomechatronic Technology, pp. 1-5, 2010.
    [5] C. Sanchez-Ferreira, J. Y. Mori, C. H. Llanos, E. Fortaleza, “Development of a Stereo Vision Measurement Architecture for an Underwater Robot,” IEEE Int. Conf. Circuit and Systems, pp. 1-4, 2013.
    [6] S. Jin, D. Kim, T. Song, Q. N. Le and J. W. Jeon, “An FPGA-Based Motion-Vision Integrated System for Real-Time Machine Vision Applications,” IEEE Int. Conf. Industrial Electronics, pp. 700-705, 2009.
    [7] H. Hagiwara, K. Asami, and M. Komori, “Real-time Image Processing System by Using FPGA for Service Robots,” IEEE Int. Conf. Consumer Eletronics, pp. 720-723, 2012.
    [8] CCIR, “Encoding Parameters of Digital Television for Studios,”  CCIR Recommendation 601-2, Int. Radio Consult. Committee, Geneva, Switzerland, 1990.
    [9] J. U. Cho, Q. N. Le, and J. W. Jeon, “An FPGA-Based Mutiple-Axis Motion Control Chip,” IEEE Trans. on Industrial Electronics, vol. 56, no. 3, pp. 856-870, 2009.
    [10] Y. S. Kung, K. S. Tseng and C. S. Chen, “FPGA-Implementation of Inverse Kinematics and Servo Controller for Robot Manipulator,” IEEE Int. Conf. Robotics and Biomimetics, pp. 1163-1168, 2006.
    [11] X. Shao, D. Sun, “Development of a New Robot Controller Architecture with FPGA-Based IC Design for Improved High-Speed Performance,” IEEE Trans. on Industrial Imformatics, vol. 3, no. 4, pp. 312-321, 2007.
    [12] C. C. Tsai, H. C. Huang, S. C. Lin, “FPGA-Based Parallel DNA Algorithm Optimal Configurations of an Omnidirectional Mobile Service Robot Performing Fire Extinguishment,” IEEE Int. on Industrial Electronics, vol. 58, no. 3, pp. 1016-1026, 2011.
    [13] H. C. Huang, C. C. Tsai, “FPGA Implementation an Embedded Robust Adaptive Controller for Autonomous Omnidirectional Mobile Platform,” IEEE Trans on Industrial Electronics, vol. 56, no. 5, pp. 1604-1616, 2009.
    [14] E. Monmasson, L. Idhajine, M. N. Cirstea, I. Bahri, A. Tisan, M. W. Naouar, “FPGAs in Industrial Control Applications,” IEEE Trans. on Industrial Imformatics, vol. 7, no. 2, pp. 224- 243, 2011.
    [15] DE2 Development Education Board User Manual, ALTERA Corporation, 2003.
    [16] RAM-Based Shift Register (ALTSHIFT TAPS) Magafunction User Guide, ALTERA Corporation, 2013.
    [17] 友晶科技, TRDB DC2 UserGuide, 2006。
    [18] 鐘書銘,以SOPC實現強健性彩色影像物體追蹤及移動預測系統,國立成功大學電機工程學系碩士論文,2004。
    [19] 林灶生,劉紹漢,Verilog FPGA晶片設計,全華圖書有限公司,2007。
    [20] 廖裕評,陸瑞強,系統晶片設計-使用NIOS II,全華圖書股份有限公司,2007。
    [21] 鐘國亮,影像處理與電腦視覺第四版,東華書局,台北,2008。
    [22] 施慶隆,李文猶,機電整合:多軸運動控制設計與應用第二版,2009。
    [23] 廖英超,基於MATLAB軟體之機械臂影像伺服控制及應用,國立台灣科技大學電機工程系碩士論文,2010。
    [24] 謝承哲,移動機器人立體視覺測距及追蹤移動目標,國立台灣科技大學電機工程系碩士論文,2010。
    [25] 吳俊錫,立體視覺導引之互動式雙臂機械人,國立台灣科技大學機械工程系碩士論文,2011。
    [26] 楊秉霖,以FPGA實現手寫數字影像辨識系統,國立台灣科技大學電機工程系碩士論文,2012。
    [27] 林奕巡,以系統晶片實現機械臂影像伺服運動控制,國立台灣科技大學電機工程研究所碩士論文,2013。

    QR CODE