(57)【要約】【課題】力センサーの異常を検出し得る剛性が高いロボットおよびロボットの異常検出方法を提供すること。【解決手段】ロボットアームと、前記ロボットアームの基台と被設置部との間に配置されている、第１部材および第２部材と、前記第１部材および前記第２部材の双方に接して、前記基台と前記被設置部とが並ぶ方向を法線方向とする平面上に配置されている、第１力センサーおよび第２力センサーと、前記第１力センサーの出力から仮想直線上における並進力成分を第１並進力成分として求め、前記第２力センサーの出力から前記仮想直線上における並進力成分を第２並進力成分として求める仮想直線上成分演算部と、前記第１並進力成分と前記第２並進力成分との差に基づいて、前記第１力センサーまたは前記第２力センサーが異常であると判断した場合、信号を出力する判断部と、を有することを特徴とするロボット。【選択図】図１
2020019067.tif 000002
【特許請求の範囲】
【請求項１】
ロボットアームと、
前記ロボットアームの基台と被設置部との間に配置されている、第１部材および第２部材と、
前記第１部材および前記第２部材の双方に接して、前記基台と前記被設置部とが並ぶ方向を法線方向とする平面上に配置されている、第１力センサーおよび第２力センサーと、
前記第１力センサーの出力から仮想直線上における並進力成分を第１並進力成分として求め、前記第２力センサーの出力から前記仮想直線上における並進力成分を第２並進力成分として求める仮想直線上成分演算部と、
前記第１並進力成分と前記第２並進力成分との差に基づいて、前記第１力センサーまたは前記第２力センサーが異常であると判断した場合、信号を出力する判断部と、
を有することを特徴とするロボット。
【請求項２】
前記判断部からの前記信号を受けて、前記ロボットアームの駆動を制限する制御部を有する請求項１に記載のロボット。
【請求項３】
前記第１力センサーの出力と前記第２力センサーの出力とに基づき、合成力を算出する外力演算部を有する請求項１または２に記載のロボット。
【請求項４】
前記第１力センサーおよび前記第２力センサーは、それぞれ６軸力覚センサーである請求項１ないし３のいずれか１項に記載のロボット。
【請求項５】
前記第１力センサーおよび前記第２力センサーは、それぞれ水晶を有するセンサーである請求項１ないし４のいずれか１項に記載のロボット。
【請求項６】
第３力センサーおよび第４力センサーを有する請求項１ないし５のいずれか１項に記載のロボット。
【請求項７】
ロボットアームと、
前記ロボットアームの基台と被設置部との間に配置されている、第１部材および第２部材と、
前記第１部材および前記第２部材の双方に接して、前記基台と前記被設置部とが並ぶ方向を法線方向とする平面上に配置されている、第１力センサーおよび第２力センサーと、
を有するロボットの異常を検出する方法であって、
前記第１力センサーの出力から仮想直線上における並進力成分を第１並進力成分として求め、前記第２力センサーの出力から前記仮想直線上における並進力成分を第２並進力成分として求めるステップと、
前記第１並進力成分と前記第２並進力成分との差が閾値を超えているか否かを判断し、前記閾値を超えている場合、前記第１力センサーまたは前記第２力センサーが異常であると判断するステップと、
を含むことを特徴とするロボットの異常検出方法。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、ロボットおよびロボットの異常検出方法に関するものである。
【背景技術】
【０００２】
特許文献１に記載のロボットシステムは、ロボットと、このロボットに作用する力に基づき所定の第１検出値および第２検出値をそれぞれ出力する第１センサーおよび第２センサーと、第１検出値と第２検出値との差が閾値を超える場合にロボットに異常が発生したと判断する制御部と、を備えている。また、特許文献１には、第１センサーおよび第２センサーが、例えばベース台と基端アームとの間に重ねて配置される旨、開示されている。
【先行技術文献】
【特許文献】
【０００３】
【特許文献１】特開２０１２−２１８０９４号公報
【発明の概要】
【発明が解決しようとする課題】
【０００４】
特許文献１に記載のロボットシステムでは、第１センサーと第２センサーとを重ねるように配置しているため、センサー部の剛性が低下する。このため、ロボットの位置決め精度が低下するという課題がある。
【課題を解決するための手段】
【０００５】
本発明の適用例に係るロボットは、ロボットアームと、
前記ロボットアームの基台と被設置部との間に配置されている、第１部材および第２部材と、
前記第１部材および前記第２部材の双方に接して、前記基台と前記被設置部とが並ぶ方向を法線方向とする平面上に配置されている、第１力センサーおよび第２力センサーと、
前記第１力センサーの出力から仮想直線上における並進力成分を第１並進力成分として求め、前記第２力センサーの出力から前記仮想直線上における並進力成分を第２並進力成分として求める仮想直線上成分演算部と、
前記第１並進力成分と前記第２並進力成分との差に基づいて、前記第１力センサーまたは前記第２力センサーが異常であると判断した場合、信号を出力する判断部と、
を有する。
【図面の簡単な説明】
【０００６】
【図１】本発明の第１実施形態に係るロボットを示す斜視図である。
【図２】図１に示すロボットのブロック図である。
【図３】図１に示す力検出部の部分拡大分解斜視図である。
【図４】図３に示す力検出部を鉛直上方から見た図である。
【図５】図４に示す力検出部の側面図である。
【図６】図１および図２に示すロボットの異常検出方法を説明するためのフローチャートである。
【図７】図４に示す力検出部に合成力座標系を追記した図である。
【図８】本発明の第２実施形態に係るロボットに含まれる力検出部を示す分解斜視図である。
【図９】図８に示す力検出部を鉛直上方から見た図である。
【図１０】図９に示す力検出部の変形例を示す図である。
【発明を実施するための形態】
【０００７】
以下、本発明のロボットおよびロボットの異常検出方法の好適な実施形態を添付図面に基づいて詳細に説明する。
【０００８】
＜第１実施形態＞
図１は、本発明の第１実施形態に係るロボットを示す斜視図であって、力検出部付近を分解して示す図である。図２は、図１に示すロボットのブロック図である。なお、以下では、ロボットアーム１０の基台１１０側を「基端側」、その反対側、すなわちロボットアーム１０のエンドエフェクター１７側を「先端側」と言う。また、図１および図３中の上方を「上」、下方を「下」という。
【０００９】
図１に示すロボット１は、エンドエフェクター１７が装着されたロボットアーム１０を用いて、例えば、精密機器やこれを構成する部品等の対象物の給材、除材、搬送および組立等の作業を行うシステムである。このロボット１は、複数のアーム１１〜１６を有するロボットアーム１０と、ロボットアーム１０の先端側に取り付けられたエンドエフェクター１７と、これらの動作を制御する制御装置５０と、を備える。以下、まず、ロボット１の概略を説明する。
【００１０】
ロボット１は、いわゆる６軸の垂直多関節ロボットである。図１に示すように、ロボット１は、基台１１０と、基台１１０に回動可能に連結されているロボットアーム１０と、を備える。
【００１１】
基台１１０は、力検出部２１を介して、例えば、床、壁、天井、移動可能な台車上等の被設置部に固定される。この力検出部２１については後述する。なお、以下の説明では、一例として基台１１０を床面に固定している場合について説明している。ロボットアーム１０は、基台１１０に対して回動可能に連結されているアーム１１（第１アーム）と、アーム１１に対して回動可能に連結されているアーム１２（第２アーム）と、アーム１２に対して回動可能に連結されているアーム１３（第３アーム）と、アーム１３に対して回動可能に連結されているアーム１４（第４アーム）と、アーム１４に対して回動可能に連結されているアーム１５（第５アーム）と、アーム１５に対して回動可能に連結されているアーム１６（第６アーム）と、を有する。なお、基台１１０およびアーム１１〜１６のうちの互いに連結された２つの部材同士を屈曲または回動させる部分が「関節部」を構成している。
【００１２】
また、図２に示すように、ロボット１は、ロボットアーム１０の各関節部を駆動する駆動部１３０と、ロボットアーム１０の各関節部の駆動状態として例えば回転角度を検出する角度センサー１３１と、を有する。駆動部１３０は、例えば、モーターおよび減速機を含んで構成されている。角度センサー１３１は、例えば、磁気式または光学式のロータリーエンコーダーを含んで構成されている。
【００１３】
このようなロボット１のアーム１６の先端面には、エンドエフェクター１７が装着されている。なお、アーム１６とエンドエフェクター１７との間には、後述する力センサーとは別の力センサーが配置されていてもよい。
【００１４】
エンドエフェクター１７は、対象物を把持する把持ハンドである。このエンドエフェクター１７は、図１に示すように、本体１７１と、本体１７１に設置されている駆動部１７０と、駆動部１７０からの駆動力により開閉する１対の把持部１７２と、把持部１７２に設けられている把持力センサー１７３と、を有する。
【００１５】
ここで、駆動部１７０は、例えば、モーターと、モーターからの駆動力を１対の把持部１７２に伝達する歯車等の伝達機構と、を含んで構成されている。そして、１対の把持部１７２は、駆動部１７０からの駆動力により開閉する。これにより、１対の把持部１７２間で対象物を掴んで保持したり、１対の把持部１７２間で保持した対象物を離脱させたりすることができる。把持力センサー１７３は、例えば、抵抗型、静電型等の感圧センサーであり、把持部１７２または把持部１７２と駆動部１７０との間に配置され、１対の把持部１７２間に加わる力を検出する。なお、エンドエフェクター１７は、前述した把持ハンドに限定されず、例えば、吸着により対象物を保持する方式のエンドエフェクターであってもよい。本明細書において、「保持」とは、吸着および把持の双方を含む概念である。また、「吸着」とは、磁力による吸着、負圧による吸着等を含む概念である。また、「力」とは、特に断りがない限り、並進力とモーメントの双方を含む概念である。また、エンドエフェクター１７に用いる把持ハンドの指の数は、２本に限定されず、３本以上であってもよい。
【００１６】
図１および図２に示す制御装置５０は、角度センサー１３１の検出結果に基づいて、ロボットアーム１０の駆動を制御する機能を有する。また、制御装置５０は、把持力センサー１７３の検出結果およびロボット１の動作条件に基づいて、エンドエフェクター１７の把持力を決定したりロボット１の動作条件を変更したりする機能を有する。
【００１７】
この制御装置５０は、ＣＰＵ（Central Processing Unit）等の制御部５１と、ＲＯＭ（Read Only Memory）、ＲＡＭ（Random Access Memory）等の記憶部５２と、Ｉ／Ｆ（インターフェース回路）５３と、を有する。そして、制御装置５０では、記憶部５２に記憶されているプログラムを制御部５１が適宜読み込んで実行することで、ロボットアーム１０およびエンドエフェクター１７の動作の制御、異常の発報等の処理を実現する。また、Ｉ／Ｆ５３は、ロボットアーム１０およびエンドエフェクター１７と通信可能に構成されている。
【００１８】
なお、制御装置５０は、図示では、ロボット１の基台１１０内に配置されているが、これに限定されず、例えば、基台１１０の外部やロボットアーム１０内に配置されていてもよい。また、制御装置５０には、ディスプレイ等のモニターを備える表示装置、例えばマウスやキーボード等を備える入力装置等が接続されていてもよい。
【００１９】
また、図１および図２に示すロボット１は、ロボットアーム１０よりも基端側であって、基台１１０と床面との間に設けられている力検出部２１を備える。
【００２０】
力検出部２１は、第１部材２１１および第２部材２１２を備えている。本実施形態に係る第１部材２１１および第２部材２１２は、基台１１０と床面（被設置部）とが並ぶ方向に沿って並んでいる。すなわち、第１部材２１１および第２部材２１２は、鉛直方向に沿って、上下に並んでいる。そして、第１部材２１１は、基台１１０の下面に接するように設けられている。一方、第２部材２１２は、床面に接するように設けられている。このような第１部材２１１および第２部材２１２は、鉛直方向から見たとき、それぞれ主面が四角形をなす板状体である。
【００２１】
また、力検出部２１は、第１部材２１１と第２部材２１２との間に設けられた第１力センサー２２１および第２力センサー２２２を備えている。第１力センサー２２１および第２力センサー２２２は、基台１１０と被設置部とが並ぶ方向、すなわち鉛直方向を法線とする平面Ｆ上に並列で配置されている。本実施形態では、第２部材２１２の上面２１２ａが平面Ｆに相当する。
【００２２】
そして、第１力センサー２２１は、第１部材２１１の下面２１１ａおよび第２部材２１２の上面２１２ａの双方に接するように配置されている。同様に、第２力センサー２２２も、第１部材２１１の下面２１１ａおよび第２部材２１２の上面２１２ａの双方に接するように配置されている。
【００２３】
なお、本実施形態では、基台１１０と被設置部とが並ぶ方向は、第１部材２１１と第２部材２１２とが並ぶ方向に等しい。第１部材２１１と第２部材２１２とが並ぶ方向とは、平面Ｆを平面視したとき、第１部材２１１の下面２１１ａおよび第２部材２１２の上面２１２ａのうち、互いに重複している領域（以下、「重複領域」という。）の重心同士を結ぶ方向のことをいう。具体的には、下面２１１ａと上面２１２ａとの間において、形状や大きさ等は互いに異なっていてもよいが、下面２１１ａ側の重複領域の重心ＣＧ１と、上面２１２ａ側の重複領域の重心ＣＧ２と、を結ぶ図３の方向Ｄが、平面Ｆの法線と平行であればよい。そして、本実施形態では、特に、平面Ｆの法線が鉛直方向と平行になっている。つまり、本実施形態に係る第１部材２１１と第２部材２１２とを結ぶ方向は、鉛直方向である。
【００２４】
このような力検出部２１は、ロボットアーム１０に付与される力を検知するセンサーである。ロボットアーム１０またはエンドエフェクター１７に力が付与されたとき、その力がロボットアーム１０を経て力検出部２１に伝達され、力検出部２１においてその力の大きさや向きを検知することができる。これにより、ロボット１において衝突検知が可能となる。
【００２５】
また、力検出部２１は、Ｉ／Ｆ５３（インターフェース）を介して仮想直線上成分演算部５４および外力演算部５６と通信可能に接続されている。
【００２６】
図３は、図１に示す力検出部２１の部分拡大分解斜視図である。また、図４は、図３に示す力検出部２１を鉛直上方から見た図である。また、図５は、図４に示す力検出部２１の側面図である。
【００２７】
図４に示す力検出部２１では、第１力センサー２２１および第２力センサー２２２について、その内部を透視するように図示している。
【００２８】
図４に示す第１力センサー２２１は、筐体２２１０と、筐体２２１０内に設けられた４つのセンサーユニット２２１１〜２２１４と、を備える６軸力覚センサーである。そして、これらのセンサーユニット２２１１〜２２１４からの出力に所定の演算処理を施すことにより、図４に示す第１センサー座標系のｘ軸、ｙ１軸、およびｚ１軸についての並進力、ならびに、ｘ軸まわり、ｙ１軸まわり、およびｚ１軸まわりのモーメントを求めることができる。
【００２９】
センサーユニット２２１１〜２２１４は、それぞれ図示しない平板状の水晶板を複数枚含み、水晶板の圧電効果によって加えられた力を電荷に変換させる素子である。各水晶板は、結晶方位が互いに異なるように積層されている。これにより、各水晶板から、その主面に直交する方向の力に基づく出力Ｆｚと、主面において互いに直交する２つの方向の力に基づく出力Ｆｘ、Ｆｙと、が得られる。なお、以下の説明では、センサーユニット２２１１〜２２１４の各水晶板の主面のことを、センサーユニット２２１１〜２２１４の主面ともいう。
【００３０】
また、図４に示すように、センサーユニット２２１１〜２２１４は、それぞれ、その主面の垂線ＮＬが筐体２２１０の中心Ｏ１を通過するように、換言すれば、主面が中心Ｏ１に臨むように配置されている。そして、４つのセンサーユニット２２１１〜２２１４は、中心Ｏ１まわりに等角度間隔で配置されている。また、４つのセンサーユニット２２１１〜２２１４のｚ１軸における位置は、互いに同じになっている。
【００３１】
なお、図４では、センサーユニット２２１１とセンサーユニット２２１４との間、および、センサーユニット２２１２とセンサーユニット２２１３との間を、第１センサー座標系のｘ軸が通過している。また、図４では、センサーユニット２２１１とセンサーユニット２２１２との間、および、センサーユニット２２１３とセンサーユニット２２１４との間を、第１センサー座標系のｙ１軸が通過している。
【００３２】
なお、センサーユニット２２１１から得られる出力Ｆｘを「Ｆｘ１」とし、出力Ｆｙを「Ｆｙ１」とする。また、センサーユニット２２１２から得られる出力Ｆｘを「Ｆｘ２」とし、出力Ｆｙを「Ｆｙ２」とする。また、センサーユニット２２１３から得られる出力Ｆｘを「Ｆｘ３」とし、出力Ｆｙを「Ｆｙ３」とする。また、センサーユニット２２１４から得られる出力Ｆｘを「Ｆｘ４」とし、出力Ｆｙを「Ｆｙ４」とする。
【００３３】
そして、図４に示すように、それぞれ平面Ｆに投影された出力Ｆｘ１の向きおよび出力Ｆｘ３の向きは、互いに反対である。同様に、それぞれ平面Ｆに投影された出力Ｆｘ２の向きおよび出力Ｆｘ４の向きは、互いに反対である。同様に、それぞれ平面Ｆに投影された出力Ｆｙ１の向きおよび出力Ｆｙ３の向きは、互いに反対である。同様に、それぞれ平面Ｆに投影された出力Ｆｙ２の向きおよび出力Ｆｙ４の向きは、互いに反対である。
【００３４】
また、図５に示すように、出力Ｆｘ１の向き、出力Ｆｘ２の向き、出力Ｆｙ１の向き、および出力Ｆｙ２の向きは、それぞれｘ軸とｙ１軸の双方と非平行になっている。また、図５には図示していないものの、出力Ｆｘ３の向き、出力Ｆｘ４の向き、出力Ｆｙ３の向き、および出力Ｆｙ４の向きも、それぞれｘ軸とｙ１軸の双方と非平行になっている。
なお、これらは、限定されるものではなく、平行になっていてもよい。
【００３５】
図４に示す第２力センサー２２２は、筐体２２２０と、筐体２２２０内に設けられた４つのセンサーユニット２２２１〜２２２４と、を備える６軸力覚センサーである。そして、これらのセンサーユニット２２２１〜２２２４からの出力に所定の演算処理を施すことにより、図４に示す第２センサー座標系のｘ軸、ｙ２軸、およびｚ２軸についての並進力、ならびに、ｘ軸まわり、ｙ２軸まわり、およびｚ２軸まわりのモーメントを求めることができる。
【００３６】
なお、第１センサー座標系におけるｘ軸と、第２センサー座標系におけるｘ軸は、互いに共通である。
【００３７】
センサーユニット２２２１〜２２２４は、それぞれ図示しない平板状の水晶板を複数枚含み、水晶板の圧電効果によって力を電荷に変換させる素子である。各水晶板は、結晶方位が互いに異なるように積層されている。これにより、各水晶板から、その主面に直交する方向の力に基づく出力Ｆｚと、主面において互いに直交する２つの方向の力に基づく出力Ｆｘ、Ｆｙと、が得られる。なお、以下の説明では、センサーユニット２２２１〜２２２４の各水晶板の主面のことを、センサーユニット２２２１〜２２２４の主面ともいう。
【００３８】
また、図４に示すように、センサーユニット２２２１〜２２２４は、それぞれ、その主面の垂線ＮＬが筐体２２２０の中心Ｏ２を通過するように、換言すれば、主面が中心Ｏ２に臨むように配置されている。そして、４つのセンサーユニット２２２１〜２２２４は、中心Ｏ２まわりに等角度間隔で配置されている。また、４つのセンサーユニット２２２１〜２２２４のｚ２軸における位置は、互いに同じになっている。
【００３９】
なお、図４では、センサーユニット２２２１とセンサーユニット２２２４との間、および、センサーユニット２２２２とセンサーユニット２２２３との間を、第２センサー座標系のｘ軸が通過している。また、図４では、センサーユニット２２２１とセンサーユニット２２２２との間、および、センサーユニット２２２３とセンサーユニット２２２４との間を、第２センサー座標系のｙ２軸が通過している。
【００４０】
なお、センサーユニット２２２１から得られる出力Ｆｘを「Ｆｘ５」とし、出力Ｆｙを「Ｆｙ５」とする。また、センサーユニット２２２２から得られる出力Ｆｘを「Ｆｘ６」とし、出力Ｆｙを「Ｆｙ６」とする。また、センサーユニット２２２３から得られる出力Ｆｘを「Ｆｘ７」とし、出力Ｆｙを「Ｆｙ７」とする。また、センサーユニット２２２４から得られる出力Ｆｘを「Ｆｘ８」とし、出力Ｆｙを「Ｆｙ８」とする。
【００４１】
そして、図４に示すように、それぞれ平面Ｆに投影された出力Ｆｘ５の向きおよび出力Ｆｘ７の向きは、互いに反対である。同様に、それぞれ平面Ｆに投影された出力Ｆｘ６の向きおよび出力Ｆｘ８の向きは、互いに反対である。同様に、それぞれ平面Ｆに投影された出力Ｆｙ５の向きおよび出力Ｆｙ７の向きは、互いに反対である。同様に、それぞれ平面Ｆに投影された出力Ｆｙ６の向きおよび出力Ｆｙ８の向きは、互いに反対である。
【００４２】
また、図示していないものの、出力Ｆｘ５の向き、出力Ｆｘ６の向き、出力Ｆｙ５の向き、および出力Ｆｙ６の向きは、それぞれｘ軸とｙ２軸の双方と非平行になっている。また、同様に、出力Ｆｘ７の向き、出力Ｆｘ８の向き、出力Ｆｙ７の向き、および出力Ｆｙ８の向きも、それぞれｘ軸とｙ２軸の双方と非平行になっている。
なお、これらは、限定されるものではなく、平行になっていてもよい。
【００４３】
以上のように、第１力センサー２２１は、複数のセンサーユニット２２２１〜２２２４からの出力に基づいて、力を検出する。同様に、第２力センサー２２２は、複数のセンサーユニット２２２１〜２２２４からの出力に基づいて、力を検出する。そして、第１力センサー２２１および第２力センサー２２２は、双方が正常である場合、同じ力が加えられると、同じ値を出力するように設定されている。例えば、出力Ｆｘ１および出力Ｆｘ５、ならびに、出力Ｆｙ１および出力Ｆｙ５は、同じになるように設定されている。また、他の出力Ｆｘ、出力Ｆｙ、および出力Ｆｚについても同様の関係を満たすように設定されている。
【００４４】
なお、各力センサーにおけるセンサーユニットの数は、特に限定されず、２個または３個であっても、５個以上であってもよい。
【００４５】
また、各力センサーは本実施形態に示すように、予め複数のセンサーユニットを組み合わせてモジュールとして構成している場合に限定されず、例えば、直接８つのセンサーユニットが、それぞれ第１部材および第２部材に組み付けられており、その内の任意の複数個（例えば４つ）からのセンサーユニットの組み合わせを第１力センサーとして、残りの（例えば４つ）のセンサーユニットの組み合わせを第２力センサーとして、合成力を出力する場合も含まれる。このような構成とした場合、１つのセンサーユニットが故障して力検出部２１が異常となっても、単一のセンサーユニットのみを交換すればよく、低コストで無駄のない修理が可能となる。
【００４６】
一方、本実施形態に示すように第１力センサー２２１および第２力センサー２２２をモジュールとして組み立てられた形態とすれば、力検出部２１の組立製造および感度校正等をより簡単に行うことが可能となる。
【００４７】
制御装置５０は、仮想直線上成分演算部５４と、センサー異常判断部５５と、外力演算部５６と、を備えている。
【００４８】
このうち、仮想直線上成分演算部５４は、第１力センサー２２１の出力から仮想直線上における並進力成分を求めるとともに、第２力センサー２２２の出力から仮想直線上における並進力成分を求める。ここで、仮想直線は、仮想直線上成分演算部５４によって仮想される任意の直線のことをいう。なお、仮想直線については、後に詳述する。
【００４９】
また、センサー異常判断部５５は、仮想直線上成分演算部５４の演算結果に基づいて、第１力センサー２２１または第２力センサー２２２が異常であるか否かを判断する。
【００５０】
また、外力演算部５６は、第１力センサー２２１の出力と第２力センサー２２２の出力とに基づき、合成力を算出する。
【００５１】
以上、ロボット１の概略を説明したが、このロボット１が備える力検出部２１では、前述したように第１力センサー２２１および第２力センサー２２２の双方が平面Ｆ上に並列で載置されている。このため、力検出部２１の厚さを抑えることができ、力検出部２１の剛性が低下しにくくなるため、ロボット１の位置決め精度の低下を防止することができる。
【００５２】
また、このロボット１では、ロボットアーム１０やエンドエフェクター１７等に対して力が付与されたとき、その力を力検出部２１において高精度に検知し、それに応じて動作するため、力検出部２１の健全性が担保されている必要がある。本実施形態に係るロボット１では、付与された力の検出値を出力するとともに、力検出部２１における異常の有無を判断し、異常があった場合には信号を出力する。これにより、早期に異常を検出することができ、ロボットアーム１０の駆動を制限するといった制御を行うことができる。
【００５３】
以下、ロボット１の動作について説明する。
図６は、図１および図２に示すロボット１の異常検出方法を説明するためのフローチャートである。
【００５４】
まず、ロボット１は、通常動作を開始する。通常動作としては、例えば、精密機器やこれを構成する部品等の対象物の給材、除材、搬送および組立等の作業が挙げられる。
【００５５】
通常動作が開始された後、ステップＳ１として、力検出部２１によって力を検出する。力検出部２１に力が加わると、第１力センサー２２１および第２力センサー２２２にその力が伝達される。そして、第１力センサー２２１の出力から図４に示す仮想直線ＶＬ上における並進力成分を「第１並進力成分ｆｘ１」として求める。また、第２力センサー２２２の出力から仮想直線ＶＬ上における並進力成分を「第２並進力成分ｆｘ２」として求める。本実施形態では、説明の便宜のため、図４に示すように、第１センサー座標系と第２センサー座標系とで共通であるｘ軸を、仮想直線ＶＬとして設定している。
【００５６】
具体的には、第１力センサー２２１に力が加わると、第１力センサー２２１からは、前述したように、４つのセンサーユニット２２１１〜２２１４からの出力として、出力Ｆｘ１、出力Ｆｙ１、出力Ｆｘ２、出力Ｆｙ２、出力Ｆｘ３、出力Ｆｙ３、出力Ｆｘ４および出力Ｆｙ４が得られる。また、第２力センサー２２２に力が加わると、第２力センサー２２２からは、前述したように、４つのセンサーユニット２２２１〜２２２４からの出力として、出力Ｆｘ５、出力Ｆｙ５、出力Ｆｘ６、出力Ｆｙ６、出力Ｆｘ７、出力Ｆｙ７、出力Ｆｘ８および出力Ｆｙ８が得られる。これらの出力は、制御装置５０の外力演算部５６に入力されるとともに、仮想直線上成分演算部５４に入力される。以下、仮想直線上成分演算部５４における演算と、外力演算部５６における演算と、について順次説明する。
【００５７】
このうち、仮想直線上成分演算部５４では、まず、第１力センサー２２１の出力から、以下の式（１）に基づき、第１並進力成分ｆｘ１を算出する。
【００５８】
ｆｘ１＝
−Ｆｘ１＋Ｆｙ１−Ｆｘ２＋Ｆｙ２＋Ｆｘ３−Ｆｙ３＋Ｆｘ４−Ｆｙ４  …（１）
【００５９】
次に、第２力センサー２２２の出力から、以下の式（２）に基づき、第２並進力成分ｆｘ２を算出する。
【００６０】
ｆｘ２＝
−Ｆｘ５＋Ｆｙ５−Ｆｘ６＋Ｆｙ６＋Ｆｘ７−Ｆｙ７＋Ｆｘ８−Ｆｙ８  …（２）
【００６１】
次に、ステップＳ２として、算出した第１並進力成分ｆｘ１および第２並進力成分ｆｘ２に基づき、第１力センサー２２１または第２力センサー２２２が異常であるか否かを判断する。具体的には、仮想直線上成分演算部５４で算出した第１並進力成分ｆｘ１および第２並進力成分ｆｘ２を、センサー異常判断部５５に入力する。センサー異常判断部５５では、第１並進力成分ｆｘ１と第２並進力成分ｆｘ２との差｜ｆｘ１−ｆｘ２｜を算出するとともに、記憶部５２に記憶されている閾値を読み出す。この閾値には、一例として、過去に取得したデータに基づいて、実際に異常があった場合に発生していた差の最小値のような、実績値に基づく値を採用するようにすればよい。また、この差は、絶対値として求められる。そして、算出した差が閾値を超えているか否かを判断する。
【００６２】
算出した差｜ｆｘ１−ｆｘ２｜が閾値以下である場合、第１力センサー２２１および第２力センサー２２２は、いずれも正常であると判断する。具体的には、第１力センサー２２１および第２力センサー２２２は、いずれも前述した第１部材２１１と第２部材２１２とに挟まれているため、力検出部２１に力が加わったとき、第１力センサー２２１および第２力センサー２２２の双方が正常であれば、第１並進力成分ｆｘ１および第２並進力成分ｆｘ２は互いにほぼ等しくなる。このため、差｜ｆｘ１−ｆｘ２｜が閾値以下であれば、第１力センサー２２１および第２力センサー２２２がいずれも正常であると判断することができる。この場合、ステップＳ１に戻す。
【００６３】
一方、算出した差｜ｆｘ１−ｆｘ２｜が閾値を超えている場合、第１力センサー２２１または第２力センサー２２２のいずれかが異常であると判断する。例えば第１力センサー２２１が正常であり、第２力センサー２２２に異常が発生している場合、第１並進力成分ｆｘ１は本来の値を示すのに対し、第２並進力成分ｆｘ２は本来の値から逸脱する。このため、差｜ｆｘ１−ｆｘ２｜が大きくなって閾値を超えることになる。センサー異常判断部５５では、それをもって第１力センサー２２１または第２力センサー２２２のいずれかが異常であると判断することができる。センサー異常判断部５５は、このような判断をした場合、それに基づく信号を制御部５１に出力する。
【００６４】
なお、センサー異常判断部５５における演算では、第１並進力成分ｆｘ１と第２並進力成分ｆｘ２との差に代えて、例えば、第２並進力成分ｆｘ２に対する第１並進力成分ｆｘ１の比を算出し、この比が閾値を超えているか否かを判断するようにしてもよい。
【００６５】
このような信号を受けた制御部５１は、ステップＳ３として、ロボットアーム１０やエンドエフェクター１７の動作を制限する。これにより、力検出部２１が正常でない状態で、ロボットアーム１０等が動作してしまうことを防止することができる。その結果、意図しない動作に伴う対象物への損傷やその他の不具合の発生を防止することができる。
【００６６】
なお、ステップＳ２後の制御は、上述したステップＳ３に限定されない。例えば、ステップＳ２後、第１力センサー２２１または第２力センサー２２２のいずれかが異常である旨の警告を発報するようにしてもよい。
【００６７】
一方、外力演算部５６では、第１力センサー２２１の出力と第２力センサー２２２の出力とに基づき、合成力を算出する。第１力センサー２２１の出力のみまたは第２力センサー２２２の出力のみから力を算出するのではなく、双方を用いて合成力を算出することにより、高い精度で力を算出することができる。その結果、ロボット１の動作の安定化や位置決め精度の向上を図ることができる。
【００６８】
ここで、合成力の算出例について説明する。
図７は、図４に示す力検出部に合成力座標系を追記した図である。算出する合成力は、第１力センサー２２１と第２力センサー２２２との間に設定されたｘ’軸、ｙ’軸およびｚ’軸からなる合成力座標系における力として求められる。
【００６９】
図７に示す合成力座標系は、第１センサー座標系の原点である中心Ｏ１と第２センサー座標系の原点である中心Ｏ２との中点を原点とし、前述したｚ１軸およびｚ２軸に平行なｚ’軸と、前述したｘ軸に等しいｘ’軸と、前述したｙ１軸およびｙ２軸に平行なｙ’軸と、で構成された３軸直交座標系である。このとき、中心Ｏ１と中点との距離Ｌ、および、中心Ｏ２と中点との距離Ｌは、互いに等しい。
【００７０】
また、６軸力覚センサーである第１力センサー２２１からは、前述したように、第１センサー座標系のｘ軸、ｙ１軸、およびｚ１軸についての並進力（ｆｘ１，ｆｙ１，ｆｚ１）、ならびに、ｘ軸まわり、ｙ１軸まわり、およびｚ１軸まわりのモーメント（ｍｘ１，ｍｙ１，ｍｚ１）を力覚値として出力する。なお、この力覚値は、前述した４つのセンサーユニット２２１１〜２２１４からの出力に基づいて既知の方法で算出される。
【００７１】
同様に、６軸力覚センサーである第２力センサー２２２からは、前述したように、第２センサー座標系のｘ軸、ｙ２軸、およびｚ２軸についての並進力（ｆｘ２，ｆｙ２，ｆｚ２）、ならびに、ｘ軸まわり、ｙ２軸まわり、およびｚ２軸まわりのモーメント（ｍｘ２，ｍｙ２，ｍｚ２）を力覚値として出力する。なお、この力覚値は、前述した４つのセンサーユニット２２２１〜２２２４からの出力に基づいて既知の方法で算出される。
【００７２】
そして、外力演算部５６では、以下の式（３）〜（８）に基づき、上述した力覚値から、合成力座標系における合成力を算出する。この合成力は、ｘ’軸についての並進力ｆｘ’、ｙ’軸についての並進力ｆｙ’、ｚ’軸について並進力ｆｚ’、ｘ’軸まわりのモーメントｍｘ’、ｙ’軸まわりのモーメントｍｙ’、およびｚ’軸まわりのモーメントｍｚ’として算出される。
【００７３】
ｆｘ’＝ｆｘ１＋ｆｘ２  …（３）
ｆｙ’＝ｆｙ１＋ｆｙ２＋ｍｚ１／Ｌ−ｍｚ２／Ｌ  …（４）
ｆｚ’＝ｆｚ１＋ｆｚ２−ｍｙ１／Ｌ＋ｍｙ２／Ｌ  …（５）
ｍｘ’＝ｍｘ１＋ｍｘ２  …（６）
ｍｙ’＝ｆｚ１・Ｌ−ｆｚ２・Ｌ  …（７）
ｍｚ’＝−ｆｙ１・Ｌ＋ｆｙ２・Ｌ  …（８）
以上のようにして、合成力を算出することができる。
【００７４】
なお、このような合成力の算出は、必須ではなく、第１力センサー２２１からの力覚値または第２力センサー２２２からの力覚値を合成することなくそのまま外力演算部５６からの出力としてもよい。また、合成力の算出方法は、上記の方法に限定されず、いかなる方法であってもよい。また、センサー異常判断部５５において第１力センサー２２１または第２力センサー２２２が異常であると判断した場合、外力演算部５６で算出された合成力も異常値であると処理するようにしてもよい。
【００７５】
また、以上のような第１力センサー２２１および第２力センサー２２２は、第１部材２１１と第２部材２１２との間に配置されているが、第１部材２１１および第２部材２１２は、それぞれ実質的に剛体であることが好ましい。これにより、力検出部２１に力が加わったとき、第１力センサー２２１および第２力センサー２２２に対して同等の力が伝達する。このため、上述したようにして第１並進力成分ｆｘ１と第２並進力成分ｆｘ２との差｜ｆｘ１−ｆｘ２｜に基づいた第１力センサー２２１または第２力センサー２２２の異常判断を可能にしたり、合成力の算出を可能にする。
【００７６】
なお、第１部材２１１および第２部材２１２の構成材料としては、例えば、ステンレス鋼のような鉄系合金、アルミニウム系合金、銅系合金等が挙げられる。
【００７７】
また、第１部材２１１および第２部材２１２の鉛直方向における長さ、すなわち第１部材２１１および第２部材２１２の厚さは、構成材料や大きさ等に応じて若干異なるが、一例として３ｍｍ以上であるのが好ましく、５ｍｍ以上５０ｍｍ以下であるのがより好ましい。構成材料によって異なるものの、例えば上記のような構成材料の場合、第１部材２１１および第２部材２１２の厚さが前記範囲内であれば、第１部材２１１および第２部材２１２を剛体とみなすことができる。
【００７８】
以上のように、ロボット１の異常検出方法は、ロボットアーム１０と、基台１１０と被設置部である床面との間に配置されている第１部材２１１および第２部材２１２と、第１部材２１１および第２部材２１２の双方に接して、基台１１０と被設置部とが並ぶ方向を法線とする平面Ｆに配置されている第１力センサー２２１および第２力センサー２２２と、を有するロボット１の異常を検出する方法である。そして、この異常検出方法は、第１力センサー２２１の出力から仮想直線ＶＬ上における並進力成分を第１並進力成分ｆｘ１として求め、第２力センサー２２２の出力から仮想直線ＶＬ上における並進力成分を第２並進力成分ｆｘ２として求めるステップＳ１と、第１並進力成分ｆｘ１と第２並進力成分ｆｘ２との差が閾値を超えているか否かを判断し、閾値を超えている場合、第１力センサー２２１または第２力センサー２２２が異常であると判断するステップＳ２と、を含む。
【００７９】
このような異常検出方法によれば、力検出部２１における異常の有無を判断し、異常があった場合には信号を出力する。これにより、早期に異常を検出することができ、ロボットアーム１０の駆動を制限するといった制御を行うことができる。また、このような力検出部２１では、前述したように第１力センサー２２１および第２力センサー２２２の双方を平面Ｆ上に載置している。このため、力検出部２１の剛性が低下しにくくなり、ロボット１の位置決め精度の低下を防止することができる。
【００８０】
また、ロボット１は、ロボットアーム１０と、基台１１０と被設置部である床面との間に配置されている第１部材２１１および第２部材２１２と、第１部材２１１および第２部材２１２の双方に接して、基台１１０と被設置部とが並ぶ方向を法線とする平面Ｆに配置されている第１力センサー２２１および第２力センサー２２２と、第１力センサー２２１の出力から仮想直線ＶＬ上における並進力成分を第１並進力成分ｆｘ１として求め、第２力センサー２２２の出力から仮想直線ＶＬ上における並進力成分を第２並進力成分ｆｘ２として求める仮想直線上成分演算部５４と、第１並進力成分ｆｘ１と第２並進力成分ｆｘ２との差に基づいて、第１力センサー２２１または第２力センサー２２２が異常であると判断した場合、信号を出力するセンサー異常判断部５５と、を有する。
【００８１】
このようなロボット１によれば、従来のように第１力センサー２２１と第２力センサー２２２とを重ねるように配置するのではなく、第２部材２１２の上面２１２ａ、すなわち平面Ｆ上に第１力センサー２２１および第２力センサー２２２が併設されている。このため、従来に比べて、力検出部２１の剛性を高めることができる。その結果、ロボット１の動作に伴う力検出部２１の変形が抑制され、ロボット１の位置決め精度の向上を図ることができる。
【００８２】
また、このような効果と併せて、力検出部２１による力の検出とともに、第１力センサー２２１または第２力センサー２２２の異常を判断することが可能になる。
【００８３】
したがって、制御装置５０が有する制御部５１は、センサー異常判断部５５からの信号を受けて、ロボットアーム１０の駆動を制限する。これにより、力検出部２１に異常が発生している状態でロボット１が動作しないよう、ロボット１の動作を制限することが可能になる。その結果、意図しない動作に伴う対象物への損傷やその他の不具合、例えば位置決め精度の低下を防止することができる。
【００８４】
また、制御装置５０が有する外力演算部５６は、第１力センサー２２１の出力と第２力センサー２２２の出力とに基づき、合成力を算出する。これにより、第１力センサー２２１および第２力センサー２２２に加わる力を、より高い精度で求めることができる。その結果、ロボット１の動作の安定化や位置決め精度の向上を図ることができる。
【００８５】
また、第１力センサー２２１および第２力センサー２２２の測定原理としては、例えば、圧電方式、歪みゲージ方式、静電容量方式等が挙げられる。このうち、圧電方式が好ましく用いられ、特に本実施形態のような水晶を用いた圧電方式がより好ましく用いられる。すなわち、第１力センサー２２１および第２力センサー２２２は、それぞれ水晶を有するセンサーであるのが好ましい。このような水晶を用いたセンサーは、幅広い大きさの力に対して特に正確な電荷量を発生させるため、高感度とワイドレンジとを両立させやすい。このため、ロボット１に用いられる第１力センサー２２１および第２力センサー２２２として有用である。
【００８６】
また、第１力センサー２２１および第２力センサー２２２は、それぞれ３軸力覚センサーであってもよいが、６軸力覚センサーであるのが好ましい。これにより、３軸の並進力と３軸まわりのモーメントとを求めることができる。このため、力検出部２１に加わる力をより精度よく求めることができる。
【００８７】
また、本実施形態では、前述したようにｘ軸を仮想直線ＶＬとして設定しているが、仮想直線ＶＬはこのような設定に限定されず、任意に引かれた直線とされる。ただし、仮想直線ＶＬは、好ましくは第１力センサー２２１または第２力センサー２２２を通過する直線とされ、より好ましくはセンサーユニット２２１１〜２２１４やセンサーユニット２２２１〜２２２４に含まれる水晶板における出力Ｆｘの向き、出力Ｆｙの向き、および出力Ｆｚの向きのいずれとも非平行である直線とされる。すなわち、第１力センサー２２１の出力軸および第２力センサー２２２の出力軸は、それぞれ仮想直線ＶＬと非平行であるのが好ましい。
【００８８】
これにより、第１並進力成分ｆｘ１を算出するための出力Ｆｘ１、出力Ｆｙ１、出力Ｆｘ２、出力Ｆｙ２、出力Ｆｘ３、出力Ｆｙ３、出力Ｆｘ４および出力Ｆｙ４は、いずれもゼロでない値を示すことになる。同様に、第２並進力成分ｆｘ２を算出するための出力Ｆｘ５、出力Ｆｙ５、出力Ｆｘ６、出力Ｆｙ６、出力Ｆｘ７、出力Ｆｙ７、出力Ｆｘ８および出力Ｆｙ８も、いずれもゼロでない値を示すことになる。このため、前述した第１並進力成分ｆｘ１と第２並進力成分ｆｘ２との差｜ｆｘ１−ｆｘ２｜は、センサーユニット２２１１〜２２１４やセンサーユニット２２２１〜２２２４に含まれる水晶板のうち、より多くの結晶方位から出力された値を反映したものとなる。その結果、前述したようにして第１力センサー２２１または第２力センサー２２２が異常であるか否かを判断するステップＳ２は、水晶板におけるより多くの結晶方位からの出力に基づいてその健全性を判断することになる。したがって、異常を見逃す可能性を減らすことができ、ロボット１の信頼性をより高めることができる。
【００８９】
なお、前述した出力軸とは、例えば水晶を含むセンサーの場合には、水晶の結晶方位によって決まる、歪みを検出可能な軸のことをいう。その他の検出原理においても、同様に、力を検出可能な軸のことをいう。
【００９０】
＜第２実施形態＞
図８は、本発明の第２実施形態に係るロボットに含まれる力検出部を示す分解斜視図である。図９は、図８に示す力検出部２１を鉛直上方から見た図である。
【００９１】
以下、第２実施形態について、前述した実施形態との相違点を中心に説明し、同様の事項については、その説明を省略する。なお、図８および図９において、前述した第１実施形態と同様の構成には、同一符号を付してある。
【００９２】
第２実施形態は、図８に示すように、第１力センサー２２１および第２力センサー２２２に加え、第３力センサー２２３および第４力センサー２２４を備えている以外、第１実施形態と同様である。すなわち、ロボット１は、さらに、第３力センサー２２３および第４力センサー２２４をさらに有する。
【００９３】
これらの第３力センサー２２３および第４力センサー２２４も、第１力センサー２２１および第２力センサー２２２とともに、第１部材２１１と第２部材２１２との間に配置され、鉛直方向を法線とする平面Ｆ上に並べられている。
【００９４】
このようにして４つのセンサーを備えることにより、ロボット１の安定性を図ることができる。すなわち、４つのセンサーを備えることにより、第１実施形態に比べて第１部材２１１と第２部材２１２との接続点数を増やすとともに、接続点の分布範囲を広げることができるので、力検出部２１Ａの剛性が高くなる。このため、ロボット１の動作に伴う力検出部２１Ａの変形が抑えられ、位置決め精度のさらなる向上を図ることができる。
【００９５】
図９に示す第１力センサー２２１は、第１実施形態とほぼ同様であるものの、図９に示す第１センサー座標系のｘ１軸、ｙ１軸、およびｚ１軸についての並進力、ならびに、ｘ１軸まわり、ｙ１軸まわり、およびｚ１軸まわりのモーメントを求めることができる点で相違している。
【００９６】
また、図９に示す第２力センサー２２２も、第１実施形態とほぼ同様であるものの、図９に示す第２センサー座標系のｘ１軸、ｙ２軸、およびｚ２軸についての並進力、ならびに、ｘ１軸まわり、ｙ２軸まわり、およびｚ２軸まわりのモーメントを求めることができる点で相違している。
【００９７】
なお、第１センサー座標系におけるｘ１軸と、第２センサー座標系におけるｘ１軸は、互いに共通である。
【００９８】
一方、図９に示す第３力センサー２２３は、筐体２２３０と、筐体２２３０内に設けられた４つのセンサーユニット２２３１〜２２３４と、を備える６軸力覚センサーである。そして、これらのセンサーユニット２２３１〜２２３４からの出力に所定の演算処理を施すことにより、図９に示す第３センサー座標系のｘ３軸、ｙ１軸、およびｚ３軸についての並進力、ならびに、ｘ３軸まわり、ｙ１軸まわり、およびｚ３軸まわりのモーメントを求めることができる。
【００９９】
センサーユニット２２３１〜２２３４の構成は、例えばセンサーユニット２２１１〜２２１４の構成と同様である。
【０１００】
また、図９に示すように、４つのセンサーユニット２２３１〜２２３４は、中心Ｏ３まわりに等角度間隔で配置されている。
【０１０１】
また、図９に示す第４力センサー２２４は、筐体２２４０と、筐体２２４０内に設けられた４つのセンサーユニット２２４１〜２２４４と、を備える６軸力覚センサーである。そして、これらのセンサーユニット２２４１〜２２４４からの出力に所定の演算処理を施すことにより、図９に示す第４センサー座標系のｘ３軸、ｙ２軸、およびｚ４軸についての並進力、ならびに、ｘ３軸まわり、ｙ２軸まわり、およびｚ４軸まわりのモーメントを求めることができる。
【０１０２】
センサーユニット２２４１〜２２４４の構成は、例えばセンサーユニット２２１１〜２２１４の構成と同様である。
【０１０３】
また、図９に示すように、４つのセンサーユニット２２４１〜２２４４は、中心Ｏ４まわりに等角度間隔で配置されている。
【０１０４】
なお、第３センサー座標系におけるｘ３軸と、第４センサー座標系におけるｘ３軸は、互いに共通である。
【０１０５】
また、第１センサー座標系におけるｙ１軸と、第３センサー座標系におけるｙ１軸は、互いに共通である。
【０１０６】
さらに、第２センサー座標系におけるｙ２軸と、第４センサー座標系におけるｙ２軸は、互いに共通である。
【０１０７】
また、図９では、センサーユニット２２１１とセンサーユニット２２１４との間、および、センサーユニット２２１２とセンサーユニット２２１３との間、ならびに、センサーユニット２２２１とセンサーユニット２２２４との間、および、センサーユニット２２２２とセンサーユニット２２２３との間を、それぞれｘ１軸が通過している。
【０１０８】
また、図９では、センサーユニット２２３１とセンサーユニット２２３４との間、および、センサーユニット２２３２とセンサーユニット２２３３との間、ならびに、センサーユニット２２４１とセンサーユニット２２４４との間、および、センサーユニット２２４２とセンサーユニット２２４３との間を、それぞれｘ３軸が通過している。
【０１０９】
また、図９では、センサーユニット２２１１とセンサーユニット２２１２との間、および、センサーユニット２２１３とセンサーユニット２２１４との間、ならびに、センサーユニット２２３１とセンサーユニット２２３２との間、および、センサーユニット２２３３とセンサーユニット２２３４との間を、それぞれｙ１軸が通過している。
【０１１０】
また、図９では、センサーユニット２２２１とセンサーユニット２２２２との間、および、センサーユニット２２２３とセンサーユニット２２２４との間、ならびに、センサーユニット２２４１とセンサーユニット２２４２との間、および、センサーユニット２２４３とセンサーユニット２２４４との間を、それぞれｙ２軸が通過している。
【０１１１】
以上のような力検出部２１Ａにおいても、第１実施形態と同様にして力センサーに異常があるか否かを判断することができ、力検出部２１Ａの異常を早期に捉えることができる。その結果、ロボット１の信頼性をより高めることができる。
【０１１２】
なお、異常の判断にあたっては、例えば４つのセンサーから任意に２つずつを選択し、その２組のセンサーについて第１実施形態と同様にして並進力成分の差が閾値を超えているか否かに基づいて判断することができる。
【０１１３】
例えば、図９では、第１力センサー２２１、第２力センサー２２２、第３力センサー２２３および第４力センサー２２４が、正方形の角に位置するように配置されている。そして、ｘ１軸を仮想直線ＶＬ１として設定するとともに、ｘ３軸を仮想直線ＶＬ３として設定している。
【０１１４】
その上で、図９に示す力検出部２１Ａでは、第１力センサー２２１と第２力センサー２２２を１組とし、第３力センサー２２３と第４力センサー２２４を別の１組とする。そして、各組において、それぞれ第１実施形態と同様にして仮想直線ＶＬ１、ＶＬ３上の並進力成分の差を算出し、それに基づいてセンサーに異常があるか否かを判断する。これにより、４つのセンサーを用いた場合でも、４つのセンサーのうちのいずれかが異常であると早期に判断することができる。
【０１１５】
なお、この場合、組み合わせを変えながら上記判断を繰り返すことによって、４つのセンサーのうちのいずれが異常であるかを特定することもできる。このため、単にいずれかのセンサーに異常があるという判断のみでなく、その異常がどのセンサーに発生しているのかについても特定することが可能になる。その結果、センサーの交換や修理といった作業を容易に行うことができる。
【０１１６】
また、力検出部２１Ａによる力の検出値についても、より精度よく検出することができる。なお、合成力の算出においても、例えば４つのセンサーのうち、２つのセンサーからなる組を２組選択し、その各組についてそれぞれ第１実施形態と同様にして合成力を算出するようにすればよい。その後、必要に応じて、各組において算出した合成力を平均する演算またはその他の演算に供するようにしてもよい。
【０１１７】
また、力検出部２１Ａにおいても、第１力センサー２２１の出力軸および第２力センサー２２２の出力軸は、それぞれ仮想直線ＶＬ１と非平行であり、第３力センサー２２３の出力軸および第４力センサー２２４の出力軸は、それぞれ仮想直線ＶＬ３と非平行である。このため、力検出部２１Ａは、異常を見逃す可能性を減らすことができ、ロボット１の信頼性をより高めることができる。
【０１１８】
次に、力検出部２１Ａの変形例である力検出部２１Ｂについて説明する。
図１０は、図９に示す力検出部２１Ａの変形例を示す図である。なお、図１０において、前述した第２実施形態と同様の構成には、同一符号を付してある。また、同様の事項については、その説明を省略する。
【０１１９】
図１０に示す第１力センサー２２１は、第１実施形態と同様である。
また、図１０に示す第２力センサー２２２は、第１実施形態とほぼ同様であるものの、図１０に示す第２センサー座標系のｘ２軸、ｙ２軸、およびｚ２軸についての並進力、ならびに、ｘ２軸まわり、ｙ２軸まわり、およびｚ２軸まわりのモーメントを求めることができる点で相違している。
【０１２０】
図１０に示す第３力センサー２２３は、図１０に示す第３センサー座標系のｘ２軸、ｙ３軸、およびｚ３軸についての並進力、ならびに、ｘ２軸まわり、ｙ１軸まわり、およびｚ３軸まわりのモーメントを求めることができる。
【０１２１】
また、図１０に示す第４力センサー２２４は、図１０に示す第４センサー座標系のｘ１軸、ｙ４軸およびｚ４軸についての並進力、ならびに、ｘ１軸まわり、ｙ４軸まわり、およびｚ４軸まわりのモーメントを求めることができる。
【０１２２】
そして、第１センサー座標系におけるｘ１軸と、第４センサー座標系におけるｘ１軸は、互いに共通である。
【０１２３】
また、第２センサー座標系におけるｘ２軸と、第３センサー座標系におけるｘ２軸は、互いに共通である。
【０１２４】
以上のような力検出部２１Ｂにおいても、その剛性を高めることができ、ロボット１の位置決め精度のさらなる向上を図ることができる。また、力検出部２１Ａと同様にして力センサーに異常があるか否かを判断することができ、力検出部２１Ｂの異常を早期に捉えることができる。その結果、ロボット１の信頼性をより高めることができる。
【０１２５】
なお、異常の判断にあたっては、例えば４つのセンサーから任意に２つずつを選択し、その２組のセンサーについて第１実施形態と同様にして並進力成分の差が閾値を超えているか否かに基づいて判断することができる。
【０１２６】
例えば、図１０では、第１力センサー２２１、第２力センサー２２２、第３力センサー２２３および第４力センサー２２４が、正方形の角に位置するように配置されている。そして、ｘ１軸を仮想直線ＶＬ１として設定するとともに、ｘ２軸を仮想直線ＶＬ２として設定している。
【０１２７】
その上で、図１０に示す力検出部２１Ｂでは、第１力センサー２２１と第４力センサー２２４を１組とし、第２力センサー２２２と第３力センサー２２３を別の１組とする。そして、各組において、それぞれ第１実施形態と同様にして仮想直線ＶＬ１、ＶＬ２上の並進力成分の差を算出し、それに基づいてセンサーに異常があるか否かを判断する。これにより、４つのセンサーを用いた場合でも、４つのセンサーのうちのいずれかが異常であると早期に判断することができる。
【０１２８】
また、力検出部２１Ｂによる力の検出値についても、より精度よく検出することができる。すなわち、力検出部２１Ｂから求められる合成力は、力検出部２１Ａから求められる合成力に比べて、より精度の高いものとなる。これは、力検出部２１Ｂにおける合成力座標系が、前述した正方形の中心に原点を持つ座標系となるためである。すなわち、力検出部２１Ｂから求められる合成力は、力検出部２１Ｂのほぼ中心において検出したとみなされる力として求められる。このため、力検出部２１Ｂによる力の検出値は、力検出部２１Ａによる力の検出値に比べて、より精度の高いものとなる。
【０１２９】
また、力検出部２１Ｂにおいても、第１力センサー２２１の出力軸および第４力センサー２２４の出力軸は、それぞれ仮想直線ＶＬ１と非平行であり、第２力センサー２２２の出力軸および第３力センサー２２３の出力軸は、それぞれ仮想直線ＶＬ２と非平行である。このため、力検出部２１Ｂは、異常を見逃す可能性を減らすことができ、ロボット１の信頼性をより高めることができる。
【０１３０】
以上のような第２実施形態によっても、前述した第１実施形態と同様の効果を発揮させることができる。
【０１３１】
なお、４つのセンサーの配置は、図示したものに限定されず、いかなる配置であってもよい。
【０１３２】
以上、本発明のロボットおよびロボットの異常検出方法を、図示の実施形態に基づいて説明したが、本発明はこれに限定されるものではなく、各部の構成は、同様の機能を有する任意の構成のものに置換することができる。また、本発明に、他の任意の構成物が付加されていてもよい。
【０１３３】
また、力検出部が備える力センサーの数は、２つや４つに限定されず、３つや５つ以上であってもよい。
【０１３４】
また、本発明のロボットは、ロボットアームを有していれば、単腕ロボットに限定されず、例えば、双腕ロボット、スカラーロボット等の他のロボットであってもよい。また、ロボットアームが有するアームの数は、前述した実施形態の数である６つに限定されず、１つ以上５つ以下または７つ以上であってもよい。
【符号の説明】
【０１３５】
１…ロボット、１０…ロボットアーム、１１…アーム、１２…アーム、１３…アーム、１４…アーム、１５…アーム、１６…アーム、１７…エンドエフェクター、２１…力検出部、２１Ａ…力検出部、２１Ｂ…力検出部、５０…制御装置、５１…制御部、５２…記憶部、５３…Ｉ／Ｆ、５４…仮想直線上成分演算部、５５…センサー異常判断部、５６…外力演算部、１１０…基台、１３０…駆動部、１３１…角度センサー、１７０…駆動部、１７１…本体、１７２…把持部、１７３…把持力センサー、２１１…第１部材、２１１ａ…下面、２１２…第２部材、２１２ａ…上面、２２１…第１力センサー、２２２…第２力センサー、２２３…第３力センサー、２２４…第４力センサー、２２１０…筐体、２２１１…センサーユニット、２２１２…センサーユニット、２２１３…センサーユニット、２２１４…センサーユニット、２２２０…筐体、２２２１…センサーユニット、２２２２…センサーユニット、２２２３…センサーユニット、２２２４…センサーユニット、２２３０…筐体、２２３１…センサーユニット、２２３２…センサーユニット、２２３３…センサーユニット、２２３４…センサーユニット、２２４０…筐体、２２４１…センサーユニット、２２４２…センサーユニット、２２４３…センサーユニット、２２４４…センサーユニット、ＣＧ１…重心、ＣＧ２…重心、Ｄ…方向、Ｆ…平面、Ｆｘ１…出力、Ｆｘ２…出力、Ｆｘ３…出力、Ｆｘ４…出力、Ｆｘ５…出力、Ｆｘ６…出力、Ｆｘ７…出力、Ｆｘ８…出力、Ｆｙ１…出力、Ｆｙ２…出力、Ｆｙ３…出力、Ｆｙ４…出力、Ｆｙ５…出力、Ｆｙ６…出力、Ｆｙ７…出力、Ｆｙ８…出力、Ｌ…距離、ＮＬ…垂線、Ｏ１…中心、Ｏ２…中心、Ｏ３…中心、Ｏ４…中心、ＶＬ…仮想直線、ＶＬ１…仮想直線、ＶＬ２…仮想直線、ＶＬ３…仮想直線
【図１】
2020019067.tif 000003
【図２】
2020019067.tif 000004
【図３】
2020019067.tif 000005
【図４】
2020019067.tif 000006
【図５】
2020019067.tif 000007
【図６】
2020019067.tif 000008
【図７】
2020019067.tif 000009
【図８】
2020019067.tif 000010
【図９】
2020019067.tif 000011
【図１０】
2020019067.tif 000012