Front page   Edit Freeze Diff Backup Upload Copy Rename Reload   New List of pages Search Recent changes   Help   RSS of recent changes

Development of Variable Stiffness Joint Drive Modules

Last-modified: 2012-08-20 (Mon) 00:29:31 (1915d)
Top / Development of Variable Stiffness Joint Drive Modules

目次

委託事業名

(財)飯塚研究開発機構調査研究開発事業

「人間のように関節の硬さを変更できる関節駆動モジュールの開発」

概要

outline.jpg

モジュールの完成イメージ

関節駆動モジュール

module_image_1.jpg

モジュールボックス

module_image_2.jpg

進捗状況報告

October 1, 2009

Scilabでシミュレータを作った。

result_091001.png

September 25, 2009

昨日の制御系のさらに上位に、関節角度を制御するためのPI制御(Kp=50, Ki=6.0)を施した。ワイヤにほとんどテンションをかけない状態で行った実験の結果は以下の通り。しかし、角度制御をしてしまうと非線形バネの柔軟性が打ち消されてしまい、関節の硬さは制御系のゲインで決まってしまう。

result_090925_1.png

fileresult_090925_1.dat

September 24 (2), 2009

モータの角速度(サンプリング周期間にエンコーダが出力するパルス数)制御系は、PI制御(Kp=0.03, Ki=0.015)で構成する。そのPI制御系の上位に、モータの角度(上記パルス数の積算値)を制御するための、P制御(Kp=0.1)を施す。実験結果は以下の通り。

result_090924_1_2.png

fileresult_090924_0.dat fileresult_090924_1.dat

September 24, 2009

ステップ応答からモータの時定数とゲインを求めた。

motor0: T = 0.02, K = 18.5

morot1: T = 0.02, K = 16.0

パルス伝達関数は以下の通り(scilabで計算)。入力はモータドライバへの指令値、出力はサンプリング周期間にエンコーダが出力したパルス数。なお、1サンプルの計算時間遅れを考慮している。

motor0:

      11.69423
   --------------
                 2
 - 0.3678794z + z

motor1:

     10.113929
   -------------
                 2
 - 0.3678794z + z

モータドライバへの指令が60の時のステップ応答は、以下のグラフの通り。 step_res_p60.gif

September 17, 2009

モータ制御系の設計をやり直す。SyRen 25A regenerative motor driver(DimensionEngineering製)の出力特性を計測した。入力電圧は15.04V(電源はALINCOのDM-33OMV)。

syren0_out_v.png syren1_out_v.png

filesyren0_out_v.dat filesyren1_out_v.dat

August 3, 2009

張力制御を入れたら、マイコンの割り込みが間に合わなくなってしまった。 制御周期を10ms->20msに変更。ゲイン調整が必要。

July 8, 2009

(株)リベックスのワイヤインパルスコーダを使って直接SATの長さを計測したかったが、高価だったので諦めた。モータと関節のエンコーダ値からSATの長さを求めることにした。

July 1, 2009

制御周期10ms、エンコーダサンプリング周期20.8μsの時、エンコーダで計測できる回転速度の上限は480pulse/10ms。

制御周期10ms、エンコーダサンプリング周期15.6μs、641pulse/10msがSH7145Fの限界か?

June 24, 2009

23日のワイヤ巻き取り量制御の上位に、PIの関節角度制御を実装した。 ゲイン調整は試行錯誤。ワイヤの張力にも依存するだろう。

exp_result_090624.png

June 23, 2009

ワイヤ巻き取り量が制御できるようになった。 モータの回転速度制御ループはPI制御、回転角度制御ループはP制御。 ゲイン調整は試行錯誤。 ワイヤを1mm巻き取るためには、モータを約800パルス逆回転すればよい。 ただし、巻き取ったワイヤによりプーリの径が増すので、巻き取るほどこの値は減少する。

May 20, 2009

2号機の動作確認実験@九工大

experimental_apparatus_2_090520.jpg

コントローラは、ArduinoからBestTechnologyのSH7145Fマイコンボードに変更した。

April 2, 2009

2号機の動作確認実験@九工大

とりあえず、非線形バネは取り付けないで、動作確認実験を行った。

March 19, 2009

成果報告会 @福岡県立飯塚研究開発センター

 

2号機のワイヤ巻き取り部動作確認実験@九工大

March 17, 2009

2号機の機構部組立終了@三ツ和金属

experimental_apparatus_2_090317_1.jpg
experimental_apparatus_2_090317_2.jpg
製作した実験装置2号機
(設計:機電研 奥村様、
部品加工:三ツ和金属様)
アーム&関節
(ケミカルウッドのカバー付)
experimental_apparatus_2_090317_3.jpg
experimental_apparatus_2_090317_4.jpg
アーム&関節
(カバーなし)
関節
(上方から)
experimental_apparatus_2_090317_5.jpg
モジュールボックス
(モータドライバなし)

March 10, 2009

とりあえず、成果報告書提出。

March 9, 2009

2号機の完成予想図

experimental_apparatus_2_090309.jpg

設計:奥村様@機電研

February 17, 2009

2号機のモータ駆動系のテスト3@九工大

昨日の問題は、ArduinoとSyRenの通信速度を、9600bpsから2400bpsに変更することで解決できた。

February 16, 2009

2号機のモータ駆動系のテスト2@九工大

エンコーダのパルスをサンプルする割り込み処理をArduinoに実装。Timer2を使用した。

しかし、割り込み処理を入れると、新しいSyRenの方が暴走してしまう。古い方は問題なし。

February 13, 2009

2号機のモータ駆動系のテスト1@九工大

で2号機のモータ駆動系を構成した。

SyRen の動作モードは、Simplified Serial Mode with Slave Select。

Arduino のプログラムを更新すると、最初は必ず暴走する。原因は不明。

February 3, 2009

機電研の奥村様が、2号機の図面を仕上げてくださった。

December 25, 2008

2号機に使用するモータドライバが納品された。

MechaRoboShopで購入。

December 16, 2008

2台目の実験装置で使用するモータが納品された。

名前:RE25 GB 20W

型番:118752

型番:225773

December 11, 2008

関節角速度計測実験2@九工大

ギアヘッドの減速比を17:1から4.1:1に変更した。 指令信号最大で関節を回転させたときの、最大関節角速度は23deg/s程度であることがわかった。ほぼ予想通り。

CCW_angle_081211.jpg
CCW_rate_081211.jpg
関節角度(反時計回り)関節角速度(反時計回り)
CW_angle_081211.jpg
CW_rate_081211.jpg
関節角度(時計回り)関節角速度(時計回り)

November 12, 2008

関節剛性計測実験@九工大

関節剛性計測実験を行った。 具体的には、ワイヤにテンションをかけた状態でアームの先端を引っ張り、そのときの関節角度の変位と引っ張り力を計測した。引っ張り力はディジタルプシュプルゲージにより計測した。

 

下のグラフの横軸は関節角度の変位で、縦軸は引っ張り力を関節軸周りのトルクに変換したものである。LとRは非線形バネの長さ(mm)を表し、自然長はL0=100、R0=100である。

 

テンションを増減させて非線形バネを伸縮することで、関節剛性を変えることができることが確認できた。

joint_stiffness_test_081112.jpg
関節剛性計測実験の結果

November 11, 2008

関節角速度計測実験1@九工大

指令信号最大で関節を回転させたときの、最大関節角速度は6deg/s程度であることがわかった。 角速度は、エンコーダで計測された関節角度のデータから、 後退差分近似を用いて計算した。 サンプリング周期は約0.1s(一定ではないが変動を考慮して計算)。

CCW_angle.jpg
CCW_rate.jpg
関節角度(反時計回り)関節角速度(反時計回り)
CW_angle.jpg
CW_rate.jpg
関節角度(時計回り)関節角速度(時計回り)

November 10, 2008

ワイヤ巻き取り部引っ張り力計測実験@九工大

プシュプルゲージで、ワイヤ巻き取り部の引っ張り力を計測した。 左右どちらとも約70Nで止まった。 ワイヤを巻き取るボビンの直径が19mmなので、 最大巻き取りトルクは70N X 9.5mm = 665mNmということになる。

October 22, 2008

実験装置組立2@三ツ和金属

(三ツ和金属、機電研、RoboPlusひびきの、九工大)

実験装置の組立終了。動作チェックを行った。

剛性の変化は確認できたが、関節の回転が予想以上に遅かった。 ギアヘッドの減速比が小さなモータを準備することにする。 ワイヤ巻き取り部にウォームギアを使用しているため、モータの電源を切ってもワイヤが緩まない。

experimental_apparatus_1_081028_1.jpg
experimental_apparatus_1_081028_2.jpg
製作した実験装置
(設計:機電研 奥村様、
部品加工:三ツ和金属様)
アーム部
(黒い物体はエンコーダ。
関節とベルトで繋がっている。)
experimental_apparatus_1_081028_3.jpg
experimental_apparatus_1_081028_4.jpg
非線形バネSAT
(鈴鹿高専の白井先生が開発)
ウォームギアを使ったワイヤ巻き取り部1
experimental_apparatus_1_090116_1.jpg
experimental_apparatus_1_090116_2.jpg
ウォームギアを使ったワイヤ巻き取り部2ウォームギアを使ったワイヤ巻き取り部3
experimental_apparatus_1_081028_5.jpg
モータドライバ
(RoboPlusひびきのが開発)

October 20, 2008

実験装置組立1 @三ツ和金属

(三ツ和金属、機電研、RoboPlusひびきの、九工大)

部品の加工が完了したので、実験装置を組み立て始める。 機構部分は95%完成。

September 15, 2008

関節に取り付けるエンコーダ(オムロン、E6A2-CWZ3C 500P/R)の値を、マイコンで読み取れるようになった。 使用しているマイコンは、BestTechnologyのSH7145Fマイコンボード。 SH7145FのMTUの位相計数モードを利用した。

September 12, 2008

打ち合わせ&納品 @九工大

(機電研、RoboPlusひびきの、九工大)

機電研の奥村様が、修正した実験装置の設計案を説明してくださった。主な修正箇所は以下の2点。

  • 非線形バネ取り付け部の長さを変更できるようにした。
  • 関節部にエンコーダを追加した。

さらに追加で、プシュプルゲージで関節の硬さを計測するために、アームに穴を開けていただくようお願いした。

続いて、RoboPlusひびきのの神田様から、仮のモータドライバとICD2を納品していただいた。また、MPLABの使用方法も教えていただいた。

September 1, 2008

打ち合わせ @三ツ和金属

(三ツ和金属、機電研、九工大)

機電研の奥村様が、実験装置の設計案を考えて、その図面を描いてきてくださった。 2点ほど修正し、9月第3週には図面が完成する予定とのこと。 その後、三ツ和金属で加工開始。

July 24, 2008

RoboPlusひびきのとの打ち合わせ @生命体石井研

RoboPlusひびきの、三ツ和金属、機電研、九工大)

開発するモジュールで使用するモータとモータドライバを決定しました。

名前:RE13 1.5W Graphite Brushes

型番:118576

名前:GP13A

型番:110314

ギア比:17:1

型番:323054

チャンネル数:2

分解能:256

名前:dsPIC搭載小型モータドライバボード

http://www.roboplus.jp/info/

July 11, 2008

打ち合わせ @三ツ和金属

(三ツ和金属、機電研、九工大、飯塚研究開発機構)

July 1, 2008

契約書、報告書などについての説明会 @福岡県立飯塚研究開発センター

June 26, 2008

採択決定

June 20, 2008

プレゼン @福岡県立飯塚研究開発センター

June 5, 2008

調査研究開発事業提案書を提出

June 3, 2008

打ち合わせ @九工大→@三ツ和金属

(三ツ和金属、機電研、九工大)

May 23, 2008

打ち合わせ @九工大

(機電研、九工大)

開発メンバー

三和金属株式会社

鈴木徳義 代表取締役

福岡県工業技術センター機械電子研究所

奥村克博 主任技師、渡邉恭弘 主任技師

九州工業大学

小林順 助教


Attach file: filetest_experiment_081028_1.mpg 708 download [Information] fileexperimental_apparatus_1_081028_4.jpg 790 download [Information] fileexperimental_apparatus_2_090317_2.jpg 766 download [Information] fileCCW_angle.jpg 821 download [Information] fileresult_090924_1_2.png 786 download [Information] fileexperimental_apparatus_1_081028_2.jpg 818 download [Information] filejoint_stiffness_test_081112.jpg 810 download [Information] filestep_res_p60.gif 786 download [Information] fileexperimental_apparatus_2_090317_3.jpg 787 download [Information] fileexperimental_apparatus_1_081028_1.jpg 822 download [Information] fileCW_angle_081211.jpg 819 download [Information] filesyren1_out_v.dat 830 download [Information] fileexperimental_apparatus_2_090317_4.jpg 762 download [Information] filetest_experiment_090520.mpg 716 download [Information] fileexperimental_apparatus_2_090520.jpg 740 download [Information] filetest_experiment_090319.mpg 645 download [Information] filetest_experiment_090402.mpg 651 download [Information] filemodule_image_1.jpg 917 download [Information] fileCCW_rate.jpg 807 download [Information] fileCW_rate_081211.jpg 811 download [Information] fileexperimental_apparatus_2_090317_5.jpg 781 download [Information] fileresult_090924_0.dat 827 download [Information] filemodule_image_2.jpg 819 download [Information] fileCW_rate.jpg 824 download [Information] fileCCW_angle_081211.jpg 859 download [Information] fileresult_091001.png 760 download [Information] fileexperimental_apparatus_2_090317_1.jpg 759 download [Information] filesyren0_out_v.png 751 download [Information] fileresult_090925_1.png 748 download [Information] fileCW_angle.jpg 794 download [Information] fileexperimental_apparatus_1_090116_2.jpg 814 download [Information] fileexperimental_apparatus_1_090116_1.jpg 903 download [Information] filesyren1_out_v.png 750 download [Information] filesyren0_out_v.dat 818 download [Information] fileexperimental_apparatus_1_081028_5.jpg 784 download [Information] fileresult_090924_1.dat 897 download [Information] fileresult_090925_1.dat 777 download [Information] fileexp_result_090624.png 814 download [Information] fileoutline.jpg 808 download [Information] fileexperimental_apparatus_2_090309.jpg 824 download [Information] fileexperimental_apparatus_1_081028_3.jpg 805 download [Information] fileCCW_rate_081211.jpg 808 download [Information]