JP2013094951A

JP2013094951A - 把持装置及びロボット

Info

Publication number: JP2013094951A
Application number: JP2011243127A
Authority: JP
Inventors: Ikuo Takeda; 郁夫武田
Original assignee: Fujitsu Ltd
Current assignee: Fujitsu Ltd
Priority date: 2011-11-07
Filing date: 2011-11-07
Publication date: 2013-05-20
Anticipated expiration: 2031-11-07
Also published as: JP5929105B2

Abstract

【課題】比較的簡単な構成で把持した部品と他の部品との接触具合を検出できる把持装置、及びその把持装置を備えたロボットを提供する。
【解決手段】把持装置２６は、それぞれ２本の指部を有する一対のハンド部材３１と、ハンド部材３１を相互に近接又は離隔する方向に移動させて第１の部品を把持するハンド部材駆動部２７と、指部の内側及び外側の面にそれぞれ配置された複数の歪みセンサと、制御部２９とを有する。制御部２９は、歪みセンサの出力から第１の部品と第２の部品との接触具合を検出する
【選択図】図３

Description

本発明は、把持装置及びロボットに関する。

産業用ロボットは、重量物又は危険物を扱う作業や、高精度の位置決めが必要な作業を中心に導入されてきた。一方、弾力性を有する部品や破損しやすい部品を扱う組み立て作業はロボットによる自動化が難しいことが多く、人間の手に頼っていることが多い。

近年、主にコスト削減のために、弾力性を有する部品や破損しやすい部品を扱う組み立て作業など、ロボットが苦手とする分野までロボットを導入することが検討されている。そのような作業には、複雑な動きができる多関節ロボットが適しているといわれている。しかし、単に多関節ロボットを使えば人間と同じように作業が行えるわけではない。

人間の場合は部品同士の接触具合を指先で感じながら作業を行っており、同じことがロボットにも求められる。そこで、ロボットによって部品同士の接触具合を検出するために、例えば多軸力覚センサを搭載することが提案されている。

特開２００６−６４４０８号公報

比較的簡単な構成で把持した部品と他の部品との接触具合を検出できる把持装置、及びその把持装置を備えたロボットを提供することを目的とする。

開示の技術の一観点によれば、それぞれ２本の指部を有する一対のハンド部材と、前記ハンド部材を相互に近接又は離隔する方向に移動させて第１の部品を把持するハンド部材駆動部と、前記指部の内側及び外側の面にそれぞれ配置された複数の歪みセンサと、前記歪みセンサの出力から前記第１の部品と第２の部品との接触具合を検出する制御部とを有する把持装置が提供される。

開示の技術の他の一観点によれば、アームと、前記アームに連結されて第１の部品を把持する把持部と、前記アームを制御して前記把持部を移動させる制御部と有し、前記把持部は、それぞれ２本の指部を有する一対のハンド部材と、前記ハンド部材を相互に近接又は離隔する方向に移動させるハンド部材駆動部と、前記指部の内側及び外側の面にそれぞれ配置された複数の歪みセンサとを備え、前記制御部は前記歪みセンサの出力から前記第１の部品と第２の部品との接触具合を検出するロボットが提供される。

上記一観点に係る把持装置及びロボットによれば、第１の部品と第２の部品との接触具合を歪みセンサにより検出する。それらの歪みセンサは、指部の内側及び外側の面に配置されているので、高速で移動させても大きな慣性力が加わることはなく、破損するおそれが少ない。また、簡単な構成で第１の部品と第２の部品との接触具合を検出することができる。

図１は、多軸力覚センサを備えた多関節ロボットの一例を表した図である。図２は、ロボットにより行う作業の一例を説明する図である。図３は、第１の実施形態に係るロボットの一例を表した図である。図４は、第１の実施形態に係るロボットのハンド部材を示す斜視図である。図５は、同じくそのハンド部材の正面図である。図６は、歪みセンサの接続状態を説明する図（その１）である。図７は、歪みセンサの接続状態を説明する図（その２）である。図８（ａ），（ｂ）は、部品を挟持したハンド部材を示す図である。図９（ａ），（ｂ）は、第１の部品を第２の部品の凹部に挿入するときの状態を説明する図である。図１０は、第１の実施形態に係るロボットの動作を説明するフローチャートである。図１１は、Ｘ軸方向、Ｙ軸方向、Ｚ軸方向を規定する図である。図１２（ａ），（ｂ）は、角度θzの補正方法を説明する図である。図１３は、角度θyの補正方法を説明する図（その１）である。図１４は、角度θyの補正方法を説明する図（その２）である。図１５は、第１の部品を把持した状態で第１の部品に上向きの応力が加えられた状態を示す図である。図１６は、Ｘ軸方向の補正方法を説明する図である。図１７は、第２の実施形態に係るロボット（把持装置）の指部を示す模式図である。

以下、実施形態について説明する前に、実施形態の理解を容易にするための予備的事項について説明する。

図１は、多軸力覚センサを備えた多関節ロボットの一例を表した図である。

この図１に例示した多関節ロボット１０は、台座部１１と、旋回支持部１２と、第１のリンク部１３と、第２のリンク部１４と、第３のリンク部１５と、多軸力覚センサ１６と、把持部（ハンド）１７と、制御部１９とを有する。

台座部１１は、作業場の床等に固定されている。旋回支持部１２は、台座部１１の上に、垂直方向の軸を中心に旋回可能に配置されている。

第１のリンク部１３の一端側は旋回支持部１２の上部に連結しており、ギヤドモータ又はエアシリンダー等の駆動装置（図示せず）により旋回支持部１２との連結部を中心に回転する。また、第２のリンク部１４の一端側は第１のリンク部１３の他端側に連結しており、駆動装置（図示せず）により第１のリンク部１３との連結部を中心に回転する。更に、第３のリンク部１５の一端側は第２のリンク部１４の他端側に連結しており、駆動装置（図示せず）により第２のリンク部１４との連結部を中心に回転する。

把持部１７は、多軸力覚センサ１６を介して第３のリンク部１５の他端側に連結している。この把持部１７は、駆動装置（図示せず）により第３のリンク部１５の中心軸に平行な軸を中心として回転する。また、把持部１７は２本の指部１７ａを有し、駆動装置（図示せず）により駆動されてそれらの指部１７ａ間の間隔が変化し、指部１７ａ間に部品を把持したり、把持していた部品を離したりする。

多軸力覚センサ１６は、例えば複数の歪みゲージを有し、把持部１７に印加される３軸（相互に直交するＸ軸、Ｙ軸及びＺ軸）方向の応力を検出して制御部１９に出力する。制御部１９は、予め設定されたプログラムと多軸力覚センサ１６の出力とに基づいて、各駆動装置を制御する。

このような多関節ロボットを用いて細長い部品、例えば図２のように幅が数ｍｍ程度、厚さが２ｍｍ〜５ｍｍ程度、長さが１５ｍｍ〜３０ｍｍ程度のゴム製の第１の部品６１をプラスチック等により形成された第２の部品６２の凹部６２ａにはめ込む作業を行うものとする。この場合、第１の部品６１と第２の部品６２との接触具合を検出して把持部１７の位置及び角度を補正することが重要であり、多軸力覚センサ１６には高い感度が要求される。通常、多軸力覚センサ１６の感度は歪みゲージを貼付する金属部品の厚さに関係し、金属部品の厚さを薄くすれば感度は高くなる。

一方、多関節ロボット１０では、作業効率を上げようとして旋回支持部１２及びリンク部１３，１４，１５を高速で動かすと、把持部１７の質量に応じた大きな慣性力が多軸力覚センサ１６に加わる。このため、多軸力覚センサ１６（特に、歪みゲージを貼付した金属部品）が破損するおそれがある。また、作業中にリンク部１３，１４，１５又は把持部１７が何らかの障害物に衝突して多軸力覚センサ１６に大きな力が加わり、多軸力覚センサ１６が破損するおそれもある。

このため、多軸力覚センサ１６には、強度が高いことが要求される。しかし、一般的に、強度が高い多軸力覚センサ１６は感度が低く、前述したような組み立て作業において部品同士の接触具合を検出することは困難である。

以下の実施形態では、比較的簡単な構成で把持した部品と他の部品との接触具合を検出できる把持装置、及びその把持装置を備えたロボットについて説明する。

（第１の実施形態）
図３は、第１の実施形態に係るロボットの一例を表した図である。この図３のように、本実施形態に係るロボット２０は、台座部２１と、旋回支持部２２と、第１のリンク部２３と、第２のリンク部２４と、第３のリンク部２５と、把持部２６と、制御部２９とを有する。なお、把持装置は、把持部２６と制御部２９とにより構成される。

台座部１１は、作業場の床等に固定されている。旋回支持部２２は、台座部２１の上に、垂直方向の軸を中心に旋回可能に配置されている。

第１のリンク部２３の一端側は旋回支持部２２の上部に連結しており、ギアドモータ又はエアシリンダー等の駆動装置（図示せず）により旋回支持部２２との連結部を中心に回転する。また、第２のリンク部２４の一端側は第１のリンク部２３の他端側に連結しており、駆動装置（図示せず）により第１のリンク部２３との連結部を中心に回転する。更に、第３のリンク部２５の一端側は第２のリンク部２４の他端側に接続されており、駆動装置（図示せず）により第２のリンク部２４との連結部を中心に回転する。第１のリンク部２３、第２のリンク部２４及び第３のリンク部２５は、把持装置２６を任意の位置に移動させるためのアームである。

把持部２６は、第３のリンク部２５の他端側に連結している。この把持部２６は、駆動装置（図示せず）により第３のリンク部２５の中心軸に平行な軸を中心として回転する。

また、把持部２６には、一対のハンド部材３１と、それらのハンド部材３１を相互に近接又は離隔する方向に移動させるハンド部材駆動部２７と、後述する歪みセンサ３７に接続された歪みゲージアンプ２８とが設けられている。

図４はハンド部材３１を示す斜視図であり、図５は同じくその正面図である。

図４のように、把持部２６には一対のハンド部材３１が設けられており、各ハンド部材３１は２本のボルト３９によりハンド部材駆動部２７（図３参照）に連結されている。また、各ハンド部材３１は、ボルト３９が挿通する穴が設けられた固定部３２と、固定部３２から導出する２本の指部３３とを有する。ハンド部材駆動部２７により一対のハンド部材３１が相互に近接又は離隔する方向に移動することで、指部３３の先端で部品を把持したり、把持していた部品を離したりする。

指部３３は、図５のように、把持すべき部品に接触する接触部３４と、接触部３４と固定部３２との間を連絡する連絡部３５とを有する。本実施形態では、固定部３２と連絡部３５とのなす角度がほぼ９０度であり、連絡部３５と接触部３４とのなす角度は９０度よりも若干大きく設定されている。

なお、ハンド部材３１は例えば厚さが１．５ｍｍのステンレス板により形成されており、指部３３の幅は例えば５．５ｍｍ、固定部３２の長さは例えば８ｍｍ、接触部３４の長さは例えば１１ｍｍ、連絡部３５の長さは例えば８ｍｍである。また、本実施形態では、図４のように各ハンド部材３１の２本の指部３３（接触部３４）が補強部３６により連結されており、これにより部品を把持したときの指部３３のねじれを防止している。しかし、補強部３６は必要に応じて設ければよく、補強部３６がなくてもよい。

連絡部３５の内側及び外側の面にはそれぞれ連絡部３５の歪みを検出する歪みセンサ３７が配置されている。これと同様に、接触部３４の外側の面にはそれぞれ接触部３４の歪みを検出する歪みセンサ３７が配置されている。これらの歪みセンサ３７は、歪みゲージアンプ２８を介して制御部２９に接続されている。本実施形態では、歪みセンサ３７として、歪みにより抵抗値が変化する歪みゲージを使用している。

図６，図７は、各歪みセンサ３７の接続状態を説明する図である。ここでは、説明の便宜上、図６における紙面手前側の接触部３４及び連絡部３５を第１の接触部３４ａ及び第１の連絡部３５ａと呼び、紙面奥側の接触部３４及び連絡部３５を第２の接触部３４ｂ及び第２の連絡部３５ｂと呼ぶ。

図６のように、各ハンド部材３１の第１の連絡部３５ａ及び第２の連絡部３５ｂの外側にそれぞれ配置された４個の歪みセンサ３７により、ホイートストンブリッジ回路４１ａが形成されている。このホイートストンブリッジ回路４１ａは、第３のホイートストンブリッジ回路の一例である。

ここでは、一方のハンド部材（図６中の左側のハンド部材３１）の第１の連絡部３５ａ及び第２の連絡部３５ｂの外側に配置された歪みセンサ３７の抵抗値をＲ１，Ｒ２とする。また、他方のハンド部材（図６中の右側のハンド部材３１）の第１の連絡部３５ａ及び第２の連絡部３５ｂの外側に配置された歪みセンサ３７の抵抗値をＲ３，Ｒ４とする。

また、図７（ａ）のように、各ハンド部材３１の第１の接触部３４ａの外側に配置された２個の歪みセンサ３７と、第１の連絡部３５ａの内側に配置された２個の歪みセンサ３７とにより、ホイートストンブリッジ回路４１ｂが形成されている。このホイートストンブリッジ回路４１ｂは、第１のホイートストンブリッジ回路の一例である。

ここでは、一方のハンド部材（図７（ａ）中の左側のハンド部材３１）の第１の接触部３４ａの外側及び第１の連絡部３５ａの内側に配置された歪みセンサ３７の抵抗値をＲ１，Ｒ２とする。また、他方のハンド部材（図７（ａ）中の右側のハンド部材３１）の第１の接触部３４ａの外側及び第１の連絡部３５ａの内側に配置された歪みセンサ３７の抵抗値をＲ３，Ｒ４とする。

更に、図７（ｂ）のように、各ハンド部材３１の第２の接触部３４ｂの外側に配置された２個の歪みセンサ３７と、第２の連絡部３５ｂの内側に配置された２個の歪みセンサ３７とにより、ホイートストンブリッジ回路４１ｃが形成されている。このホイートストンブリッジ回路４１ｃは、第２のホイートストンブリッジ回路の一例である。

ここでは、一方のハンド部材（図７（ａ）中の左側のハンド部材３１）の第２の接触部３４ｂの外側及び第２の連絡部３５ｂの内側に配置された歪みセンサ３７の抵抗値をＲ１，Ｒ２とする。また、他方のハンド部材（図７（ａ）中の右側のハンド部材３１）の第２の接触部３４ｂの外側及び第２の連絡部３５ｂの内側に配置された歪みセンサ３７の抵抗値をＲ３，Ｒ４とする。

各ホイートストンブリッジ回路４１ａ，４１ｂ，４１ｃの電源端子Ａ，Ｂ間には歪みゲージアンプ２８から所定の電圧が印加され、出力端子Ｃ，Ｄから出力される信号は歪みゲージアンプ２８で増幅された後、制御部２９に入力される。

ホイートストンブリッジ回路４１ａ，４１ｂ，４１ｃにおいて、端子Ａと端子Ｂとの間の印加される電圧をＶ_EXとし、端子Ｃと端子Ｄとの間に出力される電圧をＶoutとすると、電圧Ｖoutは下記（１）式により求めることができる。

ここで、各歪みセンサ３７の抵抗値Ｒ１，Ｒ２，Ｒ３，Ｒ４が同一であるとすると、各ホイートストンブリッジ回路４１ａ，４１ｂ，４１ｃの出力電圧Ｖouta，Ｖoutb，Ｖoutcはいずれも０Ｖになる。

図８（ａ）のように第１の部品６１を挟持して、一方のハンド部材３１と他方のハンド部材３１とに同じように歪みが発生したものとする。この場合、図８（ｂ）のように、接触部３４ａ，３４ｂの外側の歪みセンサ３７には圧縮応力が加わって抵抗値Ｒ１，Ｒ３が減少し、連絡部３５ａ，３５ｂの内側の歪みセンサ３７には引張応力が加わって抵抗値Ｒ２，Ｒ４が増加する。手前側の接触部３４ａ及び連絡部３５ａに加わる応力と奥側の接触部３４ｂ及び連絡部３５ｂに加わる応力とは同じであるので、ホイートストンブリッジ回路４１ｂの出力電圧Ｖoutbとホイートストンブリッジ回路４１ｃの出力電圧Ｖoutcとは同じになる。

図９（ａ）のように、第１の部品６１を第２の部品６２の凹部６２ａに挿入するときに第１の部品６１の右側の部分が凹部６２ａの壁面を擦ると、第１の部品６１には図９（ａ）中に矢印で示す方向に応力が加わる。その結果、抵抗値Ｒ１，Ｒ４が減少し、抵抗値Ｒ２，Ｒ３が増加して、ホイートストンブリッジ回路４１ｂ，４１ｃの出力は増大（プラス側に変化）する。第１の部品６１が凹部６２ａに対し右側にずれているほど、ホイートストンブリッジ回路４１ｂ，４１ｃの出力は大きくなる。

逆に、図９（ｂ）のように、第１の部品６１を第２の部品６２の凹部６２ａに挿入するときに第１の部品６１の左側の部分が凹部６２ａの壁面を擦ると、第１の部品６１には図９（ｂ）中に矢印で示す方向に応力が加わる。その結果、抵抗値Ｒ１，Ｒ４が増加し、抵抗値Ｒ２，Ｒ３が減少して、ホイートストンブリッジ回路４１ｂ，４１ｃの出力は減少（マイナス側に変化）する。第１の部品６１が凹部６２ａに対し左側にずれるほど、ホイートストンブリッジ回路４１ｂ，４１ｃの出力は小さくなる。

図１０は、上述の実施形態に係るロボット２０の動作を説明するフローチャートである。ここでは、図２のように幅が数ｍｍ程度、厚さが２ｍｍ〜５ｍｍ程度、長さが１５ｍｍ〜３０ｍｍ程度のゴム製の第１の部品６１をプラスチック等により形成された第２の部品６２の凹部６２ａにはめ込む作業を行うものとする。

なお、本実施形態のロボット２０が把持する部品の形状及び大きさは、この例に限定されるものではない。

また、説明の便宜上、図１１のように部品６１の長さ方向の軸をＸ軸、幅方向の軸をＹ軸、厚さ方向の軸をＺ軸とする。また、Ｚ軸を中心とした回転方向の角度をθz、Ｙ軸を中心とした回転方向の角度をθyとする。

まず、ステップＳ１１において、制御部２９は、旋回支持部２２、リンク部２３，２４，２５の駆動装置及び把持部２６のハンド部材駆動部２７を制御して、第１の部品６１を一対のハンド部材３１間に挟持する。

次に、ステップＳ１２において、制御部２９は、把持部２６の歪みゲージアンプ２８に、ホイートストンブリッジ回路４１ａ，４１ｂ，４１ｃのキャリブレーション（平衡調整）を指示する。これにより、歪みゲージアンプ２８は、ハンド部材３１により第１の部品６１を挟持した状態でホイートストンブリッジ回路４１ａ，４１ｂ，４１ｃの出力が０Ｖとなるように、キャリブレーションを開始する。

一般的に、ホイートストンブリッジ回路のキャリブレーション方法には、可変抵抗器を用いてホイートストンブリッジ回路の出力を物理的に０に調整する方法と、ソフトウェアにより調整する方法とがある。本実施形態では、どちらの方法を採用してもよい。

次に、ステップＳ１３に移行し、制御部２９は、旋回支持部２２及びリンク部２３，２４，２５の駆動装置を制御して、第１の部品６１を第２の部品６２の凹部６２ａの近傍まで移動させる。ホイートストンブリッジ回路４１ａ，４１ｂ，４１ｃのキャリブレーションが完了するまでの間には数秒間の時間が必要であるが、本実施形態ではこの間を利用して第１の部品６１を第２の部品６２の凹部６２ａの近傍まで移動させておく。

その後、制御部２９は、ステップＳ１４でホイートストンブリッジ回路４１ａ，４１ｂ，４１ｃのキャリブレーションが完了するのを待つ。そして、ホイートストンブリッジ回路４１ａ，４１ｂ，４１ｃのキャリブレーションが完了すると、ステップＳ１５に移行する。

ステップＳ１５において、制御部２９は、旋回支持部２２、リンク部２３，２４，２５の駆動装置及び把持部２６を制御して、第１の部品６１を第２の部品６２の凹部６２ａに挿入する。このとき、制御部２９は、以下に説明するように、角度θz、角度θy、Ｙ軸方向の位置及びＸ軸方向の位置の補正を行う。

（角度θzの補正）
図１２（ａ）の平面図に示すように、第２の部品６２の凹部６２ａに対し第１の部品６１の角度θzが反時計方向にずれているとする。この状態で第１の部品６１を第２の部品６２の凹部６２ａに挿入すると、手前側（図１２（ａ）では下側）では第１の部品６１の右側が凹部６２ａの壁面を擦り、奥側（図１２（ａ）では上側）では第１の部品６１の左側が凹部６２ａの壁面を擦る。

この場合、第１の部品６１には、図１２（ａ）中に矢印で示すように手前側と奥側とで反対方向に応力が加わる。このため、ホイートストンブリッジ回路４１ｂの出力電圧Ｖoutbは増大（プラス側に変化）し、ホイートストンブリッジ回路４１ｃの出力電圧Ｖoutcは減少（マイナス側に変化）する。従って、ホイートストンブリッジ回路４１ｂの出力電圧Ｖoutbとホイートストンブリッジ回路４１ｃの出力電圧Ｖoutcとの差（Ｖoutb−Ｖoutc）はプラスの値（＞０）となり、制御部２９は第１の部品６１が凹部６２ａに対し反時計方向にずれていることがわかる。

一方、図１２（ｂ）の平面図に示すように、第２の部品６２の凹部６２ａに対し第１の部品６１の角度θzが時計方向にずれているとする。この状態で第１の部品６１を凹部６２ａに挿入すると、手前側（図１２（ｂ）では下側）では第１の部品６１の左側が凹部６２ａの壁面を擦り、奥側（図１２（ｂ）では上側）では第１の部品６１の右側が凹部６２ａの壁面を擦る。

この場合、第１の部品６１には図１２（ｂ）中に矢印で示す方向に応力が加わる。このため、ホイートストンブリッジ回路４１ｂの出力電圧Ｖoutbは減少（マイナス側に変化）し、ホイートストンブリッジ回路４１ｃの出力電圧Ｖoutcは増大（プラス側に変化）する。従って、ホイートストンブリッジ回路４１ｂの出力電圧Ｖoutbとホイートストンブリッジ回路４１ｃの出力電圧Ｖoutcとの差（Ｖoutb−Ｖoutc）はマイナスの値（＜０）となり、制御部２９は第１の部品６１が凹部６２ａに対し時計方向にずれていることがわかる。

角度θzのずれ量が少ないほど、ホイートストンブリッジ回路４１ｂ，４１ｃの出力の差は小さくなる。従って、制御部２９では、ホイートストンブリッジ回路４１ｂの出力電圧Ｖoutbとホイートストンブリッジ回路４１ｃの出力電圧Ｖoutcとの差から第１の部品６１の角度θzのずれ量を把握できる。制御部２９は、リンク部２３，２４，２５等を制御し、第１の部品６１の角度θzを補正する。

（角度θyの補正）
図１３のように、第２の部品６２に対し第１の部品６１の角度θyが時計方向又は反時計方向にずれているとする。ここでは、第１の部品６１が、手前側（図１３では右側）が低く、奥側（図１３では左側）が高い状態で傾いているとする。

この状態で第１の部品６１を第２の部品６２の凹部６２ａに挿入すると、最初に第１の部品６１の手前側の部分が第２の部品６２に接触し、それによりホイートストンブリッジ回路４１ｂの出力電圧Ｖoutbが変化する。その後、第１の部品６１の奥側の部分も第２の部品６２に接触し、ホイートストンブリッジ回路４１ｃの出力電圧Ｖoutcが変化する。

図１４は、横軸に第１の部品６１のＺ軸方向の位置をとり、横軸にホイートストンブリッジ回路４１ｂ，４１ｃの出力電圧Ｖoutb，Ｖoutcをとって、ホイートストンブリッジ回路４１ｂ，４１ｃの出力の変化を示す図である。第２の部品６２に対し第１の部品６１の角度θyがずれている場合、図１４に示すように、ホイートストンブリッジ回路４１ｂの出力電圧Ｖoutbが変化するタイミングとホイートストンブリッジ回路４１ｃの出力電圧Ｖoutcが変化するタイミングとの間にずれが生じる。

第１の部品６１の挿入速度が一定であるとすると、ホイートストンブリッジ回路４１ｂの出力電圧Ｖoutbが変化するタイミングとホイートストンブリッジ回路４１ｃの出力電圧Ｖoutcが変化するタイミングとの時間差が大きいほど、角度θyが大きいということができる。すなわち、制御部２９は、ホイートストンブリッジ回路４１ｂの出力電圧Ｖoutbが変化するタイミングとホイートストンブリッジ回路４１ｃの出力電圧Ｖoutcが変化するタイミングとの時間差から、第１の部品６１の角度θyのずれ量を把握することができる。制御部２９は、角度θyのずれ量に応じてリンク部２３，２４，２５等を制御し、第１の部品６１の角度θyを補正する。

（Ｙ軸方向の補正）
前述したように第１の部品６１を把持した状態でキャリブレーションを行うと、ホイートストンブリッジ回路４１ａ，４１ｂ，４１ｃの出力電圧Ｖouta，Ｖoutb，Ｖoutcはいずれも０Ｖとなる。この状態で図９（ａ）のように第１の部品６１を第２の部品６２の凹部６２ａに挿入する際に第１の部品６１の右側の部分が凹部６２ａの壁面を擦ると、ホイートストンブリッジ回路４１ｂ，４１ｃの出力電圧Ｖoutb，Ｖoutcはいずれもプラスになる。凹部６２ａに対する第１の部品６１のＹ軸方向のずれ量が大きいほど、ホイートストンブリッジ回路４１ｂ，４１ｃの出力電圧Ｖoutb，Ｖoutcの値は大きくなる。

逆に、図９（ｂ）のように第１の部品６１の左側の部分が凹部６２ａの壁面を擦ると、ホイートストンブリッジ回路４１ｂ，４１ｃの出力電圧Ｖoutb，Ｖoutcはいずれもマイナスになる。凹部６２ａに対する第１の部品６１のＹ軸方向のずれ量が大きいほど、ホイートストンブリッジ回路４１ｂ，４１ｃの出力電圧Ｖoutb，Ｖoutcの値の絶対値は大きくなる。

制御部２９は、ホイートストンブリッジ回路４１ｂ，４１ｃの出力電圧Ｖoutb，Ｖoutcの平均値を演算することにより、第１の部品６１のＹ軸方向のずれ量を知ることができる。制御部２９は、このずれ量に応じてリンク部２３，２４，２５等を制御し、第１の部品６１のＹ軸方向のずれを補正する。

なお、図１５のように第１の部品６１を把持した状態で第１の部品６１に上向きの応力が加えられても、ホイートストンブリッジ回路４１ｂ，４１ｃの出力電圧Ｖoutb，Ｖoutcは変化しない。つまり、Ｙ軸方向のずれ量を精度よく補正することができる。

（Ｘ軸方向の補正）
図１６のように、凹部６２ａに対し第１の部品６１がＸ軸方向にずれているとする。この状態で第１の部品６１を第２の部品６２の凹部６２ａに挿入すると、第１の部品６１の前端側（図１６において下側）が凹部６２ａの壁面を擦り、第１の連絡部３５ａの外側に配置された歪みセンサ３７の抵抗値Ｒ１，Ｒ４が増加する。これにより、ホイートストンブリッジ回路４１ａの出力電圧Ｖoutaがマイナス側に変化する。

逆に、第１の部品６１を第２の部品６２の凹部６２ａにするときに第１の部品６１の後端側（図１６において上側）が凹部６２ａの壁面を擦ると、第２の連絡部３５ｂの外側に配置された歪みセンサ３７の抵抗値Ｒ２，Ｒ３が増加して、ホイートストンブリッジ回路４１ａの出力電圧Ｖoutaがプラス側に変化する。

第１の部品６１の凹部６２ａに対するＸ軸方向のずれ量が大きいほど、ホイートストンブリッジ回路４１ａの出力電圧Ｖoutaの変化量が大きいので、制御部２９はホイートストンブリッジ回路４１ａの出力電圧ＶoutaからＸ軸方向のずれ量を把握することができる。制御部２９は、Ｘ軸方向のずれ量に応じて各リンク部２３，２４，２５等を制御し、第１の部品６１のＸ軸方向の位置を補正する。

以上説明したように、本実施形態に係るロボット２０では、把持部２６に設けられた２対の指部３３の内側及び外側に歪みセンサ３７を配置し、それらの歪みセンサ３７によりホイートストンブリッジ回路４１ａ，４１ｂ，４１ｃを形成している。これにより、指部３３の各箇所における歪みを高精度に検出でき、部品同士の接触具合に応じて把持した部品の位置及び角度を補正することができる。また、本実施形態に係るロボット２０の把持部２６は、比較的簡単な構造で部品同士の接触具合を検出できるため、製造コストが低減される。

更に、本実施形態においては、歪みセンサ３７が指部３３に配置されている。このため、作業効率を上げようとして旋回支持部２１及びリンク部２３，２４，２５等を高速で動かしても歪みセンサ３７、あるいはハンド部材３１に大きな慣性力が加わることがなく、歪みセンサ３７が破損、あるいはハンド部材３１が塑性変形するおそれが少ない。また、作業中にリンク部２３，２４，２５等が障害物に衝突したとしても、歪みセンサ３７に大きな応力が加わることがなく、歪みセンサ３７の破損を回避できる。

（第２の実施形態）
図１７は、第２の実施形態に係るロボット（把持装置）の指部を示す模式図である。本実施形態に係るロボットが第１の実施形態と異なる点は指部の形状が異なることにあり、その他の構造は基本的に第１の実施形態と同様であるので、ここでは重複する部分の説明を省略する。

本実施形態では、ハンド部材駆動部２７（図３参照）に固定される固定部から垂直方向に延びる２対の指部５１を備えている。そして、ハンド部材駆動部２７により相互に対向する指部５１間の距離が変化し、指部５１の間で第１の部品６１を把持する。

各指部５１の内側及び外側の面にはそれぞれ歪みセンサ（歪みゲージ）５７が配置されており、それらの歪みセンサ５７により２つのホイートストンブリッジ回路５３ａ，５３ｂが形成されている。ホイートストンブリッジ回路５３ａ，５３ｂは、それぞれ第１の実施形態のホイートストンブリッジ回路４１ｂ，４１ｃに対応し、これらのホイートストンブリッジ回路５３ａ，５３ｂにより把持した第１の部品６１の角度θz，θy及びＹ軸方向の位置を補正することができる。

以上の諸実施形態に関し、更に以下の付記を開示する。

（付記１）それぞれ２本の指部を有する一対のハンド部材と、
前記ハンド部材を相互に近接又は離隔する方向に移動させて第１の部品を把持するハンド部材駆動部と、
前記指部の内側及び外側の面にそれぞれ配置された複数の歪みセンサと、
前記歪みセンサの出力から前記第１の部品と第２の部品との接触具合を検出する制御部と
を有することを特徴とする把持装置。

（付記２）前記歪みセンサが、歪みに応じて抵抗値が変化する歪みゲージであることを特徴とする付記１に記載の把持装置。

（付記３）前記一対のハンド部材のうちの一方のハンド部材の各指部の内側及び外側の面にそれぞれ配置された前記歪みセンサと、他方のハンド部材の各指部の内側及び外側の面にそれぞれ配置された前記歪みセンサとにより、第１のホイートストンブリッジ回路及び第２のホイートストンブリッジ回路が形成されていることを特徴とする付記２に記載の把持装置。

（付記４）前記指部が、前記第１の部品に接触する接触部と、前記接触部と前記ハンド部材駆動部との間を連絡する連絡部とを有し、
前記接触部と前記連絡部とのなす角度が９０度よりも大きく、
前記第１のホイートストンブリッジ回路及び前記第２のホイートストンブリッジ回路は、前記連絡部の内側に配置された前記歪みセンサと、前記接触部の外側に配置された前記歪みセンサとにより形成されていることを特徴とする付記３に記載の把持装置。

（付記５）更に、前記一対のハンド部材の各指部の前記接触部の外側に配置された４個の前記歪みセンサにより第３のホイートストンブリッジ回路が形成されていることを特徴とする付記４に記載の把持装置。

（付記６）アームと、
前記アームに連結されて第１の部品を把持する把持部と、
前記アームを制御して前記把持部を移動させる制御部と有し、
前記把持部は、それぞれ２本の指部を有する一対のハンド部材と、前記ハンド部材を相互に近接又は離隔する方向に移動させるハンド部材駆動部と、前記指部の内側及び外側の面にそれぞれ配置された複数の歪みセンサとを備え、
前記制御部は前記歪みセンサの出力から前記第１の部品と第２の部品との接触具合を検出することを特徴とするロボット。

（付記７）前記制御部は、前記第１の部品と前記第２の部品との接触具合の検出結果に応じて、前記第１の部品の位置又は角度を補正することを特徴とする付記６に記載のロボット。

（付記８）前記歪みセンサが、歪みに応じて抵抗値が変化する歪みゲージであることを特徴とする付記７に記載のロボット。

（付記９）前記一対のハンド部材のうちの一方のハンド部材の各指部の内側及び外側の面にそれぞれ配置された前記歪みセンサと、他方のハンド部材の各指部の内側及び外側の面にそれぞれ配置された前記歪みセンサとにより、第１のホイートストンブリッジ回路及び第２のホイートストンブリッジ回路が形成されていることを特徴とする付記８に記載のロボット。

（付記１０）前記指部が、前記第１の部品に接触する接触部と、前記接触部と前記ハンド部材駆動部との間を連絡する連絡部とを有し、
前記接触部と前記連絡部とのなす角度が９０度よりも大きく、
前記第１のホイートストンブリッジ回路及び前記第２のホイートストンブリッジ回路は、前記連絡部の内側に配置された前記歪みセンサと、前記接触部の外側に配置された前記歪みセンサとにより形成されていることを特徴とする付記９に記載のロボット。

１０…ロボット、１１…台座部、１２…旋回支持部、１３，１４，１５…リンク部、１６…多軸力覚センサ、１７…把持部、１９…制御部、２０…ロボット、２１…台座部、２２…旋回支持部、２３，２４，２５…リンク部、２６…把持部（把持装置）、２７…ハンド部材駆動部、２８…歪みゲージアンプ、２９…制御部、３１…ハンド部材、３２…固定部、３３…指部、３４…接触部、３５…連絡部、３６…補強部、３７…歪みセンサ、３９…ボルト、４１ａ，４１ｂ，４１ｃ…ホイートストンブリッジ回路、５１…指部、５３ａ，５３ｂ…ホイートストンブリッジ回路、６１…第１の部品、６２…第２の部品、６２ａ…凹部。

Claims

それぞれ２本の指部を有する一対のハンド部材と、
前記ハンド部材を相互に近接又は離隔する方向に移動させて第１の部品を把持するハンド部材駆動部と、
前記指部の内側及び外側の面にそれぞれ配置された複数の歪みセンサと、
前記歪みセンサの出力から前記第１の部品と第２の部品との接触具合を検出する制御部と
を有することを特徴とする把持装置。
前記歪みセンサが、歪みに応じて抵抗値が変化する歪みゲージであることを特徴とする請求項１に記載の把持装置。
前記一対のハンド部材のうちの一方のハンド部材の各指部の内側及び外側の面にそれぞれ配置された前記歪みセンサと、他方のハンド部材の各指部の内側及び外側の面にそれぞれ配置された前記歪みセンサとにより、第１のホイートストンブリッジ回路及び第２のホイートストンブリッジ回路が形成されていることを特徴とする請求項２に記載の把持装置。
アームと、
前記アームに連結されて第１の部品を把持する把持部と、
前記アームを制御して前記把持部を移動させる制御部と有し、
前記把持部は、それぞれ２本の指部を有する一対のハンド部材と、前記ハンド部材を相互に近接又は離隔する方向に移動させるハンド部材駆動部と、前記指部の内側及び外側の面にそれぞれ配置された複数の歪みセンサとを備え、
前記制御部は前記歪みセンサの出力から前記第１の部品と第２の部品との接触具合を検出することを特徴とするロボット。
前記制御部は、前記第１の部品と前記第２の部品との接触具合の検出結果に応じて、前記第１の部品の位置又は角度を補正することを特徴とする請求項４に記載のロボット。