エネルギー変換効率の良い６自由度柔軟関節肩義手（SDP，ロボットアーム 1.45kg）の顔面方位制御
システム用肩部２自由度位置検出センサの開発
木下 敏治*

大東 賢治**

山口 彰大***

安藤 誠基****

香川 優介*****Development of 2 degrees of freedom shoulder motion sensor for energy-saving model flexible
joint shoulder disarticulation prosthesis (SDP, robot arm 1.45kg) with 6 degrees of freedom using
Face Direction Control system
Toshiharu KINOSHITA, Kenji OHIGASHI, Shota YAMAGUCHI, Masaki ANDO,
and Yusuke KAGAWA

Abstract
A practical control system was proposed by us and was called ”the Face Direction Control
System: FDCS”. (The hand part of the prosthesis is controlled to be always restricted on theimaginary eyes existing behind the real eyes.) The Shoulder Motion Transducer is fixed tothe body, and the point P is attached to the shoulder. Forward and backward motion of theshoulderδ2 or δ4 is converted to the rotation of the potentiometer P1 through the horizontal
displacement of the point P. Consequently, two-dimensional shoulder motion is converted
into two voltages of P1 and P2 potentiometers. Motion sensor of IMU-Z (ZMP Co.) is able toactually use as detections sensor. The sensor using Potentiometers (LP-100F-C) durability
Midori Precisions Co., Ltd. is made. It is confirmed to be able to detect the movement of thesensor by the voltage change of GL900. Next, the sensor and the SDP (robot arm) areconnected by RCB-4HV (KONDO KAGAKU Co.), and the SDP (robot arm) which isoperated by the shoulder movement of two degree of freedom. Moreover, the movement of
the shoulder can be detected by installing IMU-Z.

Keywords: flexible joint prosthesis, SDP, robot arm 1.45kg, the Face Direction Control System,
Motion sensor of IMU-Z

全国 18 歳以上の身体障害者数（在宅）は，348 万

1．序論

3000 人（平成 18 年 7 月度）と推計されており，そ1.1 研究の背景*の中で肢体不自由者は全体の 50.5％を占めている。

香川高等専門学校詫間キャンパス
電子システム工学科**
大岡技研株式会社***
三菱電機株式会社通信機製作所****
富士重工業株式会社*****
扶桑建設工業株式会社

また前回調査（平成 13 年 6 月度）と比較しても，肢体不自由者は 0.6％増と年々増加傾向となっている。肢体不自由者のための義手，義足の中で，肩義
手は前腕義手などの他の義手，義足に比べて開発が167

香川高等専門学校研究紀要 2(2011)

遅れている。その中で電動式前腕義手は，手の開閉θ1 から順に設定していく効率の良い通信方式であの制御に筋電を利用して操作する方式で実用化される。本研究は現在の制御理論（有本卓，新版ロボッているが，一方で電動式肩義手は実用化が遅れていトの力学と制御，朝倉書店，p96-99，(2002)）ではる。肩義手 1)~5)は手先まで含めると自由度が非常に安定な制御が非常に難しいとされている柔軟関節構多いため制御が複雑になり多自由度になればそれだ

造を肩の部分に持つ 6 自由度肩義手である。エネル

け駆動させるアクチュエータの数が増え，重量が重

ギー吸収ボックスと名付けたアルミニウムで出来たくなる。そのため電動式肩義手の実用化には，軽量入れ物にアクチュエータをぴったりとネジ止めする

かつ安価であることや外観，耐久性が高いことが重ことにより一平面内での振動モードは存在できるが要である。

それ以外の振動モードはエネルギー吸収ボックスのゆがみにより熱エネルギーとして刻々と放出されるように設計してある。以上の工夫により，上腕水平回転角θ1・上腕挙上角θ2 の 2 自由度にエネルギー
吸収ボックスを用いることにより，非常に安定した動作を本体重量 1450g で実現した。研究紀要にこのアイデアを追実験して貰うためあらゆるデータを公開し，研究成果を積み上げることにより本方式が肩義手だけでなくあらゆるロボットに適用できることを示した。図 4 に手先部に使用予定の佐藤技研の装飾用グローブとソケットの外観を示す。

図 1．義手の概要図

図 2．義手の全体図

本研究では，日常生活においてスプーンでものを食べる，コップで水を飲む等の食事動作，鉛筆を握る，電話に出る等の机上動作，顔を洗う，歯を磨く等の洗面動作，手を洗う，髪をとく等の衛生動作を実現することを目的として肩義手を試作した。今回の試作機はより軽量で高トルクになったシリアル

図 3． シリアル制御方式を用いたシステム構造

RC サーボモータ KRS-6003HV（電源電圧 11.1V，（数珠つなぎ）

トルク 67kg･cm，重量 100g）をアクチュエータに用い，トルクをあまり要求されない手の開閉部分にはKRS-2552HV（電源電圧11.1V，
トルク14kg･cm，
重量 41.5g）を用いる。図 1 に義手の概要図を，図2 に製作した電動式肩義手の全体図を示す。システ
ムの構成は，パソコン，電源，近藤科学製のロボッ
トコントロールボード（モーションプロセッサ 2・MP2），そして RC サーボモータ 7 個である。7 個のモータを同時に制御し，500g のものを安定に移動できた。
本研究で使用したシリアル RC サーボモータは，
図 4． 佐藤技研の装飾用グローブとソケット

入力信号と電源のみで動作する。ただ，これまでと違い，シリアルサーボモータを肩義手に使用したので数珠つなぎという方法を利用した。数珠つなぎは

柔軟関節肩義手の制御という今までにない方式

シリアル RC サーボモータの最大の特徴で，図 3 のを音響工学の最新理論（B&W，FST（フィクスト，ようにポートを 2 個使用するようにし，一つのポー

サスペンション，トランデューサー）コーンからエトに ID1,2,3,4 と，もう片方のポートに ID1,2,3 とッジは伝わる屈曲波を熱エネルギーに変換する）を168木下敏治 他 : エネルギー変換効率の良い６自由度柔軟関節肩義手（SDP，ロボットアーム 1.45kg）の顔面方位制御システム用肩部２自由度位置検出センサの開発

用いて肩義手の実用化に近づく 1 つの方法を見つけ出すことが出来た。今年度は 100g で 67 kg･cm の本研究の目的はポテンショメータや IMU-Z を使

トルクを持つ KRS-6003HV という近藤科学の RC

用した 6 自由度肩義手の 2 自由度位置検出用センサ

サーボモータ(2009 年に発売)を用いて木下研究室の開発である。まず，前年度に製作できなかった

は実用型の肩義手を試作した。BMI（ブレーン・マ

LM-2900N を用いた差動増幅回路を用いた増幅器

シン・インターフェース）（横井著，サイボーグ(BMI/を製作し，ポテンショメータを用いた検出器に接続BMC)日本ロボット学会誌 vol.26 No.7 p14-p15 (20する。次に，基礎実験として回路がセンサに必要な08)）を用いた脳信号の正確な読み取りとともに，そ特性が得られているかを測定する。その後，肩センれを正確な動きにつなげることを目標に脳波と近赤サを用いて動作実験を行う。

外線で血流を測ることにより義手を制御しようとす

また，本年度に導入された ZMP 社の IMU-Z を使る研究が始まっているが上記ロボット学会誌による用し，基礎的な動作確認と今後の課題について検討と実用化は 2040 年と予想されている。また，米国する。

では手足が不自由な脊髄損傷の患者の脳に手術で電2.2 顔面方位制御方式の原理

極を埋め込み，検出信号で義手やコンピュータを動かす臨床試験が行われている。この方法は，手術による感染のおそれがある。木下研究室では安全性を考慮し，独創的な顔面方位制御方式を提案している。
肩離断患者には上肢がなく，上肢系のうち肩，頭及び両目のみが残っているが，患者の意識の中には切断前の幻肢が存在していることが知られている。連続位置制御が可能な信号として頭と肩の動きを採用した。この信号はまた，運動の滑らかさを習得する
学習過程に決定的役割を果たす固有受容の条件をも満たしている。本研究の目的は，人間の意志と直結
した頭と肩の運動を，義手制御用の情報として利用
し，それらを用いて 6 自由度肩義手の顔面方位制御システムを実用化することである。本方式を産業用ロボットへ応用すればエネルギー問題の画期的な解決法となる。
1.2 研究の目標

図 5． 上肢系の数学モデル

本研究の中で自分は肩の位置検出センサの製作を担当した。昨年度の研究で製作されたセンサのうO : 実際の目の位置

ち，直線形ポテンショメータをスライドさせると途O’ : 目の仮想位置

中で抵抗がありスムーズに動かなかった。

S : 肩関節の中心E : 肘関節の中心

そこで今回は，ベアリングが内蔵されシャフトが太い緑測器のポテンショメータ LP-100F-C を用い

L1 : 上腕の長さて耐久性の高い 2 自由度位置検出センサを製作する

L2 : 前腕の長さ

ことと，今年度新たに導入された ZMP 社の e-nuvo

L3 : 肩から頭の中心線までの長さ

IMU-Z が肩の位置検出センサとして使用可能であL4 : 肩から目までの長さ

るかを，実験を行い検討する。

L5 : 目から仮想の目までの長さ

2．本論

θ2 : 上腕挙上角θ1 : 上腕水平回転角
θ3 : 上腕回旋角
θ4 : 肘屈曲角

2.1 研究計画169香川高等専門学校研究紀要 2(2011)θ5 : 前腕回旋角θ6 : 手の開閉角
図 5 に上肢系の数学モデルを示す。
人は大脳内の頭頂葉の大部分を手と腕の動きを実現するために使用しており，脳はそれを記憶している。例えば，赤ちゃんが手を使って食べ物を口に運べるように失敗しながらも最終的には口に運ぶことができるようになる。そしてその感覚を記憶し，
図 6． 8ch ミニデータロガーGL900

繰り返し行うことで自分の体を自分の意思通りに動かせられることができる。これを固有受容という。

図 6 が今回の研究で測定に使用した 8ch ミニデー

そのため腕を失ったとしても無くなったはずの腕をタロガーGL900 である。

動かす感覚，即ち幻肢の感覚が残っている。通常，

この GL900 の 2chXY レコーダー機能を用いてセ腕を上げるときは肩も上に動き，下げるときは肩もンサの波形測定を行った。

下がる。左右の場合も同じである。それは健常者だ
けでなく，腕を失った人も幻肢を動かそうとして肩も一緒に動いてしまう。この動き(残った鎖骨の動外形寸法

232×150.1×80mmき)と頭部の動きを用いることで視点の位置に義手
質量の手先を移動させる。このような考え方を拡張固有受容という。

アナログ端子数

顔面方位制御とは前述の拡張固有受容より，人は手

8 チャネル
トリガ入力 1ch・ロジッを動かす時に視線は手先の目標を見ているという点
外部入出力に注目して顔の方向と視線を一次近似式で表し手先

ク入力 4ch パルス入力
4ch・アラーム出力 4ch

を視線の直線状に拘束する制御方式である。
両肩の動きで θ3～θ6 が動くようにする場合，

1  K13

1.1kg

イーサネットPC 接続

2  K24  K3

i2  Cii di (i 1～4)
i 1 3  C11 d1
i  2 4  C22 d2
i  3 5  C33 d3
i  4 6  C44  d4

(10BASE-T/
100BASE-TX) USB 標
準装備
内蔵 RAM：100 万デー
タ点／内蔵フラッシュメ

内蔵記憶装置

モリ：約 256MB
USB メモリスロット標

i=1（右肩の上下で上腕の回旋角を制御）

準装備

i=2（右肩の前後で肘の屈曲角を制御）

10μs MAX (内蔵 RAM

i=3（左肩の前後で前腕の回旋角を制御）

収録時)

i=4（左肩の上下で手先の回旋角を制御）
制御動作を求める式

サンプリング間隔

10/20/50/100/200/500μs/1/2/5/10/20/50/100/200/
500ms

上式に代入すれば，両肩の動きで θ3～θ6 が求ま/1/2/5/10/20/30sec

るので，これらの値からニュートンラプソン法を用

表 1． GL900 の仕様

いて視線の方向に手先を拘束するように θ1，θ2 を求め，その値に従って肩義手が動くようにする。

2.4 回路の製作
2.3 測定機器
ポテンショメータは負荷を接続すると誤差を生170木下敏治 他 : エネルギー変換効率の良い６自由度柔軟関節肩義手（SDP，ロボットアーム 1.45kg）の顔面方位制御システム用肩部２自由度位置検出センサの開発

じるため，基礎実験の前にポテンショメータの誤差を少なくし，電圧を増幅させる回路を設計・製作した。
2.4.1. 本研究の回路
まず，ボルテージフォロア回路により入力抵抗を大きくして検出器であるポテンショメータの負荷効
果による影響を小さくする。誤差の小さくなった信号を差動増幅回路によって電圧を増幅し A/D 変換
図 9． LM2900 の内部構造器に出力する。バイアス電源は，ポテンショメータの取り付け位置の微妙な変化により基準電圧が変化したときに電圧を調整するために入れている。

図 10． 使用した LM2900
図 7． 回路図
入力の最大電圧は単電源の時 0V～32V，両電源の時 ±16V で，使用温度範囲は－40～85℃である。
初めは LM2900 と使用温度範囲以外は同じで温度範囲が0～70℃のLM3900というオペアンプを使用していたが，義手に使用することを考えると使用温度範囲の広い LM2900 の方が実用的であると考え変更した。
2.4.2. 回路の測定製作した回路に 0.5V，10Hz の正弦波を入力してGL900 で出力波形を測定する。ポテンショメータの図 8． 製作した回路

出力は直流だが高速で動作した時は電圧の変化が急になるため，追従できなければ正確な位置検出が出

図 7 が設計した回路で図 8 が実際に製作した回路

来ない可能性がある。そこで 10Hz の正弦波を入力の写真である。

して回路の追従性を調べる。
測定方法

ここで，回路で使用したオペアンプを説明する。

回路の波形の測定は GL900 の時間軸表示を使用

使用したオペアンプはテキサスインスツルメン

して行う。時間軸表示は GL900 の立ち上げ時に自ツの LM2900 という製品である。

動的に表示されるので，そこから波形観測に最適な

このオペアンプは 7 番ピンをグランドにつなぐと状態に設定する。

単電源，マイナス電圧を加えると両電源として使用
できる。

171

香川高等専門学校研究紀要 2(2011)

図 13． LP-100F-P

図 11． GL900 の時間軸表示
まず，上にある設定ボタンで設定画面を表示して電圧レンジを変更する。波形を保存するときはファ
図 14． LP-100F-C

イルボタンの「画面をコピー」というコマンドで保
存できる。
測定結果

LP-100F-

LP-100P

F-C

L [mm]

130±1

138±1

φD1[mm]

φ12

φD2[mm]

φ3.0

φ5.0

機械的ストローク[mm]

102±1

103±1

電気的ストローク[mm]100±0.5回路の波形の測定は GL900 の時間軸表示を使用して行う。時間軸表示は GL900 の立ち上げ時に自動的に表示されるので，そこから波形観測に最適な寸法

状態に設定する。

図 12． 回路の出力波形

質量[g]

約 40

直線性[%]±1

φ22.2±
0.3

100±0.
5
約
110
±0.1

表 2． ポテンショメータの比較

図 12 を見ると，可変抵抗によって出力が増幅されていることがわかる。マイナス側が出力されていまた，回転形ポテンショメータは昨年と同じ

ないのは単電源で使用しているためだと思われる。

CP-2FB を使用した。

実際にはマイナスの電圧は必要ではないので，この回路を使用する。
2.5 センサの改良
昨年の位置検出用センサのうち，直線形ポテンシ
ョメータを伸縮させると，所々で抵抗がありスムー
ズではなかった。
そこで以前より重量は増加するが，図 15． CP-2FB

シャフトが太く，可動部にベアリングが内蔵されている LP-100F-C を使用したセンサの製作を行った。

172

木下敏治 他 : エネルギー変換効率の良い６自由度柔軟関節肩義手（SDP，ロボットアーム 1.45kg）の顔面方位制御システム用肩部２自由度位置検出センサの開発

有効電気角[°]

340°±3機械角[°]

360° エンドレス

質量[g]

約 20

直線性[%]±1

表 3． CP-2FB の仕様
そして製作し，実際に使用したセンサを下に示す。
図 19． 取り付け部
2.5.1. 基礎実験①
製作したセンサが実際に使用できるかどうかを確かめるため，二種類の基礎実験を行った。
一つ目はセンサを構成している二つのポテンショメ
ータの線形性を測定する実験である。

図 16． 製作したセンサ

図 20． 直線形ポテンショメータの測定

図 17． 増幅器を組み付けたセンサ
回転形ポテンショメータの取り付け部分を完全に固定させず，サーボモータ用の部品を流用して半固定させることで容易に基準位置を変えられるよう改良を行った。
図 21． 回転形ポテンショメータの測定
直線型ポテンショメータの測定はシリンダーバ
ーの先端を 5mm ずつ伸ばしていき測定し，回転式
ポテンショメータは0°から180°まで10°ずつ回転させて測定した。実験机の上に方眼紙で直線型ポテン
ショメータの移動距離が真上から見た時何 cm 移動
したか分かるように工夫して実験をした。また，回転式ポテンショメータの基礎データを得るために

図 18． スティアホーン

180°の分度器を拡大コピーし，同じ大きさの図を逆方向に貼り付けて 360°に対する測定データが得ら173香川高等専門学校研究紀要 2(2011)

れるようにした。
2.5.2. 基礎実験②
測定結果

ポテンショメータの動作が確認できたので動作実験を行った。
縦横 1cm 間隔で縦横＋3～－3 まで書いた点を 1

直線型ポテンショメータ

直線に 1 本ずつ手でなぞって測定した。方向が正確にわかるようにポテンショメータの先端に針金を付けている。

図 24． 動作実験
XY レコーダーの操作方法
図 22． 直線型ポテンショメータの電圧特性グラフを見ると，シリンダーバーの長さと電圧が直線的に変化しているため，このポテンショメータ
は実際に使用できることが分かる。
回転式ポテンショメータ

図 25． GL900 XY 表示への切り換え
画面右下の波形切り替えのチェックで X-Y 表示
を選ぶと画面が XY 表示に切り替わる。

図 23． 回転式ポテンショメータの電圧特性
こちらも直線的に増加しているため，このポテン
図 26． GL900 XY 表示

ショメータは実際に使用できることが分かる。

174

木下敏治 他 : エネルギー変換効率の良い６自由度柔軟関節肩義手（SDP，ロボットアーム 1.45kg）の顔面方位制御システム用肩部２自由度位置検出センサの開発

はじめに波形選択で回転式センサのチャンネル
が X 軸に，直線型のチャンネルが Y 軸になるように設定する。そして表示の移動，表示の拡大縮小で波形が測定したい範囲に収まるように調整する。XY
表示の波形はペンダウン状態のときのみ記録される。
ペンアップ・ペンダウンのボタンが青色のときはペンダウン状態で波形が記録される。波形の保存の方
図 29． DM-330MV

法は時間軸表示と同じである。
測定結果【ボードサイズ】
・サイズ：35×45×12mm
・重さ：11.8g
・使用電圧：6～15V 内部電圧：5V【スペック】
・CPU：ルネサステクノロジ製 M16C26A
・CLOCK：20MHz【ペリフェラル】
・SIO：8 ポート(2 系統×4)
・AD：10(基準電圧 5V)(5msec)
図 27． 測定結果

・PIO：10(5V)・EEPROM：256KB

図 27 において縦軸が直線型ポテンショメータの・COM：8 ポート(115200，625k，1.25Mbps)

出力，横軸が回転式ポテンショメータの出力である。

・SW：1 ポート

なぞった線に近い出力波形が測定され，これは写像

・LED：2(赤，緑)の関係図を表わしている。このことから，製作した【端子】

センサは位置検出装置として使用可能であると考え・電源端子：1られる。

・RESET：1
・TP ポート：1

2.6 センサとサーボモータの接続【その他】
・最大電流：1A(レギュレーター電流。
500mA 以下推奨)

センサとサーボモータの接続には近藤科学社のコントロールボード「RCB-4HV」とソフトウェア「HeartToHeart4」を使用した。またボードの電源接続方法は，① Vcc・GND 端子を DM-330MV(DC5～15V，32A)の OUTPUT に接続② COM ポートを PC に接続③ AD ポートにセンサを接続（本実験では直線形を AD1，回転形を AD2 に接続）
④ SIO ポートにサーボモータを接続する。（義手は数珠つなぎで配線しているため，SIO1と SIO5 に 1 本ずつ接続した）
以上の通りである。
今回 PIO ポートは使用しないが，このポートは0V(LOW)・5V(HIGH)を出力することができ，LEDの発光などに使用できる。

にはアルインコ製の DM-330MV を使用している。
以下に仕様を示す

図 28． RCB-4HV

175

香川高等専門学校研究紀要 2(2011)

2.6.1. HeartToHeart4 について

図 31． アナログミキシングの設定画面

次に HeartToHeart4 について説明する。本来このソフトは二足歩行ロボット KHR-3HV を制御す⑨るもので，サーボモータに対し多くの設定機能があ⑩る。しかし今回は，その内のアナログミキシング機
能を使用したのでそれについてのみ説明を行う。

①
②
③
④
⑤

C:¥ProgramFiles¥HeartToHeart4¥Heart
ToHeart4.exe を起動する。
赤丸の所のコンボボックスでボードを接続
したポートを指定する(COM3 or COM4)。
ファイル – 新規作成 – プロジェクトで任意の名前のプロジェクトを作成。
C:¥ProgramFiles¥HeartToHeart4¥Heart
ToHeart4.exe を起動する。
赤丸の所のコンボボックスでボードを接続
したポートを指定する(COM3 or COM4)。

⑪
⑫
⑬
⑭

サーボモータの初期設定欄で設定を行うサーボモータの ID を指定
ミキシング欄右上の Sync ボタンを押しボー
ドとの同期を開始
MIX1 のソースコンボボックスでセンサを接続している AD ポートを指定する。
実測値を見ながら基準値をキャプチャボタ
ンで設定し，倍率を任意の値に指定する。
Sync ボタンをもう一度押しボードとの同期を終了し，プロジェクトファイルを保存。
RAM ボタンを押し ROM へ書き出して，再起動する。

2.6.1. 動作実験

図 30． HeartToHeart4 の TOP 画面⑥⑦⑧

赤丸の所のコンボボックスでボードを接続
したポートを指定する(COM3 or COM4)。
ファイル – 新規作成 – プロジェクトで任意の名前のプロジェクトを作成。
プロジェクトタブのプロジェクトの設定を選択し，設定ウィンドウを表示させる。

図 32． 取り付け例
センサは図 32 のように脇の下に取り付ける。

肩を上下に動かすと直線形が，前後に動かすこと
で回転形が可動し肩の動きを電圧の変化として検出する。また，先ほど説明した HeartToHeart4 のア
ナログミキシング機能の倍率調整で出力電圧を増幅できることと，センサとボード間に回路を組み込んで実際に実験を行った。その時の入力波形と出力波
形をミニデーターロガーGL900 で測定した。また，回路を外して同様の実験をした。その結果，回路を使用することによりノイズが混入するしていた為，製作した増幅回路は使用しなかった。
次に，実際に義手をセンサによって動作させる。

176

木下敏治 他 : エネルギー変換効率の良い６自由度柔軟関節肩義手（SDP，ロボットアーム 1.45kg）の顔面方位制御システム用肩部２自由度位置検出センサの開発

今回はセンサの動きを分かりやすくするため，体に図 34 のように肩を上下に動かすと上腕を位置制御は装着せず撮影している。動画の一瞬を写真データ出来ることを確認した。

として下図のようにまとめた。図 33 の実験では肩を前に出すと肘が曲がるように設定してある。
また，

図 33． 肩(センサ)を前後に動かしたとき

図 34． 肩(センサ)を上下に動かしたとき
以上のようにセンサの動きによって義手を動作させることに成功した。しかし，新たな問題も発生した。体に取り付けた時に小さな動きも感知してしまい上手く義手を操作できないということである。
これについては増幅度などのパラメータやポテンシ
ョメータを変更することにより問題は解決される。
2.7

IMU-Z とは本年度，研究室に ZMP 社の e-nuvo IMU-Z というセンサが導入された。このセンサは軽量で小型なため，使用できれば装着者の負担が減るだろう。
以下に詳細を示す。

図 35． IMU-Z の外観

177

香川高等専門学校研究紀要 2(2011)

表 4 に示すように IMU-Z を使えば角速度，加速度，地磁気が XYZ 方向の 3 種類かつ 9 つのデータ
が 10msec ごとに同時出力できる。図 37CAN-USB（有線）の図を示す。

図 36． IMU-Z の座標軸
特徴
・9 軸センサを 1 つにパッケージ
ジャイロ，加速度，地磁気と，タイプの異なるセンサを 1 パッケージに収めているため それ

図 37． IMU-Z とパソコンの接続図

ぞれの特徴を生かし，組み合わせることが可能
2.7.1. 原理

・小型軽量のモジュール
約 4cm×約 5cm の小型なため，人の手や足，

加速度計測

ロボットや，
そのほかの移動体など さまざまな

STMicroelectronics 社の 3 軸加速度センサ（LIS331

場所にとりつけて使用可能

DHL)を使用。静電容量型加速度センサを用いてい・最大 28 台まで同時利用る。温度変化において特性変化が少なく，量産性に1システムに最大28台のIMU-Zが接続できる。

優れているため，家庭用ゲーム機などにも使用され人の体に多数のセンサをつけ，多くの点の動きている。

を収集したり，群行動をするたくさんの物体な

方位計測

どの計測が可能Honeywell 社の 3 軸地磁気センサ（HMC5843)を使用。 内部には 12 ビットの A/D コンバータを使用。

・Bluetooth による無線接続と，USB による有線接続

原理は，地上における地磁気の方向を北としその方無線により，被験者の動作をしばらず手軽に測向を磁気センサで検出。

定したり， 有線の接続により，電波の環境の厳

角速度計測

しい場所でも信頼性の高い測定が可能。

STMicroelectronics 社の 2 軸角速度センサ（LPR55
0AL,LPY550AL)を使用。センサ内部には質量をも加速度センサ
角速度（ジャ
イロ）
地磁気
通信インターフェイス
サンプリングられている。
弾性体は外部から回転運動を受けると，3軸それに比例したコリオリ力が発生。この力による弾3軸

性体の位置変化は静電容量の変化として観測できる。

Bluetooth

LPR550AL で XY 軸，LPY550AL で Z 軸の角速度

CAN(USB ポート）を測定する。コリオリ力とは回転座標系上で移動し10[msec]～10[sec]10[msec]刻みた際に移動方向と垂直な方向に移動速度に比例したで指定可能大きさで受ける慣性力の一種である。

サイズ

42[mm]×52.5[mm]×20.5[mm]

重量35[g](カバー無し電池無し 10[g])最大接続台数った弾性体がくみこまれていて，電気的に振動させ3軸

2.7.2. 付属アプリケーション
IMU-Z に付属のアプリケーションには，以下のよ

28 台

うなものがある。

表 4． IMU-Z の仕様

3D Viewer178木下敏治 他 : エネルギー変換効率の良い６自由度柔軟関節肩義手（SDP，ロボットアーム 1.45kg）の顔面方位制御システム用肩部２自由度位置検出センサの開発

SimpleCommunicationSample

図 38． 3D Viewer 動作画面

図 40． 実行画面

1 つの IMU-Z のデータをグラフで表示し，同時にIMU-Z から受信したセンサの値を，コンソールに

3D モデルを表示することのできるアプリケーショ

出力ン。グラフは上から加速度・ジャイロ・地磁気を表ImuzSingleCommunicationSample

示している。
Model Draw Application

図 41． 実行画面
図 39． Model Draw Application 動作画面
IMU-Z からの計測データをグラフに表示
ピラミッド型のパーツを組み合わせた上半身モデルを表示する。 身体に IMU-Z を取り付けること

ImuzMultiCommunicationSample

で人の動きと画面上のモデルが同期して動く。
また，接続する IMU-Z の数が 1 つでも，接続・設定した
IMU-Z のノード ID に対応したパーツのみ動く。モデルは 11 個のパーツから構成されており，各パーツのノード番号は以下の通りである。
Node 1：腰 Node 2：胸 Node 3：頭 Node 4：左肩
Node 5：左上腕 Node 6：左下腕 Node 7：左手
Node 8：右肩 Node 9：右上腕 Node 10：右下腕
Node 11：右手
図 42． 実行画面

また，開発用環境の SDK には他にも数種類のサンプルアプリケーションが付属しており，簡単な説

複数のポートを利用して，IMU-Z からの計測デー明を行う。

タをグラフに表示

179

香川高等専門学校研究紀要 2(2011)

図 45． 実行画面
FilterSample
姿勢推定器(PoseEstimator)のサンプル。 3 種類の推定器の結果を同時に表示
2.7.3. PC との接続・設定
次に，IMU-Z と PC との接続・設定，使用方法について説明する。
初期設定① 今回は有線で使用するため図 37 のように
AC アダプタをコンセント，USBCAN アダ
プタを PC へ繋ぐ。
② IMU-Z のNode 番号(Model Draw Applicat
ion の説明を参照)とRole※を設定するので，
IMU-Z のプッシュスイッチを押しながらパワースイッチを ON にする。すると設定モードに切り替わり LED が点滅するので，確認する。
③ C:¥Program Files¥ZMP¥IMU-Z Application and SDK¥ImuzConfigurationTool.
exe を起動し File－Open －コンボボック
ス内の[Lawicel CANUSB]を選択し，開く。
④ Target Node No を[All]にして[Get Status]
ボタンを押すと現在の設定が帰ってくる。
(複数の IMU-Z を接続しているならば，その数だけ)⑤ Target Node No を変更したいセンサの番号にして，Node No に新たに設定するノー
ド番号を入力し，Role も指定する。(今回はUSB 接続かつ右肩に装着するため，NodeNo は 8 で Role は CAN-Slave とする)
⑥ [Save]ボタンを押して設定を送信し，IMU-Z を再起動する。

図 43． 実行画面
フィルタを利用するプログラム。 元データと，フィルタ適用後のデータが グラフにプロットされる
GraphicDrawSample

図 44． 実行画面
ImuzDraw を利用して，3D の空間にオブジェク
トを表示するサンプル。 IMU-Z との通信はせずに単独で表示のみ行う
PoseEstimatorSample

図 46． ③の画面180

木下敏治 他 : エネルギー変換効率の良い６自由度柔軟関節肩義手（SDP，ロボットアーム 1.45kg）の顔面方位制御システム用肩部２自由度位置検出センサの開発

図 48． Port Setting ダイアログ

図 47． ⑤の画面(ノード番号 6⇒8 へ)※) CAN-Slave , SingleBT ,CAN-MasterBT の三つを選択できる。
CAN-Slave：CAN-USB(有線)接続時
SingleBT：Bluetooth(無線)接続時
CAN-MasterBT：Bluetooth－CAN 接続時(PC と一台の IMU-Z が無線接続，それと他の IMU-Z が有線接続)
3DViwer・Model Draw Application① IMU-Z を接続した状態で C:¥Program
Files¥ZMP¥IMU-Z Application and
SDK¥Imuz3DViewer.exe を起動し File－
Port Setting を押すとダイアログが表示されるので接続している方式(ポート番号)を選び，ADD ボタンを押して追加する。
② File－Open を押し，図 49 赤丸の所のコン
ボボックス内のノード番号を初期設定で設定した任意の値にするとセンサのグラ
フ及び 3D モデルが表示される。
補足) その他の操作についてはメニュー項目に以下の機能がある。
Edit－Clear Graph：グラフの消去
Edit－Pause Graph：グラフの一時停止
Tool－IMU-Z Manager：マネージャーダイアログを表示し，レンジや計測間隔値を設定
Tool－Communication Monitor：複数のセンサの値や変化を簡易的に表示する
Estimator－Begin Calibration：場所によって異なる地磁気の大きさの変化を吸収し，データを更正す
る
Estimator－Save Cal Data：上記の構成データを保存し，次回アプリケーション起動時には自動で読み込まれる

図 49． 3DViwer 表示画面
また Model Draw Application については，基本的な操作は同じなので省略する。
2.7.4. 動作実験

図 50． IMU-Z の取り付け例
今回，肩の動きを検出するために ZMP 社の動画を参考にし，IMU-Z を図のように鎖骨の上に装着した。
下に実際に Model Draw Application・3DViewerを動作させた様子を示す。

181

香川高等専門学校研究紀要 2(2011)

図 50． IMU-Z を用いた右肩の前後上下運動の動画の一部
ments¥avidemux_2.5.4_win32¥avidemux2.exe)
を使用している。

なお，アプリケーション動画の撮影・編集にはカハマルカの瞳(C:¥Documents and Settings¥卒研¥My Documents¥ojos3_3¥ojos.exe)と AVIDEMU
X2(C:¥Documents and Settings¥卒研¥My Docu

3．結論

182

木下敏治 他 : エネルギー変換効率の良い６自由度柔軟関節肩義手（SDP，ロボットアーム 1.45kg）の顔面方位制御システム用肩部２自由度位置検出センサの開発

3.1 成果の点についても改善を行いたい。
IMU-Z が肩のセンサとして使用できることは判

今回の実験で 2 自由度位置検出センサの電圧変化

ったが，義手と接続し動作させるところまではでき

によって義手を動作させられたので，センサの製作なかった。そこで，今後は図 51 に示すようなシスに成功した。耐久性に関しては，ポテンショメータ

テムを開発することが課題となる。頭と両肩にモーは 500 万回転以上耐えられ，スムーズに可変していションセンサ IMU-Z（現在 3 次元方位角のセンサーるので問題ない。

を除いた重量が3g のUSB ケーブルを用いた有線に

IMU-Z に関しては，肩の動きを検出できたので肩よるセンサ IMU-Z lite が販売されている）をノート
パソコンの USB 端子に入力する。また，肩義手のの位置検出センサとして使用可能である。

各関節角度の値を IMU-Z やより小型な IMU-Z lite
を USB ケーブルでノートパソコンに入力する。C#を利用して顔面方位制御アルゴリズムをプログラミ

3.2 課題

ングして，目標値を求めソフトウエアサーボプログ
今回の実験で発生した問題は，アナログミキシン

ラムを開発して定常偏差を 0 に出来る新しい目標値

グ機能によってポテンショメータの出力を増幅したを求める。USB ケーブルにシリアル USB 変換アダため小さな振動も感知してしまい手先が振動するとプター付きケーブルを用いてシリアル制御が可能ないうことである。これを改善するためには，倍率を近藤化学の RCB-4HV（シリアルサーボコントロー

下げればいい。しかし倍率を下げてしまうと肩を動ルボード）に接続する。数珠つなぎで 6 自由度柔軟

かした時に義手があまり動かなくなってしまう。そ関節肩義手（ロボットアーム）のシリアル RC サー

こで，動作範囲の少ないポテンショメータを使用でボモータ KRS-6003HV などに接続する。リハビリ

きれば倍率を下げられるだろう。
（現在使用しているで患者さんの楽な頭と肩の動きで顔面方位制御シス

ポテンショメータは 0～10cm で 0～5V，0～360°

テムが完成できるよう 2.2 で示した式の K1，K2，

で 0～5V の可変量。しかし実際に可動する範囲は 0

K3，Ci(1~4)，di(1~4)を決定する。リハビリを繰り返し～3cm，0～90°程度。そこで，0～3cm で 0～5V，ながら最終的なパラメータを最終決定し実用化を実0～90°で 0～5V の可変量のポテンショメータを使現する。コンピュータに使用されている集積回路の用できれば倍率を下げられる。
）また，今回センサの容量が毎年向上している為，現在のノートパソコン

先端を脇の下にマジックテープを使用して固定したに相当する能力の制御用ボードは将来小型軽量化がが，肩を動かすうちに外れることが多々あった。こ可能であると予想される。

図 51． 今後開発する予定のシステム全体関連図

183

香川高等専門学校研究紀要 2(2011)

4．謝辞
本研究にあたり，熱心に指導していただいた近藤
化学株式会社，ZMP 株式会社の技術部門の方々に感謝します。また，研究に必要な機材を開発して下さった，
株式会社緑測器，
グラフィテック株式会社，
テキサスインスツルメンツ，近藤化学株式会社，株
式会社 ZMP の方々に深く感謝致します。電動義手研究の恩師徳島大学工学部電子工学科故原田尚文教授に深謝します。また，初代詫間電波高専故石黒美
種校長先生の励ましに感謝します。卒業研究として
木下研究室で努力してくれた全ての卒業生に感謝します。
5．参考文献1) 木下敏治 他：“肩の 2 自由度に柔軟関節を用いた 6 自由度柔軟関節肩義手のモーションプロセ
ッサ2HVを使用した顔面方位制御システムの開発”，
香川高等専門学校研究紀要第 1 号，p.113-1
30 (2010)
2) 木下敏治 他：“高トルクなシリアル RC サーボ
モータを用いた 6 自由度柔軟関節肩義手の協調動作制御システム” ，香川高等専門学校研究紀要
第 1 号，p.130-138(2010)3) 臼井良：“ポテンショメータを用いた 6 自由度肩義手用肩部 2 自由度位置検出センサの開発”，平成 20 年度電子工学科特別研究論文,(2009)4) 松本和樹：“ポテンショメータを用いた 6 自由度
肩義手用肩部 2 自由度位置検出用センサの開発”，
平成 21 年度電子工学科特別研究論文,(1983)
5) 山口彰大：“高トルクなシリアル RC サーボモータを用いた 6 自由度柔軟関節肩義手の協調動作制御システム”， 平成 22 年度専攻科特別研究論
文, (2011)
6) 株式会社 緑測器：PRECISION POTENTIOMETERS (2009)7) テキサスインスツルメンツ：LM2900/LM3900
取扱説明書
8) グラフィテック株式会社：GL900 マニュアル(2009)
9) 近藤化学株式会社：Heart to Heart4 for User’s
Manual (2010)
10) 株式会社 ZMP：IMU-Z Manual (2010)

184