JP6964494B2

JP6964494B2 - ロボットの直接教示装置及びその方法

Info

Publication number: JP6964494B2
Application number: JP2017227223A
Authority: JP
Inventors: 広大杉本; 裕樹佐藤
Original assignee: Azbil Corp
Current assignee: Azbil Corp
Priority date: 2017-11-27
Filing date: 2017-11-27
Publication date: 2021-11-10
Anticipated expiration: 2037-11-27
Also published as: KR20200064115A; CN111356559A; WO2019102746A1; JP2019093526A

Description

この発明は、ロボットに対して操作力を加えて、その手先位置を直接教示するロボットの直接教示装置及びその方法に関する。

従来、力制御に基づいたロボットの直接教示方法が、種々提供されている。このロボットの直接教示方法の１つとして、ロボットに加えた操作力を検出し、その検出結果に基づいてロボットを移動させて、その手先位置を直接教示する方法がある。このような、従来のロボットの直接教示方法としては、例えば、特許文献１に開示されている。

特開平３−１２３９０７号公報

上記従来の直接教示方法においては、手先位置を教示する際に、軽い操作力によってロボットを高速移動させるモードと、強い操作力によってロボットを低速移動させるモードとの間で、切り替え可能としている。しかしながら、このような直接教示方法を採用すると、作業者は、教示モードを切り替える度に、スイッチ切り替え操作を必要とするため、ロボットに対する教示効率が低下するおそれがある。

この発明は、上記課題を解決するものであって、ロボットに対する教示作業時において、その教示効率を低下させることなく、高速移動と高精度移動とを使い分けることができるロボットの直接教示装置及びその方法を提供することを目的とする。

この発明に係るロボットの直接教示装置は、複数の軸を有する多関節ロボットに加わる操作力を力センサによって検出し、その検出結果に基づいた力制御部の力制御に従って、多関節ロボットを移動させて、その位置を直接教示するロボットの直接教示装置において、力センサの検出結果に基づいて、軸に加えられた操作力を推定する力推定部と、力推定部によって推定された操作力の入力パターンを、予め設定された入力パターンの種類ごとに分類する入力パターン分類部と、入力パターン分類部によって分類された操作力の入力パターンに応じて、力制御部の力制御を切り替える力制御切り替え部とを備え、力制御部は、推定された操作力の入力パターンが、多関節ロボットの回転移動に対応した入力パターンに分類された場合には、多関節ロボットにおける手先部の回転方向を制御するものである。
この発明に係るロボットの直接教示装置は、複数の軸を有する多関節ロボットに加わる操作力を力センサによって検出し、その検出結果に基づいた力制御部の力制御に従って、多関節ロボットを移動させて、その位置を直接教示するロボットの直接教示装置において、力センサの検出結果に基づいて、軸に加えられた操作力を推定する力推定部と、力推定部によって推定された操作力の入力パターンを、予め設定された入力パターンの種類ごとに分類する入力パターン分類部と、入力パターン分類部によって分類された操作力の入力パターンに応じて、力制御部の力制御を切り替える力制御切り替え部とを備え、力制御部は、推定された操作力の入力パターンが、多関節ロボットの並進移動に対応した入力パターンに分類された場合には、多関節ロボットにおける手先部の移動方向を、操作力の作用方向に応じて制御するものである。
この発明に係るロボットの直接教示装置は、複数の軸を有する多関節ロボットに加わる操作力を力センサによって検出し、その検出結果に基づいた力制御部の力制御に従って、多関節ロボットを移動させて、その位置を直接教示するロボットの直接教示装置において、力センサの検出結果に基づいて、軸に加えられた操作力を推定する力推定部と、力推定部によって推定された操作力の入力パターンを、予め設定された入力パターンの種類ごとに分類する入力パターン分類部と、入力パターン分類部によって分類された操作力の入力パターンに応じて、力制御部の力制御を切り替える力制御切り替え部とを備え、力センサは、多関節ロボットの各関節部に設けられ、力推定部は、各関節部に設けられた力センサの出力値が変化しないことを利用して、複数の軸の中から、操作力が加えられた軸を推定するものである。

この発明に係るロボットの教示方法は、複数の軸を有する多関節ロボットに加わる操作力を力センサによって検出し、その検出結果に基づいた力制御に従って、多関節ロボットを移動させて、その位置を直接教示するロボットの直接教示方法において、力センサの検出結果に基づいて、軸に加えられた操作力を推定し、推定された操作力の入力パターンを、予め設定された入力パターンの種類ごとに分類し、分類された操作力の入力パターンに応じて、力制御を切り替え、力制御部は、推定された操作力の入力パターンが、多関節ロボットの回転移動に対応した入力パターンに分類された場合には、多関節ロボットにおける手先部の回転方向を制御するものである。
この発明に係るロボットの教示方法は、複数の軸を有する多関節ロボットに加わる操作力を力センサによって検出し、その検出結果に基づいた力制御に従って、多関節ロボットを移動させて、その位置を直接教示するロボットの直接教示方法において、力センサの検出結果に基づいて、軸に加えられた操作力を推定し、推定された操作力の入力パターンを、予め設定された入力パターンの種類ごとに分類し、分類された操作力の入力パターンに応じて、力制御を切り替え、力制御部は、推定された操作力の入力パターンが、多関節ロボットの並進移動に対応した入力パターンに分類された場合には、多関節ロボットにおける手先部の移動方向を、操作力の作用方向に応じて制御するものである。
この発明に係るロボットの教示方法は、複数の軸を有する多関節ロボットに加わる操作力を力センサによって検出し、その検出結果に基づいた力制御に従って、多関節ロボットを移動させて、その位置を直接教示するロボットの直接教示方法において、力センサの検出結果に基づいて、軸に加えられた操作力を推定し、推定された操作力の入力パターンを、予め設定された入力パターンの種類ごとに分類し、分類された操作力の入力パターンに応じて、力制御を切り替え、力センサは、多関節ロボットの各関節部に設けられ、力推定部は、各関節部に設けられた力センサの出力値が変化しないことを利用して、複数の軸の中から、操作力が加えられた軸を推定するものである。

この発明によれば、ロボットに対する教示作業時において、その教示効率を低下させることなく、高速移動と高精度移動とを使い分けることができる。

この発明の実施の形態１に係るロボットの直接教示装置が適用される多関節ロボットの構成を示した外観図である。各関節部内におけるトルクセンサの設置状態を示した図である。この発明の実施の形態１に係るロボットの直接教示装置の構成を示したブロックである。この発明の実施の形態１に係るロボットの直接教示装置の処理過程を示したフローチャートである。予め設定された操作力の入力パターンの一例を示した図である。５Ａは、高精度並進移動に対応した操作力の入力パターンを示した図である。５Ｂは、高精度回転移動に対応した操作力の入力パターンを示した図である。５Ｃは、高速移動に対応した操作力の入力パターンを示した図である。作業者の動作パターンに対応したリンク部材の移動形態を示した図である。

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

実施の形態１．
図１は、この発明の実施の形態１に係るロボットの直接教示装置が適用される多関節ロボット１０の構成例を示した外観図である。図１に示すように、多関節ロボット１０は、基台１１と、この基台１１に支持されるアーム１２とから構成されている。アーム１２は、６自由度を有しており、６つのリンク部材２１ａ〜２１ｆ、６つの関節部２２ａ〜２２ｆ、及び、手先部２３から構成されている。つまり、多関節ロボット１０は、一般的な６軸多関節ロボットである。但し、本発明に係るロボット直接教示装置及びその方法は、多関節ロボットの構成及び自由度数によって、その本質が失われるものではない。

リンク部材２１ａ〜２１ｆは、軸Ｊ１〜Ｊ６をそれぞれ有しており、アーム１２の基端側から先端側に向けて順に配置されている。手先部２３は、リンク部材２１ｆの先端に設けられており、アーム１２の先端部を構成している。

関節部２２ａ〜２２ｆは、基台１１とリンク部材２１ａとの間、リンク部材２１ａ，２１ｂ間、リンク部材２１ｂ，２１ｃ間、リンク部材２１ｃ，２１ｄ間、リンク部材２１ｄ，２１ｅ間、及び、リンク部材２１ｅ，２１ｆ間を、それぞれ繋いでいる。更に、関節部２２ａ〜２２ｆは、リンク部材２１ａ〜２１ｆを軸Ｊ１〜Ｊ６周りに回転可能に支持している。

上記多関節ロボット１０に対する教示作業を行う場合には、作業者は、リンク部材２１ａ〜２２ｆのうち、いずれか１つのリンク部材２１ａ〜２２ｆを操作する。つまり、作業者から加えられた操作力は、６つの軸Ｊ１〜Ｊ６のうち、複数の軸に作用し、その操作力が作用した軸Ｊ１〜Ｊ６は、操作軸として移動し、アーム１２全体を移動させる。このとき、手先部２３は、操作軸の直線移動または回転移動に伴って、並進移動または回転移動するため、その位置及び姿勢が教示される。

図２は、各関節部２２ａ〜２２ｆにおけるトルクセンサ３４の設置状態を示した図である。図２に示すように、モータ３１の回転軸３１ａ、リンク部材２１ａ〜２１ｆの中心軸３２、連結軸３３、及び、力センサとなるトルクセンサ３４は、各関節部２２ａ〜２２ｆ内に、それぞれ設けられている。モータ３１は、リンク部材２１ａ〜２１ｆを、その中心軸３２を回転中心として回転させる。トルクセンサ３４は、各リンク部材２１ａ〜２１ｆの中心軸３２に作用した操作力をそれぞれ検出する。

モータ３１の回転軸３１ａと中心軸３２とは、連結軸３３を介して連結されている。連結軸３３の軸径は、回転軸３１ａの軸径及び中心軸３２の軸径よりも小径となっている。モータ３１の回転軸３１ａ、中心軸３２、連結軸３３は、及び、関節部２２ａ〜２２ｆの関節軸は、各軸Ｊ１〜Ｊ６と同軸状になっている。つまり、回転軸３１ａ、中心軸３２、及び、連結軸３３は、軸Ｊ１〜Ｊ６周りに回転する。

トルクセンサ３４は、取付板３５を介して、回転軸３１ａ及び中心軸３２に取り付けられており、それらの軸３１ａ，３２と共に回転する。取付板３５は、回転軸３１ａの外周面と中心軸３２の外周面との間において、それらの間に形成される軸方向隙間を跨ぐように設けられている。これにより、トルクセンサ３４は、作業者による操作力が中心軸３２に作用すると、これに伴って歪を生じ、その歪量を、操作力の大きさに換算して検出する。

図３は、この発明の実施の形態１に係るロボットの直接教示装置４０の構成を示したブロックである。図３に示した直接教示装置４０は、多関節ロボット１０に対する作業者の直接教示作業を可能にするものであって、多関節ロボット１０及び直接教示指示部３６と接続されている。

直接教示指示部３６は、作業者が、多関節ロボット１０に対して直接教示を行うことを、直接教示装置４０に指示する際に使用するものである。作業者は、直接教示指示部３６のスイッチ切り替え操作によって、多関節ロボット１０に対する直接教示の実行または停止を選択することができる。

図３に示すように、直接教示装置４０は、力推定部４１、力制御部４２、モータドライバ４３、入力パターン分類部４４、及び、力制御切り替え部４５を有している。

力推定部４１は、トルクセンサ３４の出力結果に基づいて、作業者によって操作力が加えられたリンク部材２１ａ〜２１ｆ、及び、その操作力の大きさ（入力パターン）を推定する。力制御部４２は、力推定部４１の推定結果に基づいて、モータドライバ４３の駆動を制御する。モータドライバ４３は、モータ３１の回転角度を制御する。

つまり、力制御部４２は、操作力が直接的に加えられたリンク部材２１ａ〜２１ｆと、その操作力の大きさとに基づいて、モータドライバ４３の駆動を制御して、各モータ３１の回転角度を調整する。これにより、直接教示装置４０は、アーム１２を操作力に基づいて動作させて、その手先部２３を、目標位置となる作業位置に誘導し、その作業位置を教示する。この結果、手先部２３は、作業対象物に対して、任意の方向から、任意の姿勢で、且つ、任意の力によって接触する。

入力パターン分類部４４には、予め複数種類の入力パターンが設定されている。この予め設定された入力パターンは、操作力の入力パターンであって、加えられた操作力が所定の閾値を超えた時刻を、入力開始時刻とし、その操作力の大きさが、入力開始時刻から所定期間以内において、どのように変化するのかによって、複数種類に分類されている。

例えば、加えられた操作力が入力開始時刻から所定期間以内で閾値以下となる入力パターンは、アーム１２の高精度移動に対応した操作力の入力パターンとする。また、加えられた操作力が入力開始時刻から所定期間以内で閾値を常に越えている入力パターンは、アーム１２の高速移動に対応した操作力の入力パターンとする。

作業者は、予め設定された複数種類の入力パターン、加える操作力の入力パターンが予め設定された入力パターンとなるための動作パターン（リンク部材２１ａ〜２１ｆに対する操作）、及び、動作後におけるリンク部材２１ａ〜２１ｆ及び手先部２３の移動形態を、予め記憶している。これに対して、入力パターン分類部４４は、力推定部４１によって推定された操作力の入力パターンが、予め設定された入力パターンと一致するか否かを判断し、それらが一致した場合に、推定された操作力の入力パターンを、高精度移動に対応した入力パターン及び高速移動に対応した入力パターンのいずれか一方に分類する。

力制御切り替え部４５は、入力パターン分類部４４によって分類された、操作力の入力パターンの種類に応じて、力制御部４２の力制御を切り替える。

力制御切り替え部４５は、推定された操作力の入力パターンが、高精度移動に対応した入力パターンに分類された場合には、操作軸となるリンク部材２１ａ〜２１ｆが予め規定された動作を実行するように、力制御部４２に指令する。また、力制御切り替え部４５は、推定された操作力の入力パターンが、高速移動に対応した入力パターンに分類された場合には、軽い操作力によって、従来の直接教示が行えるように、力制御部４２に指令する。

次に、この発明の実施の形態１に係るロボットの直接教示装置の処理過程について、図４を用いて説明する。

先ず、ステップＳＴ１において、作業者は、多関節ロボット１０に対する直接教示を行うことを、直接教示装置４０に指示するか否かを判断する。ここで、直接教示を実行すると判断した場合には、ステップＳＴ２に進む。一方、直接教示を実行しないと判断した場合には、処理を終了する。

次いで、ステップＳＴ２において、作業者は、リンク部材２１ａ〜２１ｆのうち、いずれか１つのリンク部材２１ａ〜２１ｆに操作力を加えて、手先部２３を、目標位置となる作業位置に向けて誘導する。このとき、各トルクセンサ３４は、リンク部材２１ａ〜２１ｆの軸Ｊ１〜Ｊ６に作用する力を、それぞれ検出する。

そして、ステップＳＴ３において、力推定部４１は、全てのトルクセンサ３４の検出結果に基づいて、操作力が加えられたリンク部材２１ａ〜２１ｆ、及び、その操作力の大きさを推定する。

具体的に、力推定部４１は、操作力が加えられたリンク部材よりも先端側に位置するリンク部材には力が作用しない（トルクセンサ３４の出力値が変化しない）ことを利用して、操作力が加えられたリンク部材２１ａ〜２１ｆを推定する。

また、力推定部４１は、操作力の大きさを、下記の式（１）を用いて推定する。
ｆ＝Ｊ^−Ｔτ …（１）
但し、
ｆ＝［ｆｘｆｙｆｚｆα ｆβ ｆγ］^Ｔ：作業者が加えた操作力
τ＝［τ１ τ２ τ３ τ４ τ５ τ６］^Ｔ：重力補償済み出力値
Ｊ：［操作力が加えられたリンク部材の軸方向中央部における速度］＝Ｊ×
［操作力が加えられたリンク部材に対応する関節部の速度］を満たす行列
なお、ｆｘ、ｆｙ、ｆｚは、直交３軸における各並進力であり、ｆα、ｆβ、ｆγは、直交３軸における各回転力である。
また、τ１、τ２、τ３、τ４、τ５、τ６は、６つのトルクセンサ３４の各重力補償済み出力値である。

次いで、ステップＳＴ４において、入力パターン分類部４４は、推定された操作力の入力パターンが、予め設定された複数種類の入力パターンのいずれか１つと一致するか否かを判断する。ここで、推定された操作力の入力パターンが予め設定された入力パターンと一致したと判断した場合には、ステップＳＴ５に進む。一方、推定された操作力の入力パターンが予め設定された入力パターンと一致しないと判断した場合には、ステップＳＴ２に戻る。

そして、ステップＳＴ５において、入力パターン分類部４４は、推定された操作力の入力パターンを、高精度移動に対応した入力パターンに分類することができるか否かを判断する。ここで、分類できると判断した場合には、ステップＳＴ６に進む。一方、分類できないと判断した場合には、ステップＳＴ７に進む。

ここで、入力パターン分類部４４に予め設定された入力パターン、及び、それに対応したリンク部材２１ａ〜２１ｆの動作形態について、図５Ａから図５Ｃ及び図６を用いて説明する。なお、図６は、リンク部材２１ａ〜２１ｆのうち、リンク部材２１ａを代表して図示している。また、図６の白抜き矢印は、作業者が叩く方向を示している。

図５Ａに示した操作力の入力パターンは、アーム１２の高精度移動に対応した入力パターンである。この高精度移動に対応した入力パターンは、加えられた操作力が所定の閾値ｆｏを超えた時刻を、入力開始時刻ｔｏとし、その操作力が、入力開始時刻ｔｏから所定期間ｔ以内で、１回閾値ｆｏ以下となり、そのまま終了する入力パターンとなっている。つまり、上記高精度移動に対応した入力パターンは、操作力が、入力開始時刻ｔｏから所定期間ｔ以内で、１つのピーク値を有している。これに対して、そのような入力パターンを得るための作業者の動作パターンは、リンク部材２１ａ〜２１ｆのいずれか１つを１回叩く動作となっている。

これにより、図６に示すように、作業者によって、リンク部材２１ａ〜２１ｆが１回叩かれると、アーム１２の手先部２３は、予め規定された動作量だけ、その叩かれた方向に向けて移動する。

図５Ｂに示した操作力の入力パターンは、アーム１２の高精度移動に対応した他の入力パターンである。この高精度移動に対応した入力パターンは、加えられた操作力が、入力開始時刻ｔｏから所定期間ｔ以内で、２回閾値ｆｏ以下となり、そのまま終了する入力パターンとなっている。つまり、上記高精度移動に対応した入力パターンは、操作力が、入力開始時刻ｔｏから所定期間ｔ以内で、２つのピーク値を有している。これに対して、そのような入力パターンを得るための作業者の動作パターンは、リンク部材２１ａ〜２１ｆのいずれか１つを２回叩く動作となっている。

これにより、図６に示すように、作業者によって、リンク部材２１ａ〜２１ｆが２回叩かれると、アーム１２の手先部２３は、予め規定された動作量だけ、演算結果の方向に向けて回転する。

図５Ｃに示した操作力の入力パターンは、アーム１２の高速移動に対応した入力パターンである。この高速移動に対応した入力パターンは、加えられた操作力が、入力開始時刻ｔｏから所定期間ｔ以内において、常に閾値ｆｏを超える入力パターンとなっている。これに対して、そのような入力パターンを得るための作業者の動作パターンは、リンク部材２１ａ〜２１ｆを押し続ける動作となっている。

次いで、ステップＳＴ６において、手先部２３は、従来の直接教示によって移動することにより、目標位置及び目標姿勢が教示される。

具体的に、推定された操作力の入力パターンが高精度並進移動に対応した入力パターンに分類された合には、先ず、力制御部４２は、加えられた操作力の作用方向（並進方向）ｇを、下記の式（２）を用いて推定する。
ｇ＝［ｆｘｆｙｆｚ］^Ｔ／｜［ｆｘｆｙｆｚ］^Ｔ｜ …（２）

続いて、力制御部４２は、操作力の作用方向ｇにおいて、手先部２３の目標位置及び目標姿勢ｒを、下記の式（３）を用いて設定する。そして、手先部２３は、現在の位置及び姿勢ｐから、設定した目標位置及び目標姿勢ｒに向けて、作用方向ｇに応じた移動方向に沿って移動する。
ｒ＝ｐ＋Ｋ［ｇ^Ｔ０_１×３］^Ｔ …（３）
但し、
ｐ＝［ｐｘｐｙｐｚｐα ｐβ ｐγ］^Ｔ：現在の位置及び姿勢
Ｋ：定数

また、推定された操作力の入力パターンが高精度回転移動に対応した入力パターンに分類された場合には、力制御部４２は、操作力の作用方向に応じて、手先部２３を回転させる。

先ず、１つ目の力制御方法として、作業者が叩いたリンク部材２１ａ〜２１ｆに応じて、手先部２３を回転させる場合には、力制御部４２は、リンク部材２１ａ，２１ｃ，２１ｅを回転方向Ｒ１に向けて回転させる一方、リンク部材２１ｂ，２１ｄ，２１ｆを回転方向Ｒ２に向けて回転させるように設定する。

つまり、作業者がリンク部材２１ａ，２１ｃ，２１ｅのいずれか１つのリンク部材を２回叩いた場合には、手先部２３は、リンク部材２１ａ，２１ｃ，２１ｅの回転方向Ｒ１への回転に伴って、その軸Ｊ１，Ｊ３，Ｊ５を回転中心として回転する。一方、作業者がリンク部材２１ｂ，２１ｄ，２１ｆのいずれか１つのリンク部材を２回叩いた場合には、手先部２３は、リンク部材２１ｂ，２１ｂ，２１ｆの回転方向Ｒ２への回転に伴って、その軸Ｊ２，Ｊ４，Ｊ６を回転中心として回転する。

また、２つ目の力制御方法として、操作力の作用方向に応じて、手先部２３を回転させる場合には、図６に示すように、力制御部４２は、リンク部材２１ａ〜２１ｆの軸Ｊ１〜Ｊ６を通る基準線Ｏを基準角度として、その基準線Ｏと、軸Ｊ１〜Ｊ６を通る操作力の作用方向との交差角度θｆが、０〜１７９［ｄｅｇ］であるときに、リンク部材２１ａ〜２１ｆを回転方向Ｒ１に向けて回転させる一方、１８０〜３５９［ｄｅｇ］であるときに、リンク部材２１ａ〜２１ｆを回転方向Ｒ２に向けて回転させる。

つまり、作業者がリンク部材２１ａ〜２１ｆのいずれか１つのリンク部材を２回叩いた場合には、叩かれたリンク部材２１ａ〜２１ｆは、交差角度θｆに応じて、回転方向Ｒ１または回転方向Ｒ２に向けて回転する。これにより、手先部２３は、その叩かれたリンク部材２１ａ〜２１ｆの軸Ｊ１〜Ｊ６を回転中心として回転する。

力制御部４２は、上述した２つの力制御方法のいずれかを採用した場合であっても、リンク部材２１ｆの目標回転角度θｒ６を、下記の式（４）を用いて設定する。
θｒｉ＝θｉ＋Ｋｓ …（４）
但し、
ｉ：リンク部材２１ａ〜２１ｆに対応する番号(手先部２３が回転する場合はｉ＝６)
θｉ：ｉに対応するリンク部材における現在の回転角度
Ｋ：定数
ｓ：回転方向Ｒ１のときは「１」、回転方向Ｒ２のときは「−１」となる変数

これに対して、ステップＳＴ７において、手先部２３は、アーム１２を軽い操作力によって移動させることができるような、従来の直接教示によって、移動することにより、目標位置及び目標姿勢が教示される。このとき、加えられた操作力が閾値ｆｏ以下になると、ステップＳＴ８に進む。

次いで、ステップＳＴ８において、作業者は、多関節ロボット１０に対する直接教示を終了することを、直接教示装置４０に指示するか否かを判断する。ここで、直接教示を終了すると判断した場合には、処理を終了する。一方、直接教示を終了しないと判断した場合には、ステップＳＴ２に進む。

以上、実施の形態１に係るロボットの直接教示装置及び直接教示方法は、多関節ロボット１０に対する教示作業時において、その教示効率を低下させることなく、高速移動と高精度移動とを使い分けることができる。

実施の形態２．
この実施の形態２に係るロボットの直接教示装置及びその方法は、実施の形態１に係るロボットの直接教示装置及びその方法における６つのトルクセンサ３４に替えて、１つの６軸力センサ（図示省略）を手先部２３に設けている。

これにより、力推定部４１は、多軸力センサとなる６軸力センサの検出結果のみを用いて、操作力ｆの大きさを、下記の式（５）を用いて推定する。
ｆ＝［ｆｘｆｙｆｚｆα ｆβ ｆγ］^Ｔ …（５）

また、推定された操作力の入力パターンが高精度回転移動に対応した入力パターンに分類された場合には、力制御部４２は、操作力の作用方向に応じて、手先部２３を回転させる。つまり、６つのトルクセンサ３４を設けた場合には、それらが各軸Ｊ１〜Ｊ６に対応して設けられているため、力推定部４１は、操作力がどのリンク部材２１ａ〜２１ｆに直接作用したのかを推定することができる。これに対して、６軸力センサを設けた場合には、それが各軸Ｊ１〜Ｊ６に対応して設けられていないため、力推定部４１は、操作力がどのリンク部材２１ａ〜２１ｆに直接作用したのかを推定することができない。従って、力制御部４２は、上述した２つ目の力制御方法のみを採用する。

以上、実施の形態２に係るロボットの直接教示装置及び直接教示方法は、多関節ロボット１０に対する教示作業時において、その教示効率を低下させることなく、高速移動と高精度移動とを使い分けることができる。

なお、本願発明は、その発明の範囲内において、各実施の形態の自由な組み合わせ、あるいは、各実施の形態における任意の構成要素の変形、もしくは、各実施の形態における任意の構成要素の省略が可能である。

１０多関節ロボット
１１基台
１２アーム
２１ａ〜２１ｆリンク部材
２２ａ〜２２ｆ関節部
２３手先部
３１モータ
３１ａ回転軸
３２中心軸
３３連結軸
３４トルクセンサ
３５取付板
３６直接教示指示部
４０直接教示装置
４１力推定部
４２力制御部
４３モータドライバ
４４入力パターン分類部
４５力制御切り替え部
Ｊ１〜Ｊ６軸

Claims

複数の軸を有する多関節ロボットに加わる操作力を力センサによって検出し、その検出結果に基づいた力制御部の力制御に従って、前記多関節ロボットを移動させて、その位置を直接教示するロボットの直接教示装置において、
前記力センサの検出結果に基づいて、前記軸に加えられた操作力を推定する力推定部と、
前記力推定部によって推定された操作力の入力パターンを、予め設定された入力パターンの種類ごとに分類する入力パターン分類部と、
前記入力パターン分類部によって分類された操作力の入力パターンに応じて、前記力制御部の力制御を切り替える力制御切り替え部とを備え、
前記力制御部は、
推定された操作力の入力パターンが、前記多関節ロボットの回転移動に対応した入力パターンに分類された場合には、
前記多関節ロボットにおける手先部の回転方向を制御する
ことを特徴とするロボットの直接教示装置。
複数の軸を有する多関節ロボットに加わる操作力を力センサによって検出し、その検出結果に基づいた力制御部の力制御に従って、前記多関節ロボットを移動させて、その位置を直接教示するロボットの直接教示装置において、
前記力センサの検出結果に基づいて、前記軸に加えられた操作力を推定する力推定部と、
前記力推定部によって推定された操作力の入力パターンを、予め設定された入力パターンの種類ごとに分類する入力パターン分類部と、
前記入力パターン分類部によって分類された操作力の入力パターンに応じて、前記力制御部の力制御を切り替える力制御切り替え部とを備え、
前記力制御部は、
推定された操作力の入力パターンが、前記多関節ロボットの並進移動に対応した入力パターンに分類された場合には、
前記多関節ロボットにおける手先部の移動方向を、操作力の作用方向に応じて制御する
ことを特徴とするロボットの直接教示装置。
複数の軸を有する多関節ロボットに加わる操作力を力センサによって検出し、その検出結果に基づいた力制御部の力制御に従って、前記多関節ロボットを移動させて、その位置を直接教示するロボットの直接教示装置において、
前記力センサの検出結果に基づいて、前記軸に加えられた操作力を推定する力推定部と、
前記力推定部によって推定された操作力の入力パターンを、予め設定された入力パターンの種類ごとに分類する入力パターン分類部と、
前記入力パターン分類部によって分類された操作力の入力パターンに応じて、前記力制御部の力制御を切り替える力制御切り替え部とを備え、
前記力センサは、前記多関節ロボットの各関節部に設けられ、
前記力推定部は、前記各関節部に設けられた前記力センサの出力値が変化しないことを利用して、前記複数の軸の中から、操作力が加えられた軸を推定する
ことを特徴とするロボットの直接教示装置。
前記力センサは、前記多関節ロボットの手先部に設けられた多軸力センサである
ことを特徴とする請求項１又は請求項２記載のロボットの直接教示装置。
複数の軸を有する多関節ロボットに加わる操作力を力センサによって検出し、その検出結果に基づいた力制御に従って、前記多関節ロボットを移動させて、その位置を直接教示するロボットの直接教示方法において、
前記力センサの検出結果に基づいて、前記軸に加えられた操作力を推定し、
推定された操作力の入力パターンを、予め設定された入力パターンの種類ごとに分類し、
分類された操作力の入力パターンに応じて、力制御を切り替え、
前記力制御部は、
推定された操作力の入力パターンが、前記多関節ロボットの回転移動に対応した入力パターンに分類された場合には、
前記多関節ロボットにおける手先部の回転方向を制御する
ことを特徴とするロボットの直接教示方法。
複数の軸を有する多関節ロボットに加わる操作力を力センサによって検出し、その検出結果に基づいた力制御に従って、前記多関節ロボットを移動させて、その位置を直接教示するロボットの直接教示方法において、
前記力センサの検出結果に基づいて、前記軸に加えられた操作力を推定し、
推定された操作力の入力パターンを、予め設定された入力パターンの種類ごとに分類し、
分類された操作力の入力パターンに応じて、力制御を切り替え、
前記力制御部は、
推定された操作力の入力パターンが、前記多関節ロボットの並進移動に対応した入力パターンに分類された場合には、
前記多関節ロボットにおける手先部の移動方向を、操作力の作用方向に応じて制御する
ことを特徴とするロボットの直接教示方法。
複数の軸を有する多関節ロボットに加わる操作力を力センサによって検出し、その検出結果に基づいた力制御に従って、前記多関節ロボットを移動させて、その位置を直接教示するロボットの直接教示方法において、
前記力センサの検出結果に基づいて、前記軸に加えられた操作力を推定し、
推定された操作力の入力パターンを、予め設定された入力パターンの種類ごとに分類し、
分類された操作力の入力パターンに応じて、力制御を切り替え、
前記力センサは、前記多関節ロボットの各関節部に設けられ、
前記力推定部は、前記各関節部に設けられた前記力センサの出力値が変化しないことを利用して、前記複数の軸の中から、操作力が加えられた軸を推定する
ことを特徴とするロボットの直接教示方法。