JPH0736519A - ロボットのニアミスチェック方法 - Google Patents
ロボットのニアミスチェック方法Info
- Publication number
- JPH0736519A JPH0736519A JP18266593A JP18266593A JPH0736519A JP H0736519 A JPH0736519 A JP H0736519A JP 18266593 A JP18266593 A JP 18266593A JP 18266593 A JP18266593 A JP 18266593A JP H0736519 A JPH0736519 A JP H0736519A
- Authority
- JP
- Japan
- Prior art keywords
- robot
- model
- data
- check
- distance
- 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
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
(57)【要約】
【目的】 簡単な計算機を用いてニアミスチェックの演
算を高速に行うことのできるロボットのニアミスチェッ
ク方法。 【構成】 本方法は,ロボット1及びロボット1の可動
範囲内にある物体2の移動データD1,D2と,ロボッ
ト1及び物体2間のニアミス回避用の安全距離Lとの関
係Xを予め設定しておき,ロボット1と物体2とをそれ
ぞれ包絡したモデルM1,M2を作成し,移動データD
1,D2を入力し,入力された移動データD1,D2か
ら上記関係Xを用いて求められた安全距離Lだけロボッ
ト1及び/又は物体2のモデルの寸法を拡大し,拡大さ
れたモデルM1′,M2′の寸法にて干渉チェックを行
うことによりニアミスチェックを行うように構成されて
いる。上記構成により,簡単な計算機を用いてニアミス
チェックの演算を高速に行うことができる。
算を高速に行うことのできるロボットのニアミスチェッ
ク方法。 【構成】 本方法は,ロボット1及びロボット1の可動
範囲内にある物体2の移動データD1,D2と,ロボッ
ト1及び物体2間のニアミス回避用の安全距離Lとの関
係Xを予め設定しておき,ロボット1と物体2とをそれ
ぞれ包絡したモデルM1,M2を作成し,移動データD
1,D2を入力し,入力された移動データD1,D2か
ら上記関係Xを用いて求められた安全距離Lだけロボッ
ト1及び/又は物体2のモデルの寸法を拡大し,拡大さ
れたモデルM1′,M2′の寸法にて干渉チェックを行
うことによりニアミスチェックを行うように構成されて
いる。上記構成により,簡単な計算機を用いてニアミス
チェックの演算を高速に行うことができる。
Description
【0001】
【産業上の利用分野】本発明はロボットのニアミスチェ
ック方法に係り,例えばロボットのオフラインプログラ
ミングシステム又はCADシステム等において使用され
る3次元モデル間のニアミスチェック方法に関するもの
である。
ック方法に係り,例えばロボットのオフラインプログラ
ミングシステム又はCADシステム等において使用され
る3次元モデル間のニアミスチェック方法に関するもの
である。
【0002】
【従来の技術】ロボットの動作を教示(プログラミン
グ)するためには,通常,教示操作盤などを操作,ある
いはロボットを人間が直接持って動かすことにより,ロ
ボットを実際に移動させて,必要なポイントの位置座標
等を教示記録してロボット制御データ(教示データ)を
作成する。しかし,実際にロボットを動かして教示デー
タを作成する上記方法では,ロボットの実作業を止めな
ければならず,また,操作も面倒なため,コンピュータ
を用いたオフラインプログラミング操作による方法が用
いられることがある。このオフラインプログラミング操
作による方法はロボット言語とよばれるロボットの動作
を記述するプログラミング言語で記述したり,ロボット
などの3次元モデルをグラフィック表示画面上で操作し
ながら現実の実機ロボットに対する操作に類似の操作を
行って教示データを作成・記録することによって行われ
る。ところで,オフラインプログラミングにおいては,
実際にロボットを作動させて教示データを作ったもので
はないため,この教示データを用いて動作シミュレーシ
ョンを行ってロボットの動作を確認する必要がある。こ
の動作シミュレーションで,ロボットとワークあるいは
周辺機器等との干渉をチェックすることを干渉チェック
と呼ぶが,この確認作業を,ロボットやワークをグラフ
ィックディスプレイ画面上に描画表示し,教示データに
基づいてロボットの絵を時系列的に描画し,目視によっ
て行うのは面倒である。そのため,ロボットやワークの
3次元数学モデルを用いて,前述の時系列的描画ととも
に,数学的にロボットとワークなどのモデル間に干渉が
ないかどうかを演算させることが広く行われている。こ
のような干渉検出演算は,モデルが複雑になってくると
非常に時間がかかるため,計算の高速化のために各種工
夫がなされている。尚,ロボットの動作確認では,ロボ
ットとワーク間での干渉検出だけでなく,ロボットがワ
ーク等に制限値を越えて接近し過ぎた場合も警告の意味
で検出することが要求されることがある。この近接チェ
ックをニアミスチェックと呼ぶ。従来ニアミスチェック
は,前述のロボットモデルとワーク等のモデルとの間の
最短距離を計算し,設定された制限値より小さいかどう
かを判定することによって行われていた。
グ)するためには,通常,教示操作盤などを操作,ある
いはロボットを人間が直接持って動かすことにより,ロ
ボットを実際に移動させて,必要なポイントの位置座標
等を教示記録してロボット制御データ(教示データ)を
作成する。しかし,実際にロボットを動かして教示デー
タを作成する上記方法では,ロボットの実作業を止めな
ければならず,また,操作も面倒なため,コンピュータ
を用いたオフラインプログラミング操作による方法が用
いられることがある。このオフラインプログラミング操
作による方法はロボット言語とよばれるロボットの動作
を記述するプログラミング言語で記述したり,ロボット
などの3次元モデルをグラフィック表示画面上で操作し
ながら現実の実機ロボットに対する操作に類似の操作を
行って教示データを作成・記録することによって行われ
る。ところで,オフラインプログラミングにおいては,
実際にロボットを作動させて教示データを作ったもので
はないため,この教示データを用いて動作シミュレーシ
ョンを行ってロボットの動作を確認する必要がある。こ
の動作シミュレーションで,ロボットとワークあるいは
周辺機器等との干渉をチェックすることを干渉チェック
と呼ぶが,この確認作業を,ロボットやワークをグラフ
ィックディスプレイ画面上に描画表示し,教示データに
基づいてロボットの絵を時系列的に描画し,目視によっ
て行うのは面倒である。そのため,ロボットやワークの
3次元数学モデルを用いて,前述の時系列的描画ととも
に,数学的にロボットとワークなどのモデル間に干渉が
ないかどうかを演算させることが広く行われている。こ
のような干渉検出演算は,モデルが複雑になってくると
非常に時間がかかるため,計算の高速化のために各種工
夫がなされている。尚,ロボットの動作確認では,ロボ
ットとワーク間での干渉検出だけでなく,ロボットがワ
ーク等に制限値を越えて接近し過ぎた場合も警告の意味
で検出することが要求されることがある。この近接チェ
ックをニアミスチェックと呼ぶ。従来ニアミスチェック
は,前述のロボットモデルとワーク等のモデルとの間の
最短距離を計算し,設定された制限値より小さいかどう
かを判定することによって行われていた。
【0003】
【発明が解決しようとする課題】上記したような従来の
ロボットのニアミスチェック方法では,ロボットモデル
とワーク等のモデルとの間の最短距離を逐一計算しなけ
ればならないため,干渉チェックの時以上の時間がかか
ってしまう。ところが,実際に教示データによるロボッ
ト動作を,シミュレーションによって確認する際には,
干渉はしていないが,その危険性がある場合の検出が重
要である。特に,ロボットの高速動作時のブレなどの現
実的な誤差要因を考えると,厳密な干渉チェックだけで
は不十分であり,上記ニアミスチェック機能は必須であ
ると考えられる。したがって,このニアミスチェックの
演算を高速に行う必要があり,このために従来は高速な
演算速度を持つエンジニアリングワークステーション等
を用いる必要があった。本発明は,このような従来の技
術における課題を解決するために,ロボットのニアミス
チェック方法を改良し,簡易な計算機を用いてニアミス
チェックの演算を高速に行うことができるロボットのニ
アミスチェック方法を提供することを目的とするもので
ある。
ロボットのニアミスチェック方法では,ロボットモデル
とワーク等のモデルとの間の最短距離を逐一計算しなけ
ればならないため,干渉チェックの時以上の時間がかか
ってしまう。ところが,実際に教示データによるロボッ
ト動作を,シミュレーションによって確認する際には,
干渉はしていないが,その危険性がある場合の検出が重
要である。特に,ロボットの高速動作時のブレなどの現
実的な誤差要因を考えると,厳密な干渉チェックだけで
は不十分であり,上記ニアミスチェック機能は必須であ
ると考えられる。したがって,このニアミスチェックの
演算を高速に行う必要があり,このために従来は高速な
演算速度を持つエンジニアリングワークステーション等
を用いる必要があった。本発明は,このような従来の技
術における課題を解決するために,ロボットのニアミス
チェック方法を改良し,簡易な計算機を用いてニアミス
チェックの演算を高速に行うことができるロボットのニ
アミスチェック方法を提供することを目的とするもので
ある。
【0004】
【課題を解決するための手段】上記目的を達成するため
に本発明は,ロボット及び該ロボットの可動範囲内にあ
る物体の移動データと,ロボット及び物体間のニアミス
回避用の安全距離との関係を予め設定しておき,上記ロ
ボットと物体とをそれぞれ包絡したモデルを作成し,上
記移動データを入力し,上記入力された移動データから
上記関係を用いて求められた安全距離だけ上記ロボット
及び/又は物体のモデルの寸法を拡大し,上記拡大され
たモデルの寸法にて干渉チェックを行うことによりニア
ミスチェックを行うロボットのニアミスチェック方法と
して構成されている。更には,上記モデルの寸法を,該
モデルを構成する面データ単位で拡大するロボットのニ
アミスチェック方法である。更には,上記モデルの寸法
を,該モデルを構成する点データ単位で拡大するロボッ
トのニアミスチェック方法である。上記移動データに
は,ロボット及び物体の軌跡だけでなく移動速度や加減
速パターンなどが含まれる。更に,ロボットの軌跡に
は,手先を揺動させたり,センサ情報によって軌跡が変
わったりする等の作業パターン,動作パターンも含まれ
る。
に本発明は,ロボット及び該ロボットの可動範囲内にあ
る物体の移動データと,ロボット及び物体間のニアミス
回避用の安全距離との関係を予め設定しておき,上記ロ
ボットと物体とをそれぞれ包絡したモデルを作成し,上
記移動データを入力し,上記入力された移動データから
上記関係を用いて求められた安全距離だけ上記ロボット
及び/又は物体のモデルの寸法を拡大し,上記拡大され
たモデルの寸法にて干渉チェックを行うことによりニア
ミスチェックを行うロボットのニアミスチェック方法と
して構成されている。更には,上記モデルの寸法を,該
モデルを構成する面データ単位で拡大するロボットのニ
アミスチェック方法である。更には,上記モデルの寸法
を,該モデルを構成する点データ単位で拡大するロボッ
トのニアミスチェック方法である。上記移動データに
は,ロボット及び物体の軌跡だけでなく移動速度や加減
速パターンなどが含まれる。更に,ロボットの軌跡に
は,手先を揺動させたり,センサ情報によって軌跡が変
わったりする等の作業パターン,動作パターンも含まれ
る。
【0005】
【作用】本発明によれば,ニアミスチェックに先立って
ロボット及び該ロボットの可動範囲内にある物体の移動
データと,ロボット及び物体間のニアミスチェック回避
用の安全距離との関係が予め設定されている。そして,
上記ロボットと物体とをそれぞれ包絡したモデルが作成
される。チェックに当って,まず上記移動データが入力
される。上記入力された移動データから上記関係を用い
て求められた安全距離だけ上記ロボット及び/又は物体
のモデルの寸法が拡大される。上記拡大されたモデルの
寸法にて干渉チェックが行われることによりニアミスチ
ェックが行われる。このように,ロボットモデルと物体
のモデルとの間の最短距離を逐一計算することなく,干
渉チェックのみを行うことによりニアミスチェックを行
うことができる。更に,上記モデルの寸法が,該モデル
を構成する面データ単位で拡大される。更に,上記モデ
ルの寸法が,該モデルを構成する点データ単位で拡大さ
れる。このように,モデルの寸法の拡大を面データ単位
又は点データ単位で行えば,全寸法を一律に拡大する場
合に比べてニアミスチェックの確度を高めることができ
る。その結果,簡単な計算機を用いてニアミスチェック
の演算を高速に行うことのできるロボットのニアミスチ
ェック方法を得ることができる。
ロボット及び該ロボットの可動範囲内にある物体の移動
データと,ロボット及び物体間のニアミスチェック回避
用の安全距離との関係が予め設定されている。そして,
上記ロボットと物体とをそれぞれ包絡したモデルが作成
される。チェックに当って,まず上記移動データが入力
される。上記入力された移動データから上記関係を用い
て求められた安全距離だけ上記ロボット及び/又は物体
のモデルの寸法が拡大される。上記拡大されたモデルの
寸法にて干渉チェックが行われることによりニアミスチ
ェックが行われる。このように,ロボットモデルと物体
のモデルとの間の最短距離を逐一計算することなく,干
渉チェックのみを行うことによりニアミスチェックを行
うことができる。更に,上記モデルの寸法が,該モデル
を構成する面データ単位で拡大される。更に,上記モデ
ルの寸法が,該モデルを構成する点データ単位で拡大さ
れる。このように,モデルの寸法の拡大を面データ単位
又は点データ単位で行えば,全寸法を一律に拡大する場
合に比べてニアミスチェックの確度を高めることができ
る。その結果,簡単な計算機を用いてニアミスチェック
の演算を高速に行うことのできるロボットのニアミスチ
ェック方法を得ることができる。
【0006】
【実施例】以下添付図面を参照して,本発明を具体化し
た実施例につき説明し,本発明の理解に供する。尚,以
下の実施例は本発明を具体化した一例であって,本発明
の技術的範囲を限定する性格のものではない。ここに,
図1は本発明の一実施例に係るロボットのニアミスチェ
ック方法による概略動作手順を示す図,図2はロボット
動作シミュレーション装置Aの概略構成図,図3はロボ
ットモデルの表示例を示す図,図4はモデルの面データ
単位の拡大例を示す図,図5はモデルの点データ単位の
拡大例を示す図である。図1に示すごとく,本実施例に
係るロボットのニアミスチェック方法は,ロボット1及
び物体2の移動データD1,D2と,ロボット1及び物
体2間のニアミス回避の安全距離Lとの関係Xを予め設
定しておき(S1),ロボット1と物体2との包絡モデ
ルM1,M2を作成し(S2),移動データD1,D2
を入力し(S3),入力された移動データD1,D2か
ら関係Xを用いて求められた安全距離LだけモデルM
1,M2の寸法を拡大し(S4),寸法拡大されたモデ
ルM1′,M2′間にて干渉チェックを行うことにより
ニアミスチェックを行う(S5)ように構成されてい
る。図2は,このようなニアミスチェック方法を具現化
する為のロボットシミュレーション装置Aの一例を示す
ものである。図2に示すごとくこの装置Aは主としてロ
ボット1の作業対象となる物体2の3次元モデルを入力
するデータ入力装置3(キーボード,マウス,フロッピ
ーディスク等)と,ロボット1の教示シミュレーション
を行う演算処理装置4(パーソナルコンピュータ等)
と,シミュレーション中で用いる種々のデータを記憶す
るローカルメモリ(不図示)を用い,ロボット1の図形
と物体2の図形とのニアミスの判別を行うニアミスチェ
ック用のプロセッサ5と,その判別結果を表示しオペレ
ータにニアミスが起こっているかどうかを知らせるシミ
ュレーション表示装置9(グラフィックディスプレイ
等)とから構成されている。
た実施例につき説明し,本発明の理解に供する。尚,以
下の実施例は本発明を具体化した一例であって,本発明
の技術的範囲を限定する性格のものではない。ここに,
図1は本発明の一実施例に係るロボットのニアミスチェ
ック方法による概略動作手順を示す図,図2はロボット
動作シミュレーション装置Aの概略構成図,図3はロボ
ットモデルの表示例を示す図,図4はモデルの面データ
単位の拡大例を示す図,図5はモデルの点データ単位の
拡大例を示す図である。図1に示すごとく,本実施例に
係るロボットのニアミスチェック方法は,ロボット1及
び物体2の移動データD1,D2と,ロボット1及び物
体2間のニアミス回避の安全距離Lとの関係Xを予め設
定しておき(S1),ロボット1と物体2との包絡モデ
ルM1,M2を作成し(S2),移動データD1,D2
を入力し(S3),入力された移動データD1,D2か
ら関係Xを用いて求められた安全距離LだけモデルM
1,M2の寸法を拡大し(S4),寸法拡大されたモデ
ルM1′,M2′間にて干渉チェックを行うことにより
ニアミスチェックを行う(S5)ように構成されてい
る。図2は,このようなニアミスチェック方法を具現化
する為のロボットシミュレーション装置Aの一例を示す
ものである。図2に示すごとくこの装置Aは主としてロ
ボット1の作業対象となる物体2の3次元モデルを入力
するデータ入力装置3(キーボード,マウス,フロッピ
ーディスク等)と,ロボット1の教示シミュレーション
を行う演算処理装置4(パーソナルコンピュータ等)
と,シミュレーション中で用いる種々のデータを記憶す
るローカルメモリ(不図示)を用い,ロボット1の図形
と物体2の図形とのニアミスの判別を行うニアミスチェ
ック用のプロセッサ5と,その判別結果を表示しオペレ
ータにニアミスが起こっているかどうかを知らせるシミ
ュレーション表示装置9(グラフィックディスプレイ
等)とから構成されている。
【0007】この装置Aの概略動作手順は以下の通りで
ある。まず,オペレータが3次元データ入力装置3によ
って物体2の図形データやロボット1のエンドエフェク
タの先端位置及び各教示点での作業命令行動などの教示
データを入力する。演算処理装置4ではその動作教示部
6及び動作シミュレーション部7においてプロセッサ5
と通信できるようになっている。プロセッサ5によりニ
アミスがあると判定された場合には,演算処理装置4か
らの指示によって教示データが変更され,シミュレーシ
ョン表示装置9により画面処理や音声処理が行われる。
そして作成された教示データは演算処理装置4のデータ
転送部8でフォーマット変換された後,ロボット制御盤
(不図示)に転送される。この装置Aのプロセッサ5に
て,図1に示すような一連の動作(ステップS1〜S
5)が実行される。図3はシミュレーション表示装置9
の例えばグラフィックディスプレイ画面上に教示される
ロボット1のモデル例を示すものである。図3(a)は
ロボット1を包絡したモデルの例であり,(b)はこの
ニアミスチェック用に作成した簡単モデルであり,
(c)はニアミスチェック簡単モデルを更に安全距離L
分だけ拡大したものである。この場合の拡大は,モデル
の各面の法線方向になされているものを示す。ここで,
ロボット1及び物体2の移動データD1,D2と安全距
離Lとの関係Xについて概略説明する。既述の如く,ロ
ボットの動作確認では,ロボット1と物体2との間の衝
突の検出だけでなく,ロボット1が物体2に制限値を越
えて接近しすぎた場合も警告の意味で検出することが要
求される。この制限値は,常に一定の値ではなく,ロボ
ット1及び物体2の軌跡,移動速度等の移動データD
1,D2により変化するものである。例えば,ロボット
1の軌跡が半径Rの曲率を持ったものであり,静止した
物体2(この場合の移動データD2はゼロデータとな
る)の近傍をロボット1が速度Vで通過する時,ロボッ
ト1にはV2 /Rに比例する遠心力が働き,この遠心力
によりロボット1がブレて物体2に接近することがあ
る。このロボットのブレの他,物体2の据え付け誤差な
ども安全距離Lに加味する必要がある。このような移動
データD1,D2と安全距離Lとの関係Xは予め解析又
はシミュレーションにより求めておくことができ,この
関係Xをプロセッサ5のローカルメモリに記憶させてお
くことができる。次に,移動データD1,D2を入力す
るが,移動データD1,D2は装置Aの動作教示部6及
び動作シミュレーション部7で使用されるデータに含ま
れているので,このデータを用いればよい。そして,入
力された移動データD1,D2に対する安全距離Lをロ
ーカルメモリに記憶しておいた関係Xを用いて求めるこ
とができる。この安全距離Lを用いてモデルM1,M2
の寸法を拡大するのである。
ある。まず,オペレータが3次元データ入力装置3によ
って物体2の図形データやロボット1のエンドエフェク
タの先端位置及び各教示点での作業命令行動などの教示
データを入力する。演算処理装置4ではその動作教示部
6及び動作シミュレーション部7においてプロセッサ5
と通信できるようになっている。プロセッサ5によりニ
アミスがあると判定された場合には,演算処理装置4か
らの指示によって教示データが変更され,シミュレーシ
ョン表示装置9により画面処理や音声処理が行われる。
そして作成された教示データは演算処理装置4のデータ
転送部8でフォーマット変換された後,ロボット制御盤
(不図示)に転送される。この装置Aのプロセッサ5に
て,図1に示すような一連の動作(ステップS1〜S
5)が実行される。図3はシミュレーション表示装置9
の例えばグラフィックディスプレイ画面上に教示される
ロボット1のモデル例を示すものである。図3(a)は
ロボット1を包絡したモデルの例であり,(b)はこの
ニアミスチェック用に作成した簡単モデルであり,
(c)はニアミスチェック簡単モデルを更に安全距離L
分だけ拡大したものである。この場合の拡大は,モデル
の各面の法線方向になされているものを示す。ここで,
ロボット1及び物体2の移動データD1,D2と安全距
離Lとの関係Xについて概略説明する。既述の如く,ロ
ボットの動作確認では,ロボット1と物体2との間の衝
突の検出だけでなく,ロボット1が物体2に制限値を越
えて接近しすぎた場合も警告の意味で検出することが要
求される。この制限値は,常に一定の値ではなく,ロボ
ット1及び物体2の軌跡,移動速度等の移動データD
1,D2により変化するものである。例えば,ロボット
1の軌跡が半径Rの曲率を持ったものであり,静止した
物体2(この場合の移動データD2はゼロデータとな
る)の近傍をロボット1が速度Vで通過する時,ロボッ
ト1にはV2 /Rに比例する遠心力が働き,この遠心力
によりロボット1がブレて物体2に接近することがあ
る。このロボットのブレの他,物体2の据え付け誤差な
ども安全距離Lに加味する必要がある。このような移動
データD1,D2と安全距離Lとの関係Xは予め解析又
はシミュレーションにより求めておくことができ,この
関係Xをプロセッサ5のローカルメモリに記憶させてお
くことができる。次に,移動データD1,D2を入力す
るが,移動データD1,D2は装置Aの動作教示部6及
び動作シミュレーション部7で使用されるデータに含ま
れているので,このデータを用いればよい。そして,入
力された移動データD1,D2に対する安全距離Lをロ
ーカルメモリに記憶しておいた関係Xを用いて求めるこ
とができる。この安全距離Lを用いてモデルM1,M2
の寸法を拡大するのである。
【0008】ここで,モデルM1,M2の拡大の方向に
ついて説明する。ただし,モデルM1,M2は図4
(a)中ではそれぞれ直方体b,aで表現されている。
図4(a)において,直方体aは面A1,A2,〜,A
5について,面の法線ベクトルVA1〜VA5の方向に
外側に向かって安全距離Lだけ移動させることによって
拡大(面移動計算)を行う。尚,面A6については,例
えば物体2の加工面であるとすると干渉チェックないし
ニアミスチェックを行う必要がないため,ここでは拡大
を行わない。この拡大を実現するために,モデルの面を
表すデータに法線ベクトルと拡大操作の可否を関連づけ
て格納しておくことにより,先の拡大演算を高速化する
ことができる。このような例を図4に(b)に示す。拡
大のための情報としては,面の向き(どちらが物体の
外側か)を表すフラグ(または法線ベクトル),拡大
時に面と平行な方向に拡大するかどうかを表すフラグな
どがある。図5(a)は,同じくモデルの拡大の例を示
すものであるが,この場合は面を移動するのではなく,
各頂点を必要な方向に移動させることによって拡大(点
移動計算)するものである。この拡大を実現するため
に,モデルの頂点を表すデータに拡大操作を行う際の拡
大の方向を例えば座標軸x,y,zのそれぞれの方向に
実施するかを符号込みで格納しておくことにより,容易
に計算できる。このような例を図5(b)に示す。以上
のようにして,寸法を拡大されたモデルM1′,M2′
間にてプロセッサ5を用いて干渉チェックを行うことに
よりニアミスチェックを行う。
ついて説明する。ただし,モデルM1,M2は図4
(a)中ではそれぞれ直方体b,aで表現されている。
図4(a)において,直方体aは面A1,A2,〜,A
5について,面の法線ベクトルVA1〜VA5の方向に
外側に向かって安全距離Lだけ移動させることによって
拡大(面移動計算)を行う。尚,面A6については,例
えば物体2の加工面であるとすると干渉チェックないし
ニアミスチェックを行う必要がないため,ここでは拡大
を行わない。この拡大を実現するために,モデルの面を
表すデータに法線ベクトルと拡大操作の可否を関連づけ
て格納しておくことにより,先の拡大演算を高速化する
ことができる。このような例を図4に(b)に示す。拡
大のための情報としては,面の向き(どちらが物体の
外側か)を表すフラグ(または法線ベクトル),拡大
時に面と平行な方向に拡大するかどうかを表すフラグな
どがある。図5(a)は,同じくモデルの拡大の例を示
すものであるが,この場合は面を移動するのではなく,
各頂点を必要な方向に移動させることによって拡大(点
移動計算)するものである。この拡大を実現するため
に,モデルの頂点を表すデータに拡大操作を行う際の拡
大の方向を例えば座標軸x,y,zのそれぞれの方向に
実施するかを符号込みで格納しておくことにより,容易
に計算できる。このような例を図5(b)に示す。以上
のようにして,寸法を拡大されたモデルM1′,M2′
間にてプロセッサ5を用いて干渉チェックを行うことに
よりニアミスチェックを行う。
【0009】このようにニアミスチェックの演算を,毎
回距離の計算をすることなく,その距離分だけ拡大した
モデルに対する周知の干渉チェック計算に帰着させるこ
とによって,計算時間を短縮することができる。又,こ
の計算をする際に包絡モデルとして面の少ない簡単なモ
デル(図3(b)参照)を用いることによって更に計算
時間を短縮することができる。この場合,計算量が少な
くなるためプロセッサ5の機能を演算処理装置4に含め
て装置の簡略化を図ることができる更に,ロボット1の
例えば溶接ワイヤやワイヤドラム等の付属物についても
これらをモデルに含めることにより,より確度の高いニ
アミスチェックを行うことができる。更に,モデルを面
データ単位,点データ単位で拡大することにより,一律
に拡大する場合に比べてきめ細かくもできるので,ニア
ミスチェックの確度を一層向上させることができる。そ
の結果,簡単な計算機(例えば手軽に使えるパーソナル
コンピュータ等)を用いてニアミスチェックの演算を高
速に行うことのできるロボットのニアミスチェック方法
を得ることができる。尚,通常はニアミスチェック用モ
デル(拡大された寸法のモデル)を表示するとロボット
1のモデル(包絡モデル)と重なって見にくくなるた
め,ニアミスチェック用モデルは表示しないようにす
る。但し,必要に応じて表示できるようにしておいても
よい。尚,上記実施例では,安全距離Lを自動計算によ
り求めたが,実使用に際してはこの安全距離Lを人間が
設定しこれを直接用いてモデルM1,M2の寸法を拡大
してもよい。尚,上記実施例では,モデルM1,M2の
両方を拡大して得られた拡大モデルM1′,M2′間で
のニアミスチェックを行ったが,実使用に際してはいず
れか一方のモデルのみを拡大してもよい。又,モデルの
例えば一点又は一面だけを拡大しこれをニアミスチェッ
クに用いてもよい。
回距離の計算をすることなく,その距離分だけ拡大した
モデルに対する周知の干渉チェック計算に帰着させるこ
とによって,計算時間を短縮することができる。又,こ
の計算をする際に包絡モデルとして面の少ない簡単なモ
デル(図3(b)参照)を用いることによって更に計算
時間を短縮することができる。この場合,計算量が少な
くなるためプロセッサ5の機能を演算処理装置4に含め
て装置の簡略化を図ることができる更に,ロボット1の
例えば溶接ワイヤやワイヤドラム等の付属物についても
これらをモデルに含めることにより,より確度の高いニ
アミスチェックを行うことができる。更に,モデルを面
データ単位,点データ単位で拡大することにより,一律
に拡大する場合に比べてきめ細かくもできるので,ニア
ミスチェックの確度を一層向上させることができる。そ
の結果,簡単な計算機(例えば手軽に使えるパーソナル
コンピュータ等)を用いてニアミスチェックの演算を高
速に行うことのできるロボットのニアミスチェック方法
を得ることができる。尚,通常はニアミスチェック用モ
デル(拡大された寸法のモデル)を表示するとロボット
1のモデル(包絡モデル)と重なって見にくくなるた
め,ニアミスチェック用モデルは表示しないようにす
る。但し,必要に応じて表示できるようにしておいても
よい。尚,上記実施例では,安全距離Lを自動計算によ
り求めたが,実使用に際してはこの安全距離Lを人間が
設定しこれを直接用いてモデルM1,M2の寸法を拡大
してもよい。尚,上記実施例では,モデルM1,M2の
両方を拡大して得られた拡大モデルM1′,M2′間で
のニアミスチェックを行ったが,実使用に際してはいず
れか一方のモデルのみを拡大してもよい。又,モデルの
例えば一点又は一面だけを拡大しこれをニアミスチェッ
クに用いてもよい。
【0010】以下,本発明について考察した結果を述べ
る。 (1)ロボット及び/又は物体のモデル寸法の拡大につ
いて,両者間の距離がいくらかによって接近距離(安全
距離)を計算すると考えると,物体側あるいはロボット
側のどちらかを拡大しても距離の算定は可能である。も
ちろん,距離を按分すれば,上記実施例の如く両方同時
に拡大しても構わない。しかし,現実的にはモデルの構
成が簡単なもの,あるいはメーカ側で予め計算しておけ
るもの,部分的に計算しなくてもよい部分を設定できる
もの,簡単なモデルで代替できるもの,・・・というよ
うな判断基準でどちらか一方だけを拡大することが望ま
しい。なぜなら,両方を拡大すると計算量が減らないか
らである。従って,例えばロボットにより静止物体のみ
を扱う場合には,ロボットモデルのみを拡大することと
すれば良い。一方,ロボットだけでなく物体(ワーク)
側をも拡大する意義は,例えば次の通りである。 ワークの部分がガス切断などで加工されており,精度
が悪いような場合 特に加工精度,組立精度の悪い部位などのみを部分的に
拡大できれば,より確度の高い(きめ細かい)ニアミス
チェックが可能となると言える。 ワークの位置ずれ誤差がある場合 ワークの座標系でずれ方向を考慮しながら,部分的に拡
大することができる。以上より本発明では,ニアミスチ
ェックにロボット及び/又は物体の拡大されたモデル寸
法を用いることとした。 (2)安全距離について 安全距離の意義は例えば次の通りである。ロボットの
軌跡が変化する場合,教示データと位置指令データとが
異なる場合,および計算上の位置指令データと現実に動
く軌跡とが異なる場合 (a)ウイービング(溶接トーチの揺動運動)や,多層
盛り動作などコントローラに内蔵されている機能を使う
と,教示した位置データを越えて動作することがある。
また,ワークを固定しているポジショナなどの回転・移
動によって,ワークの位置が変化し,それに応じてロボ
ットの制御軌跡が変化することもある。
る。 (1)ロボット及び/又は物体のモデル寸法の拡大につ
いて,両者間の距離がいくらかによって接近距離(安全
距離)を計算すると考えると,物体側あるいはロボット
側のどちらかを拡大しても距離の算定は可能である。も
ちろん,距離を按分すれば,上記実施例の如く両方同時
に拡大しても構わない。しかし,現実的にはモデルの構
成が簡単なもの,あるいはメーカ側で予め計算しておけ
るもの,部分的に計算しなくてもよい部分を設定できる
もの,簡単なモデルで代替できるもの,・・・というよ
うな判断基準でどちらか一方だけを拡大することが望ま
しい。なぜなら,両方を拡大すると計算量が減らないか
らである。従って,例えばロボットにより静止物体のみ
を扱う場合には,ロボットモデルのみを拡大することと
すれば良い。一方,ロボットだけでなく物体(ワーク)
側をも拡大する意義は,例えば次の通りである。 ワークの部分がガス切断などで加工されており,精度
が悪いような場合 特に加工精度,組立精度の悪い部位などのみを部分的に
拡大できれば,より確度の高い(きめ細かい)ニアミス
チェックが可能となると言える。 ワークの位置ずれ誤差がある場合 ワークの座標系でずれ方向を考慮しながら,部分的に拡
大することができる。以上より本発明では,ニアミスチ
ェックにロボット及び/又は物体の拡大されたモデル寸
法を用いることとした。 (2)安全距離について 安全距離の意義は例えば次の通りである。ロボットの
軌跡が変化する場合,教示データと位置指令データとが
異なる場合,および計算上の位置指令データと現実に動
く軌跡とが異なる場合 (a)ウイービング(溶接トーチの揺動運動)や,多層
盛り動作などコントローラに内蔵されている機能を使う
と,教示した位置データを越えて動作することがある。
また,ワークを固定しているポジショナなどの回転・移
動によって,ワークの位置が変化し,それに応じてロボ
ットの制御軌跡が変化することもある。
【0011】ただし,(コントローラに内蔵されてい
る)これらの機能を模擬して新たな動作指令データを生
成し,その位置指令データなどに基づいて移動データを
作成するならば,この問題は回避できる。 (b)ロボット(およびワークの)ダイナミクス(動特
性)を考慮すると,慣性力などにより位置指令値と実際
のロボットの軌跡とがずれることがある。この件は,モ
デルのダイナミクスを考慮したシミュレーションをすれ
ばわかることであるが,計算時間がかかる。従って,上
記実施例で述べた如くこれを簡略化して,移動データと
安全距離との適当な関係を設定することによりこの問題
を回避できる。 ロボットやワークの位置が確定できない場合 例えば溶接線追従センサなどを用いて,いわゆるセンサ
フィードバック制御を行う場合,その場で軌跡指令デー
タを生成することになり,予め動作やニアミスのチェッ
クをすることができない。こういった部位は,適切に
(統計的に)安全距離を大きくとっておけば良い。 部位によって危険度が違う場合 部位によって危険度が異なる場合とは,ニアミスのおそ
れを特に少なくしたい重要な部品などがある場合である
が,これはその部品の周辺の安全距離を大きくとってお
けば良い。以上より本発明ではニアミスチェックに安全
距離を用いることとした。
る)これらの機能を模擬して新たな動作指令データを生
成し,その位置指令データなどに基づいて移動データを
作成するならば,この問題は回避できる。 (b)ロボット(およびワークの)ダイナミクス(動特
性)を考慮すると,慣性力などにより位置指令値と実際
のロボットの軌跡とがずれることがある。この件は,モ
デルのダイナミクスを考慮したシミュレーションをすれ
ばわかることであるが,計算時間がかかる。従って,上
記実施例で述べた如くこれを簡略化して,移動データと
安全距離との適当な関係を設定することによりこの問題
を回避できる。 ロボットやワークの位置が確定できない場合 例えば溶接線追従センサなどを用いて,いわゆるセンサ
フィードバック制御を行う場合,その場で軌跡指令デー
タを生成することになり,予め動作やニアミスのチェッ
クをすることができない。こういった部位は,適切に
(統計的に)安全距離を大きくとっておけば良い。 部位によって危険度が違う場合 部位によって危険度が異なる場合とは,ニアミスのおそ
れを特に少なくしたい重要な部品などがある場合である
が,これはその部品の周辺の安全距離を大きくとってお
けば良い。以上より本発明ではニアミスチェックに安全
距離を用いることとした。
【0012】
【発明の効果】本発明に係るロボットのニアミスチェッ
ク方法は,上記したように構成されているため,ニアミ
スチェックの演算を,毎回距離の計算をすることなく,
その距離分だけ拡大したモデルに対する周知の干渉チェ
ック計算に帰着させることによって,計算時間を短縮す
ることができる。又,この計算をする際に包絡モデルと
して面の少ない簡単なモデルを用いることによって更に
計算時間を短縮することができる。この場合,計算量が
少なくなるため例えばプロセッサの機能を演算処理装置
に含めて装置の簡素化を図ることができる更に,ロボッ
トの例えば溶接ワイヤやワイヤドラム等の付属物につい
てもこれらをモデルに含めることにより,より確度の高
いニアミスチェックを行うことができる。更に,モデル
を面データ単位,点データ単位で拡大することにより,
一律に拡大する場合に比べてきめ細かくもできるので,
ニアミスチェックの確度を一層向上させることができ
る。その結果,簡単な計算機(例えば手軽に使えるパー
ソナルコンピュータ等)を用いてニアミチェックの演算
を高速に行うことのできるロボットのニアミスチェック
方法を得ることができる。
ク方法は,上記したように構成されているため,ニアミ
スチェックの演算を,毎回距離の計算をすることなく,
その距離分だけ拡大したモデルに対する周知の干渉チェ
ック計算に帰着させることによって,計算時間を短縮す
ることができる。又,この計算をする際に包絡モデルと
して面の少ない簡単なモデルを用いることによって更に
計算時間を短縮することができる。この場合,計算量が
少なくなるため例えばプロセッサの機能を演算処理装置
に含めて装置の簡素化を図ることができる更に,ロボッ
トの例えば溶接ワイヤやワイヤドラム等の付属物につい
てもこれらをモデルに含めることにより,より確度の高
いニアミスチェックを行うことができる。更に,モデル
を面データ単位,点データ単位で拡大することにより,
一律に拡大する場合に比べてきめ細かくもできるので,
ニアミスチェックの確度を一層向上させることができ
る。その結果,簡単な計算機(例えば手軽に使えるパー
ソナルコンピュータ等)を用いてニアミチェックの演算
を高速に行うことのできるロボットのニアミスチェック
方法を得ることができる。
【図1】 本発明の一実施例に係るロボットのニアミス
チェック方法による概略動作手順を示す図。
チェック方法による概略動作手順を示す図。
【図2】 ロボット動作シミュレーション装置Aの概略
構成図。
構成図。
【図3】 ロボットモデルの表示例を示す図。
【図4】 モデルの面データ単位の拡大例を示す図。
【図5】 モデルの点データ単位の拡大例を示す図。
1…ロボット 2…物体 D1,D1′…移動データ L…安全距離 X…関係 M1,M1′…ロボットのモデル M2,M2′…物体のモデル
Claims (3)
- 【請求項1】 ロボット及び該ロボットの可動範囲内に
ある物体の移動データと,ロボット及び物体間のニアミ
ス回避用の安全距離との関係を予め設定しておき,上記
ロボットと物体とをそれぞれ包絡したモデルを作成し,
上記移動データを入力し,上記入力された移動データか
ら上記関係を用いて求められた安全距離だけ上記ロボッ
ト及び/又は物体のモデルの寸法を拡大し,上記拡大さ
れたモデルの寸法にて干渉チェックを行うことによりニ
アミスチェックを行うロボットのニアミスチェック方
法。 - 【請求項2】 上記モデルの寸法を,該モデルを構成す
る面データ単位で拡大する請求項1記載のロボットのニ
アミスチェック方法。 - 【請求項3】 上記モデルの寸法を,該モデルを構成す
る点データ単位で拡大する請求項1記載のロボットのニ
アミスチェック方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP18266593A JPH0736519A (ja) | 1993-07-23 | 1993-07-23 | ロボットのニアミスチェック方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP18266593A JPH0736519A (ja) | 1993-07-23 | 1993-07-23 | ロボットのニアミスチェック方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
JPH0736519A true JPH0736519A (ja) | 1995-02-07 |
Family
ID=16122299
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP18266593A Pending JPH0736519A (ja) | 1993-07-23 | 1993-07-23 | ロボットのニアミスチェック方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPH0736519A (ja) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002219684A (ja) * | 2001-01-24 | 2002-08-06 | Fuji Electric Co Ltd | ロボット監視システム |
JP2006043861A (ja) * | 2004-08-09 | 2006-02-16 | Honda Motor Co Ltd | マン・マシン作業システム |
JP2008015740A (ja) * | 2006-07-05 | 2008-01-24 | Mori Seiki Co Ltd | 工作機械の制御装置 |
US7664570B2 (en) | 2003-04-23 | 2010-02-16 | Toyota Jidosha Kabushiki Kaisha | Method and apparatus for limiting the movement of a robot, and a robot equipped with said apparatus |
AT518498A1 (de) * | 2016-03-29 | 2017-10-15 | Bernecker + Rainer Industrie-Elektronik Ges M B H | Positionsüberwachung einer Kinematik |
JP2018144166A (ja) * | 2017-03-03 | 2018-09-20 | 株式会社キーエンス | 画像処理装置、画像処理方法、画像処理プログラム及びコンピュータで読み取り可能な記録媒体並びに記録した機器 |
JP2021175595A (ja) * | 2017-11-09 | 2021-11-04 | キヤノン株式会社 | シミュレータ、ロボット教示装置、ロボットシステム、シミュレーション方法、プログラム及び記録媒体 |
WO2023013042A1 (ja) * | 2021-08-06 | 2023-02-09 | ファナック株式会社 | 干渉チェック装置 |
-
1993
- 1993-07-23 JP JP18266593A patent/JPH0736519A/ja active Pending
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002219684A (ja) * | 2001-01-24 | 2002-08-06 | Fuji Electric Co Ltd | ロボット監視システム |
US7664570B2 (en) | 2003-04-23 | 2010-02-16 | Toyota Jidosha Kabushiki Kaisha | Method and apparatus for limiting the movement of a robot, and a robot equipped with said apparatus |
JP2006043861A (ja) * | 2004-08-09 | 2006-02-16 | Honda Motor Co Ltd | マン・マシン作業システム |
JP2008015740A (ja) * | 2006-07-05 | 2008-01-24 | Mori Seiki Co Ltd | 工作機械の制御装置 |
AT518498A1 (de) * | 2016-03-29 | 2017-10-15 | Bernecker + Rainer Industrie-Elektronik Ges M B H | Positionsüberwachung einer Kinematik |
AT518498B1 (de) * | 2016-03-29 | 2018-09-15 | B & R Ind Automation Gmbh | Positionsüberwachung einer Kinematik |
US11279034B2 (en) | 2016-03-29 | 2022-03-22 | B&R Industrial Automation GmbH | Position monitoring of a kinematic linkage |
JP2018144166A (ja) * | 2017-03-03 | 2018-09-20 | 株式会社キーエンス | 画像処理装置、画像処理方法、画像処理プログラム及びコンピュータで読み取り可能な記録媒体並びに記録した機器 |
JP2021175595A (ja) * | 2017-11-09 | 2021-11-04 | キヤノン株式会社 | シミュレータ、ロボット教示装置、ロボットシステム、シミュレーション方法、プログラム及び記録媒体 |
WO2023013042A1 (ja) * | 2021-08-06 | 2023-02-09 | ファナック株式会社 | 干渉チェック装置 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108453702B (zh) | 机器人仿真器、机器人***以及仿真方法 | |
EP1769891B1 (en) | Offline teaching apparatus for robot | |
JP3537362B2 (ja) | ロボットシステム用グラフィック表示装置 | |
US20070242073A1 (en) | Robot simulation apparatus | |
US20180036883A1 (en) | Simulation apparatus, robot control apparatus and robot | |
US5341458A (en) | Method of and system for generating teaching data for robots | |
JP2020110885A (ja) | 経路生成装置、経路生成方法、及び経路生成プログラム | |
JPH0736519A (ja) | ロボットのニアミスチェック方法 | |
JPS60195615A (ja) | 多関節ロボツトの姿勢教示方法 | |
JP2019197333A (ja) | 経路補正方法及び多軸加工機の制御装置 | |
JP3066646B2 (ja) | 動作シミュレーションシステム | |
JPH09212225A (ja) | ロボットの教示装置 | |
JP2021175595A (ja) | シミュレータ、ロボット教示装置、ロボットシステム、シミュレーション方法、プログラム及び記録媒体 | |
US20190235473A1 (en) | Machining simulation display apparatus and machining simulation display method | |
JP2000112510A (ja) | ロボットの教示方法及びその装置 | |
JP2868343B2 (ja) | 三次元レーザ加工機のオフライン教示方法 | |
WO2023203635A1 (ja) | ロボット装置の動作状態を算出するシミュレーション装置 | |
JP2517553B2 (ja) | ロボツトのオフライン教示方法 | |
JP2919127B2 (ja) | 三次元レーザ加工機のオフライン教示方法 | |
JPH0631450A (ja) | 溶接ロボットの動作軌跡作成装置 | |
JP7448651B2 (ja) | オフライン教示装置および動作プログラム生成方法 | |
JP2581102B2 (ja) | ロボットのオフラインティーチングにおける干渉防止方法 | |
JP4124583B2 (ja) | 作業ロボットの動作経路データ作成方法および装置 | |
WO2023073755A1 (ja) | ロボットの動作判定装置、動作判定方法および動作判定プログラム | |
WO2023037456A1 (ja) | シミュレーション装置 |