(57)【要約】【課題】ロボットに関する数理モデルのパラメータの同定を高速化する。【解決手段】軌道データ生成部５２が、ロボットモデル５８のパラメータの同定に用いるロボット１６の動作の軌道であって、パラメータの同定条件を満たす軌道を生成し、データ取得部５４が、軌道データ生成部５２により生成された軌道に従ってロボット１６を動作させた際に発生するトルクのデータを取得し、同定部５６が、軌道データ生成部５２により生成された軌道データと、データ取得部５４により取得されたデータとに基づいて、ロボットモデル５８のパラメータを同定する。【選択図】図６
2020011320.tif 000002
【特許請求の範囲】
【請求項１】
ロボットに関する数理モデルのパラメータ同定に用いる前記ロボットの動作の軌道であって、前記パラメータの同定条件を満たす軌道を生成する軌道生成部と、
前記軌道生成部により生成された軌道に従って前記ロボットを動作させる際に発生する物理量を示すデータを取得するデータ取得部と、
前記軌道生成部により生成された前記軌道と、前記データ取得部により取得された前記データとに基づいて、前記数理モデルのパラメータを同定する同定部と、
を含むパラメータ同定装置。
【請求項２】
前記パラメータの同定条件は、可同定性である請求項１に記載のパラメータ同定装置。
【請求項３】
前記軌道生成部は、前記ロボットが障害物と干渉しない前記軌道を生成する請求項１又は請求項２に記載のパラメータ同定装置。
【請求項４】
前記軌道生成部は、モーションプランニングにより前記軌道を生成する請求項１〜請求項３のいずれか１項に記載のパラメータ同定装置。
【請求項５】
前記軌道生成部は、経由点が指定された場合には、前記経由点を経由する軌道を生成する請求項１〜請求項４のいずれか１項に記載のパラメータ同定装置。
【請求項６】
前記数理モデルの入力を受け付けるか、又は、前記ロボットの機構情報に基づいて、前記数理モデルを算出することにより、前記数理モデルを取得するモデル取得部を含む請求項１〜請求項５のいずれか１項に記載のパラメータ同定装置。
【請求項７】
前記モデル取得部は、前記数理モデルのパラメータの初期推定解として、ＣＡＤモデルに基づく値を設定する請求項６に記載のパラメータ同定装置。
【請求項８】
前記数理モデルは、前記ロボットの動力学モデル若しくは運動学モデル、又は、前記ロボットの負荷物の動力学モデル若しくは運動学モデルである請求項１〜請求項７のいずれか１項に記載のパラメータ同定装置。
【請求項９】
前記物理量を示すデータは、前記ロボットに発生するトルクと、前記ロボット動作時の少なくとも姿勢とを含むデータである
請求項１〜請求項８のいずれか１項に記載のパラメータ同定装置。
【請求項１０】
前記軌道は、前記ロボットの少なくとも姿勢の系列データであり、
前記物理量を示すデータは、前記ロボットに発生するトルクを含むデータである
請求項１〜請求項８のいずれか１項に記載のパラメータ同定装置。
【請求項１１】
前記軌道生成部は、設定可能な最大の速度及び加速度を設定した軌道を生成する請求項１〜請求項１０のいずれか１項に記載のパラメータ同定装置。
【請求項１２】
軌道生成部が、ロボットに関する数理モデルのパラメータ同定に用いる前記ロボットの動作の軌道であって、前記パラメータの同定条件を満たす軌道を生成し、
データ取得部が、前記軌道生成部により生成された軌道に従って前記ロボットを動作させる際に発生する物理量を示すデータを取得し、
同定部が、前記軌道生成部により生成された前記軌道と、前記データ取得部により取得された前記データとに基づいて、前記数理モデルのパラメータを同定する
パラメータ同定方法。
【請求項１３】
コンピュータを、
ロボットに関する数理モデルのパラメータの同定に用いる前記ロボットの動作の軌道であって、前記パラメータの同定条件を満たす軌道を生成する軌道生成部、
前記軌道生成部により生成された軌道に従って前記ロボットを動作させる際に発生する物理量を示すデータを取得するデータ取得部、及び、
前記軌道生成部により生成された前記軌道と、前記データ取得部により取得された前記データとに基づいて、前記数理モデルのパラメータを同定する同定部
として機能させるためのパラメータ同定プログラム。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、パラメータ同定装置、パラメータ同定方法、及びパラメータ同定プログラムに関する。
【背景技術】
【０００２】
ロボットやロボットに取り付けたロボットハンドなどのツール、及びツールにより運搬又は加工されるワーク等のロボットに関する数理モデルのパラメータを同定することが行われている。
【０００３】
一般的に、多自由度のロボットアームの運動方程式を構成するパラメータ部を逐次同定法により同定する場合、対象ロボットの数理モデルにおいて、リンク毎に寄与する主要パラメータ部を特定しておき、ロボットアームの手先から順にそれらのパラメータを求めるよう同定試験を行う。
【０００４】
例えば、多自由度のロボットアームの運動方程式の同定を逐次同定法により行うロボットアームの動的モデルの同定方法が提案されている。この方法では、ロボットアームの動特性モデルを同定する場合に、対象ロボットを２〜４自由度のサブロボットの集合として把握し、サブロボットについて予め導出された動特性パラメータによって記述された運動方程式により演算処理を行って、必要なパラメータを求めている。
【先行技術文献】
【特許文献】
【０００５】
【特許文献１】特開平６−１９０７５４号公報
【発明の概要】
【発明が解決しようとする課題】
【０００６】
上記従来技術のような逐次同定法は、ロボットの手先から順に数理モデルのパラメータを同定する試験を逐次行っていく方法であり、簡便な方法ではあるが、同定試験に時間がかかり、また、ロボット毎に同定試験の手順を再設計する必要がある。
【０００７】
本発明は、上記の点に鑑みてなされたものであり、ロボットに関する数理モデルのパラメータ同定を高速化することができるパラメータ同定装置、方法、及びプログラムを提供することを目的とする。
【課題を解決するための手段】
【０００８】
上記目的を達成するために、本発明に係るパラメータ同定装置は、ロボットに関する数理モデルのパラメータ同定に用いる前記ロボットの動作の軌道であって、前記パラメータの同定条件を満たす軌道を生成する軌道生成部と、前記軌道生成部により生成された軌道に従って前記ロボットを動作させる際に発生する物理量を示すデータを取得するデータ取得部と、前記軌道生成部により生成された前記軌道と、前記データ取得部により取得された前記データとに基づいて、前記数理モデルのパラメータを同定する同定部と、を含んで構成されている。
【０００９】
本発明に係るパラメータ同定装置によれば、軌道生成部が、ロボットに関する数理モデルのパラメータ同定に用いるロボットの動作の軌道であって、パラメータの同定条件を満たす軌道を生成し、データ取得部が、軌道生成部により生成された軌道に従ってロボットを動作させる際に発生する物理量を示すデータを取得し、同定部が、軌道生成部により生成された軌道と、データ取得部により取得されたデータとに基づいて、数理モデルのパラメータを同定する。これにより、ロボットに関する数理モデルのパラメータ同定を高速化することができる。
【００１０】
前記パラメータの同定条件は、可同定性とすることができる。これにより、パラメータ同定に適した軌道を生成することができる。
【００１１】
また、本発明に係るパラメータ同定装置において、前記軌道生成部は、前記ロボットが障害物と干渉しない前記軌道を生成することができる。これにより、障害物のある環境下においても、ロボットに関する数理モデルのパラメータ同定を高速化することができる。
【００１２】
また、前記軌道生成部は、モーションプランニングにより前記軌道を生成することができる。これにより、非線形最適化により最適な軌道を導出する場合に比べ、簡便にパラメータ同定に用いる軌道を生成することができる。
【００１３】
また、前記軌道生成部は、経由点が指定された場合には、前記経由点を経由する軌道を生成することができる。これにより、軌道の探索範囲が限定されて探索時間が短縮されると共に、運用時の実際のロボットの動作に近い動作を行った際に得られたデータを用いてパラメータ同定を行うことになり、パラメータの同定精度の向上が見込まれる。
【００１４】
また、本発明に係るパラメータ同定装置は、前記数理モデルの入力を受け付けるか、又は、前記ロボットの機構情報に基づいて、前記数理モデルを算出することにより、前記数理モデルを取得するモデル取得部をさらに含んで構成することができる。
【００１５】
また、前記モデル取得部は、前記数理モデルのパラメータの初期推定解として、ＣＡＤモデルに基づく値を設定することができる。これにより、軌道生成部で軌道を生成する際に、設定されたパラメータが制約となって探索範囲が限定されるため、軌道の生成がより高速化され、結果としてパラメータ同定もより高速化される。
【００１６】
また、前記数理モデルは、前記ロボットの動力学モデル若しくは運動学モデル、又は、前記ロボットの負荷物の動力学モデル若しくは運動学モデルである。このように、本発明は、様々なモデルに適用可能であるため、モデルを用いた様々な機能に利用することができる。
【００１７】
また、前記物理量を示すデータは、前記ロボットに発生するトルクと、前記ロボット動作時の少なくとも姿勢とを含むデータである。また、前記軌道は、前記ロボットの少なくとも姿勢の系列データであり、前記物理量を示すデータは、前記ロボットに発生するトルクを含むデータとしてもよい。これにより、軌道、モデルのパラメータ、及びトルクで表される方程式に基づいて、パラメータを同定することができる。
【００１８】
また、前記軌道生成部は、設定可能な最大の速度及び加速度を設定した軌道を生成することができる。これにより、最大のトルクを発揮するようにロボットを動作させたときのデータを、データ取得部で取得することができ、Ｓ／Ｎ比が向上するため、パラメータの同定精度の向上が見込める。
【００１９】
また、本発明に係るパラメータ同定方法は、軌道生成部が、ロボットに関する数理モデルのパラメータ同定に用いる前記ロボットの動作の軌道であって、前記パラメータの同定条件を満たす軌道を生成し、データ取得部が、前記軌道生成部により生成された軌道に従って前記ロボットを動作させる際に発生する物理量を示すデータを取得し、同定部が、前記軌道生成部により生成された前記軌道と、前記データ取得部により取得された前記データとに基づいて、前記数理モデルのパラメータを同定する方法である。
【００２０】
また、本発明に係るパラメータ同定プログラムは、コンピュータを、ロボットに関する数理モデルのパラメータの同定に用いる前記ロボットの動作の軌道であって、前記パラメータの同定条件を満たす軌道を生成する軌道生成部、前記軌道生成部により生成された軌道に従って前記ロボットを動作させる際に発生する物理量を示すデータを取得するデータ取得部、及び、前記軌道生成部により生成された前記軌道と、前記データ取得部により取得された前記データとに基づいて、前記数理モデルのパラメータを同定する同定部として機能させるためのプログラムである。
【発明の効果】
【００２１】
本発明に係るパラメータ同定装置、方法、及びプログラムによれば、ロボットに関する数理モデルのパラメータ同定に用いるロボットの動作の軌道として、パラメータの同定条件を満たす軌道を生成することで、ロボットに関する数理モデルのパラメータ同定を高速化することができる。
【図面の簡単な説明】
【００２２】
【図１】第１及び第３実施形態に係るパラメータ同定システムの概略構成を示す図である。
【図２】第１〜第３実施形態に係るパラメータ同定装置のハードウェア構成を示すブロック図である。
【図３】逐次同定法を説明するための図である。
【図４】一括同定法を説明するための図である。
【図５】本実施形態の概要を説明するための図である。
【図６】第１実施形態に係るパラメータ同定装置の機能ブロック図である。
【図７】第１実施形態における軌道の計画を説明するための図である。
【図８】第１実施形態における軌道の計画を説明するための図である。
【図９】第１実施形態における軌道の計画を説明するための図である。
【図１０】第１実施形態における軌道の計画を説明するための図である。
【図１１】第１実施形態における軌道の計画を説明するための図である。
【図１２】第１実施形態におけるパラメータ同定処理の一例を示すフローチャートである。
【図１３】第２実施形態に係るパラメータ同定システムの概略構成を示す図である。
【図１４】第２実施形態に係るパラメータ同定装置の機能ブロック図である。
【図１５】第２実施形態における軌道の計画を説明するための図である。
【図１６】第２実施形態における軌道の計画を説明するための図である。
【図１７】第２実施形態におけるパラメータ同定処理の一例を示すフローチャートである。
【図１８】第３実施形態に係るパラメータ同定装置の機能ブロック図である。
【図１９】第３実施形態における軌道の計画を説明するための図である。
【図２０】第３実施形態における軌道の計画を説明するための図である。
【発明を実施するための形態】
【００２３】
以下、本発明の実施形態の一例を、図面を参照しつつ説明する。なお、各図面において同一又は等価な構成要素及び部分には同一の参照符号を付与している。また、図面の寸法及び比率は、説明の都合上誇張されており、実際の比率とは異なる場合がある。
【００２４】
＜第１実施形態＞
図１に示すように、第１実施形態に係るパラメータ同定システム１００は、パラメータ同定装置１０と、ロボット制御装置１２と、ロボット１６とを含んで構成される。
【００２５】
ロボット１６は、例えば、３次元空間における動作に必要な６自由度の構成を備えた垂直多関節型のロボットである。なお、ロボット１６の自由度は、６自由度に冗長自由度を加えた７自由度としてもよい。ロボット１６は、パラメータ同定装置１０により生成された軌道データに従って、ロボット制御装置１２により制御されて動作する。
【００２６】
ロボット制御装置１２は、パラメータ同定装置１０で生成された軌道データに従って、ロボット１６の動作を制御する。
【００２７】
パラメータ同定装置１０は、指定された開始姿勢から終了姿勢までの経路を計画し、軌道データを生成する。
【００２８】
ここで、本実施形態では、ロボット１６の手先（ロボットハンドなどのツールが取り付けられる側）の基準位置を、任意の始点から終点まで動作させるときのロボット１６の各時刻における姿勢を時系列に並べたものを「経路」と称する。ロボット１６の姿勢は、ロボット１６の手先の基準位置がある位置（ｘ，ｙ，ｚ）及び姿勢（ｒｏｌｌ，ｐｉｔｃｈ，ｙａｗ）にあると想定した場合の、ロボット１６の第一関節から第Ｎ関節までの各関節の値（回転角度）の系列（Ｊ１，Ｊ２，・・・，ＪＮ）で表される（Ｎはロボットの関節数）。
【００２９】
また、本実施形態では、「経路」に対して、ロボット１６の姿勢を変化させる速度及び加速度を付与したものを「軌道」と称する。
【００３０】
図２は、本実施形態に係るパラメータ同定装置１０のハードウェア構成を示すブロック図である。図２に示すように、パラメータ同定装置１０は、ＣＰＵ（Ｃｅｎｔｒａｌ  Ｐｒｏｃｅｓｓｉｎｇ  Ｕｎｉｔ）３２、メモリ３４、記憶装置３６、入力装置３８、出力装置４０、光ディスク駆動装置４２、及び通信インタフェース（Ｉ／Ｆ）４４を有する。各構成は、バスを介して相互に通信可能に接続されている。
【００３１】
記憶装置３６には、パラメータ同定処理を実行するためのパラメータ同定プログラムが格納されている。ＣＰＵ３２は、中央演算処理ユニットであり、各種プログラムを実行したり、各構成を制御したりする。すなわち、ＣＰＵ３２は、記憶装置３６からプログラムを読み出し、メモリ３４を作業領域としてプログラムを実行する。ＣＰＵ３２は、記憶装置３６に記憶されているプログラムに従って、上記各構成の制御及び各種の演算処理を行う。
【００３２】
メモリ３４は、ＲＡＭ（Ｒａｎｄｏｍ  Ａｃｃｅｓｓ  Ｍｅｍｏｒｙ）により構成され、作業領域として一時的にプログラム及びデータを記憶する。記憶装置３６は、ＲＯＭ（Ｒｅａｄ  Ｏｎｌｙ  Ｍｅｍｏｒｙ）、及びＨＤＤ（Ｈａｒｄ  Ｄｉｓｋ  Ｄｒｉｖｅ）又はＳＳＤ（Ｓｏｌｉｄ  Ｓｔａｔｅ  Ｄｒｉｖｅ）により構成され、オペレーティングシステムを含む各種プログラム、及び各種データを格納する。
【００３３】
入力装置３８は、例えば、キーボードやマウス等の、各種の入力を行うための装置である。出力装置４０は、例えば、ディスプレイやプリンタ等の、各種の情報を出力するための装置である。出力装置４０として、タッチパネルディスプレイを採用することにより、入力装置３８として機能させてもよい。光ディスク駆動装置４２は、各種の記録媒体（ＣＤ−ＲＯＭ又はブルーレイディスクなど）に記憶されたデータの読み込みや、記録媒体に対するデータの書き込み等を行う。
【００３４】
通信インタフェース４４は、他の機器と通信するためのインタフェースであり、例えば、イーサネット（登録商標）、ＦＤＤＩ又はＷｉ−Ｆｉ（登録商標）等の規格が用いられる。
【００３５】
ここで、第１実施形態に係るパラメータ同定装置１０の詳細について説明する前に、ロボットに関する数理モデルのパラメータの同定手法及びその問題点と、本実施形態の概要について説明する。
【００３６】
パラメータの同定手法には、大別して、逐次同定法と、一括同定法とが存在する。
【００３７】
逐次同定法とは、図３に示すように、ロボットの手先から順に数理モデルのパラメータの同定試験を実施し、逐次同定して行く方法である。逐次同定法では、対象ロボットの数理モデルにおいて、ロボットのリンク毎に寄与する主要パラメータ部を特定しておき、手先から順にそれらのパラメータを求めるように同定試験を行う。このため、リンク毎に同定試験の設計が必要であり、同定動作の計画に時間を要する。また、リンク毎に同定実験が必要であり、同定試験自体にも時間がかかる。さらに、ロボット毎に、各リンクのパラメータ部を特定する作業が必要であり、同定試験の手順について再設計が必要となる。ここで、パラメータ部は、質量や重心位置などの物理パラメータの組み合わせで構成されており、汎用的な導出が難しく、ロボット毎に再導出が必要となる。さらに、同定される値は物理パラメータの組み合わせの値であって、質量や重心位置などの値が直接得られないという欠点がある。また、逐次同定法では、リンク毎に同定したパラメータから最終的なパラメータを同定するまでに、同定誤差が蓄積し易いという問題もある。
【００３８】
一方、一括同定法では、ロボットに関する数理モデルから、方程式Ｗβ＝ωを導出する。この処理は理論的に確立されており、システマチックに実行することができる。Ｗは、ロボットの姿勢、速度、及び加速度を含む軌道データを表すデータ行列であり、βは、同定するパラメータベクトルであり、ωは、データ行列Ｗを構成する軌道でロボットを動作させた場合にロボットの各関節に発生するトルクである。そして、図４に示すように、非線形最適化により生成した軌道データに従ってロボットを動作させた場合に得られる、ロボットの姿勢、速度、加速度、及びトルクのデータを収集し、姿勢、速度、及び加速度のデータから最適なデータ行列Ｗを構成すると共に、ωにトルクのデータを代入する。そして、ｍｉｎ||Ｗβ-ω||２で表される最小二乗問題を解くことにより、パラメータベクトルβを同定する。
【００３９】
一括同定法によれば、同定試験は１回でよいため、上述した逐次同定法の問題点を解消することができる。しかし、パラメータの同定を適切に行うためには、Ｗが可同定性の良好な最適なデータ行列であることが必要である。可同定性とは、パラメータ同定を精度良く行うためにデータ行列Ｗが持つべき性質である。可同定性に関して最適なＷを同定に用いるためには、データ行列Ｗに対して、任意の可同定性の指標を評価関数として算出し、評価関数が最良となるデータ行列Ｗを非線形最適化により導出し、Ｗｏｐｔとして選択する。この非線形最適化の計算コストは非常に高く、特にＷのサイズ（軌道を構成するデータ点数）が増加すると、計算コストは膨大になる。
【００４０】
そこで、本実施形態では、図５に示すように、一括同定法をベースとし、データ行列Ｗｏｐｔとして、非線形最適化ではなく、可同定性を加味すると共に、モーションプランニングにより生成した軌道データを用いる。これにより、データ行列Ｗｏｐｔとなる軌道データの生成を高速化し、結果として、パラメータの同定を高速化する。
【００４１】
また、一般的に、モーションプランニングによる軌道データの生成では、ロボット周辺の障害物に干渉しない軌道を示す軌道データが生成される。そのため、障害物が存在する環境下においても、パラメータ同定の実施を高速化することができる。なお、非線形最適化により軌道データを生成する場合において、障害物と干渉しない軌道データを生成するためには、周辺環境をロボットの３次元空間で特定した後、障害物の領域又は障害物と干渉しない領域をロボット姿勢の集合であるコンフィギュレーション空間に射影し、障害物領域を制約として数式表現する必要がある。一般にこの処理には膨大な計算コストが必要となり、障害物環境下における同定動作の高速な計画を難しくしている。
【００４２】
次に、第１実施形態に係るパラメータ同定装置１０の機能構成について説明する。
【００４３】
図６は、パラメータ同定装置１０の機能構成の例を示すブロック図である。図６に示すように、パラメータ同定装置１０は、機能構成として、軌道データ生成部５２と、データ取得部５４と、同定部５６とを含む。また、パラメータ同定装置１０の所定の記憶領域には、ロボットに関する数理モデルであるロボットモデル５８が記憶される。各機能構成は、ＣＰＵ３２が記憶装置３６に記憶されたパラメータ同定プログラムを読み出し、メモリ３４に展開して実行することにより実現される。なお、軌道データ生成部５２は、本発明の軌道生成部の一例であり、データ取得部５４は、本発明のデータ取得部の一例であり、同定部５６は、本発明の同定部の一例である。
【００４４】
軌道データ生成部５２は、ロボット１６の関節配置、リンクの構成、各関節の限界角度、手先の基準位置等のロボット１６の機構情報、及びロボット１６周辺の障害物の情報を取得する。例えば、軌道データ生成部５２は、ロボットのＣＡＤデータ、及びロボット１６週辺の障害物の形状及び位置を示すＣＡＤデータの入力を受け付けることにより、これらの情報を取得する。
【００４５】
軌道データ生成部５２は、ロボット１６の機構情報、障害物の情報、及びロボットモデル５８に基づいて、ロボットモデル５８のパラメータの同定に用いるロボット１６の動作の軌道であって、パラメータの同定条件を満たし、かつ障害物とロボット１６とが干渉しない軌道を示す軌道データを生成する。
【００４６】
具体的には、軌道データ生成部５２は、機能構成として、軌道計画部５２Ａと、同定条件判定部５２Ｂとを含み、軌道計画部５２Ａと、同定条件判定部５２Ｂとを機能させて、上記の軌道データを生成する。
【００４７】
軌道計画部５２Ａは、指定されたロボット１６の開始姿勢（始点）から終了姿勢（終点）までのロボット１６の姿勢の系列である経路を計画する。経路の生成には、従来既知のモーションプランニングの手法を用いることができる。第１実施形態では、ＲＲＴ、ＰＲＭなどのランダムサンプリング手法のモーションプランニングを用いる。また、軌道計画部５２Ａは、計画した経路に、ロボット１６の姿勢を変化させる速度及び加速度の情報を付加した軌道を計画する。
【００４８】
同定条件判定部５２Ｂは、軌道計画部５２Ａによって計画される軌道の可同定性を示す指標（以下、「可同定性指標」という）を算出し、算出した可同定性指標を用いて、軌道計画部５２Ａにより、パラメータ同定条件を満たす軌道が計画されるように制御する。
【００４９】
より具体的には、軌道データ生成部５２は、図７に示すように、軌道計画部５２Ａを機能させて、ロボット１６の取り得る全ての姿勢の集合であるコンフィグレーション空間に、指定された始点及び終点を配置する。図７では、始点及び終点を黒丸で表している。なお、コンフィグレーション空間に配置される各点は、ロボットの姿勢（Ｊ１，Ｊ２，・・・，ＪＮ）を表す。そして、軌道データ生成部５２は、軌道計画部５２Ａを機能させて、始点を最初の注目点に設定し、注目点の周辺に、注目点と接続する「次の点」の候補となるサンプル点をランダムに生成する。図７の例では、始点に対して、サンプル点Ｐ１〜Ｐ４が生成された例を示している。また、軌道計画部５２Ａは、注目点と各サンプル点間に、注目点が示す姿勢から各サンプル点が示す姿勢まで変化させる際の速度及び加速度を設定する。
【００５０】
軌道データ生成部５２は、同定条件判定部５２Ｂを機能させて、サンプル点の中から、注目点と接続する「次の点」を決定する。具体的には、同定条件判定部５２Ｂは、生成されたサンプル点から、障害物と干渉する姿勢を示すサンプル点を除外する。障害物との干渉は、例えば、取得した障害物の情報に基づいて、コンフィグレーション空間に障害物を示す領域を設定し、注目点とサンプル点とを接続した経路が、その障害物を示す領域にかかるか否かにより判定することができる。また、コンフィグレーション空間上で表現されたロボットの姿勢に対して順運動学（フォワードキネマティクス）計算を行うことによって障害物の存在する作業空間でのロボットの姿勢に変換し、注目点とサンプル点とを接続した経路を動く動作をシミュレーションした場合に、障害物と干渉しているか否かにより判定することもできる。図７の例では、サンプル点Ｐ１及びＰ４が除外される。なお、図７では、網掛けの丸で除外されるサンプル点を表している。以降の図においても同様である。
【００５１】
また、同定条件判定部５２Ｂは、残ったサンプル点の各々と、注目点とを接続した際の可同定性指標を算出する。可同定性指標は、既に計画済みの軌道（始点から注目点まで軌道）を構成するサンプル点、及び新たなサンプル点の各々が示す姿勢、並びに姿勢間の速度及び加速度の値を用いて算出される指標であり、従来既知の指標を適用することができる。なお、新たなサンプル点と終点とを接続して、始点から終点までの仮の軌道について可同定性指標を算出してもよい。同定条件判定部５２Ｂは、算出した可同定性指標が最良となるサンプル点を、注目点と接続する「次の点」として決定する。図７の例では、サンプル点Ｐ２よりもサンプル点Ｐ３の方が、可同定性指標が良い値であり、サンプル点Ｐ３が「次の点」として決定された場合を示している。また、サンプル点の決定方法として、完全にランダムに決定する以外にも、可同定の情報を利用してサンプリングの範囲を絞るなどの工夫が可能である。また、過去のサンプリング情報に基づいて、可同定性の良い可能性が高い領域や障害物との衝突の可能性が低い領域へのサンプリングに重み付けするなどの工夫も可能である。
【００５２】
軌道データ生成部５２は、軌道計画部５２Ａを機能させて、図８に示すように、同定条件判定部５２Ｂにより決定された「次の点」を注目点と接続した軌道を計画する。点間の接続は、直線補間や曲線補間など、どのような手法を適用してもよい。なお、図８では、「次の点」として選択されなかったサンプル点を破線の丸（白丸及び網掛けの丸）で表している。以降の図においても同様である。
【００５３】
軌道データ生成部５２は、図９に示すように、「次の点」を新たな注目点に設定し、上記の処理を繰り返す。図９では、サンプル点Ｐ３に対して、サンプル点Ｐ５〜Ｐ９が生成され、障害物と干渉するサンプル点Ｐ５、Ｐ６、及びＰ９が除外され、可同定性指標が最良のサンプル点Ｐ８が「次の点」として決定された例を示している。軌道データ生成部５２は、軌道計画部５２Ａを機能させて、図１０に示すように、既に計画済みの軌道と「次の点」に決定されたサンプル点とを接続した軌道を生成する。
【００５４】
軌道データ生成部５２は、図１１に示すように、上記の処理を「次の点」が終点に到達するまで繰り返すことで、最終的な軌道を計画する。なお、注目点と終点との距離が所定距離以内となった場合には、終点を優先的に「次の点」に決定するようにすればよい。第１実施形態では、上記のように、可同定性指標が最良となるサンプル点を順次選択しながら軌道を計画することが、パラメータ同定条件を満たす軌道を計画することに相当する。
【００５５】
なお、本実施形態では、始点と終点とが異なるところに位置する場合について説明するが、始点と終点とを同じ点としてもよい。この場合、可同定性指標の働きにより、一度、始点及び終点から遠ざかるように軌道が生成された後、終点に戻ってくるような軌道が生成される。
【００５６】
軌道データ生成部５２は、軌道計画部５２Ａにより計画された軌道を構成する各サンプル点が示す姿勢、及び姿勢間に設定した速度及び加速度のリストを軌道データとして生成する。軌道データ生成部５２は、生成した軌道データをロボット制御装置１２へ出力する。
【００５７】
データ取得部５４は、軌道データ生成部５２により生成された軌道データに従ってロボット制御装置１２によりロボット１６を動作させた場合に発生する物理量を示すデータを取得する。具体的には、データ取得部５４は、ロボット１６動作時の各姿勢及び姿勢間の速度及び加速度のデータを取得する。また、データ取得部５４は、ロボット１６の各関節を駆動させるためのモータの出力などから、各関節のトルクを取得する。なお、姿勢、速度、及び加速度のデータは、軌道データ生成部５２により生成された軌道データを取得してもよい。データ取得部５４は、取得したデータを同定部５６へ受け渡す。
【００５８】
同定部５６は、データ取得部５４により取得されたデータに基づいて、ロボットモデル５８のパラメータを同定する。具体的には、データ取得部５４から受け渡されたデータを、上述の方程式Ｗｏｐｔβ＝ωに代入し、最小二乗法により、パラメータベクトルβを同定する。
【００５９】
ロボットモデル５８は、例えば運動方程式等を用いたパラメトリックなモデル、ガウス過程モデルやニューラルネットワークモデル等のノンパラメトリックなモデル、パラメトリックなモデルとノンパラメトリックなモデルとのハイブリッドであるセミパラメトリックなモデルなど、どのようなモデルであってもよい。また、ロボット１６の動力学モデルだけでなく、運動学モデルであってもよい。さらに、ロボット１６の手先に取り付けられるロボットハンド等のツール、及びツールによって保持されるワークなどのロボット１６の負荷物を含む数理モデルであってもよい。この場合、ロボット１６の機構情報に加え、負荷物の機構情報も入力する。
【００６０】
このように、ロボット１６の負荷物を含む数理モデルのパラメータを同定することが可能であるため、負荷物の物理特性を計測する目的で本発明を用いることも可能であり、負荷物の物理パラメータを事前に用意する手間を省くことができる。
【００６１】
次に、第１実施形態に係るパラメータ同定システム１００の作用について説明する。
【００６２】
図１２は、パラメータ同定装置１０のＣＰＵ３２により実行されるパラメータ同定処理の流れを示すフローチャートである。ＣＰＵ３２が記憶装置３６からパラメータ同定プログラムを読み出して、メモリ３４に展開して実行することにより、ＣＰＵ３２がパラメータ同定装置１０の各機能構成として機能し、図１２に示すパラメータ同定処理が実行される。
【００６３】
まず、ステップＳ１２で、軌道データ生成部５２が、ロボット１６の機構情報及び障害物の情報を取得する。
【００６４】
次に、ステップＳ１４で、軌道データ生成部５２が、生成する軌道の開始姿勢及び終了姿勢を受け付ける。なお、開始姿勢及び終了姿勢は、オペレータ等が任意の姿勢を指定してパラメータ同定装置１０に入力可能である。そして、軌道計画部５２Ａが、ロボット１６の取り得る全ての姿勢の集合であるコンフィグレーション空間に、開始姿勢を始点とし、終了姿勢を終点として配置する。
【００６５】
次に、ステップＳ１６で、軌道計画部５２Ａが、始点を最初の注目点Ｐに設定する。
【００６６】
次に、ステップＳ１８で、軌道計画部５２Ａが、注目点Ｐの周辺に、注目点Ｐと接続する次の点Ｐｎｅｘｔの候補となるサンプル点をランダムに生成する。そして、軌道計画部５２Ａは、注目点Ｐと各サンプル点間に速度及び加速度を設定する。
【００６７】
次に、ステップＳ２０で、同定条件判定部５２Ｂが、上記ステップＳ１８で生成されたサンプル点から、障害物と干渉する姿勢を示すサンプル点を除外する。そして、同定条件判定部５２Ｂが、残ったサンプル点及び終点の各々と、注目点Ｐとを接続した際の可同定性指標を算出し、算出した可同定性を示す指標が最良となるサンプル点又は終点を、次の点Ｐｎｅｘｔとして決定する。
【００６８】
次に、ステップＳ２２で、軌道計画部５２Ａが、注目点Ｐと上記ステップＳ２０で決定されたＰｎｅｘｔとを接続した軌道を計画する。
【００６９】
次に、ステップＳ２４で、軌道データ生成部５２が、上記ステップＳ２０で決定されたＰｎｅｘｔが終点か否かを判定する。Ｐｎｅｘｔが終点ではない場合には、ステップＳ２６へ移行し、軌道データ生成部５２が、Ｐｎｅｘｔを新たな注目点Ｐに設定し、ステップＳ１８に戻る。一方、Ｐｎｅｘｔが終点の場合には、ステップＳ２８へ移行する。
【００７０】
ステップＳ２８では、軌道データ生成部５２が、軌道計画部５２Ａにより計画された軌道を示す軌道データを生成し、生成した軌道データをロボット制御装置１２へ出力する。
【００７１】
これにより、ロボット制御装置１２が、軌道データ生成部５２により生成された軌道データに従ってロボット１６を動作させる。
【００７２】
次に、ステップＳ３０で、データ取得部５４が、ロボット１６動作時の各姿勢及び姿勢間の速度及び加速度のデータを取得する。また、データ取得部５４が、ロボット１６の各関節を駆動させるためのモータの出力などから、各関節のトルクを取得する。
【００７３】
次に、ステップＳ３２で、同定部５６が、上記ステップＳ３０で取得されたデータを、上述の方程式Ｗｏｐｔβ＝ωに代入し、最小二乗法等の同定手法により、パラメータベクトルβを同定し、パラメータ同定処理は終了する。
【００７４】
以上説明したように、第１実施形態に係るパラメータ同定システムによれば、パラメータ同定装置が、ロボットモデルのパラメータを一括同定法により同定するための軌道データを、可同定性が最良となるように、モーションプランニングにより生成する。これにより、ロボットに関する数理モデルのパラメータを同定する際の、同定に要する時間を高速化するだけなく、同定動作の計画に要する時間を高速化することができる。その結果、高速及び高精度な位置決めや動作計画の機能に必要なロボットパラメータの同定を、ユーザに負荷を与えることなく、高速に実施することができる。
【００７５】
さらに、第１実施形態に係るパラメータ同定装置は、障害物との干渉判定を行いながら軌道を探索するため、障害物が存在する環境下においても、ロボットに関する数理モデルのパラメータの同定を高速化することができる。このような利点は、例えばロボットが既に障害物環境下に設置された状況において、特に有効となる。
【００７６】
＜第２実施形態＞
次に、第２実施形態について説明する。なお、第２実施形態に係るパラメータ同定システムにおいて、第１実施形態に係るパラメータ同定システム１００と同一又は等価な構成要素及び部分には同一の参照符号を付与し、詳細な説明を省略する。
【００７７】
図１３に示すように、第２実施形態に係るパラメータ同定システム２００は、パラメータ同定装置２１０と、ロボット制御装置１２と、ロボット１６と、画像センサ１８とを含んで構成される。
【００７８】
画像センサ１８は、ロボット１６周辺の障害物等の環境情報を検出するセンサであり、カメラと画像処理部とを含んで構成される。画像センサ１８は、カメラによりロボット１６周辺を撮影し、画像処理部により、撮影された画像から、ロボット周辺の障害物の位置及び形状を含む情報を算出する。画像センサ１８は、算出した障害物の情報を出力する。
【００７９】
なお、障害物の情報を検出するセンサは画像センサ１８の場合に限定されず、レーザレーダなど、環境情報を検出可能な他のセンサを用いてもよい。
【００８０】
第２実施形態に係るパラメータ同定装置２１０のハードウェア構成は、図２に示す第１実施形態に係るパラメータ同定装置１０のハードウェア構成と同様であるため、説明を省略する。
【００８１】
次に、第２実施形態に係るパラメータ同定装置２１０の機能構成について説明する。
【００８２】
図１４は、パラメータ同定装置２１０の機能構成の例を示すブロック図である。図１４に示すように、パラメータ同定装置２１０は、機能構成として、軌道データ生成部２５２と、データ取得部５４と、同定部５６と、モデル算出部６０とを含む。各機能構成は、ＣＰＵ３２が記憶装置３６に記憶されたパラメータ同定プログラムを読み出し、メモリ３４に展開して実行することにより実現される。なお、軌道データ生成部２５２は、本発明の軌道生成部の一例であり、モデル算出部６０は、本発明のモデル取得部の一例である。
【００８３】
モデル算出部６０は、ロボット１６の機構情報を受け付け、受け付けた機構情報を用いて、ロボットモデル５８を算出する。ロボットモデル５８は、第１実施形態と同様に、様々なモデルを適用可能であるため、モデル算出部６０は、適用するモデルに対応した算出方法により、ロボットモデル５８を算出するものであればよい。
【００８４】
軌道データ生成部２５２は、第１実施形態の軌道データ生成部５２と同様に、パラメータ同定条件を満たし、かつ障害物と干渉しない軌道を示す軌道データを生成する。この際、軌道データ生成部２５２は、予め入力されたＣＡＤデータ等ではなく、画像センサ１８からロボット１６周辺の障害物の情報を取得する。これにより、実際の状況により即した障害物の情報を取得することができる。
【００８５】
具体的には、軌道データ生成部２５２は、機能構成として、軌道計画部２５２Ａと、同定条件判定部２５２Ｂとを含み、軌道計画部２５２Ａと、同定条件判定部２５２Ｂとを機能させて、軌道データを生成する。
【００８６】
軌道計画部２５２Ａは、ＳＴＯＭＰ等の最適化手法のモーションプランニングにより、指定されたロボット１６の開始姿勢（始点）から終了姿勢（終点）までのロボット１６の姿勢の系列である経路を計画する。また、軌道計画部２５２Ａは、計画した経路に、ロボット１６の姿勢を変化させる速度及び加速度の情報を付加した軌道を計画する。
【００８７】
同定条件判定部２５２Ｂは、軌道計画部２５２Ａによって計画される複数の軌道の各々について可同定性指標を算出し、算出した可同定性指標を用いて、パラメータ同定条件を満たす軌道を選択する。
【００８８】
より具体的には、軌道データ生成部５２は、図１５に示すように、軌道計画部２５２Ａを機能させて、ロボット１６の取り得る全ての姿勢の集合であるコンフィグレーション空間に、指定された始点及び終点を配置し、始点と終点間を接続する。また、軌道データ生成部２５２は、軌道計画部２５２Ａを機能させて、図１６に示すように、始点と終点との間の任意の複数の点を接続した経路をランダムに複数計画する。また、軌道計画部２５２Ａは、計画した各経路に対して、姿勢を変化させる速度及び加速度を設定し、軌道を計画する。
【００８９】
軌道データ生成部２５２は、同定条件判定部２５２Ｂを機能させて、軌道計画部２５２Ａにより計画された複数の軌道の中から、障害物との干渉が生じる軌道を除外する。図１６の例では、点線で示す軌道が除外される。
【００９０】
また、同定条件判定部２５２Ｂは、残った軌道の各々について、軌道を構成する始点から終点までの各点が示す姿勢、並びに姿勢間の速度及び加速度の値を用いて、可同定性指標を算出する。同定条件判定部２５２Ｂは、算出した可同定性指標が最良となる軌道を選択する。図１６の例では、実線で示す軌道が、可同定性指標が最良となる軌道を表し、破線で示す軌道は、障害物との干渉は生じていないが、可同定性指標が最良ではない軌道を表している。第２実施形態では、上記のように、複数計画した軌道の中から、可同定性指標が最良となる軌道を選択することが、パラメータ同定条件を満たす軌道を計画することに相当する。
【００９１】
軌道データ生成部２５２は、同定条件判定部２５２Ｂにより選択された軌道を構成する各点が示す姿勢、及び姿勢間に設定した速度及び加速度のリストを軌道データとして生成する。軌道データ生成部２５２は、生成した軌道データをロボット制御装置１２へ出力する。
【００９２】
次に、第２実施形態に係るパラメータ同定システム２００の作用について説明する。第２実施形態では、パラメータ同定装置２１０において、図１７に示すパラメータ同定処理が実行される。
【００９３】
まず、ステップＳ２１２で、軌道データ生成部２５２が、ロボット１６の機構情報を取得する。
【００９４】
次に、ステップＳ４２で、モデル算出部６０が、上記ステップＳ２１２で受け付けられたロボット１６の機構情報を用いて、ロボットモデル５８を算出する。
【００９５】
次に、ステップＳ４４で、軌道データ生成部２５２が、画像センサ１８からロボット１６周辺の障害物の情報を取得する。
【００９６】
次に、ステップＳ１４で、軌道データ生成部２５２が、生成する軌道の開始姿勢及び終了姿勢を受け付け、軌道計画部２５２Ａが、ロボット１６の取り得る全ての姿勢の集合であるコンフィグレーション空間に、開始姿勢を始点とし、終了姿勢を終点として配置する。
【００９７】
次に、ステップＳ４６で、軌道計画部２５２Ａが、始点と終点との間の任意の複数の点を接続した経路をランダムに複数計画する。また、軌道計画部２５２Ａは、計画した各経路に対して、姿勢を変化させる速度及び加速度を設定し、軌道を計画する。
【００９８】
次に、ステップＳ２２０で、同定条件判定部２５２Ｂが、上記ステップＳ４６で計画された複数の軌道の中から、障害物との干渉が生じる軌道を除外する。そして、同定条件判定部２５２Ｂが、残った軌道の各々について可同定性指標を算出し、可同定性指標が最良となる軌道を選択する。
【００９９】
以下、第１実施形態と同様に、ステップＳ２８〜Ｓ３２で、選択された軌道を示す軌道データを用いてロボットモデル５８のパラメータを同定し、パラメータ同定処理は終了する。
【０１００】
以上説明したように、第２実施形態に係るパラメータ同定システムによれば、パラメータ同定装置が、ロボットモデルのパラメータを一括同定法により同定するための軌道データを、可同定性が最良となるように、モーションプランニングにより生成する。これにより、ロボットに関する数理モデルのパラメータの同定を高速化することができる。その結果、位置決めや動作計画など、ロボットに関する数理モデルを必要とする機能を高速化することができる。
【０１０１】
また、第２実施形態に係るパラメータ同定装置は、軌道の計画の際に障害物との干渉判定も行うため、障害物が存在する環境下においても、ロボットに関する数理モデルのパラメータの同定を高速化することができる。
【０１０２】
さらに、第２実施形態に係るパラメータ同定装置は、画像センサから障害物の情報を取得することで、リアルタイムで障害物環境の構築を行うことができる。これにより、設備のＣＡＤデータ等を事前に用意する必要がなく、また、設備変更等により、ＣＡＤデータを変更して再度取得する等の手間を削減することができる。
【０１０３】
なお、第２実施形態では、画像センサから障害物の情報を取得する方法と軌道データ生成部２５２とを組み合わせた場合について説明したが、第１実施形態の軌道データ生成部５２と組み合わせてもよい。また、第２実施形態では、画像センサから障害物の情報を取得する方法と軌道データ生成部２５２とを組み合わせた場合について説明したが、ＣＡＤデータから障害物の情報を取得する方法と軌道データ生成部２５２とを組み合わせてもよい。
【０１０４】
＜第３実施形態＞
次に、第３実施形態について説明する。なお、第３実施形態に係るパラメータ同定システムにおいて、第１実施形態に係るパラメータ同定システム１００と同一又は等価な構成要素及び部分には同一の参照符号を付与し、詳細な説明を省略する。
【０１０５】
図１に示すように、第３実施形態に係るパラメータ同定システム３００は、パラメータ同定装置１０と、ロボット制御装置１２と、ロボット１６とを含んで構成される。
【０１０６】
第３実施形態に係るパラメータ同定装置３１０のハードウェア構成は、図２に示す第１実施形態に係るパラメータ同定装置１０のハードウェア構成と同様であるため、説明を省略する。
【０１０７】
次に、第３実施形態に係るパラメータ同定装置３１０の機能構成について説明する。
【０１０８】
図１８は、パラメータ同定装置３１０の機能構成の例を示すブロック図である。図１８に示すように、パラメータ同定装置３１０は、機能構成として、軌道データ生成部３５２と、データ取得部５４と、同定部５６とを含む。各機能構成は、ＣＰＵ３２が記憶装置３６に記憶されたパラメータ同定プログラムを読み出し、メモリ３４に展開して実行することにより実現される。なお、軌道データ生成部３５２は、本発明の軌道生成部の一例である。
【０１０９】
軌道データ生成部３５２は、第１実施形態の軌道データ生成部５２と同様に、パラメータ同定条件を満たし、かつ障害物と干渉しない軌道を示す軌道データを生成する。この際、軌道データ生成部３５２は、経由点の指定を受け付け、経由点近傍を経由する軌道データを生成する。経由点の指定は、ロボット１６の動作時に通過させたい姿勢をオペレータ等がマニュアルで入力してもよい。
【０１１０】
具体的には、軌道データ生成部３５２は、機能構成として、軌道計画部３５２Ａと、同定条件判定部５２Ｂとを含み、軌道計画部３５２Ａと、同定条件判定部５２Ｂとを機能させて、軌道データを生成する。
【０１１１】
軌道計画部３５２Ａは、モーションプランニングにより、指定された始点、経由点、及び終点を含む経路をし、計画した経路に、ロボット１６の姿勢を変化させる速度及び加速度の情報を付加した軌道を計画する。
【０１１２】
より具体的には、軌道データ生成部３５２は、軌道計画部３５２Ａを機能させて、図１９に示すように、コンフィグレーション空間に、指定された始点、経由点、及び終点を配置する。なお、図１９において、経由点を三角の記号で示している。軌道計画部３５２Ａは、経由点周辺にランダムにサンプル点を生成する。また、軌道データ生成部３５２は、第１実施形態と同様に、同定条件判定部５２Ｂを機能させて、障害物と干渉せず、可同定性指標が最良となるサンプル点を「次の点」として選択することにより、軌道を計画する。これにより、図２０に示すように、指定された経由点近傍（図２０では経由点上）を通る軌道が生成される。
【０１１３】
次に、第３実施形態に係るパラメータ同定システム３００の作用について説明する。第３実施形態では、パラメータ同定装置３１０において、図１２に示すパラメータ同定処理が実行される。
【０１１４】
第３実施形態におけるパラメータ同定処理では、ステップＳ１４において、始点及び終点と共に、経由点の指定を受け付けること、並びに、ステップＳ１８において、経由点近傍にサンプル点を生成することが第１実施形態と異なり、他の処理については第１実施形態と同様であるため、詳細な説明を省略する。
【０１１５】
以上説明したように、第３実施形態に係るパラメータ同定システムによれば、パラメータ同定装置が、ロボットモデルのパラメータを一括同定法により同定するための軌道データを、障害物との干渉を回避し、かつ可同定性が最良となるように、モーションプランニングにより生成する際に、指定された経由点を含む軌道データを生成する。これにより、軌道の探索範囲が限定されて探索時間が短縮されると共に、運用時の実際のロボットの動作に近い動作を行った際に得られたデータを用いてパラメータの同定を行うことになり、パラメータの同定精度の向上が見込まれる。
【０１１６】
なお、第３実施形態では、経由点を経由する軌道を生成することを第１実施形態の構成に適用する場合について説明したが、第２実施形態の構成に適用してもよい。この場合、軌道計画部が、始点と終点との間の任意の複数の点を接続した経路をランダムに複数計画する際に、経由点又は経由点近傍を通る経路を複数計画すればよい。
【０１１７】
また、上記各実施形態では、軌道計画部及び同定条件判定部において、干渉判定も行いつつ軌道を生成するモーションプランニングの手法を用いて軌道を計画する場合について説明したが、障害物との干渉を考慮しない軌道を計画するモーションプランニングの手法を適用してもよい。この場合、軌道計画部及び同定条件判定部とは別に、障害物との干渉を回避する干渉判定部を追加すればよい。例えば、計画された軌道と障害物の情報とを照合し、障害物と干渉しない軌道が生成されるまで、軌道の計画を繰り返したり、障害物との干渉を回避するように、計画された軌道を修正したりする処理を追加する。
【０１１８】
また、上記各実施形態において、ロボットモデルのパラメータの初期値として、ロボットのＣＡＤモデルに基づいた値を設定してもよい。これにより、軌道データ生成部で軌道データを生成する際に、設定されたパラメータが制約となって探索範囲が限定されるため、軌道データの生成がより高速化され、結果としてパラメータ同定もより高速化される。
【０１１９】
また、上記各実施形態において、軌道データ生成部で、姿勢変化の速度及び加速度を計画された経路に設定する際に、ロボットの機構情報に基づいて設定可能な最大の速度及び加速度を設定した軌道を生成してもよい。これにより、各関節で最大のトルクを発揮するようにロボットを動作させることができる。実際に取得されるトルクのデータにはノイズも重畳されているが、トルクが大きい場合は、Ｓ／Ｎ比が向上するため、最大の速度及び加速度が設定された軌道にしたがってロボットを動作させた際に取得されたデータをパラメータの同定に用いることにより、同定精度の向上が見込める。
【０１２０】
また、上記各実施形態では、垂直多関節型のロボットに関する数理モデルのパラメータ同定について説明したが、本発明は、垂直多関節型のロボットに限定されず、任意の開ループ型のロボットに適用できる。また、デルタロボットなどの閉ループ型のロボットに対しても適用できる。さらに、台座が固定されていない浮遊リンク系であるモバイルロボットやモバイルマニピュレータ等、広範なロボットに対しても適用することができる。
【０１２１】
また、上記各実施形態では、パラメータ同定装置とロボット制御装置とを別々の装置とする場合について説明したが、ロボット制御装置内にパラメータ同定装置を組み込む形態としてもよい。また、パラメータ同定装置の各機能構成を、それぞれ異なる装置で実現し、上記のパラメータ同定処理を分散処理により実現してもよい。
【０１２２】
また、上記各実施形態でＣＰＵがソフトウェア（プログラム）を読み込んで実行したパラメータ同定処理を、ＣＰＵ以外の各種のプロセッサが実行してもよい。この場合のプロセッサとしては、ＦＰＧＡ（Ｆｉｅｌｄ−Ｐｒｏｇｒａｍｍａｂｌｅ  Ｇａｔｅ  Ａｒｒａｙ）等の製造後に回路構成を変更可能なＰＬＤ（Ｐｒｏｇｒａｍｍａｂｌｅ  Ｌｏｇｉｃ  Ｄｅｖｉｃｅ）、及びＡＳＩＣ（Ａｐｐｌｉｃａｔｉｏｎ  Ｓｐｅｃｉｆｉｃ  Ｉｎｔｅｇｒａｔｅｄ  Ｃｉｒｃｕｉｔ）等の特定の処理を実行させるために専用に設計された回路構成を有するプロセッサである専用電気回路等が例示される。また、パラメータ同定処理を、これらの各種のプロセッサのうちの１つで実行してもよいし、同種又は異種の２つ以上のプロセッサの組み合わせ（例えば、複数のＦＰＧＡ、及びＣＰＵとＦＰＧＡとの組み合わせ等）で実行してもよい。また、これらの各種のプロセッサのハードウェア的な構造は、より具体的には、半導体素子等の回路素子を組み合わせた電気回路である。
【０１２３】
また、上記各実施形態では、パラメータ同定プログラムが記憶装置に予め記憶（インストール）されている態様を説明したが、これに限定されない。プログラムは、ＣＤ−ＲＯＭ（Ｃｏｍｐａｃｔ  Ｄｉｓｋ  Ｒｅａｄ  Ｏｎｌｙ  Ｍｅｍｏｒｙ）、ＤＶＤ−ＲＯＭ（Ｄｉｇｉｔａｌ  Ｖｅｒｓａｔｉｌｅ  Ｄｉｓｋ  Ｒｅａｄ  Ｏｎｌｙ  Ｍｅｍｏｒｙ）、及びＵＳＢ（Ｕｎｉｖｅｒｓａｌ  Ｓｅｒｉａｌ  Ｂｕｓ）メモリ等の記録媒体に記録された形態で提供されてもよい。また、プログラムは、ネットワークを介して外部装置からダウンロードされる形態としてもよい。
【符号の説明】
【０１２４】
１０、２１０、３１０ パラメータ同定装置
１２   ロボット制御装置
１６   ロボット
１８   画像センサ
３２   ＣＰＵ
３４   メモリ
３６   記憶装置
３８   入力装置
４０   出力装置
４２   光ディスク駆動装置
４４   通信インタフェース
５２、２５２、３５２ 軌道データ生成部
５２Ａ、２５２Ａ、３５２Ａ  軌道計画部
５２Ｂ、２５２Ｂ     同定条件判定部
５４   データ取得部
５６   同定部
５８   ロボットモデル
６０   モデル算出部
１００、２００、３００      パラメータ同定システム
【図１】
2020011320.tif 000003
【図２】
2020011320.tif 000004
【図３】
2020011320.tif 000005
【図４】
2020011320.tif 000006
【図５】
2020011320.tif 000007
【図６】
2020011320.tif 000008
【図７】
2020011320.tif 000009
【図８】
2020011320.tif 000010
【図９】
2020011320.tif 000011
【図１０】
2020011320.tif 000012
【図１１】
2020011320.tif 000013
【図１２】
2020011320.tif 000014
【図１３】
2020011320.tif 000015
【図１４】
2020011320.tif 000016
【図１５】
2020011320.tif 000017
【図１６】
2020011320.tif 000018
【図１７】
2020011320.tif 000019
【図１８】
2020011320.tif 000020
【図１９】
2020011320.tif 000021
【図２０】
2020011320.tif 000022