(57)【要約】【課題】ロボットに対する教示作業時において、その教示効率を低下させることなく、高速移動と高精度移動とを使い分けることができるロボットの直接教示装置及びその方法を提供する。【解決手段】複数の軸Ｊ１〜Ｊ６を有する多関節ロボット１０に加わる操作力を力センサ３４によって検出し、その検出結果に基づいた力制御部４２の力制御に従って、多関節ロボット１０を移動させて、その位置を直接教示するロボットの直接教示装置４０において、力センサ３４の検出結果に基づいて、軸Ｊ１〜Ｊ６に加えられた操作力を推定する力推定部４１と、力推定部４１によって推定された操作力の入力パターンを、予め設定された入力パターンの種類ごとに分類する入力パターン分類部４４と、入力パターン分類部４４によって分類された操作力の入力パターンに応じて、力制御部４２の力制御を切り替える力制御切り替え部４５とを備える。【選択図】図３
2019093526.tif 000002
【特許請求の範囲】
【請求項１】
複数の軸を有する多関節ロボットに加わる操作力を力センサによって検出し、その検出結果に基づいた力制御部の力制御に従って、前記多関節ロボットを移動させて、その位置を直接教示するロボットの直接教示装置において、
前記力センサの検出結果に基づいて、前記軸に加えられた操作力を推定する力推定部と、
前記力推定部によって推定された操作力の入力パターンを、予め設定された入力パターンの種類ごとに分類する入力パターン分類部と、
前記入力パターン分類部によって分類された操作力の入力パターンに応じて、前記力制御部の力制御を切り替える力制御切り替え部とを備える
ことを特徴とするロボットの直接教示装置。
【請求項２】
前記力制御部は、
推定された操作力の入力パターンが、前記多関節ロボットの回転移動に対応した入力パターンに分類された場合には、
前記多関節ロボットにおける手先部の回転方向を制御する
ことを特徴とする請求項１記載のロボットの直接教示装置。
【請求項３】
前記力制御部は、
推定された操作力の入力パターンが、前記多関節ロボットの並進移動に対応した入力パターンに分類された場合には、
前記多関節ロボットにおける手先部の移動方向を、操作力の作用方向に応じて制御する
ことを特徴とする請求項１記載のロボットの直接教示装置。
【請求項４】
前記力センサは、前記多関節ロボットの各関節部に設けられ、
前記力推定部は、前記複数の軸の中から、操作力が加えられた軸を推定する
ことを特徴とする請求項１から請求項３のうちのいずれか１項記載のロボットの直接教示装置。
【請求項５】
前記力センサは、前記多関節ロボットの手先部に設けられた多軸力センサである
ことを特徴とする請求項１から請求項３のうちのいずれか１項記載のロボットの直接教示装置。
【請求項６】
複数の軸を有する多関節ロボットに加わる操作力を力センサによって検出し、その検出結果に基づいた力制御に従って、前記多関節ロボットを移動させて、その位置を直接教示するロボットの直接教示方法において、
前記力センサの検出結果に基づいて、前記軸に加えられた操作力を推定し、
推定された操作力の入力パターンを、予め設定された入力パターンの種類ごとに分類し、
分類された操作力の入力パターンに応じて、力制御を切り替える
ことを特徴とするロボットの直接教示方法。
【発明の詳細な説明】
【技術分野】
【０００１】
この発明は、ロボットに対して操作力を加えて、その手先位置を直接教示するロボットの直接教示装置及びその方法に関する。
【背景技術】
【０００２】
従来、力制御に基づいたロボットの直接教示方法が、種々提供されている。このロボットの直接教示方法の１つとして、ロボットに加えた操作力を検出し、その検出結果に基づいてロボットを移動させて、その手先位置を直接教示する方法がある。このような、従来のロボットの直接教示方法としては、例えば、特許文献１に開示されている。
【先行技術文献】
【特許文献】
【０００３】
【特許文献１】特開平３−１２３９０７号公報
【発明の概要】
【発明が解決しようとする課題】
【０００４】
上記従来の直接教示方法においては、手先位置を教示する際に、軽い操作力によってロボットを高速移動させるモードと、強い操作力によってロボットを低速移動させるモードとの間で、切り替え可能としている。しかしながら、このような直接教示方法を採用すると、作業者は、教示モードを切り替える度に、スイッチ切り替え操作を必要とするため、ロボットに対する教示効率が低下するおそれがある。
【０００５】
この発明は、上記課題を解決するものであって、ロボットに対する教示作業時において、その教示効率を低下させることなく、高速移動と高精度移動とを使い分けることができるロボットの直接教示装置及びその方法を提供することを目的とする。
【課題を解決するための手段】
【０００６】
この発明に係るロボットの直接教示装置は、複数の軸を有する多関節ロボットに加わる操作力を力センサによって検出し、その検出結果に基づいた力制御部の力制御に従って、多関節ロボットを移動させて、その位置を直接教示するロボットの直接教示装置において、力センサの検出結果に基づいて、軸に加えられた操作力を推定する力推定部と、力推定部によって推定された操作力の入力パターンを、予め設定された入力パターンの種類ごとに分類する入力パターン分類部と、入力パターン分類部によって分類された操作力の入力パターンに応じて、力制御部の力制御を切り替える力制御切り替え部とを備えるものである。
【０００７】
この発明に係るロボットの教示方法は、複数の軸を有する多関節ロボットに加わる操作力を力センサによって検出し、その検出結果に基づいた力制御に従って、多関節ロボットを移動させて、その位置を直接教示するロボットの直接教示方法において、力センサの検出結果に基づいて、軸に加えられた操作力を推定し、推定された操作力の入力パターンを、予め設定された入力パターンの種類ごとに分類し、分類された操作力の入力パターンに応じて、力制御を切り替えるものである。
【発明の効果】
【０００８】
この発明によれば、ロボットに対する教示作業時において、その教示効率を低下させることなく、高速移動と高精度移動とを使い分けることができる。
【図面の簡単な説明】
【０００９】
【図１】この発明の実施の形態１に係るロボットの直接教示装置が適用される多関節ロボットの構成を示した外観図である。
【図２】各関節部内におけるトルクセンサの設置状態を示した図である。
【図３】この発明の実施の形態１に係るロボットの直接教示装置の構成を示したブロックである。
【図４】この発明の実施の形態１に係るロボットの直接教示装置の処理過程を示したフローチャートである。
【図５】予め設定された操作力の入力パターンの一例を示した図である。５Ａは、高精度並進移動に対応した操作力の入力パターンを示した図である。５Ｂは、高精度回転移動に対応した操作力の入力パターンを示した図である。５Ｃは、高速移動に対応した操作力の入力パターンを示した図である。
【図６】作業者の動作パターンに対応したリンク部材の移動形態を示した図である。
【発明を実施するための形態】
【００１０】
以下、この発明の実施の形態について図面を参照しながら詳細に説明する。
【００１１】
実施の形態１．
図１は、この発明の実施の形態１に係るロボットの直接教示装置が適用される多関節ロボット１０の構成例を示した外観図である。図１に示すように、多関節ロボット１０は、基台１１と、この基台１１に支持されるアーム１２とから構成されている。アーム１２は、６自由度を有しており、６つのリンク部材２１ａ〜２１ｆ、６つの関節部２２ａ〜２２ｆ、及び、手先部２３から構成されている。つまり、多関節ロボット１０は、一般的な６軸多関節ロボットである。但し、本発明に係るロボット直接教示装置及びその方法は、多関節ロボットの構成及び自由度数によって、その本質が失われるものではない。
【００１２】
リンク部材２１ａ〜２１ｆは、軸Ｊ１〜Ｊ６をそれぞれ有しており、アーム１２の基端側から先端側に向けて順に配置されている。手先部２３は、リンク部材２１ｆの先端に設けられており、アーム１２の先端部を構成している。
【００１３】
関節部２２ａ〜２２ｆは、基台１１とリンク部材２１ａとの間、リンク部材２１ａ，２１ｂ間、リンク部材２１ｂ，２１ｃ間、リンク部材２１ｃ，２１ｄ間、リンク部材２１ｄ，２１ｅ間、及び、リンク部材２１ｅ，２１ｆ間を、それぞれ繋いでいる。更に、関節部２２ａ〜２２ｆは、リンク部材２１ａ〜２１ｆを軸Ｊ１〜Ｊ６周りに回転可能に支持している。
【００１４】
上記多関節ロボット１０に対する教示作業を行う場合には、作業者は、リンク部材２１ａ〜２２ｆのうち、いずれか１つのリンク部材２１ａ〜２２ｆを操作する。つまり、作業者から加えられた操作力は、６つの軸Ｊ１〜Ｊ６のうち、複数の軸に作用し、その操作力が作用した軸Ｊ１〜Ｊ６は、操作軸として移動し、アーム１２全体を移動させる。このとき、手先部２３は、操作軸の直線移動または回転移動に伴って、並進移動または回転移動するため、その位置及び姿勢が教示される。
【００１５】
図２は、各関節部２２ａ〜２２ｆにおけるトルクセンサ３４の設置状態を示した図である。図２に示すように、モータ３１の回転軸３１ａ、リンク部材２１ａ〜２１ｆの中心軸３２、連結軸３３、及び、力センサとなるトルクセンサ３４は、各関節部２２ａ〜２２ｆ内に、それぞれ設けられている。モータ３１は、リンク部材２１ａ〜２１ｆを、その中心軸３２を回転中心として回転させる。トルクセンサ３４は、各リンク部材２１ａ〜２１ｆの中心軸３２に作用した操作力をそれぞれ検出する。
【００１６】
モータ３１の回転軸３１ａと中心軸３２とは、連結軸３３を介して連結されている。連結軸３３の軸径は、回転軸３１ａの軸径及び中心軸３２の軸径よりも小径となっている。モータ３１の回転軸３１ａ、中心軸３２、連結軸３３は、及び、関節部２２ａ〜２２ｆの関節軸は、各軸Ｊ１〜Ｊ６と同軸状になっている。つまり、回転軸３１ａ、中心軸３２、及び、連結軸３３は、軸Ｊ１〜Ｊ６周りに回転する。
【００１７】
トルクセンサ３４は、取付板３５を介して、回転軸３１ａ及び中心軸３２に取り付けられており、それらの軸３１ａ，３２と共に回転する。取付板３５は、回転軸３１ａの外周面と中心軸３２の外周面との間において、それらの間に形成される軸方向隙間を跨ぐように設けられている。これにより、トルクセンサ３４は、作業者による操作力が中心軸３２に作用すると、これに伴って歪を生じ、その歪量を、操作力の大きさに換算して検出する。
【００１８】
図３は、この発明の実施の形態１に係るロボットの直接教示装置４０の構成を示したブロックである。図３に示した直接教示装置４０は、多関節ロボット１０に対する作業者の直接教示作業を可能にするものであって、多関節ロボット１０及び直接教示指示部３６と接続されている。
【００１９】
直接教示指示部３６は、作業者が、多関節ロボット１０に対して直接教示を行うことを、直接教示装置４０に指示する際に使用するものである。作業者は、直接教示指示部３６のスイッチ切り替え操作によって、多関節ロボット１０に対する直接教示の実行または停止を選択することができる。
【００２０】
図３に示すように、直接教示装置４０は、力推定部４１、力制御部４２、モータドライバ４３、入力パターン分類部４４、及び、力制御切り替え部４５を有している。
【００２１】
力推定部４１は、トルクセンサ３４の出力結果に基づいて、作業者によって操作力が加えられたリンク部材２１ａ〜２１ｆ、及び、その操作力の大きさ（入力パターン）を推定する。力制御部４２は、力推定部４１の推定結果に基づいて、モータドライバ４３の駆動を制御する。モータドライバ４３は、モータ３１の回転角度を制御する。
【００２２】
つまり、力制御部４２は、操作力が直接的に加えられたリンク部材２１ａ〜２１ｆと、その操作力の大きさとに基づいて、モータドライバ４３の駆動を制御して、各モータ３１の回転角度を調整する。これにより、直接教示装置４０は、アーム１２を操作力に基づいて動作させて、その手先部２３を、目標位置となる作業位置に誘導し、その作業位置を教示する。この結果、手先部２３は、作業対象物に対して、任意の方向から、任意の姿勢で、且つ、任意の力によって接触する。
【００２３】
入力パターン分類部４４には、予め複数種類の入力パターンが設定されている。この予め設定された入力パターンは、操作力の入力パターンであって、加えられた操作力が所定の閾値を超えた時刻を、入力開始時刻とし、その操作力の大きさが、入力開始時刻から所定期間以内において、どのように変化するのかによって、複数種類に分類されている。
【００２４】
例えば、加えられた操作力が入力開始時刻から所定期間以内で閾値以下となる入力パターンは、アーム１２の高精度移動に対応した操作力の入力パターンとする。また、加えられた操作力が入力開始時刻から所定期間以内で閾値を常に越えている入力パターンは、アーム１２の高速移動に対応した操作力の入力パターンとする。
【００２５】
作業者は、予め設定された複数種類の入力パターン、加える操作力の入力パターンが予め設定された入力パターンとなるための動作パターン（リンク部材２１ａ〜２１ｆに対する操作）、及び、動作後におけるリンク部材２１ａ〜２１ｆ及び手先部２３の移動形態を、予め記憶している。これに対して、入力パターン分類部４４は、力推定部４１によって推定された操作力の入力パターンが、予め設定された入力パターンと一致するか否かを判断し、それらが一致した場合に、推定された操作力の入力パターンを、高精度移動に対応した入力パターン及び高速移動に対応した入力パターンのいずれか一方に分類する。
【００２６】
力制御切り替え部４５は、入力パターン分類部４４によって分類された、操作力の入力パターンの種類に応じて、力制御部４２の力制御を切り替える。
【００２７】
力制御切り替え部４５は、推定された操作力の入力パターンが、高精度移動に対応した入力パターンに分類された場合には、操作軸となるリンク部材２１ａ〜２１ｆが予め規定された動作を実行するように、力制御部４２に指令する。また、力制御切り替え部４５は、推定された操作力の入力パターンが、高速移動に対応した入力パターンに分類された場合には、軽い操作力によって、従来の直接教示が行えるように、力制御部４２に指令する。
【００２８】
次に、この発明の実施の形態１に係るロボットの直接教示装置の処理過程について、図４を用いて説明する。
【００２９】
先ず、ステップＳＴ１において、作業者は、多関節ロボット１０に対する直接教示を行うことを、直接教示装置４０に指示するか否かを判断する。ここで、直接教示を実行すると判断した場合には、ステップＳＴ２に進む。一方、直接教示を実行しないと判断した場合には、処理を終了する。
【００３０】
次いで、ステップＳＴ２において、作業者は、リンク部材２１ａ〜２１ｆのうち、いずれか１つのリンク部材２１ａ〜２１ｆに操作力を加えて、手先部２３を、目標位置となる作業位置に向けて誘導する。このとき、各トルクセンサ３４は、リンク部材２１ａ〜２１ｆの軸Ｊ１〜Ｊ６に作用する力を、それぞれ検出する。
【００３１】
そして、ステップＳＴ３において、力推定部４１は、全てのトルクセンサ３４の検出結果に基づいて、操作力が加えられたリンク部材２１ａ〜２１ｆ、及び、その操作力の大きさを推定する。
【００３２】
具体的に、力推定部４１は、操作力が加えられたリンク部材よりも先端側に位置するリンク部材には力が作用しない（トルクセンサ３４の出力値が変化しない）ことを利用して、操作力が加えられたリンク部材２１ａ〜２１ｆを推定する。
【００３３】
また、力推定部４１は、操作力の大きさを、下記の式（１）を用いて推定する。
ｆ＝Ｊ−Ｔτ    …（１）
但し、
ｆ＝［ｆｘ ｆｙ ｆｚ ｆα ｆβ ｆγ］Ｔ：作業者が加えた操作力
τ＝［τ１ τ２ τ３ τ４ τ５ τ６］Ｔ：重力補償済み出力値
Ｊ：［操作力が加えられたリンク部材の軸方向中央部における速度］＝Ｊ×
［操作力が加えられたリンク部材に対応する関節部の速度］を満たす行列
なお、ｆｘ、ｆｙ、ｆｚは、直交３軸における各並進力であり、ｆα、ｆβ、ｆγは、直交３軸における各回転力である。
また、τ１、τ２、τ３、τ４、τ５、τ６は、６つのトルクセンサ３４の各重力補償済み出力値である。
【００３４】
次いで、ステップＳＴ４において、入力パターン分類部４４は、推定された操作力の入力パターンが、予め設定された複数種類の入力パターンのいずれか１つと一致するか否かを判断する。ここで、推定された操作力の入力パターンが予め設定された入力パターンと一致したと判断した場合には、ステップＳＴ５に進む。一方、推定された操作力の入力パターンが予め設定された入力パターンと一致しないと判断した場合には、ステップＳＴ２に戻る。
【００３５】
そして、ステップＳＴ５において、入力パターン分類部４４は、推定された操作力の入力パターンを、高精度移動に対応した入力パターンに分類することができるか否かを判断する。ここで、分類できると判断した場合には、ステップＳＴ６に進む。一方、分類できないと判断した場合には、ステップＳＴ７に進む。
【００３６】
ここで、入力パターン分類部４４に予め設定された入力パターン、及び、それに対応したリンク部材２１ａ〜２１ｆの動作形態について、図５Ａから図５Ｃ及び図６を用いて説明する。なお、図６は、リンク部材２１ａ〜２１ｆのうち、リンク部材２１ａを代表して図示している。また、図６の白抜き矢印は、作業者が叩く方向を示している。
【００３７】
図５Ａに示した操作力の入力パターンは、アーム１２の高精度移動に対応した入力パターンである。この高精度移動に対応した入力パターンは、加えられた操作力が所定の閾値ｆｏを超えた時刻を、入力開始時刻ｔｏとし、その操作力が、入力開始時刻ｔｏから所定期間ｔ以内で、１回閾値ｆｏ以下となり、そのまま終了する入力パターンとなっている。つまり、上記高精度移動に対応した入力パターンは、操作力が、入力開始時刻ｔｏから所定期間ｔ以内で、１つのピーク値を有している。これに対して、そのような入力パターンを得るための作業者の動作パターンは、リンク部材２１ａ〜２１ｆのいずれか１つを１回叩く動作となっている。
【００３８】
これにより、図６に示すように、作業者によって、リンク部材２１ａ〜２１ｆが１回叩かれると、アーム１２の手先部２３は、予め規定された動作量だけ、その叩かれた方向に向けて移動する。
【００３９】
図５Ｂに示した操作力の入力パターンは、アーム１２の高精度移動に対応した他の入力パターンである。この高精度移動に対応した入力パターンは、加えられた操作力が、入力開始時刻ｔｏから所定期間ｔ以内で、２回閾値ｆｏ以下となり、そのまま終了する入力パターンとなっている。つまり、上記高精度移動に対応した入力パターンは、操作力が、入力開始時刻ｔｏから所定期間ｔ以内で、２つのピーク値を有している。これに対して、そのような入力パターンを得るための作業者の動作パターンは、リンク部材２１ａ〜２１ｆのいずれか１つを２回叩く動作となっている。
【００４０】
これにより、図６に示すように、作業者によって、リンク部材２１ａ〜２１ｆが２回叩かれると、アーム１２の手先部２３は、予め規定された動作量だけ、演算結果の方向に向けて回転する。
【００４１】
図５Ｃに示した操作力の入力パターンは、アーム１２の高速移動に対応した入力パターンである。この高速移動に対応した入力パターンは、加えられた操作力が、入力開始時刻ｔｏから所定期間ｔ以内において、常に閾値ｆｏを超える入力パターンとなっている。これに対して、そのような入力パターンを得るための作業者の動作パターンは、リンク部材２１ａ〜２１ｆを押し続ける動作となっている。
【００４２】
次いで、ステップＳＴ６において、手先部２３は、従来の直接教示によって移動することにより、目標位置及び目標姿勢が教示される。
【００４３】
具体的に、推定された操作力の入力パターンが高精度並進移動に対応した入力パターンに分類された合には、先ず、力制御部４２は、加えられた操作力の作用方向（並進方向）ｇを、下記の式（２）を用いて推定する。
ｇ＝［ｆｘ ｆｙ ｆｚ］Ｔ／｜［ｆｘ ｆｙ ｆｚ］Ｔ｜    …（２）
【００４４】
続いて、力制御部４２は、操作力の作用方向ｇにおいて、手先部２３の目標位置及び目標姿勢ｒを、下記の式（３）を用いて設定する。そして、手先部２３は、現在の位置及び姿勢ｐから、設定した目標位置及び目標姿勢ｒに向けて、作用方向ｇに応じた移動方向に沿って移動する。
ｒ＝ｐ＋Ｋ［ｇＴ０１×３］Ｔ    …（３）
但し、
ｐ＝［ｐｘ ｐｙ ｐｚ ｐα ｐβ ｐγ］Ｔ：現在の位置及び姿勢
Ｋ：定数
【００４５】
また、推定された操作力の入力パターンが高精度回転移動に対応した入力パターンに分類された場合には、力制御部４２は、操作力の作用方向に応じて、手先部２３を回転させる。
【００４６】
先ず、１つ目の力制御方法として、作業者が叩いたリンク部材２１ａ〜２１ｆに応じて、手先部２３を回転させる場合には、力制御部４２は、リンク部材２１ａ，２１ｃ，２１ｅを回転方向Ｒ１に向けて回転させる一方、リンク部材２１ｂ，２１ｄ，２１ｆを回転方向Ｒ２に向けて回転させるように設定する。
【００４７】
つまり、作業者がリンク部材２１ａ，２１ｃ，２１ｅのいずれか１つのリンク部材を２回叩いた場合には、手先部２３は、リンク部材２１ａ，２１ｃ，２１ｅの回転方向Ｒ１への回転に伴って、その軸Ｊ１，Ｊ３，Ｊ５を回転中心として回転する。一方、作業者がリンク部材２１ｂ，２１ｄ，２１ｆのいずれか１つのリンク部材を２回叩いた場合には、手先部２３は、リンク部材２１ｂ，２１ｂ，２１ｆの回転方向Ｒ２への回転に伴って、その軸Ｊ２，Ｊ４，Ｊ６を回転中心として回転する。
【００４８】
また、２つ目の力制御方法として、操作力の作用方向に応じて、手先部２３を回転させる場合には、図６に示すように、力制御部４２は、リンク部材２１ａ〜２１ｆの軸Ｊ１〜Ｊ６を通る基準線Ｏを基準角度として、その基準線Ｏと、軸Ｊ１〜Ｊ６を通る操作力の作用方向との交差角度θｆが、０〜１７９［ｄｅｇ］であるときに、リンク部材２１ａ〜２１ｆを回転方向Ｒ１に向けて回転させる一方、１８０〜３５９［ｄｅｇ］であるときに、リンク部材２１ａ〜２１ｆを回転方向Ｒ２に向けて回転させる。
【００４９】
つまり、作業者がリンク部材２１ａ〜２１ｆのいずれか１つのリンク部材を２回叩いた場合には、叩かれたリンク部材２１ａ〜２１ｆは、交差角度θｆに応じて、回転方向Ｒ１または回転方向Ｒ２に向けて回転する。これにより、手先部２３は、その叩かれたリンク部材２１ａ〜２１ｆの軸Ｊ１〜Ｊ６を回転中心として回転する。
【００５０】
力制御部４２は、上述した２つの力制御方法のいずれかを採用した場合であっても、リンク部材２１ｆの目標回転角度θｒ６を、下記の式（４）を用いて設定する。
θｒｉ＝θｉ＋Ｋｓ    …（４）
但し、
ｉ：リンク部材２１ａ〜２１ｆに対応する番号(手先部２３が回転する場合はｉ＝６)
θｉ：ｉに対応するリンク部材における現在の回転角度
Ｋ：定数
ｓ：回転方向Ｒ１のときは「１」、回転方向Ｒ２のときは「−１」となる変数
【００５１】
これに対して、ステップＳＴ７において、手先部２３は、アーム１２を軽い操作力によって移動させることができるような、従来の直接教示によって、移動することにより、目標位置及び目標姿勢が教示される。このとき、加えられた操作力が閾値ｆｏ以下になると、ステップＳＴ８に進む。
【００５２】
次いで、ステップＳＴ８において、作業者は、多関節ロボット１０に対する直接教示を終了することを、直接教示装置４０に指示するか否かを判断する。ここで、直接教示を終了すると判断した場合には、処理を終了する。一方、直接教示を終了しないと判断した場合には、ステップＳＴ２に進む。
【００５３】
以上、実施の形態１に係るロボットの直接教示装置及び直接教示方法は、多関節ロボット１０に対する教示作業時において、その教示効率を低下させることなく、高速移動と高精度移動とを使い分けることができる。
【００５４】
実施の形態２．
この実施の形態２に係るロボットの直接教示装置及びその方法は、実施の形態１に係るロボットの直接教示装置及びその方法における６つのトルクセンサ３４に替えて、１つの６軸力センサ（図示省略）を手先部２３に設けている。
【００５５】
これにより、力推定部４１は、多軸力センサとなる６軸力センサの検出結果のみを用いて、操作力ｆの大きさを、下記の式（５）を用いて推定する。
ｆ＝［ｆｘ ｆｙ ｆｚ ｆα ｆβ ｆγ］Ｔ    …（５）
【００５６】
また、推定された操作力の入力パターンが高精度回転移動に対応した入力パターンに分類された場合には、力制御部４２は、操作力の作用方向に応じて、手先部２３を回転させる。つまり、６つのトルクセンサ３４を設けた場合には、それらが各軸Ｊ１〜Ｊ６に対応して設けられているため、力推定部４１は、操作力がどのリンク部材２１ａ〜２１ｆに直接作用したのかを推定することができる。これに対して、６軸力センサを設けた場合には、それが各軸Ｊ１〜Ｊ６に対応して設けられていないため、力推定部４１は、操作力がどのリンク部材２１ａ〜２１ｆに直接作用したのかを推定することができない。従って、力制御部４２は、上述した２つ目の力制御方法のみを採用する。
【００５７】
以上、実施の形態２に係るロボットの直接教示装置及び直接教示方法は、多関節ロボット１０に対する教示作業時において、その教示効率を低下させることなく、高速移動と高精度移動とを使い分けることができる。
【００５８】
なお、本願発明は、その発明の範囲内において、各実施の形態の自由な組み合わせ、あるいは、各実施の形態における任意の構成要素の変形、もしくは、各実施の形態における任意の構成要素の省略が可能である。
【符号の説明】
【００５９】
１０  多関節ロボット
１１  基台
１２  アーム
２１ａ〜２１ｆ  リンク部材
２２ａ〜２２ｆ  関節部
２３  手先部
３１  モータ
３１ａ  回転軸
３２  中心軸
３３  連結軸
３４  トルクセンサ
３５  取付板
３６  直接教示指示部
４０  直接教示装置
４１  力推定部
４２  力制御部
４３  モータドライバ
４４  入力パターン分類部
４５  力制御切り替え部
Ｊ１〜Ｊ６  軸
【図１】
2019093526.tif 000003
【図２】
2019093526.tif 000004
【図３】
2019093526.tif 000005
【図４】
2019093526.tif 000006
【図５】
2019093526.tif 000007
【図６】
2019093526.tif 000008