相関性評価方法、相関性評価装置、動作再現装置
【課題】力に関する複数の収集データの相関性を適切に評価することが可能な相関性評価方法、及び装置等を提供すること。
【解決手段】人が特定の物体に対して所定の動作をする際に加えられる力を複数回計測するステップと、前記計測された力の時系列データを複数個、記憶手段に格納するステップと、前記記憶手段に格納された力の時系列データを標本とし、該時系列データ間の相関性を示す値で重み付けした隣接行列を求めるステップと、前記隣接行列を正規化した正規化隣接行列を求めるステップと、前記正規化隣接行列の固有値が１となる場合の固有ベクトルの要素の大きさに基づいて、該要素に対応する時系列データの他のデータとの相関性を評価するステップと、を備えることを特徴とする相関性評価方法。
【解決手段】人が特定の物体に対して所定の動作をする際に加えられる力を複数回計測するステップと、前記計測された力の時系列データを複数個、記憶手段に格納するステップと、前記記憶手段に格納された力の時系列データを標本とし、該時系列データ間の相関性を示す値で重み付けした隣接行列を求めるステップと、前記隣接行列を正規化した正規化隣接行列を求めるステップと、前記正規化隣接行列の固有値が１となる場合の固有ベクトルの要素の大きさに基づいて、該要素に対応する時系列データの他のデータとの相関性を評価するステップと、を備えることを特徴とする相関性評価方法。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、力を計測した時系列データの他のデータとの相関性を評価する相関性評価方法、及びこの方法を実現するための装置、更には、人が特定の物体に対して操作による当該物体の動作を再現する動作装置に関する。
【背景技術】
【０００２】
近年、ロボットや電機統合システムを用いて人間を支援するシステムの開発が行われており、係るシステムにおいては、人間の特徴的な動作を抽出することが重要なテーマとなっている。
【０００３】
人間の動作に関する情報のうち位置の変化情報については、モーションキャプチャと称される技術が存在し、動作における空間位置情報の抽出が可能となっている。例えば、踊りの動作等を抽出し、その空間情報を再現可能なロボットシステムの開発等が行われている。
【０００４】
ところが、人間の動作は位置情報のみならず、各位置において作用した力の情報も含まれるべきものである。特に、熟練技能者のスキルや技術の特徴を抽出するためには、力加減に関する情報が抽出されることが望ましい。
【０００５】
このような観点から、時系列な位置情報と力の接触情報を取得し、これを解析して再現する位置、力再現方法等についての発明が開示されている（例えば、特許文献１参照）。
【先行技術文献】
【特許文献】
【０００６】
【特許文献１】特開２００９−２７９６９９号公報
【発明の概要】
【発明が解決しようとする課題】
【０００７】
しかしながら、上記従来の方法等では、複数のデータを収集し、それらの相関性について評価することについては考慮されていない。従って、力に関する複数の収集データの相関性を適切に評価することができない。
【０００８】
本発明はこのような課題を解決するためのものであり、力に関する複数の収集データの相関性を適切に評価することが可能な相関性評価方法、及び装置等を提供することを、主たる目的とする。
【課題を解決するための手段】
【０００９】
上記目的を達成するための本発明の第１の態様は、
人が特定の物体に対して所定の動作をする際に加えられる力を複数回計測するステップと、
前記計測された力の時系列データを複数個、記憶手段に格納するステップと、
前記記憶手段に格納された力の時系列データを標本とし、該時系列データ間の相関性を示す値で重み付けした隣接行列を求めるステップと、
前記隣接行列を正規化した正規化隣接行列を求めるステップと、
前記正規化隣接行列の固有値が１となる場合の固有ベクトルの要素の大きさに基づいて、該要素に対応する時系列データの他のデータとの相関性を評価するステップと、
を備えることを特徴とする相関性評価方法である。
【００１０】
この本発明の第１の態様によれば、力に関する複数の収集データの相関性を適切に評価することができる。
【００１１】
本発明の第２の態様は、
人が特定の物体に対して所定の動作をする際に加えられる力と、前記特定の物体の変位を複数回計測するステップと、
前記計測された力が前記計測された変位を構成する第１の要素と対応づけられた第１のデータと、前記計測された変位を構成する第２の要素が前記計測された変位を構成する第１の要素と対応づけられた第２のデータとを、前記複数回の計測に係る人の動作に対応づけて複数個、記憶手段に格納するステップと、
前記第１のデータ間の相関性と、前記第２のデータ間の相関性に基づいて、前記複数回の計測に係る人の動作間の相関性を評価するステップと、
を備えることを特徴とする相関性評価方法である。
【００１２】
この本発明の第２の態様によれば、力に関する複数の収集データの相関性を適切に評価することができる。
【００１３】
この場合、
前記複数回の計測に係る人の動作間の相関性を示す値で重み付けした隣接行列を求めるステップと、
前記隣接行列を正規化した正規化隣接行列を求めるステップと、
前記正規化隣接行列の固有値が１となる場合の固有ベクトルの要素の大きさに基づいて、該要素に対応する人の動作の、他の動作との相関性を評価するステップと、
を備えることを特徴とするものとしてもよい。
【００１４】
本発明の第１又は第２の態様において、
前記特定の物体は筆記具又は筆記具に擬した物体であり、
前記人がする所定の動作は、筆記動作であり、
前記計測される力は、筆圧に相当する力であるものとしてもよい。
【００１５】
筆記具又は筆記具に擬した物体を特定の物体とする本発明の第２の態様において、
前記所定の動作は、円を描く筆記動作であり、
前記第１の要素は、角度変化であり、
前記第２の要素は、前記円の想定中心からの距離であるものとしてもよい。
【００１６】
本発明の第３の態様は、
人が特定の物体に対して所定の動作をする際に加えられる力を計測する計測手段と、
前記計測手段により計測された力の時系列データが複数個、格納される記憶手段と、
前記記憶手段に格納された力の時系列データを標本とし、該時系列データ間の相関性を示す値で重み付けした隣接行列を算出し、該隣接行列を正規化した正規化隣接行列を算出する正規化隣接行列算出手段と、
前記正規化隣接行列算出手段により算出された正規化隣接行列の固有値が１となる場合の固有ベクトルを算出する固有ベクトル算出手段と、
を備えることを特徴とする相関性評価装置である。
【００１７】
この本発明の第３の態様によれば、力に関する複数の収集データの相関性を適切に評価することができる。
【００１８】
本発明の第４の態様は、
人が特定の物体に対して所定の動作をする際に加えられる力と、前記特定の物体の変位を計測する計測手段と、
前記計測された力が前記計測された変位を構成する第１の要素と対応づけられた第１のデータと、前記計測された変位を構成する第２の要素が前記計測された変位を構成する第１の要素と対応づけられた第２のデータとが、前記計測された人の動作に対応づけられて記憶される記憶手段と、
前記第１のデータ間の相関性と、前記第２のデータ間の相関性に基づいて、人の動作間の相関性を評価する評価手段と、
を備えることを特徴とする相関性評価装置である。
【００１９】
この本発明の第４の態様によれば、力に関する複数の収集データの相関性を適切に評価することができる。
【００２０】
この場合、
前記人の動作間の相関性を示す値で重み付けした隣接行列を算出し、該隣接行列を正規化した正規化隣接行列を算出する正規化隣接行列算出手段と、
前記正規化隣接行列の固有値が１となる場合の固有ベクトルを算出する固有ベクトル算出手段と、
を備えることを特徴とするものとしてもよい。
【００２１】
本発明の第３又は第４の態様において、
前記特定の物体は筆記具又は筆記具に擬した物体であり、
前記人がする所定の動作は、筆記動作であり、
前記計測される力は、筆圧に相当する力であるものとしてもよい。
筆記具又は筆記具に擬した物体を特定の物体とする本発明の第４の態様において、
前記所定の動作は、円を描画する筆記動作であり、
前記第１の要素は、角度変化であり、
前記第２の要素は、前記円の想定中心からの距離であるものとしてもよい。
【００２２】
本発明の第５の態様は、
人が特定の物体に対して行った操作を検知し、該人が行った操作による当該物体の動作を、他の物体により再現させる動作再現装置であって、
前記他の物体における加速度に関する情報を記憶手段に記憶させ、
前記人が操作を行わない場合の動作再現においては、前記記憶手段に記憶された前記他の物体における加速度に関する情報に基づいて、前記他の物体を動作させることを特徴とする、
動作再現装置である。
【００２３】
この本発明の第５の態様によれば、初期位置が異なる場合であっても、位置や力の変化を、より正確に再現することができる。
【発明の効果】
【００２４】
本発明によれば、力に関する複数の収集データの相関性を適切に評価することが可能な相関性評価方法、及び装置等を提供することができる。
【図面の簡単な説明】
【００２５】
【図１】本発明の第１実施例に係る相関性評価装置１が有するハプティックペン１０を人が把持した様子を示す図である。
【図２】リニアモータ１６の制御系を周波数領域で表現したブロック線図である。
【図３】外乱オブザーバ２０の構成を示すブロック線図である。
【図４】有向グラフによるシステム結合の例を示す図である。
【図５】第１実施例の相関性評価装置１が実行する特徴的な処理の流れを示すフローチャートである。
【図６】各回において計測された力（筆圧）の変化を示す図である。
【図７】導出された隣接行列ＡGの各要素を示す図である。
【図８】本発明の第２実施例に係る相関性評価装置２が有するハプティックペン５０を人が把持した様子を示す図である。
【図９】第２実施例におけるバイラテラル制御を周波数領域で表現したブロック線図である。
【図１０】外乱オブザーバ７０、７２の構成を示すブロック線図である。
【図１１】力、半径、角度の関係を示す図である。
【図１２】第２実施例の相関性評価装置２が実行する特徴的な処理の流れを示すフローチャートである。
【図１３】第２実施例の実験に係る実験パラメータを示す図である。
【図１４】被験者Ａが円を描画した際の実験結果を、左から順に３次元グラフ、位置に関する結果、力に関する結果の形式で示したものである。
【図１５】被験者Ａが円を描画した際の実験結果を、左から順に３次元グラフ、位置に関する結果、力に関する結果の形式で示したものである。
【図１６】被験者Ｂが円を描画した際の実験結果を、左から順に３次元グラフ、位置に関する結果、力に関する結果の形式で示したものである。
【図１７】被験者Ｂが円を描画した際の実験結果を、左から順に３次元グラフ、位置に関する結果、力に関する結果の形式で示したものである。
【図１８】位置に関する相関性（上記Ｒp）を要素間で求めた結果を示す行列である。
【図１９】力に関する相関性（上記Ｒf）を要素間で求めた結果を示す行列である。
【図２０】位置に関する相関性と力に関する相関性を総合した結果を示す行列である。
【図２１】第２実施例に係る相関性評価装置の概念図である。
【図２２】第３実施例に係る動作再現装置３００の概念を示す図である。
【図２３】第３実施例におけるバイラテラル制御を周波数領域で表現したブロック線図である。
【図２４】外乱オブザーバ３４２と反力推定オブザーバ３４４の構成を周波数領域で表現したブロック線図である。
【図２５】保存時のマスターシステム３１０における位置と力（応答値；以下同じ）の変化を示す図である。
【図２６】第３実施例の構成による再現時のスレーブシステム３２０における位置と力の変化を示す図である。
【図２７】従来の構成によって再現した場合の、スレーブシステム３２０における位置と力の変化を示す図である。
【図２８】第３実施例の構成による再現時のスレーブシステム３２０における位置と力の変化を示す図である。
【図２９】第３実施例の動作再現装置３００を、他の態様で表現した機能ブロック図である。
【発明を実施するための形態】
【００２６】
以下、本発明を実施するための形態について、添付図面を参照しながら実施例を挙げて説明する。
【実施例】
【００２７】
＜＜第１実施例＞＞
以下、図面を参照し、本発明の第１実施例に係る相関性評価方法、及びこれを実現するための相関性評価装置について説明する。本実施例の相関性評価方法は、人の筆記動作における力加減を計測して記憶装置に記憶させ、記憶された複数のデータの中から定量的な動作の評価を行うことにより、最も標準的な動作を抽出することを最終的な目的としている。
【００２８】
本実施例の相関性評価方法は、係る定量的な動作の評価において、グラフ理論における隣接行列（重み付けのあるもの）を用いている点が特徴的である。
【００２９】
［構成］
図１は、本発明の第１実施例に係る相関性評価装置１が有するハプティックペン１０を人が把持した様子を示す図である。図示するように、ハプティックペン１０は、筆記具に擬した形状をしており、机に置かれた紙等の平面に当接するペン先に擬した先端部を有する長棒形状の軸体１２と、軸体１２に対してその長手方向（図中、Ｘ方向）に相対移動可能な把持部１４と、を備える。なお、先端部には、現実に筆記可能な部材（筆、黒鉛、小型ボールペン等）が取り付けられてよい。
【００３０】
把持部１４は、リニアモータ１６を内蔵しており、可動子が軸体１２に連結されている。従って、把持部１４は、軸体１２に対して図１におけるＸ方向に、所望の力を出力可能となっている。これによって、人が筆記動作をする際に生じる筆圧に対して反力を出力することができる。
【００３１】
図２は、リニアモータ１６の制御系を周波数領域で表現したブロック線図である。図中、「ｓ」はラプラス演算子である。また、「・」は１階の微分を表し、「＾」は推定値を表している。以下の説明においてこれらを表現する場合、必要に応じて記号中に「・」、「・・」（２階の微分）、「＾」等を挿入する。
【００３２】
ここで、パラメータ「Ｋp」は位置に対するゲインであり、「Ｋv」は速度に対するゲインである。また、パラメータ「ｇpd」は擬似微分のカットオフ周波数であり、「ｇ」は重力である。また、「Ｋt」はリニアモータ１６の推力定数であり、添え字の「n」はノミナル値を示している。更に、「Ｍ」は軸体１２の質量を示している。
【００３３】
本実施例の相関性評価装置１では、軸体１２と把持部１４の相対位置が基準位置に固定されるように、リニアモータ１６がフィードバック制御される。軸体１２と把持部１４の相対位置（位置応答値）はパラメータ「ｘres」で表現されており、「ｘres」が値ゼロとなるようにリニアモータ１６の電流制御がなされる。「ｘres」及びその変化（速度）に基づいて決定される、リニアモータ１６に供給される電流の仮電流参照値は、「Ｉref」で示されている。
【００３４】
更に、本実施例の相関性評価装置１は、外乱に対する補償を行うと共に、環境反力（＝筆圧）を推定するための外乱オブザーバ２０を備えている。
【００３５】
図３は、外乱オブザーバ２０の構成を示すブロック線図である。ここで、パラメータ「ｇd」は外乱オブザーバ２０のカットオフ周波数であり、「ｇr」は反力オブザーバのカットオフ周波数である。
【００３６】
物体が環境に及ぼす推定外乱Ｆ＾disは、次式（１）のように推定される。本実施例では、粘性による外乱が小さく、ハプティックペン１０を垂直に立てた状態で筆記するものと仮定する。
【００３７】
【数１】
【００３８】
そして、ｇrとｇdが等しいものと仮定すると、環境反力Ｆ＾envは、次式（２）のように推定される。このように推定された環境反力Ｆ＾envが、人の及ぼす力（筆圧）に相当する。
【００３９】
【数２】
【００４０】
また、リニアモータ１６に供給される電流の電流参照値「Ｉrefa」は、仮電流参照値「Ｉref」に電流補償値「Ｉcmp」を加算して求められる。
【００４１】
係る構成によって、位置応答値「ｘres」から筆圧（力）情報を導出することが可能となり、圧力センサ等を備えることなく人の力を測定することができる。
【００４２】
環境反力Ｆ＾envは、ハプティックペン１０にケーブル接続され、又はBluetooth（登録商標）等の無線通信によって接続された記憶装置３２に時系列データ（一定期間、環境反力Ｆ＾envが所定周期でサンプリングされたデータ）として格納される。そして、以下に説明するように、情報処理装置３０によって相対性評価が行われる。
【００４３】
［相対性評価］
情報処理装置３０は、例えば、ＣＰＵ（Central Processing Unit）を中心として、ＲＯＭ（Read Only Memory）やＲＡＭ（Random Access Memory）、Ｉ／Ｏポート等がバスによって接続されたマイクロコンピュータであり、ＥＥＰＲＯＭ（Electrically Erasable and Programmable Read Only Memory）やフラッシュメモリ等の記憶装置３２を内蔵している。
【００４４】
情報処理装置３０は、グラフ理論における隣接行列を用いて時系列データの他のデータとの相関性を評価している。
【００４５】
また、情報処理装置３０は、係る相関性評価のために、図示しないプログラムメモリに記憶されたプログラムをＣＰＵが実行することにより実現される機能ブロックとして、正規化隣接行列算出部３４と、固有ベクトル算出部３６と、を備える。
【００４６】
ここで、グラフ理論における隣接行列について説明する。図４は、有向グラフによるシステム結合の例を示す図である。図中、要素Ａから要素Ｃに向かう矢印は、要素Ａが要素Ｃにリンクしていることを示している。図４に示す関係を隣接行列ＡGで表すと、次式（３）のようになる。
【００４７】
【数３】
【００４８】
上記の隣接行列には、重み付けがなされておらず、全ての要素が１となっている。本実施例の情報処理装置３０では、更に、データ間の相関性を示す値（以下、相関係数と称する）で重み付けした隣接行列を算出する。なお、以下ではリンクの向きは考慮しないものとする。従って、隣接行列ＡGは対角行列となる。
【００４９】
本実施例の情報処理装置３０で扱う隣接行列ＡGは、例えば次式（４）のようになる。ここでは、時系列データの個数が３個であるものとしている。
【００５０】
【数４】
【００５１】
上式（４）において、Ｃijは、要素ｉと要素ｊの間の相関係数を表している。それぞれのＣijは、次式（５）〜（１０）によって計算される。式中、「Ｆｉ（ｔ＋ｍ）」は、時系列データの開始時刻から時間ｔ経過した時刻を基準とし、ｍ番目にサンプリングされたデータ（Ｆ＾dis）を示している。また、「Ｆｉ（上側に横棒）（ｔ）」は、時系列データの開始時刻から時間ｔ経過した時刻を基準とし、その時刻以降にサンプリングされたデータ（Ｆ＾dis）の平均値である。また、「ｋ」は、時系列データの個数であり、Ｃij（ｔ）は時系列データの開始時刻から時間ｔ経過した時刻における要素ｉと要素ｊの間の相関係数である。
【００５２】
本実施例では、変数ｔを色々と変化させ、最大値となったＣij（ｔ）をＣijとする。
【００５３】
このようにして隣接行列ＡGが生成されると、各列和を１として正規化を行い、推移確率行列（特許請求の範囲における「正規化隣接行列」に相当する）Ｍを、次式（１１）によって算出する。
【００５４】
【数５】
【００５５】
推移確率行列Ｍは正規化されているため、最大固有値は１である。情報処理装置３０では、固有値が１である場合の固有ベクトルを算出する。具体的には、固有値が１である場合の固有値と固有ベクトルの関係は次式（１２）によって規定されているため、上式（１１）を次式（１２）に代入することにより、次式（１３）を得る。
【００５６】
【数６】
【００５７】
上式（１３）におけるｘ1は、１番目の時系列データの相対的な他のデータとの相関性を示す値である。同様に、ｘ2は、２番目の時系列データの相対的な他のデータとの相関性を示す値であり、ｘ3は、３番目の時系列データの相対的な他のデータとの相関性を示す値である。
【００５８】
従って、ｘ1〜ｘ3のうち最も大きいものに対応する時系列データが、最も代表的なデータであるといえる。本実施例の情報処理装置３０では、この最も代表的なデータを、最も標準的な動作を示すものとして出力する。
【００５９】
なお、上記ｘ1〜ｘ3は、「相対的な他のデータとの相関性を示す値」であり、要素数等によって変動するため、これをより定量的な値とするために、下限値として全く筆記動作をしなかった場合の被比較データを１つ挿入してよい。そして、被比較データに相当するｘｎとの差分を求めることによって、より定量的な値を取得し、これを出力してもよい。次式（１４）は、係る場合の各時系列データと他のデータとの相関性を示す値を取得するためのものである。本式においては、ｘ3が、全く筆記動作をしなかった場合の被比較データに相当する。
【００６０】
【数７】
【００６１】
［処理フロー］
以下、本実施例の相関性評価装置１が行う処理の流れについて説明する。図５は、本実施例の相関性評価装置１が実行する特徴的な処理の流れを示すフローチャートである。
【００６２】
まず、ハプティックペン１０を用いて人が筆記動作を行い、その際の力（筆圧）を計測し（Ｓ１００）、計測値をサンプリングしたものを時系列データとして記憶装置３２に格納する（Ｓ１０２）。係る処理は、複数回に亘って行われる。
【００６３】
そして、全く筆記動作をしなかった場合の被比較データを１つ挿入する（Ｓ１０４）。
【００６４】
次に、記憶装置３２に格納された力の時系列データを標本とし、時系列データ間の相関性を示す値で重み付けした隣接行列を求める（Ｓ１０６）。
【００６５】
次に、隣接行列を正規化した正規化隣接行列を求める（Ｓ１０８）。Ｓ１０６及びＳ１０８の処理は、正規化隣接行列算出部３４によって行われる。
【００６６】
なお、記憶装置３２に格納された力の時系列データのうち一部は、予め格納された過去のデータであっても構わない。
【００６７】
そして、正規化隣接行列の固有値が１となる場合の固有ベクトルを算出し（Ｓ１１０）、固有ベクトルの要素の大きさに基づいて、この要素に対応する時系列データの他のデータとの相関性を評価する（Ｓ１１２）。具体的には、要素が最も大きいものに対応する時系列データを最も代表的なデータであるとして出力する。同時に、要素の大きさを、その時系列データの得点として出力してもよい。なお、正規化隣接行列の固有値が１となる場合の固有ベクトルは、固有ベクトル算出部３６によって行われる。
【００６８】
［利用例］
なお、最も代表的なデータを手本データとし、他の任意の時系列データとの相関性を求めることもできる。この場合、予め図５で説明したようなフローによって出力された時系列データを１番目のデータとし、他の任意の時系列データを２番目のデータとする。そして、全く筆記動作をしなかった場合の被比較データを３番目のデータとする。
【００６９】
こうして得られる上式（１４）のような結果に対し、ｘ1を値１とするような乗算を行う。その結果、手本データを１（１００点）とした場合に、他の任意の時系列データがどれだけ似通っているかを示す指標値を得ることができる。次式（１５）は、係る指標値（ｘ2／ｘ1）が得られる様子を示している。
【００７０】
【数８】
【００７１】
［実験］
本出願の発明者は、本発明の有用性を実証するための実験を行っている。以下にその結果を示す。本実験では、時系列データの数を６個としている。但し、前述のように、全く筆記動作をしなかった場合の被比較データを１つ挿入するため、筆記動作を行った場合の時系列データの数は５個である。
【００７２】
人は、ハプティックペン１０を用いて「あ」の文字を５回筆記した。一回の筆記に要する時間は１５［秒］とし、データ量を１５［秒］で固定した。
【００７３】
図６の各図は、各回において計測された力（筆圧）の変化を示す図である。これらのデータに対して前述のように隣接行列ＡGを生成し、これを正規化した後に、固有値が１となる場合の固有ベクトルを導出した。次式（１６）は、本実験において生成される隣接行列ＡGのモデルを示しており、図７は、導出された隣接行列ＡGの各要素を示す図である。
【００７４】
【数９】
【００７５】
そして、導出された固有ベクトルは次式（１７）のようになり、６番目の要素を引き算したベクトルは次式（１８）のようになる。
【００７６】
【数１０】
【００７７】
上式（１８）より、最も代表的な時系列データは、１番目に格納されたデータであることが判る。
【００７８】
［効果］
以上説明した本発明の第１実施例に係る相関性評価方法、及びこれを実現するための相関性評価装置によれば、記憶装置３２に格納された力の時系列データを標本とし、時系列データ間の相関性を示す値で重み付けした隣接行列、及びこれを正規化した正規化隣接行列を求め、正規化隣接行列の固有値が１となる場合の固有ベクトルの要素の大きさに基づいて、それぞれの要素に対応する時系列データの他のデータとの相関性を評価するため、力に関する複数の収集データの相関性を適切に評価することができる。
【００７９】
＜＜第２実施例＞＞
以下、図面を参照し、本発明の第２実施例に係る相関性評価方法、及びこれを実現するための相関性評価装置について説明する。本実施例の相関性評価方法は、人の筆記動作における力加減、及び筆記具の位置変化を計測して記憶装置に記憶させ、記憶された複数のデータ間の相関性を評価することを主要な目的としている。
【００８０】
［構成］
図８は、本発明の第２実施例に係る相関性評価装置２が有するハプティックペン５０を人が把持した様子を示す図である。本実施例のハプティックペン５０は、第１実施例とは異なり、バイラテラル制御が行われるマスター・スレーブシステムのうち一方を構成するマスターペンである。
【００８１】
ハプティックペン５０には、第１実施例と同様、図８におけるＺ方向に反力を出力すると共に筆圧に相当する力を測定可能なリニアモータ５２が取り付けられ、更に、Ｚ方向に直交するＸ方向とＹ方向の変位を測定可能な位置エンコーダ５４、５６が取り付けられている。
【００８２】
なお、ハプティックペン５０の本体部５８は剛体に固定されており、把持部６０のみが本体部５８に対してＸ，Ｙ，Ｚ方向に変位可能となっている。
【００８３】
図９は、本実施例におけるバイラテラル制御を周波数領域で表現したブロック線図である。図中、「Ｆ」は力である。また、「Ｍ」はマスターシステムを示し、「Ｓ」はスレーブシステムを示している。また、「Ｃ」は和のモードを示し、「Ｄ」は差のモードを示している。また、「ref」、「res」、「ext」は、それぞれ、参照値、応答値、外力値を示している。その他、第１実施例と共通する符号等については説明を省略する。図９で示したような構成は、Ｘ，Ｙ，Ｚ方向のそれぞれについて設けられている。
【００８４】
本実施例に係る相関性評価装置２は、マスター用及びスレーブ用の外乱オブザーバ７０、７２を備えることによりロバスト安定性を実現し、マスター用及びスレーブ用の反力オブザーバ８０、８２を備えることにより外乱中からリニアモータに受ける外力を観測可能としている。
【００８５】
図１０は、外乱オブザーバ７０、７２の構成を示すブロック線図である。ここでは、マスター用とスレーブ用を区別しない。図１０より、推定外力Ｆ＾extは、次式（１９）により表される。
【００８６】
【数１１】
【００８７】
バイラテラル制御においては、位置と力が同時に制御される。その目的は、次式（２０）、（２１）により表される。
【００８８】
【数１２】
【００８９】
これらの目的は、モード空間にQuarry行列（クオリー行列）を用いて変換することによって達成される。和のモードでは、力が制御され、差のモードでは、加速度の次元で位置が制御される。次式（２２）は、２次のQuarry行列Ｑ2を示しており、次式（２３）は、２次のQuarry逆行列Ｑ2-1を示している。
【００９０】
【数１３】
【００９１】
なお、和のモードと差のモードによる制御の詳細については、既に（特開２００９−２７９６９９号公報）等で開示されているため、詳細な説明を省略する。
【００９２】
このような構成によって、人の筆圧に相当する力（Ｆ＾Mext）やハプティックペン５０の位置（Ｚ方向には変位しないため、Ｘ方向の位置ＸMres、及びＹ方向の位置ＹMres）が把握される。
【００９３】
［相対性評価］
力Ｆ＾Mextや位置ＸMres、ＹMresは、ハプティックペン５０にケーブル接続され、又はBluetooth（登録商標）等の無線通信によって接続された記憶装置９２に一定期間、所定周期でサンプリングされたデータとして格納される。そして、以下に説明するように、情報処理装置９０によって相対性評価が行われる。
【００９４】
なお、位置についてはＸ座標、Ｙ座標として格納されてもよいが、以下の説明では想定中心からの距離（半径）、及び角度の組み合わせに変換され、すなわち極座標に変換されて格納されるものとする。従って、記憶装置９２には、力、半径、角度が対応づけられたデータとして格納される。図１１は、力、半径、角度の関係を示す図である。
【００９５】
情報処理装置９０は、例えば、第１実施例の情報処理装置３０と同様の構成を有するマイクロコンピュータであり、ＥＥＰＲＯＭ（Electrically Erasable and Programmable Read Only Memory）やフラッシュメモリ等の記憶装置９２を内蔵している。
【００９６】
情報処理装置９０は、グラフ理論における隣接行列を用いて記憶装置に格納されたデータの他のデータとの相関性を評価している。
【００９７】
本実施例の情報処理装置９０では、記憶装置９２に格納されたデータを、力と角度が対応づけられた第１のデータ、半径と角度が対応づけられた第２のデータに整理する。次式（２４）、（２５）は、第１のデータと第２のデータを、それぞれベクトル形式で示したものである。本式では、角度の分解能を２π／６２８０＝０．００１（ｒａｄ）とした。
【００９８】
【数１４】
【００９９】
相関性の評価は、第１のデータと、第２のデータのそれぞれについて行い、最終的にそれぞれの評価結果の平均値を求めることによって行う。
【０１００】
次式（２６）〜（２８）は、要素ａと要素ｂの間の、第１のデータに関する相関性を示す値Ｒfを算出するための式である。式中、ｒfa（ｉ）は、要素ａ（要素とは、ある計測回に取得された人の動作であることを示す）におけるｒfデータ（式（２４）参照）のうち、ｉ番目の値であることを意味する。
【０１０１】
【数１５】
【０１０２】
次式（２９）〜（３１）は、要素ａと要素ｂの間の第２のデータに関する相関性を示す値Ｒpを算出するための式である。式中、ｒpa（ｉ）は、要素ａにおけるｒpデータ（式（２５）参照）のうち、ｉ番目の値であることを意味する。
【０１０３】
【数１６】
【０１０４】
そして、ＲfとＲpの平均を求めることにより、要素ａと要素ｂの相関性を示す値が導出される。なお、係る処理において、重み付け等の処理を行ってもよい。
【０１０５】
Ｒab=（Ｒf＋Ｒp）／２
【０１０６】
［処理フロー］
以下、本実施例の相関性評価装置２が行う処理の流れについて説明する。図１２は、本実施例の相関性評価装置２が実行する特徴的な処理の流れを示すフローチャートである。
【０１０７】
まず、ハプティックペン５０を用いて人が円を描画し、その際の力（筆圧）及び位置を計測し（Ｓ２００）、計測値をサンプリングしたものを記憶装置９２に格納する（Ｓ２０２）。
【０１０８】
そして、力と角度に関する相関性評価と、半径と角度に関する相関性評価の双方に基づいて、要素間の相対性評価を行う（Ｓ２０４）。
【０１０９】
［利用例、応用例］
第２実施例で例示した発明は、円を描画する際の力と位置に関するものに限定されるものではない。例えば、複数回に亘って筆記された所望の文字を、直線又は曲線パーツに分解し、それぞれについて、例えば（力とＸ座標）、（Ｙ座標とＸ座標）を対応づけたデータを作成し、上記のようにパーツ毎の相関性を評価することによって、パーツ毎の筆跡鑑定を行うことが可能となる。
【０１１０】
また、第１実施例のように、正規化隣接行列算出部や固有ベクトル算出部等の機能ブロックを備え、上記Ｒabを要素とする隣接行列、正規化隣接行列を求め、固有値が１となる場合の固有ベクトルを算出することにより、代表的なデータを選出する処理を行ってもよい。
【０１１１】
［実験］
本出願の発明者は、本発明の有用性を実証するための実験を行っている。以下にその結果を示す。本実験では、被験者Ａと被験者Ｂがそれぞれ２回、円を描画した。図１３は、本実験に係る実験パラメータを示す図である。
【０１１２】
図１４及び図１５は、被験者Ａが円を描画した際の実験結果を、左から順に３次元グラフ、位置に関する結果、力に関する結果の形式で示したものである。図１４で示した結果を要素ａと称し、図１５で示した結果を要素ｂと称する。
【０１１３】
図１６及び図１７は、被験者Ｂが円を描画した際の実験結果を、左から順に３次元グラフ、位置に関する結果、力に関する結果の形式で示したものである。図１６で示した結果を要素ｃと称し、図１７で示した結果を要素ｄと称する。
【０１１４】
なお、３次元グラフにおける縦軸は、力の大きさを表している。
【０１１５】
そして、図１８は、位置に関する相関性（上記Ｒp）を要素間で求めた結果を示す行列であり、図１９は、力に関する相関性（上記Ｒf）を要素間で求めた結果を示す行列である。更に、図２０は、これらを総合した結果を示す行列である。図１８〜２０に示すように、同一人物が描画したデータである要素ａと要素ｂの間の相関、及び要素ｃと要素ｄの間の相関が明確に高くなっており、筆跡鑑定の一助となりうる結果を示している。
【０１１６】
［効果］
以上説明した本発明の第２実施例に係る相関性評価方法、及びこれを実現するための相関性評価装置によれば、計測された力が変位を構成する第１の要素と対応づけられた第１のデータと、変位を構成する第２の要素が第１の要素と対応づけられた第２のデータとを、複数回の計測に係る人の動作に対応づけて複数個、記憶装置９２に格納し、第１のデータ間の相関性と、第２のデータ間の相関性に基づいて、複数回の計測に係る人の動作間の相関性を評価するため、力及び位置に関する複数の収集データの相関性を適切に評価することができる。
【０１１７】
なお、図２１は、本実施例に係る相関性評価装置の概念図である。
【０１１８】
＜＜第３実施例＞＞
ところで、（特開２００９−２７９６９９号公報）では、人が特定の物体に対して行った動作を再現するために、位置と力の情報を保存している。この結果、初期位置が異なる場合に、位置や力の変化が再現されない場合があった。
【０１１９】
本実施例に係る動作再現装置は、係る課題を解決することを主要な目的とする。
【０１２０】
［構成］
図２２は、本実施例に係る動作再現装置３００の概念を示す図である。図示するように、動作再現装置３００は、マスターシステム３１０とスレーブシステム３２０を有し、スレーブシステム３２０から入力されたデータを保存するモーションデータメモリ３５０を備える。そして、人がマスターシステムの被操作体３１２に対して行った動作による当該被操作体３１２の位置や力の変化を、スレーブシステム３２０の可動体３２２が再現するように制御される。また、所望のタイミングで、過去にモーションデータメモリ３５０に格納された可動体３２２の動作を再現するように、可動体３２２が駆動される。
【０１２１】
被操作体３１２、及び可動体３２２には、それぞれアクチュエータが取り付けられている。被操作体３１２に取り付けられたアクチュエータは、可動体３２２が環境から受ける反力を被操作体３１２に伝えるように制御される。なお、被操作体３１２は、その長手方向に移動可能となっている。一方、可動体３２２に取り付けられたアクチュエータは、被操作体３１２に対してなされた操作を再現するように可動体３２２を駆動する。
【０１２２】
また、被操作体３１２、及び可動体３２２には、それぞれ位置エンコーダが取り付けられており、それぞれの位置や加速度を測定可能となっている。
【０１２３】
被操作体３１２、及び可動体３２２は、バイラテラル制御部によって同じ動作をするように制御される。これによって、被操作体を操作する操作者は、スレーブ側の環境の感触を知覚できる。
【０１２４】
図２３は、本実施例におけるバイラテラル制御を周波数領域で表現したブロック線図である。図中の符号や添え字は、第１実施例や第２実施例で用いたものと同様である。例えば、図中「Ｑ2」は、第２実施例で説明したQuarry行列（クオリー行列）である。
【０１２５】
マスターシステム３１０とスレーブシステム３２０は、それぞれ外乱オブザーバ３４２と反力推定オブザーバ３４４を備えている。図２４は、外乱オブザーバ３４２と反力推定オブザーバ３４４の構成を周波数領域で表現したブロック線図である。
【０１２６】
本実施例において、作業空間における加速度、力の等価加速度は、Quarry行列を用いて、次式（３２）、（３３）で示すように、差のモード空間、和のモード空間に座標変換される。
【０１２７】
【数１７】
【０１２８】
そして、バイラテラル制御の加速度次元における目標式は、次式（３４）、（３５）で表される。
【０１２９】
【数１８】
【０１３０】
上式（３５）における矢印は、２階微分された位置が零になることを示している。従って、和のモードにおける加速度参照値ｘ・・Crefと、差のモードにおける加速度参照値ｘ・・Drefは、次式（３６）、（３７）によって求められる。式中の符号や添え字は、第１実施例や第２実施例で用いたものと同様である。
【０１３１】
【数１９】
【０１３２】
マスター・スレーブシステムにおける加速度参照値は、Quarry逆行列Ｑ2-1を和のモード空間、差のモード空間に適用して、次式（３８）によって求められる。
【０１３３】
【数２０】
【０１３４】
上記のようにして逆変換されたマスターの加速度参照値ｘ・・Mrefとスレーブの加速度参照値ｘ・・Srefにより、各アクチュエータが制御される。このようなシステムを用いることにより、マスター・スレーブ間で透明性の高いバイラテラル制御が可能となる。
【０１３５】
［動作の保存］
ここで、（特開２００９−２７９６９９号公報）に記載の方法、装置では、マスターシステム３１０における被操作体３１２の位置ｘMresと、加えられた力Ｆ＾Mextを保存していた。ところが、この場合、環境との相対位置等の初期条件が異なる場合に、動作を余り正確に再現することができない場合がある。環境からの反力が存在すべき位置に対象物がない場合に、力を出力することができない等の場面が想定されるからである。
【０１３６】
これに対し、本実施例では、スレーブシステム３２０における加速度参照値ｘ・・Srefを、モーションデータメモリ３５０に保存することにしている。上式（３６）〜（３８）より、保存時のスレーブシステム３２０における加速度参照値ｘ・・Srefは、保存時におけるマスターシステム３１０及びスレーブシステム３２０の状態を反映している。これによって、保存時と再現時の環境の位置が異なる場合でも、環境からの反力が等しくなった時点から動作の正確な再現が可能となる。次式（３９）に示すように、保存時と再現時の環境からの反力の等価電流が等しくなったときに、アクチュエータにかかる電流値が等しくなり、その時点からの再現動作は、保存時の環境に対する動作と等しくなるからである。なお、式中、添え字ｓｖは保存時の値を、ｌｄは再現時の値をそれぞれ示している。
【０１３７】
【数２１】
【０１３８】
また、加速度参照値ｘ・・Srefのみを保存することにより、データの保存量を削減することもできる。
【０１３９】
［実験］
本出願の発明者は、本発明の有用性を実証するための実験を行っている。以下にその結果を示す。まず、（Ａ）保存時と再現時が同じ環境である場合について実験を行い、次に、保存時と再現時で異なる環境である場合において、（Ｂ）従来の構成によって再現した場合と、（Ｃ）本実施例の構成によって再現した場合について実験を行った。（Ｂ）、（Ｃ）においては、再現時における環境（障害物）の位置を、保存時に比して６［ｍｍ］遠くに配置した。
【０１４０】
図２５は、保存時のマスターシステム３１０における位置と力（応答値；以下同じ）の変化を示しており、図２６は、上記（Ａ）の場合の本実施例の構成による再現時のスレーブシステム３２０における位置と力の変化を示している。図２６により、同じ環境下での正確な動作再現が可能であることが判る。
【０１４１】
一方、図２７は、図２５で示したような保存時の位置と力の変化に対して、従来の構成によって再現した場合の、スレーブシステム３２０における位置と力の変化を示している（上記（Ｂ））。図示するように、従来の構成では、十分な力を再現することができず、また、環境に当接して押圧すべき場面で位置が戻ってしまうという現象も見られる。
【０１４２】
これに対し、図２８は、図２５で示したような保存時の位置と力の変化に対して、本実施例の構成によって再現した場合の、スレーブシステム３２０における位置と力の変化を示している（上記（Ｃ））。図示するように、本実施例の構成では、環境に可動体３２２が到達した後は、保存時とほぼ同様の力を再現することができている。
【０１４３】
なお、図２７、２８では、保存時のマスターシステム３１０における位置と力の変化を仮想マスターとして併記した。
【０１４４】
［効果］
以上説明した本実施例の動作再現装置３００によれば、初期位置が異なる場合であっても、位置や力の変化を、より正確に再現することができる。
【０１４５】
［構成の他の表現、及び応用］
なお、図２９は、本実施例の動作再現装置３００を、他の態様で表現した機能ブロック図である。
【０１４６】
動作再現装置３００は、前述のようにマスターシステム３１０とスレーブシステム３２０を有し、更に、アクチュエータ制御部３３０を備える。
【０１４７】
マスターシステム３１０は、被操作体３１２に取り付けられたアクチュエータを駆動するアクチュエータ駆動部３１４と、位置エンコーダ３１６と、を備える。スレーブシステム３２０は、可動体３２２に取り付けられたアクチュエータを駆動するアクチュエータ駆動部３２４と、位置エンコーダ３２６と、を備える。
【０１４８】
アクチュエータ制御部３３０は、前述のようなバイラテラル制御を行うバイラテラル制御部３４０を有し、バイラテラル制御部３４０は、外乱オブザーバ３４２、加速度制御部３４６その他の構成を有している。そして、アクチュエータ制御部３３０には、モーションデータメモリ３５０が接続されている。
【０１４９】
本実施例の動作再現装置３００は、例えばドリルを用いた穴あけ技術の保存に用いられる。従来の装置による動作再現（位置、力を保存する場合）では、初期位置と環境位置までの距離が厳密に一致する場合のみ動作の再現が可能であったが、本実施例の動作再現装置３００では、初期位置と環境位置までの距離が厳密に一致する場合でなくとも動作を概ね再現することができる。
【０１５０】
以上、本発明を実施するための最良の形態について実施例を用いて説明したが、本発明はこうした実施例に何等限定されるものではなく、本発明の要旨を逸脱しない範囲内において種々の変形及び置換を加えることができる。
【０１５１】
例えば、第３実施例において、加速度に関する情報の一例として、加速度参照値ｘ・・Srefを保存するものとしたが、これに代えて、アクチュエータに印加される電流値等を保存してもよい、すなわち、加速度を示す如何なる情報を保存しても構わない。
【符号の説明】
【０１５２】
１、２ 相関性評価装置
１０ ハプティックペン
１２ 軸体
１４、６０ 把持部
１６ リニアモータ
２０ 外乱オブザーバ
３０ 情報処理装置
３２ 記憶装置
３４ 正規化隣接行列算出部
３６ 固有ベクトル算出部
５０ ハプティックペン
５２ リニアモータ
５４、５６ 位置エンコーダ
５８ 本体部
６０ 把持部
７０、７２ 外乱オブザーバ
８０、８２ 反力オブザーバ
９０ 情報処理装置
９２ 記憶装置
３００ 動作再現装置
３１０ マスターシステム
３１２ 被操作体
３１４ アクチュエータ駆動部
３１６ 位置エンコーダ
３２０ スレーブシステム
３２２ 可動体
３２４ アクチュエータ駆動部
３２６ 位置エンコーダ
３３０ アクチュエータ制御部
３４０ バイラテラル制御部
３４２ 外乱オブザーバ
３４４ 反力推定オブザーバ
３４６ 加速度制御部
３５０ モーションデータメモリ
【技術分野】
【０００１】
本発明は、力を計測した時系列データの他のデータとの相関性を評価する相関性評価方法、及びこの方法を実現するための装置、更には、人が特定の物体に対して操作による当該物体の動作を再現する動作装置に関する。
【背景技術】
【０００２】
近年、ロボットや電機統合システムを用いて人間を支援するシステムの開発が行われており、係るシステムにおいては、人間の特徴的な動作を抽出することが重要なテーマとなっている。
【０００３】
人間の動作に関する情報のうち位置の変化情報については、モーションキャプチャと称される技術が存在し、動作における空間位置情報の抽出が可能となっている。例えば、踊りの動作等を抽出し、その空間情報を再現可能なロボットシステムの開発等が行われている。
【０００４】
ところが、人間の動作は位置情報のみならず、各位置において作用した力の情報も含まれるべきものである。特に、熟練技能者のスキルや技術の特徴を抽出するためには、力加減に関する情報が抽出されることが望ましい。
【０００５】
このような観点から、時系列な位置情報と力の接触情報を取得し、これを解析して再現する位置、力再現方法等についての発明が開示されている（例えば、特許文献１参照）。
【先行技術文献】
【特許文献】
【０００６】
【特許文献１】特開２００９−２７９６９９号公報
【発明の概要】
【発明が解決しようとする課題】
【０００７】
しかしながら、上記従来の方法等では、複数のデータを収集し、それらの相関性について評価することについては考慮されていない。従って、力に関する複数の収集データの相関性を適切に評価することができない。
【０００８】
本発明はこのような課題を解決するためのものであり、力に関する複数の収集データの相関性を適切に評価することが可能な相関性評価方法、及び装置等を提供することを、主たる目的とする。
【課題を解決するための手段】
【０００９】
上記目的を達成するための本発明の第１の態様は、
人が特定の物体に対して所定の動作をする際に加えられる力を複数回計測するステップと、
前記計測された力の時系列データを複数個、記憶手段に格納するステップと、
前記記憶手段に格納された力の時系列データを標本とし、該時系列データ間の相関性を示す値で重み付けした隣接行列を求めるステップと、
前記隣接行列を正規化した正規化隣接行列を求めるステップと、
前記正規化隣接行列の固有値が１となる場合の固有ベクトルの要素の大きさに基づいて、該要素に対応する時系列データの他のデータとの相関性を評価するステップと、
を備えることを特徴とする相関性評価方法である。
【００１０】
この本発明の第１の態様によれば、力に関する複数の収集データの相関性を適切に評価することができる。
【００１１】
本発明の第２の態様は、
人が特定の物体に対して所定の動作をする際に加えられる力と、前記特定の物体の変位を複数回計測するステップと、
前記計測された力が前記計測された変位を構成する第１の要素と対応づけられた第１のデータと、前記計測された変位を構成する第２の要素が前記計測された変位を構成する第１の要素と対応づけられた第２のデータとを、前記複数回の計測に係る人の動作に対応づけて複数個、記憶手段に格納するステップと、
前記第１のデータ間の相関性と、前記第２のデータ間の相関性に基づいて、前記複数回の計測に係る人の動作間の相関性を評価するステップと、
を備えることを特徴とする相関性評価方法である。
【００１２】
この本発明の第２の態様によれば、力に関する複数の収集データの相関性を適切に評価することができる。
【００１３】
この場合、
前記複数回の計測に係る人の動作間の相関性を示す値で重み付けした隣接行列を求めるステップと、
前記隣接行列を正規化した正規化隣接行列を求めるステップと、
前記正規化隣接行列の固有値が１となる場合の固有ベクトルの要素の大きさに基づいて、該要素に対応する人の動作の、他の動作との相関性を評価するステップと、
を備えることを特徴とするものとしてもよい。
【００１４】
本発明の第１又は第２の態様において、
前記特定の物体は筆記具又は筆記具に擬した物体であり、
前記人がする所定の動作は、筆記動作であり、
前記計測される力は、筆圧に相当する力であるものとしてもよい。
【００１５】
筆記具又は筆記具に擬した物体を特定の物体とする本発明の第２の態様において、
前記所定の動作は、円を描く筆記動作であり、
前記第１の要素は、角度変化であり、
前記第２の要素は、前記円の想定中心からの距離であるものとしてもよい。
【００１６】
本発明の第３の態様は、
人が特定の物体に対して所定の動作をする際に加えられる力を計測する計測手段と、
前記計測手段により計測された力の時系列データが複数個、格納される記憶手段と、
前記記憶手段に格納された力の時系列データを標本とし、該時系列データ間の相関性を示す値で重み付けした隣接行列を算出し、該隣接行列を正規化した正規化隣接行列を算出する正規化隣接行列算出手段と、
前記正規化隣接行列算出手段により算出された正規化隣接行列の固有値が１となる場合の固有ベクトルを算出する固有ベクトル算出手段と、
を備えることを特徴とする相関性評価装置である。
【００１７】
この本発明の第３の態様によれば、力に関する複数の収集データの相関性を適切に評価することができる。
【００１８】
本発明の第４の態様は、
人が特定の物体に対して所定の動作をする際に加えられる力と、前記特定の物体の変位を計測する計測手段と、
前記計測された力が前記計測された変位を構成する第１の要素と対応づけられた第１のデータと、前記計測された変位を構成する第２の要素が前記計測された変位を構成する第１の要素と対応づけられた第２のデータとが、前記計測された人の動作に対応づけられて記憶される記憶手段と、
前記第１のデータ間の相関性と、前記第２のデータ間の相関性に基づいて、人の動作間の相関性を評価する評価手段と、
を備えることを特徴とする相関性評価装置である。
【００１９】
この本発明の第４の態様によれば、力に関する複数の収集データの相関性を適切に評価することができる。
【００２０】
この場合、
前記人の動作間の相関性を示す値で重み付けした隣接行列を算出し、該隣接行列を正規化した正規化隣接行列を算出する正規化隣接行列算出手段と、
前記正規化隣接行列の固有値が１となる場合の固有ベクトルを算出する固有ベクトル算出手段と、
を備えることを特徴とするものとしてもよい。
【００２１】
本発明の第３又は第４の態様において、
前記特定の物体は筆記具又は筆記具に擬した物体であり、
前記人がする所定の動作は、筆記動作であり、
前記計測される力は、筆圧に相当する力であるものとしてもよい。
筆記具又は筆記具に擬した物体を特定の物体とする本発明の第４の態様において、
前記所定の動作は、円を描画する筆記動作であり、
前記第１の要素は、角度変化であり、
前記第２の要素は、前記円の想定中心からの距離であるものとしてもよい。
【００２２】
本発明の第５の態様は、
人が特定の物体に対して行った操作を検知し、該人が行った操作による当該物体の動作を、他の物体により再現させる動作再現装置であって、
前記他の物体における加速度に関する情報を記憶手段に記憶させ、
前記人が操作を行わない場合の動作再現においては、前記記憶手段に記憶された前記他の物体における加速度に関する情報に基づいて、前記他の物体を動作させることを特徴とする、
動作再現装置である。
【００２３】
この本発明の第５の態様によれば、初期位置が異なる場合であっても、位置や力の変化を、より正確に再現することができる。
【発明の効果】
【００２４】
本発明によれば、力に関する複数の収集データの相関性を適切に評価することが可能な相関性評価方法、及び装置等を提供することができる。
【図面の簡単な説明】
【００２５】
【図１】本発明の第１実施例に係る相関性評価装置１が有するハプティックペン１０を人が把持した様子を示す図である。
【図２】リニアモータ１６の制御系を周波数領域で表現したブロック線図である。
【図３】外乱オブザーバ２０の構成を示すブロック線図である。
【図４】有向グラフによるシステム結合の例を示す図である。
【図５】第１実施例の相関性評価装置１が実行する特徴的な処理の流れを示すフローチャートである。
【図６】各回において計測された力（筆圧）の変化を示す図である。
【図７】導出された隣接行列ＡGの各要素を示す図である。
【図８】本発明の第２実施例に係る相関性評価装置２が有するハプティックペン５０を人が把持した様子を示す図である。
【図９】第２実施例におけるバイラテラル制御を周波数領域で表現したブロック線図である。
【図１０】外乱オブザーバ７０、７２の構成を示すブロック線図である。
【図１１】力、半径、角度の関係を示す図である。
【図１２】第２実施例の相関性評価装置２が実行する特徴的な処理の流れを示すフローチャートである。
【図１３】第２実施例の実験に係る実験パラメータを示す図である。
【図１４】被験者Ａが円を描画した際の実験結果を、左から順に３次元グラフ、位置に関する結果、力に関する結果の形式で示したものである。
【図１５】被験者Ａが円を描画した際の実験結果を、左から順に３次元グラフ、位置に関する結果、力に関する結果の形式で示したものである。
【図１６】被験者Ｂが円を描画した際の実験結果を、左から順に３次元グラフ、位置に関する結果、力に関する結果の形式で示したものである。
【図１７】被験者Ｂが円を描画した際の実験結果を、左から順に３次元グラフ、位置に関する結果、力に関する結果の形式で示したものである。
【図１８】位置に関する相関性（上記Ｒp）を要素間で求めた結果を示す行列である。
【図１９】力に関する相関性（上記Ｒf）を要素間で求めた結果を示す行列である。
【図２０】位置に関する相関性と力に関する相関性を総合した結果を示す行列である。
【図２１】第２実施例に係る相関性評価装置の概念図である。
【図２２】第３実施例に係る動作再現装置３００の概念を示す図である。
【図２３】第３実施例におけるバイラテラル制御を周波数領域で表現したブロック線図である。
【図２４】外乱オブザーバ３４２と反力推定オブザーバ３４４の構成を周波数領域で表現したブロック線図である。
【図２５】保存時のマスターシステム３１０における位置と力（応答値；以下同じ）の変化を示す図である。
【図２６】第３実施例の構成による再現時のスレーブシステム３２０における位置と力の変化を示す図である。
【図２７】従来の構成によって再現した場合の、スレーブシステム３２０における位置と力の変化を示す図である。
【図２８】第３実施例の構成による再現時のスレーブシステム３２０における位置と力の変化を示す図である。
【図２９】第３実施例の動作再現装置３００を、他の態様で表現した機能ブロック図である。
【発明を実施するための形態】
【００２６】
以下、本発明を実施するための形態について、添付図面を参照しながら実施例を挙げて説明する。
【実施例】
【００２７】
＜＜第１実施例＞＞
以下、図面を参照し、本発明の第１実施例に係る相関性評価方法、及びこれを実現するための相関性評価装置について説明する。本実施例の相関性評価方法は、人の筆記動作における力加減を計測して記憶装置に記憶させ、記憶された複数のデータの中から定量的な動作の評価を行うことにより、最も標準的な動作を抽出することを最終的な目的としている。
【００２８】
本実施例の相関性評価方法は、係る定量的な動作の評価において、グラフ理論における隣接行列（重み付けのあるもの）を用いている点が特徴的である。
【００２９】
［構成］
図１は、本発明の第１実施例に係る相関性評価装置１が有するハプティックペン１０を人が把持した様子を示す図である。図示するように、ハプティックペン１０は、筆記具に擬した形状をしており、机に置かれた紙等の平面に当接するペン先に擬した先端部を有する長棒形状の軸体１２と、軸体１２に対してその長手方向（図中、Ｘ方向）に相対移動可能な把持部１４と、を備える。なお、先端部には、現実に筆記可能な部材（筆、黒鉛、小型ボールペン等）が取り付けられてよい。
【００３０】
把持部１４は、リニアモータ１６を内蔵しており、可動子が軸体１２に連結されている。従って、把持部１４は、軸体１２に対して図１におけるＸ方向に、所望の力を出力可能となっている。これによって、人が筆記動作をする際に生じる筆圧に対して反力を出力することができる。
【００３１】
図２は、リニアモータ１６の制御系を周波数領域で表現したブロック線図である。図中、「ｓ」はラプラス演算子である。また、「・」は１階の微分を表し、「＾」は推定値を表している。以下の説明においてこれらを表現する場合、必要に応じて記号中に「・」、「・・」（２階の微分）、「＾」等を挿入する。
【００３２】
ここで、パラメータ「Ｋp」は位置に対するゲインであり、「Ｋv」は速度に対するゲインである。また、パラメータ「ｇpd」は擬似微分のカットオフ周波数であり、「ｇ」は重力である。また、「Ｋt」はリニアモータ１６の推力定数であり、添え字の「n」はノミナル値を示している。更に、「Ｍ」は軸体１２の質量を示している。
【００３３】
本実施例の相関性評価装置１では、軸体１２と把持部１４の相対位置が基準位置に固定されるように、リニアモータ１６がフィードバック制御される。軸体１２と把持部１４の相対位置（位置応答値）はパラメータ「ｘres」で表現されており、「ｘres」が値ゼロとなるようにリニアモータ１６の電流制御がなされる。「ｘres」及びその変化（速度）に基づいて決定される、リニアモータ１６に供給される電流の仮電流参照値は、「Ｉref」で示されている。
【００３４】
更に、本実施例の相関性評価装置１は、外乱に対する補償を行うと共に、環境反力（＝筆圧）を推定するための外乱オブザーバ２０を備えている。
【００３５】
図３は、外乱オブザーバ２０の構成を示すブロック線図である。ここで、パラメータ「ｇd」は外乱オブザーバ２０のカットオフ周波数であり、「ｇr」は反力オブザーバのカットオフ周波数である。
【００３６】
物体が環境に及ぼす推定外乱Ｆ＾disは、次式（１）のように推定される。本実施例では、粘性による外乱が小さく、ハプティックペン１０を垂直に立てた状態で筆記するものと仮定する。
【００３７】
【数１】
【００３８】
そして、ｇrとｇdが等しいものと仮定すると、環境反力Ｆ＾envは、次式（２）のように推定される。このように推定された環境反力Ｆ＾envが、人の及ぼす力（筆圧）に相当する。
【００３９】
【数２】
【００４０】
また、リニアモータ１６に供給される電流の電流参照値「Ｉrefa」は、仮電流参照値「Ｉref」に電流補償値「Ｉcmp」を加算して求められる。
【００４１】
係る構成によって、位置応答値「ｘres」から筆圧（力）情報を導出することが可能となり、圧力センサ等を備えることなく人の力を測定することができる。
【００４２】
環境反力Ｆ＾envは、ハプティックペン１０にケーブル接続され、又はBluetooth（登録商標）等の無線通信によって接続された記憶装置３２に時系列データ（一定期間、環境反力Ｆ＾envが所定周期でサンプリングされたデータ）として格納される。そして、以下に説明するように、情報処理装置３０によって相対性評価が行われる。
【００４３】
［相対性評価］
情報処理装置３０は、例えば、ＣＰＵ（Central Processing Unit）を中心として、ＲＯＭ（Read Only Memory）やＲＡＭ（Random Access Memory）、Ｉ／Ｏポート等がバスによって接続されたマイクロコンピュータであり、ＥＥＰＲＯＭ（Electrically Erasable and Programmable Read Only Memory）やフラッシュメモリ等の記憶装置３２を内蔵している。
【００４４】
情報処理装置３０は、グラフ理論における隣接行列を用いて時系列データの他のデータとの相関性を評価している。
【００４５】
また、情報処理装置３０は、係る相関性評価のために、図示しないプログラムメモリに記憶されたプログラムをＣＰＵが実行することにより実現される機能ブロックとして、正規化隣接行列算出部３４と、固有ベクトル算出部３６と、を備える。
【００４６】
ここで、グラフ理論における隣接行列について説明する。図４は、有向グラフによるシステム結合の例を示す図である。図中、要素Ａから要素Ｃに向かう矢印は、要素Ａが要素Ｃにリンクしていることを示している。図４に示す関係を隣接行列ＡGで表すと、次式（３）のようになる。
【００４７】
【数３】
【００４８】
上記の隣接行列には、重み付けがなされておらず、全ての要素が１となっている。本実施例の情報処理装置３０では、更に、データ間の相関性を示す値（以下、相関係数と称する）で重み付けした隣接行列を算出する。なお、以下ではリンクの向きは考慮しないものとする。従って、隣接行列ＡGは対角行列となる。
【００４９】
本実施例の情報処理装置３０で扱う隣接行列ＡGは、例えば次式（４）のようになる。ここでは、時系列データの個数が３個であるものとしている。
【００５０】
【数４】
【００５１】
上式（４）において、Ｃijは、要素ｉと要素ｊの間の相関係数を表している。それぞれのＣijは、次式（５）〜（１０）によって計算される。式中、「Ｆｉ（ｔ＋ｍ）」は、時系列データの開始時刻から時間ｔ経過した時刻を基準とし、ｍ番目にサンプリングされたデータ（Ｆ＾dis）を示している。また、「Ｆｉ（上側に横棒）（ｔ）」は、時系列データの開始時刻から時間ｔ経過した時刻を基準とし、その時刻以降にサンプリングされたデータ（Ｆ＾dis）の平均値である。また、「ｋ」は、時系列データの個数であり、Ｃij（ｔ）は時系列データの開始時刻から時間ｔ経過した時刻における要素ｉと要素ｊの間の相関係数である。
【００５２】
本実施例では、変数ｔを色々と変化させ、最大値となったＣij（ｔ）をＣijとする。
【００５３】
このようにして隣接行列ＡGが生成されると、各列和を１として正規化を行い、推移確率行列（特許請求の範囲における「正規化隣接行列」に相当する）Ｍを、次式（１１）によって算出する。
【００５４】
【数５】
【００５５】
推移確率行列Ｍは正規化されているため、最大固有値は１である。情報処理装置３０では、固有値が１である場合の固有ベクトルを算出する。具体的には、固有値が１である場合の固有値と固有ベクトルの関係は次式（１２）によって規定されているため、上式（１１）を次式（１２）に代入することにより、次式（１３）を得る。
【００５６】
【数６】
【００５７】
上式（１３）におけるｘ1は、１番目の時系列データの相対的な他のデータとの相関性を示す値である。同様に、ｘ2は、２番目の時系列データの相対的な他のデータとの相関性を示す値であり、ｘ3は、３番目の時系列データの相対的な他のデータとの相関性を示す値である。
【００５８】
従って、ｘ1〜ｘ3のうち最も大きいものに対応する時系列データが、最も代表的なデータであるといえる。本実施例の情報処理装置３０では、この最も代表的なデータを、最も標準的な動作を示すものとして出力する。
【００５９】
なお、上記ｘ1〜ｘ3は、「相対的な他のデータとの相関性を示す値」であり、要素数等によって変動するため、これをより定量的な値とするために、下限値として全く筆記動作をしなかった場合の被比較データを１つ挿入してよい。そして、被比較データに相当するｘｎとの差分を求めることによって、より定量的な値を取得し、これを出力してもよい。次式（１４）は、係る場合の各時系列データと他のデータとの相関性を示す値を取得するためのものである。本式においては、ｘ3が、全く筆記動作をしなかった場合の被比較データに相当する。
【００６０】
【数７】
【００６１】
［処理フロー］
以下、本実施例の相関性評価装置１が行う処理の流れについて説明する。図５は、本実施例の相関性評価装置１が実行する特徴的な処理の流れを示すフローチャートである。
【００６２】
まず、ハプティックペン１０を用いて人が筆記動作を行い、その際の力（筆圧）を計測し（Ｓ１００）、計測値をサンプリングしたものを時系列データとして記憶装置３２に格納する（Ｓ１０２）。係る処理は、複数回に亘って行われる。
【００６３】
そして、全く筆記動作をしなかった場合の被比較データを１つ挿入する（Ｓ１０４）。
【００６４】
次に、記憶装置３２に格納された力の時系列データを標本とし、時系列データ間の相関性を示す値で重み付けした隣接行列を求める（Ｓ１０６）。
【００６５】
次に、隣接行列を正規化した正規化隣接行列を求める（Ｓ１０８）。Ｓ１０６及びＳ１０８の処理は、正規化隣接行列算出部３４によって行われる。
【００６６】
なお、記憶装置３２に格納された力の時系列データのうち一部は、予め格納された過去のデータであっても構わない。
【００６７】
そして、正規化隣接行列の固有値が１となる場合の固有ベクトルを算出し（Ｓ１１０）、固有ベクトルの要素の大きさに基づいて、この要素に対応する時系列データの他のデータとの相関性を評価する（Ｓ１１２）。具体的には、要素が最も大きいものに対応する時系列データを最も代表的なデータであるとして出力する。同時に、要素の大きさを、その時系列データの得点として出力してもよい。なお、正規化隣接行列の固有値が１となる場合の固有ベクトルは、固有ベクトル算出部３６によって行われる。
【００６８】
［利用例］
なお、最も代表的なデータを手本データとし、他の任意の時系列データとの相関性を求めることもできる。この場合、予め図５で説明したようなフローによって出力された時系列データを１番目のデータとし、他の任意の時系列データを２番目のデータとする。そして、全く筆記動作をしなかった場合の被比較データを３番目のデータとする。
【００６９】
こうして得られる上式（１４）のような結果に対し、ｘ1を値１とするような乗算を行う。その結果、手本データを１（１００点）とした場合に、他の任意の時系列データがどれだけ似通っているかを示す指標値を得ることができる。次式（１５）は、係る指標値（ｘ2／ｘ1）が得られる様子を示している。
【００７０】
【数８】
【００７１】
［実験］
本出願の発明者は、本発明の有用性を実証するための実験を行っている。以下にその結果を示す。本実験では、時系列データの数を６個としている。但し、前述のように、全く筆記動作をしなかった場合の被比較データを１つ挿入するため、筆記動作を行った場合の時系列データの数は５個である。
【００７２】
人は、ハプティックペン１０を用いて「あ」の文字を５回筆記した。一回の筆記に要する時間は１５［秒］とし、データ量を１５［秒］で固定した。
【００７３】
図６の各図は、各回において計測された力（筆圧）の変化を示す図である。これらのデータに対して前述のように隣接行列ＡGを生成し、これを正規化した後に、固有値が１となる場合の固有ベクトルを導出した。次式（１６）は、本実験において生成される隣接行列ＡGのモデルを示しており、図７は、導出された隣接行列ＡGの各要素を示す図である。
【００７４】
【数９】
【００７５】
そして、導出された固有ベクトルは次式（１７）のようになり、６番目の要素を引き算したベクトルは次式（１８）のようになる。
【００７６】
【数１０】
【００７７】
上式（１８）より、最も代表的な時系列データは、１番目に格納されたデータであることが判る。
【００７８】
［効果］
以上説明した本発明の第１実施例に係る相関性評価方法、及びこれを実現するための相関性評価装置によれば、記憶装置３２に格納された力の時系列データを標本とし、時系列データ間の相関性を示す値で重み付けした隣接行列、及びこれを正規化した正規化隣接行列を求め、正規化隣接行列の固有値が１となる場合の固有ベクトルの要素の大きさに基づいて、それぞれの要素に対応する時系列データの他のデータとの相関性を評価するため、力に関する複数の収集データの相関性を適切に評価することができる。
【００７９】
＜＜第２実施例＞＞
以下、図面を参照し、本発明の第２実施例に係る相関性評価方法、及びこれを実現するための相関性評価装置について説明する。本実施例の相関性評価方法は、人の筆記動作における力加減、及び筆記具の位置変化を計測して記憶装置に記憶させ、記憶された複数のデータ間の相関性を評価することを主要な目的としている。
【００８０】
［構成］
図８は、本発明の第２実施例に係る相関性評価装置２が有するハプティックペン５０を人が把持した様子を示す図である。本実施例のハプティックペン５０は、第１実施例とは異なり、バイラテラル制御が行われるマスター・スレーブシステムのうち一方を構成するマスターペンである。
【００８１】
ハプティックペン５０には、第１実施例と同様、図８におけるＺ方向に反力を出力すると共に筆圧に相当する力を測定可能なリニアモータ５２が取り付けられ、更に、Ｚ方向に直交するＸ方向とＹ方向の変位を測定可能な位置エンコーダ５４、５６が取り付けられている。
【００８２】
なお、ハプティックペン５０の本体部５８は剛体に固定されており、把持部６０のみが本体部５８に対してＸ，Ｙ，Ｚ方向に変位可能となっている。
【００８３】
図９は、本実施例におけるバイラテラル制御を周波数領域で表現したブロック線図である。図中、「Ｆ」は力である。また、「Ｍ」はマスターシステムを示し、「Ｓ」はスレーブシステムを示している。また、「Ｃ」は和のモードを示し、「Ｄ」は差のモードを示している。また、「ref」、「res」、「ext」は、それぞれ、参照値、応答値、外力値を示している。その他、第１実施例と共通する符号等については説明を省略する。図９で示したような構成は、Ｘ，Ｙ，Ｚ方向のそれぞれについて設けられている。
【００８４】
本実施例に係る相関性評価装置２は、マスター用及びスレーブ用の外乱オブザーバ７０、７２を備えることによりロバスト安定性を実現し、マスター用及びスレーブ用の反力オブザーバ８０、８２を備えることにより外乱中からリニアモータに受ける外力を観測可能としている。
【００８５】
図１０は、外乱オブザーバ７０、７２の構成を示すブロック線図である。ここでは、マスター用とスレーブ用を区別しない。図１０より、推定外力Ｆ＾extは、次式（１９）により表される。
【００８６】
【数１１】
【００８７】
バイラテラル制御においては、位置と力が同時に制御される。その目的は、次式（２０）、（２１）により表される。
【００８８】
【数１２】
【００８９】
これらの目的は、モード空間にQuarry行列（クオリー行列）を用いて変換することによって達成される。和のモードでは、力が制御され、差のモードでは、加速度の次元で位置が制御される。次式（２２）は、２次のQuarry行列Ｑ2を示しており、次式（２３）は、２次のQuarry逆行列Ｑ2-1を示している。
【００９０】
【数１３】
【００９１】
なお、和のモードと差のモードによる制御の詳細については、既に（特開２００９−２７９６９９号公報）等で開示されているため、詳細な説明を省略する。
【００９２】
このような構成によって、人の筆圧に相当する力（Ｆ＾Mext）やハプティックペン５０の位置（Ｚ方向には変位しないため、Ｘ方向の位置ＸMres、及びＹ方向の位置ＹMres）が把握される。
【００９３】
［相対性評価］
力Ｆ＾Mextや位置ＸMres、ＹMresは、ハプティックペン５０にケーブル接続され、又はBluetooth（登録商標）等の無線通信によって接続された記憶装置９２に一定期間、所定周期でサンプリングされたデータとして格納される。そして、以下に説明するように、情報処理装置９０によって相対性評価が行われる。
【００９４】
なお、位置についてはＸ座標、Ｙ座標として格納されてもよいが、以下の説明では想定中心からの距離（半径）、及び角度の組み合わせに変換され、すなわち極座標に変換されて格納されるものとする。従って、記憶装置９２には、力、半径、角度が対応づけられたデータとして格納される。図１１は、力、半径、角度の関係を示す図である。
【００９５】
情報処理装置９０は、例えば、第１実施例の情報処理装置３０と同様の構成を有するマイクロコンピュータであり、ＥＥＰＲＯＭ（Electrically Erasable and Programmable Read Only Memory）やフラッシュメモリ等の記憶装置９２を内蔵している。
【００９６】
情報処理装置９０は、グラフ理論における隣接行列を用いて記憶装置に格納されたデータの他のデータとの相関性を評価している。
【００９７】
本実施例の情報処理装置９０では、記憶装置９２に格納されたデータを、力と角度が対応づけられた第１のデータ、半径と角度が対応づけられた第２のデータに整理する。次式（２４）、（２５）は、第１のデータと第２のデータを、それぞれベクトル形式で示したものである。本式では、角度の分解能を２π／６２８０＝０．００１（ｒａｄ）とした。
【００９８】
【数１４】
【００９９】
相関性の評価は、第１のデータと、第２のデータのそれぞれについて行い、最終的にそれぞれの評価結果の平均値を求めることによって行う。
【０１００】
次式（２６）〜（２８）は、要素ａと要素ｂの間の、第１のデータに関する相関性を示す値Ｒfを算出するための式である。式中、ｒfa（ｉ）は、要素ａ（要素とは、ある計測回に取得された人の動作であることを示す）におけるｒfデータ（式（２４）参照）のうち、ｉ番目の値であることを意味する。
【０１０１】
【数１５】
【０１０２】
次式（２９）〜（３１）は、要素ａと要素ｂの間の第２のデータに関する相関性を示す値Ｒpを算出するための式である。式中、ｒpa（ｉ）は、要素ａにおけるｒpデータ（式（２５）参照）のうち、ｉ番目の値であることを意味する。
【０１０３】
【数１６】
【０１０４】
そして、ＲfとＲpの平均を求めることにより、要素ａと要素ｂの相関性を示す値が導出される。なお、係る処理において、重み付け等の処理を行ってもよい。
【０１０５】
Ｒab=（Ｒf＋Ｒp）／２
【０１０６】
［処理フロー］
以下、本実施例の相関性評価装置２が行う処理の流れについて説明する。図１２は、本実施例の相関性評価装置２が実行する特徴的な処理の流れを示すフローチャートである。
【０１０７】
まず、ハプティックペン５０を用いて人が円を描画し、その際の力（筆圧）及び位置を計測し（Ｓ２００）、計測値をサンプリングしたものを記憶装置９２に格納する（Ｓ２０２）。
【０１０８】
そして、力と角度に関する相関性評価と、半径と角度に関する相関性評価の双方に基づいて、要素間の相対性評価を行う（Ｓ２０４）。
【０１０９】
［利用例、応用例］
第２実施例で例示した発明は、円を描画する際の力と位置に関するものに限定されるものではない。例えば、複数回に亘って筆記された所望の文字を、直線又は曲線パーツに分解し、それぞれについて、例えば（力とＸ座標）、（Ｙ座標とＸ座標）を対応づけたデータを作成し、上記のようにパーツ毎の相関性を評価することによって、パーツ毎の筆跡鑑定を行うことが可能となる。
【０１１０】
また、第１実施例のように、正規化隣接行列算出部や固有ベクトル算出部等の機能ブロックを備え、上記Ｒabを要素とする隣接行列、正規化隣接行列を求め、固有値が１となる場合の固有ベクトルを算出することにより、代表的なデータを選出する処理を行ってもよい。
【０１１１】
［実験］
本出願の発明者は、本発明の有用性を実証するための実験を行っている。以下にその結果を示す。本実験では、被験者Ａと被験者Ｂがそれぞれ２回、円を描画した。図１３は、本実験に係る実験パラメータを示す図である。
【０１１２】
図１４及び図１５は、被験者Ａが円を描画した際の実験結果を、左から順に３次元グラフ、位置に関する結果、力に関する結果の形式で示したものである。図１４で示した結果を要素ａと称し、図１５で示した結果を要素ｂと称する。
【０１１３】
図１６及び図１７は、被験者Ｂが円を描画した際の実験結果を、左から順に３次元グラフ、位置に関する結果、力に関する結果の形式で示したものである。図１６で示した結果を要素ｃと称し、図１７で示した結果を要素ｄと称する。
【０１１４】
なお、３次元グラフにおける縦軸は、力の大きさを表している。
【０１１５】
そして、図１８は、位置に関する相関性（上記Ｒp）を要素間で求めた結果を示す行列であり、図１９は、力に関する相関性（上記Ｒf）を要素間で求めた結果を示す行列である。更に、図２０は、これらを総合した結果を示す行列である。図１８〜２０に示すように、同一人物が描画したデータである要素ａと要素ｂの間の相関、及び要素ｃと要素ｄの間の相関が明確に高くなっており、筆跡鑑定の一助となりうる結果を示している。
【０１１６】
［効果］
以上説明した本発明の第２実施例に係る相関性評価方法、及びこれを実現するための相関性評価装置によれば、計測された力が変位を構成する第１の要素と対応づけられた第１のデータと、変位を構成する第２の要素が第１の要素と対応づけられた第２のデータとを、複数回の計測に係る人の動作に対応づけて複数個、記憶装置９２に格納し、第１のデータ間の相関性と、第２のデータ間の相関性に基づいて、複数回の計測に係る人の動作間の相関性を評価するため、力及び位置に関する複数の収集データの相関性を適切に評価することができる。
【０１１７】
なお、図２１は、本実施例に係る相関性評価装置の概念図である。
【０１１８】
＜＜第３実施例＞＞
ところで、（特開２００９−２７９６９９号公報）では、人が特定の物体に対して行った動作を再現するために、位置と力の情報を保存している。この結果、初期位置が異なる場合に、位置や力の変化が再現されない場合があった。
【０１１９】
本実施例に係る動作再現装置は、係る課題を解決することを主要な目的とする。
【０１２０】
［構成］
図２２は、本実施例に係る動作再現装置３００の概念を示す図である。図示するように、動作再現装置３００は、マスターシステム３１０とスレーブシステム３２０を有し、スレーブシステム３２０から入力されたデータを保存するモーションデータメモリ３５０を備える。そして、人がマスターシステムの被操作体３１２に対して行った動作による当該被操作体３１２の位置や力の変化を、スレーブシステム３２０の可動体３２２が再現するように制御される。また、所望のタイミングで、過去にモーションデータメモリ３５０に格納された可動体３２２の動作を再現するように、可動体３２２が駆動される。
【０１２１】
被操作体３１２、及び可動体３２２には、それぞれアクチュエータが取り付けられている。被操作体３１２に取り付けられたアクチュエータは、可動体３２２が環境から受ける反力を被操作体３１２に伝えるように制御される。なお、被操作体３１２は、その長手方向に移動可能となっている。一方、可動体３２２に取り付けられたアクチュエータは、被操作体３１２に対してなされた操作を再現するように可動体３２２を駆動する。
【０１２２】
また、被操作体３１２、及び可動体３２２には、それぞれ位置エンコーダが取り付けられており、それぞれの位置や加速度を測定可能となっている。
【０１２３】
被操作体３１２、及び可動体３２２は、バイラテラル制御部によって同じ動作をするように制御される。これによって、被操作体を操作する操作者は、スレーブ側の環境の感触を知覚できる。
【０１２４】
図２３は、本実施例におけるバイラテラル制御を周波数領域で表現したブロック線図である。図中の符号や添え字は、第１実施例や第２実施例で用いたものと同様である。例えば、図中「Ｑ2」は、第２実施例で説明したQuarry行列（クオリー行列）である。
【０１２５】
マスターシステム３１０とスレーブシステム３２０は、それぞれ外乱オブザーバ３４２と反力推定オブザーバ３４４を備えている。図２４は、外乱オブザーバ３４２と反力推定オブザーバ３４４の構成を周波数領域で表現したブロック線図である。
【０１２６】
本実施例において、作業空間における加速度、力の等価加速度は、Quarry行列を用いて、次式（３２）、（３３）で示すように、差のモード空間、和のモード空間に座標変換される。
【０１２７】
【数１７】
【０１２８】
そして、バイラテラル制御の加速度次元における目標式は、次式（３４）、（３５）で表される。
【０１２９】
【数１８】
【０１３０】
上式（３５）における矢印は、２階微分された位置が零になることを示している。従って、和のモードにおける加速度参照値ｘ・・Crefと、差のモードにおける加速度参照値ｘ・・Drefは、次式（３６）、（３７）によって求められる。式中の符号や添え字は、第１実施例や第２実施例で用いたものと同様である。
【０１３１】
【数１９】
【０１３２】
マスター・スレーブシステムにおける加速度参照値は、Quarry逆行列Ｑ2-1を和のモード空間、差のモード空間に適用して、次式（３８）によって求められる。
【０１３３】
【数２０】
【０１３４】
上記のようにして逆変換されたマスターの加速度参照値ｘ・・Mrefとスレーブの加速度参照値ｘ・・Srefにより、各アクチュエータが制御される。このようなシステムを用いることにより、マスター・スレーブ間で透明性の高いバイラテラル制御が可能となる。
【０１３５】
［動作の保存］
ここで、（特開２００９−２７９６９９号公報）に記載の方法、装置では、マスターシステム３１０における被操作体３１２の位置ｘMresと、加えられた力Ｆ＾Mextを保存していた。ところが、この場合、環境との相対位置等の初期条件が異なる場合に、動作を余り正確に再現することができない場合がある。環境からの反力が存在すべき位置に対象物がない場合に、力を出力することができない等の場面が想定されるからである。
【０１３６】
これに対し、本実施例では、スレーブシステム３２０における加速度参照値ｘ・・Srefを、モーションデータメモリ３５０に保存することにしている。上式（３６）〜（３８）より、保存時のスレーブシステム３２０における加速度参照値ｘ・・Srefは、保存時におけるマスターシステム３１０及びスレーブシステム３２０の状態を反映している。これによって、保存時と再現時の環境の位置が異なる場合でも、環境からの反力が等しくなった時点から動作の正確な再現が可能となる。次式（３９）に示すように、保存時と再現時の環境からの反力の等価電流が等しくなったときに、アクチュエータにかかる電流値が等しくなり、その時点からの再現動作は、保存時の環境に対する動作と等しくなるからである。なお、式中、添え字ｓｖは保存時の値を、ｌｄは再現時の値をそれぞれ示している。
【０１３７】
【数２１】
【０１３８】
また、加速度参照値ｘ・・Srefのみを保存することにより、データの保存量を削減することもできる。
【０１３９】
［実験］
本出願の発明者は、本発明の有用性を実証するための実験を行っている。以下にその結果を示す。まず、（Ａ）保存時と再現時が同じ環境である場合について実験を行い、次に、保存時と再現時で異なる環境である場合において、（Ｂ）従来の構成によって再現した場合と、（Ｃ）本実施例の構成によって再現した場合について実験を行った。（Ｂ）、（Ｃ）においては、再現時における環境（障害物）の位置を、保存時に比して６［ｍｍ］遠くに配置した。
【０１４０】
図２５は、保存時のマスターシステム３１０における位置と力（応答値；以下同じ）の変化を示しており、図２６は、上記（Ａ）の場合の本実施例の構成による再現時のスレーブシステム３２０における位置と力の変化を示している。図２６により、同じ環境下での正確な動作再現が可能であることが判る。
【０１４１】
一方、図２７は、図２５で示したような保存時の位置と力の変化に対して、従来の構成によって再現した場合の、スレーブシステム３２０における位置と力の変化を示している（上記（Ｂ））。図示するように、従来の構成では、十分な力を再現することができず、また、環境に当接して押圧すべき場面で位置が戻ってしまうという現象も見られる。
【０１４２】
これに対し、図２８は、図２５で示したような保存時の位置と力の変化に対して、本実施例の構成によって再現した場合の、スレーブシステム３２０における位置と力の変化を示している（上記（Ｃ））。図示するように、本実施例の構成では、環境に可動体３２２が到達した後は、保存時とほぼ同様の力を再現することができている。
【０１４３】
なお、図２７、２８では、保存時のマスターシステム３１０における位置と力の変化を仮想マスターとして併記した。
【０１４４】
［効果］
以上説明した本実施例の動作再現装置３００によれば、初期位置が異なる場合であっても、位置や力の変化を、より正確に再現することができる。
【０１４５】
［構成の他の表現、及び応用］
なお、図２９は、本実施例の動作再現装置３００を、他の態様で表現した機能ブロック図である。
【０１４６】
動作再現装置３００は、前述のようにマスターシステム３１０とスレーブシステム３２０を有し、更に、アクチュエータ制御部３３０を備える。
【０１４７】
マスターシステム３１０は、被操作体３１２に取り付けられたアクチュエータを駆動するアクチュエータ駆動部３１４と、位置エンコーダ３１６と、を備える。スレーブシステム３２０は、可動体３２２に取り付けられたアクチュエータを駆動するアクチュエータ駆動部３２４と、位置エンコーダ３２６と、を備える。
【０１４８】
アクチュエータ制御部３３０は、前述のようなバイラテラル制御を行うバイラテラル制御部３４０を有し、バイラテラル制御部３４０は、外乱オブザーバ３４２、加速度制御部３４６その他の構成を有している。そして、アクチュエータ制御部３３０には、モーションデータメモリ３５０が接続されている。
【０１４９】
本実施例の動作再現装置３００は、例えばドリルを用いた穴あけ技術の保存に用いられる。従来の装置による動作再現（位置、力を保存する場合）では、初期位置と環境位置までの距離が厳密に一致する場合のみ動作の再現が可能であったが、本実施例の動作再現装置３００では、初期位置と環境位置までの距離が厳密に一致する場合でなくとも動作を概ね再現することができる。
【０１５０】
以上、本発明を実施するための最良の形態について実施例を用いて説明したが、本発明はこうした実施例に何等限定されるものではなく、本発明の要旨を逸脱しない範囲内において種々の変形及び置換を加えることができる。
【０１５１】
例えば、第３実施例において、加速度に関する情報の一例として、加速度参照値ｘ・・Srefを保存するものとしたが、これに代えて、アクチュエータに印加される電流値等を保存してもよい、すなわち、加速度を示す如何なる情報を保存しても構わない。
【符号の説明】
【０１５２】
１、２ 相関性評価装置
１０ ハプティックペン
１２ 軸体
１４、６０ 把持部
１６ リニアモータ
２０ 外乱オブザーバ
３０ 情報処理装置
３２ 記憶装置
３４ 正規化隣接行列算出部
３６ 固有ベクトル算出部
５０ ハプティックペン
５２ リニアモータ
５４、５６ 位置エンコーダ
５８ 本体部
６０ 把持部
７０、７２ 外乱オブザーバ
８０、８２ 反力オブザーバ
９０ 情報処理装置
９２ 記憶装置
３００ 動作再現装置
３１０ マスターシステム
３１２ 被操作体
３１４ アクチュエータ駆動部
３１６ 位置エンコーダ
３２０ スレーブシステム
３２２ 可動体
３２４ アクチュエータ駆動部
３２６ 位置エンコーダ
３３０ アクチュエータ制御部
３４０ バイラテラル制御部
３４２ 外乱オブザーバ
３４４ 反力推定オブザーバ
３４６ 加速度制御部
３５０ モーションデータメモリ
【特許請求の範囲】
【請求項１】
人が特定の物体に対して所定の動作をする際に加えられる力を複数回計測するステップと、
前記計測された力の時系列データを複数個、記憶手段に格納するステップと、
前記記憶手段に格納された力の時系列データを標本とし、該時系列データ間の相関性を示す値で重み付けした隣接行列を求めるステップと、
前記隣接行列を正規化した正規化隣接行列を求めるステップと、
前記正規化隣接行列の固有値が１となる場合の固有ベクトルの要素の大きさに基づいて、該要素に対応する時系列データの他のデータとの相関性を評価するステップと、
を備えることを特徴とする相関性評価方法。
【請求項２】
人が特定の物体に対して所定の動作をする際に加えられる力と、前記特定の物体の変位を複数回計測するステップと、
前記計測された力が前記計測された変位を構成する第１の要素と対応づけられた第１のデータと、前記計測された変位を構成する第２の要素が前記計測された変位を構成する第１の要素と対応づけられた第２のデータとを、前記複数回の計測に係る人の動作に対応づけて複数個、記憶手段に格納するステップと、
前記第１のデータ間の相関性と、前記第２のデータ間の相関性に基づいて、前記複数回の計測に係る人の動作間の相関性を評価するステップと、
を備えることを特徴とする相関性評価方法。
【請求項３】
請求項２に記載の相関性評価方法であって、
前記複数回の計測に係る人の動作間の相関性を示す値で重み付けした隣接行列を求めるステップと、
前記隣接行列を正規化した正規化隣接行列を求めるステップと、
前記正規化隣接行列の固有値が１となる場合の固有ベクトルの要素の大きさに基づいて、該要素に対応する人の動作の、他の動作との相関性を評価するステップと、
を備えることを特徴とする相関性評価方法。
【請求項４】
前記特定の物体は筆記具又は筆記具に擬した物体であり、
前記人がする所定の動作は、筆記動作であり、
前記計測される力は、筆圧に相当する力である、
請求項１ないし３のいずれか１項に記載の相関性評価方法。
【請求項５】
請求項２又は３に係る請求項４に記載の相関性評価方法であって、
前記所定の動作は、円を描く筆記動作であり、
前記第１の要素は、角度変化であり、
前記第２の要素は、前記円の想定中心からの距離である、
相関性評価方法。
【請求項６】
人が特定の物体に対して所定の動作をする際に加えられる力を計測する計測手段と、
前記計測手段により計測された力の時系列データが複数個、格納される記憶手段と、
前記記憶手段に格納された力の時系列データを標本とし、該時系列データ間の相関性を示す値で重み付けした隣接行列を算出し、該隣接行列を正規化した正規化隣接行列を算出する正規化隣接行列算出手段と、
前記正規化隣接行列算出手段により算出された正規化隣接行列の固有値が１となる場合の固有ベクトルを算出する固有ベクトル算出手段と、
を備えることを特徴とする相関性評価装置。
【請求項７】
人が特定の物体に対して所定の動作をする際に加えられる力と、前記特定の物体の変位を計測する計測手段と、
前記計測された力が前記計測された変位を構成する第１の要素と対応づけられた第１のデータと、前記計測された変位を構成する第２の要素が前記計測された変位を構成する第１の要素と対応づけられた第２のデータとが、前記計測された人の動作に対応づけられて記憶される記憶手段と、
前記第１のデータ間の相関性と、前記第２のデータ間の相関性に基づいて、人の動作間の相関性を評価する評価手段と、
を備えることを特徴とする相関性評価装置。
【請求項８】
請求項７に記載の相関性評価装置であって、
前記人の動作間の相関性を示す値で重み付けした隣接行列を算出し、該隣接行列を正規化した正規化隣接行列を算出する正規化隣接行列算出手段と、
前記正規化隣接行列の固有値が１となる場合の固有ベクトルを算出する固有ベクトル算出手段と、
を備えることを特徴とする相関性評価装置。
【請求項９】
前記特定の物体は筆記具又は筆記具に擬した物体であり、
前記人がする所定の動作は、筆記動作であり、
前記計測される力は、筆圧に相当する力である、
請求項６ないし７のいずれか１項に記載の相関性評価装置。
【請求項１０】
請求項７又は８に係る請求項９に記載の相関性評価方法であって、
前記所定の動作は、円を描画する筆記動作であり、
前記第１の要素は、角度変化であり、
前記第２の要素は、前記円の想定中心からの距離である、
相関性評価装置。
【請求項１１】
人が特定の物体に対して行った操作を検知し、該人が行った操作による当該物体の動作を、他の物体により再現させる動作再現装置であって、
前記他の物体における加速度に関する情報を記憶手段に記憶させ、
前記人が操作を行わない場合の動作再現においては、前記記憶手段に記憶された前記他の物体における加速度に関する情報に基づいて、前記他の物体を動作させることを特徴とする、
動作再現装置。
【請求項１】
人が特定の物体に対して所定の動作をする際に加えられる力を複数回計測するステップと、
前記計測された力の時系列データを複数個、記憶手段に格納するステップと、
前記記憶手段に格納された力の時系列データを標本とし、該時系列データ間の相関性を示す値で重み付けした隣接行列を求めるステップと、
前記隣接行列を正規化した正規化隣接行列を求めるステップと、
前記正規化隣接行列の固有値が１となる場合の固有ベクトルの要素の大きさに基づいて、該要素に対応する時系列データの他のデータとの相関性を評価するステップと、
を備えることを特徴とする相関性評価方法。
【請求項２】
人が特定の物体に対して所定の動作をする際に加えられる力と、前記特定の物体の変位を複数回計測するステップと、
前記計測された力が前記計測された変位を構成する第１の要素と対応づけられた第１のデータと、前記計測された変位を構成する第２の要素が前記計測された変位を構成する第１の要素と対応づけられた第２のデータとを、前記複数回の計測に係る人の動作に対応づけて複数個、記憶手段に格納するステップと、
前記第１のデータ間の相関性と、前記第２のデータ間の相関性に基づいて、前記複数回の計測に係る人の動作間の相関性を評価するステップと、
を備えることを特徴とする相関性評価方法。
【請求項３】
請求項２に記載の相関性評価方法であって、
前記複数回の計測に係る人の動作間の相関性を示す値で重み付けした隣接行列を求めるステップと、
前記隣接行列を正規化した正規化隣接行列を求めるステップと、
前記正規化隣接行列の固有値が１となる場合の固有ベクトルの要素の大きさに基づいて、該要素に対応する人の動作の、他の動作との相関性を評価するステップと、
を備えることを特徴とする相関性評価方法。
【請求項４】
前記特定の物体は筆記具又は筆記具に擬した物体であり、
前記人がする所定の動作は、筆記動作であり、
前記計測される力は、筆圧に相当する力である、
請求項１ないし３のいずれか１項に記載の相関性評価方法。
【請求項５】
請求項２又は３に係る請求項４に記載の相関性評価方法であって、
前記所定の動作は、円を描く筆記動作であり、
前記第１の要素は、角度変化であり、
前記第２の要素は、前記円の想定中心からの距離である、
相関性評価方法。
【請求項６】
人が特定の物体に対して所定の動作をする際に加えられる力を計測する計測手段と、
前記計測手段により計測された力の時系列データが複数個、格納される記憶手段と、
前記記憶手段に格納された力の時系列データを標本とし、該時系列データ間の相関性を示す値で重み付けした隣接行列を算出し、該隣接行列を正規化した正規化隣接行列を算出する正規化隣接行列算出手段と、
前記正規化隣接行列算出手段により算出された正規化隣接行列の固有値が１となる場合の固有ベクトルを算出する固有ベクトル算出手段と、
を備えることを特徴とする相関性評価装置。
【請求項７】
人が特定の物体に対して所定の動作をする際に加えられる力と、前記特定の物体の変位を計測する計測手段と、
前記計測された力が前記計測された変位を構成する第１の要素と対応づけられた第１のデータと、前記計測された変位を構成する第２の要素が前記計測された変位を構成する第１の要素と対応づけられた第２のデータとが、前記計測された人の動作に対応づけられて記憶される記憶手段と、
前記第１のデータ間の相関性と、前記第２のデータ間の相関性に基づいて、人の動作間の相関性を評価する評価手段と、
を備えることを特徴とする相関性評価装置。
【請求項８】
請求項７に記載の相関性評価装置であって、
前記人の動作間の相関性を示す値で重み付けした隣接行列を算出し、該隣接行列を正規化した正規化隣接行列を算出する正規化隣接行列算出手段と、
前記正規化隣接行列の固有値が１となる場合の固有ベクトルを算出する固有ベクトル算出手段と、
を備えることを特徴とする相関性評価装置。
【請求項９】
前記特定の物体は筆記具又は筆記具に擬した物体であり、
前記人がする所定の動作は、筆記動作であり、
前記計測される力は、筆圧に相当する力である、
請求項６ないし７のいずれか１項に記載の相関性評価装置。
【請求項１０】
請求項７又は８に係る請求項９に記載の相関性評価方法であって、
前記所定の動作は、円を描画する筆記動作であり、
前記第１の要素は、角度変化であり、
前記第２の要素は、前記円の想定中心からの距離である、
相関性評価装置。
【請求項１１】
人が特定の物体に対して行った操作を検知し、該人が行った操作による当該物体の動作を、他の物体により再現させる動作再現装置であって、
前記他の物体における加速度に関する情報を記憶手段に記憶させ、
前記人が操作を行わない場合の動作再現においては、前記記憶手段に記憶された前記他の物体における加速度に関する情報に基づいて、前記他の物体を動作させることを特徴とする、
動作再現装置。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図９】
【図１０】
【図１１】
【図１２】
【図１３】
【図１４】
【図１５】
【図１６】
【図１７】
【図１８】
【図１９】
【図２０】
【図２１】
【図２２】
【図２３】
【図２４】
【図２５】
【図２６】
【図２７】
【図２８】
【図２９】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図９】
【図１０】
【図１１】
【図１２】
【図１３】
【図１４】
【図１５】
【図１６】
【図１７】
【図１８】
【図１９】
【図２０】
【図２１】
【図２２】
【図２３】
【図２４】
【図２５】
【図２６】
【図２７】
【図２８】
【図２９】
【公開番号】特開２０１１−１７４８７１（Ｐ２０１１−１７４８７１Ａ）
【公開日】平成２３年９月８日（２０１１．９．８）
【国際特許分類】
【出願番号】特願２０１０−４０４２１（Ｐ２０１０−４０４２１）
【出願日】平成２２年２月２５日（２０１０．２．２５）
【新規性喪失の例外の表示】特許法第３０条第１項適用申請有り 平成２１年８月３１日 社団法人 電気学会産業応用部門大会委員会発行の「平成２１年電気学会 産業応用部門大会（ＣＤ）」に発表
【国等の委託研究の成果に係る記載事項】（出願人による申告）ＮＥＤＯ 産業技術研究助成事業（プロジェクトＩＤ：０７Ｃ４６０４７ａ）
【出願人】（８９９００００７９）学校法人慶應義塾 (742)
【Ｆターム（参考）】
【公開日】平成２３年９月８日（２０１１．９．８）
【国際特許分類】
【出願日】平成２２年２月２５日（２０１０．２．２５）
【新規性喪失の例外の表示】特許法第３０条第１項適用申請有り 平成２１年８月３１日 社団法人 電気学会産業応用部門大会委員会発行の「平成２１年電気学会 産業応用部門大会（ＣＤ）」に発表
【国等の委託研究の成果に係る記載事項】（出願人による申告）ＮＥＤＯ 産業技術研究助成事業（プロジェクトＩＤ：０７Ｃ４６０４７ａ）
【出願人】（８９９００００７９）学校法人慶應義塾 (742)
【Ｆターム（参考）】
[ Back to top ]