(57)【特許請求の範囲】
【請求項１】
冗長軸を構成する移動部材に関節部を介して順次連結された２つの回動可能なアームを有し、該アーム上の所定位置を直線動作させようとすると前記アームがある平面において冗長な自由度を有することになる冗長ロボットの冗長軸位置決定方法において、前記互いに連結された２つのアームが重なったときの前記ロボットアームの所定位置である特異点に関し、前記冗長軸を動かすことによってこの特異点の軌跡を求める一方、与えられた目標位置に対する前記所定位置の移動方向をアクセス方向として定め、前記特異点軌跡と前記目標位置を通る前記アクセス方向に平行な直線とにより形成される交点を基準として前記冗長軸の位置を求めることを特徴とする冗長ロボットの冗長軸位置決定方法。
【請求項２】
前記特異点軌跡は前記アクセス方向に平行なある直線と一点のみ交差するように求める領域が設定されてなることを特徴とする請求項１記載の冗長ロボットの冗長軸位置決定方法。
【請求項３】
前記特異点軌跡の中心と前記交点とを結ぶ直線の角度θ１を求め、前記冗長軸の角度をその角度θ１と等しく設定することを特徴とする請求項１または２記載の冗長ロボットの冗長軸位置決定方法。
【発明の詳細な説明】
【０００１】
【発明の属する技術分野】
本発明は、冗長ロボットの冗長軸位置決定方法に関する。更に詳述すると、本発明は、冗長ロボットの冗長軸を拘束する条件の付与方法に関する。
【０００２】
【従来の技術】
平面位置決めに関し、図１４に示すような各アーム３２，３３による２関節型ロボット１１においては、アーム３３先端の目標位置の座標が与えられれば各関節や各アーム３２，３３の位置が一義的に定まりロボット１１の姿勢もおのずと決まるのに対し、冗長な自由度を持つロボットの場合にあっては目標位置の他に冗長軸の決定条件が必要となる。即ち、図１５に示すような冗長軸２を有する冗長ロボット１では当該冗長軸２によるアーム２１先端の位置を直接決定しなければならないし、また図１６に示すような水平走行軸２２を有するスカラロボットの場合には、水平走行軸２２を冗長軸２とみなして走行軸位置を直接決定しなければならない。
【０００３】
このように、２次元の平面上でマニピュレータを位置決めする際の最低必要自由度は２であり、２関節の場合は目標位置に対して姿勢が定まる（ただしスカラの場合右、左の違いは存在している）のに対し、これにもう一つ関節が加わるとマニピュレータの自由度が増えて上述したように姿勢が定まらなくなり、軸の位置を一義的に決定できなくなる場合が生じる。そこで、冗長ロボット１の動作に際しては、まずその冗長な軸２を位置決めし、拘束してから残りの２関節の位置を定めるようにしている。このように冗長軸２を拘束すれば、残りの軸の位置は一義的に定まる。
【０００４】
【発明が解決しようとする課題】
しかしながら、冗長ロボット１の冗長軸２が固定された場合に、冗長軸２以外の残りの軸において、２関節ロボットに特有の問題が生じることがある。即ち２関節ロボット１１ではアームが重なる位置に特異点５と呼ばれる地点があり、アーム上の一点を直線運動させるような場合に、その直線軌跡と特異点５とがずれているとその特異点５を経過することができずに動作不能となってしまうことがあるという問題がある。また図１７（Ａ）〜（Ｃ）に示すように、特異点５の近傍において各アーム３２，３３に動力学的に無理な運動をさせてしまうという問題もある。この場合第１アーム（３関節ロボットにおける第２アームに相当）３２と、第２アーム（同第３アームに相当）３３とが特異点５の近傍で大きく回り込まなければならなくなっている。なお、図１７において符号６，１０はそれぞれハンド、搬送対象物（ワーク）を示している。
【０００５】
このような問題は、冗長ロボット１の冗長性を生かした最適な姿勢をとれば回避され得るものではあるが、従来は冗長軸２に適正な決定条件を付与しないままその位置を決定してしまっていたためにそのような回避が困難であった。あるいは、プログラムなど何らかの決定条件を付与したとしても、冗長軸２は各ロボットの構造に依存しているものなので、同じ決定条件であっても機構の異なるロボット間では互換性がなくなってしまうことがあった。
【０００６】
そこで、本発明は、アームの動作に際し、冗長軸の適正位置を決定して直線動作を補間することができる冗長ロボットの冗長軸位置決定方法を提供することを目的とする。
【０００７】
【課題を解決するための手段】
かかる目的を達成するため、請求項１記載の発明の冗長ロボットの冗長軸位置決定方法では、冗長軸を構成する移動部材に関節部を介して順次連結された２つの回動可能なアームを有し、該アーム上の所定位置を直線動作させようとするとアームがある平面において冗長な自由度を有することになる冗長ロボットの冗長軸位置決定方法において、互いに連結された２つのアームが重なったときのロボットアームの所定位置である特異点に関し、冗長軸を動かすことによってこの特異点の軌跡を求める一方、与えられた目標位置に対する所定位置の移動方向をアクセス方向として定め、特異点軌跡と目標位置を通るアクセス方向に平行な直線とにより形成される交点を基準として冗長軸の位置を求めるようにしている。
よって冗長軸は、ロボットアームの所定位置の直線動作が補間されるように最適位置に設定される。このようにして冗長軸が設定・固定されると、ロボットアームの所定位置が交点を通過するように冗長軸以外のアームが回動可能となる。交点は特異点軌跡と目標位置を通るアクセス方向に平行な直線とにより形成されており、冗長ロボットの動作の際にロボットアームの所定位置がこの交点を通過するようにされるので、ロボットアームが特異点を経由できずに動作不能となってしまったり、動力学的に無理な運動が生じてしまったりするなどの事態が回避される。
【０００８】
ここで導入されるアクセス方向とは、冗長ロボットの冗長軸以外における所定位置の移動方向を表すための概念であり、具体的にはアーム先端の移動可能領域における主要移動方向を表している。例えば冗長ロボットによりワークを搬送する場合、各アームの動きを組み合わせれば当該ワークをどの方向へも移動させることが可能となる。ここではそのうちの主要移動方向、即ち当該ワークを搬送させようとする方向を示すものとして定義している。冗長軸は、ワーク（あるいはアーム先端など）がアクセス方向と平行に移動したときの直線軌跡が特異点を通過するような最適位置に設定され、この冗長軸以外における所定位置の直線動作が補間されるようにしている。このように直線動作が補間されることによって、冗長ロボットの動作の際、冗長軸以外の所定位置が特異点を経由できずに動作不能となったり、動力学的に無理な運動が生じてしまったりするなどの事態が回避される。
【００１５】
請求項２記載の冗長ロボットの冗長軸位置決定方法においては、特異点軌跡はアクセス方向に平行なある直線と一点のみ交差するように求める領域が設定されてなる。したがって目標位置とアクセス方向とによって冗長軸の最適位置が一義的に決定される。
【００１６】
請求項３記載の冗長ロボットの冗長軸位置決定方法においては、特異点軌跡の中心と交点とを結ぶ直線の角度θ１を求め、冗長軸の角度をその角度θ１と等しく設定するようにしている。このように冗長軸が設定・固定されることによって、ロボットアームの所定位置が交点を通過するように冗長軸以外のアームが回動可能となる。
【００１７】
【発明の実施の形態】
以下、本発明の構成を図面に示す実施の形態の一例に基づいて詳細に説明する。
【００１８】
図１〜図１９に本発明の冗長ロボット１の冗長軸位置決定方法の一実施形態を示す。この冗長ロボット１の冗長軸位置決定方法では、アクセス方向ａという概念を導入し、このアクセス方向ａを利用して冗長軸２の最適位置（例えば回動アームの場合は回転角θの値）を見つけだすようにしている。これは、ある平面に関して冗長な自由度を有する冗長ロボット１の、冗長軸以外の軸３により定まる特異点５を冗長軸２を動かすことによって得られる特異点軌跡５１と、アクセス方向ａとにより冗長軸２の適正位置を決定しようとするものである。この場合、冗長ロボット１は、冗長軸２を構成する移動部材に関節部４を介して順次連結された２つの回動可能なアーム（第２アーム３２、第３アーム３３）を有し、冗長軸２に対するアーム先端３３ａの可動領域の主要方向をアクセス方向ａとして規定し、２つのアーム３２，３３により特異点軌跡５１を求める一方、アクセス方向ａと特異点軌跡５１から移動部材のアームとの連結部である関節部４の位置を決定するようにしている。
【００１９】
まず、本発明において導入されている概念であるアクセス方向ａについて説明する。アクセス方向ａは、例えば図２に示すように、カセットやロードロックなどの収容部７の開口している面へハンド６などが挿入するときの方向を示す概念として示されている。図２の場合、アクセス方向ａは、ハンド６を開口面に対し真っすぐに挿入させるように、図示するＸ軸、Ｙ軸方向に平行なものとされている。ただし方向はこのようなものに限られず、例えば図１１、図１２などに示すように、Ｘ軸（Ｙ軸）に対して角度を有するように斜めに設定されても構わない。この場合、アームの所定位置（例えばアーム先端３３ａ）が移動する軌跡を、以下では便宜上、アーム軌跡といい図６や図７に示すように符号Ｌで表すことにする。このアクセス方向ａは厳密なものである必要はなく、数度程度の多少の誤差を含んでいても冗長軸２の位置決め精度に大きな影響を与えることはない。冗長ロボット１などのロボットマニピュレータでＸ−Ｙ平面の精度を確保するために通常行われるティーチング作業時、このアクセス方向ａが決定していればマニピュレータの姿勢は一義的に決定され、純粋な再現精度により精度が確保され得るようになる。
【００２０】
次に、冗長ロボット１も含めたロボットの姿勢（＝ポーズ）の分類について説明する。図３に示す２関節ロボット１１のように、冗長でない水平２関節型マニピュレータは１つの座標に対して２種類の位置決め姿勢、即ち図３（Ａ）に示す左手のような左姿勢と、図３（Ｂ）に示す右手のような右姿勢とをとることができる。このような２種類の姿勢のどちらになるかは、逆機構解を解くとき三角関数の範囲や自乗根の演算の際に生じる符号の選択としてこの逆機構解の中に現れる。この逆機構解より実際の数値を選択するにはこの符号選択や逆三角関数の範囲をどこに取るかによって図４や図５の様にアーム３２，３３の姿勢が変化し、これらアーム３２，３３の可動角度によって位置決めできる領域も異なってくる。これらの姿勢としては、可動領域内であれば、Ｘ−Ｙ平面の１点の座標から角度を求めるに際して右姿勢と左姿勢のどちらが選択されていても問題はない。ただし、移動先へ向かう途中の特異点５近傍で無理なアーム動作が生じる場合や、特異点５を経由しないときに所望の姿勢では到達不可能となる場合などを考慮すると、実際のロボットの作業においてどのような姿勢が最適になるかを見定めるようにすることが必要となる。このためには、アプリケーションの動作を大まかに検討し、そのアプリケーションの必要とする位置決めすべき座標と動作経路により決定することが好ましい。
【００２１】
冗長ロボット１は、図２などに示すような冗長軸２を有するロボットであり、ここでは、少なくとも３軸の移動可能な関節部４を連結することによりロボットアームの所定位置がある平面において冗長な自由度を有するように構成されている。この場合の所定位置とは、例えばアーム先端３３ａであり、あるいはハンド６の先端である。また、この冗長ロボット１は図４及び図５に示すような４種類の姿勢をとることができる。即ち、冗長軸２に対するワークなどの搬送対象物（以下単に「ワーク」という）１０の位置関係により右手姿勢（以下「Right」という）と左手姿勢（以下「Left」という）とに分けられるのは上述のとおりであり、更に冗長軸２とワーク１０の距離によって冗長ロボット１のアーム３２，３３の姿勢が変わるので、図示するように遠い場合（以下「Far」という）と近い場合（以下「Near」という）とに分けられるため、これらの組み合わせにより４種の姿勢が得られることになる。このように、Rightか Leftかで２つのアーム３２，３３は、右手姿勢か左手姿勢かにより求める特異点軌跡５１を異ならせている。
【００２２】
ここで、ワーク１０を直線動作で搬送する際の冗長ロボット１の姿勢を、水平冗長３軸マニピュレータにおいて考察する。ここでは、３軸のうちの冗長軸２以外の連結された２軸によって定まる特異点５を冗長軸（第１アーム）２を動かすことによって得られる特異点軌跡５１を求める一方与えられた目標位置である予点Ｐ０に対してロボットアームの所定位置の可動領域の主要方向をアクセス方向ａとして定め、特異点軌跡５１と、目標位置Ｐ０を通るアクセス方向ａに平行な直線とにより形成される交点Ｓ０を基準として冗長軸２である残りの軸の適正位置を求めるようにする。
【００２３】
まず、上述したようにそれぞれのカセットなどの収容部７からワーク１０を移動させる動作には大きく分類して４種類の姿勢があるので、これらを便宜上それぞれ「Far Right」、「Near Right」、「Near Left」、「Far Left」と名付けると共に、以下ではこれらの４姿勢のうちNear Rightを例として挙げ考えることとする。
【００２４】
図１に示すように、Ｘ軸に対する冗長軸２の角度をθ１、冗長軸２に対する第２アーム３２の角度をθ２、第２アーム３２に対する第３アーム３３の角度をθ３とする。この場合、図６に示すようなNear Rightにおける引き出し動作によって、各アームはθ３が＋となるように、θ２が−となるように回転する。そして第２アーム３２と第３アーム３３とが特異点５にて重なる状態（図６中のＸ軸上にある状態）を経由し、第３アームはπ以上（最大２π）の角度まで回転する。同様にして、図７に示すように、Near Leftにおいても第３アームは０〜２πの範囲をとり得る。各アームが図６及び図７に示すような動作をしたときのθ３の可動範囲をそれぞれ同図中に円弧状に矢示する。なお、冗長軸２、第２アーム３２、第３アーム３３の長さは図１のようにそれぞれＬ１、Ｌ２、Ｌ３で示されている。
【００２５】
このようなNear動作においては、図６や図７のようにアーム軌跡Ｌ上に特異点５が位置していれば、各アーム３２，３３はこの特異点５を経由するように動作することが可能となる一方、そうでない場合には動作不能になる。即ち、特異点５を経由しないことには直線動作の際の引き出し距離を充分に確保できないことから、Near Rightでθ３がπを経過する（第２アーム３２、第３アーム３３が特異点５で重なり更に回動する）こともできなくなり、補間動作を行い得なくなる。実際には、この特異点５の位置は第１アームたる冗長軸２の角度θ１を変化させることで移動することもあるので、この観点から冗長パラメータを決定するようにする。このように、Nearにおける冗長パラメータの決定を行うには、特異点５を経由させるための補間動作を円滑に行うための逆機構解の解法アルゴリズムが必要とされる。そこで、以下のようにして冗長パラメータたる冗長軸２の姿勢を決定する。
【００２６】
図１に示すＸＹ平面上の予点Ｐ０（Ｐ０Ｘ，Ｐ０Ｙ）から、図８に示すように特異点軌跡５１に対し直線Ｌを引く。直線Ｌは、いうまでもなくアクセス方向ａに平行である。この場合の特異点軌跡５１は、第２アーム３２をＸ軸に平行にしたときの第２アーム３２上の特異点５が、冗長軸（第１アーム）２を回転させたときに描く軌跡として、図１などに示すように半円状の破線により示されている。即ち、特異点軌跡５１はθ２＝−θ１かつθ３＝π、つまりＸ軸に第２アーム３２、第３アーム３３が平行で且つ第３アーム３３が第２アーム３２に重なっている状態において冗長軸（第１アーム）２を１回転（あるいは半回転）させたときの所定の位置が描く円弧の方程式で表される。また直線Ｌはあらかじめ決められているアクセス方向ａと同一の方向成分をもつ直線であり、これにより図８に示すような特異点軌跡５１との交点Ｓ０（Ｓ０Ｘ，Ｓ０Ｙ）が求められる。交点Ｓ０には通常２つの解が存在するが、この場合の特異点軌跡５１は直線Ｌと１点のみ交差するように求める領域が設定され、アクセス方向ａをＹ軸一方向とした場合の＋側の解のみが得られるようにされている。
【００２７】
このようにして求められたＳ０に対しθ１＝ｔａｎ-1（Ｓ０Ｙ／（Ｓ０Ｘ−（Ｌ２−Ｌ３）））なるθ１を決定し、特異点軌跡５１の中心と交点Ｓ０とを結ぶ直線の角度θ１を求める（Right状態でのθ１の範囲は−π／２＜θ１＜π／２）。このようにθ１が決定されたら、図８に示すように、冗長軸２の角度をその角度θ１と等しくなるように設定し、固定させるようにすれば良い。これにより関節部４の最適位置が決まり、冗長軸２たる第１アームは冗長でなくなり、逆機構解が決定される。このような決定方式は、図９に示すように、予点Ｐ０と別の予点Ｐｍに対して別の補間動作を行う場合に各アームが連続的に動作しながらθ２、θ３により作られる特異点５を経由できるメリットがある。なお、ここまでの冗長軸位置決定の流れを、図１８に示す。
【００２８】
ここまで説明したような冗長ロボット１の適用として考えられるワーク１０のハンドリング作業（図１５）では、カセットなどの収容部７からウェハなどのワーク１０を抜き出し、プロセス装置のロードロックなどヘこのワーク１０を移載し、プロセスの終了したワーク１０をロードロックより受け取ってカセットに戻すなどの作業が遂行される。このような作業は通常クリーン環境で行われるため、クリーン設備の床面積は設備コスト（＝製造コスト）を下げるうえで重要な問題であり、いたずらにサイズの大きなロボットを使用する事はできない。
【００２９】
そこで、これまでのような移動部材が回動可能なアーム２１とされた冗長水平３関節アームだけでなく、図１６のような移動部材が水平方向に移動する水平走行軸２２とされたロボットでも同様の方式をとることができるようにされている。この場合、図１０に示す走行軸方向はｂで表され、特異点軌跡５１はこの走行軸方向ｂに平行な直線となる。また、予点Ｐ０からアクセス方向ａへの直線を引き、特異点軌跡５１と交わった点が交点Ｓ０である。ここでは、特異点５を作動させて補間動作が連続するように水平走行軸２２における位置が自動的に調整される。この冗長軸位置決定方法を示すフローチャートを図１９に示す。
【００３０】
一方、Farの姿勢における冗長軸（第１アーム）２の角度決定においては、Nearの場合と異なり、特異点５を通らなければ直線が引けないといった状態はなく完全冗長であるため、θ１を任意に決定し得る。同じ直線軌跡を描かせる場合でも、冗長軸２の角度の取り方により図１１または図１２に示すような場合が考えられ、明らかに図１２の方が動力学等速直線動作として無理が無い状態である。そこで、図１２のような冗長軸２の角度を決定する方法として、図１３のような方法がある。
【００３１】
また、第２アーム３２、第３アーム３３の長さが等しいかあるいは近い（Ｌ２≒Ｌ３）場合、θ３＝πでの特異点５近傍で動力学的等速直線動作が困難なので、この状態を回避するため図１３に示すように、予点Ｐ０よりアクセス方向ａへの直線Ｌを引きここから充分なマージンＭ０をとった所に特異点５が位置するようにθ１を決定すれば良い。
【００３２】
本発明の冗長ロボット１の冗長軸位置決定方法によれば、冗長軸２の位置決定条件として導入されたアクセス方向ａという概念により、冗長軸２の最適位置を決定することができるようになり、特異点５近傍での直線補間動作が可能になる。また本発明によれば、数度程度の多少の誤差を含んでいても位置決め精度に影響を与えることがなく、このアクセス方向ａでの誤差は最終のＸ−Ｙ平面の誤差としては無関係にすることができ、また特異点５以外の位置ではＸ−Ｙ平面上の精度は逆機構解の入力値と一致させるような演算方法をとることが可能である。
【００３３】
また、ロボットの構造によらず普遍的に冗長軸決定条件を記述できるようになり、プログラムの可読性、可搬性が向上する。またロボットアプリケーションを考慮した場合、冗長ロボット１の据え付け位置とワーク１０をハンドリングする位置との関係によって冗長ロボット１のワーク１０への向きが決まる。この向きをアクセス方向ａとし、これを利用して第２ハンド３２などのマニピュレータの最適位置を選択するようにすれば、ロボットの構造によらずにプログラムを記述することができるようになる。しかも、アクセス方向ａという概念自体は簡便な考えに基づくものであるため、プログラム作成が容易になる。
【００３４】
尚、上述の実施形態は本発明の好適な実施の一例ではあるがこれに限定されるものではなく本発明の要旨を逸脱しない範囲において種々変形実施可能である。例えば、本実施形態ではワーク１０のハンドリング作業を行う冗長ロボット１を例示して説明したが、本発明はこのようなロボットに限られず、他の用途に用いられるロボットなどにおいて広く利用可能であることはいうまでもない。
【００３５】
また、本実施形態では図１などに示すように、特異点軌跡５１として半円で描かれたもののみを用い、アクセス方向ａに平行な直線との交点あるいはアクセス方向ａに平行なアーム軌跡Ｌとの交点を一点のみ求めるようにしていたが、例えば全周描かれた特異点軌跡５１を用いれば、交点が２つ求められ得ることはいうまでもない。この場合、２つの交点によって冗長軸２の最適位置を２つ求めることができるようになる。
【００３６】
【発明の効果】
以上の説明より明らかなように、請求項１記載の発明の冗長ロボットの冗長軸位置決定方法では、互いに連結された２つのアームが重なったときのロボットアームの所定位置である特異点に関し、冗長軸を動かすことによってこの特異点の軌跡を求める一方、与えられた目標位置に対する所定位置の移動方向をアクセス方向として定め、特異点軌跡と目標位置を通るアクセス方向に平行な直線とにより形成される交点を基準として冗長軸の位置を求めているので、この冗長軸が、ロボットアームの所定位置の直線動作が補間されるような最適位置に設定される。これにより、ロボットアームが特異点を経由できずに動作不能となってしまったり、動力学的に無理な運動が生じてしまったりするなどの事態が回避される。
【００４２】
更に請求項２記載の発明の冗長ロボットの冗長軸位置決定方法では、特異点軌跡はアクセス方向に平行なある直線と一点のみ交差するように求める領域が設定されてなるので、目標位置とアクセス方向とによって冗長軸の最適位置が一義的に決定される。
【００４３】
また請求項３記載の発明の冗長ロボットの冗長軸位置決定方法では、特異点軌跡の中心と交点とを結ぶ直線の角度を求め、冗長軸の角度をその角度と等しく設定するようにしているので、冗長軸の最適位置を簡便に求めることができる。
【図面の簡単な説明】
【図１】本発明である冗長ロボットの冗長軸位置決定方法の実施形態を示す図であり、３関節ロボットにおける冗長軸及び冗長軸以外の軸の長さと角度、及び特異点軌跡を示す。
【図２】本発明におけるアクセス方向の概念を矢印で示す図である。
【図３】ロボットの姿勢の分類を水平２関節型マニピュレータを例にして示す図であり、（Ａ）は左姿勢を、（Ｂ）は右姿勢をそれぞれ示す。
【図４】冗長軸とワークとの距離が遠いFar状態にある冗長ロボットを示す図である。
【図５】冗長軸とワークとの距離が近いNear状態にある冗長ロボットを示す図である。
【図６】  Near Rightにおける各アーム動作と、θ３の可動範囲とを示す図である。
【図７】  Near Leftにおける各アーム動作と、θ３の可動範囲とを示す図である。
【図８】特異点軌跡とアーム軌跡の位置関係を示し、更に冗長軸を適正位置に設定した様子を示す図である。
【図９】予点Ｐ０と別の予点Ｐｍとを通過するように引かれたアーム軌跡と、そのアーム軌跡に沿うように動作する各アームの様子を示す図である。
【図１０】移動部材が水平方向に移動する水平走行軸とされた場合のアーム軌跡などを示す図である。
【図１１】冗長軸とアーム軌跡とが近い場合における各アームの動作の様子を示す図である。
【図１２】冗長軸とアーム軌跡とが近くない場合における各アームの動作の様子を示す図である。
【図１３】予点Ｐ０よりアクセス方向ａへの直線Ｌを引きここから充分なマージンＭ０をとった所に特異点５が位置するようにθ１を決定した様子を示す図である。
【図１４】２関節型ロボットとカセットやロードロックなどの収容部との位置関係及びアクセス方向を示す図である。
【図１５】冗長軸を構成する移動部材が回動可能なアームとされた冗長ロボットを示す図である。
【図１６】移動部材が水平方向に移動する水平走行軸とされた冗長ロボットを示す図である。
【図１７】特異点近傍において各アームが動力学的に無理な運動をしている様子を時間経過とともに（Ａ）、（Ｂ）、（Ｃ）の順に示す図である。
【図１８】本発明の冗長ロボットの冗長軸位置決定方法の流れを示すフローチャートである。
【図１９】移動部材が水平方向に移動する水平走行軸とされた場合の、本発明の冗長ロボットの冗長軸位置決定方法の流れを示すフローチャートである。
【符号の説明】
１  冗長ロボット
２  冗長軸
３  冗長軸以外の軸
４  関節部
５  特異点
２１  アーム
２２  水平走行軸
３２  第２アーム
３３  第３アーム
３３ａ  アーム先端
５１  特異点軌跡
ａ  アクセス方向
Ｐ０  予点（目標位置）
Ｓ０  交点
【図１】
0003638775.tif 000002
【図２】
0003638775.tif 000003
【図３】
0003638775.tif 000004
【図４】
0003638775.tif 000005
【図５】
0003638775.tif 000006
【図６】
0003638775.tif 000007
【図７】
0003638775.tif 000008
【図８】
0003638775.tif 000009
【図９】
0003638775.tif 000010
【図１０】
0003638775.tif 000011
【図１１】
0003638775.tif 000012
【図１２】
0003638775.tif 000013
【図１３】
0003638775.tif 000014
【図１４】
0003638775.tif 000015
【図１５】
0003638775.tif 000016
【図１６】
0003638775.tif 000017
【図１７】
0003638775.tif 000018
【図１８】
0003638775.tif 000019
【図１９】
0003638775.tif 000020