基於手部運動之人形機器人平衡控制

Balancing Control of Humanoid Robots Based on Hand Movement

陳立峰(Li-Feng Chen)

指導教授 ： 翁慶昌

共同指導教授 ： 李世安(Shih-An Li)

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

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

摘要

本論文實現一個利用雙手運動來補償人形機器人重心移動的平衡控制方法。本論文透過一台小型人形機器人之腳底加裝壓力感測器來量測重心，再加上本論文所提出之雙手運動補償方法來讓人形機器人可以實現雙腳及單腳支撐下的自主平衡，並完成如抬腳或踢球等需要平衡能力的動作。在機器人的動作軌跡部分，本論文運用工業用核心電腦計算出機器人雙足末端點位置後傳給FPGA (Field-Programmable Gate Array)，再透過FPGA內部之模組運算相對於末端點的關節馬達角度以控制人形機器人的姿態。在平衡的部分，本論文以機器人的重心位置來判斷機器人的平衡狀態，而後根據所提出的模糊控制器來修正機器人的雙手轉動以完成平衡動作。由實驗結果得知，本論文所提出之系統可以有效的修正機器人姿態，以增加平衡穩定性。

關鍵字

人形機器人 ； 模糊控制器 ； SOPC ； ZMP ； 逆運動學

並列摘要

A humanoid robot balance control method based on both of the hand movement is proposed in this thesis. A humanoid robot with 23 degree of freedom and 8 force sensors is designed as the platform. The proposed balance method determines the movement of the hands to compensate the movement of the robot’s center of gravity. The robot is able to execute the lifting leg or kicking ball motion in the one leg support situation. An IPC is applied to calculate the trajectory of the foot of the humanoid robot. The result of the trajectory of the foot is sent to FPGA (Field-Programmable Gate Array) board for calculate the relate angle of the motor based on inverse kinematic. The proposed system measures the center of gravity of the humanoid robot by the force sensors. The proposed fuzzy controller calculates the hand movement to balance the robot by the center of the gravity of the robot. The practical experiments with different situations are presented to illustrate the efficiency of the proposed method.

並列關鍵字

Humanoid robot ； Fuzzy controller ； SOPC ； ZMP(Zero Moment Point) ； Inverse Kinematic

參考文獻

[24] C. C. Wong, C. T. Cheng, H. C. Chen, Y. Y. Hu and C. S. Yin, “Static balancing control of humanoid robot based on accelerometer,” SICE Annual Conference, pp. 2836-2840, 2008.

[5] 陳顥哲，以SOPC 為基礎之人形機器人全方位行走系統的設計與實現，淡江電機工程學系碩士論文，2010。

[29] J. P. Ferreira, M. Crisostomo and A. P. Coimbra, “Neuro-Fuzzy ZMP control of a biped robot,” Proceedings of the 6th WSEAS International Conference on Simulation, pp. 331-337, 2006.

[1] H. B. Lin, C. C. Liu, Y. L. Lin, C. H. Wu and C. W. Tung, “Algebraic-elimination based solution of inverse kinematics for a humanoid robot finger,” International Conference on Mechatronics and Automation, pp. 46-51, 2007.

[2] L. Jiang, D. Sun, H. Liu and Y. H. Liu, “Study on inverse kinematics and trajectory tracking control of humanoid robot finger with nonlinearly coupled joints,” International Conference on Mechatronics and Automation, pp. 3214-3219, 2007.