特開 2023-105694 主従ロボットシステム

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

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

(11)【公開番号】P2023105694

(43)【公開日】2023-07-31

(54)【発明の名称】主従ロボットシステム

(51)【国際特許分類】

   B25J 3/00 20060101AFI20230724BHJP

【ＦＩ】

B25J3/00 Z

【審査請求】未請求

【請求項の数】11

【出願形態】ＯＬ

(21)【出願番号】P 2022006679

(22)【出願日】2022-01-19

(71)【出願人】

【識別番号】501428545

【氏名又は名称】株式会社デンソーウェーブ

(74)【代理人】

【識別番号】100121821

【弁理士】

【氏名又は名称】山田 強

(74)【代理人】

【識別番号】100125575

【弁理士】

【氏名又は名称】松田 洋

(72)【発明者】

【氏名】山本 洋介

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

3C707

【Ｆターム（参考）】

3C707BS12

3C707HS27

3C707HT40

3C707JT04

3C707JU14

3C707KS17

3C707KS20

3C707KV01

3C707KV04

3C707KW05

3C707KW07

3C707LS02

3C707LS04

3C707LS13

3C707LU02

3C707LU06

(57)【要約】

【課題】主従ロボットシステムにおいて、主ロボットの姿勢を従ロボットの姿勢に一致させる際に、ユーザが違和感を覚えることを抑制する。
【解決手段】ユーザが加えた外力により姿勢が変更される主ロボット（２０）と、主ロボットの姿勢に一致するように姿勢が制御される従ロボット（３０）と、主ロボット及び従ロボットを制御する制御部（２６，３６）と、を備える主従ロボットシステム（１０）であって、制御部は、主ロボットの姿勢と従ロボットの姿勢とのずれを解消する際に、主ロボットを動作させる加速度を制限加速度以下に制限して、主ロボットの姿勢を従ロボットの姿勢に一致させる。
【選択図】 図１

【特許請求の範囲】

【請求項1】

ユーザが加えた外力により姿勢が変更される主ロボットと、前記主ロボットの姿勢に一致するように姿勢が制御される従ロボットと、前記主ロボット及び前記従ロボットを制御する制御部と、を備える主従ロボットシステムであって、
前記制御部は、前記主ロボットの姿勢と前記従ロボットの姿勢とのずれを解消する際に、前記主ロボットを動作させる加速度を制限加速度以下に制限して、前記主ロボットの姿勢を前記従ロボットの姿勢に一致させる、主従ロボットシステム。

【請求項2】

前記制御部は、前記主ロボットの姿勢と前記従ロボットの姿勢とのずれを解消する際に、さらに、前記主ロボットを動作させる速度を制限速度以下に制限して、前記主ロボットの姿勢を前記従ロボットの姿勢に一致させる、請求項１に記載の主従ロボットシステム。

【請求項3】

前記ユーザが前記主ロボットに前記外力を加えているか否か判定する判定部を備え、
前記制御部は、前記主ロボットの姿勢と前記従ロボットの姿勢とのずれを解消する際に、前記外力を加えていないと前記判定部により判定されたことを条件として、前記主ロボットの姿勢を前記従ロボットの姿勢に一致させる、請求項１又は２に記載の主従ロボットシステム。

【請求項4】

ユーザが加えた外力により姿勢が変更される主ロボットと、前記主ロボットの姿勢に一致するように姿勢が制御される従ロボットと、前記主ロボット及び前記従ロボットを制御する制御部と、を備える主従ロボットシステムであって、
前記ユーザが前記主ロボットに前記外力を加えているか否か判定する判定部を備え、
前記制御部は、前記主ロボットの姿勢と前記従ロボットの姿勢とのずれを解消する際に、前記外力を加えていないと前記判定部により判定されたことを条件として、前記主ロボットの姿勢を前記従ロボットの姿勢に一致させる、主従ロボットシステム。

【請求項5】

前記ユーザが前記主ロボットに触れているか否か判定する判定部を備え、
前記制御部は、前記主ロボットの姿勢と前記従ロボットの姿勢とのずれを解消する際に、前記主ロボットに触れていないと前記判定部により判定されたことを条件として、前記主ロボットの姿勢を前記従ロボットの姿勢に一致させる、請求項１又は２に記載の主従ロボットシステム。

【請求項6】

ユーザが加えた外力により姿勢が変更される主ロボットと、前記主ロボットの姿勢に一致するように姿勢が制御される従ロボットと、前記主ロボット及び前記従ロボットを制御する制御部と、を備える主従ロボットシステムであって、
前記ユーザが前記主ロボットに触れているか否か判定する判定部を備え、
前記制御部は、前記主ロボットの姿勢と前記従ロボットの姿勢とのずれを解消する際に、前記主ロボットに触れていないと前記判定部により判定されたことを条件として、前記主ロボットの姿勢を前記従ロボットの姿勢に一致させる、主従ロボットシステム。

【請求項7】

前記主ロボットの姿勢に前記従ロボットの姿勢を一致させない状態で前記ユーザが前記従ロボットの姿勢を微調整する微調整操作を可能にするとともに、前記微調整操作の履歴を記憶する微調整部を備え、
前記制御部は、前記主ロボットの姿勢と前記従ロボットの姿勢とのずれを解消する際に、前記微調整部により記憶された前記履歴における前記微調整操作の順に従って前記主ロボットの姿勢を前記従ロボットの姿勢に一致させる操作順制御を実行する、請求項１～６のいずれか１項に記載の主従ロボットシステム。

【請求項8】

ユーザが加えた外力により姿勢が変更される主ロボットと、前記主ロボットの姿勢に一致するように姿勢が制御される従ロボットと、前記主ロボット及び前記従ロボットを制御する制御部と、を備える主従ロボットシステムであって、
前記主ロボットの姿勢に前記従ロボットの姿勢を一致させない状態で前記ユーザが前記従ロボットの姿勢を微調整する微調整操作を可能にするとともに、前記微調整操作の履歴を記憶する微調整部を備え、
前記制御部は、前記主ロボットの姿勢と前記従ロボットの姿勢とのずれを解消する際に、前記微調整部により記憶された前記履歴における前記微調整操作の順に従って前記主ロボットの姿勢を前記従ロボットの姿勢に一致させる操作順制御を実行する、主従ロボットシステム。

【請求項9】

前記ユーザが前記主ロボットに前記外力を加えているか否か判定する判定部を備え、
前記制御部は、前記操作順制御の実行中に、前記外力を加えていると前記判定部により判定された場合に、前記操作順制御を中断し、前記中断の後に前記外力を加えていないと前記判定部により判定された場合に、前記操作順制御を前記中断した時点から再開する、請求項７又は８に記載の主従ロボットシステム。

【請求項10】

前記主ロボットの姿勢に前記従ロボットの姿勢を一致させない状態で前記ユーザが前記従ロボットの姿勢を微調整する微調整操作を可能にする操作器を備え、
前記制御部は、前記主ロボットの姿勢と前記従ロボットの姿勢とのずれが所定量を超えた場合にその旨を報知し、
前記操作器は、前記主ロボットの姿勢を前記従ロボットの姿勢に一致させるように前記制御部に指示可能である、請求項１～９のいずれか１項に記載の主従ロボットシステム。

【請求項11】

前記制御部は、前記ユーザが前記操作器を用いて前記微調整操作を実行している場合に、前記ユーザが加えた外力により前記主ロボットの姿勢が変更されることを禁止する、請求項１０に記載の主従ロボットシステム。

【発明の詳細な説明】

【技術分野】

【0001】

本発明は、ユーザが加えた外力により姿勢が変更される主ロボットと、主ロボットの姿勢に一致するように姿勢が制御される従ロボットと、を備える主従ロボットシステムに関する。

【背景技術】

【0002】

従来、作業者が操作した操作ロボットの姿勢に一致するように対象ロボットの姿勢を制御する直接制御モードと、検出部で検出した外力の大きさが予め設定されている閾値を超えた場合に、検出した外力の方向に予め設定されている動作単位で対象ロボットの姿勢を制御する詳細制御モードとを切り替えるロボットの教示システムがある（特許文献１参照）。特許文献１に記載の教示システムでは、詳細制御モードにおいて、操作ロボットの姿勢と対象ロボットの姿勢とが乖離している場合に、操作ロボットの姿勢を対象ロボットの姿勢に一致させている。

【先行技術文献】

【特許文献】

【0003】

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

【発明の概要】

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

【0004】

ところで、特許文献１に記載の教示システムでは、操作ロボット（主ロボット）の姿勢を対象ロボット（従ロボット）の姿勢に一致させる際に、操作ロボットの姿勢が作業者（ユーザ）の意図と異なる姿勢に急激に変えられ、作業者が違和感を覚えるおそれがある。

【0005】

本発明は、こうした課題を解決するためになされたものであり、その主たる目的は、主従ロボットシステムにおいて、主ロボットの姿勢を従ロボットの姿勢に一致させる際に、ユーザが違和感を覚えることを抑制することにある。

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

【0006】

上記課題を解決するための第１の手段は、
ユーザが加えた外力により姿勢が変更される主ロボットと、前記主ロボットの姿勢に一致するように姿勢が制御される従ロボットと、前記主ロボット及び前記従ロボットを制御する制御部と、を備える主従ロボットシステムであって、
前記制御部は、前記主ロボットの姿勢と前記従ロボットの姿勢とのずれを解消する際に、前記主ロボットを動作させる加速度を制限加速度以下に制限して、前記主ロボットの姿勢を前記従ロボットの姿勢に一致させる。

【0007】

上記構成によれば、主従ロボットシステムは、ユーザが加えた外力により姿勢が変更される主ロボットと、前記主ロボットの姿勢に一致するように姿勢が制御される従ロボットと、前記主ロボット及び前記従ロボットを制御する制御部と、を備えている。このため、ユーザが主ロボットに外力を加えて主ロボットの姿勢を変更する操作を行うことにより、従ロボットの姿勢を主ロボットの姿勢に一致させるように制御すること（以下、「主従ロボット操作」という）ができる。なお、制御部は、主ロボットに設けられて主ロボットを制御する第１制御部と、従ロボットに設けられて従ロボットを制御する第２制御部とを含んでいてもよい。また、制御部は、主ロボット又は従ロボットに設けられて、主ロボット及び従ロボットを制御する１つの制御部であってもよい。

【0008】

ここで、主ロボットの姿勢に従ロボットの姿勢を一致させない状態で従ロボットの姿勢を微調整（変更）すると、主ロボットの姿勢と従ロボットの姿勢とにずれが生じる。また、主ロボットの型式（形状）と従ロボットの型式（形状）とが異なる場合に、主従ロボット操作を実行する間に、主ロボットの姿勢と従ロボットの姿勢とにずれが生じることがある。これらの場合に、主ロボットの姿勢を従ロボットの姿勢に一致させる制御を単純に実行すると、主ロボットの姿勢がユーザの意図と異なる姿勢に急激に変えられ、ユーザが違和感を覚えるおそれがある。

【0009】

この点、前記制御部は、前記主ロボットの姿勢と前記従ロボットの姿勢とのずれを解消する際に、前記主ロボットを動作させる加速度を制限加速度以下に制限して、前記主ロボットの姿勢を前記従ロボットの姿勢に一致させる。このため、主ロボットを動作させる速度が急激に変化することを抑制することができ、ひいては主ロボットの姿勢が急激に変化することを抑制することができる。したがって、主ロボットの姿勢を従ロボットの姿勢に一致させる際に、主ロボットの姿勢がユーザの意図と異なる姿勢に変えられたとしても、ユーザが違和感を覚えることを抑制することができる。

【0010】

第２の手段では、前記制御部は、主従ロボットシステムは、前記主ロボットの姿勢と前記従ロボットの姿勢とのずれを解消する際に、さらに、前記主ロボットを動作させる速度を制限速度以下に制限して、前記主ロボットの姿勢を前記従ロボットの姿勢に一致させる。こうした構成によれば、主ロボットの速度が制限速度を超えた状態で、主ロボットの姿勢がユーザの意図と異なる姿勢に変えられることを抑制することができ、ユーザが違和感を覚えることをさらに抑制することができる。

【0011】

第３の手段では、前記ユーザが前記主ロボットに前記外力を加えているか否か判定する判定部を備え、前記制御部は、前記主ロボットの姿勢と前記従ロボットの姿勢とのずれを解消する際に、前記外力を加えていないと前記判定部により判定されたことを条件として、前記主ロボットの姿勢を前記従ロボットの姿勢に一致させる。

【0012】

第４の手段は、
ユーザが加えた外力により姿勢が変更される主ロボットと、前記主ロボットの姿勢に一致するように姿勢が制御される従ロボットと、前記主ロボット及び前記従ロボットを制御する制御部と、を備える主従ロボットシステムであって、
前記ユーザが前記主ロボットに前記外力を加えているか否か判定する判定部を備え、
前記制御部は、前記主ロボットの姿勢と前記従ロボットの姿勢とのずれを解消する際に、前記外力を加えていないと前記判定部により判定されたことを条件として、前記主ロボットの姿勢を前記従ロボットの姿勢に一致させる。

【0013】

上記構成によれば、前記主ロボットの姿勢と前記従ロボットの姿勢とのずれを解消する際に、ユーザが主ロボットに外力を加えていない場合に、前記主ロボットの姿勢が前記従ロボットの姿勢に一致させられる。一方、前記主ロボットの姿勢と前記従ロボットの姿勢とのずれを解消する際に、ユーザが主ロボットに外力を加えている場合には、前記主ロボットの姿勢を前記従ロボットの姿勢に一致させる制御が実行されない。したがって、ユーザが主ロボットに外力を加えている場合に、主ロボットの姿勢がユーザの意図と異なる姿勢に変えられることを抑制することができ、ユーザが違和感を覚えることを抑制することができる。

【0014】

第５の手段では、前記ユーザが前記主ロボットに触れているか否か判定する判定部を備え、前記制御部は、前記主ロボットの姿勢と前記従ロボットの姿勢とのずれを解消する際に、前記主ロボットに触れていないと前記判定部により判定されたことを条件として、前記主ロボットの姿勢を前記従ロボットの姿勢に一致させる。

【0015】

第６の手段は、
ユーザが加えた外力により姿勢が変更される主ロボットと、前記主ロボットの姿勢に一致するように姿勢が制御される従ロボットと、前記主ロボット及び前記従ロボットを制御する制御部と、を備える主従ロボットシステムであって、
前記ユーザが前記主ロボットに触れているか否か判定する判定部を備え、
前記制御部は、前記主ロボットの姿勢と前記従ロボットの姿勢とのずれを解消する際に、前記主ロボットに触れていないと前記判定部により判定されたことを条件として、前記主ロボットの姿勢を前記従ロボットの姿勢に一致させる。

【0016】

上記構成によれば、前記主ロボットの姿勢と前記従ロボットの姿勢とのずれを解消する際に、ユーザが主ロボットに触れていない場合に、前記主ロボットの姿勢が前記従ロボットの姿勢に一致させられる。一方、前記主ロボットの姿勢と前記従ロボットの姿勢とのずれを解消する際に、ユーザが主ロボットに触れている場合には、前記主ロボットの姿勢を前記従ロボットの姿勢に一致させる制御が実行されない。したがって、ユーザが主ロボットに触れている場合に、主ロボットの姿勢がユーザの意図と異なる姿勢に変えられることを抑制することができ、ユーザが違和感を覚えることを抑制することができる。

【0017】

第７の手段では、前記主ロボットの姿勢に前記従ロボットの姿勢を一致させない状態で前記ユーザが前記従ロボットの姿勢を微調整する微調整操作を可能にするとともに、前記微調整操作の履歴を記憶する微調整部を備え、前記制御部は、前記主ロボットの姿勢と前記従ロボットの姿勢とのずれを解消する際に、前記微調整部により記憶された前記履歴における前記微調整操作の順に従って前記主ロボットの姿勢を前記従ロボットの姿勢に一致させる操作順制御を実行する。

【0018】

第８の手段は、
ユーザが加えた外力により姿勢が変更される主ロボットと、前記主ロボットの姿勢に一致するように姿勢が制御される従ロボットと、前記主ロボット及び前記従ロボットを制御する制御部と、を備える主従ロボットシステムであって、
前記主ロボットの姿勢に前記従ロボットの姿勢を一致させない状態で前記ユーザが前記従ロボットの姿勢を微調整する微調整操作を可能にするとともに、前記微調整操作の履歴を記憶する微調整部を備え、
前記制御部は、前記主ロボットの姿勢と前記従ロボットの姿勢とのずれを解消する際に、前記微調整部により記憶された前記履歴における前記微調整操作の順に従って前記主ロボットの姿勢を前記従ロボットの姿勢に一致させる操作順制御を実行する。

【0019】

上記構成によれば、微調整部は、前記主ロボットの姿勢に前記従ロボットの姿勢を一致させない状態で前記ユーザが前記従ロボットの姿勢を微調整する微調整操作を可能にするとともに、前記微調整操作の履歴を記憶する。このため、ユーザは、微調整操作を実行することにより従ロボットの姿勢を微調整することができる。このとき、前記主ロボットの姿勢に前記従ロボットの姿勢が一致させられないため、主ロボットの姿勢と従ロボットの姿勢とにずれが生じる。

【0020】

そして、前記制御部は、前記主ロボットの姿勢と前記従ロボットの姿勢とのずれを解消する際に、前記微調整部により記憶された前記履歴における前記微調整操作の順に従って前記主ロボットの姿勢を前記従ロボットの姿勢に一致させる操作順制御を実行する。このため、前記主ロボットの姿勢が前記従ロボットの姿勢に最少動作で直線的に一致させられることを抑制することができ、ひいては主ロボットの姿勢が急激に変化することを抑制することができる。したがって、主ロボットの姿勢を従ロボットの姿勢に一致させる際に、主ロボットの姿勢がユーザの意図と異なる姿勢に変えられたとしても、ユーザが違和感を覚えることを抑制することができる。

【0021】

第９の手段では、前記ユーザが前記主ロボットに前記外力を加えているか否か判定する判定部を備え、前記制御部は、前記操作順制御の実行中に、前記外力を加えていると前記判定部により判定された場合に、前記操作順制御を中断し、前記中断の後に前記外力を加えていないと前記判定部により判定された場合に、前記操作順制御を前記中断した時点から再開する。

【0022】

上記構成によれば、前記制御部は、前記操作順制御の実行中に、前記外力を加えていると前記判定部により判定された場合に、前記操作順制御を中断する。このため、前記操作順制御を開始していても、ユーザが主ロボットに外力を加えた場合は、前記操作順制御を中断することきができる。したがって、ユーザが主ロボットに外力を加えている場合に、主ロボットの姿勢がユーザの意図と異なる姿勢に変えられることを抑制することができ、ユーザが違和感を覚えることを抑制することができる。

【0023】

そして、前記制御部は、前記中断の後に前記外力を加えていないと前記判定部により判定された場合に、前記操作順制御を前記中断した時点から再開する。このため、前記操作順制御を中断した後に、ユーザが主ロボットに外力を加えなくなった場合は、前記操作順制御を中断した時点から再開することができる。したがって、前記操作順制御を最初からやり直す場合に比べて、前記主ロボットの姿勢を前記従ロボットの姿勢に速やかに一致させることができる。

【0024】

第１０の手段では、前記主ロボットの姿勢に前記従ロボットの姿勢を一致させない状態で前記ユーザが前記従ロボットの姿勢を微調整する微調整操作を可能にする操作器を備え、前記制御部は、前記主ロボットの姿勢と前記従ロボットの姿勢とのずれが所定量を超えた場合にその旨を報知し、前記操作器は、前記主ロボットの姿勢を前記従ロボットの姿勢に一致させるように前記制御部に指示可能である。

【0025】

上記構成によれば、操作器は、前記主ロボットの姿勢に前記従ロボットの姿勢を一致させない状態で前記ユーザが前記従ロボットの姿勢を微調整する微調整操作を可能にする。このため、ユーザは、操作器を用いて微調整操作を実行することにより、従ロボットの姿勢を微調整することができる。

【0026】

前記制御部は、前記主ロボットの姿勢と前記従ロボットの姿勢とのずれが所定量を超えた場合にその旨を報知する。このため、ユーザは、前記主ロボットの姿勢と前記従ロボットの姿勢とのずれが所定量を超えたことを知ることができる。そして、ユーザは、前記主ロボットの姿勢と前記従ロボットの姿勢とのずれが所定量を超えたことを知った場合に、前記主ロボットの姿勢を前記従ロボットの姿勢に一致させるように操作器等を介して前記制御部に指示することができる。この場合は、前記主ロボットの姿勢を前記従ロボットの姿勢に一致させるようにユーザが指示しているため、ユーザが違和感を覚えることを抑制することができる。

【0027】

第１１の手段では、前記制御部は、前記ユーザが前記操作器を用いて前記微調整操作を実行している場合に、前記ユーザが加えた外力により前記主ロボットの姿勢が変更されることを禁止する。

【0028】

上記構成によれば、前記制御部は、前記ユーザが前記操作器を用いて前記微調整操作を実行している場合に、前記ユーザが加えた外力により前記主ロボットの姿勢が変更されることを禁止する。このため、主従ロボット操作よりも操作器を用いた微調整操作を優先することができ、主従ロボット操作による従ロボットの制御と、操作器を用いた微調整操作による従ロボットの制御とが干渉することを抑制することができる。

【図面の簡単な説明】

【0029】

【図1】主従ロボットシステムの模式図。

【図2】主従ロボット操作が行われた場合の各軸の角度を示す図。

【図3】インチング動作後の各軸の角度を示す図。

【図4】ずれ解消操作後の各軸の角度を示す図。

【図5】主制御の手順を示すフローチャート。

【図6】従制御の手順を示すフローチャート。

【図7】インチングモードの手順を示すフローチャート。

【図8】ずれ解消動作の手順を示すフローチャート。

【図9】主制御の変更例の手順を示すフローチャート。

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

【0030】

以下、マスタロボットと、スレーブロボットと、制御部とを備える主従ロボットシステムに具現化した一実施形態について、図面を参照しつつ説明する。

【0031】

図１に示すように、主従ロボットシステム１０は、マスタロボット２０とスレーブロボット３０とを備えている。

【0032】

マスタロボット２０（主ロボット）は、例えば６軸の垂直多関節型ロボットであり、基台（ベース）２１とアーム２２とを備えている。アーム２２の隣り合うリンクは、関節を介して相対回転可能に連結されている。各関節（各軸）は、各関節に対応する各モータにより駆動される。

【0033】

アーム２２の先端には、ハンド２３が取り付けられている。ハンド２３は、例えば一対の爪を備えており、一対の爪の間隔を拡大及び縮小する開閉動作を行う。

【0034】

基台２１の内部には、後述する微調整操作の履歴を記憶する記憶部２５、及びマスタロボット２０及びハンド２３の動作を制御する制御部２６が設けられている。制御部２６は、ＣＰＵ、ＲＯＭ、ＲＡＭ、駆動回路、及び入出力インターフェース等を備えるコンピュータとして構成されている。

【0035】

マスタロボット２０の各関節（各軸）には、各関節の回転角度を検出するエンコーダ（図示略）がそれぞれ設けられている。すなわち、エンコーダは、アーム２２の制御点の位置及び方向（以下、「アーム２２の姿勢」という）を検出する。制御点は、アーム２２の先端の中央と、一対の爪の中間（ＴＣＰ：Tool Center Position）とから選択可能である。

【0036】

マスタロボット２０の各関節には、ブレーキ（図示略）が設けられている。ブレーキは、各関節を制動して、各関節の角度が変更されることを規制する。

【0037】

制御部２６は、アーム２２に作用する外力に従って、アーム２２の姿勢を制御する。詳しくは、制御部２６は、アーム２２に作用する重力及び摩擦力のみを補償するトルクを各関節のモータにより発生させ、アーム２２を外力に従って動作させる柔軟制御を行う。そして、制御部２６は、アーム２２に作用する外力がなくなった時のアーム２２の姿勢を保持する。すなわち、マスタロボット２０は、ユーザが加えた外力によりアーム２２の姿勢を変更して保持可能である。本実施形態では、ユーザは、ダイレクトティーチによりアーム２２を直接掴んで移動させることができ、そしてアーム２２の姿勢を保持することができる（ダイレクトティーチモード）。制御部２６は、マスタロボット２０の各関節のエンコーダの検出結果を、スレーブロボット３０の制御部３６へ送信する。

【0038】

マスタロボット２０には、ケーブル２９によってスレーブロボット３０が接続されている。スレーブロボット３０（従ロボット）は、例えばマスタロボット２０と同型（例えば６軸の垂直多関節型）でマスタロボット２０よりも大型のロボットである。スレーブロボット３０は、安全柵Ｇ内に設置されている。スレーブロボット３０は、マスタロボット２０よりも大型であること、マスタロボット２０と形状が若干異なることを除いて、マスタロボット２０と同様の構成を備えている。スレーブロボット３０は、基台（ベース）３１とアーム３２とを備えている。アーム３２の先端には、ハンド（図示略）が取り付けられる。スレーブロボット３０の各関節（対応関節）は、マスタロボット２０の各関節に対応している。

【0039】

基台３１の内部には、スレーブロボット３０及びハンドの動作を制御する制御部３６が設けられている。制御部３６は、ＣＰＵ、ＲＯＭ、ＲＡＭ、駆動回路、及び入出力インターフェース等を備えるコンピュータとして構成されている。制御部２６と制御部３６とはケーブル２９を介して通信可能であり、互いに情報を送受信する。

【0040】

スレーブロボット３０の各関節（各軸）には、各関節の回転角度を検出するエンコーダ（図示略）がそれぞれ設けられている。すなわち、エンコーダは、アーム３２の制御点の位置及び方向（以下、「アーム３２の姿勢」という）を検出する。制御点は、アーム３２の先端の中央と、例えば一対の爪の中間（ＴＣＰ：Tool Center Position）とから選択可能である。

【0041】

スレーブロボット３０の各関節には、ブレーキ（図示略）が設けられている。ブレーキは、各関節を制動して、各関節の角度が変更されることを規制する。

【0042】

制御部３６は、スレーブロボット３０の各関節（各軸）の角度を、マスタロボット２０の対応する各関節（各軸）の角度に一致させるように、スレーブロボット３０の各関節のモータを制御する。すなわち、制御部３６は、ユーザがマスタロボット２０に外力を加えてマスタロボット２０の姿勢を変更する操作を行うことにより、スレーブロボット３０の姿勢をマスタロボット２０の姿勢に一致させるように制御する（以下、「主従ロボット操作」という）。

【0043】

詳しくは、制御部３６は、マスタロボット２０の各関節のエンコーダ、及びスレーブロボット３０の各関節のエンコーダの検出結果に基づいて、スレーブロボット３０の各関節のモータをフィードバック制御する。すなわち、スレーブロボット３０の各関節は、マスタロボット２０の各関節に倣った動きを追従して行う。制御部３６は、スレーブロボット３０の各関節のエンコーダの検出結果を、マスタロボット２０の制御部２６へ送信する。なお、マスタロボット２０の制御部２６及びスレーブロボット３０の制御部３６により、制御部が構成されている。

【0044】

図２に示すように、主従ロボット操作が行われることにより、マスタロボット２０の各軸の角度θ１～θ６に、スレーブロボット３０の各軸の角度θ１～θ６が一致させられる。

【0045】

図３に示すように、マスタロボット２０には、操作器４０が接続されている。操作器４０は、ティーチングペンダント、タブレット端末、スマートフォン、ノートＰＣ、ＰＣ等である。なお、操作器４０は、デッドマンスイッチを備え、デッドマンスイッチをユーザが強く押す又はデッドマンスイッチからユーザが手を反した場合に、スレーブロボット３０を停止させることが望ましい。

【0046】

操作器４０は、スレーブロボット３０のアーム３２を最少単位又は微小単位で動かすインチング動作をユーザが実行可能にする。ユーザは、操作器４０を操作して、アーム３２の姿勢を変更する単位を、例えば０．１～１．０［ｍｍ］に設定可能である。ユーザは、操作器４０を操作することにより、制御部２６，３６を介してアーム３２の姿勢を設定した単位でインチング動作させる（以下、「微調整操作」という）。このとき、制御部２６は、微調整操作の履歴を記憶部２５に記憶させる。なお、操作器４０、記憶部２５、制御部２６、及び制御部３６により、微調整部が構成されている。すなわち、微調整部は、マスタロボット２０の姿勢にスレーブロボット３０の姿勢を一致させない状態でユーザがスレーブロボット３０の姿勢を微調整する微調整操作を可能にするとともに、微調整操作の履歴を記憶する。

【0047】

制御部２６は、ユーザが操作器４０を用いて微調整操作を実行している場合に、ユーザが加えた外力によりマスタロボット２０の姿勢が変更されることを禁止する。具体的には制御部２６は、ユーザが操作器４０を用いて微調整操作を実行している場合に、マスタロボット２０の各関節のブレーキを作動させて、各関節の角度を変更不能にする。なお、制御部２６は、ユーザが操作器４０を用いて微調整操作を実行している場合に、マスタロボット２０の各関節の角度を現在の角度に維持する制御を行うことにより、各関節の角度を変更不能にすることもできる。

【0048】

スレーブロボット３０の各軸Ｊ１～Ｊ６の角度がθ１～θ６である時、制御点の座標（Ｘ，Ｙ，Ｚ，Ｒｘ，Ｒｙ，Ｒｚ）は座標（Ｘ１，Ｙ１，Ｚ１，Ｒｘ１，Ｒｙ１，Ｒｚ１）である。Ｘ，Ｙ，Ｚは、それぞれＸ軸、Ｙ軸、Ｚ軸の座標である。Ｒｘ，Ｒｙ，Ｒｚは、それぞれＸ軸回り、Ｙ軸回り、Ｚ軸回りの回転角度である。

【0049】

ここで、ユーザの微調整操作により、スレーブロボット３０の制御点の座標（Ｘ，Ｙ，Ｚ，Ｒｘ，Ｒｙ，Ｒｚ）が（ａ１，ａ２，ａ３，ａ４，ａ５，ａ６）だけ変更されたとする。このとき、マスタロボット２０の各軸Ｊ１～Ｊ６の角度は変更不能とされている。微調整操作は、１回の操作であってもよいし、複数回の操作の合計であってもよい。

【0050】

その結果、スレーブロボット３０の制御点の座標は、座標（Ｘ１＋ａ１，Ｙ１＋ａ２，Ｚ１＋ａ３，Ｒｘ１＋ａ４，Ｒｙ１＋ａ５，Ｒｚ１＋ａ６）となる。スレーブロボット３０の制御点の座標が座標（Ｘ１＋ａ１，Ｙ１＋ａ２，Ｚ１＋ａ３，Ｒｘ１＋ａ４，Ｒｙ１＋ａ５，Ｒｚ１＋ａ６）である時、スレーブロボット３０の各軸Ｊ１～Ｊ６の角度は、それぞれθ１＋ｂ１，θ２＋ｂ２，θ３＋ｂ３，θ４＋ｂ４，θ５＋ｂ５，θ６＋ｂ６である。したがって、マスタロボット２０の各軸Ｊ１～Ｊ６の角度と、スレーブロボット３０の各軸Ｊ１～Ｊ６の角度とにずれが生じることとなる。

【0051】

そこで、図４に示すように、制御部２６は、マスタロボット２０の各軸Ｊ１～Ｊ６の角度（マスタロボット２０の姿勢）と、スレーブロボット３０の各軸Ｊ１～Ｊ６の角度（スレーブロボット３０の姿勢）とのずれを解消する。詳しくは、制御部２６は、姿勢のずれを解消するずれ解消動作をマスタロボット２０に実行させる。これにより、マスタロボット２０の各軸Ｊ１～Ｊ６の角度が、スレーブロボット３０の各軸Ｊ１～Ｊ６の角度に一致させられる。このとき、マスタロボット２０の各軸Ｊ１～Ｊ６の角度をスレーブロボット３０の各軸Ｊ１～Ｊ６の角度に一致させる制御を単純に実行すると、マスタロボット２０の各軸Ｊ１～Ｊ６の角度がユーザの意図と異なる角度に急激に変えられ、ユーザが違和感を覚えるおそれがある。

【0052】

この点、制御部２６は、マスタロボット２０の姿勢とスレーブロボット３０の姿勢とのずれ量が所定ずれ量を超えた場合に、その旨をユーザに報知する。操作器４０は、マスタロボット２０の姿勢をスレーブロボット３０の姿勢に一致させるように制御部２６に指示可能である。そして、マスタロボット２０の姿勢とスレーブロボット３０の姿勢とのずれ量を解消するずれ解消操作（マスタロボット２０の姿勢をスレーブロボット３０の姿勢に一致させる指示）をユーザが実行したことを条件として、制御部２６はずれ解消動作を実行する。さらに、制御部２６は、マスタロボット２０の姿勢とスレーブロボット３０の姿勢とのずれを解消する際に、マスタロボット２０を動作させる加速度を制限加速度Ａｕ以下に制限する。

【0053】

図５は、マスタロボット２０の制御部２６により実行される主制御の手順を示すフローチャートである。

【0054】

まず、マスタロボット２０のモードをダイレクトティーチモードに設定する（Ｓ１０）。ユーザは、ダイレクトティーチによりマスタロボット２０を目標姿勢まで移動させる（Ｓ１１）。ここで、目標姿勢とは、スレーブロボット３０の制御点が設定対象の教示点に到達した状態、あるいは、設定対象の教示点の近傍に到達した状態におけるマスタロボット２０の姿勢を意味する。

【0055】

このとき、制御部２６は、ユーザの手によってマスタロボット２０の姿勢が変更された場合、マスタロボット２０の姿勢を特定可能な各モータの回転角度等の情報を教示情報として制御部３６に適宜送信する。このとき送信される教示情報には、ダイレクトティーチモードで教示中であることを示す情報も含まれている。

【0056】

一方、スレーブロボット３０の制御部３６は、マスタロボット２０で教示が開始されると、図６に示すように、制御部２６から教示情報を受信したか否か判定する（Ｓ２０）。制御部３６は、教示情報を受信していない判定した場合（Ｓ２０：ＮＯ）、教示が完了したか否か判定する（Ｓ２２）。この判定において、教示が完了していないと判定した場合（Ｓ２２：ＮＯ）、ステップＳ２０の処理から再度実行する。一方、この判定において、教示が完了したと判定した場合（Ｓ２２：ＹＥＳ）、この一連の処理を一旦終了する（ＥＮＤ）。

【0057】

これに対して、制御部３６は、制御部２６から教示情報を受信したと判定した場合（Ｓ２０：ＹＥＳ）、教示情報に基づいてスレーブロボット３０の姿勢を変更する（Ｓ２１）。このとき、マスタロボット２０がダイレクトティーチモードで動作している場合には、ユーザによってマスタロボット２０の姿勢が変更されるごとに教示情報を受信することから、制御部３６は、マスタロボット２０の姿勢の変化に追従するように、スレーブロボット３０の姿勢を変更する。

【0058】

図５に戻り、ユーザは、マスタロボット２０を目標姿勢あるいはその近傍まで移動させると、現在のマスタロボット２０の姿勢で十分であるか、微調整つまりは詳細な位置決めが必要であるか否か判定する（Ｓ１２）。そして、ユーザは、微調整が必要でないと判定した場合（Ｓ１２：ＮＯ）、現在のマスタロボット２０の姿勢を教示点として設定する（Ｓ１４）。以下、現在のマスタロボット２０の姿勢を、便宜的に現姿勢と称する。具体的には、マスタロボット２０の現姿勢における制御点の位置及び方向を教示点として設定する。このとき、制御部２６から、マスタロボット２０の現姿勢、および現姿勢を教示点とする旨の情報が教示情報として制御部３６へ送信される。

【0059】

一方、ユーザが操作器４０によりインチングモードへの切り替え操作を入力した場合等、微調整が必要である場合（Ｓ１２：ＹＥＳ）、制御部２６はインチングモードを実行する（Ｓ１３）。

【0060】

図７は、インチングモードの手順を示すフローチャートである。この一連の処理は、制御部２６により実行される。

【0061】

マスタロボット２０の各軸Ｊ１～Ｊ６のブレーキを作動させる（Ｓ１３０）。微調整操作が入力されたか否か判定する（Ｓ１３１）。この判定において、微調整操作が入力されていないと判定した場合（Ｓ１３１：ＮＯ）、微調整操作が終了したか否か判定する（Ｓ１３４）。具体的には、ユーザが操作器４０においてインチングモードを終了させる操作を実行した場合に、微調整操作が終了したと判定する。微調整操作が終了していないと判定した場合（Ｓ１３４：ＮＯ）、Ｓ１３１の処理から再度実行する。

【0062】

一方、Ｓ１３１の判定において、微調整操作が入力されたと判定した場合（Ｓ１３１：ＹＥＳ）、インチング動作を実行する（Ｓ１３２）。具体的には、入力された微調整操作に応じて、制御部３６を介してアーム３２の姿勢を設定した単位でインチング動作させる。微調整操作では、ユーザが操作器４０のボタンを１度押す毎に設定した単位だけスレーブロボット３０を動作させ、ボタンを長押しした場合もボタンを１度押したとして扱う。

【0063】

続いて、入力された微調整操作を、記憶部２５に記憶させる（Ｓ１３３）。具体的には、インチングモードに切り替えてから入力された微調整操作（実行したインチング動作）を、記憶部２５に時系列に記憶させる。

【0064】

Ｓ１３４の判定において、微調整操作が終了したと判定した場合（Ｓ１３４：ＹＥＳ）、マスタロボット２０の各軸Ｊ１～Ｊ６のブレーキを解除する（Ｓ１３５）。その後、図５のＳ１３の処理の次の処理へ戻る（ＲＥＴ）。

【0065】

図５に戻り、Ｓ１４の処理の後、マスタロボット２０の姿勢とスレーブロボット３０の姿勢とのずれ量が所定ずれ量を超えているか否か判定する（Ｓ１５）。具体的には、主従ロボット操作時にはマスタロボット２０の姿勢とスレーブロボット３０姿勢とが一致しているとみなして、インチング動作によりスレーブロボット３０が１．０［ｃｍ］を超えて動かされた場合にずれ量が所定ずれ量を超えていると判定する。なお、マスタロボット２０の各軸の角度と、スレーブロボット３０の対応する各軸の角度との差に基づいて、ずれ量が所定ずれ量を超えていると判定することもできる。

【0066】

Ｓ１５の判定において、マスタロボット２０の姿勢とスレーブロボット３０の姿勢とのずれ量が所定ずれ量を超えていると判定した場合（Ｓ１５：ＹＥＳ）、マスタロボット２０の姿勢とスレーブロボット３０の姿勢とのずれ量が大きいことをユーザに報知する。例えば、操作器４０の表示部にずれ量が大きいことを表示させてもよいし、操作器４０のスピーカによりずれ量が大きいことを音声案内させてもよい。一方、Ｓ１５の判定において、マスタロボット２０の姿勢とスレーブロボット３０の姿勢とのずれ量が所定ずれ量を超えていないと判定した場合（Ｓ１５：ＮＯ）、Ｓ１７の処理へ進む。すなわち、制御部２６は、マスタロボット２０の姿勢とスレーブロボット３０の姿勢とのずれ量が所定ずれ量を超えていないと判定した場合は、マスタロボット２０の姿勢とスレーブロボット３０の姿勢とがずれていても主従ロボット操作を継続する。

【0067】

ユーザが操作器４０によりずれ解消操作を行ったか否か判定する（Ｓ１７）。この判定において、ユーザが操作器４０によりずれ解消操作を行ったと判定した場合（Ｓ１７：ＹＥＳ）、ずれ解消動作を実行する（Ｓ１８）。

【0068】

図８は、ずれ解消動作の手順を示すフローチャートである。この一連の処理は、制御部２６により実行される。

【0069】

微調整操作の履歴を、記憶部２５から読み込む（Ｓ１８０）。微調整操作の順にマスタロボット２０を動作させる（Ｓ１８１）。詳しくは、記憶された微調整操作の履歴における微調整操作の順に従って、マスタロボット２０の姿勢をスレーブロボット３０の姿勢に一致させる制御（以下、「操作順制御」という）を実行する。すなわち、スレーブロボット３０においてインチング動作が実行された順と同じ順で、インチング動作に対応する動作をマスタロボット２０に実行させる。このとき、マスタロボット２０を動作させる加速度、具体的には制御点を移動させる際の加速度を制限加速度Ａｕ以下に制限して、マスタロボット２０の姿勢をスレーブロボット３０の姿勢に一致させる。さらに、マスタロボット２０を動作させる速度、具体的には制御点を移動させる際の速度を制限速度Ｖｕ以下に制限して、マスタロボット２０の姿勢をスレーブロボット３０の姿勢に一致させる。

【0070】

操作順制御の実行中に、ユーザがマスタロボット２０に外力を加えているか否か判定する（Ｓ１８２）。この判定において、操作順制御の実行中に、ユーザがマスタロボット２０に外力を加えていると判定した場合（Ｓ１８２：ＹＥＳ）、操作順制御を中断する（Ｓ１８４）。そして、操作順制御における中断時のマスタロボット２０の動作に対応する微調整操作を記憶する（Ｓ１８５）。

【0071】

続いて、ダイレクトティーチモードに設定する（Ｓ１８６）。ユーザがマスタロボット２０に外力を加えているか否か判定する（Ｓ１８７）。この判定において、ユーザがマスタロボット２０に外力を加えていると判定した場合（Ｓ１８７：ＹＥＳ）、Ｓ１８６の処理から再度実行する。

【0072】

一方、Ｓ１８７の判定において、ユーザがマスタロボット２０に外力を加えていないと判定した場合（Ｓ１８７：ＮＯ）、Ｓ１８１の処理から再度実行する。この場合、Ｓ１８１の処理において、Ｓ１８５の処理で記憶した中断時のマスタロボット２０の動作に対応する微調整操作から順に、マスタロボット２０を動作させる。すなわち、操作順制御の中断の後に、ユーザがマスタロボット２０に外力を加えていないと判定した場合に、操作順制御を中断した時点から再開する。

【0073】

また、Ｓ１８２の処理において、操作順制御の実行中に、ユーザがマスタロボット２０に外力を加えていないと判定した場合（Ｓ１８２：ＮＯ）、微調整操作の履歴における最後の微調整操作までマスタロボット２０の動作が完了したか否か判定する（Ｓ１８３）。この判定において、最後の微調整操作までマスタロボット２０の動作が完了していないと判定した場合（Ｓ１８３：ＮＯ）、Ｓ１８１の処理から再度実行する。一方、この判定において、最後の微調整操作までマスタロボット２０の動作が完了したと判定した場合（Ｓ１８３：ＹＥＳ）、図５のＳ１８の処理の次の処理へ戻る（ＲＥＴ）。なお、Ｓ１８２，Ｓ１８７の処理が判定部としての処理に相当する。

【0074】

図５のＳ１９の処理において、全ての教示が完了したか否か判定する（Ｓ１９）。例えば、ユーザが操作器４０によりティーチングを終了する操作を実行した場合に、制御部２６は全ての教示が完了したと判定する。この判定において、全ての教示が完了していないと判定した場合（Ｓ１９：ＮＯ）、Ｓ１１の処理から再度実行する。一方、この判定において、全ての教示が完了したと判定した場合（Ｓ１９：ＹＥＳ）、この一連の処理を終了する（ＥＮＤ）。

【0075】

以上詳述した本実施形態は、以下の利点を有する。

【0076】

・制御部２６は、マスタロボット２０の姿勢とスレーブロボット３０の姿勢とのずれを解消する際に、マスタロボット２０を動作させる加速度を制限加速度Ａｕ以下に制限して、マスタロボット２０の姿勢をスレーブロボット３０の姿勢に一致させる。このため、マスタロボット２０を動作させる速度が急激に変化することを抑制することができ、ひいてはマスタロボット２０の姿勢が急激に変化することを抑制することができる。したがって、マスタロボット２０の姿勢をスレーブロボット３０の姿勢に一致させる際に、マスタロボット２０の姿勢がユーザの意図と異なる姿勢に変えられたとしても、ユーザが違和感を覚えることを抑制することができる。

【0077】

制御部２６は、マスタロボット２０の姿勢とスレーブロボット３０の姿勢とのずれを解消する際に、さらに、マスタロボット２０を動作させる速度を制限速度Ｖｕ以下に制限して、マスタロボット２０の姿勢をスレーブロボット３０の姿勢に一致させる。こうした構成によれば、マスタロボット２０の速度が制限速度Ｖｕを超えた状態で、マスタロボット２０の姿勢がユーザの意図と異なる姿勢に変えられることを抑制することができ、ユーザが違和感を覚えることをさらに抑制することができる。

【0078】

・制御部２６は、マスタロボット２０の姿勢とスレーブロボット３０の姿勢とのずれを解消する際に、記憶部２５により記憶された履歴における微調整操作の順に従ってマスタロボット２０の姿勢をスレーブロボット３０の姿勢に一致させる操作順制御を実行する。このため、マスタロボット２０の姿勢がスレーブロボット３０の姿勢に最少動作で直線的に一致させられることを抑制することができ、ひいてはマスタロボット２０の姿勢が急激に変化することを抑制することができる。したがって、マスタロボット２０の姿勢をスレーブロボット３０の姿勢に一致させる際に、マスタロボット２０の姿勢がユーザの意図と異なる姿勢に変えられたとしても、ユーザが違和感を覚えることを抑制することができる。

【0079】

・制御部２６は、操作順制御の実行中に、ユーザがマスタロボット２０に外力を加えていると判定した場合に、操作順制御を中断する。このため、操作順制御を開始していても、ユーザがマスタロボット２０に外力を加えた場合は、操作順制御を中断することきができる。したがって、ユーザがマスタロボット２０に外力を加えている場合に、マスタロボット２０の姿勢がユーザの意図と異なる姿勢に変えられることを抑制することができ、ユーザが違和感を覚えることを抑制することができる。

【0080】

・制御部２６は、中断の後にユーザがマスタロボット２０に外力を加えていないと判定した場合に、操作順制御を中断した時点から再開する。このため、操作順制御を中断した後に、ユーザがマスタロボット２０に外力を加えなくなった場合は、操作順制御を中断した時点から再開することができる。したがって、操作順制御を最初からやり直す場合に比べて、マスタロボット２０の姿勢をスレーブロボット３０の姿勢に速やかに一致させることができる。

【0081】

・操作器４０、及び制御部２６，３６は、マスタロボット２０の姿勢にスレーブロボット３０の姿勢を一致させない状態でユーザがスレーブロボット３０の姿勢を微調整する微調整操作を可能にする。このため、ユーザは、操作器４０を用いて微調整操作を実行することにより、スレーブロボット３０の姿勢を微調整することができる。

【0082】

・制御部２６は、マスタロボット２０の姿勢とスレーブロボット３０の姿勢とのずれが所定ずれ量（所定量）を超えた場合にその旨を報知する。このため、ユーザは、マスタロボット２０の姿勢とスレーブロボット３０の姿勢とのずれが所定ずれ量を超えたことを知ることができる。そして、ユーザは、マスタロボット２０の姿勢とスレーブロボット３０の姿勢とのずれが所定ずれ量を超えたことを知った場合に、マスタロボット２０の姿勢をスレーブロボット３０の姿勢に一致させるように制御部２６に指示することができる。この場合は、マスタロボット２０の姿勢をスレーブロボット３０の姿勢に一致させるようにユーザが指示しているため、ユーザが違和感を覚えることを抑制することができる。

【0083】

・制御部２６は、ユーザが操作器４０を用いて微調整操作を実行している場合に、ユーザが加えた外力によりマスタロボット２０の姿勢が変更されることを禁止する。このため、主従ロボット操作よりも操作器４０を用いた微調整操作を優先することができ、主従ロボット操作によるスレーブロボット３０の制御と、操作器４０を用いた微調整操作によるスレーブロボット３０の制御とが干渉することを抑制することができる。

【0084】

なお、上記の実施形態を、以下のように変更して実施することもできる。上記実施形態と同一の部分については、同一の符号を付すことにより説明を省略する。

【0085】

・図７において、Ｓ１３０の処理及びＳ１３５の処理を省略することもできる。

【0086】

・スレーブロボット３０が微調整操作の履歴を記憶する記憶部３５を備え、制御部２６は記憶部３５に記憶された微調整操作の履歴を読み込んでもよい。

【0087】

・図８のＳ１８４の処理において操作順制御を中断した時に、マスタロボット２０の姿勢とスレーブロボット３０の姿勢とのずれ量が所定ずれ量以下である場合に、図８のずれ解消動作の一連の処理を終了することもできる。また、図８のＳ１８４の処理において操作順制御を中断し、その後に外力の入力がなくなった場合に、ずれ解消動作の開始時の状態にマスタロボット２０を戻し、記憶部２５に記憶された微調整操作の履歴の最初から操作順制御をやり直すこともできる。

【0088】

・マスタロボット２０は、ユーザがマスタロボット２０に外力を加えているか否か判定する判定部を備えていてもよい。判定部は、例えば各関節のモータの電流値を測定し、電流値に比例するトルクを算出することにより、外力の大きさと方向と（外力の有無）を判定する。そして、制御部２６は、マスタロボット２０の姿勢とスレーブロボット３０の姿勢とのずれを解消する際に、図９に示すように、ユーザがマスタロボット２０に外力を加えていないと判定部により判定されたことを条件として（Ｓ３０）、マスタロボット２０の姿勢をスレーブロボット３０の姿勢に一致させる、といった構成を採用することもできる。なお、モータにトルクセンサを設け、トルクセンサの検出結果からトルクを算出することもできる。

【0089】

上記構成によれば、マスタロボット２０の姿勢とスレーブロボット３０の姿勢とのずれを解消する際に、ユーザがマスタロボット２０に外力を加えていない場合（Ｓ３０：ＮＯ）に、マスタロボット２０の姿勢がスレーブロボット３０の姿勢に一致させられる。一方、マスタロボット２０の姿勢とスレーブロボット３０の姿勢とのずれを解消する際に、ユーザがマスタロボット２０に外力を加えている場合（Ｓ３０：ＹＥＳ）には、マスタロボット２０の姿勢をスレーブロボット３０の姿勢に一致させる制御が実行されない。したがって、ユーザがマスタロボット２０に外力を加えている場合に、マスタロボット２０の姿勢がユーザの意図と異なる姿勢に変えられることを抑制することができ、ユーザが違和感を覚えることを抑制することができる。なお、Ｓ３０の処理を、図５のＳ１７の処理とＳ１８の処理との間に入れることもできる。

【0090】

・マスタロボット２０は、ユーザがマスタロボット２０に触れているか否か判定する判定部を備えていてもよい。判定部は、例えばアーム２２に設けられた静電容量センサ等の検出結果に基づいて、ユーザがマスタロボット２０に触れているか否か判定する。そして、制御部２６は、マスタロボット２０の姿勢とスレーブロボット３０の姿勢とのずれを解消する際に、マスタロボット２０に触れていないと判定部により判定されたことを条件として、マスタロボット２０の姿勢をスレーブロボット３０の姿勢に一致させる、といった構成を採用することもできる。この場合、図９のＳ３０の処理を、ユーザがマスタロボット２０に触れているか否か判定する処理に変更してもよいし、図５のＳ１７の処理とＳ１８の処理との間に、ユーザがマスタロボット２０に触れているか否か判定する処理を入れてもよい。

【0091】

上記構成によれば、マスタロボット２０の姿勢とスレーブロボット３０の姿勢とのずれを解消する際に、ユーザがマスタロボット２０に触れていない場合に、マスタロボット２０の姿勢がスレーブロボット３０の姿勢に一致させられる。一方、マスタロボット２０の姿勢とスレーブロボット３０の姿勢とのずれを解消する際に、ユーザがマスタロボット２０に触れている場合には、マスタロボット２０の姿勢をスレーブロボット３０の姿勢に一致させる制御が実行されない。したがって、ユーザがマスタロボット２０に触れている場合に、マスタロボット２０の姿勢がユーザの意図と異なる姿勢に変えられることを抑制することができ、ユーザが違和感を覚えることを抑制することができる。

【0092】

・図８のＳ１８１の処理において、マスタロボット２０を動作させる速度、具体的には制御点を移動させる際の速度を制限速度Ｖｕ以下に制限することを、省略することもできる。また、図８のＳ１８１の処理において、マスタロボット２０を動作させる加速度、具体的には制御点を移動させる際の加速度を制限加速度Ａｕ以下に制限することを、省略することもできる。

【0093】

・インチングモードは、ユーザが操作器４０により微調整操作を入力する構成に限らず、特開２０１９－５５４５８号公報に記載された詳細制御モードの構成により実現することもできる。

【0094】

・マスタロボット２０の姿勢とスレーブロボット３０の姿勢とのずれ量を解消するずれ解消操作をユーザが実行したことを条件として、制御部２６がずれ解消動作を実行する構成であれば、最少動作で直線的にマスタロボット２０を動作させることによりずれを解消してもよい。その場合であっても、マスタロボット２０の姿勢をスレーブロボット３０の姿勢に一致させるようにユーザが指示しているため、ユーザが違和感を覚えることを抑制することができる。

【0095】

・制御部は、マスタロボット２０又はスレーブロボット３０に設けられて、マスタロボット２０及びスレーブロボット３０を制御する１つの制御部であってもよい。

【0096】

・マスタロボット２０とスレーブロボット３０とは、同形状で大きさのみ異なるロボットであってもよい。また、マスタロボット２０とスレーブロボット３０とは、形状及び大きさが同一のロボットであってもよい。

【符号の説明】

【0097】

１０…主従ロボットシステム、２０…マスタロボット（主ロボット）、２６…制御部、３０…スレーブロボット（従ロボット）、３６…制御部。

【図1】

【図2】

【図3】

【図4】

【図5】

【図6】

【図7】

【図8】

【図9】