JP7764371B2 - ロボット用の３つの自由度を有する関節体の制御方法 - Google Patents

Description

本発明の技術分野は、ロボット用のアクチュエータであり、より詳細には、３つの自由軸を有するアクチュエータである。

本発明の技術分野はまた、３つの自由軸を有するアクチュエータの制御である。

特にロボットの娯楽用途のために、公共及び家庭の空間内で人間との自然な相互作用をもつことができるソーシャルロボットの開発。

そのようなロボットは、特に以下の特徴をもたなければならない。
－相互作用、特に人間によって実行される接触または操作中の物理的な相互作用において安全であり、
－予想外の事象に対応するだけでなく、より楽しめる相互作用を作り出し、生きている錯覚を大事にするために、動的な動きを実行することを可能にし、
－ロボットの意思を人間が直感的に理解することに都合がよい高品質のアニメーションが実行され、オブジェクトを操作することによって現実の物理的な世界で動作することを可能にする。

動作の安全性は、特に、制御における慣性を制限し、公衆を傷つける危険性を制限するために、ロボットの質量またはその部材に起因する。

ロボットでは、３つの軸に従って移動することが可能な関節体を作成することが必要なとき、最も頻繁に使用される技術的解決策は、直列の３つのアクチュエータを連鎖させることである。これは、ほとんどの産業用ロボットで見られ、人型ロボットでも肩及び腰において見られるものである。

これらの直列関節体の問題は、機構及び動態にある。

機構の観点から、任意の方向にいつでも回転することができるようになるボールヘッドの回転特性は、初期ゾーンの周りでのみ実行される。このゾーンから遠く離れるほど、ボールヘッドの特性が保持されなくなる。さらに遠くまで移動すると、自由度の１つが失われるジンバルロックと呼ばれる位置に達する。

動態な観点から、直列の１番目のアクチュエータは、有用な荷重に加えて、２番目及び３番目のアクチュエータの質量を支持する。３番目のアクチュエータの質量を支持しなければならない２番目のアクチュエータについても同様である。したがって、関節体がよく反応し動的であり得ることを保証するために、システム全体に負担をかけ、その慣性及びそのコストを等しく増加させる１番目のアクチュエータを特大にすることが必要になる。

直列アクチュエータを有する関節体の代替は、並列アクチュエータを有する関節体である。これらの機構は、実行及び制御がはるかに複雑であるが、すべてのアクチュエータがロボットのフレームに固定されるという利点を有する。これにより、可動部分にはるかに軽量な構造を有することと、構造を移動させるためにアクチュエータの各々の動力を加えることからの恩恵を受けることの両方が可能になる。最終的に、これにより、迅速かつ正確に移動することが可能な非常に動的なシステムを設計することが可能になる。

従来技術から、並列アクチュエータを有する関節体の以下の例が知られている。

Ｂｕｌｇａｒｅｌｌｉらの非特許文献１は、手話の遠隔通信のための人工手首を開発する目的で、並列アクチュエータを有する関節体を開示している。

非特許文献１は、オイラー角表現を介した関節体の制御を開示している。そのような表現は、従来、そのような複雑なシステムに使用されているが、不安定である。したがって、ジンバルロックにつながる可能性がある。

加えて、関節体の初期位置から離れると、オイラー表現を使用することによってそのような状況では複雑になる、異なる軸を中心とする回転をどのように組み合わせるかを知る必要があるので、与えられるように求められる方向を特徴付けることがますます困難になる。

Ｓｕｄｋｉらの非特許文献２は、海洋動物、特にペンギンの肩部を複製するように、海洋推進器向けの３つの自由度を有するアクチュエータを開示している。

従来技術の並列アクチュエータを有する関節体は、モータが固定されるフレームがかなりのサイズになるという欠点を有する。これらの関節体は、移動式ロボットに統合することが困難である。

A Low-Cost Open Source 3D Printable Dexterous Anthropomorphic Robotic Hand with a Parallel Spherical Joint Wrist for Sign Languages Reproduction、Bulgarelliら、International Journal of Advanced Robotic Systems、第１３巻、第３版、２０１６年１月１日 Marine Propulsor based on a Three-Degree-of-Freedom Actuated Spherical Joint、Ｓｕｄｋｉら、Third International Symposium on Marine Propulsors、smp'13、２０１３年５月

解決されるべき技術的課題は、小型化することによって並列アクチュエータの利点からどのように恩恵を受けるかである。

本発明の１つの目的は、ロボット用の３つの自由度を有する関節体であり、プラットフォームと、各々がピニオンを介してリングギアに接続された３つのモータと、を備え、各リングギアは、各ディスクがリングギアと１つになるように、ベース上に積み重ねられた中空ディスクの内部に配置され、
各ディスクはさらに、それ自体ベース及びディスクの積重体と同じ方向に延在するディスクヘッドと１つになり、
ディスクヘッドごとに、アームは、一方ではディスクヘッドに、他方ではプラットフォームに回転式に接続され、
各モータは、少なくとも１つのディスクの内部に少なくとも部分的に収容される。

各モータは、ディスクの回転軸に対してオフセットされ、ベース及び積み重ねられたディスクによって区切られたキャビティ内に３つのモータを収容するために、異なる角度セクタに配置することができる。

各ディスクヘッドの静止位置は、モータ間のオフセット角度に対応するオフセット角度を有することができる。

各モータはさらに、基準位置に対してモータの出力シャフトを決定するための手段、特に磁気エンコーダを備えることができる。

本発明の別の目的は、プラットフォームにリンクされたベクトルの所要位置及びプラットフォームにリンクされたベクトルを中心とする所要回転角に従ってプラットフォームを方向付けることを可能にする、３つの自由軸を有する関節体を制御するための方法であって、方法は、
初期位置に対する関節体のプラットフォームにリンクされた３軸基準フレームの座標を決定し、所要位置及び所要回転角に対応するプラットフォームに垂直なベクトルを受け取るステップと、
初期位置に対する関節体のプラットフォームにリンクされた３軸基準フレーム内のプラットフォームの初期位置からプラットフォームの中間位置まで通過することを可能にする回転ベクトルの座標を決定するステップであって、中間位置が、プラットフォームの中間位置から所要位置への通過が所要回転角に従うプラットフォーム自体の回転を含むようなものである、ステップと、
プラットフォームの初期位置からプラットフォームの中間位置まで通過することを可能にする初期回転角を決定するステップと、
初期位置に対する関節体のプラットフォームにリンクされた３軸基準フレーム内の所要位置に対する関節体のプラットフォームにリンクされた３軸基準フレームの座標を決定するステップと、
所要回転角、初期回転角及び関節体の構造物にリンクされたパラメータの初期位置に対する関節体のプラットフォームにリンクされた３軸基準フレーム内の所要位置に対する関節体のプラットフォームにリンクされた３軸基準フレームの座標に従って、第１のアームの回転角を決定するステップと、
角度オフセット値に加算された所要回転角、初期回転角及び関節体の構造物にリンクされたパラメータの初期位置に対する関節体のプラットフォームにリンクされた３軸基準フレーム内の所要位置に対する関節体のプラットフォームにリンクされた３軸基準フレームの座標に従って、第２のアームの回転角を決定するステップと、
角度オフセット値を減算された所要回転角、初期回転角及び関節体の構造物にリンクされたパラメータの初期位置に対する関節体のプラットフォームにリンクされた３軸基準フレーム内の所要位置に対する関節体のプラットフォームにリンクされた３軸基準フレームの座標に従って、第３のアームの回転角を決定するステップと
を含み、
ディスクごとに、ディスクの回転角は、対応するアームの回転角及び初期位置に対する関節体のプラットフォームにリンクされた３軸基準フレーム内の所要位置に対する関節体のプラットフォームにリンクされた３軸基準フレームの座標に従って決定され、
各モータは、モータに対応するディスクの回転角で制御される。

回転ベクトルは、初期位置にあるプラットフォームに垂直なベクトルと所要位置にあるプラットフォームに垂直なベクトルとの間のベクトル積として決定することができる。

関節体の構造物にリンクされたパラメータは、遠位円の直径、近位円の直径及び近位円の中心であり得る。遠位円は、プラットフォームの周りのアームによってトレースされる円である。近位円は、ディスクによってトレースされる円である。

回転角は、所要位置にあるプラットフォームに垂直なベクトルによる初期位置にあるプラットフォームに垂直なベクトルのスカラー積のアークコサインとして定義することができる。

初期位置に対する関節体のプラットフォームにリンクされた３軸基準フレーム内の所要位置に対する関節体のプラットフォームにリンクされた３軸基準フレームの座標を決定するために、初期位置から中間位置への通過を可能にする第１の四元数及びプラットフォーム自体の回転によって中間位置から所要位置への通過を可能にする第２の四元数が決定され、
初期位置にあるプラットフォームの基準フレーム内のプラットフォームの所要位置は、プラットフォームの初期位置に２つの四元数を連続して適用することによって決定することができる。

本発明によるシステムは、可逆的である、すなわち関節体がトランスデューサとして動作することができるという利点を有する。言い換えれば、関節体に対する作用は、モータによって電流に変換される。

本発明の他の目的、特徴及び利点は、添付の図面を参照して、非限定的な例としてのみ与えられる以下の説明を読むと明らかになる。

本発明による関節体の三次元図である。 本発明によるアームの側面図である。 本発明によるディスクの断面図である。

本発明による関節体は、アクチュエータを制御する３つの同心軸のシステムを備える。同心軸を動作させるモータは、関節体の内部に一体化される。

関節体１は、３つのモータを回転制御することにより、ベースに対して３つの自由軸に従ってプラットフォーム２を変位させることを可能にする。

関節体１は、各々がピニオン５ａ、５ｂ、５ｃを介してリングギア４ａ、４ｂ、４ｃに接続された３つのモータ３ａ、３ｂ、３ｃが配置されたベースを備える。図１では、モータ３ｃは、リングギア４ａ、４ｂ、４ｃの内側に示されている。しかしながら、モータ３ｂはリングギア４ａ、４ｂの内側に配置され、モータ３ａはリングギア４ａの内側に配置される。各リングギア４ａ、４ｂ、４ｃは、各ディスク６ａ、６ｂ、６ｃがリングギア４ａ、４ｂ、４ｃと１つになるように、ベース上に積み重ねられた中空ディスク６ａ、６ｂ、６ｃの内側に配置される。さらに、各ディスク６ａ、６ｂ、６ｃは、それ自体ベース及びディスク６ａ、６ｂ、６ｃの積重体と同じ方向に延在するディスクヘッド７ａ、７ｂ、７ｃと１つになる。各モータ３ａ、３ｂ、３ｃはさらに、基準位置に対してモータの出力シャフトの角度位置を決定するための手段が備えられる。そのような決定するための手段は、角度位置センサまたは磁気エンコーダであり得る。

図２は、各アーム８ａ、８ｂ、８ｃに対して転置することができる一般的な場合のプラットフォーム及びディスクとのアームの接続を示す。

各ディスクヘッド７、７ａ、７ｂ、７ｃに対して、円弧形状のアーム８、８ａ、８ｂ、８ｃは、一方ではディスクヘッド７、７ａ、７ｂ、７ｃに、他方ではプラットフォーム２に回転式に接続される。ディスクヘッド７、７ａ、７ｂ、７ｃとアーム８、８ａ、８ｂ、８ｃとの間の回転軸及びアーム８、８ａ、８ｂ、８ｃとプラットフォーム２との間の回転軸は、対応するアーム８、８ａ、８ｂ、８ｃを備えるものと同じ平面内に含まれる。有利なことに、円弧形状は円の４分の１を表す。

ディスク６、６ａ、６ｂ、６ｃはケーシングを形成し、ディスク６、６ａ、６ｂ、６ｃの移動を容易にし、摩擦及び摩耗を低減し、ディスク６、６ａ、６ｂ、６ｃのベースに対する位置合わせ及びディスク６、６ａ、６ｂ、６ｃの間の位置合わせを維持することを可能にするベアリングが備えられる。

言い換えれば、第１のディスク６ａは、ディスクヘッド７ａを介して第１のアーム８ａに接続され、第１のディスク６ａは、第１のリングギア４ａ及び第１のピニオン５ａを介して第１のモータ３ａによって駆動される。

同じ配置が第２のディスク６ｂ及び第３のディスク６ｃに対して設けられる。

より正確には、第２のディスク６ｂは、ディスクヘッド７ｂを介して第２のアーム８ｂに接続され、第２のディスク６ｂは、第２のリングギア４ｂ及び第２のピニオン５ｂを介して第２のモータ３ｂによって駆動される。同様に、第３のディスク６ｃは、ディスクヘッド７ｃを介して第３のアーム８ｃに接続され、第３のディスク６ｃは、第３のリングギア４ｃ及び第３のピニオン５ｃを介して第３のモータ３ｃによって駆動される。

第１のディスク６ａは、それ自体が第３のディスク６ｃ上に積み重ねられた第２のディスク６ｂ上に積み重ねられる。第３のディスク６ｃはベース上に配置される。第１のアーム６ａ、第２のアーム６ｂ及び第３のアーム６ｃは、プラットフォームに接続される。

図１を参照すると、各ピニオン５ａ、５ｂ、５ｃは、対応するリングギア４ａ、４ｂ、４ｃを機械的に駆動するようにベースから異なる高さに配置されていることが分かる。加えて、ベース及び積み重ねられたディスク６ａ、６ｂ、６ｃによって区切られたキャビティ内に３つのモータ３ａ、３ｂ、３ｃを収容するために、各モータ３ａ、３ｂ、３ｃは、ディスク６ａ、６ｂ、６ｃの回転軸に対してオフセットされ、異なる角度セクタに配置される。この配置が図３に示されている。したがって、３つのモータ３ａ、３ｂ、３ｃでは、各モータ３ａ、３ｂ、３ｃは異なる１２０°セクタに配置される。

この１２０°のオフセット角は、各ディスクヘッド７、７ａ、７ｂ、７ｃの静止位置にも見られ、各ディスクヘッド７、７ａ、７ｂ、７ｃは、他の２つから１２０°に配置されている。

モータ３ａ、３ｂ、３ｃは、プラットフォーム２の向きを制御するように制御され、プラットフォーム２は、近位円と呼ばれる円上の各ディスク６ａ、６ｂ、６ｃの回転を駆動する。各ディスク６ａ、６ｂ、６ｃの回転は、遠位円と呼ばれる別の円上で機械的に接続されたアーム８ａ、８ｂ、８ｃの回転を駆動する。

図１を参照すると、プラットフォーム２にリンクされた基準フレームＲがそこに示されていることが分かる。指向正規直交三次元基準フレームＲは、プラットフォーム２の重心に位置する原点Ｏ（０，０，０）と、プラットフォーム２に垂直なベクトルＺ（０，０，１）と、プラットフォーム２の表面に平行に延在し、プラットフォーム２との第３のアーム８ｃの接続を通過するベクトルＹ（０，１，０）と、ベクトルＹ及びＺに直交し、指向正規直交基準フレームを形成するベクトルＸ（１，０，０）とを含むものとして定義される。３次元指向基準フレームは基準フレームであり、ベクトルＸとベクトルＹとの間の角度は指向角であり、ベクトルＹとベクトルＺとの間の角度は指向角であり、ベクトルＺとベクトルＸとの間の角度は指向角であることを想起されたい。

ここで、プラットフォーム２を所定の位置に位置決めすることを可能にするシステムの制御に注目する。

ジンバルロックを防止するために、四元数の形式の表現が使用される。四元数は、このベクトルの周りの角度θだけの回転と組み合わされた三次元空間の正規化されたベクトルである。

以下の大きさが定義される。
Ｒ０＝（Ｘ０，Ｙ０，Ｚ０）：プラットフォーム２の初期位置を定義する指向直交基準フレーム
Ｒｒｅｑ＝（Ｘｒｅｑ，Ｙｒｅｑ，Ｚｒｅｑ）：プラットフォーム２の所要位置を定義する指向直交基準フレーム
Ｖ＝（ａ，ｂ，ｃ）：ベクトルＲ０及びＲｒｅｑによって定義される平面に直交する回転ベクトル
θ：プラットフォーム２のための所要位置を定義するベクトルＶの周りの回転角
β：初期位置と所要位置との間のプラットフォーム２自体の回転角

プラットフォーム２は、基準フレームＲ０によって定義された初期位置から基準フレームＲｒｅｑによって定義された所要位置まで通過するように制御されることが求められる。

次いで、運動は２つの回転に分解される。第１の回転は、基準フレームＲ０及びＲｒｅｑによって定義された平面に垂直なベクトルＶの周りの角度θだけの回転である。

第２の回転は、プラットフォーム２のベクトル法線の周りのβだけの回転である。プラットフォーム２の法線ベクトルは、ベクトルＺ０、Ｚｒｅｑ、または任意の他の中間ベクトルであり得ることに留意されたい。

回転の順序は無関係である。したがって、第２の回転は第１の回転の前に実行することができる。

次いで、ベクトルＶは、以下の方法でベクトルＺ０及びＺｒｅｑのベクトル積として定義される。
［数式１］

回転角θは、プラットフォーム２に垂直なＲ０及びＲｒｅｑの成分に従って定義される。
［数式２］

次いで、ベクトルＶは、四元数とともに使用できるように正規化される。

ベクトルＶの周りの角度θだけの第１の回転に関連付けられた第１の四元数ｑ１は、以下のように記述される。
［数式３］
ここで、
［数式４］
［数式５］
［数式６］
［数式７］

次いで、プラットフォーム２に垂直なベクトルの周りで角度βだけ第２の回転を実行することを可能にする第２の四元数ｑ２が定義される。第１の四元数ｑ１について提示されたものと同じ形式を使用することによって、以下が得られる。
［数式８］
ここで、
［数式９］
［数式１０］
［数式１１］
［数式１２］

プラットフォーム２に垂直なベクトルは、形式（０，０，Ｚ）のベクトルである。この場合、四元数の項ｘ２及びｙ２は０である。

したがって、初期位置にリンクされた基準フレームＲ０から所要位置にリンクされた基準フレームＲｒｅｑへの通過を可能にする２つの回転に関連付けられた２つの四元数が存在する。

しかしながら、アームがプラットフォーム２を初期位置Ｒ０から所要位置Ｒｒｅｑに移動させるようにこれらの四元数によって定義された回転を実行するために、θ１１、θ１２、θ１３と注記される３つのモータの回転角を決定することが依然として必要である。

これらの回転角を決定するために、以下の要素が定義される。
Ｒｄ：遠位円とも呼ばれる、プラットフォーム２の周りのアームによってトレースされる円の半径
Ｒｐ：近位円とも呼ばれる、ディスクによってトレースされる円の半径
Ｃｐ＝（０，０，Ｃｚ）：近位円とも呼ばれる、ディスクによってトレースされる円の中心の座標
Ｐｃ＝（０，０，０）：遠位円の中心の座標
θ３ｉ プラットフォーム２に対するアームｉの角度
θ１ｉ その基準位置に対するディスクｉの角度

遠位円Ｘｉ及び近位円Ｘｉ_ｐの式は、以下の式によって表現される。
［数式１３］
［数式１４］

したがって、第１の四元数ｑ１を適用することにより、基準フレームＲ０によって定義された初期位置から基準フレームＲｉｎｔｅｒによって定義された中間位置への通過を可能にする第１の変位が定義される。
［数式１５］

したがって、第２の四元数ｑ２を適用することにより、基準フレームＲｉｎｔｅｒによって定義された中間位置から基準フレームＲｒｅｑによって定義された所要位置への通過を可能にする第２の変位が定義される。
［数式１６］
座標Ｚ上の四元数がこのように適用されると、以下が得られる。
［数式１７］
［数式１８］

しかしながら、第２の四元数ｑ２によって定義された回転は、方向Ｚの周りで実行される。したがって、方向Ｚは不変であり、したがって、そこからＺｉｎｔｅｒ＝Ｚｒｅｑが導出される。

回転ベクトルが正規化されている場合、四元数ｑ１の共役
が四元数ｑ１の逆数に等しいことに留意されたい。したがって、
及び
が得られる。

第２の四元数ｑ２の適用中に軸Ｘ及びＹを中心とする回転がないので、座標Ｘｒｅｑ及びＹｒｅｑの計算は、２つの四元数ｑ１及びｑ２を含む単一のステップで実行することができる。
［数式１９］
［数式２０］

基準フレーム内の変化を伴って、座標Ｘ０、Ｙ０、Ｚ０及び座標Ｘｒｅｑ、Ｙｒｅｑ、Ｚｒｅｑは、プラットフォームの初期位置にリンクされた基準フレームＲ０内で定義される。

したがって、基準フレームＲ０では、以下の式を有する。
Ｘ０＝（Ｘ０，０，０）
Ｙ０＝（０，Ｙ０，０）
Ｚ０＝（０，０，Ｚ０）
Ｘｒｅｑ＝（Ｘｘ，Ｙｘ，Ｚｘ）
Ｙｒｅｑ＝（Ｘｙ，Ｙｙ，Ｚｙ）
Ｚｒｅｑ＝（Ｘｚ，Ｙｚ，Ｚｚ）

座標Ｘｒｅｑ、Ｙｒｅｑ、Ｚｒｅｑを知ることにより、ディスクの角度θ１１、θ１２、θ１３を決定することが可能である。
式１及び式２から生じる式Ｘｉ＝Ｘｐを解くことによって、以下の連立方程式が得られる。
［数式２１］
［数式２２］
［数式２３］

この連立方程式［数式２１］、［数式２２］、［数式２３］を解くことにより、それぞれ、角度θ３ｉ及びθ１ｉの以下の式が得られる。
［数式２４］
［数式２５］

式［数式２４］の適用により、システムの各アームｉの角度θ３ｉが最初に決定される。式［数式２５］の適用により、システムの各ディスクｉの角度θ１ｉが次に決定される。

上述されたように、ベクトルＺｒｅｑは、第２の回転角βによる回転によって修正されない。一方、ベクトルＸｒｅｑ及びＹｒｅｑは、確かにこの回転によって修正される。

静止時には、各ディスクは互いに対して１２０°だけオフセットされる。第１のディスクの角度位置を基準とすると、第２の回転角βに対して＋１２０°のオフセットを適用することによって第２のディスクの角度位置を、第２の回転角βに対して－１２０°のオフセットを適用することによって第３のディスクの角度位置を得ることが可能である。

式［数式２４］及び［数式２５］の値Ｘｘ、Ｙｘ及びＺｘがこのオフセットに起因して修正されることがこれから生じる。

上述された実施形態は、プラットフォームにリンクされた基準フレームの軸Ｚに沿った第２の回転を含む。他の実施形態では、第２の回転は、軸Ｘもしくは軸Ｙに沿って、またはプラットフォームにリンクされたベクトルに沿って実行することができる。当業者であれば、考慮された軸に従って上述された数学的形式を適合させるであろう。

同様に、本発明の範囲を逸脱することなく、第１の回転及び第２の回転を反転させて入れ替えることができる。

プラットフォーム２の所要位置及び所要回転角に従ってプラットフォーム２を方向付けることを可能にする３つの自由軸を有する関節体を制御するための方法は、以下のステップを含む。

第１のステップの間に、初期位置に対する関節体のプラットフォーム２にリンクされた指向正規直交３軸基準フレームの座標が決定され、所要位置及び所要回転角に対する関節体のプラットフォーム２にリンクされた指向正規直交３軸基準フレームの座標が決定される。

第２のステップの間に、プラットフォーム２の初期位置にリンクされた基準フレームから、初期位置に対する関節体のプラットフォーム２にリンクされた３軸基準フレーム内のプラットフォーム２の中間位置にリンクされた基準フレームへの通過を可能にする回転ベクトルＶの座標が決定され、中間位置は、プラットフォーム２の中間位置から所要位置への通過が、所要回転角に従ってプラットフォーム２自体の回転を含むようなものである。

第３のステップの間に、プラットフォーム２の初期位置からプラットフォーム２の中間位置への通過を可能にする初期回転角が決定される。

第４のステップの間に、初期位置に対する関節体のプラットフォーム２にリンクされた３軸基準フレーム内の所要位置に対する関節体のプラットフォーム２にリンクされた３軸基準フレームの座標が決定される。

第５のステップの間に、所要回転角、初期回転角及び関節体の構造物にリンクされたパラメータの初期位置に対する関節体のプラットフォーム２にリンクされた３軸基準フレーム内の所要位置に対する関節体のプラットフォーム２にリンクされた３軸基準フレームの座標に従って、第１のアームの回転角θ３１が決定される。

第６のステップの間に、角度オフセット値に加算された所要回転角、初期回転角及び関節体の構造物にリンクされたパラメータの初期位置に対する関節体のプラットフォーム２にリンクされた３軸基準フレーム内の所要位置に対する関節体のプラットフォーム２にリンクされた３軸基準フレームの座標に従って、第２のアームの回転角θ３２が決定される。

第７のステップの間に、角度オフセット値を減算された所要回転角、初期回転角及び関節体の構造物にリンクされたパラメータの初期位置に対する関節体のプラットフォーム２にリンクされた３軸基準フレーム内の所要位置に対する関節体のプラットフォーム２にリンクされた３軸基準フレームの座標に従って、第３のアームの回転角θ３３が決定される。

第８のステップの間に、ディスクごとに、対応するアームの回転角及び初期位置に対する関節体のプラットフォーム２にリンクされた３軸基準フレーム内の所要位置に対する関節体のプラットフォーム２にリンクされた３軸基準フレームの座標に従って、ディスクの回転角が決定される。

各モータは、モータに対応するディスクの回転角で制御される。

１ 関節体、２ プラットフォーム、３ａ 第１のモータ、３ｂ 第２のモータ、３ｃ 第３のモータ、４ａ 第１のリングギア、４ｂ 第２のリングギア、４ｃ 第３のリングギア、５ａ 第１のピニオン、５ｂ 第２のピニオン、５ｃ 第３のピニオン、６ ディスク、６ａ 第１のディスク，中空ディスク、６ｂ 第２のディスク，中空ディスク、６ｃ 第３のディスク，中空ディスク、７ ディスクヘッド、７ａ 第１のディスクヘッド、７ｂ 第２のディスクヘッド、７ｃ 第３のディスクヘッド、８ アーム、８ａ 第１のアーム、８ｂ 第２のアーム、８ｃ 第３のアーム

Claims (5)

1. ロボット用の３つの自由度を有する関節体を制御するための方法であって、
   前記関節体は、
   プラットフォーム（２）と、
   各々がピニオン（５ａ、５ｂ、５ｃ）を介してリングギア（４、４ａ、４ｂ、４ｃ）に接続された３つのモータ（３ａ、３ｂ、３ｃ）と、
   を備え、
   前記リングギア（４、４ａ、４ｂ、４ｃ）それぞれが、ベース上に積み重ねられた中空ディスク（６ａ、６ｂ、６ｃ）の内部に配置され、それにより、前記ディスク（６、６ａ、６ｂ、６ｃ）それぞれが、リングギア（４、４ａ、４ｂ、４ｃ）と１つになり、
   前記ディスク（６、６ａ、６ｂ、６ｃ）それぞれがさらに、それ自体前記ベース及び前記ディスク（６、６ａ、６ｂ、６ｃ）の積重体と同じ方向に延在するディスクヘッド（７、７ａ、７ｂ、７ｃ）と１つになり、
   前記ディスクヘッド（７、７ａ、７ｂ、７ｃ）ごとに、アーム（８、８ａ、８ｂ、８ｃ）が、一方では前記ディスクヘッド（７、７ａ、７ｂ、７ｃ）に、他方では前記プラットフォーム（２）に回転式に接続され、
   前記モータ（３ａ、３ｂ、３ｃ）それぞれが、少なくとも１つの前記ディスク（６、６ａ、６ｂ、６ｃ）の内部に少なくとも部分的に収容される、
   関節体であり、
   前記方法が、
   前記プラットフォーム（２）にリンクされたベクトルの所要位置及び前記プラットフォーム（２）にリンクされた前記ベクトルを中心とする所要回転角に従って前記プラットフォーム（２）を方向付けることを可能にする方法であって、
   － 初期位置に対する前記関節体の前記プラットフォーム（２）にリンクされた３軸基準フレームの座標を決定し、前記所要位置及び所要回転角に対応する前記プラットフォーム（２）に垂直な前記ベクトルを受け取るステップと、
   － 前記初期位置に対する前記関節体の前記プラットフォーム（２）にリンクされた前記３軸基準フレーム内の前記プラットフォーム（２）の前記初期位置から前記プラットフォーム（２）の中間位置まで通過することを可能にする回転ベクトルの前記座標を決定するステップであって、前記中間位置が、前記プラットフォーム（２）の前記中間位置から前記所要位置への前記通過が所要回転角に従う前記プラットフォーム（２）自体の回転を含むようなものである、ステップと、
   － 前記プラットフォーム（２）の前記初期位置から前記プラットフォーム（２）の中間位置まで通過することを可能にする初期回転角を決定するステップと、
   － 前記初期位置に対する前記関節体の前記プラットフォーム（２）にリンクされた前記３軸基準フレーム内の前記所要位置に対する前記関節体の前記プラットフォーム（２）にリンクされた前記３軸基準フレームの前記座標を決定するステップと、
   － 前記所要回転角、前記初期回転角及び前記関節体の構造物にリンクされたパラメータの前記初期位置に対する前記関節体の前記プラットフォーム（２）にリンクされた前記３軸基準フレーム内の前記所要位置に対する前記関節体の前記プラットフォーム（２）にリンクされた前記３軸基準フレームの前記座標に従って、第１の前記アームの回転角を決定するステップと、
   － 角度オフセット値に加算された前記所要回転角、前記初期回転角及び前記関節体の前記構造物にリンクされたパラメータの前記初期位置に対する前記関節体の前記プラットフォーム（２）にリンクされた前記３軸基準フレーム内の前記所要位置に対する前記関節体の前記プラットフォーム（２）にリンクされた前記３軸基準フレームの前記座標に従って、第２の前記アームの前記回転角を決定するステップと、
   － 前記角度オフセット値を減算された前記所要回転角、前記初期回転角及び前記関節体の前記構造物にリンクされたパラメータの前記初期位置に対する前記関節体の前記プラットフォーム（２）にリンクされた前記３軸基準フレーム内の前記所要位置に対する前記関節体の前記プラットフォーム（２）にリンクされた前記３軸基準フレームの前記座標に従って、第３の前記アームの前記回転角を決定するステップと、
   を含み、
   前記ディスクごとに、前記ディスクの回転角が、前記対応するアームの前記回転角及び前記初期位置に対する前記関節体の前記プラットフォーム（２）にリンクされた前記３軸基準フレーム内の前記所要位置に対する前記関節体の前記プラットフォーム（２）にリンクされた前記３軸基準フレームの座標に従って決定され、
   前記モータそれぞれが、前記モータに対応する前記ディスクの前記回転角で制御される、方法。
2. 前記回転ベクトルが、前記初期位置にある前記プラットフォーム（２）に垂直な前記ベクトルと前記所要位置にある前記プラットフォーム（２）に垂直な前記ベクトルとの間のベクトル積として決定される、請求項１に記載の方法。
3. 前記関節体の前記構造物にリンクされた前記パラメータが、遠位円の直径、近位円の直径及び前記近位円の中心である、請求項１に記載の方法。
4. 前記回転角が、前記所要位置の前記プラットフォームに垂直なベクトルによる前記初期位置の前記プラットフォームに垂直なベクトルのスカラー積のアークコサインとして定義される、請求項１に記載の方法。
5. 前記初期位置に対する前記関節体の前記プラットフォーム（２）にリンクされた前記３軸基準フレーム内の前記所要位置に対する前記関節体の前記プラットフォーム（２）にリンクされた前記３軸基準フレームの前記座標を決定するために、前記初期位置から前記中間位置への通過を可能にする第１の四元数及び前記プラットフォーム自体の回転によって前記中間位置から前記所要位置への通過を可能にする第２の四元数が決定され、
   前記プラットフォームの前記初期位置に２つの前記四元数を連続して適用して、前記初期位置にある前記プラットフォームにおける前記基準フレーム内の前記プラットフォームの前記所要位置を決定するステップ
   をさらに含む、請求項１に記載の方法。