特開 2024-104305 接触検知装置

(19)【発行国】日本国特許庁(JP)

(12)【公報種別】公開特許公報(A)

(11)【公開番号】P2024104305

(43)【公開日】2024-08-05

(54)【発明の名称】接触検知装置

(51)【国際特許分類】

   B25J 19/06 20060101AFI20240729BHJP

【ＦＩ】

B25J19/06

【審査請求】未請求

【請求項の数】3

【出願形態】ＯＬ

(21)【出願番号】P 2021096598

(22)【出願日】2021-06-09

(71)【出願人】

【識別番号】000003388

【氏名又は名称】東京計器株式会社

(74)【代理人】

【識別番号】100101856

【弁理士】

【氏名又は名称】赤澤 日出夫

(72)【発明者】

【氏名】東 孝行

(72)【発明者】

【氏名】大塚 麻美

【テーマコード（参考）】

3C707

【Ｆターム（参考）】

3C707BS09

3C707DS01

3C707ES03

3C707ET03

3C707EU02

3C707HS27

3C707KS21

3C707MS07

(57)【要約】

【課題】より低コストで被駆動部材と対象物との接触を検知する接触検知装置を提供する。
【解決手段】回転力を発生させる回転駆動部により回転可能または揺動可能に設けられた被駆動部材による対象物への接触を検知する接触検知装置１４であって、回転駆動部を所定のトルクにより回転駆動させる駆動制御部１５１と、回転センサにより測定された回転駆動部の回転角度を周期的に取得する駆動監視部１５２と、取得された回転角度に基づく回転角度の変化がゼロである場合、被駆動部材が対象物に接触したと判定する接触判定部１５３とを備える。
【選択図】図２

【特許請求の範囲】

【請求項1】

回転力を発生させる回転駆動部により回転可能または揺動可能に設けられた被駆動部材による対象物への接触を検知する接触検知装置であって、
前記回転駆動部を所定のトルクにより回転駆動させる駆動制御部と、
回転センサにより測定された前記回転駆動部の回転角度を周期的に取得する駆動監視部と、
前記取得された回転角度に基づく回転角度の変化がゼロである場合、前記被駆動部材が前記対象物に接触したと判定する接触判定部と
を備える接触検知装置。

【請求項2】

前記被駆動部材は、略円形に形成され、前記回転駆動部により円中心周りに回転されることを特徴とする請求項１に記載の接触検知装置。

【請求項3】

前記被駆動部材は、一方向に延在するように形成され、前記回転駆動部により一端部を支点として揺動されることを特徴とする請求項１に記載の接触検知装置。

【発明の詳細な説明】

【技術分野】

【0001】

本発明は、接触を検知する技術に関する。

【背景技術】

【0002】

従来、モータにより駆動される被駆動部材の対象物への接触検知は、接触センサ、トルクセンサ、電流検出などによりなされていた。接触センサは被駆動部材において対象物との接触により生じる物理的変位を検知することにより接触を検知する。トルクセンサは、モータにおけるトルクの増加を検出することにより接触を検知する。電流検出は、モータにおける電流の増加を検出することにより接触を検知する。

【0003】

また、関連する技術として、基台の上部に３軸以上の多関節を有するロボットの外部接触２重チェック装置において、ロボットと外部との接触を検知する相互に独立した第１検知手段及び、第２検知手段の２つの検知手段を有し、第１検知手段は多関節のうち第１軸と第２軸と第３軸に設けた３つのトルクセンサによる第１系統であり、第２検知手段は基台の設置部に設けた３自由度力トルクセンサによる第２系統であり、第１検知手段及び第２検知手段から得られる検知信号により、ロボットを安全に制御することを特徴とするロボットの外部接触２重チェック装置、が知られている（特許文献１参照）。

【先行技術文献】

【特許文献】

【0004】

【特許文献1】特開２０１９－４２９０６号公報

【発明の概要】

【発明が解決しようとする課題】

【0005】

接触センサ、トルクセンサ、電流検出のそれぞれによる接触検知によれば、被駆動部材またはモータに対して追加の専用部品や専用回路が必要となるため、コストが増大する、という問題がある。

【0006】

本発明の実施形態は、より低コストで被駆動部材と対象物との接触を検知する接触検知装置を提供することを目的とする。

【課題を解決するための手段】

【0007】

上述した課題を解決するため、本実施形態に係る接触検知装置は、回転力を発生させる回転駆動部により回転可能または揺動可能に設けられた被駆動部材による対象物への接触を検知する接触検知装置であって、前記回転駆動部を所定のトルクにより回転駆動させる駆動制御部と、回転センサにより測定された前記回転駆動部の回転角度を周期的に取得する駆動監視部と、前記取得された回転角度に基づく回転角度の変化がゼロである場合、前記被駆動部材が前記対象物に接触したと判定する接触判定部とを備える。

【発明の効果】

【0008】

本発明の実施形態によれば、より低コストで被駆動部材と対象物との接触を検知することができる。

【図面の簡単な説明】

【0009】

【図1】実施形態に係る接触検知システムのハードウェア構成を示すブロック図である。

【図2】接触検知装置の機能構成を示すブロック図である。

【図3】接触検知装置の動作を示すフローチャートである。

【図4】接触検知装置を適用したロボットハンドを示す概略図である。

【図5】接触が検知された状態におけるロボットハンドを示す概略図である。

【図6】接触検知装置を適用したロボットアームを示す概略図である。

【図7】接触が検知された状態におけるロボットアームを示す概略図である。

【図8】接触検知装置を適用した多車両連結ロボットを示す概略図である。

【図9】接触が検知された状態における多車両連結ロボットを示す概略図である。

【発明を実施するための形態】

【0010】

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

【0011】

（接触検知装置の構成）
本実施形態に係る接触検知装置のハードウェア構成及び機能構成について説明する。図１は、本実施形態に係る接触検知装置を含むシステムのハードウェア構成を示すブロック図である。

【0012】

図１に示すように、本実施形態に係る接触検知システム１は、ハードウェアとして、回転駆動部１１と、回転センサ１２と、被駆動部材１３と、回転駆動部１１及び回転センサ１２と通信可能に接続される接触検知装置１４とを備える。回転駆動部１１は、後に詳述する被駆動部材１３を回転または揺動させる回転駆動力を出力するものであり、例えば回転モータである。回転センサ１２は、回転駆動部１１の回転角度を測定するセンサである。被駆動部材１３は、回転駆動部１１により回転可能または揺動可能に設けられた部材である。

【0013】

なお、回転駆動部１１と回転センサ１２とは、回転駆動部１１から被駆動部材１３に一方的に回転力が伝達されるのではなく、互いに回転力が伝達されるように接続されているものとする。

【0014】

接触検知装置１４は、ハードウェアとして、各種機能を実現するＣＰＵ（Ｃｅｎｔｒａｌ Ｐｒｏｃｅｓｓｉｎｇ Ｕｎｉｔ）１４１とメモリ１４２とを備える。また、接触検知装置１４は、図２に示すように、ＣＰＵ１４１及びメモリ１４２により実現される機能として、駆動制御部１５１、駆動監視部１５２、接触判定部１５３を備える。

【0015】

駆動制御部１５１は、所定のトルクで回転するように回転駆動部１１を駆動制御する。駆動監視部１５２は、回転センサ１２により測定された回転駆動部１１の回転角度を周期的に取得する。接触判定部１５３は、駆動監視部１５２により取得された回転駆動部１１の回転角度に基づいて、被駆動部材１３が対象物に接触しているか否かを判定する。

【0016】

（接触検知装置の動作）
接触検知装置の動作について説明する。図３は、接触検知装置の動作を示すフローチャートである。なお、図３に示す動作は、所定の周期毎に実行されるものとする。

【0017】

図３に示すように、まず、駆動制御部１５１は、所定のトルク、具体的には被駆動部材１３が対象物に接触した場合に停止する程度に低く設定されたトルクにより回転駆動部１１を駆動制御する（Ｓ１０１）。次に、駆動監視部１５２は、回転センサ１２により測定された、駆動制御部１５１により駆動制御された状態における回転駆動部１１の回転角度を取得する（Ｓ１０２）。

【0018】

次に、接触判定部１５３は、駆動監視部１５２により取得された回転角度に関して、回転角度変化、即ち、前周期の回転角度と現周期の回転角度との差がゼロであるか否かを判定する（Ｓ１０３）。

【0019】

回転角度変化がゼロである場合（Ｓ１０３，ＹＥＳ）、接触判定部１５３は、被駆動部材１３が対象物に接触していると判定し（Ｓ１０４）、再度、駆動制御部１５１が回転駆動部１１を駆動制御する（Ｓ１０１）。

【0020】

一方、回転角度変化がゼロではない場合（Ｓ１０３，ＮＯ）、接触判定部１５３は、被駆動部材１３が対象物に接触していないと判定し（Ｓ１０５）、再度、駆動制御部１５１が回転駆動部１１を駆動制御する（Ｓ１０１）。

【0021】

このような接触検知装置１４によれば、回転駆動部１１と回転センサ１２とを備えたサーボモータに他のハードウェアを追加することなく接触検知を行うことができる。これによって、サーボモータを用いた装置において、コスト、重量が増加させることなく接触判定を行うことができる。また、接触検知装置１４に含まれる各機能についても、回転駆動部１１、回転センサ１２、被駆動部材１３を含む装置全体を制御する他の制御装置上で実現することができる。

【0022】

（第１の適用例）
第１の適用例として、接触検知装置を適用したロボットハンドについて説明する。図４は、接触検知装置を適用したロボットハンドを示す概略図である。図５は、接触が検知された状態におけるロボットハンドを示す概略図である。

【0023】

図４に示すように、第１の適用例に係るロボットハンド２は、対象物Ｏを把持可能に構成された装置であり、回転駆動部１１及び回転センサ１２に相当するサーボモータ２１と、被駆動部材１３に相当する２つのグリッパ２３ａ，２３ｂと、２つの伝達ギヤ２６ａ，２６ｂと、サーボモータ２１と通信可能に接続される接触検知装置１４とを備える。

【0024】

２つのグリッパ２３ａ，２３ｂは、それぞれ、全体として、一方向に延在する略棒状に形成された部材であり、一端部を支点として揺動可能に設けられる。伝達ギヤ２６ａは、サーボモータ２１により回転されるように設けられたギヤであり、伝達ギヤ２６ｂは、伝達ギヤ２６ａと噛み合い、伝達ギヤ２６ａによりサーボモータ２１の回転が伝達されるように設けられたギヤである。グリッパ２３ａは、サーボモータ２１の回転力により直接に揺動され、グリッパ２３ｂは、伝達ギヤ２６ｂを介してサーボモータ２１の回転力により揺動される。

【0025】

図５に示すように、図５中反時計周りの回転力がサーボモータ２１に発生されることによって、２つのグリッパ２３ａ，２３ｂは、それぞれにおける揺動支点とは逆側の端部が互いに近接するように揺動される。この際、２つのグリッパ２３ａ，２３ｂが対象物Ｏに接触するとサーボモータ２１の回転角度変化がゼロとなり、接触検知装置１４により接触が検知される。

【0026】

（第２の適用例）
第２の適用例として、接触検知装置を適用したロボットアームについて説明する。図６は、接触検知装置を適用したロボットアームを示す概略図である。図７は、接触が検知された状態におけるロボットアームを示す概略図である。

【0027】

図６に示すように、第２の適用例に係るロボットアーム３は、一部分が対象物Ｏに接触可能に構成された装置であり、第１アーム３０と、回転駆動部１１及び回転センサ１２に相当するサーボモータ３１と、被駆動部材１３に相当する第２アーム３３と、サーボモータ３１と通信可能に接続される接触検知装置１４とを備える。

【0028】

第１アーム３０、第２アーム３３は、それぞれ、全体として一方向に延在する略棒状に形成された部材である。第１アーム３０は、下端部がロボットアーム３の接地面に載置された基台に接続され、上端部にサーボモータ３１が設けられる。第２アーム３３は、一端部を支点としてサーボモータ３１の回転力により揺動可能に設けられる。

【0029】

図７に示すように、図７中反時計回りの回転力がサーボモータ３１により発生されることによって、第２アーム３３が揺動されて対象物Ｏに接触すると、サーボモータ３１の回転角度変化がゼロとなり、接触検知装置１４により接触が検知される。

【0030】

（第３の適用例）
第３の適用例として接触検知装置を適用した多車両連結ロボットについて説明する。図８は、接触検知装置を適用した多車両連結ロボットを示す概略図である。図９は、接触が検知された状態における多車両連結ロボットを示す概略図である。

【0031】

図８に示すように、第３の適用例に係る多車両連結ロボット４は、複数の車両が進行方向に連結された移動装置であって、互いに連結される２つの車両において、後方の車両が前方の車両をピッチング可能に構成される。接触検知装置１４（図８、図９に不図示）は、多車両連結ロボット４における先頭の車両に適用され、地面と直交する壁面Ｗを接触検知対象とする。

【0032】

先頭の車両は、筐体部４０と、回転駆動部１１及び回転センサ１２に相当するサーボモータ４１と、被駆動部材１３に相当する車輪４２と、筐体部４０内に内蔵され、サーボモータ４１と通信可能に接続される接触検知装置１４とを備える。車輪４２は、地面または壁面Ｗを走行面として走行可能に構成された全体として略円形に形成された部材であり、サーボモータ４１により円中心周りに回転可能に設けられる。

【0033】

図９に示すように、図９中時計回りの回転力がサーボモータ４１により発生された状態において、多車両連結ロボット４が壁面Ｗに向かって走行し、車輪４２が壁面Ｗに当接すると、車輪４２の回転が停止される。これによって、サーボモータ４１の回転角度変化がゼロとなり、接触検知装置１４により接触が検知される。

【0034】

以上に説明したように、接触検知装置１４は、被駆動部材１３を回転または揺動させるあらゆる装置において、被駆動部材１３と対象物Ｏとの接触検知に用いることができる。

【0035】

本発明の実施形態は、例として提示したものであり、発明の範囲を限定することは意図していない。これら新規な実施形態は、その他の様々な形態で実施されることが可能であり、発明の要旨を逸脱しない範囲で、種々の省略、置き換え、変更を行うことができる。これら実施形態やその変形は、発明の範囲や要旨に含まれるとともに、特許請求の範囲に記載された発明とその均等の範囲に含まれる。

【符号の説明】

【0036】

１４ 接触検知装置
１５１ 駆動制御部
１５２ 駆動監視部
１５３ 接触判定部

【図1】

【図2】

【図3】

【図4】

【図5】

【図6】

【図7】

【図8】

【図9】