JPH07319547A - ロボットの倣い制御方法 - Google Patents

Abstract

(57)【要約】 【目的】 センサを使用せず、ソフトウェアによるフロ
ーティング機構によって曲面に対する倣い制御を実現す
ること。 【構成】 Ｚ軸がフェイスプレート中心Ｏf の方向を向
くようにツール座標系Ｏt −ＸＹＺが設定される。ツー
ルＩは、常に倣い対象面Γと接し、力を及ぼし合ってい
る。ロボットＲＢは二重矢印Ｈの方向に、速度ｖで移動
するように教示される。各軸Ｊj の力を、位置偏差と位
置ゲインの積から求め、この力を軸数分の成分とするベ
クトルを定め、これを３次元空間のベクトルに変換し、
その位置における倣い対象面Γの法線ベクトル＜Ｎ＞を
定める。ベクトル＜Ｎ＞の向きとＺ軸の向きを一致させ
るように、位置ゲインに変化を与えずに、ロボット姿勢
を制御する。次に、位置偏差を固定して、ベクトル＜Ｎ
＞の方向の力が一定値Ｗとなる各軸位置ゲインを求め、
その値に一致させる。更に、その位置における接線方向
を求め、ロボットＲＢの移動目標位置を定め、速度ｖを
与えるに必要な各軸位置偏差足し込み量を計算し、位置
制御ループの位置偏差計数部へ足し込む。

Description

【発明の詳細な説明】

【０００１】

【産業上の利用分野】本願発明はロボットの制御方法に
関し、更に詳しく言えば、ソフトウェアによるフローテ
ィング機能を用いて、バリ取り加工などの作業対象面に
対する倣い制御を実現するロボットの制御方法に関す
る。

【０００２】

【従来の技術】産業用ロボット（以下、単にロボットと
言う。）のアプリケーションの一類型として、バリ取り
加工のように、任意の方向を向いた面（一般には曲面）
に対してその位置における法線方向の力成分を一定に維
持し、その面を正確に倣うようにロボットを動作させる
ことが要求されるものがある。

【０００３】このような要求に応える為に従来より利用
されている制御方法には、大別して、（１）機械的な手
段を用いてロボットに一定の強さを持たせ、作業対象面
にロボットを押し付けながら作業を行なう方法と、
（２）力センサまたは距離センサを用い、ロボットが作
業対象面から受ける力あるいは作業対象面とロボットの
距離を一定に保つ方法がある。

【０００４】

【発明が解決しようとする課題】しかし、前者の方法で
は、細かい教示を行なわなければ曲面上の場所によって
実際にロボットが受ける力が異なってしまい、高い精度
で倣い制御を行なうことが困難となる。また、後者の専
用の力センサを用いた方法では、センサが高価であるこ
とや周辺装備（取付機構、信号処理回路等）が複雑にな
り、大型のバリ取り加工ツールを取り付け際に邪魔にな
ること、更には、センサの耐用性によってシステムの信
頼性が左右される等の問題点がある。

【０００５】そこで、本願発明の基本的な目的は、セン
サを用いずに正確な倣い制御が実現可能なロボットの制
御方法を提供することにあり、また、その事を通して、
倣い制御を必要とするアプリケーションにおいて安価で
信頼性の高いシステムを組めるようにすることにある。

【０００６】更に、別の１つの観点から言えば、本願発
明は、センサあるいは機械的手段によらず、ソフトウェ
ア手段を用いたフローティング機能によって倣い制御を
実行する方法を提供することにある。

【０００７】

【課題を解決するための手段】本願発明は、上記目的を
達成する為の基本的な構成として、「（ａ）ロボットに
位置教示と移動速度教示を行なう段階と、（ｂ）各軸に
かかっている力を、位置偏差と位置ゲインの積から求め
る段階と、（ｃ）この力を軸数分の成分に持つベクトル
を定め、これを３次元空間のベクトルに変換し、その位
置における倣い対象面Γの法線ベクトル＜Ｎ＞を定める
段階と、（ｄ）前記法線ベクトル＜Ｎ＞の向きと前記ロ
ボットに予め設定されたツール座標系の向きを一致させ
るように、各軸の位置ゲインに変化を与えずに、ロボッ
ト姿勢を制御する段階と、（ｅ）各軸の位置偏差を固定
した条件で、ベクトル＜Ｎ＞の方向の力が一定値Ｗとな
る各軸の位置ゲインを求め、その値に各軸のゲインを一
致させるさせる段階と、（ｆ）その位置における接線方
向を前記法線ベクトルの方向と前記位置教示で指示され
た方向に基づいて求める段階と、（ｇ）前記接線上にロ
ボットＲＢの移動目標位置を定め、速度ｖを与えるに必
要な各軸位置偏差足し込み量を計算し、位置制御ループ
の位置偏差算出部へ足し込む段階を含み、少なくとも前
記段階（ｂ）〜（ｇ）がロボット制御装置上のソフトウ
ェア処理によって実行されることを特徴とするロボット
の倣い制御方法」（請求項１）を提案したものである。

【０００８】そして、特に、ロボットに支持されたツー
ルの方向（先端部から基部側へ）が倣い対象面の法線ベ
クトル方向と常に一致するような倣い制御、及びツール
の方向が倣い対象面の法線ベクトル方向と傾斜した関係
に保たれる制御を各々行なう為に、上記構成に、「前記
ツール座標系は、そのの向きが、前記ロボットに支持さ
れたツールの軸方向と一致するように設定されている」
（請求項２）及び「前記ツール座標系は、そのの向き
が、前記ロボットに支持されたツールの軸方向に対して
傾斜して設定されている」（請求項３）という要件を課
したものである。

【０００９】

【作用】図１は、倣い制御を行なうロボットを一般的に
表わした模式図であり、図２は本願発明に従った倣い制
御を行なう場合のブロック線図を表わしている。これら
の図を参照して本願発明の原理を説明する。

【００１０】図１中、符号ＲＢで表わされたロボット
は、各々サーボモータで駆動される第１軸Ｊ1 （軸変数
θ1 ）〜第ｎ軸Ｊn （軸変数θn ）を有し、その先端の
フェイスプレート面に適当な取付機構（図示略）を介し
てツールＩ（例えばバリ取りツール）が取り付けられて
いる。ツールＩの先端点Ｏt にはツール座標系Ｏt −Ｘ
ＹＺが設定されている。ツール座標系の向き（ここで
は、Ｚ軸の方向で代表させる。）は、フェイスプレート
中心Ｏf の方向を向いて設定されているものとする。

【００１１】ツール先端点Ｏt は、常に倣い対象面Γ
（一般には平面または曲面）と接しており、ツール先端
点Ｏt を通してロボットＲＢと倣い対象面Γは作用反作
用の法則に従って互いに向きが反対で同じ大きさの力を
及ぼし合っている。また、教示によって、ロボットＲＢ
の基本的な進行方向は二重矢印Ｈの方向（教示点Ｐ1 か
らＰ2 へ向かう方向）とされており、移動速度は教示速
度ｖで指定されているものとする。

【００１２】倣い制御は、ロボットＲＢがその位置にお
いて倣い対象面Γから受ける力の倣い対象面法線成分
（法線ベクトル＜Ｎ＞と平行な方向の分力＜Ｗ＞の大き
さ）が一定値Ｗ（＜Ｗ＞＝Ｗ）に保たれると共にツール
座標系のＺ軸方向が倣い対象面Γの法線方向と一致する
ような状態を実現目標として実行される。

【００１３】ロボットＲＢが図１の位置にある状態を考
えると、各軸Ｊj （ｊ＝１〜ｎ、以下同様。）について
位置偏差が生じている。各軸Ｊj にかかっている力は、
各軸における位置偏差と位置ゲインの積から求めること
が出来る。この力を軸数分の成分とするベクトルを定
め、これを３次元空間（例えばロボットのベース座標系
で定義される３次元空間）上のベクトルに変換すること
によって、その位置における倣い対象面Γの法線ベクト
ル（図２中＜Ｎ＞で表示）が定められる。

【００１４】各軸の力を３次元空間上のベクトルに変換
する計算方法は公知であり、例えば、遠山茂樹著、「機
械系のためのロボティクス」、総合電子出版社、に記載
された手法を利用することが出来る。その概略を記せば
次のようになる。

【００１５】３次元空間空間は、ロボットが認識し得る
任意の座標系（ベース座標系、ワーク座標系、ツール座
標系等）とすることが出来るが、ここではベース座標系
Σ0を考える。今、エンドエフェクタ（例えば、バリ取
りツール先端）をベース座標系Σ0 上の位置ベクトル＜
ｐn+1 ＞で表わし、そこに外力＜Ｆn+1 ＞とモーメント
＜Ｍn+1 ＞がかかっているものとする。これを支えるた
めにｉ番目の関節軸にかかる力／トルクは、次式
（１），（２）で表わされる。即ち、ｉ番目の軸が回転
関節に対応している場合には、 Ｍi ＝＜ｚi-1⁽⁰⁾＞・（＜ｐn+1⁽⁰⁾＞−＜ｐi-1⁽⁰⁾＞）×＜Ｆn+1⁽⁰⁾＞ ＋＜Ｍn+1⁽⁰⁾＞） ・・・・・（１） であり、ｉ番目の軸が直動関節に対応している場合に
は、 Ｆi ＝＜ｚi-1⁽⁰⁾＞・＜Ｆn+1⁽⁰⁾＞ ・・・・・（２）となる。 但し、＜ｚi-1⁽⁰⁾＞，＜ｐn+1⁽⁰⁾＞，＜ｐi-1⁽⁰⁾＞），
＜Ｆn+1⁽⁰⁾＞，＜Ｍn+1⁽⁰⁾＞は次の量を意味している。 ＜ｚi-1⁽⁰⁾＞；ｉ−１番目の軸（回転軸または並進軸）
＜ｚi-1 ＞の方向を表わす単位ベクトルのベース座標系
Σ0 表示 ＜ｐn+1⁽⁰⁾＞；Σ0 （ベース座標系）の原点からΣn+1
（ツール先端に設定された座標系、ツール座標系）の原
点へ向かう位置ベクトルのベース座標系Σ0 表示。 ＜ｐi-1⁽⁰⁾＞；Σ0 （ベース座標系）の原点からΣi-1
（ｉ−１番目の軸に設定された座標系）の原点へ向かう
位置ベクトルのベース座標系Σ0 表示。 ＜Ｆn+1⁽⁰⁾＞；＜Ｆn+1 ＞のベース座標系Σ0 表示 ＜Ｍn+1⁽⁰⁾＞；＜Ｍn+1 ＞のベース座標系Σ0 表示 そこで、ｉ＝１，２，３・・・・ｎとして、上記（１）
式あるいは（２）式を＜Ｆn+1⁽⁰⁾＞及び＜Ｍn+1⁽⁰⁾＞を
未知数とする方程式とみて数値計算によって解けば、エ
ンドエフェクタにかかる力とモーメントのベース座標系
Σ0 表現＜Ｆn+1⁽⁰⁾＞及び＜Ｍn+1⁽⁰⁾＞が求まる。

【００１６】なお、各軸で検出される力（トルク）及び
各軸にかかる並進力には重力の効果が含まれているか
ら、上記３次元空間への変換時には、この重力効果が補
償される。補償量は、各時点におけるロボットの位置・
姿勢データやロボットアームの重量データ、長さデータ
等から計算される。

【００１７】次に、図２括弧内の付属図は、重力補正後
の力＜Ｆn+1⁽⁰⁾＞（ここでは、便宜上＜Ｆtotal ＞で表
記する。）が３次元空間上のベクトルとして計算された
場合に、法線力を求める原理を説明するものである。

【００１８】付属図に示されているように、ツールにか
かる＜Ｆtotal ＞は、倣い対象面Γの法線成分＜ＦN ＞
と接線成分＜Ｆr ＞の合力と考えることが出来る。接線
成分＜Ｆr ＞は摩擦力と見て良いから、その大きさは｜
＜Ｆr ＞｜＝μ｜ＦN ｜（μは動摩擦係数）で与えられ
る。また、動摩擦力はロボットの移動方向と直交する方
向には作用しないものとすれば、ベクトル＜Ｆtotal
＞、ベクトル＜Ｆr ＞及びベクトル＜ＦN ＞で張られる
平面上の方向は、ロボットに教示された移動方向を表わ
すベクトル＜Ｈ＞と直交しているものと考えることが出
来る。

【００１９】ベクトル＜Ｈ＞とベクトル＜Ｆtotal ＞の
方向は判っているから、ベクトル＜Ｆtotal ＞、ベクト
ル＜Ｆr ＞及びベクトル＜ＦN ＞で張られる平面は計算
出来る。この平面内で、ベクトル＜Ｆtotal ＞の方向を
φ＝arctanμだけ回転した方向を求めれば、それがベク
トル＜ＦN ＞の方向、即ち法線ベクトル＜Ｎ＞の方向で
ある。従って、動摩擦係数μを予め与えておけば、法線
ベクトル＜Ｎ＞の方向を決定することが出来る。

【００２０】こうして求められた法線ベクトル＜Ｎ＞の
向きとツール座標系のＺ軸の向きを一致させる回転行列
を計算し、それに基づいて法線ベクトル＜Ｎ＞の向きと
ツール座標系のＺ軸の向きが一致するようにロボット姿
勢を制御する。この時、各軸の位置ゲインに変化を与え
ないことにすれば、変化量は位置偏差のみとなる。

【００２１】次に、この位置偏差を固定した条件で、法
線ベクトル＜Ｎ＞の方向に働く力を一定値Ｗにするよう
になる各軸の位置ゲインを逆変換演算によって求め、各
軸のゲインをその値に一致させる。これにより、その位
置においてツール座標系のＺ軸の向きが法線ベクトル＜
Ｎ＞の向きが一致し、且つ、倣い対象面からロボットＲ
Ｂが受ける法線方向成分がＷに等しいという条件が満た
される。

【００２２】更に、ロボットＲＢの教示速度ｖで教示点
Ｐ2 の方向へ移動させる為に、その位置における接線方
向を求め、ロボットＲＢの移動目標位置を定め、そのロ
ボット移動目標位置へ向けて速度ＶでロボットＲＢを移
動させるに必要な各軸位置偏差足し込み量を計算し、位
置制御ループの位置偏差計数部（例えば、エラーレジス
タ）へ足し込む。

【００２３】なお、接線方向は、教示ラインの方向（Ｐ
1 →Ｐ2 ）を向いた任意のベクトルと法線ベクトル＜Ｎ
＞によって張られる平面とその位置における倣い対象面
Γの接面（法線ベクトル＜Ｎ＞と垂直な面）の交線とし
て求められる。また、位置制御ループの位置偏差計数部
（例えば、エラーレジスタ）へ足し込まれる位置偏差量
（パルス数）は、摩擦力（接線方向に作用）を適当な方
式で評価し（例えば、ロボット移動方向と反対方向を向
いた定ベクトルで評価）、これに見合った力を各軸に生
じるに必要な位置偏差量（各軸の力＝位置ゲイン×位置
偏差、で求める。）を上乗せして計算される。

【００２４】以上のプロセスを、ロボットコントローラ
上のソフトウェア処理によって実行すれば、目的とする
倣い制御が実現される。倣い制御時の各軸のブロック線
図を示せば、図２のようになる。

【００２５】図２中、符号１は、位置ループの伝達関数
を表わしており、Ｋp は位置ループゲインである。ま
た、符号２は定数で与えられる伝達関数で、Ｋv は速度
ループゲインを表わし、符号３はサーボアンプとサーボ
モータを含む系の伝達関数を表わし、Ｋt はモータのト
ルク定数、Ｊはモータ軸にかかるエナーシャを表わして
いる。また、４、５はモータの軸制御器の中で行なわれ
る積分処理を表わしている。

【００２６】ロボットコントローラの軸制御器は、ＣＰ
Ｕからの位置指令Ｐc と現在速度値Ｖを積分（ブロック
５）して得られる現在位置Ｐf との位置偏差εp に応じ
てゲインＫp の位置制御処理を行ない、速度指令Ｖc を
得る。そして、速度指令Ｖcと現在速度値Ｖとの偏差εv
応じてゲインＫv の速度制御処理を行ない、トルク指
令Ｔc を生成し、サーボアンプへ入力する。

【００２７】そして、このトルク指令（電流指令）Ｔc
を受けたサーボアンプがモータにトルク指令Ｔc に応じ
た駆動電流を流すことによってモータが速度Ｖで回転す
る。

【００２８】ここで特徴的なことは、本願発明における
倣い制御時には、通常の方式とは異なり、オンラインで
位置ゲインＫp を変化させる点にある。

【００２９】

【実施例】図３は、本願発明を実施する為に使用し得る
ロボットコントローラの要部ブロック図である。図中、
ロボットコントローラ１０は、中央演算処理装置（ＣＰ
Ｕ）１１を有し、該ＣＰＵ１１には、ＲＯＭからなるメ
モリ１２、ＲＡＭからなるメモリ１３、ＣＭＯＳ等から
なる不揮発性メモリ１４、ＬＣＤ（液晶表示装置）１５
が付設された教示操作盤１６、ロボットの各軸を制御す
るロボット軸制御部１７、及びオフラインプログラミン
グ装置等の外部装置との入出力の為の汎用インターフェ
イス１９がバス２０を介して接続されている。

【００３０】ロボット軸制御部１７は更にサーボ回路１
８を経由してロボット本体ＲＢに接続されている。ＲＯ
Ｍ１２には、ＣＰＵ１１がロボットＲＢ及びロボットコ
ントローラ１０自身の制御の為に実行する各種のプログ
ラムが格納されている。ＲＡＭ１３はデータの一時記憶
や演算の為に利用されるメモリである。不揮発性メモリ
１４には、教示操作盤１６、あるいは図示しない外部装
置から入力される教示位置データを含むプログラムや各
種設定値が格納される。

【００３１】上述の構成及び機能は、従来のロボットコ
ントローラと基本的には変わるところはないが、本願発
明に従った倣い制御を実現する為に、次に説明する処理
（図５のフローチャート）を実行する為のプログラム及
び所要設定値がＲＯＭ１２あるいは不揮発性メモリ１４
に格納されている。

【００３２】本実施例では、図４に示したような事例を
想定するものとする。図４において、符号３０は曲面Γ
を有するワークを表わしており、曲面Γの中央部には線
状に延在する要除去バリＢが形成されている。そこで、
このバリＢに沿ったスプラインＱ1 〜Ｑm をロボットＲ
Ｂに教示し、バリ取り作業を実行する。アプローチポイ
ントを兼ねるホームポジションとしてＱ0 を設定し、ま
た、エスケープポントとしてＱm+1 を設定する。両者は
いずれもエアカット点である。

【００３３】また、ボットＲＢに支持されたバリ取りツ
ールＩの先端には、ツール座標系が、作用の説明の欄で
述べた向きで設定されているものとする。更に、法線力
の目標値Ｗ、動摩擦係数μ等所要設定値は、ロボットコ
ントローラ１０の不揮発性メモリ１４に格納済みである
ものとする。これら準備の下で、図５のフローチャート
に記した処理を実行する。

【００３４】教示点指標ｉを０に初期設定された状態で
処理を開始し、動作プログラムの１ブロックを読み込ん
でロボットを位置Ｑ1 へ移動させる（ステップＳ１〜ス
テップＳ２）。この間は、倣い制御は実行されない。教
示点指標ｉに１を加算し（ステップＳ３）、ｍ番目（倣
い制御終了点）に到達していないことを確認した上で
（ステップＳ５）、倣い制御を開始する。

【００３５】先ず、各軸Ｊj にかかっている力Ｆj を、
各軸の位置偏差と位置ゲインＫpjの積から求める（ステ
ップＳ６）。そして、この力Ｆj を軸数分の成分とする
ベクトル＜Ｆj ＞を定め（ステップＳ７）、３次元空間
のベクトル＜Ｆtotal ＞に変換し（ステップＳ８）、動
摩擦係数μの値及び教示ラインの方向（Ｑi →Ｑi+1）
から、その位置における倣い対象面Γの法線ベクトル＜
Ｎ＞を求める（ステップＳ９）。

【００３６】次いで、法線ベクトル＜Ｎ＞の向きとツー
ル座標系のＺ軸の向きを一致させる回転行列Ｔを計算し
（ステップＳ１０）、それに基づいて法線ベクトル＜Ｎ
＞の向きとツール座標系のＺ軸の向きが一致するように
ロボット姿勢を制御する（ステップＳ１１）。この時、
各軸の位置ゲインに変化を与えない。

【００３７】更に、位置偏差を固定した条件で、法線ベ
クトル＜Ｎ＞の方向に働く力を一定値Ｗにするようにな
る各軸の位置ゲインＫpj' を逆変換演算によって求め
（ステップＳ１２）、各軸のゲインをＫpj' に一致させ
る（ステップＳ１３）。

【００３８】そして、ロボットＲＢの教示速度ｖで次教
示点Ｑi+1 の方向へ移動させる為に、「作用」の欄で説
明した求め方によってその位置における接線方向を求め
（ステップＳ１４）、ロボットＲＢの移動目標位置を定
め、そのロボット移動目標位置へ向けて教示速度ｖでロ
ボットＲＢを移動させるに必要な各軸位置偏差足し込み
量を計算し（ステップＳ１５）、位置制御ループの位置
偏差計数部（例えば、エラーレジスタ）へ足し込み（ス
テップＳ１６）、移動目標位置へロボットＲＢを移動さ
せる（ステップＳ１７）。

【００３９】次いで、次教示点Ｑi+1 に対応する位置ま
でロボットＲＢが到達しているか否かに応じて（ステッ
プＳ１８）、ステップＳ３またはステップＳ６へ戻る。
即ち、次教示点Ｑi+1 に対応する位置までロボットＲＢ
が未到達であれば、直ちにステップＳ６以降の処理を繰
り返し、次教示点Ｑi+1 に対応する位置までロボットＲ
Ｂが到達していれば、教示点指標ｉに１を加算し（ステ
ップＳ３）、動作プログラムの次の１ブロックを読み込
み（ステップＳ４）、倣い制御終了点Ｑm に到達してい
ないこと（ステップＳ）を確認した上で（ステップＳ
５）、ステップＳ６以降の処理を繰り返す。

【００４０】ロボットＲＢが倣い制御終了点Ｑm に到達
すると、倣い制御が終了され、ステップＳ５からステッ
プＳ１９へ進み、最終教示点Ｑm+1 へロボットＲＢを移
動させて、１処理サイクルを終了する。

【００４１】なお、上記実施例の説明において、バリ取
りツールのオンオフのタイミング、駆動電流等の制御に
ついては記載を省略したが、通常は動作プログラム中に
挿入された命令文に基づいてバリ取りツール制御器（図
示省略）を制御することによって行なわれる。

【００４２】また、本実施例ではツールの姿勢（軸線の
向き）を倣い対象面Γの法線に垂直に保つケースを説明
したが、ツールの姿勢を倣い対象面Γの法線に対して傾
斜させた場合には、ツール座標系の設定方向（Ｚ軸方
向）をツール軸線の向きに対して傾けた条件で上記処理
による再生運転を実行すれば良い。即ち、この条件で上
記処理による再生運転を実行すると、ツール座標系の姿
勢を倣い対象面Γの法線に垂直に保つ制御が行なわれ、
ツール自体の姿勢は倣い対象面Γの法線に対して一定角
度傾斜した状態に保たれることになる。

【００４３】

【発明の効果】本願発明によれば、力センサあるいは距
離センサ等のセンサをロボットに搭載させることなく、
ソフトウェアによるフローティング機能によって倣い制
御が実現される。従って、倣い制御を必要とするアプリ
ケーションにおいて安価で信頼性の高いシステムを組め
るようなった。

【図面の簡単な説明】

【図１】本願発明の原理を説明する為に、倣い制御を行
なうロボットを一般的に表わした模式図である。

【図２】本願発明に従った倣い制御時のブロック線図を
表わしている。

【図３】本願発明を実施する為に使用し得るロボットコ
ントローラの要部ブロック図である。

【図４】実施例で想定する事例を説明する模式図であ
る。

【図５】図４で示したケースについて、ロボットコント
ローラのＣＰＵが行なう処理の概略を記したフローチャ
ートである。

【符号の説明】

１ 位置ループの伝達関数 ２ トルク指令出力算出に関する伝達関数（定数） ３ サーボアンプとサーボモータを含む系の伝達関数 ４、５ モータの軸制御器の中で行なわれる積分処理 ６ トルク指令値に基づく位置補正値算出 １０ ロボットコントローラ １１ 中央演算処理装置（ＣＰＵ） １２ ＲＯＭ １３ ＲＡＭ １４ 不揮発性メモリ １１ 液晶表示装置（ＬＣＤ） １６ 教示操作盤 １７ ロボット軸制御器 １８ サーボ回路 １９ 汎用インターフェイス ２０ バス ３０ ワーク Ｂ バリ Ｈ ロボットに教示された進行方向を表わす二重矢印 Ｉ ツール（バリ取りツール） Ｊ1 〜Ｊn ロボット軸 ＜Ｎ＞ 法線ベクトル Ｏf フェイスプレート中心 Ｏt ツール先端点 Ｏt −ＸＹＺ ツール座標系 Ｐ1 ，Ｐ2 教示点 Ｑ0 ，Ｑm+1 実施例のロボット経路の始点及び終点 Ｑ1 〜Ｑm 実施例のロボット経路（倣い制御実行区
間） ＜Ｗ＞ 法線ベクトル＜Ｎ＞と同方向を向いた長さＷの
定長ベクトル Γ 倣い対象面

Claims (3)

【特許請求の範囲】
1. 【請求項１】 （ａ）ロボットに位置教示と移動速度教
   示を行なう段階と、 （ｂ）各軸にかかっている力を、位置偏差と位置ゲイン
   の積から求める段階と、 （ｃ）この力を軸数分の成分に持つベクトルを定め、こ
   れを３次元空間のベクトルに変換し、その位置における
   倣い対象面Γの法線ベクトル＜Ｎ＞を定める段階と、 （ｄ）前記法線ベクトル＜Ｎ＞の向きと前記ロボットに
   予め設定されたツール座標系の向きを一致させるよう
   に、各軸の位置ゲインに変化を与えずに、ロボット姿勢
   を制御する段階と、 （ｅ）各軸の位置偏差を固定した条件で、ベクトル＜Ｎ
   ＞の方向の力が一定値Ｗとなる各軸の位置ゲインを求
   め、その値に各軸のゲインを一致させるさせる段階と、 （ｆ）その位置における接線方向を前記法線ベクトルの
   方向と前記位置教示で指示された方向に基づいて求める
   段階と、 （ｇ）前記接線上にロボットＲＢの移動目標位置を定
   め、速度ｖを与えるに必要な各軸位置偏差足し込み量を
   計算し、位置制御ループの位置偏差算出部へ足し込む段
   階を含み、少なくとも前記段階（ｂ）〜（ｇ）がロボッ
   ト制御装置上のソフトウェア処理によって実行されるこ
   とを特徴とするロボットの倣い制御方法。
2. 【請求項２】 前記ツール座標系は、そのの向きが、前
   記ロボットに支持されたツールの軸方向と一致するよう
   に設定されていることを特徴とする請求項１に記載され
   たロボットの倣い制御方法。
3. 【請求項３】 前記ツール座標系は、そのの向きが、前
   記ロボットに支持されたツールの軸方向に対して傾斜し
   て設定されていることを特徴とする請求項１に記載され
   たロボットの倣い制御方法。