Pat

J-GLOBAL ID：200903023081067258

脚を有する機械の姿勢制御装置及び制御方法

Inventor： 伊藤 聡 ,  川崎 晴久
Applicant, Patent owner： 岐阜大学長
Agent (1)： 恩田 博宣 (外1名)
Gazette classification：公開公報
Application number (International application number)：2001271863
Publication number (International publication number)：2003080478
Application date： Sep. 07, 2001
Publication date： Mar. 18, 2003
Summary：

【要約】【課題】未知環境下においても、その外力に応じて姿勢を変化させることができ適正な姿勢制御を実現することができる脚を有する機械の姿勢制御装置及び制御方法を提供する。【解決手段】脚12を足部材11に回動自在に有する機械10を制御する際、姿勢制御装置1は足部材11が床に接地した複数部分に働く床反力をロードセル16a〜16dにて検出し、脚12の傾き角度θをモータ13に設けたエンコーダにて検出する。姿勢制御装置1は外力が脚12に付与された際に足関節の傾き角度θを予め定めた目標値θdに制御するPD制御を行うとともに、外力が付与された際に検出された複数の接地部分に働く床反力の差が0になるように収束制御する力フィードバック制御を行う。両制御に基づいて足関節トルクτの算出し、演算された足関節トルクτに基づいてモータ13を駆動制御する。

Claim (excerpt)：

接地する接地部材と、同接地部材に対して回動自在に設けられた脚と、前記脚を駆動する駆動手段と、前記駆動手段を駆動制御する制御手段とを備えた脚を有する機械の姿勢制御装置において、接地部材が床に接地した複数部分に働く床反力をそれぞれ検出する床反力検出手段と、前記脚の傾き角度を検出する角度検出手段又は前記脚の傾き角度の角速度を検出する角速度検出手段とを備え、前記制御手段は、外力が付与された際に検出された前記角度又は角速度に基づいて得られた角度を予め定めた目標角度に制御するPD制御を行うとともに、外力が付与された際に検出された複数の接地部分に働く床反力の差が所定値になるように収束制御する力フィードバック制御とを行い、さらに、制御手段は両制御によりトルク演算をし、演算されたトルクに基づいて前記駆動手段を駆動制御することを特徴とする脚を有する機械の姿勢制御装置。

IPC (2)：

B25J 5/00 ,  G05D 1/08

FI (2)：

B25J 5/00 E ,  G05D 1/08 Z

F-Term (18)：

3C007CS08 ,  3C007KS21 ,  3C007KS34 ,  3C007KV01 ,  3C007KV06 ,  3C007KX12 ,  3C007KX13 ,  3C007LU07 ,  3C007LW07 ,  3C007WA13 ,  3C007WA24 ,  3C007WB06 ,  3C007WB08 ,  5H301AA01 ,  5H301AA10 ,  5H301BB14 ,  5H301CC08 ,  5H301DD01