大型雙足機器人之腳掌機構與站立平衡控制的設計

Design of Feet Mechanism and Standing Balance Control for Adult-Sized Biped Robot

張宸晉(Chen-Chin Chang)

指導教授 ： 鄭吉泰

共同指導教授 ： 許駿飛(Chun-Fei Hsu)

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

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

摘要

本論文著重於設計大型雙足機器人之腳掌機構與平衡控制。在腳掌機構設計中，機構重量限制在1公斤以下並利用壓縮量小的波形彈簧作為緩衝材料，且裝置力量感測器作為站立平衡控制器之輸入。在平衡控制設計中，將力量感測器之數值透過卡爾曼濾波器(Kalman Filter)後，計算機器人站立時的零力矩點(ZMP)，將ZMP傳入模糊控制器，當ZMP位置偏離預定的平衡點時，馬達會將上方機構轉向反方向的位置，由此可驗證平衡控制可用來計算雙足機器人需偏移的角度以保持平衡。最後，經由大型雙足機器人平穩站立與腰部晃動的實際實驗可知，ZMP位置皆在預期的範圍內，因此本論文設計的機器人之腳掌機構與感測器配合模糊控制器可達成預期的功能。

關鍵字

雙足機器人 ； 零力矩點 ； 力量感測器 ； 機構設計 ； 模糊控制器

並列摘要

In this thesis, a feet mechanism design and a standing balance control are proposed for an adult-sized biped robot. In feet mechanism design, the feet mechanism total weight is below 1 kg. A wave spring is used to reduce spring height as a cushioning material, and some force sensors are used to measure position of forces movement. In balance control, Kalman filter is utilized to determine the zero moment point (ZMP) in standing for robot and the ZMP is used to be an input variable of a controller. When the ZMP deviates from a desired position, the motor rotates the mechanism to a balance posture. The developed balance control system can calculate a required offset angle of biped robot to maintain balance. Finally, some experimental results are presented for the adult-sized biped robot via standing stable and moving waist. The ZMP position can be controlled within the expected range. Thus, the proposed feet mechanism and standing balance controller with sensors can efficiently control to balance in standing maintenance of the adult-sized biped robot.

並列關鍵字

Biped Robot ； Zero Moment Point ； Force Sensor ； Mechanism Design ； Fuzzy Controller

參考文獻

[7] 王紹帆，雙足機器人的設計與實現，國立台灣大學工學院機械工程學系碩士論文(指導教授：林沛群)，2010。

[14] 陳立峰，基於手部運動之人形機器人平衡控制，淡江大學電機工程學系碩士班(指導教授：翁慶昌、李世安)，2013。

[2] S.H.Hyon, “A Motor Control Strategy With Virtual Musculoskeletal Systems for Compliant Anthropomorphic Robots,” IEEE/ASME Transactions on Mechatronicc, vol. 14, no. 6, pp. 677-688, Dec. 2009.

[3] N. Paine and L.Sentis, “A New Prismatic Series Elastic Actuator with Compact Size and High Performance,” IEEE International Conference on Robotics and Biomimetics, pp.1759-1766, Dec. 2012.

[9] Z.B. Li, N.G. Tsagarakis, and D.G. Caldwell, "A Passivity Based Admittance Control for Stabilizing the Compliant Humanoid COMAN." 12th IEEE-RAS International Conference on Humanoid Robots, pp. 43-49,Nov. 2012.