簡易檢索 / 詳目顯示

研究生: 巫憲欣
Shian-shin Wu
論文名稱: 以系統晶片發展具機器視覺之機械手臂運動控制
Machine Vision Based Robot Motion Control by Using a SOPC System
指導教授: 黃緒哲
Shiuh-Jer Huang
口試委員: 黃安橋
An-Chyau Huang
周瑞仁
Jui-Jen Chou
學位類別: 碩士
Master
系所名稱: 工程學院 - 機械工程系
Department of Mechanical Engineering
論文出版年: 2006
畢業學年度: 94
語文別: 中文
論文頁數: 127
中文關鍵詞: 系統晶片模糊滑動模式控制機械手臂
外文關鍵詞: sopc, fuzzy-sliding mode control, robot
相關次數: 點閱:396下載:30
分享至:
查詢本校圖書館目錄 查詢臺灣博碩士論文知識加值系統 勘誤回報

本文主要應用SOPC技術研製具機器視覺之機械手臂運動控制系統,並且實現以視覺感測輔助機械手臂辨識五子棋棋盤變化之對戰遊戲。在影像輔助之機械手臂伺服系統的控制晶片內包含兩部分,第一個部份是在晶片內以數位硬體電路實現訊號擷取與輸出控制訊號之功能,共包含五組光學編碼器信號偵測與四倍頻寬解碼電路、極限開關訊號偵測、五組脈波寬度調變信號輸出、CMOS影像感測器訊號擷取等。第二部份是在Nios II微處理器內以軟體方式實現控制動作,其功能有控制晶片與個人電腦間的串列通訊、反運動學方程式計算、點對點運動控制、連續運動軌跡計算、機械手臂運動之程序控制、自組織模糊控制器、模糊滑動模式控制器、數位影像處理及五子棋AI演算法等等。在系統晶片內之硬體部分使用Verilog硬體描述語言撰寫;軟體部分使用C程式語言撰寫。系統晶片採用美商ALTERA公司生產的Statrix II EP2S60F672C5ES現場可程式邏輯閘陣列(FPGA),CMOS影像感測器採用國內PIXART公司所生產的PAS106BCB283彩色影像感測器,此感測器為解析度為356×292。最後,本論文整合一套系統,包括Nios II發展板、機械手臂、直流馬達驅動電路和CMOS影像感測器等,經由實驗結果之比較而選擇精確且有效率的控制器,配合機器視覺輔助來驗證本文所設計的系統晶片之有效性與正確性。


A servo control IC for robot arm using SOPC technology is presented in this thesis. A gobang game is implemented in the system by using vision feedback to recognition pieces in the board. In the proposed servo control IC, there are two modules. One module is implemented by hardware circuit. Its functions are five quadrature encoder pulse process, ten limit switches detect, five pulse width modulation generator and CMOS image sensor signal capture. The other module is implemented by software using Nios II micro processor. Its functions are an UART to connection with PC, inverse kinematics of robot arm, point to point motion control, continuous motion trajectory control, sequential control, self organization fuzzy control, fuzzy sliding mode control, digital image processing and gobang game AI algorithm. The digital hardware circuits are design by Verilog language and programs in Nios II micro processor is coded in C language. The FPGA chip adopts ALTERA Statrix II EP2S60F672C5ES on the development board. The CMOS color image sensor adopts PIXART PAS106BCB283 which resolution is 356×292 pixels. At last, an integrated experimental system which includes Nios II development board, five axis robot arm, DC motor drivers and CMOS image sensor has been constructed. Some experimental results have been provided and demonstrated the effectiveness and correctness of the proposed servo control system.

中文摘要 I 英文摘要 II 誌謝 III 目錄 IV 圖表索引 VI 符號縮寫 XIII 第一章 緒論 1 1.1 前言 1 1.2 文獻回顧 2 1.3 研究動機與目的 5 1.4 論文架構 5 第二章 系統架構 6 2.1 Nios II發展板 8 2.2 機械手臂 10 2.3 馬達驅動電路 11 2.4 CMOS影像感測器 12 2.5 個人電腦 14 第三章 系統晶片之設計 15 3.1 數位低通濾波器 17 3.2 馬達光學編碼器量測原理 17 3.3 脈波寬度調變電路 21 3.4 CMOS SENSOR影像訊號擷取 22 3.5 Nios II微處理器規劃 25 第四章 機械手臂理論分析 28 4.1 座標系統 28 4.1.1 座標系(Coordinate Frame) 28 4.1.2 旋轉(Rotation) 30 4.1.3 齊次轉換(Homogeneous Transformation) 32 4.1.4 連桿參數與座標(Link Parameters and Coordinate) 34 4.2 機械手臂運動分析 36 4.3 機械手臂反運動學 41 4.3.1 反運動學推導方式ㄧ 41 4.3.2 反運動學推導方式二 44 4.4 梯形速度規劃 47 第五章 控制理論 52 5.1 模糊邏輯控制 53 5.1.1 模糊集合與隸屬函數 53 5.1.2 基本模糊控制器架構 54 5.2 自組織模糊控制器 58 5.3 滑動模式控制 64 5.3.1 滑動模式控制原理 64 5.3.2 滑動模式控制理論基礎 65 5.4 平滑化滑動模式控制理論基礎 68 5.5 模糊滑動模式控制器 70 第六章 數位影像處理 73 6.1 I2C電路 73 6.2 色彩內插演算法 76 6.2.1 彩色濾波陣列 76 6.2.2 內插演算法 77 6.3 影像灰階化 78 6.4 影像平滑處理 78 6.5 影像二值化 79 6.6 辨識玩家下棋點 80 第七章 實驗結果與討論 81 7.1 自組織模糊控制器實驗 83 7.1.1 自組織模糊控制器之實現 83 7.1.2 自組織模糊控制器之實驗結果 84 7.2 模糊滑動模式控制器實驗 94 7.2.1 模糊滑動模式控制器之實現 94 7.2.2 模糊滑動模式控制器之實驗結果 95 7.3 FSMC與SOFC實驗結果討論 106 7.4 影像處理實驗 107 7.5 五子棋對戰遊戲 110 第八章 結論與未來展望 112 8.1 結論 112 8.2 未來展望 113 參考文獻 114 附錄 120 作者簡歷 127

【1】 L. W. Tsai, “Robot Analysis - The Mechanics of Serial and Parallel Manipulators,” John Wiley & Sons, Inc., 1999.
【2】 R. J. Schilling, “Fundamentals of robotics: analysis and control,” Prentice-Hall, Inc., 1990.
【3】 J. Denavit, and R. S. Hartenberg, “A Kinematics Notation for Lower Pair Mechanisms Based on Matrices,” ASME., J. of Applied Mechanics 22, 1955.
【4】 F. J. Lin, D. H. Wang, and P. K. Huang, “FPGA-based Fuzzy Sliding-mode Control for a Linear Induction Motor Drive,” Proceeding of the IEEE International Conference on Electrical Power Application, Vol. 152, No. 5, pp. 1137-1148, September 2005.
【5】 Y. S. Kung, and G. S. Shu, “Development of a FPGA-based Motion Control IC for Robot Arm,” Proceeding of the IEEE International Conference on Industrial Technology, pp.1397-1402, 2005.
【6】 C. H. An, C. G. Atkeson, J. D. Griffiths, and J. M. Hollerbach, ”Experimental Evaluation of Feedforward and Computer Torque Control,” in proc. IEEE Int. Conf. on Robotics and Automation (Raleigh, Nc, Mar.31-Apr.3. 1987), pp.165-168.
【7】 Sprros Tzafestas, and Leonidas Dristsas, ”Combined Computed Torque and Model Reference Adaptive Control of Robot System,” Journal of the Franklin Institute.Vol.327, No.2, pp. 273-294,1990.
【8】 Ho-Hoon Lee, and Fred E. Chlick, “Design of a Adaptive Control Law for Robotic Manipulator,” Journal of Robotic Systems, Vol.11, No.4, pp.241-255, Jun.1994.
【9】 Louis-A Dessaint, Marouf Sand, and Bernard Hebert, “An Adaptive Controller for a Direct-drive SCARA Robot,” IEEE Trans. on Industrial Electronics, Vol.39, No.2, pp.105-111, April.1995.
【10】 G. C. Huang, and S. C. Lin, “A stability approach to fuzzy control design for nonlinear systems,” Fuzzy Set Syst., Vol.48, pp.269-278, 1992.
【11】 Y.S. Lu, and J.S. Chen, “A self-organizing fuzzy sliding mode controller design for a class of nonlinear servo systems,” IEEE Trans. on Industrial Electronics, Vol. 41, pp.492-502, Oct. 1994.
【12】 C. C. Kung, and S. C. Lin, “A fuzzy-sliding mode controller design,” IEEE International Conference on Systems Engineering, pp.608–611, 17-19 Sep 1992.
【13】 T.C. Chen, and J.U. Hsu, “A fuzzy sliding mode controller for induction motor position control,” IECON '94, 20th International Conference on Industrial Electronics, Control and Instrumentation, Vol. 1, pp. 44-49, 5-9 Sep 1994.
【14】 J. N. Reed, S. J. Miles, J. Butler, M. Baldwin, and R. Noble, “Automation and Emerging Technologies: Automatic Mushroom Harvester Development,” Journal of Agricultural Engineering Research Vol. 78, Issue: 1, pp. 15-23, January, 2001.
【15】 Adolfo Bauchspiess, Alfaro Absi, C. Sadek, and Leszek A. Dobrzanski, “Predictive sensor guided robotic manipulators in automated welding cells,” Journal of Materials Processing Technology Vol. 109, Issue: 1-2, pp. 13-19, February 1, 2001.
【16】 Yingen Xiong, and Francis Quek, “Machine vision for 3D mechanical part recognition in intelligent manufacturing environments,” Proceedings of the Third International Workshop on Robot Motion and Control, RoMoCo '02, pp.441-446, 2002.
【17】 D. M. Bulanon, T. Kataoka, Y. Ota, and T. Hiroma, “Automation and Emerging Technologies: A Segmentation Algorithm for the Automatic Recognition of Fuji Apples at Harvest,” Biosystems Engineering Vol. 83, Issue: 4, pp. 405-412, December 2002.
【18】 S. Hutchinson, G. D. Hager, and P. I. Corke, “A tutorial on visual servo control,” IEEE Trans. Robot. Automat., vol. 12, pp. 651–670, May 1996.
【19】 Chern-Sheng Lin, and Li-Wen Lue, “An image system for fast positioning and accuracy inspection of ball grid array boards,” Microelectronics Reliability Vol. 41, Issue: 1, pp. 119-128, January 2001.
【20】 Nan-Feng Xiao, and S. Nahavandi, “Multi-agent model for robotic assembly system,” Proceedings of the 5th Biannual World Automation Congress, 2002., Vol. 14, pp.495-500, 2002.
【21】 J. Blasco, N. Aleixos, J.M. Roger, G. Rabatel, and E. Molto, “Automation and Emerging Technologies: Robotic Weed Control using Machine Vision,” Biosystems Engineering Vol. 83, Issue: 2, pp. 149-157, October, 2002.
【22】 Changman Son, “Optimal control planning strategies with fuzzy entropy and sensor fusion for robotic part assembly tasks,” International Journal of Machine Tools and Manufacture Vol. 42, Issue: 12, pp. 1335-1344, September 2002.
【23】 T.I.J. Tsay, M.K. Lee, G.L. Wang, M.S. Hsu, and C.H. Lai, “Robotic eye/arm coordination via visual servoing,” Proceedings of the 2002 International Conference on Control Applications, Vol.2, pp.742-747, 2002.
【24】 R. Garrido, A. Soria, P. Castillo, and I. Vazquez, “A visual servoing architecture for controlling electromechanical systems,” in Proc. Int. Conf. Control Applications & Int. Symp. Intelligent Control, Mexico City, Mexico, Sept. 5–7, 2001.
【25】 A. Nagchaudhuri, “Robotics and machine vision for introduction to flexible automation to engineering undergraduates,” Frontiers in Education, 2002. FIE 2002. 32nd Annual, Vol. 1, pp. T2D-23 -T2D-28, 2002.
【26】 T. J. Procky, and E. H. Mammdani, “Self-organizing Process Controller,” Automatica, Vol.15, pp.15-30, 1979.
【27】 J. J. E. Slotine, and W. Li, “Applied nonlinear control,” Prentice-Hall, Englewood Cliffs, New Jersey, 1991.
【28】 S. W. Kim, and J. J. Lee, “Design of a fuzzy controller with fuzzy sliding surface,” Fuzzy Sets and Systems, Vol.71, pp.359-367, 1995.
【29】 R. Palm, “Sliding mode fuzzy control,” IEEE Int. Conference Fuzzy System, San Diego, CA, pp.519-526, Mar. 1992.
【30】 L. X. Wang, “Stable adaptive fuzzy control of nonlinear systems,” IEEE Trans. Fuzzy System, vol.1, pp.146-155, 1993.
【31】 R. Palm, “Robust control by fuzzy sliding mode,” Automatica, Vol.30, No.9, pp.1429-1437, 1994.
【32】 S.C. Lin, and Y.Y. Chen, “Design of adaptive fuzzy sliding mode control for nonlinear system control,” in Proc. 3rd IEEE Conf. Fuzzy Syst., IEEE World congress Computat. Intell., Orlando, FL, Vol.1, pp.35-39, June 1994.
【33】 Jan T. Bosiers, Agnes C. Kleimann, Harry C. van Kuijk, Laurent Le Cam, Herman L. Peek, Joris P. Maas, and Albert J.P. Theuwissen, “Frame Transfer CCDs for Digital Still Cameras: Concept, Design, and Evaluation,” IEEE Trans. On electron devices, Vol. 49, NO. 3, MAR. 2002.
【34】 Tzuu-Hseng S. Li, Shih-Jie Chang, and Yi-Xiang Chen, “Implementation of Autonomous Fuzzy Garage-Parking Control by an FPGA-Based Car-Like Mobile Robot Using Infrared Sensors,” Proceedings of the 2003 IEEE International Conference on Robotics & Automation, Taipei. Taiwan, September 14-19. 2003.
【35】 M. Okura, and K. Murase, “Artificial Evolution of FPGA that controls a Miniature Mobile Robot Khepera,” Proceedings of the Autonomous minirobots for research and edulainmente (AniiRE2003). pp. 103-111 , 2003.
【36】 喬執中, “力量控制於機械手臂運動之應用,” 碩士論文, 國立中央大學機械工程研究所, 2001.
【37】 許哲誌, “關節型機械臂系統整合晶片之研製,” 碩士論文, 南台科技大學電機工程研究所, 2005.
【38】 呂學德, “使用FPGA實現機械手臂運動控制器,” 碩士論文, 國立台灣科技大學電機工程研究所, 2004.
【39】 謝欣瑋, ”氣壓平台之運動控制,” 碩士論文, 國立台灣科技大學機械工程技術研究, 2000.
【40】 蔡金波, “機器人於自動化組裝之應用,” 碩士論文, 國立台灣科技大學機械工程研究所, 2003.
【41】 楊清任, “即時語意式自組織模糊控制器之設計,” 國立台灣大學機械工程研究所, 碩士論文, 1992.
【42】 王紫峰, “自組織模糊控制應用於垂直負載液壓伺服系統,” 國立臺灣工業技術學院機械技術工程研究所, 碩士學位論文, 1995.
【43】 林明德, “色彩內插演算法之比較與FPGA硬體系統實現,” 碩士論文, 國立高雄第一科技大學, 2005.
【44】 范存堯, “永磁同步馬達位置控制之FPGA晶片研製,” 碩士論文, 國立交通大學電機工程研究所, 2004.
【45】 曾佑民, “無量測器直流無刷馬達控制之FPGA設計與製作,” 碩士論文, 國立台灣科技大學電機工程研究所, 2004.
【46】 http://www.altera.com/, 2006.
【47】 ALTERA, “Altera Embedded Peripherals,” ALTERA Corporation, 2005.
【48】 ALTERA, “Nios II Development Board,” ALTERA Corporation, 2005.
【49】 CIC, ALTERA Training manual-FPGA Design with Quartus II, 2003.
【50】 http://www.national.com/pf/LM/LMD18200.html, 2006.
【51】 PAS106BCB283 datasheet, Version 2, Pixart Image Inc., 2002.
【52】 http://www.esacademy.com/faq/i2c/I2C_Bus_specification.pdf, 2006.
【53】 ALTERA, “Nios II Software Developer’s Handbook,” ALTERA Corporation, 2005.
【54】 鄭信源, “Verilog硬體描述語言數位電路,” 儒林出版社, 2003.
【55】 鐘國亮, “影像處理與電腦視覺,” 東華書局, 2004.

QR CODE