JPH07195287A - 力制御ロボットの接触式位置検出装置 - Google Patents
力制御ロボットの接触式位置検出装置Info
- Publication number
- JPH07195287A JPH07195287A JP35444493A JP35444493A JPH07195287A JP H07195287 A JPH07195287 A JP H07195287A JP 35444493 A JP35444493 A JP 35444493A JP 35444493 A JP35444493 A JP 35444493A JP H07195287 A JPH07195287 A JP H07195287A
- Authority
- JP
- Japan
- Prior art keywords
- force
- contact
- force control
- distance
- speed
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Landscapes
- Manipulator (AREA)
- Control Of Position Or Direction (AREA)
- Finish Polishing, Edge Sharpening, And Grinding By Specific Grinding Devices (AREA)
Abstract
(57)【要約】
【目的】 力制御ロボットの接触式位置検出装置で安価
な非接触式距離センサで高速、安全に研削工具を対象物
に接触し、位置を検出する。 【構成】 研削工具7に加わる力を検出する力検出手段
5,22と、研削工具7の位置を検出する位置検出手段21,2
7 と、研削工具の位置と力を制御する制御手段8,25を備
える研削ロボットで、研削工具を力制御モードで移動
し、研削工具が対象物に接触した時の位置データを実際
の位置として取り出す。研削工具と対象物の間の距離を
測定する非接触式距離センサ12と、研削工具の力制御モ
ードでの移動で、距離センサで得られた距離に基づき距
離区間における初期の高速度移動区間と対象物直前の低
速度移動区間を含む速度パターンを生成する演算処理手
段40とを備える。
な非接触式距離センサで高速、安全に研削工具を対象物
に接触し、位置を検出する。 【構成】 研削工具7に加わる力を検出する力検出手段
5,22と、研削工具7の位置を検出する位置検出手段21,2
7 と、研削工具の位置と力を制御する制御手段8,25を備
える研削ロボットで、研削工具を力制御モードで移動
し、研削工具が対象物に接触した時の位置データを実際
の位置として取り出す。研削工具と対象物の間の距離を
測定する非接触式距離センサ12と、研削工具の力制御モ
ードでの移動で、距離センサで得られた距離に基づき距
離区間における初期の高速度移動区間と対象物直前の低
速度移動区間を含む速度パターンを生成する演算処理手
段40とを備える。
Description
【0001】
【産業上の利用分野】本発明は力制御ロボットの接触式
位置検出装置に関し、特に、研削ロボットのごとき多自
由度力制御ロボットにおいてアーム先部をワークに接触
させることによりワークの実際の設置位置を正確に検出
する接触式位置検出装置に関するものである。
位置検出装置に関し、特に、研削ロボットのごとき多自
由度力制御ロボットにおいてアーム先部をワークに接触
させることによりワークの実際の設置位置を正確に検出
する接触式位置検出装置に関するものである。
【0002】
【従来の技術】一般的な多自由度の力制御ロボットで、
そのアーム先部(手先効果器)が作業対象物に接近し当
該作業対象物に対し研削等の特定作業を行う場合、作業
対象物との間の距離関係を考慮した当該ロボットにおけ
る動作の制御は、従来、例えばロボットの周辺部に非接
触センサを設け、この非接触センサによってアーム先部
と作業対象物の距離を検出し、その検出情報に基づいて
アーム先部の軌道を制御する制御方式が知られている
(特開昭60−108285号公報)。この制御方式で
は、非接触式センサによってアーム先部と作業対象物の
距離が、予め設定された一定値よりも小さくなったこと
が検出された場合に、制御モードの切換または変更の処
理を行うようにしている。
そのアーム先部(手先効果器)が作業対象物に接近し当
該作業対象物に対し研削等の特定作業を行う場合、作業
対象物との間の距離関係を考慮した当該ロボットにおけ
る動作の制御は、従来、例えばロボットの周辺部に非接
触センサを設け、この非接触センサによってアーム先部
と作業対象物の距離を検出し、その検出情報に基づいて
アーム先部の軌道を制御する制御方式が知られている
(特開昭60−108285号公報)。この制御方式で
は、非接触式センサによってアーム先部と作業対象物の
距離が、予め設定された一定値よりも小さくなったこと
が検出された場合に、制御モードの切換または変更の処
理を行うようにしている。
【0003】また従来の装置として、上記の非接触式セ
ンサに加えて、接触式センサである力センサをアームの
手首部に設け、ハイブリッド状態で制御方式を実現した
ものもある。このハイブリッド型制御方式のロボットで
は、例えば軸状ワークを他の固定ワークに組み付ける場
合、大きな衝撃の発生や低速移動の問題を避けるため、
組付け直前の所定位置までは非接触センサを利用して位
置制御モードで高速に移動して軸状ワークを搬送し、所
定位置を検出した後は位置制御モードのままで低速移動
に移り、軸状ワークと固定ワークの接触を力センサで検
出して組付け作業を実行していた。
ンサに加えて、接触式センサである力センサをアームの
手首部に設け、ハイブリッド状態で制御方式を実現した
ものもある。このハイブリッド型制御方式のロボットで
は、例えば軸状ワークを他の固定ワークに組み付ける場
合、大きな衝撃の発生や低速移動の問題を避けるため、
組付け直前の所定位置までは非接触センサを利用して位
置制御モードで高速に移動して軸状ワークを搬送し、所
定位置を検出した後は位置制御モードのままで低速移動
に移り、軸状ワークと固定ワークの接触を力センサで検
出して組付け作業を実行していた。
【0004】他の従来装置の構成として、さらに、第7
回日本ロボット学会学術講演会予稿集(平成元年11月
2〜4日)の第189頁〜第192頁に記載されるよう
に、力センサと非接触型の渦電流式センサを備え、位置
制御モードでの搬送移動中に非接触式距離センサがワー
クまでの距離を測定し、その接近する距離情報に基づい
て適宜なタイミングで位置制御モードから力制御モード
に切換え、ワークとの接触時にはコンプライアンス制御
を行うように構成されたロボットがある。
回日本ロボット学会学術講演会予稿集(平成元年11月
2〜4日)の第189頁〜第192頁に記載されるよう
に、力センサと非接触型の渦電流式センサを備え、位置
制御モードでの搬送移動中に非接触式距離センサがワー
クまでの距離を測定し、その接近する距離情報に基づい
て適宜なタイミングで位置制御モードから力制御モード
に切換え、ワークとの接触時にはコンプライアンス制御
を行うように構成されたロボットがある。
【0005】
【発明が解決しようとする課題】非接触式距離センサを
利用してワークとの距離または位置関係を検出しながら
所定区間の間ロボットのアーム先部の研削工具等を高速
に移動するようにした従来のロボットでは、実際的な問
題として、ロボットの制御手段は高速移動の制御を行い
ながら距離センサで得られた距離情報を取込み、この距
離情報を利用して再び高速移動の制御のための指令を生
成するので、距離センサの測定能力(距離検出とデータ
処理)の限界を無視することができなかった。すなわ
ち、従来装置では、高速移動時における距離センサの測
定能力の限界について十分に配慮されていないため、高
速移動中に非接触式の距離センサによってワークに至る
までの距離を正確に測定することができない場合があっ
た。このような場合には、アーム先部に取り付けた研削
工具が高速でワークに衝突し、研削工具およびワークが
共に破損するという問題が起きた。
利用してワークとの距離または位置関係を検出しながら
所定区間の間ロボットのアーム先部の研削工具等を高速
に移動するようにした従来のロボットでは、実際的な問
題として、ロボットの制御手段は高速移動の制御を行い
ながら距離センサで得られた距離情報を取込み、この距
離情報を利用して再び高速移動の制御のための指令を生
成するので、距離センサの測定能力(距離検出とデータ
処理)の限界を無視することができなかった。すなわ
ち、従来装置では、高速移動時における距離センサの測
定能力の限界について十分に配慮されていないため、高
速移動中に非接触式の距離センサによってワークに至る
までの距離を正確に測定することができない場合があっ
た。このような場合には、アーム先部に取り付けた研削
工具が高速でワークに衝突し、研削工具およびワークが
共に破損するという問題が起きた。
【0006】上記問題を解決する1つの方法としては、
距離データの取込み時間およびデータ処理時間が短い距
離センサを使用すればよい。しかしこの場合には、非接
触式の距離センサの使用コストが高くなるという問題を
提起する。
距離データの取込み時間およびデータ処理時間が短い距
離センサを使用すればよい。しかしこの場合には、非接
触式の距離センサの使用コストが高くなるという問題を
提起する。
【0007】本発明の目的は、安価な非接触式距離セン
サを利用して高速にかつ安全に手先効果器を被検知対象
物に接触し、その位置を検出することのできる力制御ロ
ボットの接触式位置検出装置を提供することにある。
サを利用して高速にかつ安全に手先効果器を被検知対象
物に接触し、その位置を検出することのできる力制御ロ
ボットの接触式位置検出装置を提供することにある。
【0008】
【課題を解決するための手段】本発明に係る力制御ロボ
ットの接触式位置検出装置は次のように構成される。
ットの接触式位置検出装置は次のように構成される。
【0009】例えば研削工具等の手先効果器に加わる力
を検出する力検出手段と、手先効果器の位置を検出する
ための位置検出手段と、力検出手段で得られる力データ
と位置検出手段で得られる位置データを入力し、各デー
タを用いて制御演算式に基づき制御指令のデータを作成
し、手先効果器の位置と力を制御する制御手段を備える
例えば研削ロボット等の力制御ロボットであり、制御手
段を力制御モードに設定し、力制御モードでの手先効果
器の移動速度を力目標値、位置目標値、仮想粘性係数、
仮想バネ定数に基づき算出し、手先効果器を力制御モー
ドで移動させると共に、手先効果器が対象物に接触した
時、位置検出手段で検出した位置データを対象物の位置
として取り出す前記力制御ロボットにおいて適用される
接触式位置検出装置において、手先効果器の近くに設け
られ、手先効果器と対象物の間の距離を測定するための
非接触式距離センサと、手先効果器が対象物の近くにお
いて対象物に接触すべく当該対象物に向かって力制御モ
ードで移動するとき、距離センサによる測定で得られた
距離に基づいて当該距離区間における初期の高速度移動
区間と対象物直前の低速度移動区間を含む速度パターン
を生成する演算処理手段とを備え、制御手段の移動指令
に基づき手先効果器は速度パターンに従って力制御モー
ドによって移動するように構成される。
を検出する力検出手段と、手先効果器の位置を検出する
ための位置検出手段と、力検出手段で得られる力データ
と位置検出手段で得られる位置データを入力し、各デー
タを用いて制御演算式に基づき制御指令のデータを作成
し、手先効果器の位置と力を制御する制御手段を備える
例えば研削ロボット等の力制御ロボットであり、制御手
段を力制御モードに設定し、力制御モードでの手先効果
器の移動速度を力目標値、位置目標値、仮想粘性係数、
仮想バネ定数に基づき算出し、手先効果器を力制御モー
ドで移動させると共に、手先効果器が対象物に接触した
時、位置検出手段で検出した位置データを対象物の位置
として取り出す前記力制御ロボットにおいて適用される
接触式位置検出装置において、手先効果器の近くに設け
られ、手先効果器と対象物の間の距離を測定するための
非接触式距離センサと、手先効果器が対象物の近くにお
いて対象物に接触すべく当該対象物に向かって力制御モ
ードで移動するとき、距離センサによる測定で得られた
距離に基づいて当該距離区間における初期の高速度移動
区間と対象物直前の低速度移動区間を含む速度パターン
を生成する演算処理手段とを備え、制御手段の移動指令
に基づき手先効果器は速度パターンに従って力制御モー
ドによって移動するように構成される。
【0010】前記低速度移動区間の距離は、手先効果器
の慣性による行過ぎ量と距離センサの測定誤差のうち少
なくとも一方を考慮して設定される。低速度移動区間が
最初に設定されることが好ましい。
の慣性による行過ぎ量と距離センサの測定誤差のうち少
なくとも一方を考慮して設定される。低速度移動区間が
最初に設定されることが好ましい。
【0011】また移動初期の高速度移動区間の距離は、
距離センサで測定された距離と低速度移動区間の距離と
の差として設定される。
距離センサで測定された距離と低速度移動区間の距離と
の差として設定される。
【0012】前記の構成において、好ましくは、演算処
理手段は、高速度移動区間と低速度移動区間における速
度切換え時間を各区間の距離データを基に算出する時間
演算手段と、各区間の移動速度を算出する速度演算手段
と、速度データを制御手段内の制御用係数に変換する変
換手段と、係数を記憶する記憶手段と、係数をサンプリ
ングタイム毎に制御手段に入力する入力手段とを含むよ
うに構成される。
理手段は、高速度移動区間と低速度移動区間における速
度切換え時間を各区間の距離データを基に算出する時間
演算手段と、各区間の移動速度を算出する速度演算手段
と、速度データを制御手段内の制御用係数に変換する変
換手段と、係数を記憶する記憶手段と、係数をサンプリ
ングタイム毎に制御手段に入力する入力手段とを含むよ
うに構成される。
【0013】前記の構成において、さらに、手先効果器
の先部で対象物に接触し、設定された押付け力を力検出
手段が検出した時に、位置検出手段で検出される位置デ
ータを対象物の位置であると判定する判断手段を備え
る。上記押付け力を、研削作業時の押付け力に設定する
と、研削作業時における研削工具のたわみ分を含んで対
象物の位置を検出することができるので、精度が向上す
る。
の先部で対象物に接触し、設定された押付け力を力検出
手段が検出した時に、位置検出手段で検出される位置デ
ータを対象物の位置であると判定する判断手段を備え
る。上記押付け力を、研削作業時の押付け力に設定する
と、研削作業時における研削工具のたわみ分を含んで対
象物の位置を検出することができるので、精度が向上す
る。
【0014】前記の各構成において、距離センサによる
距離の測定、および力制御モードでの移動のための設定
は、ロボット本体の動作を停止させて行うことが好まし
い。
距離の測定、および力制御モードでの移動のための設定
は、ロボット本体の動作を停止させて行うことが好まし
い。
【0015】
【作用】本発明では、例えばティーチングプレイバック
方式でかつ位置と力の制御が実行される制御手段の制御
の下で動作する研削ロボットにおいて本来の研削作業の
開始前に、例えば研削工具を研削対象物に向かって移動
させ接触式で研削対象物の実際の設置位置を検出すると
き、研削対象物の設置誤差に約数ミリを付加した直前の
位置まで研削工具を位置制御モードで移動させ、そこで
停止する。そしてその位置で、非接触式の距離センサを
用いて研削工具から研削対象物までの距離を測定し、こ
の測定距離に基づいて、その後の力制御モードによる研
削工具の移動に関し速度パターンを作成する。速度パタ
ーンは、初期の高速度移動区間と接触直前の低速度移動
区間を含むもので、低速度移動区間を優先的に決定し
て、全体の速度パターンを作成する。研削対象物に接触
する前の段階で、かかる速度パターンを作成し、この速
度パターンに従ってかつ力制御モードで移動することに
よって、光学式変位計等の安価な非接触式距離センサを
利用して、衝突を生じることなく高速にかつ安全に研削
工具を研削対象物に接触させ、その実際の設置位置を正
確に検出できる。
方式でかつ位置と力の制御が実行される制御手段の制御
の下で動作する研削ロボットにおいて本来の研削作業の
開始前に、例えば研削工具を研削対象物に向かって移動
させ接触式で研削対象物の実際の設置位置を検出すると
き、研削対象物の設置誤差に約数ミリを付加した直前の
位置まで研削工具を位置制御モードで移動させ、そこで
停止する。そしてその位置で、非接触式の距離センサを
用いて研削工具から研削対象物までの距離を測定し、こ
の測定距離に基づいて、その後の力制御モードによる研
削工具の移動に関し速度パターンを作成する。速度パタ
ーンは、初期の高速度移動区間と接触直前の低速度移動
区間を含むもので、低速度移動区間を優先的に決定し
て、全体の速度パターンを作成する。研削対象物に接触
する前の段階で、かかる速度パターンを作成し、この速
度パターンに従ってかつ力制御モードで移動することに
よって、光学式変位計等の安価な非接触式距離センサを
利用して、衝突を生じることなく高速にかつ安全に研削
工具を研削対象物に接触させ、その実際の設置位置を正
確に検出できる。
【0016】
【実施例】以下に、本発明の実施例を添付図面に基づい
て説明する。
て説明する。
【0017】図1は、力制御ロボットの一例である研削
ロボットのシステム構成を示す。ここで力制御ロボット
は、制御部が位置と力の制御を行い、この制御に従って
力を伴う作業をワークに対して行うロボットを意味す
る。またこの研削ロボットは、ティーチングプレイバッ
ク方式で構成される。図1で、1はロボット本体であ
り、複数の関節部を含むアーム2を備え、基台3の上に
取り付けられる。各関節部にはモータ等の駆動装置が設
けられ、各関節部は決められた範囲内で可動する機能を
有する。アーム2の各関節部の可動機能により、アーム
を含むロボット本体1の全体の姿勢は作業上必要な姿勢
に変化し、アーム2の先部は作業上必要とされる位置に
移動する。アーム2のリスト(手首)部4には6軸の力
センサ5が取り付けられる。力センサ5の先側部分に
は、ワーク6に対し研削作業を行う研削工具7が取り付
けられる。研削工具7は、例えばグラインダである。
ロボットのシステム構成を示す。ここで力制御ロボット
は、制御部が位置と力の制御を行い、この制御に従って
力を伴う作業をワークに対して行うロボットを意味す
る。またこの研削ロボットは、ティーチングプレイバッ
ク方式で構成される。図1で、1はロボット本体であ
り、複数の関節部を含むアーム2を備え、基台3の上に
取り付けられる。各関節部にはモータ等の駆動装置が設
けられ、各関節部は決められた範囲内で可動する機能を
有する。アーム2の各関節部の可動機能により、アーム
を含むロボット本体1の全体の姿勢は作業上必要な姿勢
に変化し、アーム2の先部は作業上必要とされる位置に
移動する。アーム2のリスト(手首)部4には6軸の力
センサ5が取り付けられる。力センサ5の先側部分に
は、ワーク6に対し研削作業を行う研削工具7が取り付
けられる。研削工具7は、例えばグラインダである。
【0018】8はコントローラであり、コントローラ8
はコンピュータで構成される。コントローラ8は、位置
と力の制御を実行するため予め定められた演算式等を計
算する制御プログラムを有し、この制御プログラム、与
えられた条件に関するパラメータ、作業開始前の教示内
容を用いて、ロボット本体1の動作を制御する。ロボッ
ト本体1の研削動作を制御するためのプログラムは、コ
ントローラ8の内部に設けられたメモリに格納されてい
る。
はコンピュータで構成される。コントローラ8は、位置
と力の制御を実行するため予め定められた演算式等を計
算する制御プログラムを有し、この制御プログラム、与
えられた条件に関するパラメータ、作業開始前の教示内
容を用いて、ロボット本体1の動作を制御する。ロボッ
ト本体1の研削動作を制御するためのプログラムは、コ
ントローラ8の内部に設けられたメモリに格納されてい
る。
【0019】コントローラ8は、信号ライン9で、ロボ
ット本体1に対して研削作業の動作を制御するための指
令を与える。またコントローラ8は、力センサ5から研
削工具7に加わる力およびモーメントに関する検出信号
(力信号)10を入力する。11は、研削ロボットのコ
ントローラ8に対し、実行すべき研削作業に関する諸条
件を付与し、そのメモリにセットするための教示用操作
器である。操作器11は、テンキーおよび各種の指令を
与えるための操作スイッチを有する。この操作器11に
よって、例えば、研削作業前における基準ワークを用い
た研削動作の教示、研削作業条件の設定等の教示が行わ
れる。本実施例では、操作器11を介して、後述するよ
うな研削対象であるワークの実際の設置位置の検出作業
が行われる。なお操作器11は、必要に応じて、研削作
業を実行させるオペレータが所持する携帯用のものとし
て構成できるし、また固定設置用のものとして構成する
こともできる。
ット本体1に対して研削作業の動作を制御するための指
令を与える。またコントローラ8は、力センサ5から研
削工具7に加わる力およびモーメントに関する検出信号
(力信号)10を入力する。11は、研削ロボットのコ
ントローラ8に対し、実行すべき研削作業に関する諸条
件を付与し、そのメモリにセットするための教示用操作
器である。操作器11は、テンキーおよび各種の指令を
与えるための操作スイッチを有する。この操作器11に
よって、例えば、研削作業前における基準ワークを用い
た研削動作の教示、研削作業条件の設定等の教示が行わ
れる。本実施例では、操作器11を介して、後述するよ
うな研削対象であるワークの実際の設置位置の検出作業
が行われる。なお操作器11は、必要に応じて、研削作
業を実行させるオペレータが所持する携帯用のものとし
て構成できるし、また固定設置用のものとして構成する
こともできる。
【0020】また12は非接触式の距離センサであり、
力センサ5の先側部分に取り付けられる。この非接触式
の距離センサ12には、安価なものが使用され、例えば
光学式変位計が使用される。距離センサ12の検出部
は、研削時に発生する火花の影響を受けにくい、研削工
具7の研削位置から離れた箇所に配置され、研削工具7
の刃先を含む領域に臨んでいる。距離センサ12によっ
て検出された、研削工具7からワーク6までの距離に関
するデータは、信号ライン13を介してコントローラ8
に送給される。距離センサ12の距離検出の原理につい
ては、前述の光学式のものの他に、例えば、磁気インピ
ーダンスの変化を利用するもの、発振周波数の変化を利
用するもの、超音波式のものなどが利用され、研削時に
発生する火花の影響を受けない離れた位置から距離を測
定することができる各種のものを用いられる。
力センサ5の先側部分に取り付けられる。この非接触式
の距離センサ12には、安価なものが使用され、例えば
光学式変位計が使用される。距離センサ12の検出部
は、研削時に発生する火花の影響を受けにくい、研削工
具7の研削位置から離れた箇所に配置され、研削工具7
の刃先を含む領域に臨んでいる。距離センサ12によっ
て検出された、研削工具7からワーク6までの距離に関
するデータは、信号ライン13を介してコントローラ8
に送給される。距離センサ12の距離検出の原理につい
ては、前述の光学式のものの他に、例えば、磁気インピ
ーダンスの変化を利用するもの、発振周波数の変化を利
用するもの、超音波式のものなどが利用され、研削時に
発生する火花の影響を受けない離れた位置から距離を測
定することができる各種のものを用いられる。
【0021】次に、図2を参照してコントローラ8で実
現される制御手段の詳細な構成について説明する。研削
作業を行うように設定されたロボット本体1に対して、
当該研削作業の内容を決定する制御内容は、コントロー
ラ8の内部のメモリに格納されたプログラムによってソ
フト的に実現される。図2は、その制御機能要素および
接続関係を示すブロック図であり、制御手段の構成を概
念的に示したものである。なお、ハード回路を利用して
制御手段を構成することができるのは勿論である。
現される制御手段の詳細な構成について説明する。研削
作業を行うように設定されたロボット本体1に対して、
当該研削作業の内容を決定する制御内容は、コントロー
ラ8の内部のメモリに格納されたプログラムによってソ
フト的に実現される。図2は、その制御機能要素および
接続関係を示すブロック図であり、制御手段の構成を概
念的に示したものである。なお、ハード回路を利用して
制御手段を構成することができるのは勿論である。
【0022】ロボット本体1の内部には、アーム2の各
関節部を動作させるための駆動モータが複数内蔵されて
おり、これらの駆動モータにはそれぞれの駆動量を計測
するための角度計21が取り付けられる。角度計21に
よって、各関節部の軸角度データが測定される。
関節部を動作させるための駆動モータが複数内蔵されて
おり、これらの駆動モータにはそれぞれの駆動量を計測
するための角度計21が取り付けられる。角度計21に
よって、各関節部の軸角度データが測定される。
【0023】基本構成である位置・力制御演算系の構成
は、次の通りである。位置・力制御演算系は仮想コンプ
ライアンス制御を実行する制御系の構成を有する。ロボ
ット本体1のアームリスト部に取り付けられた力センサ
5で検出される力信号10は、力演算部22に送られ
る。力演算部22は、入力した力信号をセンサ座標系か
らベース座標系に変換しかつ力信号から研削工具7の重
力分を差し引くことにより、重力補償を行う機能を有す
る。こうして力演算部22でワーク6と研削工具7の接
触点部分で発生する力〈f〉が算出される。ここで記号
「〈f〉」はfがベクトル量であることを意味するもの
とする。以下において、記号「〈 〉」の意味は同じで
ある。
は、次の通りである。位置・力制御演算系は仮想コンプ
ライアンス制御を実行する制御系の構成を有する。ロボ
ット本体1のアームリスト部に取り付けられた力センサ
5で検出される力信号10は、力演算部22に送られ
る。力演算部22は、入力した力信号をセンサ座標系か
らベース座標系に変換しかつ力信号から研削工具7の重
力分を差し引くことにより、重力補償を行う機能を有す
る。こうして力演算部22でワーク6と研削工具7の接
触点部分で発生する力〈f〉が算出される。ここで記号
「〈f〉」はfがベクトル量であることを意味するもの
とする。以下において、記号「〈 〉」の意味は同じで
ある。
【0024】力演算部22で得られた力〈f〉は減算器
23に入力され、この減算器23で力〈f〉と力目標値
設定部24に設定された力目標値〈fr〉との間の減算
が行われる。減算器23の出力は、力〈f′〉として位
置・力制御演算部25に送られる。上記の力目標値〈f
r〉は、一般的に研削工具7の押付け方向の力の目標値
を与えるための指令値である。また研削工具7が、非接
触状態でかつ力制御モードで制御されて移動するとき、
力目標値〈fr〉は、研削工具7をワーク6に接近させ
接触させるための速度を決定する指令値となる。
23に入力され、この減算器23で力〈f〉と力目標値
設定部24に設定された力目標値〈fr〉との間の減算
が行われる。減算器23の出力は、力〈f′〉として位
置・力制御演算部25に送られる。上記の力目標値〈f
r〉は、一般的に研削工具7の押付け方向の力の目標値
を与えるための指令値である。また研削工具7が、非接
触状態でかつ力制御モードで制御されて移動するとき、
力目標値〈fr〉は、研削工具7をワーク6に接近させ
接触させるための速度を決定する指令値となる。
【0025】また26は不感帯処理部であり、減算器2
3の出力である力〈f′〉はここで不感帯処理を施され
減算器30に送出される。位置制御モードでは、不感帯
処理部26で設定される不感帯設定領域を大きくして力
〈f′〉に関する信号の減算器30への送出を阻止し、
位置フィードバック成分のみに基づいて研削工具7の移
動制御を実行する。
3の出力である力〈f′〉はここで不感帯処理を施され
減算器30に送出される。位置制御モードでは、不感帯
処理部26で設定される不感帯設定領域を大きくして力
〈f′〉に関する信号の減算器30への送出を阻止し、
位置フィードバック成分のみに基づいて研削工具7の移
動制御を実行する。
【0026】角度計21によって検出された各軸に関す
る角度データは、位置演算部27に送られる。位置演算
部27では、入力された角度データに基づいてベース座
標系における研削工具7の位置〈x〉(姿勢データを含
む)を算出する。算出された位置〈x〉は、位置偏差演
算部28において、位置目標値設定部29で設定された
位置の目標値〈xr〉と比較され、それらの間の位置偏
差〈Δx〉が求められる。
る角度データは、位置演算部27に送られる。位置演算
部27では、入力された角度データに基づいてベース座
標系における研削工具7の位置〈x〉(姿勢データを含
む)を算出する。算出された位置〈x〉は、位置偏差演
算部28において、位置目標値設定部29で設定された
位置の目標値〈xr〉と比較され、それらの間の位置偏
差〈Δx〉が求められる。
【0027】上記のごとく、減算器23で得られた力
〈f′〉と位置偏差演算部28で得られた位置偏差〈Δ
x〉は、位置・力制御演算部25に入力される。
〈f′〉と位置偏差演算部28で得られた位置偏差〈Δ
x〉は、位置・力制御演算部25に入力される。
【0028】位置・力制御演算部25は、減算器30
と、バネ定数演算部31と、特性補償演算部32を有す
る。減算器23から出力された力〈f′〉は、減算器3
0に入力される。位置偏差演算部28から出力された位
置偏差〈Δx〉は、バネ定数演算部31に入力される。
バネ定数演算部31には仮想バネ定数行列Kが設定され
る。バネ定数演算部31は、入力された位置偏差〈Δ
x〉に対し、設定された仮想バネ定数行列Kを乗算する
ことによりK〈Δx〉を算出する。バネ定数演算部31
で算出されたK〈Δx〉は減算器30に対して出力され
る。減算器30では〈f′〉−K〈Δx〉が演算され
る。減算器30で求められた演算結果は特性補償演算部
32に与えられる。
と、バネ定数演算部31と、特性補償演算部32を有す
る。減算器23から出力された力〈f′〉は、減算器3
0に入力される。位置偏差演算部28から出力された位
置偏差〈Δx〉は、バネ定数演算部31に入力される。
バネ定数演算部31には仮想バネ定数行列Kが設定され
る。バネ定数演算部31は、入力された位置偏差〈Δ
x〉に対し、設定された仮想バネ定数行列Kを乗算する
ことによりK〈Δx〉を算出する。バネ定数演算部31
で算出されたK〈Δx〉は減算器30に対して出力され
る。減算器30では〈f′〉−K〈Δx〉が演算され
る。減算器30で求められた演算結果は特性補償演算部
32に与えられる。
【0029】特性補償演算部32にはコントローラゲイ
ンKcが設定される。特性補償演算部32に入力された
前述の演算値は、ここで制御上の特性補償を受け、それ
により速度指令値〈v〉が算出される。位置・力制御演
算部25で最終的に求められた速度指令値〈v〉は駆動
指令部33に供給され、この駆動指令部33において速
度指令値〈v〉は、ロボット本体1の各駆動モータの駆
動指令値〈θ〉(角加速度である)に変換される。得ら
れた駆動指令値〈θ〉は、ロボット本体1の各駆動モー
タに供給され、各駆動モータの動作に基づきロボット本
体1は所望の位置および姿勢で動作する。
ンKcが設定される。特性補償演算部32に入力された
前述の演算値は、ここで制御上の特性補償を受け、それ
により速度指令値〈v〉が算出される。位置・力制御演
算部25で最終的に求められた速度指令値〈v〉は駆動
指令部33に供給され、この駆動指令部33において速
度指令値〈v〉は、ロボット本体1の各駆動モータの駆
動指令値〈θ〉(角加速度である)に変換される。得ら
れた駆動指令値〈θ〉は、ロボット本体1の各駆動モー
タに供給され、各駆動モータの動作に基づきロボット本
体1は所望の位置および姿勢で動作する。
【0030】上記においてワークの実際の設置位置を接
触式にて検出する場合の動作で、研削工具7をワーク6
に向かって接近させる方向については、仮想バネ定数K
を0として位置のフィードバックをなくすようにする。
これにより、研削工具7をワーク6に接近させる方向に
ついては、位置・力制御演算部25に入力されるのは力
成分〈f′〉のみとなり、速度指令値〈v〉は力
〈f′〉に比例する関係を有し、力制御モードで研削工
具7の移動が行われる。研削工具7の移動速度は、力目
標値と粘性係数に基づいて決定される。
触式にて検出する場合の動作で、研削工具7をワーク6
に向かって接近させる方向については、仮想バネ定数K
を0として位置のフィードバックをなくすようにする。
これにより、研削工具7をワーク6に接近させる方向に
ついては、位置・力制御演算部25に入力されるのは力
成分〈f′〉のみとなり、速度指令値〈v〉は力
〈f′〉に比例する関係を有し、力制御モードで研削工
具7の移動が行われる。研削工具7の移動速度は、力目
標値と粘性係数に基づいて決定される。
【0031】前述の仮想コンプライアンス制御を実現す
る位置・力制御の基本構成に対して、さらに、本発明の
特徴部である制御定数設定部40が付設される。この制
御定数設定部40は、研削工具7がワーク6に向かって
移動しワーク6に接触する過程において、非接触式の距
離センサ12による検出情報(研削工具7の先端部から
ワーク6までの距離)に基づいて、位置制御モードでの
移動後における研削工具7のワーク接触に至るまでの速
度パターンを演算する速度演算部41と、この速度パタ
ーンを研削工具7の移動速度を決定する力目標値に変換
する速度パラメータ変換部42と、この速度パラメータ
を記憶する速度パラメータ記憶部43とで構成される。
速度パラメータ変換部42と速度パラメータ記憶部43
のそれぞれは、力目標設定部24に接続され得る状態に
構成される。
る位置・力制御の基本構成に対して、さらに、本発明の
特徴部である制御定数設定部40が付設される。この制
御定数設定部40は、研削工具7がワーク6に向かって
移動しワーク6に接触する過程において、非接触式の距
離センサ12による検出情報(研削工具7の先端部から
ワーク6までの距離)に基づいて、位置制御モードでの
移動後における研削工具7のワーク接触に至るまでの速
度パターンを演算する速度演算部41と、この速度パタ
ーンを研削工具7の移動速度を決定する力目標値に変換
する速度パラメータ変換部42と、この速度パラメータ
を記憶する速度パラメータ記憶部43とで構成される。
速度パラメータ変換部42と速度パラメータ記憶部43
のそれぞれは、力目標設定部24に接続され得る状態に
構成される。
【0032】45は接触判定部、46は位置取込み部で
ある。接触判定部45には、接続端子(1)を介した接
続関係に基づき力演算部22の出力が入力される。接触
判定部45で、入力された力の値と力目標値とが比較さ
れ、両者が等しくなったときには接触検出信号が位置取
込み部46に送られる。位置取込み部46は接触検出信
号を入力すると、このときの研削工具7の接触箇所に関
する位置データを位置演算部27から取り込む。これに
よって、ワーク6における定められた接触箇所の位置を
検出することができる。
ある。接触判定部45には、接続端子(1)を介した接
続関係に基づき力演算部22の出力が入力される。接触
判定部45で、入力された力の値と力目標値とが比較さ
れ、両者が等しくなったときには接触検出信号が位置取
込み部46に送られる。位置取込み部46は接触検出信
号を入力すると、このときの研削工具7の接触箇所に関
する位置データを位置演算部27から取り込む。これに
よって、ワーク6における定められた接触箇所の位置を
検出することができる。
【0033】次に、上記構成を有する制御手段によって
実行される研削ロボットの特徴的な動作について説明す
る。
実行される研削ロボットの特徴的な動作について説明す
る。
【0034】特徴的動作は、ティーチングプレイバック
方式の研削ロボットに対し要求される基本的動作であ
り、1つまたはそれ以上の数のワークに対してその被加
工部を研削する研削作業を実行することにおいて、研削
作業の開始前に基準ワークについて被加工部の存在箇所
に関する位置データを教示作業でコントローラ8のメモ
リに格納した状態において、実際の研削作業で実際のワ
ークが与えられたとき、その実際の設置位置を検出し、
基準ワークの設置位置とのずれを求める動作である。そ
して特徴的動作の要部は、研削工具7を実際のワーク6
の所定の箇所に接近させ、そして研削工具7の刃先を当
該所定の箇所に接触させることによって実際のワークの
設置位置を検出する部分にある。さらに詳しくは、最
初、ロボット本体1の動作を位置制御モードで制御し研
削工具7をワーク6に位置制御モードで接近移動させ、
ワーク6の近傍の所定位置で力制御モードに切換え、非
接触式の距離センサ12でその所定位置からワーク6ま
での距離を測定し、その距離情報に基づいて、研削工具
7の刃先がワーク6の所定箇所に接触するまでの速度を
特定の速度パターンとして算出し、算出した速度を力目
標値や粘性係数等の速度パラメータに変換する動作であ
る。コントローラ8は、新たに得られた速度パタメータ
によって、ロボット本体1およびアーム2の動作を力制
御モードにて制御し、この力制御モードで研削工具7に
接近移動および接触動作を行わせる。
方式の研削ロボットに対し要求される基本的動作であ
り、1つまたはそれ以上の数のワークに対してその被加
工部を研削する研削作業を実行することにおいて、研削
作業の開始前に基準ワークについて被加工部の存在箇所
に関する位置データを教示作業でコントローラ8のメモ
リに格納した状態において、実際の研削作業で実際のワ
ークが与えられたとき、その実際の設置位置を検出し、
基準ワークの設置位置とのずれを求める動作である。そ
して特徴的動作の要部は、研削工具7を実際のワーク6
の所定の箇所に接近させ、そして研削工具7の刃先を当
該所定の箇所に接触させることによって実際のワークの
設置位置を検出する部分にある。さらに詳しくは、最
初、ロボット本体1の動作を位置制御モードで制御し研
削工具7をワーク6に位置制御モードで接近移動させ、
ワーク6の近傍の所定位置で力制御モードに切換え、非
接触式の距離センサ12でその所定位置からワーク6ま
での距離を測定し、その距離情報に基づいて、研削工具
7の刃先がワーク6の所定箇所に接触するまでの速度を
特定の速度パターンとして算出し、算出した速度を力目
標値や粘性係数等の速度パラメータに変換する動作であ
る。コントローラ8は、新たに得られた速度パタメータ
によって、ロボット本体1およびアーム2の動作を力制
御モードにて制御し、この力制御モードで研削工具7に
接近移動および接触動作を行わせる。
【0035】上記の動作において、位置制御モードによ
る移動の過程と、力制御モードおよび決められた速度パ
ターンによる移動の過程との間では、研削工具7の移動
動作を一度停止することが望ましい。
る移動の過程と、力制御モードおよび決められた速度パ
ターンによる移動の過程との間では、研削工具7の移動
動作を一度停止することが望ましい。
【0036】図3は、接触の対象である実際のワークを
示す。このワーク6Aの上面に被加工部47が形成され
ており、この被加工部47を研削工具7によって研削す
る作業が行われる。まず、実際のワーク6Aの設置位置
が検出される。ワーク6Aの設置位置を検出するには、
基準面48の上の一点49に研削工具7を接触させ、点
49の位置を検出することによりワーク6Aの実際の設
置位置を決定する。なお教示作業では、基準ワークの基
準面における同一点についての位置データに基づいて基
準ワークの設置位置が定められ、当該設置位置に基づき
被加工部を研削するための位置データが教示されてい
る。しかし、実際のワークと基準ワークの各設置位置は
完全に同じとは限らないので、実際のワークの設置位置
を検出し、基準ワークの設置位置とのずれを求め、教示
された位置データを修正する必要が生じる。
示す。このワーク6Aの上面に被加工部47が形成され
ており、この被加工部47を研削工具7によって研削す
る作業が行われる。まず、実際のワーク6Aの設置位置
が検出される。ワーク6Aの設置位置を検出するには、
基準面48の上の一点49に研削工具7を接触させ、点
49の位置を検出することによりワーク6Aの実際の設
置位置を決定する。なお教示作業では、基準ワークの基
準面における同一点についての位置データに基づいて基
準ワークの設置位置が定められ、当該設置位置に基づき
被加工部を研削するための位置データが教示されてい
る。しかし、実際のワークと基準ワークの各設置位置は
完全に同じとは限らないので、実際のワークの設置位置
を検出し、基準ワークの設置位置とのずれを求め、教示
された位置データを修正する必要が生じる。
【0037】図3では、実際のワーク6Aの設置位置を
検出するために、研削工具7をワーク6Aに向けて移動
させる経路を示している。点aに至る区間Aでは、衝突
が起きない空間における移動であるので、研削工具7は
位置・力制御装置による位置制御モードで移動する。研
削工具7が点aの位置に到達すると、一度停止する。そ
こで、位置・力制御装置を位置制御モードから力制御モ
ードに切換え、非接触式距離センサ12で基準となる検
出点49までの距離を測定し、測定した距離に基づいて
作成された制御情報によって研削工具7は移動を開始す
る。研削工具7は、点aからの移動において最初は高速
移動し、その後検出点49まで低速移動するという速度
パターンに従って移動し、検出点49に力制御モードに
て接触する。ワーク6Aの設置誤差により検出点49の
位置は教示位置より変化しているが、点aにおいて非接
触式距離センサ12で点49までの距離を測定し、点b
から基準点49までの低速移動距離を一定に保つように
研削工具7を移動させるので、高速移動中において研削
工具7がワーク6Aに衝突する等の誤動作が生じること
がなく、安全かつ高速にワーク6Aに接触させることが
可能になる。
検出するために、研削工具7をワーク6Aに向けて移動
させる経路を示している。点aに至る区間Aでは、衝突
が起きない空間における移動であるので、研削工具7は
位置・力制御装置による位置制御モードで移動する。研
削工具7が点aの位置に到達すると、一度停止する。そ
こで、位置・力制御装置を位置制御モードから力制御モ
ードに切換え、非接触式距離センサ12で基準となる検
出点49までの距離を測定し、測定した距離に基づいて
作成された制御情報によって研削工具7は移動を開始す
る。研削工具7は、点aからの移動において最初は高速
移動し、その後検出点49まで低速移動するという速度
パターンに従って移動し、検出点49に力制御モードに
て接触する。ワーク6Aの設置誤差により検出点49の
位置は教示位置より変化しているが、点aにおいて非接
触式距離センサ12で点49までの距離を測定し、点b
から基準点49までの低速移動距離を一定に保つように
研削工具7を移動させるので、高速移動中において研削
工具7がワーク6Aに衝突する等の誤動作が生じること
がなく、安全かつ高速にワーク6Aに接触させることが
可能になる。
【0038】研削工具7が検出点49に接触することに
基づいてワーク6Aの実際の設置位置が検出された後、
高速の力制御モードで研削工具7はワーク6Aから離
れ、予め設定された位置に移動する。その後、ワーク6
Aの実際の設定位置に基づいて修正された教示データに
従って被加工部47を研削する作業が行われる。
基づいてワーク6Aの実際の設置位置が検出された後、
高速の力制御モードで研削工具7はワーク6Aから離
れ、予め設定された位置に移動する。その後、ワーク6
Aの実際の設定位置に基づいて修正された教示データに
従って被加工部47を研削する作業が行われる。
【0039】前述の実施例では、位置検出の対象を研削
対象物である実際のワークとしたが、位置検出の対象は
かかるワークに限定されず、他のものであってもかまわ
ない。また前述の力制御モードによる移動は、研削対象
物である実際のワークの正確な位置検出のために行われ
たが、研削作業を開始するための接近・接触移動におい
ても同様に利用することができる。
対象物である実際のワークとしたが、位置検出の対象は
かかるワークに限定されず、他のものであってもかまわ
ない。また前述の力制御モードによる移動は、研削対象
物である実際のワークの正確な位置検出のために行われ
たが、研削作業を開始するための接近・接触移動におい
ても同様に利用することができる。
【0040】次に、図4のフローチャートおよび図5の
速度パターンを参照して、前述した位置検出のための移
動に関する制御動作を詳述する。以下の説明では、非接
触式距離センサ12として安価な光学式変位計を用いる
ものとする。
速度パターンを参照して、前述した位置検出のための移
動に関する制御動作を詳述する。以下の説明では、非接
触式距離センサ12として安価な光学式変位計を用いる
ものとする。
【0041】最初の設定状態では、ロボット本体1の動
作を位置制御モードで制御し、研削工具7の先端部を位
置制御モードで点aまで高速に移動させる(ステップS
1)。このときロボット本体1の高速移動状態における
慣性による行過ぎ量と光学式変位計12の測定誤差を考
慮して、低速移動距離(XL)と低速移動速度(VL)が
速度演算部41に予め設定されている。研削工具7の先
端が点aの位置に近づくと、ロボット本体1の動作を移
動から停止に切換え、研削工具7の先端を点aで停止さ
せる(ステップS2)。
作を位置制御モードで制御し、研削工具7の先端部を位
置制御モードで点aまで高速に移動させる(ステップS
1)。このときロボット本体1の高速移動状態における
慣性による行過ぎ量と光学式変位計12の測定誤差を考
慮して、低速移動距離(XL)と低速移動速度(VL)が
速度演算部41に予め設定されている。研削工具7の先
端が点aの位置に近づくと、ロボット本体1の動作を移
動から停止に切換え、研削工具7の先端を点aで停止さ
せる(ステップS2)。
【0042】ステップS3では、ロボット本体1の動作
が停止した状態で、ワーク6Aの位置検出点49までの
距離(Xd)を光学式変位計12で測定する。次に、検
出された距離Xdに基づいて、ワーク6Aに接触するま
での全区間における移動に関して、高速移動距離XH を
算出した後、加速時間、一定速度時間、および減速時間
が算出される(ステップS4)。具体的には、距離Xd
から距離XL を差し引き、得られた量を高速移動の距離
XH とする。力制御モードにおける高速移動時の一定速
度をVH 、力制御モードにおける加速度をαA ,αD と
すると、高速移動距離XH は、次式で与えられる。ただ
し0<t<t1 を加速時間、t1 <t<t2 を一定速度
時間、t2 <t<t3 を減速時間とする。この速度に関
する条件で作られる速度パターンを図5に示す。図5に
おいて、B1は加速区間、B2は一定高速度区間、B3
は減速区間、B4は一定低速度区間である。
が停止した状態で、ワーク6Aの位置検出点49までの
距離(Xd)を光学式変位計12で測定する。次に、検
出された距離Xdに基づいて、ワーク6Aに接触するま
での全区間における移動に関して、高速移動距離XH を
算出した後、加速時間、一定速度時間、および減速時間
が算出される(ステップS4)。具体的には、距離Xd
から距離XL を差し引き、得られた量を高速移動の距離
XH とする。力制御モードにおける高速移動時の一定速
度をVH 、力制御モードにおける加速度をαA ,αD と
すると、高速移動距離XH は、次式で与えられる。ただ
し0<t<t1 を加速時間、t1 <t<t2 を一定速度
時間、t2 <t<t3 を減速時間とする。この速度に関
する条件で作られる速度パターンを図5に示す。図5に
おいて、B1は加速区間、B2は一定高速度区間、B3
は減速区間、B4は一定低速度区間である。
【0043】
【数1】 XH =1/2・αA・t1 2+VH・(t2−t1) +1/2・|αD|・(t3−t2)2 +VL(t3−t2) …(1) ここで、t1=VH/αA …(2) t3=(VH−VL)/|αD|+t2 …(3)
【0044】式(2)と式(3)を式(1)に代入し、
一定終了時間t2 を求めると、次式が得られる。
一定終了時間t2 を求めると、次式が得られる。
【0045】
【数2】 t2 ={XH+VH 2/2αA−(VH−VL)2 /2|αD| −VL(VH−VL)/|αD|}/VH …(4)
【0046】そして次のステップS5で、コントローラ
8内におけるロボット本体1に関する制御状態を、位置
制御モードから力制御モードに切り換える。すなわち、
前述したバネ定数演算部31の仮想バネ定数を0にセッ
トし、不感帯処理部26の不感帯幅を狭くする。ステッ
プS6では、ロボット本体1の動作に関し、力制御モー
ドによる移動動作が開始される。このとき、速度パラメ
ータ変換部42内で加速区間B1における力目標値Fr
が、次式のように設定される。
8内におけるロボット本体1に関する制御状態を、位置
制御モードから力制御モードに切り換える。すなわち、
前述したバネ定数演算部31の仮想バネ定数を0にセッ
トし、不感帯処理部26の不感帯幅を狭くする。ステッ
プS6では、ロボット本体1の動作に関し、力制御モー
ドによる移動動作が開始される。このとき、速度パラメ
ータ変換部42内で加速区間B1における力目標値Fr
が、次式のように設定される。
【0047】
【数3】Fr=−CV(t) …(5) (Cは特性補償演算部32で設定された速度ゲイン) V(t)=αA t …(6)
【0048】式(6)を式(5)に代入し、離散時間制
御式に変換すると、次式のようになり、力目標値Frn
が求まる。
御式に変換すると、次式のようになり、力目標値Frn
が求まる。
【0049】
【数4】 Frn =−C(Vn-1 +αA Δt) …(7) (Δtはサンプリングタイム)
【0050】ステップS7においては、サンプリングタ
イム毎に力目標値Frが力目標値設定部24に出力さ
れ、研削工具7は、ワーク6Aの基準面における検出点
49に向かって移動を行う。移動開始と同時にディジタ
ルカウンタによって経過時間を計測し、t=t1 に到達
したとき一定高速度区間B2 に切り換わり、Frn =
−CVH となるように力目標値が算出され、力目標値
設定部24に出力され設定される(ステップS8,S
9)。
イム毎に力目標値Frが力目標値設定部24に出力さ
れ、研削工具7は、ワーク6Aの基準面における検出点
49に向かって移動を行う。移動開始と同時にディジタ
ルカウンタによって経過時間を計測し、t=t1 に到達
したとき一定高速度区間B2 に切り換わり、Frn =
−CVH となるように力目標値が算出され、力目標値
設定部24に出力され設定される(ステップS8,S
9)。
【0051】次に、t=t2 で、Frn =−C(Vn-1
−αD Δt)のように力目標値が算出され、力目標値設
定部24に設定される(ステップS10,S11)。
−αD Δt)のように力目標値が算出され、力目標値設
定部24に設定される(ステップS10,S11)。
【0052】t=t3 の後は力目標値設定部24に設定
される力目標値がFrn =−CVLのように切り換わ
り、一定低速度区間B4で研削工具7は一定低速度VL
(すなわち接触速度)の移動状態でワーク6Aに向かっ
て移動する(ステップS12,S13)。
される力目標値がFrn =−CVLのように切り換わ
り、一定低速度区間B4で研削工具7は一定低速度VL
(すなわち接触速度)の移動状態でワーク6Aに向かっ
て移動する(ステップS12,S13)。
【0053】ステップS14では、力センサ5の出力信
号を監視し、力目標値と検出した力の値が等しくなった
時点で、研削工具7の先端部とワーク6Aとが接触した
ものと判定する。その判定の後、ロボット本体1および
アーム2の各関節部に設けた角度計21によってワーク
6Aの位置を検出する。この時の接触を検出するための
力目標値は、研削作業時における押付け方向の力または
それ以上の力を設定しておく。そして研削時の押付け力
と力検出値が等しいと判断された後に、ロボット本体1
等の各関節部に設けられた各角度計21によってワーク
6Aの位置を検出する(ステップS15)。
号を監視し、力目標値と検出した力の値が等しくなった
時点で、研削工具7の先端部とワーク6Aとが接触した
ものと判定する。その判定の後、ロボット本体1および
アーム2の各関節部に設けた角度計21によってワーク
6Aの位置を検出する。この時の接触を検出するための
力目標値は、研削作業時における押付け方向の力または
それ以上の力を設定しておく。そして研削時の押付け力
と力検出値が等しいと判断された後に、ロボット本体1
等の各関節部に設けられた各角度計21によってワーク
6Aの位置を検出する(ステップS15)。
【0054】ロボット本体1のアーム先部の移動におい
て、前述の加速や減速を必要としない場合もあり得る。
このような場合には、図5に示した速度パターンにおい
て加速区間B1や減速区間B3を特に設ける必要がな
い。従って、図6に示すようなフローチャートになる。
図6のフローチャートにおいて、図4に示したフローチ
ャートと同一のステップについては同一のステップ番号
を付し、その説明を省略する。図6のフローチャートの
特徴的な部分は、ロボット本体1の動作が停止している
間に、一定高速度VH の移動時間内の力目標値と一定低
速度VL の移動時間内の力目標値を計算し、速度パラメ
ータ記憶部43に記憶することである(ステップS2
1)。そしてステップS22,S23,S24によっ
て、一定高速度および一定低速度の移動が行われる。
て、前述の加速や減速を必要としない場合もあり得る。
このような場合には、図5に示した速度パターンにおい
て加速区間B1や減速区間B3を特に設ける必要がな
い。従って、図6に示すようなフローチャートになる。
図6のフローチャートにおいて、図4に示したフローチ
ャートと同一のステップについては同一のステップ番号
を付し、その説明を省略する。図6のフローチャートの
特徴的な部分は、ロボット本体1の動作が停止している
間に、一定高速度VH の移動時間内の力目標値と一定低
速度VL の移動時間内の力目標値を計算し、速度パラメ
ータ記憶部43に記憶することである(ステップS2
1)。そしてステップS22,S23,S24によっ
て、一定高速度および一定低速度の移動が行われる。
【0055】上記の実施例では、位置および力の制御に
おいて位置制御モードと力制御モードとの切換え点
(a)でロボットの動作を停止させ、検出点49までの
距離を測定するように構成したが、図3に示すワーク6
Aに対してかなり近づいた点bで再度ロボットを停止さ
せ、検出点49までの距離を光学式変位計12で測定
し、速度パターンを作成し、この速度パターンに基づく
前述の接触動作を行わせるようにすることもできる。ま
た点bで、接触後の力目標値パターンを作成することも
できる。
おいて位置制御モードと力制御モードとの切換え点
(a)でロボットの動作を停止させ、検出点49までの
距離を測定するように構成したが、図3に示すワーク6
Aに対してかなり近づいた点bで再度ロボットを停止さ
せ、検出点49までの距離を光学式変位計12で測定
し、速度パターンを作成し、この速度パターンに基づく
前述の接触動作を行わせるようにすることもできる。ま
た点bで、接触後の力目標値パターンを作成することも
できる。
【0056】上記実施例では、力目標値設定部24に制
御定数設定部40の出力を入力するようにしたが、速度
パラメータ変換部24において目標速度を仮想粘性係数
に変換し、このデータを特性補償部32に設定するよう
に構成することもできる。ただしこのときの力目標値
は、研削時の押付け力の目標値を設定する。
御定数設定部40の出力を入力するようにしたが、速度
パラメータ変換部24において目標速度を仮想粘性係数
に変換し、このデータを特性補償部32に設定するよう
に構成することもできる。ただしこのときの力目標値
は、研削時の押付け力の目標値を設定する。
【0057】
【発明の効果】以上の説明で明らかなよう本発明によれ
ば、研削ロボット等の力制御ロボットにおいて本来の作
業を行う前に研削工具等の手先効果器を実際の対象物に
接触させて実際の設置位置を検出し、検出された位置デ
ータに基づいて教示された内容を補正する場合の位置検
出作業で、力制御モードでの手先効果器の移動の動作
で、対象物に接触する前に手先効果器と対象物との距離
を光学式変位計等の接触式距離センサで検出し、当該距
離に基づいて初期の高速度移動区間と接触直前の低速度
移動区間からなる速度パターンを作成し、この速度パタ
ーンに従って移動を行うように構成したため、距離セン
サの測定誤差の影響を受けず、高速の移動を行うことが
でき、さらに衝突を避け、安全かつ確実な接触を行うこ
とができ、正確な位置検出を行うことができる。
ば、研削ロボット等の力制御ロボットにおいて本来の作
業を行う前に研削工具等の手先効果器を実際の対象物に
接触させて実際の設置位置を検出し、検出された位置デ
ータに基づいて教示された内容を補正する場合の位置検
出作業で、力制御モードでの手先効果器の移動の動作
で、対象物に接触する前に手先効果器と対象物との距離
を光学式変位計等の接触式距離センサで検出し、当該距
離に基づいて初期の高速度移動区間と接触直前の低速度
移動区間からなる速度パターンを作成し、この速度パタ
ーンに従って移動を行うように構成したため、距離セン
サの測定誤差の影響を受けず、高速の移動を行うことが
でき、さらに衝突を避け、安全かつ確実な接触を行うこ
とができ、正確な位置検出を行うことができる。
【図1】研削ロボットのシステムを示す構成図である。
【図2】コントローラに設定される制御手段の詳細な構
成を示すブロック図である。
成を示すブロック図である。
【図3】研削対象部を有する実際のワークの正面図であ
る。
る。
【図4】第1の動作例を示すフローチャートである。
【図5】速度パターンの一例を示す図である。
【図6】第2の動作例を示すフローチャートである。
1 ロボット本体 2 アーム 5 力センサ 6 ワーク 6A 研削対象である実際のワーク 7 研削工具 8 コントローラ 12 非接触式距離センサ 22 力演算部 24 力目標値設定部 25 位置・力制御演算部 26 不感帯処理部 27 位置演算部 29 位置目標値設定部 40 制御定数設定部 41 速度演算部 42 速度パラメータ変換部 43 速度パラメータ記憶部
Claims (6)
- 【請求項1】 手先効果器に加わる力を検出する力検出
手段と、前記手先効果器の位置を検出するための位置検
出手段と、前記力検出手段で得られる力データと前記位
置検出手段で得られる位置データを入力し、前記各デー
タを用いて制御演算式に基づき制御指令のデータを作成
し、前記手先効果器の位置と力を制御する制御手段を備
える力制御ロボットであり、前記制御手段を力制御モー
ドに設定し、力制御モードでの前記手先効果器の移動速
度を力目標値、位置目標値、仮想粘性係数、仮想バネ定
数に基づき算出し、前記手先効果器を力制御モードで移
動させると共に、前記手先効果器が対象物に接触した
時、前記位置検出手段で検出した位置データを前記対象
物の位置として取り出す力制御ロボットの接触式位置検
出装置において、 前記手先効果器の近くに設けられ、前記手先効果器と前
記対象物の間の距離を測定するための非接触式距離セン
サと、前記手先効果器が前記対象物の近くにおいて前記
対象物に接触すべく前記対象物に向かって前記力制御モ
ードで移動するとき、前記距離センサによる測定で得ら
れた距離に基づいて当該距離区間における初期の高速度
移動区間と対象物直前の低速度移動区間を含む速度パタ
ーンを生成する演算処理手段とを備え、前記制御手段の
移動指令に基づき前記手先効果器は前記速度パターンに
従って前記力制御モードで移動することを特徴とする力
制御ロボットの接触式位置検出装置。 - 【請求項2】 請求項1記載の力制御ロボットの接触式
位置検出装置において、前記低速度移動区間の距離は、
前記手先効果器の慣性による行過ぎ量と前記距離センサ
の測定誤差のうち少なくとも一方を考慮して設定される
ことを特徴とする力制御ロボットの接触式位置検出装
置。 - 【請求項3】 請求項2記載の力制御ロボットの接触式
位置検出装置において、前記高速度移動区間の距離は、
前記距離センサで測定された前記距離と前記低速度移動
区間の距離との差として設定されることを特徴とする力
制御ロボットの接触式位置検出装置。 - 【請求項4】 請求項1記載の力制御ロボットの接触式
位置検出装置において、前記演算処理手段は、前記高速
度移動区間と前記低速度移動区間における速度切換え時
間を前記各区間の距離データを基に算出する時間演算手
段と、前記各区間の移動速度を算出する速度演算手段
と、前記速度データを前記制御手段内の制御用係数に変
換する変換手段と、前記係数を記憶する記憶手段と、前
記係数をサンプリングタイム毎に前記制御手段に入力す
る入力手段とを含むことを特徴とする力制御ロボットの
接触式位置検出装置。 - 【請求項5】 請求項1〜4のいずれか1項に記載の力
制御ロボットの接触式位置検出装置において、前記手先
効果器の先部で前記対象物に接触し、設定された押付け
力を前記力検出手段が検出した時に、前記位置検出手段
で検出される位置データを前記対象物の位置であると判
定する判断手段を備えることを特徴とする力制御ロボッ
トの接触式位置検出装置。 - 【請求項6】 請求項1〜5のいずれか1項に記載の力
制御ロボットの接触式位置検出装置において、前記距離
センサによる前記距離の測定、および力制御モードでの
移動のための設定は、ロボット本体の動作を停止させて
行うこと特徴とする力制御ロボットの接触式位置検出装
置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP35444493A JPH07195287A (ja) | 1993-12-29 | 1993-12-29 | 力制御ロボットの接触式位置検出装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP35444493A JPH07195287A (ja) | 1993-12-29 | 1993-12-29 | 力制御ロボットの接触式位置検出装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
JPH07195287A true JPH07195287A (ja) | 1995-08-01 |
Family
ID=18437613
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP35444493A Pending JPH07195287A (ja) | 1993-12-29 | 1993-12-29 | 力制御ロボットの接触式位置検出装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPH07195287A (ja) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2011104599A (ja) * | 2009-11-12 | 2011-06-02 | Fanuc Ltd | 力センサを搭載したロボットマニピュレータを用いたロールヘム加工装置 |
JP2015085458A (ja) * | 2013-10-31 | 2015-05-07 | セイコーエプソン株式会社 | ロボット制御装置、ロボットシステム、及びロボット |
CN107498575A (zh) * | 2017-09-11 | 2017-12-22 | 澳门大学 | 一种具有力传感器的柔性微夹钳 |
CN107825431A (zh) * | 2017-10-24 | 2018-03-23 | 深圳市智能机器人研究院 | 基于智能机器人自反馈速度控制的工件去毛刺***及方法 |
CN107876904A (zh) * | 2017-12-18 | 2018-04-06 | 华北理工大学 | 对齿轮端面进行倒角打磨机械手及其打磨方法 |
-
1993
- 1993-12-29 JP JP35444493A patent/JPH07195287A/ja active Pending
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2011104599A (ja) * | 2009-11-12 | 2011-06-02 | Fanuc Ltd | 力センサを搭載したロボットマニピュレータを用いたロールヘム加工装置 |
JP2015085458A (ja) * | 2013-10-31 | 2015-05-07 | セイコーエプソン株式会社 | ロボット制御装置、ロボットシステム、及びロボット |
US10059001B2 (en) | 2013-10-31 | 2018-08-28 | Seiko Epson Corporation | Robot control device, robot system, and robot |
CN107498575A (zh) * | 2017-09-11 | 2017-12-22 | 澳门大学 | 一种具有力传感器的柔性微夹钳 |
CN107825431A (zh) * | 2017-10-24 | 2018-03-23 | 深圳市智能机器人研究院 | 基于智能机器人自反馈速度控制的工件去毛刺***及方法 |
CN107876904A (zh) * | 2017-12-18 | 2018-04-06 | 华北理工大学 | 对齿轮端面进行倒角打磨机械手及其打磨方法 |
CN107876904B (zh) * | 2017-12-18 | 2023-10-27 | 唐山师范学院 | 对齿轮端面进行倒角打磨机械手及其打磨方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5311294B2 (ja) | ロボットの接触位置検出装置 | |
CN110186553B (zh) | 振动分析装置以及振动分析方法 | |
EP2530428A1 (en) | Coordinate positioning machine using proxy module | |
CN110394817B (zh) | 使用机器人推断负载重量和重心位置的装置、方法及程序 | |
JP2787891B2 (ja) | レーザロボットの自動教示装置 | |
JP3062412B2 (ja) | 倣い測定制御方法 | |
JPH09230922A (ja) | 力制御ロボットの接触検出装置 | |
JPH07195287A (ja) | 力制御ロボットの接触式位置検出装置 | |
JP2786874B2 (ja) | 可動位置制御装置 | |
JPH07198370A (ja) | 力制御ロボットの位置検出プローブ | |
JPH09141582A (ja) | 力制御ロボットの接触位置検出装置 | |
JPH0410568B2 (ja) | ||
JP2793695B2 (ja) | 物体の認識制御方法 | |
JP2709001B2 (ja) | 力制御ロボットにおける作業対象物の位置検出装置 | |
JPH09267282A (ja) | 多関節ロボットの作業対象物位置検出装置 | |
JPS60127987A (ja) | ならい制御方法および装置 | |
JP2654206B2 (ja) | タッチアップ方法 | |
JPH0924476A (ja) | ロボット溶接ガンの打点位置ティーチング方法 | |
JPH0651268B2 (ja) | 押し圧制御式研削装置 | |
JPH08197465A (ja) | 力制御ロボットの接触検出装置 | |
JP2691591B2 (ja) | 力制御ロボットの制御方式 | |
JP3078884B2 (ja) | 倣い制御装置 | |
JPH0691528A (ja) | 研削ロボットの接触式位置検出装置 | |
JPH0929453A (ja) | ロボット溶接ガンの打点位置ティーチング方法 | |
WO2024116223A1 (ja) | ロボット制御装置 |