JP3421442B2 - ロボットの位置教示方法及びロボット制御装置 - Google Patents

Description

【発明の詳細な説明】

【０００１】

【産業上の利用分野】本願発明は、産業用ロボット（以
下、単に「ロボット」と言う。）に位置教示を行なう為
の技術に関し、更に詳しく言えば、位置ずれ時に外力が
加わる環境にある教示位置に関するロボットの位置教示
を簡便且つ正確に行えるようにする為の技術に関する。

【０００２】

【従来の技術】ロボットに位置教示を行なう為に最も一
般的に用いられている方法は、ティーチング・プレイバ
ック方式と呼ばれている。この方法によれば、実際の作
業環境に出来るだけ近い状況の下で、ツール先端点が作
業実行時にとるべき位置（姿勢も含む。以下、同様。）
に来るようにロボットの実機が操作され、その時のロボ
ット位置（ツール先端点の位置）がロボットに教示され
る。このような教示点は所望されるロボット経路に沿っ
て、複数個指定されるのが通常である。

【０００３】従来より、上記方式による教示時における
ロボットの操作は、いわゆるジョグ送りによって実行さ
れている。このジョグ送りによる教示作業には高度の熟
練と多くの作業時間が要求されることが通常であった。
即ち、正確な教示を行なう為には、ツール先端点の位置
をあらゆる方向から目視によって確認しながらロボット
を試行錯誤的に細かく操作する作業が必要であった。特
に、位置ずれ時に外力が加わる環境にある教示位置につ
いてロボットの位置教示を行なう場合には、細心の注意
と高度の熟練を要していた。

【０００４】例えば、ロボットハンドによってワークを
把持する位置を教示する場合には、ロボットハンドがワ
ークを正確に把持出来る位置をロボットに実際にとらせ
る必要があるが、ロボットをそのような正確な位置にも
ってくる為のジョグ送り操作には高度の熟練を要し、ま
た、ジョグ送りの最終過程あるいはハンド閉成試行時等
にハンド（一般には、エンドエフェクタ）とワークの間
に予期しない力がかかり易く、破損事故を招く危険性も
あった。

【０００５】このように、従来の方式で位置ずれ時に外
力が加わる環境にある教示位置についてロボットの位置
教示を行なう場合には、エンドエフェクタに外力が作用
した時にこれを回避して位置ずれに起因した外力を受け
ない状態にロボットを確実にもってくる技術手段を欠い
ていた為に、位置教示を高精度で安全に実行することが
困難であった。

【０００６】

【発明が解決しようとする課題】そこで本願発明の目的
は、最適の教示位置（適正な教示位置としてみなし得る
位置のこと。以下、同様。）からずれた位置にロボット
が存在する時に該位置ずれを修正する方向に作用する外
力がロボットに加わり得る環境にある教示位置につい
て、ロボットの位置教示を簡単な操作で安全確実に実行
することが出来るロボットの位置教示方法、並びに、該
方法を実行する際に使用出来るロボット制御装置を提供
することにある。また、本願発明は、そのことを通して
ロボット作業の精度と効率を向上させることを企図する
ものである。

【０００７】

【課題を解決するための手段】本願発明は、位置制御ル
ープ及び速度制御ループを備える制御系で制御されるサ
ーボモータで各軸を駆動されるロボットに対し、最適の
教示位置からずれた位置にロボットが存在する時に該位
置ずれを修正する方向に作用する外力がロボットに加わ
り得る環境にある教示位置について教示を行なうケース
について、上記技術課題を解決する為に、次の諸段階を
含む方法及びそれら段階に対応した手段を備えたロボッ
ト制御装置を提案した。このような外力は、通常、ロボ
ット作業に関連した対象物（把持ワーク、溶接ワーク、
溶接ガン、嵌め合い対象ワークなど）からの反力として
与えられる。ここで、外力に従ったロボットの移動をソ
フトフローティングサーボによる制御によって行われ
る。このソフトフローティングサーボによる制御は、ソ
フトフローティング機能のバネ定数が予め設定された値
と一致するように行なわれる。

【０００８】本願発明に従えば、ロボットをプログラム
再生運転あるいはジョグ送り操作を適宜用いて、ロボッ
トを前記最適の教示位置の近傍に移動させ、前記最適な
教示位置からの位置ずれを修正する方向に作用する外力
が前記ロボットに加わる状態とする。この状態におい
て、ソフトフローティングサーボによる制御が実行され
る。その為には、前記各軸の内少なくとも１つの軸につ
いて、位置ループゲイン及び速度ループゲインを変更す
れば良い。

【０００９】ロボットが外力（例えば、ワークからの反
力）を受け、外力が弱まる方向へ移動した段階で、その
時点における現在位置を前記ロボットに教示すること
で、ロボットに最適な位置が教示される。現在位置の教
示は、既に教示済みの位置データの修正あるいは教示位
置データの新規の書き込みの形態で実行される。

【００１０】上述した制御は、前記の少なくとも１つの
軸に関する先端距離がロボットコントローラ内で求めら
れ、それに応じて位置ループゲイン及び速度ループゲイ
ンを変更することで実現される。この提案に従えば、ソ
フトフローティング機能のバネ定数がロボットの姿勢に
影響されない利点が生じる。

【００１１】

【作用】本願発明は、通常の「硬いサーボ制御方式」の
弊害を避ける為に提案され、利用されている「ソフトフ
ローティングサーボによる制御」をロボットの位置教示
に利用した点に基本的な特徴がる。そこで、先ず、本願
発明で利用されるソフトフローティングサーボに制御方
法について、ソフトフローティングサーボを用いない通
常の制御と対比させて簡単に説明する。

【００１２】ロボットのアームを駆動する各軸のサーボ
モータの制御は、通常、位置制御ループ及び速度制御ル
ープを有する制御系によって制御されている。図２は、
これを示したブロック図で、符号１は位置ループにおけ
るボジションゲインＫｐの項、符号２は速度ループゲイ
ンＫｖの項である。また符号３，４はモータの伝達関数
の項であり、３はトルク定数Ｋｔ、４はイナーシャＪで
ある。更に、符号５はモータ速度ｖを積分してモータ位
置ｙを求める伝達関数である。なお、ｓはラプラス演算
子を表わしている。

【００１３】ロボットコントローラの内部で作成される
移動指令ｒとモータ位置ｙより位置偏差ｅが求められ、
該位置偏差ｅにポジションゲインＫｐを乗じて速度指令
ｖｃｍｄが求められる。更に、速度偏差ｅが、該速度指
令ｖｃｍｄとモータ速度ｖより求められる。この速度偏
差ｅに速度ループゲインＫｖを乗じてトルク指令Ｔｃが
求められ、該トルク指令Ｔｃに応じた駆動電流がモータ
に供給される。

【００１４】なお、速度ループの制御においては、図２
の例ではＰＩ制御を例として記載しているが、ＩＰ制御
とすることも出来る。

【００１５】このような制御系でサーボモータが制御さ
れる場合には、与えられた位置指令によって目標位置に
向かってロボット乃至エンドエフェクタが移動している
途上において、エンドエフェクタがなんらかの障害物に
遭遇・接触しても、そのまま目標位置に向かって移動し
続けるとういう現象が生じる。

【００１６】この現象は次のように説明される。即ち、
障害物の存在に関わらずサーボモータは目標位置に向か
って移動しようとするが、実際には障害物によりその目
標位置に移動することが阻まれ位置偏差が増大し、この
位置偏差にポジションゲインＫｐを乗じて得られる速度
指令ｖｃｍｄも増大する。そして、この増大する速度指
令ｖｃｍｄとモータの速度（障害物に当接しているとき
には、速度は「０」と考えられる。）との差は、速度ル
ープの持つ積分器によって積分されて増大し、トルク指
令Ｔｃは大きな値となる。

【００１７】その結果、サーボモータは目標位置に達す
るように最大のトルクを出力するようになる。ここで障
害物となるものは、ロボットによる作業（把持、溶接、
機械加工、嵌め合い等）の対象物（以下、「ワーク」で
これを代表させる。）の対象物である場合が多く、従っ
て、上記したような現象はワークとの干渉事故（衝突）
の原因となる。

【００１８】このような不都合を回避する為に、ソフト
ウェアによって制御系に「柔軟なサーボ制御」を行なわ
せることによって、ソフトフローティング機能を発揮さ
せることが提案されている。これは、位置制御ループ及
び速度制御ループを備えるサーボモータの制御系におい
て、柔軟制御指令の入力時に、ポジションゲイン及び速
度ループゲインを低下させることにより、速度指令及び
トルク指令の値を小さな値に抑える方式である。ここで
は、このような制御方式を一般に、「ソフトフローティ
ングサーボによる制御」と呼ぶこととする。

【００１９】柔軟制御指令の入力時のポジションゲイン
及び速度ループゲインの決め方として、柔軟制御用の値
を予め設定しておき、柔軟制御指令の入力時にその設定
値に切り換える手法が従来より利用されている。本願発
明で利用されるソフトフローティングサーボによる制御
は、このような方式によるものであっても構わないが、
本出願人に係る特願平６−２４７０９号に添付された明
細書及び図面に記載されたような改良方式を利用するこ
とも出来る。

【００２０】これは、柔軟制御指令の入力時のポジショ
ンゲイン及び速度ループゲインを、そのサーボモータに
よって駆動される軸に関する先端距離に応じてソフトフ
ローティング機能のバネ定数が設定値となるように変更
するものである。この改良方式によれば、先端距離が変
化しても、駆動体先端での柔らかさが一定に保たれる利
点が得られる（詳細については、上記出願関連文書を参
照）。

【００２１】ここで、「先端距離」とは、その軸で駆動
される駆動体（アーム）の運動軸（回転軸または直動
軸）から測った駆動体の先端点（外力が作用する点。ロ
ボットであれば、エンドエフェクタの先端点乃至これに
準ずる点。例えば、アーム先端に装着されたハンドに設
定されたハンド座標系の原点位置、アーム先端のフェイ
スプレート中心位置など。以下、同様。）までの回転半
径を指すものとする。別の言い方をすれば、任意の軸に
関する先端距離は、外力の作用点をその軸で駆動される
駆動体（アーム）の運動軸に対して垂直な面（以後、
「回転平面」と言う。）上に射影し、回転平面上でその
運動軸に垂線を降ろした時の足の長さのことである（実
例は実施例を参照）。

【００２２】この先端距離はロボットの姿勢に依存して
変化するので、ロボットコントローラ内で柔軟制御指令
の入力時のロボット姿勢に対応した先端距離が計算され
る。このような改良された方式を採用した場合には、サ
ーボ制御の「柔らかさ」がロボット姿勢に影響を受けな
い利点が発揮される（詳しくは、実施例参照）。

【００２３】以上が本願発明で利用されるソフトフロー
ティングサーボ制御方法の概要である。上記説明から理
解されるように、ソフトフローティングサーボによる制
御の特徴は、強い外力がロボットに作用した時に、ロボ
ットの機構部を駆動するサーボモータが無理にこれに打
ち勝とうとして大きなトルクを出力しない点にある。

【００２４】通常、この性質は障害物との強い干渉を避
ける為に利用されるのであるが、本願発明ではこの性質
を逆用し、ロボット乃至エンドエフェクタがワーク等の
作業関連物に押し付けられる状況を作り、その時に受け
る反力をロボットに作用する外力として利用し、ロボッ
トをその反力が弱まる位置まで移動させる。

【００２５】このような移動のプロセスは、多くの場
合、ロボット作業に関連した対象物（把持ワーク、溶接
ワーク、溶接ガン、嵌め合い対象ワークなど）にロボッ
トが過剰に接近した押し付け状態から、最適な教示位置
へ向けて必要量（ベクトル量）だけ修正シフトされた位
置に移動するプロセスとみなすことが出来る。そこで、
この修正シフトされた位置をロボットに教示すれば、精
度の高い位置教示が実現されることになる。

【００２６】

【実施例】先ず、本実施例で利用されるソフトウェアに
よるソフトフローティングサーボ制御についてその概要
を説明する。

【００２７】図３は、本願発明の実施例で使用されるロ
ボットコントローラＲＣを関連機器と共に要部ブロック
図で示したものである。先ず、ソフトフローティングサ
ーボ制御に直接関係のある部分から説明すると、符号１
０はシステム全体を制御するホストコンピュータを表わ
している。符号１６は、ホストコンピュータ１０から出
力される移動指令や制御信号を後述のディジタルサーボ
回路のプロセッサに引渡し、逆にディジタルサーボ回路
のプロセッサからの各種信号をホストコンピュータ１０
に引き渡すための共有ＲＡＭメモリを表わしている。

【００２８】また、符号１７は、上述したサーボ制御を
実行するディジタルサーボ（ソフトウェアサーボ）回路
で、プロセッサ、ＲＯＭ、ＲＡＭ等のメモリ等で構成さ
れる。符号１８は、ロボット３０における各軸のサーボ
モータの位置のフィードバック値、速度のフィードバッ
ク値、電流のフィードバック値等が書き込まれる帰還レ
ジスタを表わしている。

【００２９】他の部分について見ると、ホストＣＰＵ１
０にはバスライン１９を介してＲＯＭ１１、ＲＡＭ１
２、不揮発性メモリ１３、外部装置４０とのインターフ
ェイスの役割を果たす入出力装置（Ｉ／Ｏ）１４、教示
操作盤２０とのインターフェイス（Ｉ／Ｆ）が接続され
ている。ＲＯＭ１１には、各種のシステムプログラムが
格納される。ＲＯＭ１２は、ホストＣＰＵ１０によるデ
ータの一時記憶に使用されるメモリである。不揮発性メ
モリ１３には、ロボット３０及び外部装置４０の動作内
容に関する各種プログラム、関連設定値等が格納され
る。

【００３０】教示操作盤２０は、液晶ディスプレイ（Ｌ
ＣＤ）及びキーボードＫＹを備え、通常の指令（プログ
ラム再生運転指令、ジョグ送り指令、プログラムデータ
の入力／変更、関連設定値入力／変更等）が可能である
他に、ソフトフローティングサーボ制御の開始／解除の
指令の入力が可能である。

【００３１】入出力装置１４に接続される外部装置は、
アプリケーションによって異なる。例えば、ワークの把
持を伴う作業であればロボットハンド、スポット溶接で
あればスポット溶接装置（電源、溶接ガン等を含む。）
が入出力装置１４に接続される。

【００３２】さて、本実施例で利用されるソフトウェア
によるソフトフローティング制御の理解を容易にする為
に、ここでロボット３０として、図５に示したように、
Ｊ１軸とＪ２軸の２軸により構成される例を想定する。

【００３３】このＪ１軸がモータにより駆動されて、回
転平面の中心点を駆動体中心としてＪ１軸が回転し、そ
のＪ１軸に取り付けられているＪ２軸の先端の駆動体先
端がワークＷに当接して力を作用する。Ｊ２軸のＪ１軸
に対する姿勢は、Ｊ１軸の回転平面に対してＪ２軸のな
す角度θにより表される。ここで、Ｊ１軸のアーム長は
Ｌ１、Ｊ２軸のアーム長はＬ２により表されるものとす
る。

【００３４】図中のＪ１軸の駆動について、ソフトウェ
アによるソフトフローティング制御を実施する場合の処
理について説明する。

【００３５】図５に示すロボット機構図において、駆動
体先端にかかる力ｆ（例えば、ｋｇ）と駆動体の移動距
離Ｙ（例えば、ｃｍ）との関係により表される柔軟制御
のソフトフローティング制御の柔らかさの程度である駆
動体のバネ定数Ｙ／ｆは、Ｄを駆動体中心から駆動体先
端までの回転平面上での距離、ｉをモータ側での減速
比、Ｋｐを位置ループゲイン、Ｋｖを速度ループゲイン
とすると、 Ｙ／ｆ＝（Ｄ・ｉ² ）／（Ｋｔ・Ｋｐ・Ｋｖ） ・・・（１） となる（この式の導出法については、ここでは省略す
る。詳しくは、前記出願関連文書を参照）。これを位置
ループゲインＫｐと速度ループゲインＫｖとの積の値に
ついて解くと、 Ｋｐ・Ｋｖ＝（Ｄ・ｉ² ）／｛Ｋｔ・（Ｙ／ｆ）｝ ・・・（２） となる。ここで、バネ定数Ｙ／ｆをα（ｒａｇ／ｋｇ）
と設定した場合、前記（２）式は次式（３）となる。

【００３６】 Ｋｐ・Ｋｖ＝（Ｄ・ｉ² ）／（Ｋｔ・α） ・・・（３） 従って、前記式（３）において、駆動体（ロボット）の
姿勢が変化して先端距離Ｄの値が変更されても、はじめ
に設定したバネ定数αの値が変化しないようにするため
には、位置ループゲインＫｐと速度ループゲインＫｖと
の積の値Ｋｐ・Ｋｖを先端距離Ｄの値に応じて前記
（３）の右辺に一致するように変更させればよい。

【００３７】一方、図に示す２軸の駆動体において、Ｊ
１軸は水平回転軸であり、駆動体の先端距離ＤはＪ２軸
の角度θとＪ２軸のアーム長Ｌ２に依存し、次式（４）
により表される。

【００３８】 Ｄ＝Ｌ２・ｃｏｓθ ・・・（４） また、バネ定数（＝Ｙ／ｆ）をα（ｒａｇ／ｋｇ）と設
定した場合の位置ループゲインｐと速度ループゲインＫ
ｖの関係は前記式（３），（４）から Ｋｐ・Ｋｖ＝（Ｄ・ｉ2 ）／（Ｋｔ・α） ＝（Ｌ２・ｃｏｓθ・ｉ² ）／（Ｋｔ・α） ・・・（５） となる。この式（５）において、駆動体（ロボット）の
姿勢変化は角度θの角度変化として現れる。この角度θ
の変化により先端距離Ｄの値が変更されても、はじめに
設定したバネ定数αの値が変化しないようにするために
は、式（５）の左辺の項である位置ループゲインＫｐと
速度ループゲインＫｖとの積の値Ｋｐ・Ｋｖが、θの値
に応じて変化する式（５）の右辺の値となるように変更
させればよく、さらに、その制御安定性を崩さないため
には位置ループゲインＫｐと速度ループゲインＫｖの比
が一定であることが条件となる。そこで、通常動作時に
おける位置ループゲインをＫｐｏ、速度ループゲインを
Ｋｖｏとして、位置ループゲインＫｐと速度ループゲイ
ンＫｖの比が一定となるように変更すると、 Ｋｐｏ：Ｋｖｏ＝Ｋｐ：Ｋｖ ・・・（６） の関係から、 Ｋｐｏ・Ｋｖ＝Ｋｖｏ・Ｋｐ ・・・（７） の条件式を満足する必要がある。この条件式（７）と前
記式（５）から、位置ループゲインＫｐ及び速度ループ
ゲインＫｖについて解き、ソフトフローティング制御を
行うときの位置ループゲイン、速度ループゲインをＫｐ
ｆ、Ｋｖｆとすると、それぞれ、 Ｋｐｆ＝｛（Ｋｐｏ・ｉ2 ・Ｌ２・ｃｏｓθ）／（Ｋｖｏ・Ｋｔ・α）｝^1/2 ・・・（８） Ｋｖｆ＝｛（Ｋｖｏ・ｉ2 ・Ｌ２・ｃｏｓθ）／（Ｋｐｏ・Ｋｔ・α）｝^1/2 ・・・（９） となる。

【００３９】従って、ソフトウェアによって、位置ルー
プゲインＫｐ及び速度ループゲインＫｖの値を、上記式
（８），（９）により設定される値に変更してソフトフ
ローティング制御を行うことにより、あらかじめ定めた
値のバネ定数により希望とする柔らかさの制御を行うこ
とが出来る。

【００４０】次に、前記した図３におけるディジタルサ
ーボ回路１２のプロセッサが実行する、ソフトウェアに
よるソフトフローティングサーボ制御の処理について、
図５及び図６に示す２軸の駆動体（ロボット）の例につ
いて、図４のソフトフローチャートを参照して説明す
る。

【００４１】なお、前述したバネ定数α＝Ｙ／ｆの値は
設定済みであり、通常のサーボ制御を行うときのポジシ
ョンゲインＫｐ、速度ループゲインＫｖの値は、Ｋｐ
ｏ、Ｋｖｏとして設定されているものとする。

【００４２】本願発明では、位置教示されるべき位置へ
ロボットを接近させる為に、ロボットがプログラム再生
モードまたはジョグ送りモードで運転される。ソフトフ
ローティングサーボ制御は、ソフトフローティングサー
ボ制御開始指令によって開始される。この指令は、オペ
レータによる教示操作盤２０からのマニュアル入力また
は動作プログラムに基づいて、ホストＣＰＵ１０から発
せられる。

【００４３】なお、プログラム再生あるいはジョグ送り
によるロボット動作の内容、ソフトフローティングサー
ボ制御の開始指令の入力タイミング等については後述す
る。

【００４４】ディジタルサーボ回路１２のプロセッサ
は、ソフトフローティングサーボ制御の開始指令を受け
て位置・速度ループ処理周期毎に以下の如く図４に示す
処理を実行する。

【００４５】ディジタルサーボ回路１２のプロセッサ
は、ホストコンピータ１０から共有メモリ１１を介して
送られてくる移動指令より移動指令ｒを読み込み（ステ
ップＳ１）、ロボット１４のモータ位置ｙを読み込む
（ステップＳ２）。このモータ位置ｙは、帰還レジスタ
１３に書き込まれている位置フィードバック値を用いる
ことが出来る。また、図示していない入力装置により共
有メモリ１１にバネ定数αを入力して、柔軟制御の柔ら
かさの程度の設定を行う（ステップＳ３）。次に、ホス
トコンピータ１０からＪ２軸のアーム角度θを取り込む
（ステップＳ４）。このＪ２軸のアーム角度θは、ワー
クに力を印加するための駆動体を駆動するために、ホス
トコンピータ１０から駆動体に送られる角度信号を用い
ることが出来る。前記ステップＳ４で取り込んだＪ２軸
のアーム角度θを用いて、駆動体の駆動体先端の位置を
算出する（ステップＳ５）。この駆動体の先端位置は、
図５，６において、駆動体の回転平面上における駆動体
中心から駆動体先端の投影位置までの距離Ｄとして求め
られ、次式により表される。 Ｄ＝Ｌ２・ｃｏｓθ ・・・（１０） なお、Ｌ２はＪ２軸のアーム長である。

【００４６】次に、式（１０）で表される駆動体の先端
距離Ｄを用いて、ソフトフローティング制御を行うとき
の位置ループゲインＫｐｆ、及び速度ループゲインＫｖ
ｆを算出する（ステップＳ６）。この位置ループゲイン
Ｋｐｆ、及び速度ループゲインＫｖｆの算出は、前記式
（８），（９），及び式（１０）から得られる前式
（８），（９）を用いて行うことが出来る。 Ｋｐｆ＝｛（Ｋｐｏ・ｉ² ・Ｄ）／（Ｋｖｏ・Ｋｔ・α）｝^1/2 ・・（８） Ｋｖｆ＝｛（Ｋｖｏ・ｉ² ・Ｄ）／（Ｋｐｏ・Ｋｔ・α）｝^1/2 ・・（９） なお、ｉは減速比である。

【００４７】これにより、共有メモリ１１には、通常の
制御を行う場合の位置ループゲインＫｐｏ、及び速度ル
ープゲインＫｖｏと、ソフトフローティング制御を行う
ときの位置ループゲインＫｐｆ、及び速度ループゲイン
Ｋｖｆが格納されることになる。

【００４８】前記ステップＳ６までの工程により、サー
ボモータの制御を行う場合において、通常の制御に用い
る位置ループゲインＫｐｏ、及び速度ループゲインＫｖ
ｏと、ソフトフローティング制御に用いる位置ループゲ
インＫｐｆ、及び速度ループゲインＫｖｆのゲイン値が
準備できたことになる。

【００４９】そこで、次に、サーボモータの制御におい
て、通常の制御を行うか、あるいはループゲインを駆動
体の姿勢に応じて変更するソフトフローティング制御を
行うかの判定を行い（ステップＳ７）、その判定に応じ
て位置ループゲイン値の設定を行う（ステップＳ８，
９）。

【００５０】ステップＳ７の判定は、手動によるオペレ
ータからの柔軟制御指令の有無を判断することにより行
うことができ、例えば、共有メモリ１１内に設けたフラ
グを柔軟制御指令、及び解除指令によりセット、リセッ
トし、そのフラグを監視することにより行うことが出来
る。

【００５１】前記ステップＳ７の判定において、ソフト
フローティング制御によりループゲインを駆動体の姿勢
に応じて変更する場合には、ソフトフローティング制御
に用いる位置ループゲインＫｐｆをＫｐの値とし（ステ
ップＳ８）、一方、通常制御を行う場合には通常の位置
ループゲインＫｐｏをＫｐの値とし（ステップＳ９）、
それぞれの値を共有メモリ１１から読み出して設定す
る。

【００５２】次に、前記ステップＳ１で読み込んだ移動
指令ｒから前記ステップＳ２で読み込んだモータ位置ｙ
を減算して位置偏差ｅを求め、その位置偏差ｅに前記ス
テップＳ８，９で設定した位置ループゲインＫｐを乗算
して速度指令ｖｃｍｄを算出する（ステップＳ１０）。
次に、モータ速度の取込みを行う（ステップＳ１１）。
このモータ速度の取込みは、例えば、帰還レジスタ１３
内に書き込まれている速度フィードバック値を用いるこ
とが出来る。そして、速度ループゲインの設定を行うた
めに、サーボモータの制御において、通常の制御を行う
か、あるいはループゲインを駆動体の姿勢に応じて変更
するソフトフローティング制御を行うかの判定を行い
（ステップＳ１２）、その判定に応じて速度ループゲイ
ン値の設定を行う（ステップＳ１３，１４）。

【００５３】ステップＳ１２の判定は、前記ステップＳ
７と同様に行うことが出来る。前記ステップＳ１２の判
定において、ソフトフローティング制御によりループゲ
インを駆動体（ロボット）の姿勢に応じて変更する場合
には、ソフトフローティング制御に用いる速度ループゲ
インＫｖｆをＫｖの値とし（ステップＳ１３）、一方、
通常制御を行う場合には通常の速度ループゲインＫｖｏ
をＫｖの値とし（ステップＳ１４）、それぞれの値を共
有メモリ１１から読み出して設定する。

【００５４】次に、前記ステップＳ１０で算出した速度
指令ｖｃｍｄから前記ステップＳ１１で読み込んだモー
タ速度ｖを減算して速度偏差を求め、その速度偏差に前
記ステップＳ１３，１４で設定した速度ループゲインＫ
ｖを乗算してトルク指令Ｔｃｍｄを算出する（ステップ
Ｓ１５）。この算出したトルク指令Ｔｃｍｄをアンプ等
に出力して、電流ループに引渡し（ステップＳ１６）、
当該位置・速度ループ処理周期の処理を終了する。

【００５５】前記位置・速度ループ処理を所定周期毎に
繰り返すことにより、ソフトウェアによるソフトフロー
ティングサーボ制御が行われ、駆動体（ロボット）の姿
勢に応じて先端位置を求めて、その先端位置に応じた位
置ループゲインと速度ループゲインによりサーボ制御を
行い、設定したバネ定数の柔らかさを実施することが出
来る。

【００５６】以上が、ロボット３０として、図５の構成
（Ｊ１軸とＪ２軸の２軸）を想定した場合のソフトフロ
ーティングサーボ制御の処理の概要である。ロボット３
０が３軸以上の構成を有する場合についても、上記説明
した処理の考え方を拡張して任意の駆動軸について、ソ
フトフローティングサーボ制御を実行することが出来
る。

【００５７】例えば、図７及び図８に示す３軸の駆動体
の例について簡単に説明すると次のようになる。図７及
び図８に示す３軸の駆動体（ロボット）は、ＪＩ軸，Ｊ
２軸，及びＪ３軸からなり、各軸が同一平面上にある例
であり、ＪＩ軸はモータに接続されて該軸を駆動体中心
として回転する。ＪＩ軸の先端にはＪ２軸が接続され、
さらに該Ｊ２軸の先端にはＪ３軸が接続され、Ｊ３軸の
先端を駆動体先端としてワークＷと当接する。そして、
Ｊ２軸のＪＩ軸に対する取付け角度は回転平面に対して
θ２であり、Ｊ３軸のＪ２軸に対する取付け角度は回転
平面に対してθ３である。従って、この駆動体の姿勢
は、この角度θ２，及びθ３により決定されることにな
る。なお、Ｊ２軸，及びＪ３軸のアーム長は、それぞれ
Ｌ２，及びＬ３とする。

【００５８】この駆動体における先端距離Ｄは、図にお
いてＪ２軸，及びＪ３軸のアーム長を回転平面に投影し
た長さＤ２，Ｄ３の和であり、 Ｄ＝Ｄ２＋Ｄ３ ・・・（１１） により表される。

【００５９】なお、Ｄ２，及びＤ３は次式で表される。 Ｄ２＝Ｌ２・ｃｏｓθ２ ・・・（１２） Ｄ３＝Ｌ３・ｃｏｓθ３ ・・・（１３） この駆動体（ロボット）のＪ１軸についてのフトウェア
によるソフトフローティングサーボ制御の処理は、前記
実施例の作用で説明したソフトフローチャートとほぼ同
様にして行われる。前記フローチャートとの相違は、ス
テップＳ４のアーム角度θの取込みと、ステップＳ５の
先端位置の算出である。

【００６０】アーム角度θの取込みにおいては、Ｊ２軸
のＪＩ軸に対する取付け角度を表す角度θ２と、Ｊ３軸
のＪ２軸に対する取付け角度を表す角度θ３を取り込む
ことにより行うことができ、また、先端位置の算出にお
いては、前記式（１１），（１２），及び（１０）を用
いて行うことが出来る。

【００６１】４軸以上の多軸の場合においても同様にし
て、ホストコンピータ１０から駆動体に送られる角度信
号等によりソフトウェアからの制御信号を用いることに
より軸相互の位置関係を表す角度を逐次取込んで駆動体
の姿勢を求め、その姿勢における位置ループゲインと速
度ループゲインを求め、その求めたゲインにより制御を
行うことができ、これにより、駆動体の姿勢変化した場
合でも設定したバネ定数により所望の柔らかさによる制
御を行うことが出来る。

【００６２】以上が、本実施例で利用されるソフトフロ
ーティングサーボ制御の概要である。以下、このような
ソフトフローティングサーボ制御とジョグ送りとを組み
合わせてロボットの位置教示を行なう方法について、幾
つかの例を挙げて説明する。

【００６３】以下の適用例１〜適用例３に示すように、
本願発明の方法が適用可能なアプリケーションの条件
は、「ロボットに対し、最適の教示位置からずれた位置
にロボットが存在する時に該位置ずれを修正する方向に
外力が加わる状態は、ハンドの開閉等によって作り出さ
れる。

【００６４】先ず、図９（１）〜（４）は第１の適用例
を説明する状態推移図である。

【００６５】［適用例１］これは、据置型の溶接ガンを
使用したスポット溶接への適用例であり、システム構成
としては、図３における外部装置４０としてスポット溶
接装置を配したものを使用する。各図において、溶接ガ
ン（全体図は省略）の先端部が符号Ｇ1 ，Ｇ2 で表わさ
れている。先端部Ｇ1 ，Ｇ2 は、ホストＣＰＵ１０から
の指令に従って閉成／開成動作を行なう（上下方向矢印
参照）。

【００６６】溶接対象ワークは、２枚の板状部材Ｗ1 ，
Ｗ2 を重ねたものをまとめて符号Ｗで表わされている。
ワークＷは、ロボットアームＡＭの先端部に装着された
ハンドＨに堅く把持されている。符号Ｗ0 は、溶接点に
対応して設定されたツール先端点を表わしている。

【００６７】本願発明の適用にあたっては、ロボットを
図９（１）に示した初期位置から溶接ガンＧ1 ，Ｇ2 に
接近させ、図９（２）の状態とする。この状態へのロボ
ット移動は、粗い位置教示後の再生運転によって行なっ
ても良いし、ジョグ送りによっても良い。また、両者を
組み合わせて利用しても構わない。

【００６８】図９（２）の状態では、ツール先端点Ｗ0
は位置Ｐ0 にあるものとする。この位置（姿勢を含む。
以下、同様）Ｐ0 は、図９（１）に符号Ｑ0 で示した最
適の教示位置とは少量ずれていることが通常である。何
故ならば、位置Ｐ0 の教示あるいはジョグ送りに、高精
度を期待するのは一般に困難であるからである。図中で
は、特にロボットの姿勢に無視出来ないずれがある状態
が描かれている。

【００６９】次いで、動作プログラムあるいは教示操作
盤２０からの入力により、ソフトフローティングサーボ
制御の開始指令をホストＣＰＵ１０から発し、ソフトフ
ローティングサーボ制御を開始させる。更に、溶接ガン
Ｇ1 ，Ｇ2 の閉成指令によって溶接ガンＧ1 ，Ｇ2 の閉
成動作を開始する。やがて、溶接ガンＧ1 ，Ｇ2 は図９
（３）に示したように、ワークＷに接触してワークＷ、
ハンドＨを介してロボットに力を及ぼす状態となる。

【００７０】ロボットは、ソフトフローティングサーボ
制御が行なわれている為に、この反力に抗しきれずに、
矢印ＡＲ１で示した向きに移動を開始する。この移動
は、溶接ガンＧ1 ，Ｇ2 の閉成動作が進み、図９（４）
の状態（閉成完了）まで続行される。図９（４）の状態
においては、ロボットの位置（特に、姿勢）が図９
（２）の状態から修正され、最適な位置Ｑ0 により近い
ロボット位置が実現されているものと考えられる。

【００７１】そこで、この図９（４）の状態で、位置教
示を実行すれば高精度の位置教示が実現される。粗い位
置教示によって位置Ｐ0 の位置データが不揮発性メモリ
１３に書き込み済みである場合には、その位置データが
書き直される。また、初めての位置教示の場合（位置Ｐ
0 への移動はジョグ送り）であれば、図９（４）の状態
における現在位置データに基づいて、新規に位置データ
が不揮発性メモリ１３の位置データ書込領域に書き込ま
れる。位置教示が終わったら、溶接ガンＧ1 ，Ｇ2 を開
成し、ロボットを退避させた上でソフトフローティング
サーボ制御を解除する。

【００７２】なお、この適用例の変形として、ワークＷ
に代えてポータブルガンをロボットに装着し、位置決め
されたワークに対してロボットを接近させ、ソフトフロ
ーティングサーボ制御の下で、ポータブルガンを閉成さ
せる態様が考えられる。この場合には、ポータブルガン
を介してロボットに作用する力によってロボットがより
適正な教示位置へ移動され、移動後の位置が教示され
る。

【００７３】［適用例２］これは、ロボットハンドによ
るハンドリングへの適用例であり、システム構成として
は、図３における外部装置４０としてハンド（開閉装
置）を配したものを使用する。各図において、ロボット
のアーム先端ＡＭの装着されたハンドＨの把持部が符号
Ｈ1 ，Ｈ2 で表わされている。ハンドＨの把持部Ｈ1 ，
Ｈ2 は、ホストＣＰＵ１０からの指令に従って閉成／開
成動作を行なう（左右方向矢印参照）。

【００７４】ハンドリング対象ワークＷは、ワークテー
ブルＴＢ上に固定的に位置決めされている。ハンドＨに
よるワークＷのハンドリングは、把持部Ｈ1 ，Ｈ2 の閉
成動作によってワークＷの突起部ＰＲを挟むことで達成
されるものとする。このケースで把持を確実に行なう為
には、突起部ＰＲを把持部Ｈ1 ，Ｈ2 で挟む時のロボッ
トの姿勢が特に重要である。なお、符号Ｈ0 は、ハンド
Ｈの軸線上に設定されたツール先端点を表わしている。

【００７５】本願発明の適用にあたっては、ロボットを
図１０（１）に示した初期位置からワークＷに接近さ
せ、図１０（２）の状態とする。この状態へのロボット
移動は、適用例１の場合と同じく、粗い位置教示後の再
生運転によって行なっても良い。また、ジョグ送りによ
っても良く、両者を組み合わせても構わない。

【００７６】図１０（２）の状態では、ツール先端点Ｈ
0 は位置Ｐ0 にあるものとする。この位置（姿勢を含
む。以下、同様）Ｐ0 は、適用例１の場合と同じく、図
１０（１）に符号Ｑ0 で示した最適の教示位置とは少量
ずれていることが通常である。

【００７７】次いで、動作プログラムあるいは教示操作
盤２０からの入力により、ソフトフローティングサーボ
制御の開始指令をホストＣＰＵ１０から発し、ソフトフ
ローティングサーボ制御を開始させる。更に、溶接ガン
Ｇ1 ，Ｇ2 の閉成指令によって溶接ガンＧ1 ，Ｇ2 の閉
成動作を開始する。やがて、把持部Ｈ1 ，Ｈ2 は図１０
（３）に示したように、ワークＷに接触してハンドＨを
介してロボットに力を及ぼす状態となる。

【００７８】ロボットは、ソフトフローティングサーボ
制御が行なわれている為に、この反力に抗しきれずに、
矢印ＡＲ２で示した向きに移動を開始する。

【００７９】この移動は、把持部Ｈ1 ，Ｈ2 の閉成動作
が進み、図１０（４）の状態（閉成完了）まで続行され
る。図１０（４）の状態においては、ロボットの位置
（特に、姿勢）が図１０（２）の状態から修正され、最
適な位置Ｑ0 により近いロボット位置が実現されている
ものと考えられる。

【００８０】そこで、この図１０（４）の状態で、位置
教示を実行すれば高精度の位置教示が実現される。適用
例１の場合と同じく、粗い位置教示によって位置Ｐ0 の
位置データが不揮発性メモリ１３に書き込み済みである
場合には、その位置データが書き直される。また、初め
ての位置教示の場合（位置Ｐ0 への移動はジョグ送り）
であれば、図１０（４）の状態における現在位置データ
に基づいて、新規に位置データが不揮発性メモリ１３の
位置データ書込領域に書き込まれる。位置教示が完了し
たら、把持部Ｈ1 ，Ｈ2 を開成し、ロボットを退避させ
た上でソフトフローティングサーボ制御を解除する。

【００８１】［適用例３］これは、ロボットハンドによ
るローディングへの適用例であり、システム構成として
は、図３における外部装置４０としてハンド（開閉装
置）並びにチャック（開閉装置）を配したものを使用す
る。図１１（１）〜（４）において、符号ＣＨ1 〜ＣＨ
4 で表わされたチャッキング部材を有するチャックＣＨ
（全体描図は省略）は、例えば工作機械のワーク保持部
に使用されてるものである。これらのチャッキング部材
ＣＨ1 〜ＣＨ4 は、ホストＣＰＵ１０からの指令に従っ
て拡張／収縮方向に閉成／開成動作を行なう（各矢印参
照）。

【００８２】ロボットのハンドＨからチャックＣＨにロ
ーディングされるワークＷは、ロボットのアームＡＭに
装着されたハンドＨの把持部Ｈ1 ，Ｈ2 によって把持さ
れているものとする。そして、ワークＷのローディング
は、ロボット移動によってワークＷをチャッキング部材
ＣＨ1 〜ＣＨ4 で取り囲まれた空間領域に搬送し、チャ
ッキング部材ＣＨ1 〜ＣＨ4 の閉成動作によってワーク
Ｗの四個の側面を挟むことで達成されるものとする。

【００８３】このケースでローディングを支障なく行な
う為には、ワークＷの四辺側面をチャッキング部材ＣＨ
1 〜ＣＨ4 で挟む時のロボットの姿勢が特に重要であ
る。なお、符号Ｈ0 は、ハンドＨの軸線上に設定された
ツール先端点を表わしている。また、符号ＣＨ0 はロー
ディングの為に最適と考えられる教示点を表わしたもの
である。

【００８４】本願発明の適用にあたっては、ロボットを
図１１（１）に示した初期位置からチャックＣＨに接近
させ、図１１（２）の状態とする。なお、図１１（２）
〜図１１（４）においては、ワークＷの位置とチャッキ
ング部材ＣＨ1 〜ＣＨ4 の状態のみを抽出して図１１
（１）の矢印Ｃの方向から見た平面図で描示した。この
状態へのロボット移動には、適用例１，２の場合と同じ
く、粗い位置教示後の再生運転あるいはジョグ送りが適
宜利用される。

【００８５】図１１（２）の状態では、ツール先端点Ｈ
0 は位置Ｐ0 にあるものとする。この位置Ｐ0 は、最適
の教示位置ＣＨ0 とは少量ずれている。次いで、動作プ
ログラムあるいは教示操作盤２０からの入力により、ソ
フトフローティングサーボ制御の開始指令をホストＣＰ
Ｕ１０から発し、ソフトフローティングサーボ制御を開
始させる。更に、チャックＣＨに対する閉成指令によっ
てチャッキング部材ＣＨ1 〜ＣＨ4 の閉成動作を開始す
る。やがて、チャッキング部材ＣＨ1 〜ＣＨ4の内の一
部または全部は図１１（３）に示したように、ワークＷ
に接触してワークＷ、ハンドＨを介してロボットに力を
及ぼす状態となる。

【００８６】ロボットは、ソフトフローティングサーボ
制御が行なわれている為に、この反力に抗しきれずに、
矢印ＡＲ３で示した向きに移動を開始する。

【００８７】この移動は、チャッキング部材ＣＨ1 〜Ｃ
Ｈ4 の閉成動作が進み、図１１（４）の状態（閉成完
了）まで続行される。図１１（４）の状態においては、
ロボットの位置（特に、姿勢）が図１１（２）の状態か
ら修正され、最適な位置ＣＨ0により近いロボット位置
が実現されている。

【００８８】そこで、この図１１（４）の状態で、位置
教示を実行すれば高精度の位置教示が実現される。適用
例１，２の場合と同じく、粗い位置教示によって位置Ｐ
0 の位置データが不揮発性メモリ１３に書き込み済みで
ある場合には、その位置データが書き直される。また、
初めての位置教示の場合（位置Ｐ0 への移動はジョグ送
り）であれば、図１１（４）の状態における現在位置デ
ータに基づいて、新規に位置データが不揮発性メモリ１
３の位置データ書込領域に書き込まれる。位置教示が完
了したら、チャッキング部材ＣＨ1 〜ＣＨ4 を開成し、
ロボットを退避させた上でソフトフローティングサーボ
制御を解除する。

【００８９】以上３つの適用例について説明したが、本
願発明はこれらの適用例に限定されれれうものではな
い。即ち、最適の教示位置からずれた位置にロボットが
存在する時に該位置ずれを修正する方向に作用する外力
をロボットに加え得る環境にある教示位置について教示
を行なうケースであれば、上記各事例で説明した考え方
を状況に応じて適用し、本願発明を実施することが可能
である。

【００９０】なお、本願発明を実施する際にソフトフロ
ーティングサーボ制御を実行する軸は、ロボットの全軸
とすることも出来るが、必ずしもそうする必要はない。
即ち、ロボットが不必要な運動方向について「柔らか
く」ならない為に、ソフトフローティングサーボ制御を
実行する軸を限定することも可能である。ソフトフロー
ティングサーボ制御を実行する軸の選択にあたっては、
使用されるロボットの軸構成、アプリケーションのタイ
プ、特に、最適の教示位置からずれた位置にロボットが
存在する時に受ける反力の作用方向がを考慮される。例
えば、上記各適用例１〜３においては、矢印ＡＲ１〜Ａ
Ｒ３で示した方向へのロボットの移動を許容する柔らか
さがロボットに要求される。従って、少なくともこのよ
うな移動に対応した運動自由度に関連した軸について
は、ソフトフローティングサーボ制御を行なうことが必
要である。

【００９１】

【発明の効果】以上説明したように、本願発明によれ
ば、スポット溶接、ハンドリング、ローディング等のよ
うに、最適の教示位置からずれた位置にロボットが存在
する時に該位置ずれを修正する方向に作用する外力がロ
ボットに加わり得る環境が与えらたアプリケーションに
ついて、位置教示作業の作業負担を軽減し、短時間で高
精度の位置教示を行なうことが出来る。

【００９２】また、ソフトフローティングサーボ制御時
のソフトフローティング機能のバネ定数がロボット姿勢
に影響されないようにした方式を採用すれば、ロボット
姿勢によって変動しない柔らかさをもったソフトフロー
ティングサーボ制御の下で、位置教示を行なうことが出
来る。

【図面の簡単な説明】

【図１】本願発明のソフトウェアによるソフトフローテ
ィングサーボ制御方法を実施するサーボ制御系のブロッ
ク図である。

【図２】従来のサーボ制御系のブロック図である。

【図３】本願発明の実施例で使用されるロボットコント
ローラＲＣを関連機器と共に要部ブロック図で示したも
のである。

【図４】本願発明の実施例における位置・速度ループ処
理の概要を記したフローチャートである。

【図５】ロボットとして、２軸により構成される一例を
想定した場合の構成を説明する図である。

【図６】図５による説明を補助する為の平面図である。

【図７】ロボットとして、３軸により構成される一例を
想定した場合の構成を説明する図である。

【図８】図７による説明を補助する為の平面図である。

【図９】（１）〜（４）は本願発明の方法の第１の適用
例（スポット溶接）を説明する状態推移図である。

【図１０】（１）〜（４）は本願発明の方法の第２の適
用例（ハンドリング）を説明する状態推移図である。

【図１１】（１）〜（４）は本願発明の方法の第３の適
用例（ローディング）を説明する状態推移図である。

【符号の説明】

１ 位置ループのボジションゲインの項 ２ 速度ループゲインの項 ３，４ モータの伝達関数の項 ５ モータ速度からモータ位置を求める伝達関数 １０ ホストＣＰＵ １１ ＲＯＭ １２ ＲＡＭ １３ 不揮発性メモリ １４ 入出力装置 １５ インターフェイス １６ 共有ＲＡＭ １７ ディジタルサーボ回路 １８ 帰還レジスタ １９ バスライン ２０ 教示操作盤 ３０ ロボット ４０ 外部装置 ＡＭ ロボットアーム（先端部） ＡＲ１，ＡＲ２ 反力によるロボット移動方向 ＣＨ チャック ＣＨ0 ，Ｑ0 最適の教示位置 ＣＨ1 〜ＣＨ4 チャッキング部材 Ｇ1 ，Ｇ2 溶接ガン（先端部） Ｈ ハンド Ｈ0 ，Ｗ0 ツール先端点 Ｈ1 ，Ｈ2 ハンド先端部 Ｊ イナーシャ ＫＢ キーボード Ｋｐ ポジションゲイン Ｋｖ 速度ループゲイン Ｋｔ トルク定数 ＬＣＤ 液晶ディスプレイ ＰＲ 突起部 Ｐ0 粗い精度で教示された教示点 ＲＣ ロボットコントローラ ＴＢ ワークテーブル Ｗ1 ，Ｗ2 板状部材 Ｗ ワーク

───────────────────────────────────────────────────── フロントページの続き (51)Int.Cl.⁷ 識別記号 ＦＩ Ｇ０５Ｄ 3/12 ３０６ Ｇ０５Ｄ 3/12 ３０６Ｚ (56)参考文献 特開 昭61−264406（ＪＰ，Ａ) 特開 昭62−4584（ＪＰ，Ａ) 特開 平２−58107（ＪＰ，Ａ) 特開 平４−40506（ＪＰ，Ａ) 特開 平３−218502（ＪＰ，Ａ)

Claims (4)

(57)【特許請求の範囲】
1. 【請求項１】 位置制御ループ及び速度制御ループを備
   える制御系で制御されるサーボモータで各軸を駆動され
   るロボットに対し、最適の教示位置からずれた位置にロ
   ボットが存在する時に該位置ずれを修正する方向に作用
   する外力をロボットに加え得る環境にある教示位置につ
   いて教示を行なう方法であって、 前記ロボットをプログラム再生運転を含む動作により前
   記最適の教示位置の近傍にロボットを移動させ、前記最
   適な教示位置からの位置ずれを修正する方向に作用する
   外力を前記ロボットに加える段階と、 前記外力に従って前記ロボットが移動するように前記ロ
   ボットを制御する段階と、 前記ロボットの移動後に現在位置データに基づいて前記
   教示位置データを修正する段階を含み、 前記外力に従った前記ロボットの移動が、ソフトフロー
   ティングサーボによる制御によって行なわれ、 その際にソフトフローティング機能のバネ定数が予め設
   定された値と一致するように制御されることを特徴とす
   る、 ロボットの位置教示方法。
2. 【請求項２】 位置制御ループ及び速度制御ループを備
   える制御系で制御されるサーボモータで各軸を駆動され
   るロボットに対し、最適の教示位置からずれた位置にロ
   ボットが存在する時に該位置ずれを修正する方向に作用
   する外力をロボットに加え得る環境にある教示位置につ
   いて教示を行なう際に用いられるロボット制御装置であ
   って、 前記ロボットをプログラム再生運転を含む動作により前
   記最適の教示位置の近傍にロボットを移動させるための
   制御を行なう手段と、 前記最適な教示位置からの位置ずれを修正する方向に作
   用する外力に従って前記ロボットを移動させるための制
   御を行なう手段と、 前記ロボットの移動後に現在位置データに基づいて前記
   教示位置データを修正する手段を備え、 前記外力に従った前記ロボットの移動をソフトフローテ
   ィングサーボによる制御によって行われ、 その際にソフトフローティング機能のバネ定数が予め設
   定された値と一致するように制御する手段を備えること
   を特徴とする、 ロボット制御装置。
3. 【請求項３】 位置制御ループ及び速度制御ループを備
   える制御系で制御されるサーボモータで各軸を駆動され
   るロボットに対し、最適の教示位置からずれた位置にロ
   ボットが存在する時に該位置ずれを修正する方向に作用
   する外力をロボットに加え得る環境にある教示位置につ
   いて教示を行なう方法であって、 前記ロボットをジョグ送り操作により前記最適の教示位
   置の近傍にロボットを移動させ、前記最適な教示位置か
   らの位置ずれを修正する方向に作用する外力を前記ロボ
   ットに加える段階と、 前記外力に従って前記ロボットが移動するように前記ロ
   ボットを制御する段階と、 前記ロボットの移動後に現在位置データに基づいて前記
   教示位置データを教示する段階を含み、 前記外力に従った前記ロボットの移動が、ソフトフロー
   ティングサーボによる制御によって行なわれ、 その際にソフトフローティング機能のバネ定数が予め設
   定された値と一致するように制御されることを特徴とす
   る、 ロボットの位置教示方法。
4. 【請求項４】 位置制御ループ及び速度制御ループを備
   える制御系で制御されるサーボモータで各軸を駆動され
   るロボットに対し、最適の教示位置からずれた位置にロ
   ボットが存在する時に該位置ずれを修正する方向に作用
   する外力をロボットに加え得る環境にある教示位置につ
   いて教示を行なう際に用いられるロボット制御装置であ
   って、 前記ロボットをジョグ送り操作により前記最適の教示位
   置の近傍に移動させるための制御を行なう手段と、 前記最適な教示位置からの位置ずれを修正する方向に作
   用する外力に応じて前記ロボットを移動させるための制
   御を行なう手段と、 前記ロボットの移動後に現在位置データに基づいて前記
   教示位置データを修正する手段を備え、 前記外力に従った前記ロボットの移動をソフトフローテ
   ィングサーボによる制御によって行われ、その際にソフトフローティング機能のバネ定数が予め設
   定された値と一致するように制御する手段を備えること
   を特徴とする、 ロボット制御装置。