JP2004344998A - Robot controller - Google Patents

Abstract

An object of the present invention is to provide a robot control device capable of sufficiently guaranteeing work direction compliance.
In a robot control device provided with servo control means (2) capable of compliance control having friction compensation, a work command input means (3) for inputting work content and each joint of the robot based on an input result of the work command input means (3). And a friction compensation direction control means 5 for determining a direction of friction compensation for each joint of the robot 1 of the servo control means 2 from an output result of the movement direction determination means 4, The servo control means 2 executes friction compensation according to the output of the friction compensation direction control means 5.
[Selection diagram] Fig. 1

Description

ここでＫ１は定数であり、ｓは演算子である。
積分器１３５の出力は位相補償器１３６に与えられて位相制御動作時に位相補償の演算が行われ、このゲインＧ２は式２で示される。
【数２】

ここでαは定数である。
位相補償器１３６の出力は、もう１つの加算手段１３７に与えられる。加算手段１３７には、エンコーダ１２７の出力に応答する重力補償演算回路１３８からの出力が与えられて加算され、その加算出力はライン１３９から各軸のトルク指令値として制御回路１２２の増幅回路１２６に入力される。
【０００５】
図１７は、制御回路１２２の構成および動作を設定するためのブロック図である。図において、ライン１３９を介するサーボ制御回路１２３からの各軸のトルク指令信号は、ライン１３９を経て増幅回路１２６に与えられ、これによってサーボモータ１２５が駆動される。モータ１２５の負荷であるアームには、参照符１４１で示されるように重力が作用し、したがってモータ１２５によって駆動されるアームなどの負荷には、重力１４１が引き算され、その重力１４１が、重力回路１３８の出力により、キャンセルされて補償され、アームなどが移動される。アームなどの慣性力１４３の角加速度は、積分手段１４４によって積分されることによって、角速度が求められ、さらに積分手段１４５によってその角速度を積分することによって、アームなどの回転角が求められ、この回転角はエンコーダ１２７によって前述のように検出される。
【０００６】
図１８は特許文献１記載の発明の一実施例の動作を簡略化して示す図である。
ロボット１０９に適用作業をさせるとき、ロボット１０９のツール１１０に加わる外力Ｆに対して、任意の希望する移動方向１２０にそのツール１１０が逃げ動作をさせてコンプライアンス機能を達成するにあたり、外力に対して受動的にそのコンプライアンス機能が達成され、ツール１１０は図１８（１）に示されるようにコンプライアンス動作開始直前の一定の姿勢を保持し、その移動方向１２０は、ツール１１０の座標系で定める方向とし、コンプライアンス度を調整可能とし、各軸の重力補償は、計算式によって補償する構成とし、ワーク１１６への反力は、粘性抵抗力とし、静摩擦力が大きい基本軸である第１軸４などもまた動くように構成し、安全対策として、各軸の動作制限角度を設定するように構成される。このコンプライアンス度の調整のために、図１６に示されるサーボ制御回路１２３では、係数器１３１および１３４における位置ゲインＫｐおよび速度ゲインＫｖを調整することによって達成される。
外力によるツール１１０の各軸の変位を、エンコーダ１２７によって検出することによって、力センサなどを用いることが不要になる。
このように、従来のロボット制御装置は、エンコーダ１２７の位置情報用いて、位置変位が発生した時点で目標指令値を逐次更新することでコンプライアンス制御動作を実現するものである。
【０００７】
【発明が解決しようとする課題】
しかしながら、特許文献１に示す従来のロボット制御装置は、予め位置変位が発生し、それに基づく位置指令が与えられていることが前提となっており、初期の位置変位が発生する以前における、つまりロボットが静止した状態で、任意の方向から外力が作用した場合の静止摩擦力の低減については考察されておらず、静止摩擦力分の硬さがロボット側に残ったままである。
また、特許文献２に示す従来装置においては、各軸の補償方向を同期させて制御することまで考察されておらず、実際の適用にあたっては、ロボット先端の直交座標系において目的とする方向のコンプライアンスが得にくいという問題があった。
そのため、従来の両手法とも周辺機器と衝突した場合、静止摩擦分のダメージを受けてしまう問題があった。
また、作業者が直接教示をするような場合には、静止摩擦分の抵抗力が作業者に作用して操作性が悪化するといった問題があった。
そこで、本発明はこのような問題点に鑑みてなされたものであり、静止摩擦を、その方向性も考慮して、各軸の同期も考慮して効果的に補償し、ロボットが静止状態においても十分なコンプライアンス性を保証するロボット制御装置を提供することを第１の目的とする。
【０００８】
また、特許文献３および４に記載のこれらの方式ではロボット関節軸で発生する静止摩擦抵抗をそもそも考慮しておらず、コンプライアンス制御の柔軟さを発揮するには外力が静止摩擦以上である必要があり、操作者がダイレクト操作しようとしても、ロボットが動かないという問題があった。
また、ロボットに関する静止摩擦を補償する装置として、マスタ・スレーブ型ロボットのマスタアーム操作装置が上記特許文献５に記載されている。しかしながらこの特許文献５記載の操作装置も次の理由から問題があった。
【０００９】
以下、特許文献５記載の操作装置の問題点について、図面を用いて簡単に説明する。
図１９は１軸のマスタアーム操作装置を示している。
同図においいて、（Ａ）、（Ｂ）、（Ｃ）は何れも操作後の停止状態を示し、静止摩擦補償トルクの方向を説明するための図である。
図１９において、２２１はマスタアームであり、２２２はマスタアーム２２１の一端に設けた操作者が把持するグリップであり、２２３はマスタアーム２２１の軸であり、２２４は軸２２３に嵌装された歯車（１）であり、２２５はモータであり、２２６はモータ２２５の出力軸であり、２２７は出力軸２２６に嵌着された歯車（２）であり、２２８はモータ２２５に直結して設けた速度検出器である。
グリップ２２２は操作者の把持有無を検知するスイッチがある。マスタアームの操作者はグリップ２２２を把持してマスタアーム２２１を動かし、モータ２２５の速度検出器２２８に操作信号を送ることでスレーブロボットの操作を行うものとする。
【００１０】
図２０は図１９の（イ）、（ロ）、（ハ）の順でマスタアーム２２１を動かした時のタイムチャートであり、（Ａ）はスイッチのＯＮ／ＯＦＦ状態を示し、（Ｂ）は静止摩擦補償トルクの供給状態を順方向（＋）逆方向（−）として示し、（Ｃ）は速度検出器の出力電圧を順方向（＋）逆方向（−）として示したタイムチャートである。
図１９を用いて図２０のタイムチャートを説明する。
操作者がグリップ２２２を把持した瞬間（Ａ）のスイッチＯＮ／ＯＦＦ状態がＯＮとなり、（Ｂ）の静止摩擦補償トルクの供給状態が＋Ｔとなる。Ｔは軸固有の静止摩擦補償トルクであり、軸２２３を動かすために必要な静止摩擦トルクよりは通常少ない値である。このためマスタアーム２２１が単独で動くことはないが、静止摩擦補償トルクの影響で操作者は微細な力を加えることでマスタアーム２２１を操作することができる。
操作者によりマスタアーム２２１が図（Ａ）の（イ）のような順方向（反時計回り）に動いた時、（Ｃ）の速度検出器の出力電圧は順方向（＋）に変化し、マスタアーム２２１が動作したと認識する閾値である（＋α）を超えた時点で静止摩擦補償トルクの供給を停止する。操作者がマスタアーム２２１を停止し、速度検出器の出力電圧がゼロとなった瞬間、静止摩擦補償トルクの供給状態が前回の静止摩擦補償トルク（＋Ｔ）と符号が反対な−Ｔとなる。
このように静止摩擦補償トルクが反転することで次はマスタアーム２２１が図（Ｂ）の（ロ）のような逆方向（時計回り）に動きやすい状態を作り、操作者は微細な力でマスタアーム２２１を逆方向（時計回り）に操作することができる。
その次は静止摩擦補償トルクの供給状態が＋Ｔとなり、図（Ｃ）の（ハ）のような順方向（反時計回り）に動きやすくなり、操作者は微細な力でマスタアーム２２１を順方向（反時計回り）に操作することができる。
このように、このマスタアーム操作装置は、マスタアーム２２１を操作する度に静止摩擦補償トルクの供給状態を反転するので、静止摩擦補償トルクの加わる方向に向かって操作者は微細な力を加えることでマスタアーム２２１を操作することができる。
【００１１】
しかしながら、このマスタアーム操作装置は、マスタアームを操作する度に静止摩擦補償トルクの供給状態を反転しているので、マスタアームの操作方向を連続的に同方向に操作者が操作したい場合、通常のマスタアーム操作よりも静止摩擦補償トルクだけ更に過大な力がマスタアーム操作に必要となり、マスタアーム操作できないという問題があった。
また、スレーブロボットへのダイレクト操作ができないという問題もあった。
そこで、本発明はこのような問題点に鑑みてなされたものであり、操作者が静止摩擦補償トルクの供給状態を指示し特定することで、操作者に負担の少ないダイレクト操作を実現することができるロボット装置を提供することを第２の目的とする。
【００１２】
【課題を解決するための手段】
上記問題を解決するため、請求項１記載のロボット制御装置の発明は、摩擦補償を有するコンプライアンス制御可能なサーボ制御手段を備えたロボットの制御装置において、作業内容を入力する作業命令入力手段と、前記作業命令入力手段の入力結果から、前記ロボットの各関節の動作方向を決定する動作方向決定手段と、前記動作方向決定手段の出力結果から前記サーボ制御手段の前記ロボットの関節毎の摩擦補償の方向を決定する摩擦補償方向制御手段とを備え、前記サーボ制御手段は、前記摩擦補償方向制御手段の出力に従って摩擦補償を実行するようになっていることを特徴とする。
このようになっているため、作業方向から決まる各関節毎に摩擦補償の方向を正確に制御するため、作業方向のコンプライアンス性を十分に保証することが可能であり、ロボットへのダメージの低減と直接教示作業者の操作力低減を実現できるようになる。
【００１３】
また、請求項２記載の発明は、請求項１記載のロボット制御装置において、前記動作方向決定手段が、過去の作業履歴を記憶する作業情報記憶手段と、前記作業命令入力手段の入力命令から前記作業情報記憶手段の今回の作業に該当する作業の制御点位置（ｐ１）を抽出する目標作業点抽出手段と、前記目標作業点抽出手段の出力と現在の前記ロボットの制御点位置（ｐ２）とから、ｐ２からｐ１の方向でｐ２近傍位置までの微小移動量を算出する微小移動量導出手段と、前記微小移動量導出手段の出力から各関節の動作量を算出し動作方向を導出する関節動作方向導出手段とを備えたことを特徴とする。
このようになっているため、過去の作業情報を用いて、各関節毎の摩擦補償の方向を正確に制御することで、作業方向の特定に要する時間が削減でき、作業効率が良くなる。
また、請求項３記載の発明は、請求項１又は２記載のロボット制御装置において、前記作業命令入力手段が、入力する作業内容として、デカルト座標系上の動作方向を入力することを特徴とする。
このようになっているため、作業者が直感的なイメージで指示することが可能であり、初期の動作方向が不定な直接教示作業では有効である。
請求項４記載の発明は、請求項２記載のロボット制御装置において、前記動作方向決定手段が、前記作業情報記憶手段から作業の候補として対応する複数の制御点位置を抽出し、前記抽出された複数の制御点位置と現在の前記ロボットの制御点位置とから、それぞれの関節毎の動作方向を求め、前記摩擦補償方向制御手段は、前記それぞれの関節毎の動作方向に合致するように、各関節の摩擦補償方向を、周期的に切り替えることを特徴とする。
このようになっているため、作業方向に任意性がある場合においても、複数の作業方向を予め想定して、摩擦補償の方向を周期的に切り替えるため、外力の方向によらずコンプライアンス性を十分に保証することが可能であり、ロボットへのダメージの低減と直接教示作業者の操作力低減を実現できる。
【００１４】
次に、上記第２の課題を解決するため、請求項５記載の発明は、ロボット全軸の位置指令入力部と、前記位置指令入力部の位置指令とモータエンコーダの位置フィードバックからサーボトルクを導出するサーボ処理部と、前記サーボトルクにより動作するロボットとを備えたロボット制御装置において、外力が作用する少なくとも一つの軸の外力トルクを設定する外力トルク設定部と、前記外力トルクから軸毎の摩擦補償トルクを特定し補償する摩擦補償部とを備え、前記サーボトルクと前記摩擦補償トルクを加算することを特徴とするものである。
また、請求項６記載の発明は、前記サーボ処理部が、前記位置指令と前記位置フィードバックから指令トルクを導出する位置速度ループ処理部と、前記指令トルクを制限し制限トルクとして出力するトルク制限部と、前記位置フィードバックから動力学により各軸に加わる重力トルクを演算し重力トルクを補償する重力補償トルクを導出する重力補償部とを備え、前記制限トルクと前記重力補償トルクを加算し前記サーボトルクとして出力することを特徴とするものである。
これら請求項５及び請求項６の発明によれば、少なくとも１つ以上の軸に対して指定方向の摩擦補償トルクを加えることによってダイレクト操作の初期起動トルクを低減させることができ、柔軟なダイレクト操作を実現することができる。
さらに請求項７に記載の発明は、ロボット全軸の位置指令入力部と、前記位置指令入力部の位置指令とモータエンコーダの位置フィードバックからサーボトルクを導出するサーボ処理部と、前記サーボトルクにより動作するロボットとを備えたロボット制御装置において、作業座標上における外力ベクトルを設定する外力ベクトル設定部と、前記外力ベクトルと転置ヤコビ行列から各軸のヤコビトルクを導出するヤコビ行列演算部と、前記ヤコビトルクから摩擦補償トルクパターンを生成する摩擦補償トルクパターン生成部と、外力が作用する少なくとも一つの軸の外力トルクを設定する外力トルク設定部と、前記外力トルクから軸毎の摩擦補償トルクを特定し補償する摩擦補償部とを備え、前記サーボトルクと前記摩擦補償トルクを加算することを特徴とするものである。
請求項７の発明によれば、作業座標上の外力ベクトルを設定し、外力ベクトルと転置ヤコビ行列から外力ベクトルによりロボット軸に加わるモーメントを求めることができるので作業座標上でのダイレクト操作の初期起動トルクを低減させることができ、柔軟なダイレクト操作を実現することができる。
【００１５】
【発明の実施の形態】
以下、この発明のロボット制御装置について図面に基づいて詳細に説明する。
［第１の実施の形態］
まず、第１の実施の形態について図１〜図６に基づいて説明する。
図１は本発明の第１の実施の形態の基本構成を示す図、図２は第１の実施の形態のサーボ制御手段を示す図、図３は第１の実施の形態の動作方向決定手段を示す図、図４は第１の実施の形態の作業情報記憶手段に記憶されている作業情報を示す図、図５は第１の実施の形態の作業の位置情報を示す図、図６は第１の実施の形態の摩擦補償方向決定手段が微小変位の正負の方向から摩擦補償の方向を決定するための処理フロー図である。
第１の実施の形態の基本構成を示す図１において、１は６自由度を有するロボット、２はサーボ制御手段、３は作業命令入力手段、４は動作方向決定手段、５は摩擦補償方向制御手段である。
作業命令入力手段３としては、タッチパネルや押しボタンスイッチ、音声入力などが用いられる。作業命令入力手段３の入力結果が動作方向決定手段４に入力されると、後述する方法で現在のロボット制御点位置に最も近接した位置を持つ作業の作業情報を選択し、その作業の目標点である位置を目標作業点として抽出する。摩擦補償方向制御手段５では、後述する方法で各関節の微小変位の正負の方向から、摩擦補償の方向を決定し、前記作業の動作方向にスムーズに動作可能なように摩擦補償の方向を制御できるようにする。
従って、この状態で作業者が例えばロボット１を直接操作して目標作業点誘導するような場合には極めて微小な作用力でロボット１を誘導することが可能となる。
以下、図１に示された各手段について説明する。
【００１６】
図１のサーボ制御手段２は、図２に示すように、通常の位置速度ループのほかに、トルク制限器２５と重力補償器２６と摩擦補償器２７を備えている。
図において、ホスト制御回路からラインを介して各軸毎の位置指令値が減算手段２１の一方の入力に与えられる。エンコーダからの各軸の軸角度を表すフィードバック信号はラインから減算手段２１の他方の入力に与えられる。減算手段２１の出力は、係数器２２に与えられ、ここで位置ゲインＫｐで増幅され、減算手段２３の一方の入力に与えられる。エンコーダからのフィードバック信号は微分回路２０で微分され、減算手段２３の他方の入力に与えられる。減算手段２３の出力は、係数器２４で速度ゲインＫｖで増幅され、トルク制限器２５に与えられる。
【００１７】
作業命令入力手段３は、タッチパネルや押しボタンスイッチ、音声入力などが用いられる。
【００１８】
動作方向決定手段４は、図３に示すように、目標作業点抽出手段４１と作業情報記憶手段４２と微小移動量導出手段４３と関節動作方向導出手段４４で構成される。そして、前記作業情報記憶手段４２には、図４に示す作業の異なる作業Ａと作業Ｂの作業情報が記憶されており、更に作業Ａと作業Ｂは動作位置の違いによりそれぞれ、作業Ａ１、Ａ２…，作業Ｂ１，Ｂ２…が記憶されている。
前記作業Ａの記憶されている位置（Ｐ１，Ｐ２…）のそれぞれの位置関係を図５に示す。例えば、作業Ａ１であれば、前記ロボット１の制御点がＰ１→Ｐ２→Ｐ３と動作することを意味している。
【００１９】
そこで、本発明の第１の実施の形態の動作について説明する。
前記作業命令入力手段３（図１）で作業Ａが入力されたとして以下の実施形態を説明する。前記作業命令入力手段３の入力結果が前記動作方向決定手段４（図１）に入力されると、動作方向決定手段４内で目標作業点抽出手段４１（図３）は図５に示すように、前記作業情報記憶手段４２（図３）に記憶されている作業Ａに関連する作業情報（作業Ａ１、Ａ２…）から現在のロボット制御点位置Ｐ０に最も近接した位置Ｐ１を持つ作業Ａ１の作業情報を選択し、作業Ａ１の目標点である位置Ｐ３を目標作業点として抽出する。
前記微小移動量導出手段４３（図３）では、抽出された目標作業点Ｐ３と現在の前記ロボット制御点位置Ｐ０とから、Ｐ０近傍Ｐ’０までの微小移動量を（式３）として算出する。
【数３】

関節動作方向導出手段４４（図３）では、各関節の微小変位（Δｑ１，Δｑ２…Δｑ６）をヤコビ行列Ｊを用いて（式４）として算出する。
【数４】

なお、ここでは、姿勢変化は無いと仮定しているが、（式４）の右辺第２項ベクトルの第４、５，６成分に角速度を設定することで姿勢変化を考慮してもよい。
前記摩擦補償方向制御手段５（図１）では、前記各関節の微小変位（Δｑ１，Δｑ２…Δｑ６）の正負の方向から、摩擦補償の方向を図６に示す処理フローに基づいて決定する。
図６において、フローがスタートすると、カウンタをＮ＝１（ステップ２）とし、Δｑ（Ｎ）を入力する（ステップ３）。Δｑ（Ｎ）の正負を調べ（ステップ４）、正ならばＳｇｎ（Ｎ）＝１とし、負ならばＳｇｎ（Ｎ）＝−１とし（ステップ５）、Ｎ＝Ｎ＋１として（ステップ６）、Ｎの最大値に達するまでステップ３からを繰り返し、Ｎが最大値に達したら終了する。
この結果は前記摩擦補償器２７（図２）に入力され、前記作業Ａ１の動作方向にスムーズに動作可能なように摩擦補償の方向を制御できる。
従って、この状態で作業者が例えば、前記ロボット１を直接操作して目標作業点Ｐ３２誘導するような場合には極めて微小な作用力で前記ロボット１を誘導することが可能である。
なお、前記作業命令入力手段３（図１）において、デカルト座標系上の動作方向を、例えば（Δｘ１，Δｙ１，Δｚ１）と入力し、前記関節動作方向導出手段４４（図３）の数２を用いて、同様に実現することが可能である。
【００２０】
［第１の実施の形態の変形例］
次に、第１の実施の形態の変形例について説明する。
前記作業命令入力手段３（図１）で、作業Ａが入力されたとして以下の実施形態を説明する。但し今回は、前記目標作業点抽出手段４１（図３）が現在の前記ロボット１の制御点位置Ｐ０に近接した位置として複数の候補点を抽出した場合について説明する。
前記目標作業点抽出手段４１（図３）は、前記作業情報記憶手段４２（図３）から図７に示す複数の候補点（Ｐ３，Ｐ１３，Ｐ２３，Ｐ３３）を抽出する。
前記微小移動量導出手段４３（図３）は、第１の実施形態の場合と同様に式（３）を用いて、前記制御点位置Ｐ０から前記候補点（Ｐ３，Ｐ１３，Ｐ２３，Ｐ３３）に対応する複数の近傍点（Ｐ’１，Ｐ’２，Ｐ’３，Ｐ’４）までの、複数の微小移動量（Δｒ１，Δｒ２，Δｒ３，Δｒ４）を導出し、前記関節動作方向導出手段４４は、式（４）を用いて、複数の各関節の微小変位の組み（ΔＱ１，ΔＱ２，ΔＱ３，ΔＱ４）を算出する。
【数５】

前記摩擦補償方向制御手段５（図１）は、前記各関節の微小変位の組み（ΔＱ１，ΔＱ２，ΔＱ３，ΔＱ４）の各要素の正負の方向から、摩擦補償の方向を図６に示す処理フローに基づいて決定し、図８に示すテーブルＴＥを作成する。
図８のテーブルＴＥには、候補点Ｐ３についてパターン１、候補点Ｐ１３についてパターン２、候補点Ｐ２３についてパターン３、候補点Ｐ３３についてパターン４の４つのパターンが作成されている。各パターンは第１軸〜第６軸についてそれぞれｓｇｎ［Ｋ］［Ｎ］の符号が付されている。
そこで、このテーブルＴＥを用いて、図９に示す制御処理フローに基づいて、摩擦補償器２７（図２）の補償方向を周期Ｔのタイミングで切り替えて、各軸毎に図１０に示す摩擦補償の方向のパターン（図８のパターン１〜パターン４）を実現し、複数方向のコンプライアンス性を保証することが可能となる。
【００２１】
図９の制御処理フローは次のようになっている。
フローがスタートすると、まず、ｓｇｎ［Ｋ］［Ｎ］を図８のテーブルから読み込み（ｓｓ２）、これをＳｇｎ［Ｎ］＝ｓｇｎ［Ｋ］［Ｎ］とし（ｓｓ３）、Ｎ＝Ｎ＋１に置き換えて（ｓｓ４）、これをＮ＞６になるまで繰り返す（ｓｓ５）。Ｎ＞６になったら、Ｓｇｎ［１］、Ｓｇｎ［２］、Ｓｇｎ［３］、Ｓｇｎ［４］、Ｓｇｎ［５］、Ｓｇｎ［６］を摩擦補償器に設定する（ｓｓ５）。Ｔ秒したら（ｓｓ６）、Ｋ＝Ｋ＋１に置き換えて（ｓｓ８）、ステップｓｓ９へ進み、Ｋ＞４であればＫ＝１に置き換えてステップｓｓ１１へ進み、Ｋ＞４でなければそのままステップｓｓ１１へ進み、フィードバック速度＞閾値Ａを調べる（ｓｓ１１）。フィードバック速度＞閾値Ａでなければｓｓ３に戻り、フィードバック速度＞閾値Ａとなったら終了する。
図１０は第１の実施の形態の複数の動作方向に対応した摩擦補償の方向を周期的に切り替えている様子を示す図である。図９に示す制御処理フローに基づいて、摩擦補償器２７（図２）の補償方向を周期Ｔのタイミングで切り替えた６個の摩擦補償パターンが見られる。例えば、時間Ｔ１では第１軸〜第６軸に対して、図８のテーブルＴＥのパターン１が適用され、摩擦補償の方向は第１軸に対して＋１、第２軸に対して＋１、第３軸に対して−１、第４軸に対して−１、第５軸に対して＋１、第６軸に対して＋１が与えられる。
同じく、時間Ｔ２では第１軸〜第６軸に対して、図８のテーブルＴＥのパターン２が適用され、摩擦補償の方向は第１軸に対して＋１、第２軸に対して−１、第３軸に対して＋１、第４軸に対して−１、第５軸に対して−１、第６軸に対して＋１が与えられる。
時間Ｔ３では第１軸〜第６軸に対して、図８のテーブルＴＥのパターン３が適用され、摩擦補償の方向は第１軸に対して−１、第２軸に対して−１、第３軸に対して−１、第４軸に対して−１、第５軸に対して＋１、第６軸に対して＋１が与えられる。
時間Ｔ４では第１軸〜第６軸に対して、図８のテーブルＴＥのパターン４が適用され、摩擦補償の方向は第１軸に対して＋１、第２軸に対して−１、第３軸に対して−１、第４軸に対して−１、第５軸に対して＋１、第６軸に対して＋１が与えられる。
さらに、時間Ｔ５〜Ｔ８では同様にしてそれぞれ図８のテーブルＴＥのパターン１〜パターン４が適用される。
このようにして、複数方向のコンプライアンス性を保証することが可能となる。
【００２２】
［第２の実施の形態］
次に、本発明の第２の実施の形態について説明する。
図１１は、本発明の第２の実施の形態を示すロボット制御装置のブロック図であり、請求項５の内容に相当するものである。
図１１において、２０１は位置指令入力部、２０２はサーボ処理部、２０３はロボット、２０４は外力トルク設定部、２０５は摩擦補償部である。なお、位置指令入力部２０１、サーボ処理部２０２、外力トルク設定部２０４および摩擦補償部２０５は上位コントローラＣに含まれるものとする。
ロボット制御装置は、図１１に示すようにロボット２０３を構成する各軸モータの位置指令を取得する位置指令入力部２０１と、位置指令入力部２０１の位置指令とロボット２０３の位置フィードバックからロボット２０３の各軸モータへの指令値であるサーボトルクを出力するサーボ処理部２０２と、外力が作用する関節軸の外力方向を含んだ外力トルクを設定する外力トルク設定部と、外力トルク設定部で設定された外力トルクを用いて摩擦補償トルク分だけ補償する摩擦補償部５とから構成されている。サーボトルクと摩擦補償トルクを加えた最終的なモータへの指令値をモータトルクとする。
【００２３】
ここで、サーボ処理部２０２について図１２を用いて説明する。
図１２はサーボ処理部２０２を改良したロボット制御装置のブロック図であり、請求項６の内容に相当するものである。図１２において、２０６は位置速度ループ処理部、２０７はトルク制限部、２０８は重力補償部である。
位置速度ループ処理部２０６は位置指令入力部１の位置指令とロボット２０３の位置フィードバックから指令トルクを出力する。トルク制限部２０７は位置速度ループ処理部２０６の指令トルクに上限値と下限値による制限を加え、制限トルクとして出力する。
重力補償部２０８は予め設定されたツールを含む各リンクの重量情報とロボット２０３の位置フィードバックから動力学演算で各軸に作用する重力トルクを演算し、重力トルクに対して大きさ同じで向きが反対の重力補償トルクを出力する。
サーボ処理部２０２はトルク制限部２０７の制限トルクと重力補償部２０８の重力補償トルクを加えた値をサーボトルクとして出力する。
【００２４】
次に、図１３及び図１４を用いて外力に倣う追従動作であるコンプライアンス動作を説明する。
図１３は本発明により操作者がロボット２０３をダイレクト操作している図である。図１３において、要点に絞って説明するためにロボット２０３を２軸ロボットとし、各関節を軸１、軸２とし、各リンクをリンク１、リンク２とし、リンク上に設置した外力の方向を特定するためのスイッチを軸１外力方向スイッチ、軸２外力方向スイッチとし、操作者はリンク２の軸２外力方向スイッチを操作しながら軸２のダイレクト操作を行っている。
【００２５】
図１４は図１３のように操作者がダイレクト操作している時の図１２中の制限トルク、重力補償トルク、サーボトルク、摩擦補償トルク、モータトルク、軸２に加わる外力と軸２に加わる総トルクの時間経過である。
操作者は軸２外力方向スイッチをプラス側やマイナス側に切り替えることで、軸２の動かしたい方向をロボット制御装置に教える。
図１３中の操作者が仮に軸２外力方向スイッチをプラス側に指定した場合、ロボット制御装置内の摩擦補償部５は軸２がプラス方向に動作する向きの摩擦補償トルクを図１４（４Ｄ）のような波形として出力する。図１４（４Ｄ）中のＭは軸２の摩擦補償トルクである。
摩擦補償トルクが原因でロボットが動きださないようにするために、通常、摩擦補償トルクの大きさは軸固有の静止摩擦トルクの大きさよりも若干小さな値とする。
位置指令入力部１の位置指令がなく位置速度ループ処理部６の指令トルクがゼロもしくは、トルク制限部７の上限値と下限値が共にゼロで制限トルクがゼロ（図１４（４Ａ）参照）の時、サーボトルクは重力補償部８の重力補償トルクのみとなり、重力補償トルク（図１４（４Ｂ）参照）とサーボトルク（図１４（４Ｃ）参照）は同じ波形となる。
動作開始前の軸２の重力トルクをＧとする。なお、軸２の動作開始時点から重力補償トルクとサーボトルクが減少するのはリンク２が操作者の外力によって直立する方向（プラス方向）に動作し、軸２に影響を与えるリンク２の重力トルクが減少するためである。
モータトルクはサーボトルクと摩擦補償トルクの和なので図１４（４Ｅ）のようになる。
外力が図１４（４Ｆ）のように軸２に作用し、モータトルクと外力の和である軸２に加わる総トルクが図１４（４Ｇ）となった場合、総トルクが軸２の静止摩擦トルクを超えた時点で軸２は動作を開始することになる。
従来制御では摩擦補償部５がなく静止摩擦トルク以上の外力が必要だったが、本発明では一定の摩擦補償トルクを加えた分だけ軸２を動かすための外力が低減され、ダイレクト操作しやすくなっている。
操作時の外力ベクトル設定部９としては音声認識やプログラミングペンダント上のキーなどにより実現でき、ジョブプレイバック時の外力ベクトル設定部９としてはジョブ中のコマンド表記により実現できる。
外力方向スイッチを単なるＯＮ／ＯＦＦスイッチとせず、変化量の程度を検出する検出器とすれば、操作者が希望する摩擦補償トルクを各軸に与えることができるのは言うまでもない。
このように、少なくとも１つ以上の軸に対して指定方向の摩擦補償トルクを加えることによってダイレクト操作の初期起動トルクを低減させることができ、柔軟なダイレクト操作を実現することができる。
【００２６】
［第２の実施の形態の変形例］
図１５は、本発明の第２の実施の形態の変形例を示すロボット制御装置のブロック図１であり、請求項７の内容に相当するものである。なお、本発明の構成要素が前出の実施形態の構成要素と同じものについては同一符号を付して説明を省略し、異なる点のみ説明する。
図１５において、２０９は外力ベクトル設定部、２１０はヤコビ行列演算部、２１１は摩擦補償トルクパターン生成部である。外力ベクトル設定部２０９で作業座標上における外力ベクトルを設定する。ヤコビ行列演算部２１０は外力ベクトル設定部２０９で設定した外力ベクトルと転置ヤコビ行列から各軸のヤコビトルクを導出する。摩擦補償トルクパターン生成部２１１はヤコビ行列演算部２１０で導出したヤコビトルクから摩擦補償トルクパターンを生成する。
ロボットを２０６軸とした時、作業座標上における各軸方向の力成分をＦｘ，Ｆｙ，Ｆｚとし、各軸周りのモーメントをＭｘ，Ｍｙ，Ｍｚとした時、外力ベクトルは（Ｆｘ，Ｆｙ，Ｆｚ，Ｍｘ，Ｍｙ，Ｍｚ）として表現できる。
外力ベクトルによってロボットの各軸に加わるモーメントであるヤコビトルクをＴ１，Ｔ２，Ｔ３，Ｔ４，Ｔ５，Ｔ６とし、６行６列の転置ヤコビ行列をＪＴとした時、外力ベクトル（Ｆｘ，Ｆｙ，Ｆｚ，Ｍｘ，Ｍｙ，Ｍｚ）とヤコビトルク（Ｔ１，Ｔ２，Ｔ３，Ｔ４，Ｔ５，Ｔ６）との間には式（５）の関係が一般に知られている。
【数６】

従って、（Ｆｘ，Ｆｙ，Ｆｚ，Ｍｘ，Ｍｙ，Ｍｚ）を外力ベクトル設定部２０９に設定すれば、ヤコビ行列演算部２１０では転置ヤコビ行列ＪＴと式（１）からヤコビトルク（Ｔ１，Ｔ２，Ｔ３，Ｔ４，Ｔ５，Ｔ６）を導出する。
摩擦補償トルクパターン生成部２１１はヤコビトルク（Ｔ１，Ｔ２，Ｔ３，Ｔ４，Ｔ５，Ｔ６）の値からプラス側領域、不感帯領域、マイナス側領域のどれかに区別し、外力トルク設定部２０４に各軸の外力方向としてプラス、ゼロ、マイナスのどれか一つを設定する。摩擦補償部２０５は外力トルク設定部２０４に設定された外力方向と同方向の摩擦補償トルクを出力する。以降の処理は第２の実施の形態と同様な処理を行う。
また、外力トルクをプラス、ゼロ、マイナスの内のどれかと限定するのではなく、外力トルクを比例的に指定することもできる。その場合、摩擦補償トルクパターン生成部２１１が最大外力トルクに対するヤコビトルクの比として外力トルクを外力トルク設定部４に設定することで外力トルクの比例的な変化に対応することができる。
操作時の外力ベクトル設定部２０９としては音声認識やロボット先端のようなロボット本体に設置するハンドルスイッチなどにより実現でき、ジョブプレイバック時の外力ベクトル設定部２０９としてはジョブ中のコマンド表記により実現できる。
このように、作業座標上の外力ベクトルを設定し、外力ベクトルと転置ヤコビ行列から外力ベクトルによりロボット軸に加わるモーメントを求めることができるので作業座標上でのダイレクト操作の初期起動トルクを低減させることができ、柔軟なダイレクト操作を実現することができる。
【００２７】
【発明の効果】
以上述べたように、請求項１記載のロボット制御装置によれば、作業方向から決まる各関節毎に摩擦補償の方向を正確に制御するため、作業方向のコンプライアンス性を十分に保証することが可能であり、ロボットへのダメージの低減と直接教示作業者の操作力低減を実現できる。
請求項２記載のロボット制御装置によれば、過去の作業情報を用いて、各関節毎の摩擦補償の方向を正確に制御するため、作業方向の特定に要する時間が削減でき、作業効率が良くなる。
請求項３記載のロボット制御装置によれば、作業者が直感的なイメージで指示することが可能であり、初期の動作方向が不定な直接教示作業では有効である。
請求項４記載のロボット制御装置によれば、作業方向に任意性がある場合においても、複数の作業方向を予め想定して、摩擦補償の方向を周期的に切り替えるため、外力の方向によらずコンプライアンス性を十分に保証することが可能であり、ロボットへのダメージの低減と直接教示作業者の操作力低減を実現できる。
【００２８】
請求項５もしく６記載のロボット制御装置によれば、少なくとも１つ以上の軸に対して指定方向の摩擦補償トルクを加えることによってダイレクト操作の初期起動トルクを低減させることができ、柔軟なダイレクト操作を実現することができるという効果がある。
また、請求項７記載のロボット制御装置によれば、作業座標上の外力ベクトルを設定し、外力ベクトルと転置ヤコビ行列から外力ベクトルによりロボット軸に加わるモーメントを求めることができるので作業座標上でのダイレクト操作の初期起動トルクを低減させることができ、柔軟なダイレクト操作を実現することができるという効果がある。
【図面の簡単な説明】
【図１】本発明の第１の実施の形態の基本構成を示す図である。
【図２】第１の実施の形態のサーボ制御手段２を示す図である。
【図３】第１の実施の形態の動作方向決定手段４を示す図である。
【図４】第１の実施の形態の作業情報記憶手段４２に記憶されている作業情報を示す図である。
【図５】第１の実施の形態の作業Ａの位置情報を示す図である。
【図６】第１の実施の形態の摩擦補償方向決定手段が微小変位の正負の方向から摩擦補償の方向を決定するための処理フロー図である。
【図７】第１の実施の形態の変形例の実施内容を示す図である。
【図８】第１の実施の形態の複数の動作方向に対応した摩擦補償の方向を定めたテーブルを示す図である。
【図９】第１の実施の形態の摩擦補償器の補償方向を周期Ｔのタイミングで切り替えて所定の摩擦補償パターンを実現する制御処理フローを示す図である。
【図１０】第１の実施の形態の複数の動作方向に対応した摩擦補償の方向を周期的に切り替えている様子を示す図である。
【図１１】本発明の第２の実施の形態を示すロボット制御装置のブロック図である。
【図１２】第２の実施の形態のサーボ処理部２を改良したロボット制御装置のブロック図である。
【図１３】第２の実施の形態により操作者がダイレクト操作している図である。
【図１４】ダイレクト操作におけるロボット装置内の信号タイムチャートである。
【図１５】第２の実施の形態の変形例を示すロボット制御装置のブロック図である。
【図１６】従来のロボット制御装置の基本構成を示す図である。
【図１７】従来の制御回路の構成および動作を設定するためのブロック図である。
【図１８】従来装置の実施例の動作を簡略化して示す図である。
【図１９】従来装置の１軸マスタアーム操作装置の説明図である。
【図２０】図１９の（イ）、（ロ）、（ハ）の順でマスタアームを動かした時のタイムチャートである。
【符号の説明】
１ ロボット
２ サーボ制御手段
２１ 第１減算手段
２２ 位置ゲイン
２３ 第２減算手段
２４ 速度ゲイン
２５ トルク制限器
２６ 重力補償器
２７ 摩擦補償器
２８ 加算器
２９ 微分回路
３ 作業命令入力手段
４ 動作方向決定手段
４１ 目標作業点抽出手段
４２ 作業情報記憶手段
４３ 微小移動量導出手段
４４ 関節動作方向導出手段
５ 摩擦補償方向制御手段
１０１ ロボット
１１０ ツール
１１６ ワーク
１２０ 移動方向
１２２ 制御回路
１２３ サーボ制御回路
１２４ ホスト制御回路
１２５ サーボモータ
１２６ 増幅回路
１２７ エンコーダ
１２８ ライン
１２９ 減算手段
１３０ ライン
１３１ 係数器
１３２ 加算手段
１３３ 微分回路
１３４ 係数器
１３５ 積分器
１３６ 位相補償器
１３７ 加算手段
１３８ 重力補償演算回路
１３９ ライン
１４１ 重力
１４２ 減算手段
１４３ 慣性力
１４４ 積分手段
１４５ 積分手段
２０１ 位置指令入力部
２０２ サーボ処理部
２０３ ロボット
２０４ 外力トルク設定部
２０５ 摩擦補償部
２０６ 位置速度ループ処理部
２０７ トルク制限部
２０８ 重力補償部
２０９ 外力ベクトル設定部
２１０ ヤコビ行列演算部
２１１ 摩擦補償トルクパターン生成部
２２１ マスタアーム
２２２ グリップ
２２３ 軸
２２４ 歯車（１）
２２５ モータ
２２６ 出力軸
２２７ 歯車（２）
２２８ 速度検出器[0001]
TECHNICAL FIELD OF THE INVENTION
The present invention relates to a robot control device for performing a tracking operation following an external force acting on a robot, that is, a compliance operation.
[0002]
[Prior art]
Conventional industrial robots that perform position control have a high position rigidity and are configured for the purpose of realizing position control with high speed and high accuracy.
On the other hand, in pulling out a work, which is a die-cast molded product, or in direct teaching by an operator's guidance, a compliance operation is required, and some compliance control devices have been proposed. Among them, there is a method that places importance on practicality and realizes it without using a dedicated tool and a force sensor. For example, during the compliance operation, each axis angle θ1 whose position has been changed by an external force is captured in real time, the current value of the position / orientation in the specified tool coordinate system is calculated, and the current value of the specified vector component is set to the command value. Robot control that moves the work in one predetermined direction without changing the posture of the work when an external force is applied to the work while holding the work with the tool. There was a device (for example, see Patent Document 1).
Also, a method has been proposed in which the static friction of the robot axis at the start of the operation is periodically compensated to smooth the operation at the start of the movement (for example, see Patent Document 2).
Further, a method of reducing a servo gain to perform flexible control without adding a special device such as a force sensor for detecting an external force has been known (for example, see Patent Document 3). .
There is also known a method capable of setting softness on work coordinates by developing a method of reducing the servo gain (for example, see Patent Document 4).
Further, as a device for compensating for static friction relating to a robot, a master arm operating device of a master-slave type robot has been proposed (for example, see Patent Document 5).
[0003]
[Patent Document 1]
JP 08-155868 A
[Patent Document 2]
JP 08-286759 A
[Patent Document 3]
JP-A-06-332538
[Patent Document 4]
JP-A-07-020941
[Patent Document 5]
Japanese Patent No. 2769433
[0004]
Hereinafter, the robot control device described in Patent Document 1 will be briefly described.
FIG. 16 is an electric circuit diagram showing a specific configuration of the servo control circuit 123 of the robot control device described in Patent Document 1.
In the figure, a position command value for each axis is given to one input of a subtraction means 129 from a host control circuit 124 via a line 128. A signal representing the axis angle of each axis from the encoder 127 is provided from a line 130 to the other input of the subtraction means 129. The output of the subtraction unit 129 is supplied to a coefficient unit 131, where it is amplified by a position gain Kp and supplied to an addition unit 132. The output of the encoder 127 is also differentiated by a differentiating circuit 133, amplified by a coefficient gain 134 with a speed gain Kv, and provided to an adding means 132. The output of the adding means 132 is provided to an integrator 135, where an integration operation is performed. The gain G1 of the integrator 135 is represented by Expression 1.
(Equation 1)

Here, K1 is a constant and s is an operator.
The output of the integrator 135 is supplied to the phase compensator 136 to perform a phase compensation operation during the phase control operation, and the gain G2 is expressed by Expression 2.
(Equation 2)

Here, α is a constant.
The output of the phase compensator 136 is provided to another adding means 137. The output from the gravity compensation calculation circuit 138 responsive to the output of the encoder 127 is given to the addition means 137 and added, and the added output is sent from the line 139 to the amplification circuit 126 of the control circuit 122 as a torque command value of each axis. Is entered.
[0005]
FIG. 17 is a block diagram for setting the configuration and operation of control circuit 122. In the figure, a torque command signal of each axis from a servo control circuit 123 via a line 139 is given to an amplifier circuit 126 via a line 139, and thereby a servo motor 125 is driven. Gravity acts on the arm that is the load of the motor 125, as indicated by reference numeral 141. Therefore, gravity 141 is subtracted from a load such as an arm driven by the motor 125, and the gravity 141 is applied to the gravity circuit. The output of 138 cancels and compensates, and the arm or the like is moved. The angular acceleration of the inertial force 143 of the arm or the like is obtained by integrating the angular velocity by the integrating means 144, and the angular velocity of the arm or the like is obtained by integrating the angular velocity by the integrating means 145. The angle is detected by the encoder 127 as described above.
[0006]
FIG. 18 is a diagram showing the operation of one embodiment of the invention described in Patent Document 1 in a simplified manner.
When the robot 109 performs an application work, the tool 110 of the robot 109 performs an escape operation in any desired moving direction 120 with respect to the external force F applied to the tool 110 to achieve the compliance function. The compliance function is passively achieved, and the tool 110 keeps a constant posture immediately before the start of the compliance operation as shown in FIG. 18A, and its movement direction 120 is a direction defined by the coordinate system of the tool 110. The degree of compliance can be adjusted, the gravity compensation of each axis is compensated by a calculation formula, the reaction force to the work 116 is a viscous resistance force, and the first axis 4 which is a basic axis having a large static friction force is also used. It is also configured to move, and as a safety measure, it is configured to set the operation limit angle of each axis. In order to adjust the degree of compliance, the servo control circuit 123 shown in FIG. 16 is achieved by adjusting the position gain Kp and the speed gain Kv in the coefficient units 131 and 134.
By detecting the displacement of each axis of the tool 110 due to the external force by the encoder 127, it becomes unnecessary to use a force sensor or the like.
As described above, the conventional robot control device realizes the compliance control operation by sequentially updating the target command value when the position displacement occurs, using the position information of the encoder 127.
[0007]
[Problems to be solved by the invention]
However, the conventional robot control device disclosed in Patent Literature 1 is based on the premise that a positional displacement has been generated in advance and a position command based on the positional displacement has been given. However, the reduction of the static friction force when an external force is applied from an arbitrary direction in a stationary state is not considered, and the hardness corresponding to the static friction force remains on the robot side.
Further, in the conventional device disclosed in Patent Document 2, even the control of the compensation directions of the axes in a synchronized manner is not considered, and in actual application, the compliance in the target direction in the orthogonal coordinate system of the robot tip is considered. There was a problem that it was difficult to obtain.
For this reason, when both of the conventional methods collide with the peripheral device, there is a problem that the static damage is damaged.
In addition, when the worker directly teaches, there is a problem that the resistance force corresponding to the static friction acts on the worker and the operability is deteriorated.
Therefore, the present invention has been made in view of such a problem, and effectively compensates for the static friction in consideration of the directionality thereof and also in consideration of the synchronization of each axis, so that when the robot is stationary, It is a first object of the present invention to provide a robot controller which guarantees sufficient compliance.
[0008]
Further, these methods described in Patent Documents 3 and 4 do not consider the static friction resistance generated at the robot joint axis in the first place, and the external force needs to be higher than the static friction in order to exhibit the flexibility of the compliance control. There is a problem that the robot does not move even if the operator attempts direct operation.
Further, as a device for compensating for static friction related to a robot, a master arm operating device of a master-slave type robot is described in Patent Document 5 described above. However, the operating device described in Patent Document 5 also has a problem for the following reason.
[0009]
Hereinafter, problems of the operating device described in Patent Document 5 will be briefly described with reference to the drawings.
FIG. 19 shows a one-axis master arm operating device.
In the figure, (A), (B), and (C) all show the stopped state after the operation, and are diagrams for explaining the direction of the static friction compensation torque.
In FIG. 19, reference numeral 221 denotes a master arm, 222 denotes a grip provided at one end of the master arm 221 and is gripped by an operator, 223 denotes a shaft of the master arm 221, and 224 denotes a gear fitted on the shaft 223. (1), 225 is a motor, 226 is an output shaft of the motor 225, 227 is a gear (2) fitted on the output shaft 226, and 228 is a speed directly connected to the motor 225. It is a detector.
The grip 222 has a switch for detecting the presence or absence of gripping by the operator. It is assumed that the master arm operator operates the slave robot by gripping the grip 222 and moving the master arm 221 and sending an operation signal to the speed detector 228 of the motor 225.
[0010]
FIG. 20 is a time chart when the master arm 221 is moved in the order of (A), (B), and (C) of FIG. 19, (A) shows the ON / OFF state of the switch, and (B) shows FIG. 4C is a time chart showing the supply state of the static friction compensation torque as a forward direction (+) and a reverse direction (−), and FIG. 4C shows the output voltage of the speed detector as a forward direction (+) and a reverse direction (−).
The time chart of FIG. 20 will be described with reference to FIG.
The moment the operator grips the grip 222, the switch ON / OFF state at (A) is ON, and the state of supply of the static friction compensation torque at (B) is + T. T is a shaft-specific static friction compensation torque, which is usually smaller than the static friction torque required to move the shaft 223. Therefore, the master arm 221 does not move alone, but the operator can operate the master arm 221 by applying a minute force under the influence of the static friction compensation torque.
When the master arm 221 moves in the forward direction (counterclockwise) as shown in (A) of FIG. (A) by the operator, the output voltage of the speed detector of (C) changes in the forward direction (+), The supply of the static friction compensation torque is stopped at a time point when the threshold value (+ α), which is the threshold value for recognizing that the master arm 221 has operated, is exceeded. At the moment when the operator stops the master arm 221 and the output voltage of the speed detector becomes zero, the supply state of the static friction compensation torque becomes −T, which is opposite in sign to the previous static friction compensation torque (+ T).
By reversing the static friction compensation torque in this manner, the master arm 221 is easily moved in the opposite direction (clockwise) as shown in (b) of FIG. The arm 221 can be operated in the opposite direction (clockwise).
Next, the supply state of the static friction compensation torque becomes + T, and it becomes easy to move in the forward direction (counterclockwise) as shown in (c) of FIG. 9C, and the operator moves the master arm 221 in the forward direction with a small force. (Counterclockwise).
As described above, the master arm operating device reverses the supply state of the static friction compensation torque every time the master arm 221 is operated, so that the operator applies a minute force in the direction in which the static friction compensation torque is applied. Can operate the master arm 221.
[0011]
However, since this master arm operating device reverses the state of supply of the static friction compensation torque every time the master arm is operated, when the operator wants to continuously operate the master arm in the same direction, it is usually There is a problem in that the master arm operation requires more force than the master arm operation by the static friction compensation torque, and the master arm cannot be operated.
There is also a problem that direct operation to the slave robot cannot be performed.
Therefore, the present invention has been made in view of such a problem, and it is possible to realize a direct operation with a small burden on the operator by specifying and specifying the supply state of the static friction compensation torque by the operator. A second object is to provide a robot device that can perform the above-described operations.
[0012]
[Means for Solving the Problems]
In order to solve the above problem, an invention of a robot control device according to claim 1 is a robot control device including a servo control unit capable of performing compliance control having friction compensation. An operation direction determining unit that determines an operation direction of each joint of the robot from an input result of the work command input unit; and a servo control unit that performs friction compensation for each joint of the robot based on an output result of the operation direction determining unit. And a friction compensation direction control means for determining a direction, wherein the servo control means executes friction compensation in accordance with an output of the friction compensation direction control means.
Because of this, the direction of friction compensation is accurately controlled for each joint determined by the working direction, so it is possible to sufficiently guarantee the compliance of the working direction, reducing damage to the robot and The operation force of the direct teaching operator can be reduced.
[0013]
Further, according to a second aspect of the present invention, in the robot control apparatus according to the first aspect, the operation direction determining unit is configured to store a work history in the past and a work information storage unit to store the work history. Target work point extraction means for extracting the control point position (p1) of the work corresponding to the current work in the work information storage means; the output of the target work point extraction means and the current control point position (p2) of the robot; A small movement amount deriving means for calculating a small movement amount from p2 to a position close to p2 in a direction from p2 to a joint movement for calculating a movement amount of each joint from an output of the small movement amount deriving means to derive a movement direction. And a direction deriving unit.
Because of this, by accurately controlling the direction of friction compensation for each joint using past work information, the time required to specify the work direction can be reduced, and work efficiency can be improved.
According to a third aspect of the present invention, in the robot control device according to the first or second aspect, the work command input means inputs an operation direction on a Cartesian coordinate system as input work content. .
With this configuration, the operator can give an instruction with an intuitive image, and is effective in a direct teaching operation in which the initial operation direction is uncertain.
According to a fourth aspect of the present invention, in the robot controller according to the second aspect, the motion direction determining means extracts a plurality of control point positions corresponding to the work candidates from the work information storage means, and From the plurality of control point positions and the current control point position of the robot, the motion direction of each joint is obtained, and the friction compensation direction control means adjusts the motion direction of each joint so as to match the motion direction of each joint. It is characterized in that the friction compensation direction of the joint is switched periodically.
Because of this, even when the working direction is arbitrary, a plurality of working directions are assumed in advance, and the direction of friction compensation is periodically switched, so that the compliance is sufficient regardless of the direction of the external force. It is possible to reduce the damage to the robot and the operating force of the direct teaching operator.
[0014]
Next, in order to solve the second problem, the invention according to claim 5 derives a servo torque from a position command input unit of all axes of the robot, a position command of the position command input unit, and a position feedback of a motor encoder. An external force torque setting unit for setting an external force torque of at least one axis on which an external force acts, and a friction for each axis from the external force torque. And a friction compensating unit for specifying and compensating for the compensation torque, wherein the servo torque and the friction compensation torque are added.
The invention according to claim 6, wherein the servo processing unit is a position / speed loop processing unit that derives a command torque from the position command and the position feedback, and a torque limiting unit that limits the command torque and outputs the command torque as a limited torque. And a gravity compensating unit for calculating a gravity torque applied to each axis by dynamics from the position feedback to derive a gravity compensation torque for compensating the gravity torque. The servo torque is obtained by adding the limited torque and the gravity compensation torque. Is output.
According to the fifth and sixth aspects of the present invention, the initial startup torque of the direct operation can be reduced by applying the friction compensation torque in the designated direction to at least one or more axes, and the flexible direct operation can be performed. Can be realized.
Further, the invention according to claim 7 is characterized in that a position command input unit for all axes of the robot, a servo processing unit for deriving a servo torque from a position command of the position command input unit and a position feedback of a motor encoder, and an operation by the servo torque A robot controller provided with a robot to perform the operation, an external force vector setting unit that sets an external force vector on the work coordinates, a Jacobian matrix calculation unit that derives the Jacobian torque of each axis from the external force vector and the transposed Jacobian matrix, and A friction compensation torque pattern generation unit that generates a friction compensation torque pattern; an external force torque setting unit that sets an external force torque of at least one axis on which an external force acts; and specifies and compensates for a friction compensation torque for each axis from the external force torque. A friction compensator, and adds the servo torque and the friction compensation torque. It is characterized in.
According to the invention of claim 7, since the external force vector on the work coordinates is set, and the moment applied to the robot axis can be obtained from the external force vector and the transposed Jacobian matrix by the external force vector, the initial start of the direct operation on the work coordinates The torque can be reduced, and a flexible direct operation can be realized.
[0015]
BEST MODE FOR CARRYING OUT THE INVENTION
Hereinafter, a robot control device according to the present invention will be described in detail with reference to the drawings.
[First Embodiment]
First, a first embodiment will be described with reference to FIGS.
FIG. 1 is a diagram showing a basic configuration of a first embodiment of the present invention, FIG. 2 is a diagram showing servo control means of the first embodiment, and FIG. 3 is an operation direction determining means of the first embodiment. FIG. 4 is a diagram showing work information stored in the work information storage means of the first embodiment, FIG. 5 is a diagram showing position information of work in the first embodiment, and FIG. It is a processing flow figure for the friction compensation direction determination means of the first embodiment to determine the direction of friction compensation from the positive and negative directions of the minute displacement.
In FIG. 1 showing the basic configuration of the first embodiment, 1 is a robot having 6 degrees of freedom, 2 is a servo control unit, 3 is a work command input unit, 4 is an operation direction determination unit, and 5 is a friction compensation direction control. Means.
As the work instruction input means 3, a touch panel, a push button switch, a voice input, or the like is used. When the input result of the work instruction input means 3 is input to the movement direction determining means 4, work information of a work having a position closest to the current robot control point position is selected by a method described later, and a target point of the work is selected. Is extracted as a target working point. The friction compensation direction control means 5 determines the direction of friction compensation from the positive and negative directions of the minute displacement of each joint by a method described later, and controls the direction of friction compensation so that the operation can be smoothly performed in the operation direction of the work. It can be so.
Therefore, in this state, for example, when the worker directly operates the robot 1 to guide the target working point, it is possible to guide the robot 1 with an extremely small acting force.
Hereinafter, each means shown in FIG. 1 will be described.
[0016]
As shown in FIG. 2, the servo control means 2 in FIG. 1 includes a torque limiter 25, a gravity compensator 26, and a friction compensator 27 in addition to a normal position / speed loop.
In the figure, a position command value for each axis is given to one input of a subtraction means 21 from a host control circuit via a line. A feedback signal indicating the axis angle of each axis from the encoder is provided to the other input of the subtraction means 21 from the line. The output of the subtracting means 21 is provided to a coefficient unit 22 where it is amplified by the position gain Kp and provided to one input of the subtracting means 23. The feedback signal from the encoder is differentiated by the differentiating circuit 20 and applied to the other input of the subtracting means 23. The output of the subtracting means 23 is amplified by the coefficient gain 24 by the speed gain Kv, and given to the torque limiter 25.
[0017]
As the work instruction input means 3, a touch panel, a push button switch, a voice input, or the like is used.
[0018]
As shown in FIG. 3, the motion direction determining means 4 includes a target work point extracting means 41, a work information storage means 42, a minute movement amount deriving means 43, and a joint motion direction deriving means 44. The work information storage means 42 stores work information of work A and work B which are different from each other as shown in FIG. .., Operations B1, B2,.
FIG. 5 shows the positional relationship between the stored positions (P1, P2,...) Of the work A. For example, in the case of work A1, this means that the control point of the robot 1 operates in the order of P1 → P2 → P3.
[0019]
Therefore, the operation of the first embodiment of the present invention will be described.
The following embodiment will be described on the assumption that work A is input by the work instruction input means 3 (FIG. 1). When the input result of the work instruction input means 3 is input to the motion direction determining means 4 (FIG. 1), the target work point extracting means 41 (FIG. 3) in the motion direction determining means 4 is operated as shown in FIG. The work A1 having the position P1 closest to the current robot control point position P0 from the work information (work A1, A2...) Related to the work A stored in the work information storage means 42 (FIG. 3). Information is selected, and a position P3, which is a target point of the work A1, is extracted as a target work point.
The minute movement amount deriving means 43 (FIG. 3) calculates the minute movement amount from the extracted target working point P3 and the current robot control point position P0 to the vicinity P0 of P0 as (Equation 3). .
[Equation 3]

The joint movement direction deriving means 44 (FIG. 3) calculates the minute displacement (Δq1, Δq2... Δq6) of each joint as (Equation 4) using the Jacobi matrix J.
(Equation 4)

Here, it is assumed that there is no posture change, but the posture change may be considered by setting the angular velocities in the fourth, fifth, and sixth components of the second term vector on the right side of (Equation 4).
The friction compensation direction control means 5 (FIG. 1) determines the direction of friction compensation from the positive and negative directions of the minute displacement (Δq1, Δq2... Δq6) of each joint based on the processing flow shown in FIG.
In FIG. 6, when the flow starts, the counter is set to N = 1 (step 2), and Δq (N) is input (step 3). The sign of Δq (N) is checked (step 4). If positive, Sgn (N) = 1, if negative, Sgn (N) = − 1 (step 5), N = N + 1 (step 6), N Is repeated until the maximum value is reached, and the process is terminated when N reaches the maximum value.
The result is input to the friction compensator 27 (FIG. 2), and the direction of the friction compensation can be controlled so that the operation can be smoothly performed in the operation direction of the work A1.
Therefore, in this state, for example, when the operator directly operates the robot 1 to guide the target working point P32, it is possible to guide the robot 1 with an extremely small acting force.
In the work command input means 3 (FIG. 1), for example, the operation direction on the Cartesian coordinate system is input as (Δx1, Δy1, Δz1), and the number 2 of the joint operation direction derivation means 44 (FIG. 3) is calculated. And can be implemented similarly.
[0020]
[Modification of First Embodiment]
Next, a modified example of the first embodiment will be described.
The following embodiment will be described on the assumption that work A has been input by the work instruction input means 3 (FIG. 1). However, this time, a case will be described in which the target work point extracting means 41 (FIG. 3) extracts a plurality of candidate points as positions close to the current control point position P0 of the robot 1.
The target work point extraction means 41 (FIG. 3) extracts a plurality of candidate points (P3, P13, P23, P33) shown in FIG. 7 from the work information storage means 42 (FIG. 3).
The small movement amount deriving means 43 (FIG. 3) uses the equation (3) to convert the control point position P0 to the candidate points (P3, P13, P23, P33) as in the first embodiment. Deriving a plurality of minute movement amounts (Δr1, Δr2, Δr3, Δr4) up to a corresponding plurality of neighboring points (P′1, P′2, P′3, P′4), 44 calculates a set of small displacements (ΔQ1, ΔQ2, ΔQ3, ΔQ4) of each of the plurality of joints using Expression (4).
(Equation 5)

The friction compensation direction control means 5 (FIG. 1) determines the direction of friction compensation from the positive and negative directions of each element of the set of small displacements (ΔQ1, ΔQ2, ΔQ3, ΔQ4) of each joint shown in FIG. And a table TE shown in FIG. 8 is created.
In the table TE of FIG. 8, four patterns, that is, pattern 1 for the candidate point P3, pattern 2 for the candidate point P13, pattern 3 for the candidate point P23, and pattern 4 for the candidate point P33 are created. Each pattern is denoted by the symbol sgn [K] [N] for the first to sixth axes.
Therefore, using this table TE, the compensation direction of the friction compensator 27 (FIG. 2) is switched at the timing of the cycle T based on the control processing flow shown in FIG. 9, and the friction compensation shown in FIG. (Patterns 1 to 4 in FIG. 8) can be realized, and compliance in a plurality of directions can be guaranteed.
[0021]
The control processing flow of FIG. 9 is as follows.
When the flow starts, first, sgn [K] [N] is read from the table of FIG. 8 (ss2), this is set as Sgn [N] = sgn [K] [N] (ss3), and replaced with N = N + 1. (Ss4) This is repeated until N> 6 (ss5). When N> 6, Sgn [1], Sgn [2], Sgn [3], Sgn [4], Sgn [5], and Sgn [6] are set in the friction compensator (ss5). After T seconds (ss6), K = K + 1 is replaced (ss8) and the process proceeds to step ss9. If K> 4, K = 1 is replaced and the process proceeds to step ss11. If K> 4, the process proceeds to step ss11. , Feedback speed> threshold A (ss11). If the feedback speed is not larger than the threshold value A, the process returns to ss3.
FIG. 10 is a diagram illustrating a state in which the direction of friction compensation corresponding to a plurality of operation directions according to the first embodiment is periodically switched. Based on the control processing flow shown in FIG. 9, six friction compensation patterns in which the compensation direction of the friction compensator 27 (FIG. 2) is switched at the timing of the cycle T are seen. For example, at time T1, pattern 1 of the table TE in FIG. 8 is applied to the first to sixth axes, and the directions of friction compensation are +1 for the first axis, +1 for the second axis, and +1 for the second axis. -1 is given to the third axis, -1 to the fourth axis, +1 to the fifth axis, and +1 to the sixth axis.
Similarly, at time T2, the pattern 2 of the table TE in FIG. 8 is applied to the first to sixth axes, and the direction of friction compensation is +1 for the first axis, -1 for the second axis, +1 is given to the third axis, -1 to the fourth axis, -1 to the fifth axis, and +1 to the sixth axis.
At time T3, the pattern 3 of the table TE in FIG. 8 is applied to the first to sixth axes, and the direction of friction compensation is -1 for the first axis, -1 for the second axis, and -1 for the second axis. -1 is given to the third axis, -1 to the fourth axis, +1 to the fifth axis, and +1 to the sixth axis.
At time T4, the pattern 4 of the table TE in FIG. 8 is applied to the first to sixth axes, and the directions of friction compensation are +1 for the first axis, −1 for the second axis, and -1 for the axis, -1 for the fourth axis, +1 for the fifth axis, and +1 for the sixth axis.
Further, at times T5 to T8, patterns 1 to 4 of the table TE of FIG. 8 are similarly applied, respectively.
In this way, it is possible to guarantee compliance in multiple directions.
[0022]
[Second embodiment]
Next, a second embodiment of the present invention will be described.
FIG. 11 is a block diagram of a robot control device according to a second embodiment of the present invention, and corresponds to the contents of claim 5.
11, 201 is a position command input unit, 202 is a servo processing unit, 203 is a robot, 204 is an external force torque setting unit, and 205 is a friction compensation unit. The position command input unit 201, the servo processing unit 202, the external force torque setting unit 204, and the friction compensation unit 205 are included in the host controller C.
The robot control device includes a position command input unit 201 that acquires a position command of each axis motor that configures the robot 203 as shown in FIG. 11, and a position command of the position command input unit 201 and a position feedback of the robot 203. A servo processing unit 202 that outputs a servo torque that is a command value to each axis motor, an external force torque setting unit that sets an external force torque including an external force direction of a joint axis on which an external force acts, and an external force torque setting unit. And a friction compensator 5 that compensates for the friction compensation torque using the external force torque. The final command value to the motor obtained by adding the servo torque and the friction compensation torque is defined as the motor torque.
[0023]
Here, the servo processing unit 202 will be described with reference to FIG.
FIG. 12 is a block diagram of a robot control device in which the servo processing unit 202 is improved, and corresponds to the contents of claim 6. In FIG. 12, reference numeral 206 denotes a position / speed loop processing unit, 207 denotes a torque limiting unit, and 208 denotes a gravity compensation unit.
The position / velocity loop processing unit 206 outputs a command torque from the position command of the position command input unit 1 and the position feedback of the robot 203. The torque limiting unit 207 limits the command torque of the position / velocity loop processing unit 206 by an upper limit value and a lower limit value, and outputs the result as a limited torque.
The gravity compensating unit 208 calculates the gravitational torque acting on each axis by dynamics calculation from the weight information of each link including the preset tool and the position feedback of the robot 203, and the direction is the same as the gravitational torque and the direction is the same. Outputs the opposite gravity compensation torque.
The servo processing unit 202 outputs a value obtained by adding the limiting torque of the torque limiting unit 207 and the gravity compensation torque of the gravity compensating unit 208 as a servo torque.
[0024]
Next, a compliance operation which is a following operation following an external force will be described with reference to FIGS.
FIG. 13 is a diagram in which the operator directly operates the robot 203 according to the present invention. In FIG. 13, the robot 203 is a two-axis robot, each joint is an axis 1 and an axis 2, each link is a link 1 and a link 2, and the direction of an external force installed on the link is specified. The switches for performing this operation are a shaft 1 external force direction switch and a shaft 2 external force direction switch, and the operator directly operates the shaft 2 while operating the shaft 2 external force direction switch of the link 2.
[0025]
FIG. 14 shows the limiting torque, the gravity compensation torque, the servo torque, the friction compensation torque, the motor torque, the external force applied to the shaft 2 and the total force applied to the shaft 2 when the operator directly operates as shown in FIG. This is the time lapse of the torque.
By switching the external force direction switch of the shaft 2 to the plus side or the minus side, the operator informs the robot controller of the direction to move the shaft 2.
If the operator in FIG. 13 specifies the shaft 2 external force direction switch to the plus side, the friction compensating unit 5 in the robot control device sets the friction compensation torque in the direction in which the shaft 2 operates in the plus direction as shown in FIG. 14 (4D). Is output as a waveform like M in FIG. 14 (4D) is the friction compensation torque of the shaft 2.
In order to prevent the robot from moving due to the friction compensation torque, the magnitude of the friction compensation torque is usually slightly smaller than the magnitude of the static friction torque inherent to the shaft.
When there is no position command from the position command input unit 1 and the command torque of the position / velocity loop processing unit 6 is zero, or the upper limit value and the lower limit value of the torque limiter 7 are both zero and the limit torque is zero (see FIG. 14 (4A)). At this time, the servo torque is only the gravity compensation torque of the gravity compensation unit 8, and the gravity compensation torque (see FIG. 14 (4B)) and the servo torque (see FIG. 14 (4C)) have the same waveform.
Let G be the gravitational torque of the shaft 2 before the operation starts. The reason that the gravity compensation torque and the servo torque are reduced from the start of the operation of the shaft 2 is that the link 2 operates in a direction (positive direction) in which the link 2 is erected by an external force of the operator, and the gravity torque of the link 2 which affects the shaft 2. Is to decrease.
Since the motor torque is the sum of the servo torque and the friction compensation torque, it becomes as shown in FIG. 14 (4E).
When the external force acts on the shaft 2 as shown in FIG. 14 (4F) and the total torque applied to the shaft 2 which is the sum of the motor torque and the external force becomes FIG. 14 (4G), the total torque becomes the static friction torque of the shaft 2. , The axis 2 starts operating.
In the conventional control, the friction compensator 5 was not provided and an external force higher than the static friction torque was required. However, in the present invention, the external force for moving the shaft 2 by the amount of the fixed friction compensation torque is reduced, and direct operation becomes easier. ing.
The external force vector setting unit 9 at the time of operation can be realized by voice recognition or a key on a programming pendant, and the external force vector setting unit 9 at the time of job playback can be realized by command notation in a job.
If the external force direction switch is not a simple ON / OFF switch but a detector for detecting the degree of change, it is needless to say that a friction compensation torque desired by the operator can be given to each axis.
As described above, the initial startup torque of the direct operation can be reduced by applying the friction compensation torque in the designated direction to at least one or more axes, and flexible direct operation can be realized.
[0026]
[Modification of Second Embodiment]
FIG. 15 is a block diagram 1 of a robot control device showing a modification of the second embodiment of the present invention, and corresponds to the contents of claim 7. Note that the same components as those of the above-described embodiment are denoted by the same reference numerals and the description thereof will be omitted, and only different points will be described.
In FIG. 15, 209 is an external force vector setting unit, 210 is a Jacobi matrix calculation unit, and 211 is a friction compensation torque pattern generation unit. The external force vector setting unit 209 sets an external force vector on the work coordinates. The Jacobi matrix operation unit 210 derives the Jacobi torque of each axis from the external force vector set by the external force vector setting unit 209 and the transposed Jacobian matrix. The friction compensation torque pattern generation unit 211 generates a friction compensation torque pattern from the Jacobi torque derived by the Jacobi matrix calculation unit 210.
When the robot has 206 axes, the force components in each axis direction on the working coordinates are Fx, Fy, Fz, and the moments around each axis are Mx, My, Mz, the external force vector is (Fx, Fy, Fz). , Mx, My, Mz).
When the Jacobian torque, which is the moment applied to each axis of the robot by the external force vector, is T1, T2, T3, T4, T5, T6, and the transposed Jacobian matrix of 6 rows and 6 columns is JT, the external force vector (Fx, Fy, Fz, The relationship of equation (5) is generally known between Mx, My, Mz) and the Jacobian torque (T1, T2, T3, T4, T5, T6).
(Equation 6)

Therefore, if (Fx, Fy, Fz, Mx, My, Mz) is set in the external force vector setting unit 209, the Jacobian matrix calculation unit 210 calculates the Jacobian torque (T1, T2, T3, JT) from the transposed Jacobian matrix JT and Equation (1). T4, T5, T6) are derived.
The friction compensation torque pattern generation unit 211 discriminates the value of the Jacobi torque (T1, T2, T3, T4, T5, T6) into one of a plus side region, a dead zone region, and a minus side region, and sends the external force torque setting unit 204 each axis. Set any one of plus, zero, and minus as the external force direction of. The friction compensation unit 205 outputs a friction compensation torque in the same direction as the direction of the external force set in the external force torque setting unit 204. Subsequent processing is similar to that of the second embodiment.
Also, instead of limiting the external force torque to any one of plus, zero, and minus, the external force torque can be specified in proportion. In that case, the friction compensation torque pattern generation unit 211 sets the external force torque in the external force torque setting unit 4 as the ratio of the Jacobi torque to the maximum external force torque, so that it is possible to cope with a proportional change in the external force torque.
The external force vector setting unit 209 at the time of operation can be realized by voice recognition or a handle switch installed on the robot body such as a robot tip, and the external force vector setting unit 209 at the time of job playback can be realized by command notation in a job. .
In this way, the external force vector on the work coordinates is set, and the moment applied to the robot axis can be obtained from the external force vector and the transposed Jacobian matrix by the external force vector, so that the initial starting torque of the direct operation on the work coordinates is reduced. And a flexible direct operation can be realized.
[0027]
【The invention's effect】
As described above, according to the robot control device of the first aspect, since the direction of friction compensation is accurately controlled for each joint determined from the work direction, it is possible to sufficiently guarantee the work direction compliance. Thus, it is possible to reduce the damage to the robot and the operating force of the direct teaching operator.
According to the robot control device of the second aspect, since the direction of the friction compensation for each joint is accurately controlled using the past work information, the time required for specifying the work direction can be reduced, and the work efficiency is improved. Become.
According to the robot control device of the third aspect, it is possible for an operator to give an instruction with an intuitive image, and this is effective in a direct teaching operation in which the initial operation direction is uncertain.
According to the robot control device of the fourth aspect, even when there is arbitrariness in the working direction, a plurality of working directions are assumed in advance, and the direction of friction compensation is periodically switched, regardless of the direction of the external force. The compliance can be sufficiently ensured, and the damage to the robot and the operation force of the direct teaching operator can be reduced.
[0028]
According to the robot controller of the fifth or sixth aspect, the initial starting torque of the direct operation can be reduced by applying the friction compensation torque in the designated direction to at least one or more axes, and the flexible direct There is an effect that the operation can be realized.
According to the robot control device of the seventh aspect, an external force vector on the work coordinates can be set, and the moment applied to the robot axis can be obtained from the external force vector and the transposed Jacobian matrix by the external force vector. There is an effect that the initial starting torque of the direct operation can be reduced, and a flexible direct operation can be realized.
[Brief description of the drawings]
FIG. 1 is a diagram showing a basic configuration of a first embodiment of the present invention.
FIG. 2 is a diagram illustrating a servo control unit 2 according to the first embodiment.
FIG. 3 is a diagram illustrating an operation direction determining unit 4 according to the first embodiment.
FIG. 4 is a diagram illustrating work information stored in a work information storage unit according to the first embodiment.
FIG. 5 is a diagram illustrating position information of a work A according to the first embodiment.
FIG. 6 is a processing flowchart for determining the direction of friction compensation from the positive and negative directions of the small displacement by the friction compensation direction determining means of the first embodiment.
FIG. 7 is a diagram showing the contents of a modification of the first embodiment.
FIG. 8 is a diagram illustrating a table in which directions of friction compensation corresponding to a plurality of operation directions according to the first embodiment are determined.
FIG. 9 is a diagram showing a control processing flow for realizing a predetermined friction compensation pattern by switching the compensation direction of the friction compensator according to the first embodiment at a timing of a cycle T.
FIG. 10 is a diagram showing a state where friction compensation directions corresponding to a plurality of operation directions according to the first embodiment are periodically switched.
FIG. 11 is a block diagram of a robot control device according to a second embodiment of the present invention.
FIG. 12 is a block diagram of a robot control device in which the servo processing unit 2 according to the second embodiment is improved.
FIG. 13 is a diagram illustrating a state where an operator performs a direct operation according to the second embodiment.
FIG. 14 is a signal time chart in the robot apparatus in the direct operation.
FIG. 15 is a block diagram of a robot control device showing a modification of the second embodiment.
FIG. 16 is a diagram showing a basic configuration of a conventional robot control device.
FIG. 17 is a block diagram for setting the configuration and operation of a conventional control circuit.
FIG. 18 is a diagram schematically showing the operation of the embodiment of the conventional device.
FIG. 19 is an explanatory view of a one-axis master arm operating device of a conventional device.
20 is a time chart when the master arm is moved in the order of (a), (b), and (c) of FIG.
[Explanation of symbols]
1 Robot
2 Servo control means
21 First subtraction means
22 Position gain
23 Second subtraction means
24 Speed gain
25 Torque limiter
26 Gravity compensator
27 Friction compensator
28 Adder
29 Differentiating circuit
3 Work instruction input means
4 Operating direction determining means
41 Target work point extraction means
42 work information storage means
43 minute movement amount deriving means
44 Joint movement direction deriving means
5 Friction compensation direction control means
101 Robot
110 tools
116 Work
120 Moving direction
122 control circuit
123 Servo control circuit
124 Host control circuit
125 servo motor
126 amplifier circuit
127 encoder
128 lines
129 Subtraction means
130 lines
131 Coefficient unit
132 Addition means
133 Differentiator
134 coefficient unit
135 integrator
136 Phase compensator
137 Addition means
138 Gravity compensation arithmetic circuit
139 lines
141 Gravity
142 subtraction means
143 inertial force
144 Integrator
145 integration means
201 Position command input unit
202 Servo processing unit
203 robot
204 External force torque setting section
205 Friction compensator
206 Position / velocity loop processing unit
207 Torque limiter
208 Gravity compensation unit
209 External force vector setting section
210 Jacobi matrix operation unit
211 Friction compensation torque pattern generator
221 Master arm
222 grip
223 axes
224 Gear (1)
225 motor
226 Output shaft
227 Gears (2)
228 Speed detector

Claims (7)

In a robot controller including a servo control unit capable of performing compliance control having friction compensation, a work command input unit for inputting work content, and an operation direction of each joint of the robot is determined from an input result of the work command input unit. Operating direction determining means, and friction compensation direction controlling means for determining a direction of friction compensation for each joint of the robot of the servo control means from an output result of the operating direction determining means, wherein the servo control means comprises: A robot controller configured to execute friction compensation in accordance with an output of a compensation direction controller. The operation direction determining means includes: a work information storage means for storing a past work history; and a control point position (p1) of the work corresponding to the current work of the work information storage means from an input command of the work command input means. A target work point extracting means to be extracted; a minute movement amount for calculating a minute movement amount from p2 to a position close to p2 in a direction from p2 to p1 from the output of the target work point extracting means and the current control point position (p2) of the robot. 2. The robot control device according to claim 1, further comprising: a movement amount deriving unit; and a joint operation direction deriving unit that calculates an operation amount of each joint from an output of the minute movement amount deriving unit and derives an operation direction. . The robot control device according to claim 1, wherein the operation command input unit inputs an operation direction on a Cartesian coordinate system as the input work content. The operation direction determining means extracts a plurality of control point positions corresponding to work candidates from the work information storage means, and calculates respective control point positions from the extracted plurality of control point positions and a current control point position of the robot. 3. The operation direction of each joint is determined, and the friction compensation direction control means periodically switches the friction compensation direction of each joint so as to match the operation direction of each joint. Robot controller. In a robot control device including a position command input unit for all axes of the robot, a servo processing unit that derives a servo torque from a position command of the position command input unit and position feedback of a motor encoder, and a robot that operates by the servo torque An external force torque setting unit that sets an external force torque of at least one shaft on which an external force acts, and a friction compensation unit that specifies and compensates for a friction compensation torque for each axis from the external force torque, wherein the servo torque and the friction compensation A robot control device for adding a torque. The servo processing unit is a position / speed loop processing unit that derives a command torque from the position command and the position feedback, a torque limiting unit that limits the command torque and outputs the torque as a limited torque, and a dynamics from the position feedback. A gravitational compensation unit for calculating a gravitational torque applied to a shaft to derive a gravitational compensation torque for compensating for the gravitational torque, wherein the limiting torque and the gravitational compensation torque are added and output as the servo torque. 6. The robot controller according to 5. In a robot control device including a position command input unit for all axes of the robot, a servo processing unit that derives a servo torque from a position command of the position command input unit and position feedback of a motor encoder, and a robot that operates by the servo torque An external force vector setting unit that sets an external force vector on work coordinates, a Jacobian matrix calculation unit that derives the Jacobian torque of each axis from the external force vector and the transposed Jacobian matrix, and a friction compensation torque that generates a friction compensation torque pattern from the Jacobian torque. A pattern generating unit, an external force torque setting unit that sets an external force torque of at least one axis on which an external force acts, and a friction compensation unit that specifies and compensates for a friction compensation torque for each axis from the external force torque, wherein the servo torque And the friction compensation torque are added. Location.

Images