JPH08505091A - 冗長軸を使用して対象物上の形態をトラッキングするためのシステム並びに方法 - Google Patents

Abstract

(57)【要約】 軌道のプログラミングをしないでリアルタイムでシームをトラッキングするためのシステム並びに方法は、少なくとも２つの自由度と、冗長軸によりつくられる少なくとも１つの自由度とを使用している。ロボットは、これの可動端部がワークピースのシームを追従するのに従って、ロボットのベースに対して移動可能な位置付け器に装着されたワークピースに溶接、接着剤もしくはシーラントの供給をするために使用され得る。センサーは、ワークピース座標内にシーム軌道を表示しコンピュータプロセッサーに座標を配列し、この結果、座標はロボットの端部がシームをトラッキングするようにプロセッサーから抽出される。ワークピースは固定され、ロボットのベースは動かされ得るか、ベースは固定でワークピースが動かされ得るか、ワークピースとロボットのベースとの両方が動かされ売る。道理にかなった数の冗長軸が、６以上の自由度の夫々に対して独立に規定される１つの制御パラメータがある限りは、利用され得る。従来のシームトラッキングシステムは、冗長軸によりつくられる１つの自由度を備えた１対上の自由度を有さず、また、ワークピースに対してロボットのベースを自動的に動かさない。

Description

【発明の詳細な説明】 冗長軸を使用して対象物上の形態をトラッキング するためのシステム並びに方法 発明の背景 発明の分野 本発明は、予めプラグラミングされた軌道がなく、リアルタイムで対象物上の 形態をトラッキングするためのシステム並びに方法に関し、特に、１もしくは複 数の運動学上の冗長軸を備え、溶接、シーラント、もしくは接着に使用されるシ ームトラッキングシステムに関する。 従来の技術 ロボットによるシームトラッキングは知られており、そして、トラッキングさ れもしくは追従されるシームもしくは形態は、ロボットの端部もしくは工具に装 着されたセンサーを使用して確認される。このセンサーは、シームもしくは形態 が位置するワークピースの表面を、工具の少し手前でモニターする。ロボットの 端部は、表面に対して工具を所望の方位に維持しながら、シーム、即ち、形態に 沿って移動される。従来のアーク溶接システムは、溶接されるシームに沿って、 複数のポインイ毎にライン上にしばしばプログラミングされる。これは、非常に 時間を費やす方法であり、またワークピースの位置付けもしくは治具の配置が不 正確であり、もしく は、接着が良好でなく認容できない溶接となる。従来のシステムの精度は、溶接 される部材のディメンション的精度を改良し、またこれら部材に治具が位置付け られる一貫性を改良するか、または、シームの場所と準備のライン上の感知によ りデイメンションと固定との両者の部分毎の変化を補償することにより改善され 得る。少量の製造もしくは溶接精度が重要でない適用においては、シーム感知の 使用はより発展性がある。これは、感知される接合デイメンションと場所とに応 答して、制御可能な溶接パラメータを調節可能とするためである。 従来のロボットによるアーク溶接システムにおいては、溶接されるシームの場 所を決定するために、シームトラッキングセンサーは溶接トーチの前に配置され ている。これは、通常、トラッキングされる表面の形状に基づき、予めプロクラ ミングされる名目上のトーチ軌道を必要とする。また、センサーは、トーチの移 動速度とそれが適合と接合の準備とにおける変化を補償するように調節され得る ように、接合部のディメンションを測定するように使用され得る。これは、シー ムが、これらのパラメータがデータを得るときとその場所でシームを溶接すると きとの間のタイムディレイに渡って変化され得るように、描画されることを必要 とする。 固定されたワークピースでシーム、即ち形態のトラッキングの場合、シームト ラッカーにより感知されるようなシーム上のいかなるポイントの場所は、絶対的 座標（即ち、ロボットのベースに対して固定された座標フレーム）で表わされ得 る。これは、エンド・ポイントの位置が絶対的座標で知られる（ロボットの前方 への運動学を介して）ので、シームトラッカーの座標フレームの場所はエンド・ ポイントに対して知られ、また、シーム形態の場所はシームトラッカーの座標フ レームで規定される。ワークピースは固定であるので、ワークピースに装着され た座標フレームに、感知されるシーム場所を示すのに等しく有効である。このワ ークピースのフレームは、一定の遷移により絶対的座標フレームに関連し、Ｔで 表示される。 さらに、１９９１年にストラウス（Ｄ．Ｌ．Ｓｔｒａｕｓｓ）により、カナダ のオンタリオ州のオンタリオ大学で“溶接ロボットのためのリアルタイム・シー ムトラッキング並びにトーチ制御”という表題で発表された論文に記載されてい るように、事前のプログラミングをしない溶接ロボットのためのリアルタイム・ シームトラッキング・システムを使用することが知られている。 この従来のシームトラッキングシステムは、非常に長い時間を必要としかつ効 果な軌道プログラミングを必要とする欠点がある。もし、ワークピースがロボッ トのベースに対して移動することが要求されなければ、これは現在のプラクテス に論理的に許容され得る。もしワークピースがロボットのベースに対して連続的 に移動することが要求されていると、ワークピースの位置付け器が使用される。 表面速度に対する相対的エンド・ポイントの制御を与えるために、精度よくシー ケンスされた多数の場所が、必要な座標での移動に対応して 位置付け器とロボットとの両者に対してプログラミングされなければならない。 発明の概要 本発明の目的は、トラッキングされるシームに対してロボットのエンド・ポイ ントの相対的位置並びに方位のリアルタイム制御をしながらシームをロボットが トラッキングするシームのトラッキングシステムを提供することである。ロボッ トは、要求されるワークピースの表面のシームをトラッキングすることができる 。ワークピースの表面は、シームのトラッキングの間、移動される。また、ロボ ットは、ワークピースの表面を方位の基準に適用させながら、未知のワークピー スの表面のシームを力学的にトラッキングできる。 本発明においては、軌道の予めのプログラミングは必要ではなく、本システム はワークピースの移動の結果である、運動学上の冗長軸の充分に座標化された移 動を自動的に提供するように使用される。 軌道の予めのプログラミングなしでリアルタイムで対象物の形態をトラッキン グするシステムは、可動端部とベースとを有するマニピュレータを使用する。こ の可動端部はベースに対して移動可能である。センサーは可動端部近くに設けら れ、この可動端部近くの形態をモニターするように指向される。このシステムは 、冗長軸により作られる少なくとも１つの自由度を有する少なくとも２つの自由 度を有する。このシステムのための制御手段が設けられ、この制御手段は、セン サーから情報を受け、この情報を処理し、この処理された情報をマニピュレータ に送り、この結果、前記端部で前記形態をトラッキングさせる。 軌道の予めのプログラミングなしでリアルタイムで対象物の形態をトラッキン グする方法は、可動端部とベースとを有するマニピュレータを使用する。対象物 に対してマニピュレータのベースを移動させる手段が設けられている。センサー は可動端部近くに設けられ、この可動端部近くの形態をモニターするように指向 される。このシステムは、冗長軸により作られる少なくとも１つの自由度を有す る少なくとも２つの自由度を有する。このシステムのための制御手段が設けられ 、この方法は、対象物の表面が、前記端部が対象物上の形態を追跡するのに従っ て、前記端部の領域内で実質的に水平な位置に維持されるように、対象物を動か すように前記制御手段を駆動させる工程を具備する。 図面の簡単な説明 図１は、シーム上のトラッキング位置での従来のトーチとセンサーとを概略的 に示す側面図である。 図２は、従来のシームトラッキングシステムを概略的に示す上面図である。 図３は、トーチがシームをトラッキングしている従来のトラッキングシステム を概略的に示す斜視図である。 図４は、固定されたワークピースの近くでロボットに装着されたトーチを備え た従来のシステムを示す部分側面図であ る。 図５は、本発明に係わる、対象物上の形態をトラッキングするためのシステム の部分斜視図である。 図６は、図５に示す対象物の側面図である。 図７は、他のワークピースの斜視図である。 図８は、単１の軸の位置付け器を使用した、本発明に係わるシステムの概略的 斜視図である。 図９は、図８に示すシステムを使用するように要求された種々の工程を設定す るブロックダイアグラムである。 図１０は、ワークピースが移動するのに従う、ワークピースに対するトーチの 方位を示す概略図である。 図１１は、可動フレームに設けられた円筒状の対象物の概略側面図である。 図１２は、フレームが除去された図１１に示す対象物の正面図である。 図１３は、フレームが除去された図１１に示す対象物の背面図である。 図１４は、２軸のワークピース位置付け器を使用して形態をトラッキングする システムの概略図である。 好ましい実施例の説明 図１は、可動端部４と、ロボット（図示せず）のアーム８の一端に前記可動端 部４と近接して設けられたセンサー１２とを有する、従来の溶接トーチ２を概略 的に示す側面図である。これら可動端部４とトーチ２とはシームをトラッキング する。 本発明を達成するために使用されるセンサーは、ＣＣＤアレイのカメラ（５１ ２ｘ５１２個の画素）と、構築されたレザー光源とにより構成されている。レザ ービーム６はシリンドリカルレンズにより広がってワークピースの表面上にライ ンを投影する。レザーと同じハウジング内に設けられたカメラは、投影レザー光 の面に対して約２０゜の角度からワークピースの表面を観察する。カメラのレン ズの前に位置された狭いバンドの光学フイルターは、レザーの波長以外の全ての 波長の光を遮蔽する。この結果の像はシームが上に位置するワークピースの形態 の傾斜図を提供する。 ハードウエアのプロセッサー・ボードはシームをトラッキングするカメラと、 データ解析に使用されるＰＣ−ＡＴとの間のインターフェイスとして機能する。 各ビデオ視野は、視野内の２４０本の走査線に対応する２４０の値のアレイに圧 縮される。各アレイ値は、像内の対応する走査線上にレザーラインの中心を想定 するのに最良である画素位置を表す。レザーラインを検出するときのスパッター 並びにアーク・フュームの影響に対するノイズを除去するために、連続した画素 強度が、有効インパルス応答（ＦＩＲ）フイルターを使用したチューナブル強度 形態にマッチングされる。像の各走査線の強度形態は、走査線に沿う画素毎のレ ザー・ストリップの予め規定された強度形態と比較される。２つの形態が良くマ ッチする位置は、レザーラインの場所として戻される。かくして、センサーのデ ータは、ワークピースの表面と、直交す る平面との間の交差曲線の部分に沿う、センサーと表面との間の距離の測定値を 表す。 予め処理された像のデータはワークピースの表面形態の片状の描写を表す。こ のデータの解析の目的は、像内でシームの位置を抽出するためである。（トラッ キングされるシームのような）ワークピースの表面上の形態は、データの連続性 での変化として現れる。これらの変化の大きさは、表面の勾配での変化の厳格さ を反映している。一般的なシーム・ジオメトリーの多くは、予め処理された像の データの第１並びに第２の誘導を使用して分類できる。例えば、Ｖ溝は、第１の 誘導でゼロ・クロスと第２の誘導の非ゼロ・クロスをサーチすることにより検出 され得る。これら２つの判断が一致するアレイ・インデックスは、シームの場所 に対応する。 アレイ値のセット内のいかなるポイントでも誘導を得るために、ｎ−ポイント のウインドウが、誘導が必要なポイントを中心として対称的に設定される。ウイ ンドウ内のポイントと最も良く適合する直線の傾斜は計算され、そして、ウイン ドウの中心で誘導に接近するように使用される。アレイ内の各ポイントでの誘導 は（第１と最後の１／ｎポイントを除いて）、アレイ値に沿ってウインドウを順 次移動させることにより計算され得る。第２の誘導は、そのデータとして第１の 誘導を使用して同じような方法で計算され得る。第１並びに第２の誘導のために 使用されるウインドウのサイズは、夫々３２並びに８データのポイントで有る。 帰納式の使用により、誘導を非常に能率良く計算するためのアナゴリズムが得ら れ る。 さらなる判断が、間違いのデータによるエラーを減じるために導入されている 。シームは連続しているとみなしているので、シームの場所は直前の場所近くで なければならない。仮定したシームの場所が最後の２〜３のシームの場所の回り の特定のウインドウ内にない場合、データは汚れ易く、このため、極く最近の信 頼性のあるデータを基礎とし仮定することにより、破棄されまた取換えられるべ きである。 シームの場所は、画素座標から実空間ディメンションに変換されなければなら ない。かくして、これらは、カメラのフレームの原点がロボットの工具フレーム に対して固定されているので、工具フレーム座標に変換され得る。 センサー１２とシーム１０とがカメラの視野内に常時あるように、常に位置さ れなければならない。かくしてトーチの方位は、シーム１０があるワークピース の極率に伴って変化する。一般的には、カメラがトーチに近づくように配置され れされるほど、ワークピースの表面形状がトーチの方位の制御に与える影響が少 なくなる。しかし、カメラとトーチとの間の距離を短くするのに従って、カメラ の領域内でアーク光、スバッター並びにフュームが多くなり、レザー光６（かく してシーム）が検出され得る信頼性が減少する。かくして、カメラに対するトー チの距離は、データ精度と方位制御との兼ね合いで設定される。 前記カメラに対するトーチの距離の設定は、シームの角もしくは曲部の周囲の トーチの軌道を考慮しなければならない。 もし、ロボット・コントローラが、単に、カメラの視野の中心に感知されるシー ム場所を維持し、可動端部４の移動を感知されるシーム場所に指向させようとす ると、トーチの軌道は、シームが直線でない限りはシームに正確には沿わない。 制御方法は、カメラの視野内にシームを維持しトーチを既に感知したシームに沿 って案内することが必要で有る。 図２はシーム１０を横切るレザーライン１４を示す従来技術の図である。カメ ラ（図示せず）は視野１６を有する。シーム１０に沿う一連のセット・ポイント １８は、シームトラッカー（図示せず）がシームに沿って移動することにより事 前に生じたポイントである。シームに沿って生じた最後のセット・ポイントはポ イント２０で示されている。カメラは、レザーライン１４がシーム１０を横切る ポイント２１を検出しる。ポイント２０とポイント２１とを結ぶ直線は計算され る。増分変位は、両ポイント２０，２１間の距離から所定長さ１から引くことに より得られる。この増分変位は、直線１９に沿って位置するような新たな幾つか のセット・ポイント２２を与えるように、セット・ポイント距離により分けられ る。各視野を分析することにより発生された新たなセット・ポイント２２の数は 、カメラが移動した距離に依存し、またこれは、ワークピースの幾何学形状やト ーチの速度に依存する。これは、感知されるシーム場所での少しの横方向の変化 が、連続してセット・ポイントが発生しているのに従って直線１９の方向をほと んど変化させないので、続くセット・ポイント１８の方向の変化の割合にローパ スフィルター として機能する。セット・ポイントはカメラの視野度（６０Ｈｚ）で発生するの で、この近似値法によりほとんどエラーが生じない。 ロボットのエンド・ポイントが従う軌道は、シームトラッカーが工具を前進さ せるのに従って、このシームトラッカーによって確認された一連のセット・ポイ ントにより規定される。この一連のセット・ポイントは、ロボットの現在のエン ド・ポイントの場所とシームの現在の感知される場所との間のシームを規定する 列としてストアされる。シームをトラッキングするセンサーの評価毎に、発生さ れた新たなセット・ポイント２２は列の前に加えられる。 図３の従来技術に示すように、カメラ（図示せず）の視野１６は中心２４を有 する。この中心２４は、距離Ｊ，Ｋだけシーム１０から外れている。トーチ２は カメラに追従し、トーチとカメラとの間の距離は一定でであり符号Ｒにより示さ れている。一連のセット・ポイントはＤ₁，Ｄ₂，Ｄ₃，Ｄ_nとして示されている。 連続したセット・ポイント間の間隔はＤＭＭであり、これは単位ベクトル長とし て表されている。これらセット・ポイントは一列に位置され、この長さはシーム をトラッキングするセンサーとトーチ２との間のシームの長さと対応する。セッ ト・ポイント間の間隔は、列の長さ、及びシームが描かれる精度を決定する。セ ット・ポイントの間隔が短くなると、トーチからカメラまでの軌道を示すのに必 要なセット・ポイントの数が多くなる。間隔が増すのに従って、曲線がトラッキ ングされる精度が減じられる。 ロボットのエンド・ポイントは、各増分エンド・ポイントの動きで、エンド・ ポイントとシームトラッキング・センサー（カメラ）とを分ける距離の一部のみ を移動する。ロボットのエンド・ポイントの次の増分移動は、列の後ろから複数 の単位ベクトルを除去し、そして、ロボット・コントローラの次の軌道立案サイ クルでこの移動を実行することにより、計画される。このロボット・コントロー ラの軌道立案サイクル・レートは一定であり、代表的には２５Ｈｚである。シー ムに沿うエンド・ポイントの速度は、各軌道立案サイクルで列から除去された複 数の単位ベクトルにより制御される。エンド・ポイントが移動するようになる軌 道を規定する複数の単位ベクトルは小さい。例えば、エンド・ポイントは次の軌 道立案サイクルで３．６単位ベクトルを動かすのに必要な場合、残りの０．４単 位ベクトルがシーケンスの後端で維持される。 エンド・ポイントが次の軌道立案サイクルで動くようになるシームに沿う位置 の計算をすると、シームに対する要求されるトーチの離間、それ並びに方位は、 シームの場所に対する遷移として加えられる。この考えの重要な態様は、シーム トラッキングフログラムがシームに沿うトーチの姿勢と速度のリアルタイムの制 御とをすることを可能にするということである。 シームトラッキング・センサーは、単に、現在のエンド・ポイント位置に対し てシーム座標とワークピース表面とを与えるだけなので、セット・ポイント列は 、ロボットのエンド ・ポイント場所を制御するのに必要な６つのパラメータのうちの４つのみを与え る。残りの２つのパラメータは、トラッキングされるシームがシームトラッキン グ・カメラの視野内に維持されることを確実にするように使用される。 図４には、ベース２８と、アーム３０と、可動端部３２とを有する従来のロボ ット２６が示されている。この可動端部３２には溶接トーチ２が装着されている 。ワークピース３４はフレーム３６上で固定位置に支持されている。シームトラ ッカーは、図４に示されていないが、所定距離だけトーチ２から離間するように して、可動端部３２に固定されている。シームトラッキングとトーチ制御とを果 たすために６つの自由度がある。このうちの３つの自由度はトーチのチップ（Ｘ ，Ｙ，Ｚ）の特別の位置を描くのために必要であり、他の２つの自由度はトーチ の方位（傾斜と傾き）を規定するためであり、６つの自由度はトーチの周りのシ ームトラッキングカメラを位置付ける（回転）するためのものである。これらに より、空間にポイントを描くのに必要な６つのパラメータが規定され、またこれ は最も一般的な工業ロボットの軸の数と対応している。 図５に、本発明に従う対象物上の形態をトラッキングするためのシステムが示 されている。このシステムは、ベース２８と、可動端部３２とを有するロボット ２６を具備する。このロボットは、ライン３９を介してロボットコントローラ３ ８に接続されている。可動端部３２は、ヘッド４０と、シームトラッキングセン サー１２とを互いに固定された関係で 支持している。このヘッド４０は、溶接トーチ、カッテングトーチ、シーラント ディスペンサー、スプレイガン、接着剤ディスペンサー、レザー射出ヘッド、も しくは、対象物に対してマニピュレートされることが望まれる実用上の他の工具 またはディスペンサーである。勿論、カッチングトーチは、酸素燃料形式並びに プラズマ形式のもので良い。シームトラッキングセンサーは、ワークピース上の 地勢学上の形態を感知できるように構成された光形式、もしくは、ワークピース 上に与えられた視覚可能なラインまたはマークを感知できるよう受動形式のもの で良い。また、このシステムは、ヘッドにより与えられる溶接の品質や接着剤も しくはシーラントの適用に係わるデータを与えるようなプロセスモニターセンサ ーを含み得、また、これは光学的、受動光学的、ソナー、もしくは他の適当な感 知技術により構成され得る。前記ヘッド４０は、接続ライン４２を介して供給ユ ニット（図示せず）に接続されている。例えば、ヘッドが溶接トーチの場合、こ のトーチは溶接電源に接続される。プロセス制御コンピュータ（図示せず）は、 測定されたシームディメンション並びにプロセスモニターセンサーからのフイー ドバックに基づいて、溶接処理を制御するように電力供給パラメータを設定する 。電気ライン４４は、プロセス制御コンピュータ（図示せず）をシームトラッキ ングコンピュータ４６に接続する。また、電気ライン４８は、シームトラッキン グコンピュータ４６をロボットコントローラ３８に接続する。そして、電気ライ ン５０はシームトラッキングコンピュータ４６とシームトラッ キングセンサー１２との間に延びている。対象物、即ち、ワークピース５２はフ レーム５４に支持されている。このフレーム５４は、ワークピースを単１の軸を 中心として回転させることを可能にする単１軸の位置付け器である。電気ライン ５６は位置付け器５６とシームトラッキングコンピュータ４６との間に延びてい る。この位置付け器５６は、シームトラッキングコンピュータ４６によるソフト ウェアのもとで、サーボモータ６４により動力が供給される。位置付け器の軸に 装着されたエンコーダ（図示せず）は、実際のワークピースの回転を測定する。 この位置付け器の軸は水平であり、ワークピースを重心の近くで通る。この結果 、ワークピースの全周に渡ってロボットアクセスが可能となっている。位置付け 器、即ち、フレーム５４は１つの回転軸を有するように示されているが、複数の 回転軸を有する位置付け器も使用される。例えば、位置付け器は３つ以上の回転 軸を持っていても良い。 図５で使用されているロボットは、６つの自由度の関節アーム（Ｒｅｉｖ Ｖ １５）である。ＰＣ−ＡＴコンビュータ４６は、シームトラッキング。ソフトウ エアをランし、平行インターフェイス・バス４８を介して、ロボットコントロー ラ３８に直接接続されている。単１一軸の位置付け器５４は、市販の移動制御イ ンターフェイスコード（図示せず）を介して、シームトラッキングコンピュータ ４６により直接制御される。かくして、この７軸システムは、１つの運動学的冗 長軸を有する。 ワークピース５２は図６に詳しく示されている。このワークピースはシーム１ ０と、回転軸５８と、凹部領域６０と、凸部領域６２とを有する。この形状は、 ワークピース５２の回転方向はトーチがサドル領域６０を通るときに反転しなけ ればならないので、本発明の技術能力を誇示するように選定された。座標で示さ れた動きはリードスルー・プログラムにより達成するのは難しい。 本発明は、エンド・ポイントとシームとの間の１セット（リアルタイムでコマ ンド可能な）の相対速度を維持そながら、エンド・ポイント６６の下の一定表面 方位を維持するように使用され得る。シームトラッキングを使用する座標フレー ムはワークピースに関連して規定され、かくして位置付け器と共に回転する。達 成しようとする効果は、ワークピースとトーチとの間の相対速度の特別な計算を 必要としないことである。エンド・ポイント６６は、コマンドされた移動速度で ワークピースに関連して単に移動する。ワークピースの動きは、移動する座標シ ステムによって、自動的に考慮される。ロボットの結果としての動きは、ワーク ピースの動きと、トラッキングによる動きとの両者を表す。ワークピースは動く ので、ワークピースはロボットのベース２８に対して動くといえる。 ロボットコントローラ３８は、オリジナルな制御プロセッサーボードに代わる ２つのＶＭＥ−バス・モートローラ６８０２０（ＶＭＥ−ｂｕｓ Ｍｏｔｏｒｏ ｌａ６８０２０）が再び装着されている。ＲＣＣＬは、使用者の コードに編集されて直接接続されたモジュールのライブラリーである。これは、 全ての内部ロボット変数にアクセスを与え、また、与えられるヘッドのエンド・ ポイント６６の位置のリアルタイムの制御を可能にする。ロボットが動いている 間、この動きの最終位置はシームトラッキングコンピュータ４６により変更され 得る。これらの変更は、ヘッドの位置が最終場所を変更することにより連続的に 調節されるように自動的にトラッキングされる。多くの標準の工業ロボットコン トローラは、本発明により要求されている制御の形態を果たす能力がソフトウエ アに無いためか、コントローラ自体の構造のために、本適用には使用され得ない 。図五に示す配置は、単１軸の位置付け器に対する好ましい実施例であるが、種 々の他の配置が請求の範囲に記載した範囲内で本発明を実施するためになされ得 る。本発明は上述したような装備に限定されるものではなく、種々の装備が本発 明を実施するために適用可能である。 図７に示すワークピース６８は、これの上面７４上に位置する形態７０と溶接 プール７２とを有する。このワークピースは２軸の位置付け器（図示せず）に支 持されている。仮想垂直線Ｃは溶接プールの中心を通り、第１の平面内でタンジ エントＤに対して角度θ₁で、また第２の平面内でタンジエントＥに対して角度 θ₂で延出している。これらタンジエントＤ，Ｅは互いに直交している。ワーク ピース６８の移動は、溶接プール７２の領域内で上面７４が、これを動かすワー クピース位置付け器の軸（図示せず）の要求された動きを規定 する角度θ₁、θ₂を使用することにより常時ほぼ水平となるように、制御される 。ワークピースの領域を非水平位置に維持することが望まれる他の使用も可能で ある。 シームトラッキング工程の間にワークピースが移動されるときに、少なくとも １つの付加の自由度がシステム中に取り入れられる。トラッキングされる部分が ロボットのワーク・エンベェロップよりも大きい場所にワークピースを動かすこ とが必要もしくは好ましい。さらにワークピースを移動させることにより小型で 案かなロボットを使用することができる。また、ロールストックの製造のような 場合には、ワークピース（もしくはロボットのベース）の移動が、全ワークピー スアクセスするための唯一の実現可能な方法であろう。アーク溶接方法は、溶接 プールの方位に非常に依存する。ワークピースの方位全体に渡って制御すること は、方法の制御を非常に簡単にする。単１の冗長軸（７つの自由度の全部を与え る）を使用することにより、１つの方位角度を設定することができる。円筒状の もしくは軸に対称な部分に対して、これは所望の溶接方位を制御するのに充分で あろう。しかし、より複雑な部分に対しては、より多くの自由度が必要であろう 。 図８において、ロボット７６は、シームトラッキングセンサー１２の近くの可 動端部３２に装着されたトーチ２を有する。このロボットは、ベース２８と、規 定されたベース座標フレーム７７とを有する。このベース座標フレーム７７は、 遷移Ｔ_Bにより絶対基準フレーム７１内で規定されている。ワークピース５２は 、単１軸の位置付け器（図８には示さず） 内に装着されている。このワークピース座標フレーム７５は、ワークピース５２ に固定されてこれと共に回転する。図９に示すブロックダイアグラムは、図８に 示すトラッキングシステムを動作する手段を示す。 シームトラッキングしながらワークピースが動かされたときには、これは、ワ ークピースフレーム７５を絶対基準フレーム７１に関連付ける遷移Ｔがもはや一 定でないことを効果的に意味する。これは、ワークピース座標フレーム７５内の シーム軌道を規定する増分単位ベクトルを記憶することにより許容される。遷移 動作のシーケンスは図９に示されている。遷移Ｔ₁は、ワークピース５２に装着 されこれと共に回転するフレーム７５内の現在のエンド・ポイント位置を規定す る。遷移Ｔ₂は、絶対基準フレーム７１に対するワークピースフレーム７５の現 在の位置を規定する。シーム場所は、カメラ（シームトラッキングセンサー）の 座標内にコープレット（カメラフレーム内のシーム形態のｘ並びにｙ場所）とし て認識される。これは、カメラとエンド・ポイント（もしくはトーチ）とを関連 付ける遷移により、工具フレーム７３に転換される。重要な工程は、これを、現 在のワークピース位置付け軸（１もしくは複数）角度と現在の工具フレーム（エ ンド・ポイント位置）との間の関係を規定する遷移を使用して、ワークピース座 標に、変換することである。増分ベクトルは、ワークピース座標フレーム７５内 に、ワークピース表面に対して（列で）記憶される。ワークピースが回転されて も、ベクトルの列はワークピースフレーム７５に対して規定されて いるのでまだ有効である。逆の遷移Ｔ₁、Ｔ₂によりこれらベクトルを遷移するこ とにより、ベクトル列は、ベースフレーム座標内で再び表され、かくして、ロボ ットによりトラッキングされる。これは、図９の後の４つのブロックで示されて いる。本当の効果は、ワークピースが動いており、またシームトラッカーにより 生じた上記増分変位に単に従うことをロボットが認識できないように振る舞うこ とである。これは、エンド・ポイント制御のこのモードに関する要点である。 図８において、ロボット７６は、シームトラッキングセンサー１２の近くの可 動端部３２に装着されたトーチ２を有する。このロボットは、ベース２８と、規 定されたベース座標フレーム７７とを有する。このベース座標フレーム７７は、 遷移Ｔ_Bにより絶対基準フレーム７１内で規定されている。ワークピース５２は 、単１軸の位置付け器（図８には示さず）内に装着されている。このワークピー ス座標フレーム７５は、ワークピース５２に固定されてこれと共に回転する。図 ９に示すブロックダイアグラムは、図８に示すトラッキングシステムを動作する 手段を示す。 シームトラッキングしながらワークピースが動かされたときには、これは、ワ ークピースフレーム７５を絶対基準フレーム７１に関連付ける遷移Ｔがもはや一 定でないことを効果的に意味する。これは、ワークピース座標フレーム７５内の シーム軌道を規定する増分単位ベクトルをストアすることにより許容される。遷 移動作のシーケンスは図９に示されている。遷移Ｔ₁は、ワークピース５２に装 着されこれと共に回 転するフレーム７５内の現在のエンド・ポイント位置を規定する。遷移Ｔ₂は、 絶対基準フレーム７１に対するワークピースフレーム７５の現在の位置を規定す る。シーム場所は、カメラ（シームトラッキングセンサー）の座標内にコープレ ット（カメラフレーム内のシーム形態のｘ並びにｙ場所）として認識される。こ れは、カメラとエンド・ポイント（もしくはトーチ）とを関連付ける遷移により 、工具フレーム７３に転換される。重要な工程は、これを、現在のワークピース 位置付け軸（１もしくは複数）角度と現在の工具フレー（エンド・ポイント位置 ）との間の関係を規定する遷移を使用して、ワークピース座標に、変換すること である。増分ベクトルは、ワークピース座標フレーム７５内に、ワークピース表 面にに対して（列で）記憶される。ワークピースが回転されても、ベクトルの列 はワークピースフレーム７５に対して規定されているのでまだ有効である。逆の 遷移Ｔ₁、Ｔ₂によりこれらベクトルを遷移することにより、ベクトル列は、ベー スフレーム座標内で再び表わされ、かくして、ロボットによりトラッキングされ る。これは、図９の後の４つのブロックで示されている。本当の効果は、ワーク ピースが動いており、またシームトラッカーにより生じた上記増分変位に単に従 うことをロボットが認識できないように振る舞うことである。これは、エンド・ ポイント制御のこのモードに関する要点である。 ロボットによるシームトラッキングシステムで運動学上の冗長軸を使用する主 な効果は、シームを単にトラッキングす ること以外の基準が含まれ得ることである。このような運動学上の冗長軸が、上 述したワークピースの表面の方位とエンド・ポイント位置基準と一緒にシームト ラッキングセンサーにより与えられるデータのみに基礎をなし、またワークピー スの上記説明なしでどのようにして適当に制御され得るかという問題は、この技 術の本質である。解決は、シームをトラッキングしている間、ロボットのエンド ・ポイントの方位（もしくは位置）から必要なワークピースの動きを引き出すこ とである。これを、例を使用して、最も簡単に説明すると以下のようである。周 方向に溶接がなされる円筒状のワークピースを考える。溶接プールは水平位置に 維持され、溶接トーチをワークピースの表面に垂直に配置する。ワークピース位 置付け軸は円筒状のワークピースの対称軸を通る。ロボットコントローラは、ワ ークピースがこれの軸を中心として回転され得ることを“気付かない”（“ｕｎ ａｗａｒｅ”）。ワークピースのトップ・ポイント上に垂直に位置された溶接ト ーチで円周状のシームをトラッキングし始めるのに際して、シームトラッカーは 、トーチがワークピースに対して前方に移動されるべきであることを決定する。 この動きは、計画されてから始まるが、溶接は水平面上に位置されるべきである 状態は、もはや有効ではない。このエラーは、ワークピース位置付け軸と直交す る垂直面に工具ベクトル（トーチ軸）を投影することにより得られる。（このエ ラーにより規定されるような）トーチのミスアラインメントは、エラーが減じら れる、即ち、溶接のポイントが円筒状のワークピース上の現 在のトップ・ポイント方向に戻されるように、ワークピースを回転させるような ワークピースの回転を制御するシステムにより使用される。かくして、シームト ラッカーにより発生される増分変位はワークピースの面変位（移動）により減じ られる。本当の影響は、トーチが円周の溶接全体に渡ってほぼ垂直になり、また 、トーチがワークピースのトップ上に位置されることである。シームトラッカー により与えられる変位列に応答するロボットコントローラは、ワークピースが回 転していることを気付かず、列の増分ベクトルに単に従う。冗長軸コントローラ は、シームをトラッキングするロボットにより生じるトーチ方位のエラーに単に 応答し、トーチの特別の位置を描く他のパラメータに全く気が付かない（係わり ない）。 上述したようなトーチの矯正のための工程のシーケンスは図１０に示されてい る。移動するワークピースをトラッキングしている間、シームに対するトーチの 離間、それ、傾き並びに方位は運動学的に説明される。即ち、トーチとシームと の特別の関係は、移動するワークピースのシームがトラッキングされている間、 もし望むのであれば、連続的に変化される。上記例において、ワークピースの曲 率は溶接操作を始める前に、知る必要がないことは重要である。 円筒状のワークピースが断面楕円形のワークピースに取換えられても、シーム トラッキング並びに冗長軸の制御は同様に容易になされる（トーチは、ワークピ ースの動きに応答して垂直に動くけれど）。このことは、ワークピース表面の形 態は溶接を始める前に予め決定される必要がないので、この技術の重要な態様で ある。これは、従来のロボットプログリミング技術に対して非常に効果がある。 次に、図１１ないし図１３に示す円筒状のワークピース７７と軸との配設のた めの軸の必要な動きを考察する。周方向の溶接は円筒状のワークピースの回りに 位置され、また、規定された制限は、再び、溶接が平坦な位置でしなければなら ない、ということである。ワークピースは軸Ｘ−Ｘを長身として回転され、また 、この軸Ｘ−ＸはＹ−Ｙ軸の回りに位置されなければならないということが明ら かであろう。前述したように、ワークピースの形状はこのときまで知られておら ず、もた断面楕円形のものに対しても同様である。適当な開始位置が設定されて いることを想定すると（即ち、ここではワークピースの表面がトーチの下で水平 となるようにして、トーチがシーム上に位置されている）、前に使用したのと同 様のアプローチが必要とされるワークピースの軸の回転を得るように使用され得 る。シームトラッキングが開始されエンド・ポイントが前記例と同様に前に移動 される。今、制御される２つのワークピースの軸があるので、２つの“エラー” の基準が規定されるように必要で有る。これらは工具ベクトルを２つの平面に投 影することにより得られ得る。これらのうち第１の平面はＹ−Ｙ軸が直交する面 であり、また、第２の平面はＹ−Ｙ軸を含む面である。標準逆オイラー運動学を 使用して、これらエラーを減じるようにＸ−Ｘ軸並びにＹ−Ｙ軸を中心とする必 要な回転が得られる。 図１１ないし図１３に示す円筒状のワークピースが卵形状のワークピースに取 換えられると、第３の軸が、任意の所望の角度でトーチの下に表面が維持され得 るようなワークピース位置付け器が要求される。位置付け器の軸を制御するエラ ー角度は、位置付け器の軸を含む平面とこの軸に直交する平面とにトーチベクト ルを投影することにより前述したように得られる。 上記例は、“遅延（ｌａｇ）”制御アプローチとして述べることができる。ま た、“先行（ｌｅａｄ）”のアプローチは、動きがなされた場合に生じるエラー を最初に計算し、次にこのエラーが生じないようにワークピースの軸を制御する ことにより使用され得る。移されるワークピースの軸は、また、上述したような 制御計画に含まれ得る。しかし、これら軸は、ワークピースの表面の方位には明 らかに影響せず、絶対座標内のその位置にのみ影響する。これにも係わらず、方 位並びに／もしくは位置制御のためにいかなるワークピースの軸を駆動する概要 は上述した技術で説明され得る。 移動しているワークピースの表面に動的なトラッキングをするこの技術は、表 面の動きがトーチの方位もしくは位置から導かれない適用を含むことに注意統べ 器で有る。ワークピースの動きが操作者により制御され（もしくは実際にプログ ラミングされ）ると、この技術によりワークピース上のシームは運動学的にトラ ッキングされる。 冗長の利益は明白であるけれど、冗長軸を加えることは従来のリードスロープ ログラミングでの意味のあるプログラム をつくる。溶接されるシーム上の各ポイントは、最初は所定の方位で位置付けら れなければならず、そしてロボットはシーム全体に渡って対応した位置を教えや ければならない。不幸にも、これは教えられた位置でマツチを補償するのみて有 る。これらの間を動いている間、トーチとワークピースとの相対的な場所は、連 続したポイントがシームに沿いかつ絶対的な間隔で互いに接近していなければ、 大いに変化する。さらにオンライン制御もしくはトーチの速度は、速度が絶対値 よりもワークピースに対して測定されるので、極めて困難になる。シームに沿う 考えられた位置間の距離が非常に近い間隔で等しく離れていないのであれば、シ ーム全体の相対移動速度は正確には制御され得ない。 これらの問題を解決するために、ワークピース位置付け器の制御はロボット並 びにシームトラッキングシステムと一体的でなければならない。空間中でのいか なるポイントで位置と方位とを規定するために必要な６つ以上の夫々の自由度に 対して、制御パラメータが規定され得る。これら制御パラメータは、ワークピー スの方位の制御が達成されるようになっているのであれば、ロボットのエンド・ ポイントの位置を描くことから独立して規定されなければならない。制御パラメ ータは多くの方法で規定され得る。例えば、７番目の自由度のための制御パラメ ータは、溶接トーチの下のワークピースの表面の絶対的傾斜として規定され得る 。もし、トーチがシームに対して一定の角度を維持することが要求されると、こ の基準は、空間内で一定のトーチ角度を維持するように、再 公式化され得る。これは、ロボット工具フレームのアプローチベクトルを垂直平 面に投影することにより計算され得る。この角度と所望のトーチ角度との間の相 違は７番目の軸を制御するコマンド信号を与える。 図１４には、２軸の位置付け器もしくは６軸までの位置付け器で形態をトラッ キングするためのシステムの冗長軸制御での遷移間の関係が示されている。位置 付け器が６軸位置付け器の場合、第２のロボットが位置付け器として使用され得 る。このシームトラッキングロボットはペースフレーム８０を有する。遷移Ｔ₆ はロボット端のリスト中心８５（位置並びに方位）を規定する。遷移Ｔ_SENSORは 、リスト中心８５に対するシームトラッキングセンサー視野を規定している。ま た、遷移Ｔ_TOOLはリスト中心８５に対する工具８４のエンド・ポイントを規定し ている。かくして、シームトラッキングセンサーの座標フレーム（図示せず）内 の感知されるシーム場所８６はＴ₆・Ｔ_SENSORとしてシームトラッキングロボッ トのベースフレーム８０に表され得る。遷移Ｔ_RBPBはシームトラッキングロボッ トのベースフレーム８０とワークピース位置付け器のベースフレーム８２との間 の関係を規定している。また、Ｔ_PBWは、位置付け器のベースフレーム８２から ワークピース座標フレーム８３への遷移を規定している。遷移Ｔ_WPSは、ワーク ピース座標フレーム８３内の工具ポイント８４でのシームの場所を規定している 。前記Ｔ_PBWは、位置付け器が有する冗長軸の数を規に対応している。また、こ のＴ_PBWは、６軸ワークピ ース位置付けロボットの遷移Ｔ₆を表し得るか、標準の２軸ワークピース位置付 け器もしくは３，４，５軸ワークピース位置付け器を表し得る。位置付け器（こ こでは２軸位置付け器）を制御するために、２軸を制御するのに使用される２つ のパラメータを与えるように基準は設定されなければならいな。この基準は、全 システムにいくらかの利益を与えるように選定されている。Ｔ_PBWにより規定さ れ得る軸の数は、条文な基準の有効性によって制限されるだけである。 本発明は溶接以外の種々の文やで使用可能である。また、システムは、ワーク ピースが固定でロボットのベースが移動の場合にも使用され得る。例えば、シス テムは道路のクラックをシールするように使用される場合、ワークピースは固定 である。そして、このシステムは、ワークピースとロボットのベースとの両者が 移動の場合にも使用され得る。種々の変形が、請求の範囲の範囲内で、当業者に とって容易になし得る。

【手続補正書】特許法第１８４条の８ 【提出日】１９９５年２月７日 【補正内容】 る。これは、エンド・ポイントの位置が絶対的座標で知られる（ロボットの前方 への運動学を介して）ので、シームトラッカーの座標フレームの場所はエンド・ ポイントに対して知られ、また、シーム形態の場所はシームトラッカーの座標フ レームで規定される。ワークピースは固定であるので、ワークピースに装着され た座標フレームに、感知されるシーム場所を示すのに等しく有効である。このワ ークピースのフレームは、一定の遷移により絶対的座標フレームに関連し、Ｔで 表示される。 三宅等によるヨーロッパ出願Ｎｏ．０ ３８１ １８５ Ａ２には、ポイント が１つの座標システムから他のシステムに移動され得る数学的技術が開示されて いる。この出願は、冗長軸を構成できるロボットと周辺危機とを開示している。 しかし、このシステムは、処理部材と対象物との間の経路プログラムを必要とし ている。 さらに、１９９１年にストラウス（Ｄ．Ｌ．Ｓｔｒａｕｓｓ）により、カナダ のオンタリオ州のオンタリオ大学で“溶接ロボットのためのリアルタイム・シー ムトラッキング並びにトーチ制御”という表題で発表された論文に記載されてい るように、事前のプログラミングをしない溶接ロボットのためのリアルタイム・ シームトラッキング・システムを使用することが知られている。 この従来のシームトラッキングシステムは、非常に長い時間を必要としかつ効 果な軌道プログラミングを必要とする欠点がある。もし、ワークピースがロボッ トのベースに対して 移動することが要求されなければ、これは現在のプラクテスに論理的に許容され 得る。もしワークピースがロボットのベースに対して連続的に移動することが要 求されていると、ワークピースの位置付け器が使用される。表面速度に対する相 対的エンド・ポイントの制御を与えるために、精度よくシーケンスされた多数の 場所が、必要な座標での移動に対応して 請求の範囲 １．軌道のプログラミングをしないでリアルタイムで対象物上の形態をトラッ キングするためのシステムであり、 （ａ）可動端部とベースとを有し、この可動端部がベースに対して移動可能 であるマニピュレータと、 （ｂ）前記可動端部近くに装着され、前記端部近くの形態をモニターするよ うに指向されたセンサーと、 （ｃ）前記システムは、少なくとも２つの自由度を有し、少なくとも１つの 自由度が冗長軸によりつくられると、 （ｄ）前記センサーから情報を受け、この情報を処理し、この処理した情報 を前記マニピュレータに送って前記端部により前記形態をトラッキングさせる、 システムのための制御手段とを具備するシステム。 ２．前記ベースを前記対象物に対して動かす手段をさらに具備する請求項１の システム。 ３．調節手段は前記対象物を支持する可動フレームである請求項２のシステム 。 ４．前記フレームは前記対象物をベースに対して回転可能にする請求項３のシ ステム。 ５．前記フレームは１以上の平面内で前記対象物を回転可能にする請求項４の システム。 ６．少なくとも６つの自由度を有する請求項５のシステム。 ７．前記センサーはカメラである請求項６のシステム。 ８．前記マニピュレータはロボットである請求項７のシステム。 ９．７つの自由度を有し、前記端部はチップであり、３つの自由度は可動端部 のチップ用であり、２つの自由度は可動端部の方位用であり、１つの自由度は、 それぞれ前記可動端部の回りにセンサーを位置付けるためのものと、前記ベース を前記対象物に対して移動させる前記調節手段用のものとである請求項８のシス テム。 １０．前記制御手段は、前記対象物の位置を前記ベース、マニピュレータ並び に可動端部に対して制御する少なくとも１つのコンピュータプロセッサー（４６ ）である請求項９のシステム。 １１．６以上の自由度の夫々に対して独立に規定された制御パラメータを有す る請求項１０のシステム。 １２．前記可動端部は、溶接トーチ、カッテングトーチ、シーラントディスペ ンサー、スプレイガン、接着剤ディスペンサー並びにレザー射出ヘッドから選ば れた少なくとも１つのヘッド（４０）を支持し、また、前記フレームは前記対象 物の表面が常時前記ヘッドの領域内でほぼ水平となるように対象物を位置付ける 請求項１１のシステム。 １３．冗長軸により作られる自由度の数は２ないし６の範囲であり、６以上の 各自由度に対して独立に規定された１つ の制御パラメータを有する請求項１，２もしくは３のシステム。 １４．前記対象物は固定であり、そして前記ロボットのベースは対象物に対し て動く請求項１１のシステム。 １５．可動端部（３２）とベース（２８）とを有するマニピュレータ（２６） と、対象物に対してマニピュレータのベースを動かす手段と、前記可動端部近く に装着され、前記端部近くの形態をモニターするように指向されたセンサー（１ ２）と、制御手段（３８，４６）とを具備し、少なくとも２つの自由度を有し、 少なくとも１つの自由度が冗長軸によりつくられる、システムを使用して、プロ グラミングをしないでリアルタイムで対象物上の形態をトラッキングするための 方法であり、前記センサーから情報を受け、この情報を冗長軸を制御するように 処理し、この処理した情報を前記マニピュレータに送って前記端部により前記形 態をトラッキングさせるように、前記センサーからの情報を処理するように前記 制御手段を駆動することを特徴とする方法。 １６．前記端部が対象物上の形態を追従するのに従って、端部の領域内でほぼ 水平位置に対象物を維持するように対象物を動かす工程を有する請求項１５の方 法。 １７．感知される形態軌道を対象物座標に表す工程と、これら座標を前記制御 手段に適当に配列する工程と、制御手段から前記座標を抽出する工程都、前記端 部を形態に追従させる工程とを具備する請求項１５の方法。 【手続補正書】特許法第１８４条の８ 【提出日】１９９５年２月１３日 【補正内容】 請求の範囲 １．軌道のプログラミングをしないでリアルタイムで対象物（５２）上の形態 （１０）をトラッキングするためのシステムであり、 （ａ）可動端部（３２）とベース（２８）とを有し、この可動端部がベース に対して移動可能であるマニピュレータ（２６）と、 （ｂ）前記可動端部近くに装着され、前記端部近くの形態をモニターするよ うに指向されたセンサー（１２）と、 （ｃ）前記システムは、少なくとも２つの自由度を有し、少なくとも１つの 自由度が冗長軸によりつくられると、 （ｄ）前記センサーから情報を受け、この情報を冗長軸を制御するように処 理し、この処理した情報を前記マニピュレータに送って前記端部により前記形態 をトラッキングさせる制御手段により特徴付けられる、システムのための制御手 段とを具備するシステム。 ２．前記ベースと前記対象物とを互いに相対的に動かす手段をさらに具備する 請求項１のシステム。 ３．前記ベースと前記対象物とを互いに相対的に動かす手段は、前記対象物を 支持する可動フレーム（５４）である請求項２のシステム。 ４．前記フレームは前記対象物をベースに対して回転可能にする請求項３のシ ステム。 ５．前記フレームは１以上の平面内で前記対象物を回転可能にする請求項４の システム。 ６．少なくとも６つの自由度を有する請求項５のシステム。 ７．前記センサーはカメラである請求項６のシステム。 ８．前記マニピュレータはロボットである請求項７のシステム。 ９．７つの自由度を有し、前記端部はチップであり、３つの自由度は可動端部 のチップ用であり、２つの自由度は可動端部の方位用であり、１つの自由度は、 それぞれ前記可動端部の回りにセンサーを位置付けるためのものと、前記ベース を前記対象物に対して移動させる前記調節手段用のものとである請求項８のシス テム。 １０．前記制御手段は、前記対象物の位置を前記ベース、マニピュレータ並び に可動端部に対して制御する少なくとも１つのコンピュータプロセッサー（４６ ）である請求項９のシステム。 １１．６以上の自由度の夫々に対して独立に規定された制御パラメータを有す る請求項１０のシステム。 １２．前記可動端部は、溶接トーチ、カッテングトーチ、シーラントディスペ ンサー、スプレイガン、接着剤ディスペンサー並びにレザー射出ヘッドから選ば れた少なくとも１つのヘッド（４０）を支持し、また、前記フレームは前記対象 物の表面が常時前記ヘッドの領域内でほぼ水平となるように対象物を位置付ける 請求項１１のシステム。 １３．冗長軸により作られる自由度の数は２ないし６の範囲であり、６以上の 各自由度に対して独立に規定された１つ の制御パラメータを有する請求項１，２もしくは３のシステム。 １４．前記対象物は固定であり、そして前記ロボットのベースは対象物に対し て動く請求項１１のシステム。 １５．可動端部（３２）とベース（２８）とを有するマニピュレータ（２６） と、対象物に対してマニピュレータのベースを動かす手段と、前記可動端部近く に装着され、前記端部近くの形態をモニターするように指向されたセンサー（１ ２）と、制御手段（３８，４６）とを具備し、少なくとも２つの自由度を有し、 少なくとも１つの自由度が冗長軸によりつくられる、システムを使用して、プロ グラミングをしないでリアルタイムで対象物上の形態をトラッキングするための 方法であり、前記センサーから情報を受け、この情報を冗長軸を制御するように 処理し、この処理した情報を前記マニピュレータに送って前記端部により前記形 態をトラッキングさせるように、前記センサーからの情報を処理するように前記 制御手段を駆動することを特徴とする方法。 １６．前記端部が対象物上の形態を追従するのに従って、端部の領域内でほぼ 水平位置に対象物を維持するように対象物を動かす工程を有する請求項１５の方 法。 １７．感知される形態軌道を対象物座標に表す工程と、これら座標を前記制御 手段に適当に配列する工程と、制御手段から前記座標を抽出する工程都、前記端 部を形態に追従させる工程とを具備する請求項１５の方法。

───────────────────────────────────────────────────── フロントページの続き (72)発明者 ストラウス、デイビッド・ローレンス カナダ国、エヌ２エヌ・３イー８、オンタ リオ、キッチェナー、イーストフォレス ト・トレイル 200 【要約の続き】 ワークピースに対してロボットのベースを自動的に動か さない。

Claims (1)

1. 【特許請求の範囲】 １．軌道のプログラミングをしないでリアルタイムで対象物上の形態をトラッ キングするためのシステムであり、 （ａ）可動端部とベースとを有し、この可動端部がベースに対して移動可能 であるマニピュレータと、 （ｂ）前記可動端部近くに装着され、前記端部近くの形態をモニターするよ うに指向されたセンサーと、 （ｃ）前記システムは、少なくとも２つの自由度を有し、少なくとも１つの 自由度が冗長軸によりつくられると、 （ｄ）前記センサーから情報を受け、この情報を処理し、この処理した情報 を前記マニピュレータに送って前記端部により前記形態をトラッキングさせる、 システムのための制御手段とを具備するシステム。 ２．前記ベースを前記対象物に対して動かす手段をさらに具備する請求項１の システム。 ３．調節手段は前記対象物を支持する可動フレームである請求項２のシステム 。 ４．前記フレームは前記対象物をベースに対して回転可能にする請求項３のシ ステム。 ５．前記フレームは１以上の平面内で前記対象物を回転可能にする請求項４の システム。 ６．少なくとも６つの自由度を有する請求項５のシステム。 ７．前記センサーはカメラである請求項６のシステム。 ８．前記マニピュレータはロボットである請求項７のシス テム。 ９．７つの自由度を有し、前記端部はチップであり、３つの自由度は可動端部 のチップ用であり、２つの自由度は可動端部の方位用であり、１つの自由度は、 それぞれ前記可動端部の回りにセンサーを位置付けるためのものと、前記ベース を前記対象物に対して移動させる前記調節手段用のものとである請求項８のシス テム。 １０．前記制御手段は、前記対象物の位置を前記ベース、マニピュレータ並び に可動端部に対して制御する少なくとも１つのコンピュータプロセッサーである 請求項９のシステム。 １１．６以上の自由度の夫々に対して独立に規定された制御パラメータを有す る請求項１０のシステム。 １２．前記可動端部は、溶接トーチ、カッテングトーチ、シーラントディスペ ンサー、スプレイガン、接着剤ディスペンサー並びにレザー射出ヘッドから選ば れた少なくとも１つのヘッドを支持し、また、前記フレームは前記対象物の表面 が常時前記ヘッドの領域内でほぼ水平となるように対象物を位置付ける請求項１ １のシステム。 １３．冗長軸により作られる自由度の数は２ないし６の範囲であり、６以上の 各自由度に対して独立に規定された１つの制御パラメータを有する請求項１，２ もしくは３のシステム。 １４．前記対象物は固定であり、そして前記ロボットのベースは対象物に対し て動く請求項１１のシステム。 １５．可動端部とベースとを有するマニピュレータと、対 象物に対してマニピュレータのベースを動かす手段と、前記可動端部近くに装着 され、前記端部近くの形態をモニターするように指向されたセンサーと、制御手 段とを具備し、少なくとも２つの自由度を有し、少なくとも１つの自由度が冗長 軸によりつくられる、システムを使用して、プログラミングをしないでリアルタ イムで対象物上の形態をトラッキングするための方法であり、前記端部が前記対 象物上の形態を追従するのに従って対象物を動かすように前記制御手段を駆動す る工程を有する方法。 １６．前記端部が対象物上の形態を追従するのに従って、端部の領域内でほぼ 水平位置に対象物を維持するように対象物を動かす工程を有する請求項１５の方 法。 １７．感知される形態軌道を対象物座標に表す工程と、これら座標を前記制御 手段に適当に配列する工程と、制御手段から前記座標を抽出する工程都、前記端 部を形態に追従させる工程とを具備する請求項１５の方法。