JP3996702B2 - 組立テーブルとこれを用いた組立方法 - Google Patents
組立テーブルとこれを用いた組立方法 Download PDFInfo
- Publication number
- JP3996702B2 JP3996702B2 JP14486698A JP14486698A JP3996702B2 JP 3996702 B2 JP3996702 B2 JP 3996702B2 JP 14486698 A JP14486698 A JP 14486698A JP 14486698 A JP14486698 A JP 14486698A JP 3996702 B2 JP3996702 B2 JP 3996702B2
- Authority
- JP
- Japan
- Prior art keywords
- assembly
- movable frame
- axis
- assembly plate
- freedom
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Images
Landscapes
- Machine Tool Units (AREA)
- Manipulator (AREA)
Description
【０００１】
【発明の属する技術分野】
本発明は、組立ロボットなどにおいてワークが置かれる台となる組立テーブルに関するものである。
【０００２】
【従来の技術】
組立ロボットにおいては、マニピュレータと称されている組立ハンドで把持したワークを、組立テーブル上に置かれた他のワークに組み付ける作業がよくなされるが、組立テーブルにおけるワークが表面に置かれる組立プレートに２自由度（通常、ピッチ及びロールの動き）を与えることができれば、組立についての便がよくなるために、ピッチ及びロール回転を組立プレートに与えることができる組立テーブルが特開平３−１９６９８０公報に示されている。
【０００３】
【発明が解決しようとする課題】
しかし、上記公報に示された組立テーブルでは、組立プレートの回転中心とピッチ及びロールの回転中心とが異なっているために、座標変換が複雑で誤差も生じやすいものとなっている。また、力センサーが組立ハンド側にあって、力計測部の回転中心も組立プレートから離れているために、力センサーの出力で的確な状態判断を行うことが難しい。
【０００４】
本発明はこのような点に鑑みなされたものであって、その目的とするところは組立プレート上のワークの座標変換が簡単である組立テーブルを提供することと、該組立テーブルを用いてワーク同士の組み付けを容易に行うことができる組立方法を提供するにある。
【０００５】
【課題を解決するための手段】
しかして本発明に係る組立テーブルは、第１の軸を中心に揺動する第１可動フレームと、第１可動フレームに対して第２の軸を中心に揺動する第２可動フレームと、第２可動フレームに設けられた組立プレートと、第１可動フレーム及び第２可動フレームを各軸回りに駆動する駆動手段とからなるとともに、上記第１の軸と第２の軸とは組立プレートの表面を通り且つ組立プレートの表面上で直交しており、上記第１の軸を中心とする揺動及び上記第２の軸を中心とする揺動であるピッチ及びロールの姿勢制御が自在な上記組立プレートはその上に配されるワークとの接触状態を組立制御のために検出する力センサーを備え、駆動手段と各可動フレームとは弾性体から伝達機構を介して連結して組立プレート側にそのピッチ及びロールの動きについてパッシブコンプライアンスを持たせていることに特徴を有している。組立プレート表面の上記２つの軸が交差している１点は、両軸を中心とする回転時にもその位置が動かないものであり、また組立プレートに設けた力センサーによる組立プレートとワークとの接触状態の検出で組立制御がなされるようにしたものであり、また組立プレート側にパッシブコンプライアンスを持たせたものである。
【０００６】
上記組立プレートは、ワークの位置決め用のピンを備えるとともに対象ワーク毎に用意された該組立プレートが第２可動フレームに対して着脱自在となっていることが好ましい。
【０００７】
また、４自由度のＮＣ姿勢制御が可能で且つ上記力センサー出力に応じた制御が可能なロボットとの組み合わせで６自由度を確保しているものが望ましい。
【０００８】
そして本発明にかかる組立方法は、 第１の軸を中心に揺動する第１可動フレームと、第１可動フレームに対して第２の軸を中心に揺動する第２可動フレームと、第２可動フレームに設けられた組立プレートと、第１可動フレーム及び第２可動フレームを各軸回りに駆動する駆動手段とからなるとともに、上記第１の軸と第２の軸とは組立プレートの表面を通り且つ組立プレートの表面上で直交して上記第１の軸を中心とする揺動及び上記第２の軸を中心とする揺動であるピッチ及びロールの姿勢制御が可能な組立テーブルに、４自由度のＮＣ姿勢制御が可能なロボットとを組み合わせて６自由度を確保するとともに、駆動手段と各可動フレームとは弾性体から伝達機構を介して連結して組立プレート側にそのピッチ及びロールの動きについてパッシブコンプライアンスを持たせ、上記組立プレートに設けた力センサーの出力に基づいて６自由度姿勢制御における逐次位置変更を行うことに特徴を有している。
【０００９】
【発明の実施の形態】
以下本発明を実施の形態の一例に基づいて詳述すると、図４は組立ハンド１を備えたＮＣ制御の４自由度型組立ロボット（スカラロボット）Ｒを示しており、該ロボットＲに設けられた組立ハンド１は、２自由度を有している組立テーブル２と協同して、６自由度の組立作業をこなすものとなっている。
【００１０】
組立テーブル２はワークが表面に置かれる組立プレート３を備えるとともに、該組立プレート３に対してピッチ及びロールの回転を与えることができるようにされたもので、Ｕ字形の固定フレーム２０と、この固定フレーム２０の両側板上部を夫々貫通する軸２ｘによって揺動自在に吊り下げられた第１可動フレーム２１と、この第１可動フレーム２１に対して軸２ｙによって揺動自在に吊り下げられた第２可動フレーム２２とを備えており、上記組立プレート３は第２可動フレーム２２に着脱自在に取り付けられたものとなっている。
【００１１】
ここにおいて、上記の軸２ｘ，２ｙは直交する関係に設けられている上に、これら軸２ｘ，２ｙの延長線が組立プレート３の表面を通って組立プレート３の表面上で直交するように、軸２ｘ，２ｙの位置及び組立プレート３の第２可動フレーム２２への取り付け位置を定めてある。
【００１２】
このために、軸２ｘを中心に第１可動フレーム２１が揺動する時、第２可動フレーム２２と組立プレート３とは第１可動フレーム２１とともにピッチ（もしくはロール）の動きを行い、軸２ｙを中心に第２可動フレーム２２が揺動する時、組立プレート３は第２可動フレーム２２とともにロール（もしくはピッチ）の動きを行うのであるが、ピッチ及びロールのいずれの動きがあっても、上記軸２ｘ，２ｙの延長線が交差している組立プレート３の表面の中央１点の位置はまったく変化しない。
【００１３】
従って、組立プレート３上に置かれるワークにしても、上記１点が基準点となるように組立プレート３上に位置決め配置することにより、組立ロボットＲ側の組立ハンド１との協同によるワーク組立にあたり、組立プレート３上のワークに対して複雑な座標変換が必要となることがなく、また座標変換に伴う誤差の発生もないために、信頼性の高い組立を行うことができるものとなっている。
【００１４】
上記特性を活かすために、組立プレート３へのワークの取り付けは、図３に示すように、組立プレート３にピン３０を設けておいて、該ピン３０によってワーク９０の位置決め及びワーク９０の保持を行っている。特に、各種ワークへの対応を容易とするために、ワーク毎（ワークの大きさ毎）に専用の組立プレート３を設けて、組立プレート３の交換だけで対応できるようにしている。上記ピン３０としては、ＪＩＳ平行ピンを組立プレート３に圧入したようなものを好適に用いることができる。
【００１５】
また、組立プレート３はその裏面側に力センサー４が取り付けられたものとなっている。この力センサー４は、上記組立にあたり、組立プレート３上のワークと、組立ハンド１側のワークとの接触状態を検出するためのものとして機能する。
【００１６】
ところで、第１可動フレーム２１の駆動は固定フレーム２０に設けたモータ２５で行い、第２稼動フレーム２２の駆動は第１可動フレーム２１に設けたモータ２６で行っているのであるが、これらモータ２５，２６と可動フレーム２１，２２とは直結とせずに、弾性体からなる伝達部材（図示例ではベルト）２７，２７を介在させるものとしている。これは上記組立に際して、組立プレート３側のワークにそのピッチ及びロールの動きについてパッシブコンプライアンスを持たせて、組立性を向上させるためである。
【００１７】
図５は上記ピッチ及びロール制御が可能な組立テーブル２と、Ｘ，Ｙ，Ｚ軸方向移動及びロール角の４自由度の姿勢制御が可能な上記ロボットＲとを組み合わせることでワーク組立時の６自由度を確保したシステムのブロック図であり、該システムにおいては、力センサー（好ましくは６軸力センサー）４の計測データに基づいて接触状態の把握を行いつつ、ロボットＲ及び組立テーブル２の姿勢制御を行う。すなわち、図６にも示すように、組立プレート３上のワーク９０と、組立ハンド１側のワーク９１との接触状態を力センサー４を通じて検出して現状位置認識を行い、この認識結果に基づいてロボットＲの姿勢制御及び組立プレート３の姿勢変更を行うのである。組立時の傾き外乱に対して高い信頼性を確保することができると同時に姿勢の効率のよい変更が可能である。図５中の３５は汎用サーボコントローラ、３６はサーボドライバーであり、上記モータ２５，２６はこれらによって制御される。
【００１８】
組立性の向上という点においては、組立プレート３上のワーク９０にロボットＲ側の組立ハンド１で把持したワーク９１を上方側から嵌めこむ動作を行う場合、組立ハンド１の図中矢印で示す水平方向剛性が０となるように、水平方向駆動用のモータをフリーとすることが好ましい。ワーク９０，９１同士に少々のひっかかりがあっても水平方向のパッシブコンプライアンスで吸収して、組立（嵌めこみ）を行うことができる。
【００１９】
また、組立プレート３上のワーク９０にロボットＲ側の組立ハンド１で把持したワーク９１を上方側から嵌めこむ動作を行う場合、図８に示すように、組立プレート３を意図的に傾けることも有効である。ワーク９０，９１同士が接触した際の力センサー４から得ることができるモーメントデータ（Ｍｙ＿ｏｒｇ）に基づき、現在の接触位置（ｘｎｏｗ，ｙｎｏｗ）を計算して、ワーク９１の誘導方向を推定することができる。つまり、ワーク９１の最終目的地が（ｘｎｏｗ＋Δｘ，ｙｎｏｗ＋Δｙ）である時、Δｘ＝ｘｎｏｗ・Ｍｙ＿ｏｒｇ、Δｙ＝ｙｎｏｗ・Ｍｙ＿ｏｒｇで計算することができる。
【００２０】
図９に示すように、ワーク９１を意図的に水平移動させることで少なくとも２点で水平方向においてワーク９０，９１同士を接触させ、各接触位置（ｘ１，ｙ１）（ｘ２，ｙ２）から目的地座標（（ｘ１＋ｘ２）／２，（ｙ１＋ｙ２）／２）を同定するようにしてもよい。
【００２１】
図１０及び図１１はワーク９０上のピン９２が差し込まれる孔９３を備えたワーク９１をワーク９０に組み付ける場合を示しており、この場合、ワーク９１をワーク９１側に押しつける力（発生力Ｎ）を一定とした状態でピン９２に対する孔９３の探索を行い、発生力Ｎが急に小さくなった時点を孔９３の発見として、この時点でワーク９０，９１の許容限界近くの挿入力でワーク９１を押しこむ動作を示している。挿入の成功率が向上する。なお、この場合のワーク９０，９１の組み付け成功の最終判定は、組み付け終了時の６軸力データが予め設定された閾値ｆ０以下かどうかで判断するとよい。
【００２２】
上記閾値ｆ０は予め設定しておくことになるが、力データ計測ソフトウェアのスタート毎に無負荷時の力オフセットデータｆａを計測して、該オフセットデータｆａからの相対増分ｆｂで自動決定（ｆ０＝ｆａ＋ｆｂ）するようにしておくことが好ましい。ノイズ等によるデータのばらつきを回避することができる。
【００２３】
【発明の効果】
以上のように本発明に係る組立テーブルは、第１の軸を中心に揺動する第１可動フレームと、第１可動フレームに対して第２の軸を中心に揺動する第２可動フレームと、第２可動フレームに設けられた組立プレートと、第１可動フレーム及び第２可動フレームを各軸回りに駆動する駆動手段とからなるとともに、上記第１の軸と第２の軸とは組立プレートの表面を通り且つ組立プレートの表面上で直交しているから、組立プレート表面の上記２つの軸が交差している１点は、両軸を中心とする回転時にもその位置が動かないものであり、このために組立プレートを回転させた時にも組立プレート上のワークについての座標変換が複雑となることがなく、座標変換に伴う誤差も少なくてすむものであり、このために組立制御を容易とすることができる。
【００２４】
しかも上記第１の軸を中心とする揺動及び上記第２の軸を中心とする揺動であるピッチ及びロールの姿勢制御が自在な上記組立プレートはその上に配されるワークとの接触状態を組立制御のために検出する力センサーを備えているために、組立プレートが上記２軸回りの揺動の自由度を有しているにもかかわらず、組立プレート上のワークと該ワークに組み付ける他のワークとの接触状態を的確に判別することができる。加えるに、駆動手段と各可動フレームとは弾性体からなる伝達機構を介して連結して組立プレート側にそのピッチ及びロールの動きについてパッシブコンプライアンスを持たせているために、組立テー ブルの上記ピッチ及びロールの両方の姿勢制御の精度を高くとらなくてもパッシブコンプライアンス効果による組立性の向上を図ることができる。
【００２５】
また、ワークの位置決め用のピンを組立プレートが備えるとともに対象ワーク毎に用意された該組立プレートが第２可動フレームに対して着脱自在となっていると、品種切り換えを低コストで行うことができる。
【００２６】
また、４自由度のＮＣ姿勢制御が可能なロボットとの組み合わせで６自由度を確保することで、各種の組立作業を低コストで行わせることができる。
【００２７】
そして本発明にかかる組立方法は、第１の軸を中心に揺動する第１可動フレームと、第１可動フレームに対して第２の軸を中心に揺動する第２可動フレームと、第２可動フレームに設けられた組立プレートと、第１可動フレーム及び第２可動フレームを各軸回りに駆動する駆動手段とからなるとともに、上記第１の軸と第２の軸とは組立プレートの表面を通り且つ組立プレートの表面上で直交して上記第１の軸を中心とする揺動及び上記第２の軸を中心とする揺動であるピッチ及びロールの姿勢制御が可能な組立テーブルに、４自由度のＮＣ姿勢制御が可能なロボットとを組み合わせて６自由度を確保するとともに、駆動手段と各可動フレームとは弾性体から伝達機構を介して連結して組立プレート側にそのピッチ及びロールの動きについてパッシブコンプライアンスを持たせ、上記組立プレートに設けた力センサーの出力に基づいて６自由度姿勢制御における逐次位置変更を行うために、姿勢の効率のよい変更が可能であり、上記パッシブコンプライアンスのこともあって組立時の傾き外乱に対して高信頼性を確保することができる。
【図面の簡単な説明】
【図１】本発明の実施の形態の一例の斜視図である。
【図２】同上の概略側面である。
【図３】(a)(b)は同上の異なる組立プレートの側面図である。
【図４】組立ロボットとの対の状態を示す斜視図である。
【図５】同上の制御ブロック図である。
【図６】同上の動作説明図である。
【図７】(a)(b)は同上の組立動作の一例の動作説明図である。
【図８】(a)(b)は同上の組立動作の他例の動作説明図である。
【図９】(a)(b)(c)は同上の組立動作のさらに他例の動作説明図である。
【図１０】(a)(b)(c)は同上の組立動作の別の例の動作説明図である。
【図１１】同上の動作説明図である。
【図１２】同上の閾値の説明図である。
【符号の説明】
２ 組立テーブル
３ 組立プレート
２１ 第１可動フレーム
２２ 第２可動フレーム
【発明の属する技術分野】
本発明は、組立ロボットなどにおいてワークが置かれる台となる組立テーブルに関するものである。
【０００２】
【従来の技術】
組立ロボットにおいては、マニピュレータと称されている組立ハンドで把持したワークを、組立テーブル上に置かれた他のワークに組み付ける作業がよくなされるが、組立テーブルにおけるワークが表面に置かれる組立プレートに２自由度（通常、ピッチ及びロールの動き）を与えることができれば、組立についての便がよくなるために、ピッチ及びロール回転を組立プレートに与えることができる組立テーブルが特開平３−１９６９８０公報に示されている。
【０００３】
【発明が解決しようとする課題】
しかし、上記公報に示された組立テーブルでは、組立プレートの回転中心とピッチ及びロールの回転中心とが異なっているために、座標変換が複雑で誤差も生じやすいものとなっている。また、力センサーが組立ハンド側にあって、力計測部の回転中心も組立プレートから離れているために、力センサーの出力で的確な状態判断を行うことが難しい。
【０００４】
本発明はこのような点に鑑みなされたものであって、その目的とするところは組立プレート上のワークの座標変換が簡単である組立テーブルを提供することと、該組立テーブルを用いてワーク同士の組み付けを容易に行うことができる組立方法を提供するにある。
【０００５】
【課題を解決するための手段】
しかして本発明に係る組立テーブルは、第１の軸を中心に揺動する第１可動フレームと、第１可動フレームに対して第２の軸を中心に揺動する第２可動フレームと、第２可動フレームに設けられた組立プレートと、第１可動フレーム及び第２可動フレームを各軸回りに駆動する駆動手段とからなるとともに、上記第１の軸と第２の軸とは組立プレートの表面を通り且つ組立プレートの表面上で直交しており、上記第１の軸を中心とする揺動及び上記第２の軸を中心とする揺動であるピッチ及びロールの姿勢制御が自在な上記組立プレートはその上に配されるワークとの接触状態を組立制御のために検出する力センサーを備え、駆動手段と各可動フレームとは弾性体から伝達機構を介して連結して組立プレート側にそのピッチ及びロールの動きについてパッシブコンプライアンスを持たせていることに特徴を有している。組立プレート表面の上記２つの軸が交差している１点は、両軸を中心とする回転時にもその位置が動かないものであり、また組立プレートに設けた力センサーによる組立プレートとワークとの接触状態の検出で組立制御がなされるようにしたものであり、また組立プレート側にパッシブコンプライアンスを持たせたものである。
【０００６】
上記組立プレートは、ワークの位置決め用のピンを備えるとともに対象ワーク毎に用意された該組立プレートが第２可動フレームに対して着脱自在となっていることが好ましい。
【０００７】
また、４自由度のＮＣ姿勢制御が可能で且つ上記力センサー出力に応じた制御が可能なロボットとの組み合わせで６自由度を確保しているものが望ましい。
【０００８】
そして本発明にかかる組立方法は、 第１の軸を中心に揺動する第１可動フレームと、第１可動フレームに対して第２の軸を中心に揺動する第２可動フレームと、第２可動フレームに設けられた組立プレートと、第１可動フレーム及び第２可動フレームを各軸回りに駆動する駆動手段とからなるとともに、上記第１の軸と第２の軸とは組立プレートの表面を通り且つ組立プレートの表面上で直交して上記第１の軸を中心とする揺動及び上記第２の軸を中心とする揺動であるピッチ及びロールの姿勢制御が可能な組立テーブルに、４自由度のＮＣ姿勢制御が可能なロボットとを組み合わせて６自由度を確保するとともに、駆動手段と各可動フレームとは弾性体から伝達機構を介して連結して組立プレート側にそのピッチ及びロールの動きについてパッシブコンプライアンスを持たせ、上記組立プレートに設けた力センサーの出力に基づいて６自由度姿勢制御における逐次位置変更を行うことに特徴を有している。
【０００９】
【発明の実施の形態】
以下本発明を実施の形態の一例に基づいて詳述すると、図４は組立ハンド１を備えたＮＣ制御の４自由度型組立ロボット（スカラロボット）Ｒを示しており、該ロボットＲに設けられた組立ハンド１は、２自由度を有している組立テーブル２と協同して、６自由度の組立作業をこなすものとなっている。
【００１０】
組立テーブル２はワークが表面に置かれる組立プレート３を備えるとともに、該組立プレート３に対してピッチ及びロールの回転を与えることができるようにされたもので、Ｕ字形の固定フレーム２０と、この固定フレーム２０の両側板上部を夫々貫通する軸２ｘによって揺動自在に吊り下げられた第１可動フレーム２１と、この第１可動フレーム２１に対して軸２ｙによって揺動自在に吊り下げられた第２可動フレーム２２とを備えており、上記組立プレート３は第２可動フレーム２２に着脱自在に取り付けられたものとなっている。
【００１１】
ここにおいて、上記の軸２ｘ，２ｙは直交する関係に設けられている上に、これら軸２ｘ，２ｙの延長線が組立プレート３の表面を通って組立プレート３の表面上で直交するように、軸２ｘ，２ｙの位置及び組立プレート３の第２可動フレーム２２への取り付け位置を定めてある。
【００１２】
このために、軸２ｘを中心に第１可動フレーム２１が揺動する時、第２可動フレーム２２と組立プレート３とは第１可動フレーム２１とともにピッチ（もしくはロール）の動きを行い、軸２ｙを中心に第２可動フレーム２２が揺動する時、組立プレート３は第２可動フレーム２２とともにロール（もしくはピッチ）の動きを行うのであるが、ピッチ及びロールのいずれの動きがあっても、上記軸２ｘ，２ｙの延長線が交差している組立プレート３の表面の中央１点の位置はまったく変化しない。
【００１３】
従って、組立プレート３上に置かれるワークにしても、上記１点が基準点となるように組立プレート３上に位置決め配置することにより、組立ロボットＲ側の組立ハンド１との協同によるワーク組立にあたり、組立プレート３上のワークに対して複雑な座標変換が必要となることがなく、また座標変換に伴う誤差の発生もないために、信頼性の高い組立を行うことができるものとなっている。
【００１４】
上記特性を活かすために、組立プレート３へのワークの取り付けは、図３に示すように、組立プレート３にピン３０を設けておいて、該ピン３０によってワーク９０の位置決め及びワーク９０の保持を行っている。特に、各種ワークへの対応を容易とするために、ワーク毎（ワークの大きさ毎）に専用の組立プレート３を設けて、組立プレート３の交換だけで対応できるようにしている。上記ピン３０としては、ＪＩＳ平行ピンを組立プレート３に圧入したようなものを好適に用いることができる。
【００１５】
また、組立プレート３はその裏面側に力センサー４が取り付けられたものとなっている。この力センサー４は、上記組立にあたり、組立プレート３上のワークと、組立ハンド１側のワークとの接触状態を検出するためのものとして機能する。
【００１６】
ところで、第１可動フレーム２１の駆動は固定フレーム２０に設けたモータ２５で行い、第２稼動フレーム２２の駆動は第１可動フレーム２１に設けたモータ２６で行っているのであるが、これらモータ２５，２６と可動フレーム２１，２２とは直結とせずに、弾性体からなる伝達部材（図示例ではベルト）２７，２７を介在させるものとしている。これは上記組立に際して、組立プレート３側のワークにそのピッチ及びロールの動きについてパッシブコンプライアンスを持たせて、組立性を向上させるためである。
【００１７】
図５は上記ピッチ及びロール制御が可能な組立テーブル２と、Ｘ，Ｙ，Ｚ軸方向移動及びロール角の４自由度の姿勢制御が可能な上記ロボットＲとを組み合わせることでワーク組立時の６自由度を確保したシステムのブロック図であり、該システムにおいては、力センサー（好ましくは６軸力センサー）４の計測データに基づいて接触状態の把握を行いつつ、ロボットＲ及び組立テーブル２の姿勢制御を行う。すなわち、図６にも示すように、組立プレート３上のワーク９０と、組立ハンド１側のワーク９１との接触状態を力センサー４を通じて検出して現状位置認識を行い、この認識結果に基づいてロボットＲの姿勢制御及び組立プレート３の姿勢変更を行うのである。組立時の傾き外乱に対して高い信頼性を確保することができると同時に姿勢の効率のよい変更が可能である。図５中の３５は汎用サーボコントローラ、３６はサーボドライバーであり、上記モータ２５，２６はこれらによって制御される。
【００１８】
組立性の向上という点においては、組立プレート３上のワーク９０にロボットＲ側の組立ハンド１で把持したワーク９１を上方側から嵌めこむ動作を行う場合、組立ハンド１の図中矢印で示す水平方向剛性が０となるように、水平方向駆動用のモータをフリーとすることが好ましい。ワーク９０，９１同士に少々のひっかかりがあっても水平方向のパッシブコンプライアンスで吸収して、組立（嵌めこみ）を行うことができる。
【００１９】
また、組立プレート３上のワーク９０にロボットＲ側の組立ハンド１で把持したワーク９１を上方側から嵌めこむ動作を行う場合、図８に示すように、組立プレート３を意図的に傾けることも有効である。ワーク９０，９１同士が接触した際の力センサー４から得ることができるモーメントデータ（Ｍｙ＿ｏｒｇ）に基づき、現在の接触位置（ｘｎｏｗ，ｙｎｏｗ）を計算して、ワーク９１の誘導方向を推定することができる。つまり、ワーク９１の最終目的地が（ｘｎｏｗ＋Δｘ，ｙｎｏｗ＋Δｙ）である時、Δｘ＝ｘｎｏｗ・Ｍｙ＿ｏｒｇ、Δｙ＝ｙｎｏｗ・Ｍｙ＿ｏｒｇで計算することができる。
【００２０】
図９に示すように、ワーク９１を意図的に水平移動させることで少なくとも２点で水平方向においてワーク９０，９１同士を接触させ、各接触位置（ｘ１，ｙ１）（ｘ２，ｙ２）から目的地座標（（ｘ１＋ｘ２）／２，（ｙ１＋ｙ２）／２）を同定するようにしてもよい。
【００２１】
図１０及び図１１はワーク９０上のピン９２が差し込まれる孔９３を備えたワーク９１をワーク９０に組み付ける場合を示しており、この場合、ワーク９１をワーク９１側に押しつける力（発生力Ｎ）を一定とした状態でピン９２に対する孔９３の探索を行い、発生力Ｎが急に小さくなった時点を孔９３の発見として、この時点でワーク９０，９１の許容限界近くの挿入力でワーク９１を押しこむ動作を示している。挿入の成功率が向上する。なお、この場合のワーク９０，９１の組み付け成功の最終判定は、組み付け終了時の６軸力データが予め設定された閾値ｆ０以下かどうかで判断するとよい。
【００２２】
上記閾値ｆ０は予め設定しておくことになるが、力データ計測ソフトウェアのスタート毎に無負荷時の力オフセットデータｆａを計測して、該オフセットデータｆａからの相対増分ｆｂで自動決定（ｆ０＝ｆａ＋ｆｂ）するようにしておくことが好ましい。ノイズ等によるデータのばらつきを回避することができる。
【００２３】
【発明の効果】
以上のように本発明に係る組立テーブルは、第１の軸を中心に揺動する第１可動フレームと、第１可動フレームに対して第２の軸を中心に揺動する第２可動フレームと、第２可動フレームに設けられた組立プレートと、第１可動フレーム及び第２可動フレームを各軸回りに駆動する駆動手段とからなるとともに、上記第１の軸と第２の軸とは組立プレートの表面を通り且つ組立プレートの表面上で直交しているから、組立プレート表面の上記２つの軸が交差している１点は、両軸を中心とする回転時にもその位置が動かないものであり、このために組立プレートを回転させた時にも組立プレート上のワークについての座標変換が複雑となることがなく、座標変換に伴う誤差も少なくてすむものであり、このために組立制御を容易とすることができる。
【００２４】
しかも上記第１の軸を中心とする揺動及び上記第２の軸を中心とする揺動であるピッチ及びロールの姿勢制御が自在な上記組立プレートはその上に配されるワークとの接触状態を組立制御のために検出する力センサーを備えているために、組立プレートが上記２軸回りの揺動の自由度を有しているにもかかわらず、組立プレート上のワークと該ワークに組み付ける他のワークとの接触状態を的確に判別することができる。加えるに、駆動手段と各可動フレームとは弾性体からなる伝達機構を介して連結して組立プレート側にそのピッチ及びロールの動きについてパッシブコンプライアンスを持たせているために、組立テー ブルの上記ピッチ及びロールの両方の姿勢制御の精度を高くとらなくてもパッシブコンプライアンス効果による組立性の向上を図ることができる。
【００２５】
また、ワークの位置決め用のピンを組立プレートが備えるとともに対象ワーク毎に用意された該組立プレートが第２可動フレームに対して着脱自在となっていると、品種切り換えを低コストで行うことができる。
【００２６】
また、４自由度のＮＣ姿勢制御が可能なロボットとの組み合わせで６自由度を確保することで、各種の組立作業を低コストで行わせることができる。
【００２７】
そして本発明にかかる組立方法は、第１の軸を中心に揺動する第１可動フレームと、第１可動フレームに対して第２の軸を中心に揺動する第２可動フレームと、第２可動フレームに設けられた組立プレートと、第１可動フレーム及び第２可動フレームを各軸回りに駆動する駆動手段とからなるとともに、上記第１の軸と第２の軸とは組立プレートの表面を通り且つ組立プレートの表面上で直交して上記第１の軸を中心とする揺動及び上記第２の軸を中心とする揺動であるピッチ及びロールの姿勢制御が可能な組立テーブルに、４自由度のＮＣ姿勢制御が可能なロボットとを組み合わせて６自由度を確保するとともに、駆動手段と各可動フレームとは弾性体から伝達機構を介して連結して組立プレート側にそのピッチ及びロールの動きについてパッシブコンプライアンスを持たせ、上記組立プレートに設けた力センサーの出力に基づいて６自由度姿勢制御における逐次位置変更を行うために、姿勢の効率のよい変更が可能であり、上記パッシブコンプライアンスのこともあって組立時の傾き外乱に対して高信頼性を確保することができる。
【図面の簡単な説明】
【図１】本発明の実施の形態の一例の斜視図である。
【図２】同上の概略側面である。
【図３】(a)(b)は同上の異なる組立プレートの側面図である。
【図４】組立ロボットとの対の状態を示す斜視図である。
【図５】同上の制御ブロック図である。
【図６】同上の動作説明図である。
【図７】(a)(b)は同上の組立動作の一例の動作説明図である。
【図８】(a)(b)は同上の組立動作の他例の動作説明図である。
【図９】(a)(b)(c)は同上の組立動作のさらに他例の動作説明図である。
【図１０】(a)(b)(c)は同上の組立動作の別の例の動作説明図である。
【図１１】同上の動作説明図である。
【図１２】同上の閾値の説明図である。
【符号の説明】
２ 組立テーブル
３ 組立プレート
２１ 第１可動フレーム
２２ 第２可動フレーム
Claims (4)
- 第１の軸を中心に揺動する第１可動フレームと、第１可動フレームに対して第２の軸を中心に揺動する第２可動フレームと、第２可動フレームに設けられた組立プレートと、第１可動フレーム及び第２可動フレームを各軸回りに駆動する駆動手段とからなるとともに、上記第１の軸と第２の軸とは組立プレートの表面を通り且つ組立プレートの表面上で直交しており、上記第１の軸を中心とする揺動及び上記第２の軸を中心とする揺動であるピッチ及びロールの姿勢制御が自在な上記組立プレートはその上に配されるワークとの接触状態を組立制御のために検出する力センサーを備え、駆動手段と各可動フレームとは弾性体からなる伝達機構を介して連結して組立プレート側にそのピッチ及びロールの動きについてパッシブコンプライアンスを持たせていることを特徴とする組立テーブル。
- 組立プレートはワークの位置決め用のピンを備えるとともに対象ワーク毎に用意された該組立プレートが第２可動フレームに対して着脱自在となっていることを特徴とする請求項１記載の組立テーブル。
- ４自由度のＮＣ姿勢制御が可能で且つ上記力センサー出力に応じた制御が可能なロボットとの組み合わせで６自由度を確保していることを特徴とする請求項１記載の組立テーブル。
- 第１の軸を中心に揺動する第１可動フレームと、第１可動フレームに対して第２の軸を中心に揺動する第２可動フレームと、第２可動フレームに設けられた組立プレートと、第１可動フレーム及び第２可動フレームを各軸回りに駆動する駆動手段とからなるとともに、上記第１の軸と第２の軸とは組立プレートの表面を通り且つ組立プレートの表面上で直交して上記第１の軸を中心とする揺動及び上記第２の軸を中心とする揺動であるピッチ及びロールの姿勢制御が可能な組立テーブルに、４自由度のＮＣ姿勢制御が可能なロボットとを組み合わせて６自由度を確保するとともに、駆動手段と各可動フレームとは弾性体から伝達機構を介して連結して組立プレート側にそのピッチ及びロールの動きについてパッシブコンプライアンスを持たせ、上記組立プレートに設けた力センサーの出力に基づいて６自由度姿勢制御における逐次位置変更を行うことを特徴とする組立方法。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP14486698A JP3996702B2 (ja) | 1998-05-26 | 1998-05-26 | 組立テーブルとこれを用いた組立方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP14486698A JP3996702B2 (ja) | 1998-05-26 | 1998-05-26 | 組立テーブルとこれを用いた組立方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH11333647A JPH11333647A (ja) | 1999-12-07 |
| JP3996702B2 true JP3996702B2 (ja) | 2007-10-24 |
Family
ID=15372226
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP14486698A Expired - Fee Related JP3996702B2 (ja) | 1998-05-26 | 1998-05-26 | 組立テーブルとこれを用いた組立方法 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3996702B2 (ja) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR20210072407A (ko) * | 2019-12-09 | 2021-06-17 | 전주대학교 산학협력단 | 조립 장치 |
Family Cites Families (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS58206389A (ja) * | 1982-05-28 | 1983-12-01 | 日産自動車株式会社 | ロボツトの制御装置 |
| JPS6052276A (ja) * | 1983-09-02 | 1985-03-25 | 松下電器産業株式会社 | ロボット装置 |
| JPS6224991A (ja) * | 1985-07-26 | 1987-02-02 | 松下電器産業株式会社 | 産業用ロボツト |
| FR2631100A1 (fr) * | 1988-05-05 | 1989-11-10 | Stutzmann Louis | Dispositif de positionnement de pieces metalliques contre un element metallique |
| JPH02284827A (ja) * | 1989-04-27 | 1990-11-22 | Aisin Seiki Co Ltd | 複数種類ワーク組立を行う組立用パレット |
| JPH03196980A (ja) * | 1989-12-22 | 1991-08-28 | Hitachi Ltd | 多関節６自由度ロボット機構および該ロボット機構を用いた組立、加工装置 |
| JP3304652B2 (ja) * | 1994-12-19 | 2002-07-22 | 富士通株式会社 | 部品組み立て装置 |
| JPH09248778A (ja) * | 1996-03-14 | 1997-09-22 | Ricoh Co Ltd | ロボット装置 |
-
1998
- 1998-05-26 JP JP14486698A patent/JP3996702B2/ja not_active Expired - Fee Related
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR20210072407A (ko) * | 2019-12-09 | 2021-06-17 | 전주대학교 산학협력단 | 조립 장치 |
| KR102371221B1 (ko) | 2019-12-09 | 2022-03-07 | 전주대학교 산학협력단 | 조립 장치 |
Also Published As
| Publication number | Publication date |
|---|---|
| JPH11333647A (ja) | 1999-12-07 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| EP0541811B1 (en) | Working device | |
| US7765031B2 (en) | Robot and multi-robot interference avoidance method | |
| JP5114019B2 (ja) | エフェクタの軌道を制御するための方法 | |
| JP7363098B2 (ja) | ロボットの制御方法 | |
| US6216056B1 (en) | Method of controlling force assisting device and control apparatus using the same | |
| US20150127141A1 (en) | Robot, control device, robot system and robot control method | |
| CN106493711B (zh) | 控制装置、机器人以及机器人系统 | |
| US4884941A (en) | Active compliant end-effector with force, angular position, and angular velocity sensing | |
| US11691290B2 (en) | Robot control method and robot system | |
| JPH0413062B2 (ja) | ||
| US10906175B2 (en) | Apparatus and method for estimating position of the center of gravity of robot | |
| JP4485887B2 (ja) | 脚式移動ロボットの力センサ異常検知装置 | |
| JPH0438553B2 (ja) | ||
| US11951625B2 (en) | Control method for robot and robot system | |
| WO2019017416A1 (ja) | 作業用ロボット、作業用ロボットの制御方法 | |
| JP3996702B2 (ja) | 組立テーブルとこれを用いた組立方法 | |
| JPH11156769A (ja) | 双腕型スカラロボット | |
| JPH06278007A (ja) | 研削ロボット | |
| JP2015085499A (ja) | ロボット、ロボットシステム、制御装置及び制御方法 | |
| JPH11345010A (ja) | ロボットの制御装置 | |
| JP2019155523A (ja) | ロボット制御装置、ロボット制御方法、ロボット制御装置を用いた物品の組立方法、プログラム及び記録媒体 | |
| JPH02190276A (ja) | 自走型ロボットの姿勢安定装置 | |
| JPH058187A (ja) | ロボツト | |
| WO2022210186A1 (ja) | ロボットの位置および姿勢を制御するパラメータを算出する制御装置 | |
| JP2718687B2 (ja) | 多自由度作業機械の位置と力の制御装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20040622 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20050105 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20050307 |
|
| A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20051011 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20051110 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20051212 |
|
| A911 | Transfer of reconsideration by examiner before appeal (zenchi) |
Free format text: JAPANESE INTERMEDIATE CODE: A911 Effective date: 20051219 |
|
| A912 | Removal of reconsideration by examiner before appeal (zenchi) |
Free format text: JAPANESE INTERMEDIATE CODE: A912 Effective date: 20060519 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20070702 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20070803 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100810 Year of fee payment: 3 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100810 Year of fee payment: 3 |
|
| S533 | Written request for registration of change of name |
Free format text: JAPANESE INTERMEDIATE CODE: R313533 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100810 Year of fee payment: 3 |
|
| R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110810 Year of fee payment: 4 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120810 Year of fee payment: 5 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130810 Year of fee payment: 6 |
|
| LAPS | Cancellation because of no payment of annual fees |