以FPGA設計兩輪自主機器人之行為式控制系統

Behavior-based Control System Design in FPGA for a Two-wheeled Autonomous Robot

陳俊隆(Chun-Lung Chen)

指導教授 ： 王銀添

淡江大學/工學院/機械與機電工程學系碩士班/碩士(2007年)

https://doi.org/10.6846/TKU.2007.00891

摘要

本研究利用上層PC-based的視覺處理、中層FPGA-based的運動控制器與底層的馬達驅動電路完成兩輪自主機器人系統。馬達驅動電路提供轉速與電流信號並回授至中層控制器處理，而中層包含兩個運動控制器，分別由系統能量穩定與單位質量控制的概念，使用Lyapunov直接方法與逆動力學控制來設計兩種機器人的運動控制器。利用這兩種控制器的特性，規劃兩輪自主機器人的行為式控制。運動控制器的功能模組是利用VHDL實現在FPGA晶片上，功能模組包含串列傳輸、位置解碼、扭力解碼、轉速回授控制、電流回授控制與PWM訊號產生等模組。最後，利用PC-based整合三層系統，並將整合的系統應用在兩輪自主機器人上完成不同的行為式控制。

關鍵字

FPGA ； VHDL

並列摘要

In this research, we develop a two-wheeled autonomous robot system, which is composed of an upper-level PC-based vision processor, a middle-level FPGA-based motion controller, and a lower-level motor drive circuit. This motor drive circuit provides velocity and current feedback signals which are fed back to middle-level controller. In the middle-level, two robot motion controllers are deduced from the concepts of the system stability and the unit-mass control using Lyapunov’s direct method and inverse dynamics control, respectively. These two motion controllers are utilized to develop the behaviors for the autonomous robot. All the function modules of the motion controllers are devised with VHDL on the FPGA chip, including the modules of controller design, UART, position decoder, torques decoder, velocity feedback control, current feedback control, and PWM modules. The information of three-level processors is integrated in the PC-based processor and the integrated system is expected to perform different types of behavior on the two-wheeled autonomous robots.

並列關鍵字

FPGA ； VHDL

參考文獻

[29] 謝如蕓，全方位移動機器人之運動控制，淡江大學機械與機電工程學系碩士論文，2006。

[31] 蔡爾傑，兩輪移動機器人之控制與驅動設計，淡江大學機械工程學系碩士論文，2005。

[35] 陳添義，具備全方位視覺之兩輪足球機器人的追蹤控制，淡江大學機械與機電工程學系碩士論文，2006。

[1] J. Aranda, A. Grua and J. Climent, “Control Architecture for a Three- wheeled Roller Robot”, Proceedings International Workshop on Advanced Motion Control, 1998.

[3] J. Barraquand and J. C. Latombe, “Nonholonomic Multibody Mobile Robots: Controllability and Motion Planning in the Presence of Obstacles”, Proceeding of IEEE International Conference of Robotics and Automation, pp.2328-2335, 1991.