平成 29 年度 卒業研究論文

慣性センサによる動作測定装置の開発

平成 30 年 2 月 14 日
指導教員

福永道彦

准教授

大分大学工学部
機械・エネルギーシステム工学科エネルギーコース

学籍番号 1451010
井上祐輔

目次
1. 序論
2.姿勢計測法
2.1. 3 次元角度推定
2.2.静止時にドリフト誤差を補正する測定方法
2.3. Madwick フィルタを用いる方法
3.実験方法
3.1.計測システム
3.2.膝関節モデルとの比較
3.3.立ち上がり動作での計測
3.4.歩行動作での計測
4.実験結果と考察
4.1.膝関節モデルとの比較結果
4.2.立ち上がり動作での計測結果
4.3.歩行動作での計測結果
5.結論
参考文献
図1

1．序論
慣性センサ（ジャイロセンサ，加速度センサ）は，MEMS（Micro Electro Mechanical Systems）技術により著しく小型化，低価格化が進んでいる．また，身体部位に取り付けることにより，身体部位の姿勢を簡易に計測可能である事から，スポーツ工学，医療工学分野等において，慣性センサを用いた運動計測法が提案されている．現在，身体運動計測においては，主にディジタルビデオカメラや高速度カメラから得られる映像情報から 3 次元位置座標を算出する DLT（Direct Linear Transformation）法が用いられている．しかし，DLT 法を用いた運動計測はシステムが高価かつ大規模であり，専用の計測場所が必要である．一方，慣性センサを用いた方法は，低コストであり，簡易かつ計測場所に制限されない計測が可能である．慣性センサから得られる計測情報は，加速度や角速度であり，身体運動計測において重要な情報である姿勢情報は，角速度の積分計算や重力加速度からの変換によって得ることができる[1]．
しかし，ジャイロセンサから得られる角速度には微小な誤差が存在し，積分計算をすることで，その誤差が蓄積してしまうことから，ジャイロセンサのみでは長時間の運動計測ができない．また，角速度を積分して得られた角度は 3 次元姿勢を表すために必要となる
ロール・ピッチ・ヨー角やオイラー角とは異なるものであり，回転順序依存性があるため，正確な姿勢測定ができない．更に，ジャイロセンサのみでは計測開始時の姿勢情報を得ることができない為，あらかじめ初期姿勢を計測しておかなければならない等の短所がある．
これは，ドリフトによる誤差の影響や初期姿勢の問題が解決されれば姿勢計測に幅広く利用できる．また，関節角度に加えて，床反力を測定し入力値とすることで，筋骨格系をモデル化して関節および筋にかかる負担を推定することができる．従って，身体運動の解析においては，関節角度等の姿勢情報を得ることは重要であるため，慣性センサから正確な姿勢情報を得る方法の構築が必要である[2]．
ジャイロセンサのドリフトによる誤差を修正するための方法として，角速度センサ，加速度センサ，地磁気センサを用いて補正するセンサフュージョンが提案されており，3 軸ジャイロセンサ，3 軸加速度センサ，3 軸地磁気センサからロール・ピッチ・ヨー角を推定するアルゴリズム等が提案されている．これらの方法は，ジャイロセンサのドリフト誤差を補正した姿勢情報を推定することができる．また，通常の回転行列と違いシンバルロックが起きないクォータニオンを使った推定方法も提案されている．これらの方法で正確な姿勢情報が得られれば，無線 LAN などを通じてディスプレイ付の PC にデータを送信し，リアルタイムで姿勢情報を可視化することができる．更に，測定場所に限定されない動作解析が可能になり，普段の生活の中での姿勢解析が可能となる．
本研究では，測定場所に限定されない姿勢情報の計測を可能にすることを目的とし，加速度，磁気，角速度のセンサフュージョンの方法の検討を行った．本研究では，動作していないときは加速度と磁気から姿勢情報を推定し，動作中は角速度から姿勢情報を推定する方法．常に，加速度，磁気，角速度の 3 つの情報から推定する方法の 2 通りのセンサフュージョンの方法を提案する．これらの 2 つの方法を用い，膝関節の屈曲，内外反，回旋を推定し，精度を比較することで有用性を検討した．

22．姿勢計測法
2．1
3 次元角度推定
身体動作を測定することは，関節の角度を測定することと同義である．関節角度は，その関節が繋いでいるセグメントの相対姿勢を表現したものである．たとえば膝関節であれば，大腿骨と脛骨の相対姿勢が屈曲角度，内外旋角度，内外反角度で表現される．
ただし，これらの角度の表現は臨床的，解剖学的なものであり，必ずしもオイラー角表示のような数学的厳密さを有さない．そこで Grood らは，数学的厳密さと臨床的分かりやすさを両立した関節座標系を提案した．本研究の結果も関節座標系に従って表すため，本節では大腿骨と脛骨の相対位置から関節角度を算出する方法について記述する．
まず，関節角度の算出には，大腿骨と脛骨それぞれのセグメントに固定されたローカル座標系の基底ベクトルが必要である．図 1 のように大腿骨，脛骨のローカル座標系をそれぞれ，XYZ，xyz で決定する．わかりやすくするために，XYZ 軸の単位ベクトルをそれぞれ IJK，xyz 軸の単位ベクトルをそれぞれ ijk とする．また，このとき𝐞は単位ベクトルを意味し，𝐞𝟏（大腿骨の外側ベクトル），𝐞𝟐（大腿骨，脛骨の双方に垂直なベクトル），𝐞𝟑（脛骨の上方向ベクトル），𝐞′𝟏 (大腿骨の前方向ベクトル)，𝐞′𝟑（脛骨の前方向ベクトル）とする[3]．
表 1 関節座標系の人間の膝への適応
大腿骨の軸（屈曲）𝐞𝟏 = 𝐈𝐞′𝟏 = 𝐉
脛骨の軸（脛骨の回旋）
𝐞𝟑 = 𝐤𝐞′𝟑 = 𝐣
浮動軸 F
𝐞𝟐 = 𝐞𝟑 × 𝐞𝟏 /|𝐞𝟑 × 𝐞𝟏 |
ただし，右側に向けられたベクトルを i，I，前方に向けられたベクトルを j，J とする．
表 2 臨床回転
α＝Flexion
sinα = −𝐞𝟐 ∙ 𝐊
πβ＝ {π2+ Adduction，right knee

cosβ = 𝐈 ∙ 𝐊− Adduction，left knee
2γ＝External rotation

sinγ = {−𝐞𝟐 ∙ 𝐢，right knee𝐞𝟐 ∙ 𝐢，left knee

大腿骨と脛骨の相対的な関係が図 2 に示されている．また，表 1，2 は臨床回転を定義する際に使用される記号規則をまとめたものである．屈曲運動は大腿固定軸の周りに起こり，回旋運動は脛骨の固定軸周りに起こる．浮動軸周りには内外反運動が発生する．屈曲および脛骨の回旋は，各骨の浮動軸と固定軸との間に形成される角度である．したがって，次の 2 つの関係が示される．
cosα = 𝐞′𝟏 ∙ 𝐞𝟐 = 𝐉 ∙ 𝐞𝟐
α = flexion（2.1-1）′cosγ = 𝐞𝟑 ∙ 𝐞𝟐 = 𝐣 ∙ 𝐞𝟐
γ = tibial rotation（2.1-2）
また，cos(α) = cos(−α)なので，αとγの大きさは符号に関係なく大きさを求めることになり，符号を求めるために次の関係式を用いる．

3

π𝐞𝟐 ∙ 𝐊 = cos ( 2 + α) = − sin α（2.1-3）πcos ( 2 + γ) = −sinγ， right knee𝐞𝟐 ∙ 𝐢 = {πcos ( 2 − γ) = sinγ，left knee

（2.1-4）式（2.1-4）の符号は任意に決められるものであり，脛骨の回旋は外旋，内旋共に正の角度となる．内外反の大きさは大腿骨と脛骨の固定軸間の角度βから次の関係があることがわかる．
cosβ = 𝐈 ∙ 𝐊πβ − ，right knee
Adduction＝ { π 2− β，left knee2（2.1-5）式(2.1-3)，（2.1-4），（2.1-5）を用いて左足の屈曲，内外反，回旋を求める．
Flexion = sin−1 (−𝐞𝟐 ∙ 𝐊)
（2.1-6）πAdduction = 2 − cos−1 (𝐈 ∙ 𝐊)

（2.1-7）External rotation = sin−1(𝐞𝟐 ∙ 𝐢)
（2.1-8）以上のように，大腿，脛骨に固定された基底ベクトルが既知であれば，関節角度を算出することができる．以下の節で，これらの基底ベクトルを測定する方法を 2 通り説明す
る．
2．2 静止時にドリフト誤差を補正する測定方法
本節では，身体静止時には加速度と磁気の向きを用いてセグメント姿勢を算出し，身体動作時には角速度の積分によってセグメント動作の追跡をする．また，動作が止まったときに改めて加速度と磁気による算出を行い積分によるドリフト度差を補正する．まずは，加速度センサから得られる重力加速度と地磁気センサから得られる単位ベクトルを算出する．
本方法においては，測定対象となるセグメントが一様な重力場，磁場にある事を前提としている．そして，重力と磁気の向きを用いてグローバル座標系を構築し，各セグメントに固定されたローカル座標系の基底ベクトルをグローバル座標系で表現することで，関節角度の算出に必要な情報を取得する．まずは，加速度センサから得られる重力加速度と地磁気センサから得られる磁場を用いることで初期姿勢を算出する．重力加速度と地磁気の無次元の向きを G，CMP とし，単位ベクトルとして扱う．図 3 に示すように，式（2.2-1），（2.2-2），（2.2-3）にてお互いに直交する基準ベクトル X，Y，Z をそれぞれ定めた[4]．
Z=-G（2.2-1）
X=Z×CMP（2.2-2）
X=Z×Y（2.2-3）
重力軸方向と地磁気軸方向のなす角が 0 度の場合，基準ベクトルを定めることはできな
4

い．そのため，重力軸方向と地磁気軸方向が重なることが想定されるような環境，または，重力や地磁気が存在しない環境ではこの計算を用いて基準ベクトルを定めることができな
い．基準ベクトル X，Y，Z にはそれぞれ X 軸方向成分，Y 軸方向成分，Z 軸方向成分の値があり，計 9 個の値を 3 行 3 列行列として扱う．ここで算出された単位ベクトルを式4654 に適応することで屈曲，内外反，回旋が求められる．しかし，この場合，歩行時などの並進加速度が大きくなる運動では並進加速度が白色雑音として計算され外乱が生じる．
そこで，歩行時などの並進加速度が大きくなる運動では，ジャイロセンサから得られる角速度から姿勢情報を以下のように計算する．
3 軸角速度センサはセンサに付随したそれぞれ直交した基準軸の角速度𝜔𝑥 ，𝜔𝑦 ，𝜔𝑧 を検出することができる．それらの角速度をベクトルとして合成することで，3 次元的な回転の角速度𝜔と軸ベクトル A を算出することができる．関係式を式（2.2-4），（2.2-5），（2.2-6）に示す．
ωx𝛚 = (ωy )ωz（2.2-4）

ω = |𝛚|（2.2-5）𝐀 = 𝛚⁄ω（2.2-6）角速度𝜔とサンプリング周期𝛥𝑡を掛け合わせることで角度変化量𝜃𝑔𝑣𝑟 を求めることができる．関係式を式（2.2-7）に示す．
𝜃𝑔𝑣𝑟 = ω∆t（2.2-7）大きさ 1 の回転軸ベクトル𝐀 = [𝑛1 ，𝑛2 ，𝑛3 ]の周りを角度𝜃回転させたときのベクトル計
算には式（2.2-8）のロドリゲスの回転公式を用いた．
cos θ + n12 (1 − cos θ)n1 n2 (1 − cos θ) − n3 sin θ n1 n3 (1 − cos θ) + n2 sin θ
𝑅 = [n2 n1 (1 − cos θ) + n3 sin θcos θ + n22 (1 − cos θ)n2 n3 (1 − cos θ) − n1 sin θ]（2.2-8）
n3 n1 (1 − cos θ) − n2 sin θ n3 n2 (1 − cos θ) + n1 sin θcos θ + n23 (1 − cos θ)式（2.2-1），（2.2-2），（2.2-3）または，式（2.2-8）で求められた単位行列を式（2.1-6），（2.17），（2.1-8）に用いて膝関節の屈曲，内外反，回旋を求めた．
2．3 Madwick フィルタを用いた方法
ここでは，Madwick フィルタを用いた単位ベクトル算出を行う．Madwick フィルタを用いて単位ベクトル算出を行う場合，クォータニオンによる計算が必要となる．クォータニ
オンとは，3 次元空間内の軸と，その軸中心の回転を表す 4 次元数である[2].例えば，4 次元数 q は a,x,y,z を実数，i,j,k を虚数単位として，q = a + x𝐢 + y𝐣 + z𝐤のように表される．3 次元座標系Ａと比較して任意の 3 次元座標系 B はAr が定めた軸周りの回転で表される．クォ5

ータニオン𝐪𝐀𝐁 の回転軸の単位ベクトルをAr ，回転をθとすると式（2.3-1）が定義され，𝐫𝐱 ，𝐫𝐲 ，𝐫𝐳 がそれぞれ，Ar の構成要素の x，y，z 軸方向の成分となる[5]．これを図 4 に示す．
θθθθ𝐪𝐀𝐁 = [q1 𝐪𝟐 𝐪𝟑 𝐪𝟒 ] = [cos (2) −𝐫𝐱 sin (2) −𝐫𝐲 sin (2) −𝐫𝐳 si n (2)]（2.3-1）

また，q BA は 3 次元座標系 B から 3 次元座標系Ａに変形させたものであり，式（2.3-2）のように表せる．
𝐪𝐀𝐁 = 𝐪𝐁𝐀 = [q1 −𝐪𝟐 −𝐪𝟑 −𝐪𝟒 ]（2.3-2）
次に，3 つの 3 次元座標系 A，B，C おける関係は式（2.3-3）のように表せる．
𝐪𝐀𝐂 = 𝐪𝐁𝐂 ⊗ 𝐪𝐀𝐁（2.3-3）2 つのクォータニオン a，b はハミルトンの法則を用いて式（2.3-4）のように表せる．このことから，a，b は入れ替えることが不可能であり，𝐚 ⊗ 𝐛 ≠ 𝐛 ⊗ 𝐚である事がわかる．
𝐚 ⊗ 𝐛 = [a1 𝐚𝟐 𝐚𝟑 𝐚𝟒 ] ⊗ [b1 𝐛𝟐 𝐛𝟑 𝐛𝟒 ]𝐚𝟏 𝐛𝟏 − 𝐚𝟐 𝐛𝟐 − 𝐚𝟑 𝐛𝟑 − 𝐚𝟒 𝐛𝟒
𝐚 𝐛 + 𝐚𝟐 𝐛𝟏 − 𝐚𝟑 𝐛𝟒 − 𝐚𝟒 𝐛𝟑=[ 𝟏 𝟐]
𝐚𝟏 𝐛𝟑 − 𝐚𝟐 𝐛𝟒 − 𝐚𝟑 𝐛𝟏 − 𝐚𝟒 𝐛𝟐𝐚𝟏 𝐛𝟒 + 𝐚𝟐 𝐛𝟑 − 𝐚𝟑 𝐛𝟐 − 𝐚𝟒 𝐛𝟏（2.3-4）

クォータニオン𝐪𝐀𝐁 によって表される回転行列𝐑 𝐀𝐁 は式（2.3-5）のように表すことができる．
2q21 − 1 + 2q22 2(q 2 q 3 + q1 q 4 ) 2(q 2 q 4 − q1 q 3 )R AB = [2(q 2 q 3 − q1 q 4 ) 2q21 − 1 + 2q23 2(q 3 q 4 + q1 q 2 )]（2.3-5）222(q 2 q 4 + q1 q 3 ) 2(q 3 q 4 − q1 q 2 ) 2q1 − 1 + 2q 4
航空工学で用いられるオイラー角ψ，θ，ϕを用いて，3 次元座標系 A は 3 次元座標系 BをzB 軸周りにψ，yB 軸周りにθ，xB 軸周りにϕ回転させることで表せる．この𝐪𝐀𝐁 から得られるオイラー角ψ，θ，ϕは次の式（2.3-6），（2.3-7），（2.3-8）で求めることがきる．
ψ = Atan2(2q 2 q 3 − 2q1 q 4 , 2q21 + 2q22 − 1)
（2.3-6）−1 (2qθ = − sin（2.3-7）
2 q 4 + 2q1 q 3 )22
ϕ = Atan2(2q 3 q 4 − 2q1 q 2 , 2q1 + 2q 4 − 1)
（2.3-8）
また，ドリフトによる誤差を軽減するために Madwick らの研究結果[5]を用い，フィルタを作成する．
関節角度を求めるためには，x，y，z 軸それぞれにおける単位ベクトルが必要となる．
そこで，式（2.3-6），（2.3-7），（2.3-8）で求められたオイラー角と x，y，z 軸それぞれの回転行列を用いて単位ベクトルを求める．計算方法を式（2.3-9）で示す．
1 0[0 10 00 10] [01 000cos θcos ϕ −sin ϕ] [ 0sin ϕ cos ϕ −sin θ0 sin θ cos ψ10 ] [ sin ψ0 cos θ0− sin ψcos ψ000]1（2.3-9）式（2.3-9）で求められた単位行列を式（2.1-6），（2.1-7），（2.1-8）に用いて膝関節の屈曲，内外反，回旋を求めた．

63．実験方法
3．1 計測システム
本研究で用いる計測システムを図 5 に示す．本計測システムには，3 軸加速度センサ（InvenSense,MPU-9250,測定範囲：±2[g]），3 軸ジャイロセンサ（InvenSense,MPU-9250,測定範囲：±250[deg/sec]），3 軸地磁気センサ（旭化成エレクトロニクス，AK8963，測定範囲：±4800[μT]）が搭載された 9 軸センサモジュールを 2 つ用いており，3 軸の角速度，加速度，磁場を計測可能である． 2 つのセンサは大腿と下腿に図 2 の様に装着する．各センサからの情報を取得し，PC へ送信するために，AVR マイコン（Arduino，UNO）を使用している．
本計測システムの大きさは 121×53×50mm，重さ 78g であり，身体部位に直接取り付けることで，3 次元の角速度，加速度，磁場を計測することができる[2]．2 章第 2 節，第 3 節で述
べた 2 つの推定方法を用い，実験を行う．2 章第 2 節で述べた方法では，対象セグメントが動作しているかどうか判断するための値として，しきい値を 0.1[rad/s]とし，合成角速度がしきい値を 0.1[s]以上越え続けた場合は動作中として計算を行う．
3．2 膝関節モデルとの比較本研究で提案した方法の精度を示すために，ポテンショメータを搭載し，膝関節をモデルとした実験装置から得られる角度と本方法を用いて推定した姿勢情報との比較を行った．
実験装置と計測システムの取り付け位置を図 6 に示す．本装置は，各軸周りに 3 個のポテンショメータ（Supertech Electronic Co.Ltd，16K4）を搭載しており，3 自由度の関節角度計測が可能である．このとき，ポテンショメータによる単位ベクトル算出を式（3.2-1）を用いて行う．
1 0[0 10 00 10] [01 00cos θ3sin θ30cos θ2−sin θ3 ] [ 0cos θ3 −sin θ2010sin θ2 cos θ10 ] [ sin θ1cos θ20− sin θ1cos θ1000]1（3.2-1）

ただし，θ1 ，θ2 ，θ3はポテンショメータ 1，2，3 から得られた角度とする．
ポテンショメータは AVR マイコン（Arduino，UNO）を用いて PC と接続しており，計測システムと同期してデータを取得することができる．計測開始後約 5 秒間静止した後に，手動でロール，ピッチ，ヨー角のすべてが変化するように回転させ，計測システムとポテンショメータからの情報を計測した．計測システムのサンプリング周期は 100Hz である[1]．
3．3 立ち上がり動作での計測
椅子からの立ち上がり動作中の膝関節角度の推定を行った．足にマーカーを付け，ビデオ撮影をし，画像由来の角度と本計測システム由来の角度を比較した．実験装置の足への取り付け位置を図 7 に示す．起立した状態から計測を開始し，開始後約 5 秒間静止した後に起立，着席動作を 3 回行う．被験者は健常男子 1 名とし，動作の速さは指定せずに 1 回の実験で起立，着席動作を 4 回行った．計 4 回の実験を行った．
3．4 歩行動作での計測
歩行動作中の膝関節角度の推定を行った．J. Favre らの歩行周期の計測結果[6]との比較を行った．実験装置の足への取り付け位置は 3．3 と同様である．被験者は健常男子 1 名とし，通常歩行になるように「普段どおりに歩いて下さい」との指示をした．計測開始後約7

5 秒間静止した後に 10 秒間歩行を行い，計 4 回の実験を行った．

84．実験結果と考察
4．1 膝関節モデルとの比較結果
膝関節モデルとの比較結果を図 8 に示す．2.2 章で述べた静止時にドリフト誤差を補正す
る測定方法では，屈曲での最大誤差 56.50°，平均誤差 13.64°，内外反での最大誤差 48.30°，平均誤差 17.23°，回旋での最大誤差 141.2°，平均誤差 82.49°であり，現用の動作測定装置と比較すると精度が悪かった．このとき，回旋角度の誤差が最も大きかった．回旋角度は地磁気センサの値を主として推定している．地磁気センサは磁性体の影響を受けやすく，様々な外的要因によって測定値が常に変動していることが推察され，測定精度の低下の原因であることが考えられる．また，屈曲角度が 90°に近づくにつれて，内外反の角度推定に用いる地磁気の割合が大きくなる．このことから，屈曲角度が 90°付近の場合の内外反角度の精度が低下する原因は地磁気センサへの外的要因であることが考えられる．
2.3 章で述べた Madwick フィルタを用いる方法では，屈曲での最大誤差 37.22°，平均誤差 12.19°，内外反での最大誤差 16.81°，平均誤差 8.013°，回旋での最大誤差 58.57°，平均誤差 20.08°であり，現用の動作測定装置と比較すると精度が悪かった．これは，初期姿勢の算出に角速度を用いており，初期姿勢の誤差が角度算出時の誤差につながったと推測できる．また，地磁気への外的要因によって，フィルタの補正値に誤差が生じたことが推察され，測定精度の低下の原因であることが考えられる．
地磁気センサの測定値の検証実験として，静止時の地磁気センサの値を測定した．大腿，下腿の各センサから算出された地磁気の方向を図 9 に示す．本来，同一方向を向いているはずの地磁気であるが，大腿，下腿のセンサから得られた方向には約 20°の差があり，これが回旋角度の誤差に繋がっていると考えられる．
4．2 立ち上がり動作での計測結果
立ち上がり動作での画像由来とセンサ由来の測定結果の比較結果を図 10 に示す．この時，画像由来の角度は起立時，着席時の屈曲角のみ測定した．
2.2 章で述べた静止時にドリフト誤差を補正する測定方法では，屈曲角度は精度よく測定できていることがわかる．また，回旋角度が常に-30°付近を示している．これは，4.1 章で述べた地磁気の外的要因による変化が原因だと考えられる．
2.3 章で述べた Madwick フィルタを用いる方法では，起立時の屈曲角度が徐々に減少している．これは，地磁気への外的要因によって，フィルタの補正値に誤差が生じたことが考えられる．また，どちらの方法でも，動作中に筋肉が収縮した影響でセンサがずれ，骨軸とセンサ軸がずれてしまうことが原因だと考えられる．
4．3 歩行動作での計測結果
歩行動作での測定結果を図 11 に示す．
2.2 章で述べた，静止時にドリフト誤差を補正する測定方法では，計測開始直後は屈曲には二峰性が見られたが，計測開始 4 秒以降では，周期的な値とならなかった．また，大きく角度が変化することのない内外反角度，回旋角度が大きく変化していた．J. Favre らの歩行周期の計測結果[6]と比較すると，屈曲において計測開始直後は同様の歩行周期がみられたが，計測開始 4 秒以降では同様の周期は得られなかった．これは，歩行時にはセンサの動作時間が長く，角速度を用いた姿勢算出が続いたため，ドリフト誤差が補正されず，精9度が低下したことが考えられる．
2.3 章で述べた Madwick フィルタを用いる方法では，すべての測定値において周期的な値の変化がみられたが，内外反角度，回旋角度が大きく変化していた．J. Favre らの歩行周期の計測結果[6]と比較すると，同様の波形がみられたが，ゼロ点がシフトしている．これは，地磁気への外的要因によって，フィルタの補正値に誤差が生じ，実際のドリフト誤差の値と異なる値を計算していたことが考えられる．また，4.1 章，4.2 章と比べ，どちらの方法でも屈曲角度が短い時間で大きく変化しており，角速度センサの測定可能範囲を超えていたことが考えられる．更に，動作中に筋肉が収縮した影響でセンサがずれ，骨軸とセンサ軸がずれてしまうことが原因だと考えられる．

10

5．結論
本研究では慣性センサを用いた動作測定装置の製作にあたり，加速度，地磁気，角速度の値を用いたベクトル計算法の構築，角速度のドリフト誤差の補正方法の提案と，補正方法を実行するプログラムの構築を行い，ポテンショメータとの比較，起立着席動作と歩行動作の測定を行った．
得られた実験結果は，先行された実験の結果と比較すると差異が見られた．原因としては，地磁気の外的要因による変化，角速度センサの測定範囲を超えた角速度の変化があったこと，更に，センサの固定方法が原因と推察される．
今後の課題は，地磁気の外的要因による変化に対応できるセンサフュージョンの構築，筋肉の収縮による影響が少なく動作中のずれが少ないセンサの固定方法の確立である．

11

参考文献
[1] 近藤 亜希子，土岐 仁，廣瀬 圭，慣性センサを用いた身体運動計測における 3 次元
姿勢推定法に関する研究，日本機械学会論文集（C 編）79 巻 803 号，（2013）[2] 廣瀬 圭，土岐 仁，近藤 亜希子，慣性センサ・地磁気センサを用いたスポーツにおける姿勢計測に関する研究，スポーツ産業学研究，Vol.22，No.2（2012）[3] E.S.Grood,W.J.Suntay, A Joint Coordinate System for the Clinical Description of ThreeDimensional Motions:Application to the Knee ,Transactions of the ASME,Vol.105,pp.136-144,MAY（1983）[4] 平岡 匠一，慣性・地磁気センサを用いた動作解析装置の製作，大分大学修士論文（2016）[5] Sebastian O.H.Madgwick，An efficient orientation filter for inertial and inertial/magnetic sensor
arrays（2010）[6] J. Favre ほか，A new ambulatory system for comparative evaluation of the three-dimensionalknee kinematics, applied to anterior cruciate ligament injuries，Knee Surg Sports Traumatol Arthrosc(2006)

12

図1

図2

大腿，脛骨のローカル座標系

大腿骨と脛骨の相対関係

13

図3

重力加速度と地磁気の基準軸ベクトル

図43 次元座標系Ａ，Ｂの関係

14

図5

図 6．1

計測システムポテンショメータを用いた膝関節モデル15

図 6．2

センサの膝関節モデルへの装着図

図7

センサの足への装着図

16120100

静止時にドリフト誤差を補正

60Madwick40

フィルタ

20
ポテンショ00246810メータ-20時間[s]図 8．1

屈曲角度の膝関節モデルとの比較

6040静止時にドリフト誤差

屈曲角度[deg]

屈曲角度[deg]8020を補正

0Madwick0246810フィルタ-20-40

ポテンショ
メータ-60時間[s]図 8．2

内外反角度の膝関節モデルとの比較

1710080
静止時にド60リフト誤差

屈曲角度[deg]40を補正

200-20Madwick
0246810フィルタ-40-60ポテンショ-80

メータ-100時間[s]図 8．3

図9回旋角度の膝関節モデルとの比較

各センサから得られた地磁気方向

18120
屈曲100

膝関節角度[deg]80
内外反604020

回旋00123456789

10 11 12 13 14 15 16-20

画像由来の屈-40

曲-60時間[s]図 10．1

静止時にドリフト誤差を補正する方法との比較

10080
屈曲膝関節角度[deg]60
内外反4020

回旋0012345678910111213141516-20

画像由来の屈曲-40時間[s]図 10．2Madwick フィルタを用いた方法との比較

19

150

関節角度[deg]

100

屈曲

50

内外反00246810-50
回旋-100-150時間[s]図 11．1

静止時にドリフト誤差を補正する方法での歩行計測

10080
屈曲

関節角度[deg]

60
40
内外反2000246810-20
回旋-40-60時間[s]図 11．2

Madwick フィルタを用いた方法での歩行計測

20