JP5402119B2

JP5402119B2 - 組立装置

Info

Publication number: JP5402119B2
Application number: JP2009063476A
Authority: JP
Inventors: 正和藤井; 光治曽根原; 弘記村上; 暢宏柴崎; 渡稲村
Original assignee: IHI Corp
Current assignee: IHI Corp
Priority date: 2009-03-16
Filing date: 2009-03-16
Publication date: 2014-01-29
Anticipated expiration: 2029-03-16
Also published as: JP2010214514A

Description

本発明は、凹部または孔が設けられた部材（孔部品）と、凸部を有する部材または棒状部材（軸部品）とのいずれかを把持して移動操作し、凹部または孔が設けられた部材の凹部または孔に、凸部または棒状部材を挿入させる組立装置に関する。

従来、凸部を有する部材、例えば、棒状部材（軸部品）を把持して移動操作し、この棒状部材を、凹部が設けられた部材、例えば、孔が設けられた部材（孔部品）の孔（凹部）に挿入、嵌合させる組立装置が提案されている。

このような組立装置としては、孔が設けられた部材を固定して支持し、この部材の孔の内径と棒状部材の外径との差（孔及び棒状部材間のクリアランス）よりも芯ずれが小さくなるように、棒状部材を高精度に移動操作できるように構成し、この棒状部材を孔に挿入できるようにしたものが提案されている。

また、このような組立装置として、特許文献１には、ロボットアームに力覚センサを設け、このロボットアームによって棒状部材を把持し、棒状部材を孔が設けられた部材の孔に挿入させようとしたときに、棒状部材の先端が当接して受ける力（反力）を力覚センサにより検出し、受けた力の方向に応じて棒状部材を移動操作し、再度の挿入動作を行うようにしたピン挿入装置が提案されている。

さらに、このような組立装置として、特許文献１には、ロボットアームに力覚センサ及び微小動作用のアクチュエータを設け、このロボットアームによって棒状部材を把持し、棒状部材を孔が設けられた部材の孔に挿入させようとしたときに、棒状部材の先端が当接して受ける力（反力）を力覚センサにより検出し、受けた力の方向に応じてアクチュエータを動作させて棒状部材を微小移動させ、再度の挿入動作を行うようにした組立装置が記載されている。

また、従来、ロボットアームに、弾性を有し、または、並進及びねじれ方向に自由に動作する受動機構を設け、このロボットアームによって棒状部材を把持し、棒状部材を孔が設けられた部材の孔に挿入させようとしたときに、棒状部材の先端が当接して受ける力（反力）に応じて受動機構の位置及び姿勢が変化して棒状部材が移動し、挿入動作が行えるようにした組立装置が提案されている。

特開２００３−７１７６０号公報

ところで、前述した従来の組立装置においては、芯ずれが孔及び棒状部材間のクリアランスよりも小さくなるように構成したものにおいては、棒状部材の移動操作を極めて高い精度で行う必要があり、特に、精密部品を扱う場合には、クリアランスが極めて小さいため、バックラッシュや装置の微小な撓みも重大な影響を与えるものとなり、装置の構成及び使用が困難となる。すなわち、極めて高い精度で部材の把持及び固定を行うことができる冶具や把持手段を用意しなければならず、また、装置の動作について精密な教示が必要となる。このような教示は部材の種類が変わるたびに実施しなければならず、極めて煩雑である。

また、特許文献１に記載された組立装置及びさらに微小動作用のアクチュエータを設けた組立装置においては、力覚センサやアクチュエータなど多くの機構をロボットアームの先端部分に設ける必要があるため、その分、ロボットアームの可搬重量が制限されてしまうという問題がある。

また、ロボットアームに受動機構を設けた組立装置においては、ロボットアームの動作によって把持した部材が振動してしまい、振動が収まるまで挿入操作ができず、迅速な作業ができないという問題がある。また、ロボットアームを横向きにすると重力によって受動機構より先端側が下方に降下してしまうので、上下方向の挿入操作以外は極めて困難で、受動動作にロック機構を設けるか、または、把持した部材の位置及び姿勢を検出するセンサを別途設けるなどの必要が生じ、装置構成が複雑化してしまう。

さらに、これら組立装置においては、ロボットアームの先端部分が長くなってしまい、把持した部材の姿勢を所定量変化させるためにロボットアームを大きく動かす必要が生じ、可動範囲が制約されてしまうという問題がある。

そこで、本発明は、前記の実情に鑑みてなされたものであり、その目的は、部材の移動操作の精度を特段に向上させる必要を生ずることなく、凸部または棒状部材の凹部または孔への挿入を短時間で完了することができ、さらに、把持手段の可搬重量や可動範囲が制限されることのない組立装置を提供することにある。

前述の課題を解決し、前記目的を達成するため、本発明に係る組立装置は、以下の構成のいずれか一を有するものである。

〔構成１〕
凹部または孔が設けられた部材と凸部を有する部材または棒状部材とのいずれか一方を把持して移動操作し凹部または孔に凸部または棒状部材を挿入させる把持手段と、凹部または孔が設けられた部材と凸部を有する部材または棒状部材との他方を保持する保持台と、把持手段または保持台に設けられ、把持手段が凹部または孔に凸部または棒状部材を挿入させようとしたときに、凸部または棒状部材の先端部と凹部または孔の周囲部とが当接した場合に、凹部または孔が設けられた部材または凸部を有する部材または棒状部材を介して保持台が受ける挿入方向に直交する軸回りのモーメントを検出する検出手段と、保持台を挿入方向に直交する軸回りの回転方向に移動操作するアクチュエータと、検出手段により検出されたモーメントに基づく演算を行いこの演算結果に応じてアクチュエータを制御する制御手段と、保持台を挿入方向に直交する方向に移動可能に支持する受動機構とを備え、把持手段が凹部または孔に凸部または棒状部材を挿入させようとしたときに、凸部または棒状部材の先端部と凹部または孔の周囲部とが当接した場合に、保持台に固定された部材が受ける並進力により、受動機構が変位され、制御手段は、検出手段により検出されたモーメントに基づき、アクチュエータにより保持台を移動操作させ、凸部または棒状部材を凹部または孔に挿入させることを特徴とするものである。

なお、回転３自由度のどの自由度を検出手段により検出し、アクチュエータを動作させるかは任意である。例えば、検出手段による検出は、挿入方向に対し直交する軸回り２自由度であってもよい。

また、受動機構の変位は、並進３自由度のうちどの自由度であってもよい。例えば、受動機構の変位は、挿入方向に対し直交する並進軸２自由度であってもよい。

〔構成２〕
構成１を有する組立装置において、保持台に設けられ受動機構の変位を計測して検出結果を制御手段に送る変位センサを備え、制御手段は、把持手段が凹部または孔に凸部または棒状部材を挿入させようとしたときに、凸部または棒状部材の先端部と凹部または孔の周囲部とが当接した場合に、保持台に固定された部材が受ける並進力により受動機構が変位されて凸部または棒状部材が凹部または孔に挿入されたときの受動機構の変位量を記録し、次に把持手段が凹部または孔に凸部または棒状部材を挿入させるときに、記録された受動機構の変位量に応じて、把持手段を制御して、凸部または棒状部材を凹部または孔に挿入させることを特徴とするものである。

〔構成３〕
構成２を有する組立装置において、制御手段は、保持台に固定される部材を該保持台に固定する前の受動機構の変位量を記録するとともに、保持台に固定される部材を該保持台に固定した後の該部材の重心の偏りによって生じた受動機構の変位量を記録しておき、把持手段が凹部または孔に凸部または棒状部材を挿入させるときに、記録された保持台に固定された部材の搭載前後の受動機構の変位量の差にも応じて把持手段を制御することを特徴とするものである。

すなわち、保持台に固定された部材に重心の偏りがあると、保持台に当該部材を載せただけで受動機構が変位するので，載せる前と後との受動機構の変位を計測しておき，載せたことによって受動機構が変位した分だけ、把持手段の動作開始点を変更し、さらに、棒状部材が孔に挿入されたときの受動機構の変位量に基づいて、把持手段を制御するものである。

〔構成４〕
構成１を有する組立装置において、保持台に設けられ、受動機構の変位を計測して検出結果を制御手段に送る変位センサを備え、制御手段は、保持台に固定される部材を該保持台に固定する前の受動機構の変位量を記録するとともに、保持台に固定される部材を該保持台に固定した後の該部材の重心の偏りによって生じた受動機構の変位量を記録しておき、把持手段が凹部または孔に凸部または棒状部材を挿入させるときに、記録された保持台に固定された部材の搭載前後の受動機構の変位量の差に応じて把持手段を制御して、凸部または棒状部材を凹部または孔に挿入させることを特徴とするものである。

すなわち、保持台に固定された部材に重心の偏りがあると、保持台に当該部材を載せただけで受動機構が変位するので，載せる前と後との受動機構の変位を計測しておき，載せたことによって受動機構が変位した分だけ、把持手段の動作開始点を変更するものである。

本発明に係る組立装置においては、構成１を有することにより、把持手段が凹部または孔に凸部または棒状部材を挿入させようとしたときに、凸部または棒状部材の先端部と凹部または孔の周囲部とが当接した場合に、保持台に固定された部材が受ける並進力により、受動機構が変位されるとともに、制御手段は、検出手段により検出されたモーメントに基づき、アクチュエータにより保持台を移動操作させ、凸部または棒状部材を凹部または孔に挿入させるので、凸部または棒状部材と凹部または孔との相対位置を迅速に修正して、凸部または棒状部材の凹部または孔への挿入を完了することができる。

この組立装置においては、把持手段（ロボットアーム）としては受動機構等の特別の機構を有しない任意の把持手段を用いることができるので、把持手段の可搬重量や可動範囲が制限されることがない。また、アクチュエータの制御周期や位置精度を把持手段よりも高性能のものとすることにより、把持手段のみを制御する場合よりも高速、かつ、高精度の組立を行うことができる。また、この組立装置においては、把持手段に受動機構を設ける必要がないので、任意の方向の組立（挿入）を行うことができる。

この組立装置においては、保持台に固定された部材が受ける並進力の方向については、受動機構（バネやダンパ）の固さに応じて、受けた並進力に対する位置が変位するだけなので、固定パラメータの受動機構を用いても、多品種に対応することができる。受動機構を用いることにより、構造を簡素化し、製造コストを抑えながら、高速の応答が可能となる。

そして、検出手段により検出されるモーメントについては、アクチュエータを用いることにより、回転中心を任意の場所に移動させることができるので、多品種に対応することができる。アクチュエータの移動角度は、座標系の教示などによって校正することが容易であり、補正する角度の値は小さいので、検出手段及びアクチュエータの応答性が良好でない場合であっても、十分な補正が可能である。

さらに、この組立装置において、アクチュエータには、任意の軸に対して任意の特性を持たせることができ、組立作業によって特性を変更したり、アクチュエータの弾性的な移動をなくすこともできる。例えば、組立（挿入）時には変位が大きくなっても過大な力がかからないようダンパ要素のみを持たせ、組立（挿入）後にばね要素を加えて原点に戻すなどの動作も容易に行うことができる。

そして、本発明に係る組立装置においては、構成２を有することにより、制御手段は、把持手段が凹部または孔に凸部または棒状部材を挿入させようとしたときに、凸部または棒状部材の先端部と凹部または孔の周囲部とが当接した場合に、保持台に固定された部材が受ける並進力及び／又はモーメントにより受動機構が変位されて凸部または棒状部材が凹部または孔に挿入されたときの受動機構の変位量を記録し、次に把持手段が凹部または孔に凸部または棒状部材を挿入させるときに、記録された受動機構の変位量に応じて把持手段を制御して、凸部または棒状部材を凹部または孔に挿入させるので、凸部または棒状部材と凹部または孔との相対位置が迅速に修正され、凸部または棒状部材の凹部または孔への挿入を完了することができる。

この組立装置においても、把持手段としては受動機構等の特別の機構を有しない任意の把持手段を用いることができるので、把持手段の可搬重量や可動範囲が制限されることがない。また、この組立装置においては、把持手段に受動機構が設けられていないので、任意の方向の組立（挿入）を行うことができる。

さらに、本発明に係る組立装置においては、構成３を有することにより、制御手段は、保持台に固定される部材を該保持台に固定する前の受動機構の変位量を記録するとともに、保持台に固定される部材を該保持台に固定した後の該部材の重心の偏りによって生じた受動機構の変位量を記録しておき、把持手段が凹部または孔に凸部または棒状部材を挿入させるときに、記録された該部材の搭載前後の受動機構の変位量の差にも応じて把持手段を制御するので、保持台に固定される部材に重心の偏りがあり、保持台に当該部材を載せただけで受動機構が変位する場合においても、載せたことによる受動機構の変位分だけ、把持手段の動作開始点が変更され、さらに、凸部または棒状部材が凹部または孔に挿入されたときの受動機構の変位量に基づいて、把持手段が制御されるので、凸部または棒状部材と凹部または孔との相対位置が迅速に修正され、凸部または棒状部材の凹部または孔への挿入を完了することができる。

さらに、本発明に係る組立装置においては、構成４を有することにより、制御手段は、保持台に固定される部材を該保持台に固定する前の受動機構の変位量を記録するとともに、保持台に固定される部材を該保持台に固定した後の該部材の重心の偏りによって生じた受動機構の変位量を記録しておき、把持手段が凹部または孔に凸部または棒状部材を挿入させるときに、記録された該部材の搭載前後の受動機構の変位量の差に応じて把持手段を制御して、凸部または棒状部材を凹部または孔に挿入させるので、保持台に固定される部材に重心の偏りがあり、保持台に当該部材を載せただけで受動機構が変位する場合においても、載せたことによる受動機構の変位分だけ、把持手段の動作開始点が変更され、凸部または棒状部材と凹部または孔との相対位置が迅速に修正され、凸部または棒状部材の凹部または孔への挿入を完了することができる。

すなわち、本発明は、部材の移動操作の精度を特段に向上させる必要を生ずることなく、凸部または棒状部材の凹部または孔への挿入を短時間で完了することができ、さらに、把持手段の可搬重量や可動範囲が制限されることのない組立装置を提供することができるものである。

本発明に係る組立装置の第１の実施の形態における構成を示す側面図である。本発明に係る組立装置の第１の実施の形態において、前回の挿入操作における検出値を反映した組立作業を示す側面図である。本発明に係る組立装置の第２の実施の形態における構成を示す側面図である。本発明に係る組立装置の第２の実施の形態において、前回の挿入操作における検出値を反映した組立作業を示す側面図である。本発明に係る組立装置の第３の実施の形態において、動作の対象となる凹部が設けられた部材及び凸部が設けられた部材の形状を示す斜視図である。

以下、本発明を実施するための形態について図面を参照して説明する。

〔第１の実施の形態における組立装置の構成〕
図１は、本発明に係る組立装置の第１の実施の形態における構成を示す側面図である。

本発明に係る組立装置は、図１に示すように、把持手段となるロボットアーム１、制御手段３及び保持台４を有して構成されている。ロボットアーム１は、凹部が設けられた部材である孔が設けられた部材（以下、「孔部品」という。）１０１または凸部が設けられた部材である棒状部材（以下、「軸部品」という。）１０２のいずれかを保持治具１ａを介して把持し、移動操作する。この実施の形態においては、ロボットアーム１は、孔部品１０１を把持するようになっている。また、この組立装置においては、保持台４には、軸部品１０２または孔部品１０１が固定される。この実施の形態においては、保持台４には、保持治具４ａを介して軸部品１０２が固定される。

この組立装置においては、ロボットアーム１は、把持した孔部品１０１を移動操作し、この孔部品１０１の孔１０３に、図１中矢印で示す挿入方向に、軸部品１０２を挿入させる。

保持台４には、には、この保持台４が軸部品１０２を介して受ける挿入方向に直交する軸回りのモーメントを計測する検出手段として、力覚センサ２が設けられている。この力覚センサ２は、ロボットアーム１が軸部品１０２を孔１０３に挿入させようとしたときに、軸部品１０２の先端部と孔１０３の周囲部とが当接した場合に、軸部品１０２を介して保持台４が受ける挿入方向に直交する軸周りのモーメントを検出する。

なお、力覚センサ２は、回転３自由度のどの自由度を検出するものであってもよい。例えば、力覚センサ２は、挿入方向に対し直交する並進軸２自由度及びこれらの軸回り２自由度を検出するものでであってもよい。

そして、保持台４には、この保持台４を挿入方向に直交する軸周りの回転方向に移動操作するアクチュエータ５ａが設けられている。

この組立装置においては、力覚センサ２からの検出出力は、制御手段３の演算装置３ａに送られる。この制御手段３は、演算装置３ａと、制御手段３ｂとから構成されている。演算装置３ａは、力覚センサ２により検出されたモーメントに基づき、保持台４が受けた力に倣ってアクチュエータ５ａを動作させるための倣い動作信号（移動角度及び角速度）を生成する。アクチュエータ５ａは、倣い動作信号に応じて動作する。また、倣い動作信号は、制御手段３ｂに送られる。

また、保持台４には、この保持台４を挿入方向に直交する方向に弾性的に移動可能に支持する受動機構５ｂが設けられている。この受動機構５ｂは、ロボットアーム１が孔１０３に軸部品１０２を挿入させようとしたときに、軸部品１０２の先端部と孔１０３の周囲部とが当接した場合に、軸部品１０２（保持台４に固定された部材）が受ける挿入方向の並進力により変位される。

演算装置３ａによって行なわれる処理は、力覚センサ２により取得された力覚情報から、アクチュエータ５ａの動作指令を生成することである。力覚センサ２が計測する力覚の軸数は、アクチュエータ５ａの制御に用いる軸数となるが、ここでは、図１に示すｘ軸周りのロール（Roll）及びｙ軸周りのピッチ（Pitch）の２軸について説明する。

力覚センサ２により計測されたモーメントをＦｉ、アクチュエータ５ａへの指令角速度をｖｉとする。ここで、ｉは、ｘ軸周りのロール及びｙ軸周りのピッチのいずれかを示す。

この組立装置において、アクチュエータ５ａにより仮想的なダンパを構成するためには、２軸それぞれに対して、指令角速度を以下のように定めればよい。なお、ここで、Ｄｉは、仮想粘性係数である。
ｖｉ＝−Ｆｉ／Ｄｉ

また、この組立装置において、アクチュエータ５ａにより仮想的なダンパを構成する上で、目標の力（押し付け力など）を設定するためには、２軸それぞれに対して、指令角速度を以下のように定めればよい。なお、ここで、Ｆｄｉは、目標の力である。
ｖｉ＝−（Ｆｉ−Ｆｄｉ）／Ｄｉ

さらに、この組立装置において、アクチュエータ５ａにより仮想的なインピーダンス（バネ、マス、ダンパ）を構成するためには、２軸それぞれについて、以下に示す微分方程式を解けばよい。なお、ここで、変数の肩の「′」は、時間による微分を示し、〔ｘｉ′（角度の微分）＝ｖｉ（角速度）〕である。また、Ｍｉ、Ｄｉ、Ｋｉは、それぞれ仮想重量、仮想粘性、仮想バネ係数を示す。
Ｍｉ×ｘｉ′′＋Ｄｉ×ｘｉ′＋Ｋｉ×ｘｉ＝Ｆｉ

これらの方法により角速度ｖｉを求め、アクチュエータ５ａを駆動させる。アクチュエータ５ａが角度入力を必要とする場合には、角速度ｖｉを積分した値を角度情報として入力し、また、トルクの入力を必要とする場合には、アクチュエータ５ａの角速度が角速度ｖｉと一致するような制御系を構成して、トルクｔｉを求めればよい。

〔第１の実施の形態における組立装置の動作〕
この組立装置においては、ロボットアーム１が孔１０３に軸部品１０２を挿入させようとしたときに、軸部品１０２の先端部と孔１０３の周囲部とが当接しても、受動機構５ｂが迅速に変位し、また、力覚センサ２により検出されたモーメントに基づき、保持台４が受けた力に倣ってアクチュエータ５ａが動作するので、孔１０３と軸部品１０２とが倣い、軸部品１０２を孔１０３に迅速、かつ、確実に挿入することができる。

図２は、本発明に係る組立装置の第１の実施の形態において、前回の挿入操作における検出値を反映した組立作業を示す側面図である。

この組立装置においては、図２中の（ａ）に示すように、保持台４の傾きを変更しない場合において、孔部品１０１と軸部品１０２との間に毎回同じだけの傾きが想定される場合には、この傾きに対応したアクチュエータ５ａの移動量の情報を保存しておき、図２中の（ｂ）に示すように、この移動量の情報に基づいてロボットアーム１を制御することにより、アクチュエータ５ａを駆動しなくとも、孔部品１０１と軸部品１０２とを組立てることができる。

また、この組立装置において、受動機構５ｂの変位は、ロボットアーム１が孔１０３に軸部品１０２を挿入させようとしたときに、軸部品１０２の先端部と孔１０３の周囲部とが当接した場合に、軸部品１０２（保持台４に固定された部材）が受ける挿入方向の並進力によるものである。

すなわち、孔部品１０１と軸部品１０２との間の傾き（角度ずれ）に対応したアクチュエータ５ａの傾き量の情報を制御手段３ｂに送信し、この制御手段３ｂにより、ロボットアーム１の動作に、アクチュエータ５ａの傾き量に対応した傾き量を加算して制御することによって、アクチュエータ５ａを駆動させずに、孔部品１０１と軸部品１０２とを組立てることができる。

例えば、最初の組立作業において、アクチュエータ５ａをｘ軸回りに２°、ｙ軸回りに１°傾けて組立作業が完了したとする。そして、次に組立作業を行うときには、ロボットアーム１を、ｘ軸回りに−２°、ｙ軸回りに−１°傾ける制御を行うことにより、挿入時に各部品１０１，１０２にかかる力を減らすことができ、より高速、かつ、部品に無理な力をかけずに組立作業を完了することができる。このとき、受動機構５ｂは、軸部品１０２の先端部と孔１０３の周囲部とが当接した場合に、軸部品１０２（保持台４に固定された部材）が受ける挿入方向の並進力に応じて変位し、軸部品１０２が孔１０３に挿入されるようにする。

〔第２の実施の形態における組立装置の構成〕
図３は、本発明に係る組立装置の第２の実施の形態における構成を示す側面図である。

この組立装置においては、図３に示すように、保持台４に、この保持台４の変位量（すなわち、受動機構５ｂの変位量）を計測する変位センサ７を設けてもよい。この変位センサ７は、ロボットアーム１が軸部品１０２を孔１０３に挿入させようとしたときに、軸部品１０２の先端部と孔１０３の周囲部とが当接した場合に、保持台４が受ける挿入方向の並進力に応じた受動機構５ｂの変位を検出する。

この組立装置においては、変位センサ７からの検出出力は、データ収集装置６によって収集され、制御手段３に送られる。制御手段３は、変位センサ７により検出された受動機構５ｂの変位量に基づき、ロボットアーム１を制御する。

〔第２の実施の形態における組立装置の動作〕
この組立装置においても、ロボットアーム１が孔１０３に軸部品１０２を挿入させようとしたときに、軸部品１０２の先端部と孔１０３の周囲部とが当接しても、受動機構５ｂが迅速に変位し、また、力覚センサ２により検出されたモーメントに基づき、保持台４が受けた力に倣ってアクチュエータ５ａが動作するので、孔１０３と軸部品１０２とが倣い、軸部品１０２を孔１０３に迅速、かつ、確実に挿入することができる。

図４は、本発明に係る組立装置の第２の実施の形態において、前回の挿入操作における検出値を反映した組立作業を示す側面図である。

この組立装置においては、図４中の（ａ）に示すように、孔部品１０１と軸部品１０２との間に毎回同じだけの位置ずれが想定され、その度に受動機構５ｂが変位される場合には、この位置ずれに対応した受動機構５ｂの変位量の情報を保存しておき、図４中の（ｂ）に示すように、この変位量の情報に基づいてロボットアーム１を制御することにより、受動機構５ｂを変位させずに、孔部品１０１と軸部品１０２とを組立てることができる。

すなわち、孔部品１０１と軸部品１０２との間の位置ずれに対応した受動機構５ｂの変位量の情報を制御手段３に送信し、この制御手段３により、ロボットアーム１の動作に、受動機構５ｂの変位量の情報に対応した変位量を加算して制御することによって、受動機構５ｂを変位させずに、孔部品１０１と軸部品１０２とを組立てることができる。

例えば、最初の組立作業において、受動機構５ｂがｘ方向に２ｍｍ、ｙ方向に１ｍｍ変位されて組立作業が完了したとする。そして、次に組立作業を行うときには、ロボットアーム１を、ｘ方向に−２ｍｍ、ｙ方向に−１ｍｍずれた場所を目標位置として制御することにより、挿入時に各部品１０１，１０２にかかる力を減らすことができ、より高速、かつ、部品に無理な力をかけずに組立作業を完了することができる。

なお、本発明に係る組立装置において、受動機構５ｂがダンパ要素のみを持つものである場合には、組立作業が完了した後、この受動機構５ｂは、変位したままとなる。これを初期状態に戻すためには、テーパピンなどにより保持台４を初期位置に戻す構成や、あるいは、変位センサ７により計測された変位量だけ、ロボットアーム１により保持台４を押し戻すことが考えられる。

さらに、この組立装置においては、制御手段３は、保持台４に固定される部材（孔部品１０１または軸部品１０２）を固定する前の受動機構５ｂの変位量を記録するとともに、保持台４に固定される部材（孔部品１０１または軸部品１０２）を保持台４に固定した後の当該部材の重心の偏りによって生じた受動機構５ｂの変位量を記録しておくようにしてもよい。

そして、ロボットアーム１が孔１０３に軸部品１０２を挿入させるときに、記録された保持台４に固定される部材（孔部品１０１または軸部品１０２）の搭載前後の受動機構５ｂの変位量の差に応じてロボットアーム１を制御して、軸部品１０２を孔１０３に挿入させるようにしてもよい。

すなわち、保持台４に固定される部材に重心の偏りがあると、保持台４に当該部材を載せただけで受動機構５ｂが変位するので，載せる前と後との受動機構５ｂの変位を計測しておき，載せたことによって受動機構５ｂが変位した分だけ、ロボットアーム１の動作開始点を変更することにより、軸部品１０２と孔１０３との相対位置が迅速に修正され、軸部品１０２の孔１０３への挿入を完了することができる。

さらに、この組立装置においては、制御手段３は、保持台４に固定される部材（孔部品１０１または軸部品１０２）を保持台４に固定する前後の当該部材の重心の偏りによって生じた受動機構５ｂの変位量を記録しておくとともに、受動機構５ｂが変位されて軸部品１０２が孔１０３に挿入されたときの受動機構５ｂの変位量も記録し、次にロボットアーム１が孔１０３に軸部品１０２を挿入させるときに、記録された受動機構５ｂの変位量に応じて、ロボットアーム１を制御するようにしてもよい。

すなわち、保持台４に固定される部材（孔部品１０１または軸部品１０２）に重心の偏りがあると、保持台４に当該部材を載せただけで受動機構５ｂが変位するので，載せる前と後との受動機構５ｂの変位を計測しておき，載せたことによって受動機構５ｂが変位した分だけ、ロボットアーム１の動作開始点を変更し、さらに、軸部品１０２が孔１０３に挿入されたときの受動機構５ｂの変位量に基づいて、ロボットアーム１を制御することにより、軸部品１０２と孔１０３との相対位置が迅速に修正され、軸部品１０２の孔１０３への挿入を完了することができる。

〔第３の実施の形態における組立装置の構成〕
本発明に係る組立装置においては、力覚センサ２は、状況に応じて、保持台４にではなく、ロボットアーム１の先端側に設けるようにしてもよい。すなわち、力覚センサ２は、より計測レンジの狭い小型な力覚センサで足りる側に設ければよい。また、力覚センサ２は、ロボットアーム１及び保持台４のうち、孔部品１０１を保持する側に設けることが望ましい。

すなわち、本発明に係る組立装置においては、力覚センサ２及び受動機構５ｂを保持台４に設ける構成（第１の実施の形態）の他に、力覚センサ２をロボットアーム１の先端側に設け受動機構５ｂを保持台４に設ける構成の２通りの構成が考えられる。

図５は、本発明に係る組立装置の第３の実施の形態において、動作の対象となる凹部が設けられた部材及び凸部が設けられた部材の形状を示す斜視図である。

また、本発明に係る組立装置においては、動作の対象となる凹部が設けられた部材としては、図５に示すように、前述のような孔部品１０１に限定されず、また、凸部が設けられた部材としては、前述のような軸部品１０２に限定されない。

すなわち、凹部が設けられた部材及び凸部が設けられた部材は、図５中の（ａ）に示すように、複数の凹部１０３ａ及び複数の凸部１０２ａを有する部材であってもい。

また、凹部が設けられた部材及び凸部が設けられた部材は、図５中の（ｂ）に示すように、矩形の凹部１０３ｂ及び矩形の凸部１０２ｂを有する部材であってもい。

さらに、凹部が設けられた部材及び凸部が設けられた部材は、図５中の（ｃ）に示すように、溝状の凹部１０３ｃ及び突条１０２ｃを有する部材であってもい。

本発明は、凹部または孔が設けられた部材（孔部品）と、凸部を有する部材または棒状部材（軸部品）とのいずれかを把持して移動操作し、凹部または孔が設けられた部材の凹部または孔に、凸部または棒状部材を挿入させる組立装置に適用される。

１ロボットアーム（把持手段）
２力覚センサ
３制御手段
４保持台
５ａアクチュエータ
５ｂ受動機構
７変位センサ
１０１孔部品
１０２軸部品
１０３孔

Claims

凹部または孔が設けられた部材と、凸部を有する部材または棒状部材とのいずれか一方を把持して移動操作し、前記凹部または孔に前記凸部または棒状部材を挿入させる把持手段と、
前記凹部または前記孔が設けられた部材と、前記凸部を有する部材または前記棒状部材との他方を保持する保持台と、
前記把持手段または前記保持台に設けられ、前記把持手段が前記凹部または前記孔に前記凸部または前記棒状部材を挿入させようとしたときに、前記凸部または前記棒状部材の先端部と前記凹部または前記孔の周囲部とが当接した場合に、前記凹部または前記孔が設けられた部材または前記凸部を有する部材または前記棒状部材を介して保持台が受ける挿入方向に直交する軸回りのモーメントを検出する検出手段と、
前記保持台を前記挿入方向に直交する軸回りの回転方向に移動操作するアクチュエータと、
前記検出手段により検出されたモーメントに基づく演算を行い、この演算結果に応じてアクチュエータを制御する制御手段と、
前記保持台を前記挿入方向に直交する方向に移動可能に支持する受動機構と
を備え、
前記把持手段が前記凹部または前記孔に前記凸部または前記棒状部材を挿入させようとしたときに、前記凸部または前記棒状部材の先端部と前記凹部または前記孔の周囲部とが当接した場合に、前記保持台に固定された部材が受ける並進力により、前記受動機構が変位され、
前記制御手段は、前記検出手段により検出されたモーメントに基づき、前記アクチュエータにより前記保持台を移動操作させ、前記凸部または前記棒状部材を前記凹部または前記孔に挿入させる
ことを特徴とする組立装置。
前記保持台に設けられ、前記受動機構の変位を計測して検出結果を前記制御手段に送る変位センサを備え、
前記制御手段は、前記把持手段が前記凹部または前記孔に前記凸部または前記棒状部材を挿入させようとしたときに、前記凸部または前記棒状部材の先端部と前記凹部または前記孔の周囲部とが当接した場合に、前記保持台に固定された部材が受ける並進力により前記受動機構が変位されて前記凸部または前記棒状部材が前記凹部または前記孔に挿入されたときの前記受動機構の変位量を記録し、次に前記把持手段が前記凹部または前記孔に前記凸部または前記棒状部材を挿入させるときに、記録された受動機構の変位量に応じて、前記把持手段を制御して、前記凸部または前記棒状部材を前記凹部または前記孔に挿入させる
ことを特徴とする請求項１記載の組立装置。
前記制御手段は、前記保持台に固定される部材を該保持台に固定する前の前記受動機構の変位量を記録するとともに、前記保持台に固定される部材を該保持台に固定した後の該部材の重心の偏りによって生じた前記受動機構の変位量を記録しておき、前記把持手段が前記凹部または前記孔に前記凸部または前記棒状部材を挿入させるときに、記録された前記保持台に固定された部材の搭載前後の前記受動機構の変位量の差にも応じて前記把持手段を制御する
ことを特徴とする請求項２記載の組立装置。
前記保持台に設けられ、前記受動機構の変位を計測して検出結果を前記制御手段に送る変位センサを備え、
前記制御手段は、前記保持台に固定される部材を該保持台に固定する前の前記受動機構の変位量を記録するとともに、前記保持台に固定される部材を該保持台に固定した後の該部材の重心の偏りによって生じた前記受動機構の変位量を記録しておき、前記把持手段が前記凹部または前記孔に前記凸部または前記棒状部材を挿入させるときに、記録された前記保持台に固定された部材の搭載前後の前記受動機構の変位量の差に応じて前記把持手段を制御して、前記凸部または前記棒状部材を前記凹部または前記孔に挿入させる
ことを特徴とする請求項１記載の組立装置。