JPH11345018A - ロボット制御装置 - Google Patents
ロボット制御装置Info
- Publication number
- JPH11345018A JPH11345018A JP10150261A JP15026198A JPH11345018A JP H11345018 A JPH11345018 A JP H11345018A JP 10150261 A JP10150261 A JP 10150261A JP 15026198 A JP15026198 A JP 15026198A JP H11345018 A JPH11345018 A JP H11345018A
- Authority
- JP
- Japan
- Prior art keywords
- teaching
- point
- work
- section
- trajectory
- 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.)
- Withdrawn
Links
Classifications
-
- Y02P80/114—
Landscapes
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
(57)【要約】
【課題】 ロボットの作業区間における軌道の再生軌跡
精度を損なうことなく、周辺機器やワーク等との干渉も
回避しつつタクトタイムを短縮し、生産効率の向上、消
費電力の低減及び安全性の確保等を図る。 【解決手段】 コントローラ1において、演算装置10
が記憶装置11に記憶された教示データを読み出し、塗
装ガン7がこれから侵入しようとする教示点間の区間が
塗装作業をONとする区間かどうかを判断する。そし
て、塗装作業ONの区間であれば教示データに基づいて
補間式を生成して軌道を生成する。これに対し、塗装作
業OFFの区間であれば、その区間の始点に到達したと
きに教示データに基づく軌道よりも短い滑らかな曲線を
表す補間式を生成し、塗装作業OFFの区間について
は、その生成した補間式によって軌道を再生することに
する。
精度を損なうことなく、周辺機器やワーク等との干渉も
回避しつつタクトタイムを短縮し、生産効率の向上、消
費電力の低減及び安全性の確保等を図る。 【解決手段】 コントローラ1において、演算装置10
が記憶装置11に記憶された教示データを読み出し、塗
装ガン7がこれから侵入しようとする教示点間の区間が
塗装作業をONとする区間かどうかを判断する。そし
て、塗装作業ONの区間であれば教示データに基づいて
補間式を生成して軌道を生成する。これに対し、塗装作
業OFFの区間であれば、その区間の始点に到達したと
きに教示データに基づく軌道よりも短い滑らかな曲線を
表す補間式を生成し、塗装作業OFFの区間について
は、その生成した補間式によって軌道を再生することに
する。
Description
【0001】
【発明の属する技術分野】本発明は、工業用ロボットを
制御するロボット制御装置に係り、特に、動作軌道が作
業を実施する区間と実施しない区間とに区別される工業
用ロボットの制御に用いて好適なロボット制御装置に関
する。
制御するロボット制御装置に係り、特に、動作軌道が作
業を実施する区間と実施しない区間とに区別される工業
用ロボットの制御に用いて好適なロボット制御装置に関
する。
【0002】
【従来の技術】塗装ロボットやシーリングロボット、ア
ーク溶接ロボット等の工業用ロボットは、塗装等の各ロ
ボットに応じた作業を施す作業工具を移動させ、その移
動軌道上の所定位置でこれを作動させることにより作業
対象物(ワーク)に対する作業を行う。このような工業
用ロボットは、一般に、予め教示された教示データに従
った動作を再生する教示再生型のロボットによって構成
されており、制御装置が教示データに基づいて各可動部
や作業工具等を動作させるための指令信号を供給し、こ
れにより、教示された軌道を再生すると共に、その軌道
上のある区間では作業を実施し、ある区間では作業を停
止するように制御される。
ーク溶接ロボット等の工業用ロボットは、塗装等の各ロ
ボットに応じた作業を施す作業工具を移動させ、その移
動軌道上の所定位置でこれを作動させることにより作業
対象物(ワーク)に対する作業を行う。このような工業
用ロボットは、一般に、予め教示された教示データに従
った動作を再生する教示再生型のロボットによって構成
されており、制御装置が教示データに基づいて各可動部
や作業工具等を動作させるための指令信号を供給し、こ
れにより、教示された軌道を再生すると共に、その軌道
上のある区間では作業を実施し、ある区間では作業を停
止するように制御される。
【0003】従来、かかる工業用ロボットの制御におい
ては、作業工具を移動させる移動軌道上の教示点位置と
同移動軌道上での作業内容の情報とを教示データとして
与え、その教示点位置によってロボットの動作軌道(運
動形態)を規定し、作業内容の情報によって作業工具の
移動時にどのように作業を実施するかを指示することと
していた。そして、制御装置がその教示データ中の教示
点位置に基づいてロボットを動作させて作業工具を所望
の軌道に沿って移動させると共に、同制御装置或いは他
の作業制御用の制御装置が教示データ中の作業内容情報
に基づいて作業工具等の作業用機具を動作させることに
より、上述のような軌道再生と所定区間での作業実施及
び作業停止の制御を行うこととしていた。
ては、作業工具を移動させる移動軌道上の教示点位置と
同移動軌道上での作業内容の情報とを教示データとして
与え、その教示点位置によってロボットの動作軌道(運
動形態)を規定し、作業内容の情報によって作業工具の
移動時にどのように作業を実施するかを指示することと
していた。そして、制御装置がその教示データ中の教示
点位置に基づいてロボットを動作させて作業工具を所望
の軌道に沿って移動させると共に、同制御装置或いは他
の作業制御用の制御装置が教示データ中の作業内容情報
に基づいて作業工具等の作業用機具を動作させることに
より、上述のような軌道再生と所定区間での作業実施及
び作業停止の制御を行うこととしていた。
【0004】又、従来においては、作業を実施する教示
点(作業点)位置のみを教示すれば、作業を実施しない
区間については自動的にロボットの動作経路を生成する
制御装置もあった。この制御装置によれば、作業工具が
作業を実施する区間(以下、「作業区間」という。)は
教示データに従った軌道が再生され、作業を実施しない
区間(以下、「非作業区間」という。)は制御装置内で
生成された動作経路に従った軌道が再生されることにな
る。
点(作業点)位置のみを教示すれば、作業を実施しない
区間については自動的にロボットの動作経路を生成する
制御装置もあった。この制御装置によれば、作業工具が
作業を実施する区間(以下、「作業区間」という。)は
教示データに従った軌道が再生され、作業を実施しない
区間(以下、「非作業区間」という。)は制御装置内で
生成された動作経路に従った軌道が再生されることにな
る。
【0005】
【発明が解決しようとする課題】ところで、上述した教
示点位置と作業内容情報とを教示データとして与える従
来技術においては、タクトタイムを短縮しようとする場
合、教示データ中の教示点位置の方を変更して軌道再生
時間を短縮することになるが、作業品質確保のため作業
区間の軌道は変更すべきでないので、非作業区間の軌道
を再生時間が短くなるように変更することになる。しか
し、一旦教示されて各区間の移動速度や通過点等がそれ
ぞれ定まっている軌道において、非作業区間にある教示
点位置のみを不用意に変更すると、再生される作業区間
における軌道の軌跡精度が悪化し、結局作業区間の軌道
も変更されてしまい、作業品質が低下するという問題が
あった。又、このような場合には振動が発生したりする
こともあり、これに伴って作業品質が更に低下するとい
う問題もあった。
示点位置と作業内容情報とを教示データとして与える従
来技術においては、タクトタイムを短縮しようとする場
合、教示データ中の教示点位置の方を変更して軌道再生
時間を短縮することになるが、作業品質確保のため作業
区間の軌道は変更すべきでないので、非作業区間の軌道
を再生時間が短くなるように変更することになる。しか
し、一旦教示されて各区間の移動速度や通過点等がそれ
ぞれ定まっている軌道において、非作業区間にある教示
点位置のみを不用意に変更すると、再生される作業区間
における軌道の軌跡精度が悪化し、結局作業区間の軌道
も変更されてしまい、作業品質が低下するという問題が
あった。又、このような場合には振動が発生したりする
こともあり、これに伴って作業品質が更に低下するとい
う問題もあった。
【0006】一方、作業点位置のみを教示して非作業区
間のロボット動作経路を自動生成する従来技術にあって
は、ワークや周囲の環境等に応じて適宜非作業区間の軌
道を指示、修正することができない。このため、ワーク
から大きくはみ出た所へロボットが動作し、隣のロボッ
トやワーク等に衝突することがあるという問題があっ
た。
間のロボット動作経路を自動生成する従来技術にあって
は、ワークや周囲の環境等に応じて適宜非作業区間の軌
道を指示、修正することができない。このため、ワーク
から大きくはみ出た所へロボットが動作し、隣のロボッ
トやワーク等に衝突することがあるという問題があっ
た。
【0007】本発明はこのような事情に鑑みてなされた
もので、ロボットの作業区間における軌道の再生軌跡精
度を損なうことなく、周辺機器やワーク等との干渉も回
避しつつタクトタイムを短縮することを可能とし、生産
効率の向上、消費電力の低減及び安全性の確保等を図る
ことができるロボット制御装置を提供することを目的と
する。
もので、ロボットの作業区間における軌道の再生軌跡精
度を損なうことなく、周辺機器やワーク等との干渉も回
避しつつタクトタイムを短縮することを可能とし、生産
効率の向上、消費電力の低減及び安全性の確保等を図る
ことができるロボット制御装置を提供することを目的と
する。
【0008】
【課題を解決するための手段】請求項1記載の発明は、
ワークに対して作業を実施する作業手段を有するロボッ
トを制御するロボット制御装置において、前記作業手段
を移動させる軌道上の教示点と前記作業手段の前記軌道
上における作業内容とに基づき、前記軌道における前記
作業手段の非作業区間の教示点を判別する判別手段と、
前記判別手段の判別結果により、前記区間の始点及び終
点の教示点間に他の教示点があったとき、当該始点及び
終点の教示点と当該他の教示点とに基づいて当該区間に
ついての前記作業手段を移動させる軌道を新たに生成す
る軌道生成手段とを有することを特徴としている。
ワークに対して作業を実施する作業手段を有するロボッ
トを制御するロボット制御装置において、前記作業手段
を移動させる軌道上の教示点と前記作業手段の前記軌道
上における作業内容とに基づき、前記軌道における前記
作業手段の非作業区間の教示点を判別する判別手段と、
前記判別手段の判別結果により、前記区間の始点及び終
点の教示点間に他の教示点があったとき、当該始点及び
終点の教示点と当該他の教示点とに基づいて当該区間に
ついての前記作業手段を移動させる軌道を新たに生成す
る軌道生成手段とを有することを特徴としている。
【0009】請求項2記載の発明は、請求項1記載のロ
ボット制御装置において、前記軌道生成手段は、当該区
間についての前記作業手段を移動させる軌道として、当
該始点及び終点の教示点と当該他の教示点とに従った当
初の軌道より短い軌道を生成することを特徴としてい
る。
ボット制御装置において、前記軌道生成手段は、当該区
間についての前記作業手段を移動させる軌道として、当
該始点及び終点の教示点と当該他の教示点とに従った当
初の軌道より短い軌道を生成することを特徴としてい
る。
【0010】
【発明の実施の形態】<構成> 1.全体構成 以下に、図面を参照して本発明の実施の形態について説
明する。初めに、本実施形態の全体的な構成を説明し、
併せてその基本的な動作について概説する。図1は、本
発明の一実施形態によるロボット制御装置を適用した塗
装ロボットシステム全体の外観構成を示す図である。
明する。初めに、本実施形態の全体的な構成を説明し、
併せてその基本的な動作について概説する。図1は、本
発明の一実施形態によるロボット制御装置を適用した塗
装ロボットシステム全体の外観構成を示す図である。
【0011】この図において、1はコントローラであ
り、入力装置2からケーブル3を介して各種指示データ
を受け、ケーブル4を介してマニピュレータ5の各可動
部に対する動作指令信号を供給すると共に、マニピュレ
ータ5との間で各種信号の授受を行い、これによりマニ
ピュレータ5の状態を監視しつつ、その動作を制御す
る。このコントローラ1は、教示プログラム、各種制御
パラメータ等を記憶する記憶部と、それらプログラム等
と前記指示データ及びマニピュレータ5から受けた信号
等とに基づいて各種制御演算処理を行う演算処理部とを
有しており、該演算処理部における演算処理の結果に基
づいてマニピュレータ5の動作を決定し、前記動作指令
信号を生成する。
り、入力装置2からケーブル3を介して各種指示データ
を受け、ケーブル4を介してマニピュレータ5の各可動
部に対する動作指令信号を供給すると共に、マニピュレ
ータ5との間で各種信号の授受を行い、これによりマニ
ピュレータ5の状態を監視しつつ、その動作を制御す
る。このコントローラ1は、教示プログラム、各種制御
パラメータ等を記憶する記憶部と、それらプログラム等
と前記指示データ及びマニピュレータ5から受けた信号
等とに基づいて各種制御演算処理を行う演算処理部とを
有しており、該演算処理部における演算処理の結果に基
づいてマニピュレータ5の動作を決定し、前記動作指令
信号を生成する。
【0012】又、コントローラ1は、色替えバルブ6、
塗装ガン7及び図示せぬ塗料供給装置等の塗装作業用に
設けられた各種機器による塗料作業動作も制御する。す
なわち、コントローラ1は、マニピュレータ5を動作さ
せつつ、塗装作業の実施も併せて制御する。この制御を
実行する機能は、上記演算処理部等によってマニピュレ
ータ5の動作制御と併せて実現することとしてもよい
が、塗装作業制御用に別の演算処理装置をコントローラ
1内部若しくは外部に付加して実現することとしてもよ
い。尚、コントローラ1の内部構成の詳細や演算処理動
作の具体的内容等については更に後述する。
塗装ガン7及び図示せぬ塗料供給装置等の塗装作業用に
設けられた各種機器による塗料作業動作も制御する。す
なわち、コントローラ1は、マニピュレータ5を動作さ
せつつ、塗装作業の実施も併せて制御する。この制御を
実行する機能は、上記演算処理部等によってマニピュレ
ータ5の動作制御と併せて実現することとしてもよい
が、塗装作業制御用に別の演算処理装置をコントローラ
1内部若しくは外部に付加して実現することとしてもよ
い。尚、コントローラ1の内部構成の詳細や演算処理動
作の具体的内容等については更に後述する。
【0013】入力装置2は、オペレータがマニピュレー
タ5への動作指令やデータ管理等のための指示入力を行
う入力装置であり、入力されたデータを前記指示データ
としてケーブル3を介してコントローラ1へ供給する。
ケーブル3、4は、それぞれ、入力装置2−コントロー
ラ1間、コントローラ1−マニピュレータ5間で授受さ
れる信号を伝達する接続線である。
タ5への動作指令やデータ管理等のための指示入力を行
う入力装置であり、入力されたデータを前記指示データ
としてケーブル3を介してコントローラ1へ供給する。
ケーブル3、4は、それぞれ、入力装置2−コントロー
ラ1間、コントローラ1−マニピュレータ5間で授受さ
れる信号を伝達する接続線である。
【0014】マニピュレータ5は、本塗装ロボットシス
テムにおける塗装ロボットの主要部であって、工場床面
に取り付けられたボックス5aによって床面の所定位置
に固定されている。このマニピュレータ5は、図中に符
合5a〜5jで示すボックス、旋回ベース及びアーム等
と各可動部の駆動ユニット等の構成要素によって構成さ
れており、図示のように各可動部の駆動によって回転角
度θ1、θ2、θ3、θ4、θ5及びθ6の方向にそれぞれ動
作可能な6自由度を有するものとなっている。以下、マ
ニピュレータ5の各構成要素について順に説明する。
テムにおける塗装ロボットの主要部であって、工場床面
に取り付けられたボックス5aによって床面の所定位置
に固定されている。このマニピュレータ5は、図中に符
合5a〜5jで示すボックス、旋回ベース及びアーム等
と各可動部の駆動ユニット等の構成要素によって構成さ
れており、図示のように各可動部の駆動によって回転角
度θ1、θ2、θ3、θ4、θ5及びθ6の方向にそれぞれ動
作可能な6自由度を有するものとなっている。以下、マ
ニピュレータ5の各構成要素について順に説明する。
【0015】ボックス5aは、上述のように工場床面の
所定位置に固定され、図中に符号5bで示す第1の可動
部駆動ユニットを収納しており、旋回ベース5cがこの
第1可動部駆動ユニットを介してボックス5a上に取り
付けられている。第1可動部駆動ユニット5bは、ボッ
クス5a内に固定されたサーボモータ、その出力軸側に
設けられた減速機及びエンコーダ等からなっており、旋
回ベース5cは、減速機を介してサーボモータの出力軸
と連結され、図中の矢印θ1方向に回転自在に取り付け
られている。そして、第1可動部駆動ユニット5bのサ
ーボモータがコントローラ1から供給される動作指令信
号によって駆動され、これにより、旋回ベース5cがθ
1方向に回転し、この回転角度をエンコーダが検出して
コントローラ1へ供給するようになっている。
所定位置に固定され、図中に符号5bで示す第1の可動
部駆動ユニットを収納しており、旋回ベース5cがこの
第1可動部駆動ユニットを介してボックス5a上に取り
付けられている。第1可動部駆動ユニット5bは、ボッ
クス5a内に固定されたサーボモータ、その出力軸側に
設けられた減速機及びエンコーダ等からなっており、旋
回ベース5cは、減速機を介してサーボモータの出力軸
と連結され、図中の矢印θ1方向に回転自在に取り付け
られている。そして、第1可動部駆動ユニット5bのサ
ーボモータがコントローラ1から供給される動作指令信
号によって駆動され、これにより、旋回ベース5cがθ
1方向に回転し、この回転角度をエンコーダが検出して
コントローラ1へ供給するようになっている。
【0016】又、旋回ベース5cには、同様にサーボモ
ータや減速機等からなる第2の可動部駆動ユニット5d
が取り付けられている。第2可動部駆動ユニット5dに
おいては、サーボモータが旋回ベース5c側に固定され
ており、その出力軸が減速機を介して第1アーム5eの
一端(後方端)と連結されている。そして、この第2可
動部駆動ユニット5dのサーボモータがコントローラ1
から供給される動作指令信号によって駆動され、これに
より、第1アーム5eが図中の矢印θ2方向に回転し、
この回転角度をエンコーダが検出してコントローラ1へ
供給するようになっている。
ータや減速機等からなる第2の可動部駆動ユニット5d
が取り付けられている。第2可動部駆動ユニット5dに
おいては、サーボモータが旋回ベース5c側に固定され
ており、その出力軸が減速機を介して第1アーム5eの
一端(後方端)と連結されている。そして、この第2可
動部駆動ユニット5dのサーボモータがコントローラ1
から供給される動作指令信号によって駆動され、これに
より、第1アーム5eが図中の矢印θ2方向に回転し、
この回転角度をエンコーダが検出してコントローラ1へ
供給するようになっている。
【0017】一方、第1アーム5eの他端(先方端)に
は、第3の可動部駆動ユニット5fが取り付けられてい
る。第3可動部駆動ユニット5fにおいてもサーボモー
タの出力軸が減速機を介して第2アーム5g側と連結さ
れており、これがコントローラ1から供給される動作指
令信号によって駆動され、第2アーム5gが図中の矢印
θ3方向に回転し、この回転角度をエンコーダが検出し
てコントローラ1へ供給するようになっている。
は、第3の可動部駆動ユニット5fが取り付けられてい
る。第3可動部駆動ユニット5fにおいてもサーボモー
タの出力軸が減速機を介して第2アーム5g側と連結さ
れており、これがコントローラ1から供給される動作指
令信号によって駆動され、第2アーム5gが図中の矢印
θ3方向に回転し、この回転角度をエンコーダが検出し
てコントローラ1へ供給するようになっている。
【0018】第2アーム5gには、第3可動部駆動ユニ
ット5fとの連結部側(後方端側)に手首駆動ユニット
ケース5hが取り付けられており、先方端側に第1手首
部材5i、第2手首部材5j、塗装ガン7がそれぞれ図
中の矢印θ4、θ5、θ6方向に回転自在な連結部を介し
て順次取り付けられている。
ット5fとの連結部側(後方端側)に手首駆動ユニット
ケース5hが取り付けられており、先方端側に第1手首
部材5i、第2手首部材5j、塗装ガン7がそれぞれ図
中の矢印θ4、θ5、θ6方向に回転自在な連結部を介し
て順次取り付けられている。
【0019】ここで、手首駆動ユニットケース5h内に
は、第1手首部材5i、第2手首部材5j及び塗装ガン
7をそれぞれ回転動作させるためのサーボモータと、そ
れらサーボモータによる回転角度を検出するエンコーダ
等とからなる第4、第5及び第6の可動部駆動ユニット
が収納されている(図示略)。又、第2アーム5g等の
内部には、それら第4、第5、第6可動部駆動ユニット
にて発生された駆動力をθ4、θ5、θ6方向の回転力と
して、それぞれ、第1手首部材5i、第2手首部材5
j、塗装ガン7へ伝達する動力伝達機構が設けられてい
る。
は、第1手首部材5i、第2手首部材5j及び塗装ガン
7をそれぞれ回転動作させるためのサーボモータと、そ
れらサーボモータによる回転角度を検出するエンコーダ
等とからなる第4、第5及び第6の可動部駆動ユニット
が収納されている(図示略)。又、第2アーム5g等の
内部には、それら第4、第5、第6可動部駆動ユニット
にて発生された駆動力をθ4、θ5、θ6方向の回転力と
して、それぞれ、第1手首部材5i、第2手首部材5
j、塗装ガン7へ伝達する動力伝達機構が設けられてい
る。
【0020】このような手首部分の構成において、上記
同様、第4、第5、第6可動部駆動ユニットのサーボモ
ータがコントローラ1から供給される動作指令信号によ
って駆動され、その駆動力が動力伝達機構を介して伝達
されて第1手首部材5i、第2手首部材5j、塗装ガン
7がそれぞれθ4、θ5、θ6方向に回転する。そして、
これらの回転角度を各エンコーダが検出し、コントロー
ラ1へ供給するようになっている。
同様、第4、第5、第6可動部駆動ユニットのサーボモ
ータがコントローラ1から供給される動作指令信号によ
って駆動され、その駆動力が動力伝達機構を介して伝達
されて第1手首部材5i、第2手首部材5j、塗装ガン
7がそれぞれθ4、θ5、θ6方向に回転する。そして、
これらの回転角度を各エンコーダが検出し、コントロー
ラ1へ供給するようになっている。
【0021】一方、色替えバルブ6は、第2アーム5g
上に搭載され、第2アーム5gの先端側から第1手首部
材5i、第2手首部材5jの内部に設けられたチューブ
(図示略)を介して塗装ガン7と接続されており、図示
せぬ塗料タンクやポンプ等からなる塗料供給装置から供
給される複数色の塗料、シンナー及び加圧エアの塗装ガ
ン7への供給をコントローラ1からの指示信号に従って
制御する。
上に搭載され、第2アーム5gの先端側から第1手首部
材5i、第2手首部材5jの内部に設けられたチューブ
(図示略)を介して塗装ガン7と接続されており、図示
せぬ塗料タンクやポンプ等からなる塗料供給装置から供
給される複数色の塗料、シンナー及び加圧エアの塗装ガ
ン7への供給をコントローラ1からの指示信号に従って
制御する。
【0022】塗装ガン7は、エアモータのタービンによ
って回転されるカップ状の回転子等で塗料を拡散しつつ
噴射する回転霧化式の塗装ガンである。この塗装ガン7
は、色替えバルブ6から上記チューブを介して供給され
る塗料や加圧エア等とコントローラ1から供給される指
示信号とに応じてワーク(図示略)に対する塗装作業を
実施する。
って回転されるカップ状の回転子等で塗料を拡散しつつ
噴射する回転霧化式の塗装ガンである。この塗装ガン7
は、色替えバルブ6から上記チューブを介して供給され
る塗料や加圧エア等とコントローラ1から供給される指
示信号とに応じてワーク(図示略)に対する塗装作業を
実施する。
【0023】本塗装ロボットシステムの全体構成は以上
のようなものとなっており、コントローラ1、入力装置
2、ケーブル3、4及びマニピュレータ5によって構成
される塗装ロボットと、色替えバルブ6、塗装ガン7及
び塗料供給装置等によって構成される塗装作業用機器と
に大別することができる。このような構成において、マ
ニピュレータ5は、塗装ガン7を空間上の任意の位置、
姿勢に移動させ、上記各可動部の回転角度θ1、θ2、θ
3、θ4、θ5及びθ6によって決定される位置、姿勢にて
ガン先(図中の符合7x)から塗料を噴射させ、ワーク
の塗装を行う。すなわち、本塗装ロボットシステムにお
いては、旋回ベース5c、第1アーム5e、第2アーム
5g、第1手首部材5i、第2手首部材5j及び塗装ガ
ン7の回転角度θ1〜θ6によって塗装ガン7の位置及び
姿勢(ねらい方向)が決定されると共に、塗料供給装置
からの供給状態、色替えバルブ6の動作状態及び塗装ガ
ン7の塗料噴射動作状態によって当該位置及び姿勢での
塗装作業の実施内容が決定される。そして、これらの位
置、姿勢及び回転角度θ1〜θ6並びに塗装作業の実施内
容等は、コントローラ1での演算処理により決定され、
その決定に基づく第1〜第6の可動部駆動ユニットへの
動作指令信号と色替えバルブ6や塗装ガン7等への指示
信号とによって制御される。
のようなものとなっており、コントローラ1、入力装置
2、ケーブル3、4及びマニピュレータ5によって構成
される塗装ロボットと、色替えバルブ6、塗装ガン7及
び塗料供給装置等によって構成される塗装作業用機器と
に大別することができる。このような構成において、マ
ニピュレータ5は、塗装ガン7を空間上の任意の位置、
姿勢に移動させ、上記各可動部の回転角度θ1、θ2、θ
3、θ4、θ5及びθ6によって決定される位置、姿勢にて
ガン先(図中の符合7x)から塗料を噴射させ、ワーク
の塗装を行う。すなわち、本塗装ロボットシステムにお
いては、旋回ベース5c、第1アーム5e、第2アーム
5g、第1手首部材5i、第2手首部材5j及び塗装ガ
ン7の回転角度θ1〜θ6によって塗装ガン7の位置及び
姿勢(ねらい方向)が決定されると共に、塗料供給装置
からの供給状態、色替えバルブ6の動作状態及び塗装ガ
ン7の塗料噴射動作状態によって当該位置及び姿勢での
塗装作業の実施内容が決定される。そして、これらの位
置、姿勢及び回転角度θ1〜θ6並びに塗装作業の実施内
容等は、コントローラ1での演算処理により決定され、
その決定に基づく第1〜第6の可動部駆動ユニットへの
動作指令信号と色替えバルブ6や塗装ガン7等への指示
信号とによって制御される。
【0024】2.信号系 次に、本塗装ロボットシステムにおける信号系について
説明する。図2は、本塗装ロボットシステムにおける信
号の系統図である。但し、ここでは、本発明の特徴との
関連性から特にマニピュレータ5の動作制御のための信
号系のみを説明することとするので、図2においてはそ
の信号系の系統図のみを示し、塗装作業を制御するため
の信号系は省略してある。尚、図中の1点鎖線で囲まれ
た部分はコントローラ1に対応する。
説明する。図2は、本塗装ロボットシステムにおける信
号の系統図である。但し、ここでは、本発明の特徴との
関連性から特にマニピュレータ5の動作制御のための信
号系のみを説明することとするので、図2においてはそ
の信号系の系統図のみを示し、塗装作業を制御するため
の信号系は省略してある。尚、図中の1点鎖線で囲まれ
た部分はコントローラ1に対応する。
【0025】図示のように、コントローラ1内には、演
算装置10、記憶装置11、インターフェイス12、1
3及びモータドライバD1〜D6等が設けられている。演
算装置10は、各種制御演算処理を行う上述の演算処理
部に相当する。記憶装置11は、教示プログラムや各種
制御パラメータ等を記憶する上述の記憶部に相当し、第
1アーム5e、第2アーム5g等の長さや回転角度θ1
〜θ6の動作可能な角度範囲等のようなマニピュレータ
5の諸元データは、制御パラメータの一部としてこの記
憶装置11に記憶されている。又、記憶装置11の一部
は、演算装置10が演算処理の実行時に各種変数のデー
タを格納する汎用の記憶領域としても使用される。
算装置10、記憶装置11、インターフェイス12、1
3及びモータドライバD1〜D6等が設けられている。演
算装置10は、各種制御演算処理を行う上述の演算処理
部に相当する。記憶装置11は、教示プログラムや各種
制御パラメータ等を記憶する上述の記憶部に相当し、第
1アーム5e、第2アーム5g等の長さや回転角度θ1
〜θ6の動作可能な角度範囲等のようなマニピュレータ
5の諸元データは、制御パラメータの一部としてこの記
憶装置11に記憶されている。又、記憶装置11の一部
は、演算装置10が演算処理の実行時に各種変数のデー
タを格納する汎用の記憶領域としても使用される。
【0026】インターフェイス12は、演算装置10と
上記入力装置2との間を接続するインターフェイスであ
り、これらの間で授受される信号を所定の信号形態とし
て伝達する。尚、このインターフェイス12と入力装置
2との間を接続しているのが上述のケーブル3である。
一方、インターフェイス13は、演算装置10とモータ
ドライバD1〜D6との間を接続するインターフェイスで
あり、これらの間で授受される信号を所定の信号形態と
して伝達する。
上記入力装置2との間を接続するインターフェイスであ
り、これらの間で授受される信号を所定の信号形態とし
て伝達する。尚、このインターフェイス12と入力装置
2との間を接続しているのが上述のケーブル3である。
一方、インターフェイス13は、演算装置10とモータ
ドライバD1〜D6との間を接続するインターフェイスで
あり、これらの間で授受される信号を所定の信号形態と
して伝達する。
【0027】モータドライバD1、D2、…、D6は、そ
れぞれ、インターフェイス13を介して演算装置10か
ら指令信号を受け、その指令信号に応じてマニピュレー
タ5の第1、第2、…、第6可動部駆動ユニットのサー
ボモータM1、M2、…、M6へ駆動電流(上記動作指令
信号)を供給する。又、各モータドライバは、自己が駆
動電流を供給するサーボモータから(正確にはそのサー
ボモータに付設された上述のエンコーダから)回転角度
に応じた信号を受け、その信号をそれぞれの可動部の回
転角度データとしてインターフェイス13を介して演算
装置10へ供給する。
れぞれ、インターフェイス13を介して演算装置10か
ら指令信号を受け、その指令信号に応じてマニピュレー
タ5の第1、第2、…、第6可動部駆動ユニットのサー
ボモータM1、M2、…、M6へ駆動電流(上記動作指令
信号)を供給する。又、各モータドライバは、自己が駆
動電流を供給するサーボモータから(正確にはそのサー
ボモータに付設された上述のエンコーダから)回転角度
に応じた信号を受け、その信号をそれぞれの可動部の回
転角度データとしてインターフェイス13を介して演算
装置10へ供給する。
【0028】サーボモータM1、M2、…、M6は、それ
ぞれ、第1、第2、…、第6可動部駆動ユニットに設け
られている上述のサーボモータであり、モータドライバ
D1、D2、…、D6から受けた駆動電流によって駆動力
を発生し、マニピュレータ5の各可動部の回転角度θ
1、θ2、…、θ6を同駆動電流に応じた角度に回転させ
る。
ぞれ、第1、第2、…、第6可動部駆動ユニットに設け
られている上述のサーボモータであり、モータドライバ
D1、D2、…、D6から受けた駆動電流によって駆動力
を発生し、マニピュレータ5の各可動部の回転角度θ
1、θ2、…、θ6を同駆動電流に応じた角度に回転させ
る。
【0029】このような信号系の構成において、演算装
置10は、入出力装置2、モータドライバD1〜D6とそ
れぞれインターフェイス12、13を介して信号の授受
を行うと共に、記憶装置11からの必要なデータの読出
及び記憶装置11への必要なデータの書込を行う。そし
て、塗装ガン7の位置及び姿勢の算出、塗装ガン7を次
に移動させるべき目標位置及び目標姿勢の算出、それら
目標位置等に応じた回転角度θ1〜θ6の算出等、種々の
演算処理を行い、その演算処理結果に応じた指令信号を
インターフェイス13を介してモータドライバD1〜D6
へ出力する。これにより、サーボモータM1〜M6へ演算
装置10における演算処理結果に応じた動作指令信号
(電流)が供給され、マニピュレータ5の動作が制御さ
れる。
置10は、入出力装置2、モータドライバD1〜D6とそ
れぞれインターフェイス12、13を介して信号の授受
を行うと共に、記憶装置11からの必要なデータの読出
及び記憶装置11への必要なデータの書込を行う。そし
て、塗装ガン7の位置及び姿勢の算出、塗装ガン7を次
に移動させるべき目標位置及び目標姿勢の算出、それら
目標位置等に応じた回転角度θ1〜θ6の算出等、種々の
演算処理を行い、その演算処理結果に応じた指令信号を
インターフェイス13を介してモータドライバD1〜D6
へ出力する。これにより、サーボモータM1〜M6へ演算
装置10における演算処理結果に応じた動作指令信号
(電流)が供給され、マニピュレータ5の動作が制御さ
れる。
【0030】3.教示プログラム (1)塗装作業の例 次に、本塗装ロボットシステムにおける教示プログラム
について、塗装作業の具体例を挙げて説明する。図3に
塗装作業の一例を模式的に示す。この図においては、符
号Wで示す長方形の斜線領域が塗装作業を施すべきワー
クを表し、これを横切る矢印付の実線がガン先7xを移
動させる軌道の一例を表している。
について、塗装作業の具体例を挙げて説明する。図3に
塗装作業の一例を模式的に示す。この図においては、符
号Wで示す長方形の斜線領域が塗装作業を施すべきワー
クを表し、これを横切る矢印付の実線がガン先7xを移
動させる軌道の一例を表している。
【0031】図示の軌道による塗装作業は、白抜きの小
円で示した点P1〜点P8の位置を直線でつなぐようにガ
ン先7xを移動させ、その移動軌道上にある黒色の小円
で示した点G1〜点G8の位置で塗装ガン7の塗料噴射動
作のON/OFFを切り替えることにより、ワークWの
塗装を行うものである。すなわち、ガン先7xが点P1
〜点P8を順次通過して図中の実線軌道上を移動するよ
うにマニピュレータ5が塗装ガン7を移動させ、ガン先
7xが点G1〜点G8のうちの奇数番目の点(G1、G3、
G5及びG7)に達したときには塗装ガン7の塗料噴射動
作をONとし、偶数番目の点(G2、G4、G6及びG8)
に達したときには塗料噴射動作をOFFとするのであ
る。
円で示した点P1〜点P8の位置を直線でつなぐようにガ
ン先7xを移動させ、その移動軌道上にある黒色の小円
で示した点G1〜点G8の位置で塗装ガン7の塗料噴射動
作のON/OFFを切り替えることにより、ワークWの
塗装を行うものである。すなわち、ガン先7xが点P1
〜点P8を順次通過して図中の実線軌道上を移動するよ
うにマニピュレータ5が塗装ガン7を移動させ、ガン先
7xが点G1〜点G8のうちの奇数番目の点(G1、G3、
G5及びG7)に達したときには塗装ガン7の塗料噴射動
作をONとし、偶数番目の点(G2、G4、G6及びG8)
に達したときには塗料噴射動作をOFFとするのであ
る。
【0032】従って、図3のワークWを塗装するための
軌道を教示する際には、塗装ガン7(ガン先7x)を移
動させる移動軌道上の教示点として点P1〜点P8の位置
を教示し、塗装作業の内容を指示する情報として点G1
〜点G8の位置とそれら各点における塗料噴射動作のO
N/OFFを教示する。尚、これらの教示は、オペレー
タが入力装置2を用いて所定の指示入力をすることによ
って行うが、オペレータは上記各点の位置等以外にも適
宜必要な他のデータ(後述)を併せて入力する。
軌道を教示する際には、塗装ガン7(ガン先7x)を移
動させる移動軌道上の教示点として点P1〜点P8の位置
を教示し、塗装作業の内容を指示する情報として点G1
〜点G8の位置とそれら各点における塗料噴射動作のO
N/OFFを教示する。尚、これらの教示は、オペレー
タが入力装置2を用いて所定の指示入力をすることによ
って行うが、オペレータは上記各点の位置等以外にも適
宜必要な他のデータ(後述)を併せて入力する。
【0033】(2)教示プログラムの形態 上述のように教示を行った場合の教示プログラムの形態
例を図4に示す。図示の教示プログラムは、そのプログ
ラムに関する総括的なデータで構成されるHEADER部と、
マニピュレータ5の動作軌道(ガン先7xの移動軌道)
を規定する各教示点に関するデータで構成されるPOINT
データ部(POINT1、POINT2、…)と、塗装作業の内容
に関するデータで構成されるPAINTデータ部(PAINT1、
PAINT2、…)とからなっている。
例を図4に示す。図示の教示プログラムは、そのプログ
ラムに関する総括的なデータで構成されるHEADER部と、
マニピュレータ5の動作軌道(ガン先7xの移動軌道)
を規定する各教示点に関するデータで構成されるPOINT
データ部(POINT1、POINT2、…)と、塗装作業の内容
に関するデータで構成されるPAINTデータ部(PAINT1、
PAINT2、…)とからなっている。
【0034】これら教示プログラムの各部を構成するデ
ータの具体例を図5に示す。図示のように、HEADER部
は、プログラムの名称や教示点の総数、使用する作業工
具の種類等のデータによって構成される。ここで、これ
らのデータは上述の他のデータに相当するものであり、
オペレータが入力装置3を用いて適宜入力する。例え
ば、作業工具の種類としては、上記塗装ガン7を示すデ
ータを入力する。
ータの具体例を図5に示す。図示のように、HEADER部
は、プログラムの名称や教示点の総数、使用する作業工
具の種類等のデータによって構成される。ここで、これ
らのデータは上述の他のデータに相当するものであり、
オペレータが入力装置3を用いて適宜入力する。例え
ば、作業工具の種類としては、上記塗装ガン7を示すデ
ータを入力する。
【0035】POINTデータ部は、軌道を規定する各教示
点についてのPOINTデータからなり、各教示点のPOINTデ
ータが図示の[POINTi]のように作業工具の位置及び
姿勢、次の教示点までの軌道補間方法、作業工具先端の
移動速度、位置決め方法並びに加速度制限値等のデータ
によって構成されている。ここで、図3の軌道を教示し
た場合、[POINTi]における作業工具の位置及び姿勢
は上記点Pi(i=1、2、…、8)の位置データとそ
の位置における塗装ガン7の姿勢データとなり、次の教
示点までの軌道補間方法や作業工具先端の移動速度等は
オペレータが適宜指定したり、マニピュレータ5の動作
能力等に応じて演算装置10が算出したりしたデータと
なる。これらのガン先7xの移動軌道を規定するデータ
により、マニピュレータ5の動作軌道が規定されること
になる。
点についてのPOINTデータからなり、各教示点のPOINTデ
ータが図示の[POINTi]のように作業工具の位置及び
姿勢、次の教示点までの軌道補間方法、作業工具先端の
移動速度、位置決め方法並びに加速度制限値等のデータ
によって構成されている。ここで、図3の軌道を教示し
た場合、[POINTi]における作業工具の位置及び姿勢
は上記点Pi(i=1、2、…、8)の位置データとそ
の位置における塗装ガン7の姿勢データとなり、次の教
示点までの軌道補間方法や作業工具先端の移動速度等は
オペレータが適宜指定したり、マニピュレータ5の動作
能力等に応じて演算装置10が算出したりしたデータと
なる。これらのガン先7xの移動軌道を規定するデータ
により、マニピュレータ5の動作軌道が規定されること
になる。
【0036】PAINTデータ部は、塗装作業を制御する
(切り替える)ためのPAINTデータからなり、軌道上で
塗装作業を制御する位置毎のPAINTデータが図示の[PAI
NTi]のように作業工具の制御データ、動作ポイント及
びコマンド出力位置等のデータによって構成されてい
る。ここに、動作ポイントとは、そのPAINTデータによ
って塗装作業を制御しようとする位置に至るときに通過
してきた教示点、すなわち、当該位置の直前にある教示
点を示すデータであり、その教示点が何番目の教示点か
を示す番号データ等によって表される。又、コマンド出
力位置は、そのPAINTデータによって塗装作業を制御し
ようとする位置の前記動作ポイントからの位置を示すデ
ータであり、前記直前の教示点を通過してから塗装作業
を制御する指令信号を送信するタイミングデータに相当
するものである。図3の軌道を教示した場合にあって
は、[PAINTi]における作業工具の制御データは塗装
ガン7のON/OFFを指示するデータとなり、動作ポ
イントは教示点である上記点Piの番号データiとな
り、コマンド出力位置は塗装ガン7のON/OFFを切
り替える上記点Gi(i=1、2、…、8)の点Piから
の位置となる。
(切り替える)ためのPAINTデータからなり、軌道上で
塗装作業を制御する位置毎のPAINTデータが図示の[PAI
NTi]のように作業工具の制御データ、動作ポイント及
びコマンド出力位置等のデータによって構成されてい
る。ここに、動作ポイントとは、そのPAINTデータによ
って塗装作業を制御しようとする位置に至るときに通過
してきた教示点、すなわち、当該位置の直前にある教示
点を示すデータであり、その教示点が何番目の教示点か
を示す番号データ等によって表される。又、コマンド出
力位置は、そのPAINTデータによって塗装作業を制御し
ようとする位置の前記動作ポイントからの位置を示すデ
ータであり、前記直前の教示点を通過してから塗装作業
を制御する指令信号を送信するタイミングデータに相当
するものである。図3の軌道を教示した場合にあって
は、[PAINTi]における作業工具の制御データは塗装
ガン7のON/OFFを指示するデータとなり、動作ポ
イントは教示点である上記点Piの番号データiとな
り、コマンド出力位置は塗装ガン7のON/OFFを切
り替える上記点Gi(i=1、2、…、8)の点Piから
の位置となる。
【0037】本塗装ロボットシステムにおいては、以上
のような形態でコントローラ1内の記憶装置11に教示
プログラムが記憶される。そして、その教示プログラム
中の教示データ(上記各部を構成する種々のデータの総
称。以下においても同様)を用い、以下のようにして軌
道の生成やマニピュレータ5の実動作制御等が行われ
る。尚、以下においては、上記各点のような教示された
各点の混乱を避けるため、上記POINTデータ部において
マニピュレータ5の動作軌道(ガン先7xの移動軌道)
を規定する点として教示された教示点(図3でいえば点
P1〜点P8)を「位置教示点」といい、上記PAINTデー
タ部において塗装作業を制御する位置として教示された
教示点(図3でいえば点G1〜点G8)を「作業教示点」
ということにする。
のような形態でコントローラ1内の記憶装置11に教示
プログラムが記憶される。そして、その教示プログラム
中の教示データ(上記各部を構成する種々のデータの総
称。以下においても同様)を用い、以下のようにして軌
道の生成やマニピュレータ5の実動作制御等が行われ
る。尚、以下においては、上記各点のような教示された
各点の混乱を避けるため、上記POINTデータ部において
マニピュレータ5の動作軌道(ガン先7xの移動軌道)
を規定する点として教示された教示点(図3でいえば点
P1〜点P8)を「位置教示点」といい、上記PAINTデー
タ部において塗装作業を制御する位置として教示された
教示点(図3でいえば点G1〜点G8)を「作業教示点」
ということにする。
【0038】<動作> 1.軌道生成 次に、上記構成による動作について説明する。本塗装ロ
ボットシステムにおいては、上述したように記憶装置1
1に記憶された教示データに基づき、塗装ガン7がOF
Fとなっているときの軌道を適宜新たに生成しつつ、マ
ニピュレータ5の動作を制御する。この制御動作は、コ
ントローラ1において実行される本塗装ロボットシステ
ム特有の機能であり、教示プログラムに基づく教示点間
を結んだ当初の軌道より短い軌道を生成し、図4及び図
5に示したような教示プログラムによれば再生される軌
道が通常は図3の矢印付実線のようになるところを以下
のように変更する。
ボットシステムにおいては、上述したように記憶装置1
1に記憶された教示データに基づき、塗装ガン7がOF
Fとなっているときの軌道を適宜新たに生成しつつ、マ
ニピュレータ5の動作を制御する。この制御動作は、コ
ントローラ1において実行される本塗装ロボットシステ
ム特有の機能であり、教示プログラムに基づく教示点間
を結んだ当初の軌道より短い軌道を生成し、図4及び図
5に示したような教示プログラムによれば再生される軌
道が通常は図3の矢印付実線のようになるところを以下
のように変更する。
【0039】図6は、本塗装ロボットシステムにおける
制御動作の一部の処理手順を示す図であり、全体の動作
開始時における処理の手順と動作開始以降に行う軌道生
成演算の処理手順とを示している。本塗装ロボットシス
テムでは、まず、演算装置10が記憶装置11から教示
プログラムを読み出すと共に、後続の各処理で使用する
各種変数、定数の初期化を行う(ステップS1)。そし
てこれ以降、教示プログラムの再生スタート指示がある
まで、すなわち、オペレータが入力装置2を操作してマ
ニピュレータ5の動作開始指示が発せられるまで、コン
トローラ1は図6の処理を停止して待機する(ステップ
S2)。
制御動作の一部の処理手順を示す図であり、全体の動作
開始時における処理の手順と動作開始以降に行う軌道生
成演算の処理手順とを示している。本塗装ロボットシス
テムでは、まず、演算装置10が記憶装置11から教示
プログラムを読み出すと共に、後続の各処理で使用する
各種変数、定数の初期化を行う(ステップS1)。そし
てこれ以降、教示プログラムの再生スタート指示がある
まで、すなわち、オペレータが入力装置2を操作してマ
ニピュレータ5の動作開始指示が発せられるまで、コン
トローラ1は図6の処理を停止して待機する(ステップ
S2)。
【0040】このステップS2の待機状態においてマニ
ピュレータ5の動作開始指示が発せられ、これをコント
ローラ1が受けると、ステップS3へ進んでカウンタ
i、カウンタjの値を共に‘0’に初期化する。ここ
に、カウンタiは、実行中の教示プログラムにおける位
置教示点の番号をカウントするためのカウンタであり、
塗装ガン7(ガン先7x)が直前に到達した(或いは現
在到達している)位置教示点の番号を示す。尚、カウン
タiがこのような位置教示点番号を示すものとなること
については後述する。一方、カウンタjは、後続の処理
において、位置教示点間にある作業教示点を変数に格納
する際に使用するカウンタである。
ピュレータ5の動作開始指示が発せられ、これをコント
ローラ1が受けると、ステップS3へ進んでカウンタ
i、カウンタjの値を共に‘0’に初期化する。ここ
に、カウンタiは、実行中の教示プログラムにおける位
置教示点の番号をカウントするためのカウンタであり、
塗装ガン7(ガン先7x)が直前に到達した(或いは現
在到達している)位置教示点の番号を示す。尚、カウン
タiがこのような位置教示点番号を示すものとなること
については後述する。一方、カウンタjは、後続の処理
において、位置教示点間にある作業教示点を変数に格納
する際に使用するカウンタである。
【0041】以後、コントローラ1から動作終了信号が
送信されるまで(ステップS4)、ステップS5以下の処
理を繰り返す。このステップS5以下の処理は、後述す
るマニピュレータ5等の動作制御においてカウンタiや
カウンタkの値が更新される度に繰り返されるものであ
るが、この繰り返しの態様については後に明らかにす
る。ここに、カウンタkとは、軌道生成に位置教示点と
作業教示点の双方を利用するために導入するカウンタで
あり、塗装ガン7が移動中の位置教示点間の区間につい
て、その区間内にある作業教示点のうちで塗装ガン7が
到達した作業教示点の数をカウントしていくものであ
る。尚、カウンタkがこのような作業教示点数を示すも
のとなることについても後述する。
送信されるまで(ステップS4)、ステップS5以下の処
理を繰り返す。このステップS5以下の処理は、後述す
るマニピュレータ5等の動作制御においてカウンタiや
カウンタkの値が更新される度に繰り返されるものであ
るが、この繰り返しの態様については後に明らかにす
る。ここに、カウンタkとは、軌道生成に位置教示点と
作業教示点の双方を利用するために導入するカウンタで
あり、塗装ガン7が移動中の位置教示点間の区間につい
て、その区間内にある作業教示点のうちで塗装ガン7が
到達した作業教示点の数をカウントしていくものであ
る。尚、カウンタkがこのような作業教示点数を示すも
のとなることについても後述する。
【0042】ステップS5以下では、まず、塗装ガン7
が現在到達している位置教示点Piと、塗装ガン7を次
に移動させるべき位置教示点Pi+1との間に、作業教示
点があるかどうかを判断する。そして、位置教示点Pi
とPi+1の間に作業教示点がある場合には、その作業教
示点の数を変数m(以下、「作業点数m」という。)に
格納すると共に(ステップS6)、それらの作業教示点
(Gijとする。)の位置データを軌道生成点xjに順次
格納する(ステップS7)。ここに、軌道生成点xjは、
軌道生成演算に用いる点の位置データを格納するための
変数であり、これにステップS7での処理によってj=
1〜mの作業教示点Gijの位置データが順次格納され、
位置教示点PiとPi+1の間にあるm個の作業教示点の全
位置データが演算処理用に確保される。
が現在到達している位置教示点Piと、塗装ガン7を次
に移動させるべき位置教示点Pi+1との間に、作業教示
点があるかどうかを判断する。そして、位置教示点Pi
とPi+1の間に作業教示点がある場合には、その作業教
示点の数を変数m(以下、「作業点数m」という。)に
格納すると共に(ステップS6)、それらの作業教示点
(Gijとする。)の位置データを軌道生成点xjに順次
格納する(ステップS7)。ここに、軌道生成点xjは、
軌道生成演算に用いる点の位置データを格納するための
変数であり、これにステップS7での処理によってj=
1〜mの作業教示点Gijの位置データが順次格納され、
位置教示点PiとPi+1の間にあるm個の作業教示点の全
位置データが演算処理用に確保される。
【0043】これに対し、位置教示点PiとPi+1の間に
作業教示点がない場合には、作業点数mを‘0’とする
(ステップS8)。このようにして位置教示点間の作業
教示点の有無に応じた変数設定を行った後にステップS
9へと進む。
作業教示点がない場合には、作業点数mを‘0’とする
(ステップS8)。このようにして位置教示点間の作業
教示点の有無に応じた変数設定を行った後にステップS
9へと進む。
【0044】ステップS9では、カウンタkの値が作業
点数m以下であるかどうかを判断し、作業点数m以下で
あった場合にステップS10以下の処理を行う。
点数m以下であるかどうかを判断し、作業点数m以下で
あった場合にステップS10以下の処理を行う。
【0045】ステップS10では、カウンタkの値が
‘0’であるかどうかを判断し、‘0’であった場合に
は進行区間始点Xsを位置教示点Piとし(ステップS1
1)、‘0’でなかった場合には進行区間始点Xsを軌道
生成点xkとする(ステップS12)。
‘0’であるかどうかを判断し、‘0’であった場合に
は進行区間始点Xsを位置教示点Piとし(ステップS1
1)、‘0’でなかった場合には進行区間始点Xsを軌道
生成点xkとする(ステップS12)。
【0046】ここで、進行区間始点Xsの意義について
説明する。今、塗装ガン7が移動中の位置教示点間の区
間を、その始点である位置教示点Piと当該区間内にあ
る第1番目の作業教示点Gi1との間の第0区間、同作業
教示点Gi1と第2番目の作業教示点Gi2との間の第1区
間、同作業教示点Gi2と第3番目の作業教示点Gi3との
間の第2区間、…、第m番目の作業教示点Gimと終点で
ある位置教示点Pi+1との間の第m区間、に分けて考え
る。すると、カウンタkが移動中の位置教示点間におけ
る到達作業教示点数を示すものであることから、これが
‘0’のときは塗装ガン7は第0区間の始点、すなわ
ち、位置教示点Piにあり、これが‘0’以外のときは
第k区間の始点、すなわち、作業教示点Gikにある。そ
して、この作業教示点Gikの位置データは、上記ステッ
プS7の処理によって軌道生成点xkに格納されており、
軌道生成点xkが作業教示点Gikに相当するものとなっ
ている。
説明する。今、塗装ガン7が移動中の位置教示点間の区
間を、その始点である位置教示点Piと当該区間内にあ
る第1番目の作業教示点Gi1との間の第0区間、同作業
教示点Gi1と第2番目の作業教示点Gi2との間の第1区
間、同作業教示点Gi2と第3番目の作業教示点Gi3との
間の第2区間、…、第m番目の作業教示点Gimと終点で
ある位置教示点Pi+1との間の第m区間、に分けて考え
る。すると、カウンタkが移動中の位置教示点間におけ
る到達作業教示点数を示すものであることから、これが
‘0’のときは塗装ガン7は第0区間の始点、すなわ
ち、位置教示点Piにあり、これが‘0’以外のときは
第k区間の始点、すなわち、作業教示点Gikにある。そ
して、この作業教示点Gikの位置データは、上記ステッ
プS7の処理によって軌道生成点xkに格納されており、
軌道生成点xkが作業教示点Gikに相当するものとなっ
ている。
【0047】従って、ステップS10〜S12の処理によっ
て設定される進行区間始点Xsとは、すべての教示点、
すなわち、位置教示点と作業教示点の双方の教示点によ
って塗装ガン7の移動軌道を分割した区間のうち、塗装
ガン7がこれから内部へ侵入しようとする区間の始点に
相当するものとなる。
て設定される進行区間始点Xsとは、すべての教示点、
すなわち、位置教示点と作業教示点の双方の教示点によ
って塗装ガン7の移動軌道を分割した区間のうち、塗装
ガン7がこれから内部へ侵入しようとする区間の始点に
相当するものとなる。
【0048】更に、上記進行区間始点Xsの設定に続い
てカウンタkの値が‘m’であるかどうかを判断し(ス
テップS13)、‘m’であった場合には進行区間終点X
eを位置教示点Pi+1とし(ステップS14)、‘m’でな
かった場合には進行区間終点Xeを軌道生成点xk+1とす
る(ステップS15)。
てカウンタkの値が‘m’であるかどうかを判断し(ス
テップS13)、‘m’であった場合には進行区間終点X
eを位置教示点Pi+1とし(ステップS14)、‘m’でな
かった場合には進行区間終点Xeを軌道生成点xk+1とす
る(ステップS15)。
【0049】ここで、カウンタkが‘m’のとき(ステ
ップS14)については、塗装ガン7が第m区間の始点
(作業教示点Gim)にあり、この第m区間の終点が位置
教示点Pi+1であることから、設定される進行区間終点
Xeは、塗装ガン7がこれから内部へ侵入しようとする
区間(教示点PiとPi+1の間における最終の第m区間)
の終点に相当するものとなる。一方、カウンタkが
‘m’でないとき(ステップS15)については、塗装ガ
ン7が第k区間の始点(位置教示点Pi又は作業教示点
Gik)にあり、この第k区間の終点が作業教示点Gik+1
であって、この位置データは軌道生成点xk+1に格納さ
れており、軌道生成点xk+1が作業教示点Gik+1に相当
するものとなっていることから、設定される進行区間終
点Xeは、ステップS14同様に塗装ガン7がこれから内
部へ侵入しようとする区間の終点に相当するものとな
る。
ップS14)については、塗装ガン7が第m区間の始点
(作業教示点Gim)にあり、この第m区間の終点が位置
教示点Pi+1であることから、設定される進行区間終点
Xeは、塗装ガン7がこれから内部へ侵入しようとする
区間(教示点PiとPi+1の間における最終の第m区間)
の終点に相当するものとなる。一方、カウンタkが
‘m’でないとき(ステップS15)については、塗装ガ
ン7が第k区間の始点(位置教示点Pi又は作業教示点
Gik)にあり、この第k区間の終点が作業教示点Gik+1
であって、この位置データは軌道生成点xk+1に格納さ
れており、軌道生成点xk+1が作業教示点Gik+1に相当
するものとなっていることから、設定される進行区間終
点Xeは、ステップS14同様に塗装ガン7がこれから内
部へ侵入しようとする区間の終点に相当するものとな
る。
【0050】このように、ステップS5〜S15での処理
により、カウンタiとカウンタkの値に応じた進行区間
始点Xsと進行区間終点Xeがセットされ、これらによっ
て塗装ガン7がこれから侵入していく進行区間が特定さ
れることになる。その後、ステップS16において、その
始点終点間で作業ONかどうか、すなわち、設定された
進行区間始点Xsと進行区間終点Xeとの間の進行区間で
は塗装ガン7の塗料噴射動作をONとするのかどうかを
教示データ(上記図5の例でいえば[PAINTi]中のデ
ータ)に基づいて判断する。
により、カウンタiとカウンタkの値に応じた進行区間
始点Xsと進行区間終点Xeがセットされ、これらによっ
て塗装ガン7がこれから侵入していく進行区間が特定さ
れることになる。その後、ステップS16において、その
始点終点間で作業ONかどうか、すなわち、設定された
進行区間始点Xsと進行区間終点Xeとの間の進行区間で
は塗装ガン7の塗料噴射動作をONとするのかどうかを
教示データ(上記図5の例でいえば[PAINTi]中のデ
ータ)に基づいて判断する。
【0051】そして、ステップS16で始点終点間の塗装
作業がONであった場合にはステップS17へ進み、教示
データで指示された補間方法により補間式を生成し、そ
の補間式や同教示データで指示された位置決め方法等に
基づいて軌道を再生することにする(軌道再生の詳細は
後述の動作制御参照)。これにより、塗装作業を行う作
業区間の軌道が教示データに従って再生される。尚、こ
こにいう補間式とは、これから塗装ガン7を移動させる
教示点間の軌道を補間する式であり、マニピュレータ5
の動作制御を行う制御周期(後述)毎に目標位置及び目
標姿勢を決定するためのもので、これによって塗装ガン
7の移動軌道とマニピュレータ5の動作軌道が生成され
ることになる。
作業がONであった場合にはステップS17へ進み、教示
データで指示された補間方法により補間式を生成し、そ
の補間式や同教示データで指示された位置決め方法等に
基づいて軌道を再生することにする(軌道再生の詳細は
後述の動作制御参照)。これにより、塗装作業を行う作
業区間の軌道が教示データに従って再生される。尚、こ
こにいう補間式とは、これから塗装ガン7を移動させる
教示点間の軌道を補間する式であり、マニピュレータ5
の動作制御を行う制御周期(後述)毎に目標位置及び目
標姿勢を決定するためのもので、これによって塗装ガン
7の移動軌道とマニピュレータ5の動作軌道が生成され
ることになる。
【0052】一方、ステップS16で始点終点間の塗装作
業がONでなかった(OFFであった)場合にはステッ
プS18へ進み、以下に説明する処理Aによって補間式を
生成して軌道を生成(再生)することにする。
業がONでなかった(OFFであった)場合にはステッ
プS18へ進み、以下に説明する処理Aによって補間式を
生成して軌道を生成(再生)することにする。
【0053】処理Aの手順を図7に示す。処理Aでは、
まず、進行区間の始点(上記進行区間始点Xs)が作業
OFFの最初の点であるかどうかを判断する(ステップ
S20)。ここにいう作業OFFの最初の点とは、塗装作
業をOFFとする区間の始点である教示点を意味し、軌
道上で塗装作業ONの状態から塗装作業OFFに切り替
える点がこれに当たる。図3の例でいえば、作業教示点
G2、G4及びG6のような塗装作業OFF区間の最初の
教示点がこれである。
まず、進行区間の始点(上記進行区間始点Xs)が作業
OFFの最初の点であるかどうかを判断する(ステップ
S20)。ここにいう作業OFFの最初の点とは、塗装作
業をOFFとする区間の始点である教示点を意味し、軌
道上で塗装作業ONの状態から塗装作業OFFに切り替
える点がこれに当たる。図3の例でいえば、作業教示点
G2、G4及びG6のような塗装作業OFF区間の最初の
教示点がこれである。
【0054】ステップS20で進行区間の始点が塗装作業
OFFの最初の点でなかった場合には、何等の処理も行
わずに処理Aを終了する。すなわち、処理Aは、塗装ガ
ン7が塗装作業OFF区間の始点に到達した場合にのみ
ステップS21以下の処理によって新たな補間式を生成す
ることとし、塗装ガン7が塗装作業OFF区間の始点以
外(塗装作業OFF区間内)にある場合には補間式を生
成しない。これにより、図6のステップS18では、前者
の場合には以下に述べるようにして生成した補間式を使
用して軌道を生成するようにし、後者の場合には前回生
成した補間式を引き続き使用して軌道を生成するように
するのである。
OFFの最初の点でなかった場合には、何等の処理も行
わずに処理Aを終了する。すなわち、処理Aは、塗装ガ
ン7が塗装作業OFF区間の始点に到達した場合にのみ
ステップS21以下の処理によって新たな補間式を生成す
ることとし、塗装ガン7が塗装作業OFF区間の始点以
外(塗装作業OFF区間内)にある場合には補間式を生
成しない。これにより、図6のステップS18では、前者
の場合には以下に述べるようにして生成した補間式を使
用して軌道を生成するようにし、後者の場合には前回生
成した補間式を引き続き使用して軌道を生成するように
するのである。
【0055】ステップS20で進行区間の始点が塗装作業
OFFの最初の点であった場合には、次に塗装作業ON
とする点(作業教示点)までにある教示点(位置教示点
及び作業教示点の双方)の数を教示データに基づいて判
断し、その判断結果に応じて後続の処理を区別する(ス
テップS21)。
OFFの最初の点であった場合には、次に塗装作業ON
とする点(作業教示点)までにある教示点(位置教示点
及び作業教示点の双方)の数を教示データに基づいて判
断し、その判断結果に応じて後続の処理を区別する(ス
テップS21)。
【0056】今、教示点が図8の(a)に示すようにな
っており、ステップS21において図示の進行区間始点X
sが設定されている場合、次に塗装作業ONとする点ま
での教示点数は‘0’となる。この場合にはステップS
22へ進み、教示データで指示された補間方法(図中白抜
きの小円で示す位置教示点間の補間情報)により補間式
を生成する。尚、図8においては、それぞれ、白抜きの
小円が位置教示点を表し、黒色の小円が作業教示点を表
す。
っており、ステップS21において図示の進行区間始点X
sが設定されている場合、次に塗装作業ONとする点ま
での教示点数は‘0’となる。この場合にはステップS
22へ進み、教示データで指示された補間方法(図中白抜
きの小円で示す位置教示点間の補間情報)により補間式
を生成する。尚、図8においては、それぞれ、白抜きの
小円が位置教示点を表し、黒色の小円が作業教示点を表
す。
【0057】一方、図8の(b)に示すように作業教示
点間に挟まれた位置教示点が1つ存在し、ステップS21
において図示の作業教示点に進行区間始点Xsが設定さ
れている場合、次に塗装作業ONとする点までの教示点
数は‘1’となる。この場合にはステップS23へ進み、
塗装作業OFFの最初の点(すなわち、進行区間始点X
s。以下においても同様)をX0、次に塗装作業ONとす
る点をX2、これらの点の間に挟まれた中間の位置教示
点をX1としてステップS24へ進む。
点間に挟まれた位置教示点が1つ存在し、ステップS21
において図示の作業教示点に進行区間始点Xsが設定さ
れている場合、次に塗装作業ONとする点までの教示点
数は‘1’となる。この場合にはステップS23へ進み、
塗装作業OFFの最初の点(すなわち、進行区間始点X
s。以下においても同様)をX0、次に塗装作業ONとす
る点をX2、これらの点の間に挟まれた中間の位置教示
点をX1としてステップS24へ進む。
【0058】ステップS24では、上記ステップS23で設
定した点X0、X1、X2により生成される三角形を決定
し、線分X0X1と線分X1X2の長さの和より短く(すな
わち、教示点間を直線でつないだ軌道より短く)、同三
角形に内接する滑らかな曲線(図中に符号Cbで示すよ
うな曲線)を表す式を補間式として生成する。これによ
り、点X0〜点X2の間、すなわち、図8の(b)に示す
ような塗装作業OFF区間について、教示点に従った軌
道よりも短く、かつ、塗装作業ON区間と滑らかにつな
がる軌道を規定する補間式を生成する。
定した点X0、X1、X2により生成される三角形を決定
し、線分X0X1と線分X1X2の長さの和より短く(すな
わち、教示点間を直線でつないだ軌道より短く)、同三
角形に内接する滑らかな曲線(図中に符号Cbで示すよ
うな曲線)を表す式を補間式として生成する。これによ
り、点X0〜点X2の間、すなわち、図8の(b)に示す
ような塗装作業OFF区間について、教示点に従った軌
道よりも短く、かつ、塗装作業ON区間と滑らかにつな
がる軌道を規定する補間式を生成する。
【0059】他方、図8の(c)に示すように作業教示
点間に挟まれた位置教示点が2つ存在し、ステップS21
において図示の作業教示点に進行区間始点Xsが設定さ
れている場合、次に塗装作業ONとする点までの教示点
数は‘2’となる。この場合にはステップS25へ進み、
塗装作業OFFの最初の点をX0、次に塗装作業ONと
する点をX3、これらの点の間に挟まれた中間の位置教
示点をX1、X2としてステップS26へ進む。
点間に挟まれた位置教示点が2つ存在し、ステップS21
において図示の作業教示点に進行区間始点Xsが設定さ
れている場合、次に塗装作業ONとする点までの教示点
数は‘2’となる。この場合にはステップS25へ進み、
塗装作業OFFの最初の点をX0、次に塗装作業ONと
する点をX3、これらの点の間に挟まれた中間の位置教
示点をX1、X2としてステップS26へ進む。
【0060】ステップS26では、上記ステップS25で設
定した点X1、X2の中点を求め、これを点X4とする。
次いでステップS27へ進み、上記ステップS25で設定し
た点X0、X3及びステップS26で求めた点X4により生
成される三角形を決定し、線分X0X4と線分X4X3の長
さの和より短く、同三角形に内接する滑らかな曲線(図
中に符号Ccで示すような曲線)を表す式を補間式とし
て生成する。これにより、点X0〜点X3の間、すなわ
ち、図8の(c)に示すような塗装作業OFF区間につ
いて、教示点に従った軌道よりも短く、かつ、塗装作業
ON区間と滑らかにつながる軌道を規定する補間式を生
成する。
定した点X1、X2の中点を求め、これを点X4とする。
次いでステップS27へ進み、上記ステップS25で設定し
た点X0、X3及びステップS26で求めた点X4により生
成される三角形を決定し、線分X0X4と線分X4X3の長
さの和より短く、同三角形に内接する滑らかな曲線(図
中に符号Ccで示すような曲線)を表す式を補間式とし
て生成する。これにより、点X0〜点X3の間、すなわ
ち、図8の(c)に示すような塗装作業OFF区間につ
いて、教示点に従った軌道よりも短く、かつ、塗装作業
ON区間と滑らかにつながる軌道を規定する補間式を生
成する。
【0061】又、図8の(d)に示すように作業教示点
間に挟まれた位置教示点が3つ以上存在し、ステップS
21において図示の作業教示点に進行区間始点Xsが設定
されている場合、次に塗装作業ONとする点までの教示
点数は‘3以上’となる。この場合にはステップS28へ
進み、教示データで指示された各位置教示点間の補間方
法(図中の位置教示点間それぞれの補間情報)に従い、
各位置教示点間を滑らかにつなぐ補間式を生成する。
間に挟まれた位置教示点が3つ以上存在し、ステップS
21において図示の作業教示点に進行区間始点Xsが設定
されている場合、次に塗装作業ONとする点までの教示
点数は‘3以上’となる。この場合にはステップS28へ
進み、教示データで指示された各位置教示点間の補間方
法(図中の位置教示点間それぞれの補間情報)に従い、
各位置教示点間を滑らかにつなぐ補間式を生成する。
【0062】処理Aでは、以上のようにして進行区間の
作業がOFFである場合(作業を停止する場合)の補間
式が生成される。これにより、その生成された補間式に
よって求められる目標位置と目標姿勢による軌道生成が
行われ、塗装作業を行わない非作業区間については、も
ともとの教示点の位置を考慮して新たに生成された軌道
が再生されることになる。そして、この新たな軌道は、
図8に破線で示すように非作業区間の始点と終点である
教示点を通り、それら教示点間の他の教示点近傍を通過
するものとなる。
作業がOFFである場合(作業を停止する場合)の補間
式が生成される。これにより、その生成された補間式に
よって求められる目標位置と目標姿勢による軌道生成が
行われ、塗装作業を行わない非作業区間については、も
ともとの教示点の位置を考慮して新たに生成された軌道
が再生されることになる。そして、この新たな軌道は、
図8に破線で示すように非作業区間の始点と終点である
教示点を通り、それら教示点間の他の教示点近傍を通過
するものとなる。
【0063】2.他の補間式生成形態による軌道生成 図8の(d)に示すような場合にあっては、上記ステッ
プS28のように教示データに基づいて補間式を生成する
こととしてもよいが、図9に示すような処理によって中
間の位置教示点を省略する補間式を生成することとして
もよい。以下、図9の処理による補間式の生成について
説明する。
プS28のように教示データに基づいて補間式を生成する
こととしてもよいが、図9に示すような処理によって中
間の位置教示点を省略する補間式を生成することとして
もよい。以下、図9の処理による補間式の生成について
説明する。
【0064】図9の処理では、まず、塗装作業OFFの
最初の点をxs、次に塗装作業ONとする点をxeとし、
これらの点の間に挟まれた中間の位置教示点の数をnと
する(ステップS30。併せて図8の(d)参照)。次い
でステップS31でn/2が整数かどうかを判断し、これ
が整数でないときには位置教示点P(n/2-0.5)とP(n/2+
0.5)との間の中点を中間点xcとする(ステップS3
2)。これに対し、n/2が整数であるときには位置教
示点P(n/2)を中間点xcとする(ステップS33)。但
し、ここにいう位置教示点の番号は、点xsと点xeとの
間にある位置教示点のみについて順次付した番号を表し
ており、(n/2-0.5)と(n/2+0.5)はn個の位置教示点中の
中央にある2つの位置教示点の番号に相当し、(n/2)は
n個の位置教示点中の中央にある位置教示点の番号に相
当する。
最初の点をxs、次に塗装作業ONとする点をxeとし、
これらの点の間に挟まれた中間の位置教示点の数をnと
する(ステップS30。併せて図8の(d)参照)。次い
でステップS31でn/2が整数かどうかを判断し、これ
が整数でないときには位置教示点P(n/2-0.5)とP(n/2+
0.5)との間の中点を中間点xcとする(ステップS3
2)。これに対し、n/2が整数であるときには位置教
示点P(n/2)を中間点xcとする(ステップS33)。但
し、ここにいう位置教示点の番号は、点xsと点xeとの
間にある位置教示点のみについて順次付した番号を表し
ており、(n/2-0.5)と(n/2+0.5)はn個の位置教示点中の
中央にある2つの位置教示点の番号に相当し、(n/2)は
n個の位置教示点中の中央にある位置教示点の番号に相
当する。
【0065】これにより、n/2が整数かどうかに応じ
て中間点xcを設定し、ステップS34の処理へ進む。ス
テップS34では、点xs、点xc及び点xeを滑らかにつ
なぐ曲線(例えば2次曲線)であって、三角形xsxcx
eに内接するもの(図8の(d)中に符号Cdで示すよう
な曲線)を表す式を求める。
て中間点xcを設定し、ステップS34の処理へ進む。ス
テップS34では、点xs、点xc及び点xeを滑らかにつ
なぐ曲線(例えば2次曲線)であって、三角形xsxcx
eに内接するもの(図8の(d)中に符号Cdで示すよう
な曲線)を表す式を求める。
【0066】その後、ステップS35へ進み、上記ステッ
プS34で求めた曲線と、点xsと点xeの間にある位置教
示点をすべてつないで生成される折れ線(基準軌道)と
のずれを確認するため、同曲線と同折れ線とのずれ距離
を軌道進行方向の所定間隔dx毎に算出する。
プS34で求めた曲線と、点xsと点xeの間にある位置教
示点をすべてつないで生成される折れ線(基準軌道)と
のずれを確認するため、同曲線と同折れ線とのずれ距離
を軌道進行方向の所定間隔dx毎に算出する。
【0067】そして、それら所定間隔dx毎のずれ距離
が所定値εより小さいかどうかを判断し(ステップS3
6)、小さければ点xsと点xeの間の軌道についての補
間式を上記ステップS34で求めた曲線を表す式に決定す
る(ステップS37)。ここに、所定値εとは、新たに求
めた補間式によって表される軌道がもとの教示データに
基づく軌道に対して妥当なものかどうかを判断するため
の基準値であり、ワークや周辺機器の状況、教示プログ
ラムの具体的内容等に応じて予め定めておく。これによ
り、図8の(d)に示すような塗装作業OFF区間につ
いて、教示点に従った軌道よりも短く、かつ、塗装作業
ON区間と滑らかにつながる軌道を規定する補間式を生
成する。
が所定値εより小さいかどうかを判断し(ステップS3
6)、小さければ点xsと点xeの間の軌道についての補
間式を上記ステップS34で求めた曲線を表す式に決定す
る(ステップS37)。ここに、所定値εとは、新たに求
めた補間式によって表される軌道がもとの教示データに
基づく軌道に対して妥当なものかどうかを判断するため
の基準値であり、ワークや周辺機器の状況、教示プログ
ラムの具体的内容等に応じて予め定めておく。これによ
り、図8の(d)に示すような塗装作業OFF区間につ
いて、教示点に従った軌道よりも短く、かつ、塗装作業
ON区間と滑らかにつながる軌道を規定する補間式を生
成する。
【0068】一方、所定間隔dx毎のずれ距離が所定値
εより小さくなければ、点xsと点xeの間の軌道につい
ての補間式を上記図7のステップS28同様に教示データ
に基づいて生成することとし、上記ステップS34で求め
た曲線を表す式は用いないことにする(ステップS3
8)。
εより小さくなければ、点xsと点xeの間の軌道につい
ての補間式を上記図7のステップS28同様に教示データ
に基づいて生成することとし、上記ステップS34で求め
た曲線を表す式は用いないことにする(ステップS3
8)。
【0069】図9の処理では、以上のようにして中間の
位置教示点を省略する補間式を生成する。この図9の処
理による補間式生成を利用する場合には、図6のステッ
プS18での処理Aにおいて進行区間始点Xsが塗装作業
OFFの最初の点であり、かつ、次に塗装作業ONとす
る点までの教示点数が‘3以上’であったときに、図7
のステップS28に代えて上述した図9の処理で補間式を
生成し、軌道を生成することとする。
位置教示点を省略する補間式を生成する。この図9の処
理による補間式生成を利用する場合には、図6のステッ
プS18での処理Aにおいて進行区間始点Xsが塗装作業
OFFの最初の点であり、かつ、次に塗装作業ONとす
る点までの教示点数が‘3以上’であったときに、図7
のステップS28に代えて上述した図9の処理で補間式を
生成し、軌道を生成することとする。
【0070】以上述べたように、非作業区間内の教示点
の数に応じて軌道生成の形態を変更することとすれば、
もともとの非作業区間の軌道を十分考慮してタクトタイ
ムを短縮するためのより適切な軌道を生成することがで
きる。
の数に応じて軌道生成の形態を変更することとすれば、
もともとの非作業区間の軌道を十分考慮してタクトタイ
ムを短縮するためのより適切な軌道を生成することがで
きる。
【0071】尚、上述した処理によって当初の軌道より
短い軌道を生成した後に、上述したような処理を再び行
って更に短い軌道を生成することとしてもよく、短い軌
道を生成する処理を複数回繰り返し行うこととしてもよ
い。このようにする場合のそれぞれの軌道生成処理にお
いては、前回行われた軌道生成処理によって生成された
短い軌道を当初の軌道とし、これより更に短い軌道を生
成することとする。
短い軌道を生成した後に、上述したような処理を再び行
って更に短い軌道を生成することとしてもよく、短い軌
道を生成する処理を複数回繰り返し行うこととしてもよ
い。このようにする場合のそれぞれの軌道生成処理にお
いては、前回行われた軌道生成処理によって生成された
短い軌道を当初の軌道とし、これより更に短い軌道を生
成することとする。
【0072】3.マニピュレータ5等の動作制御 次に、上述のようにして生成される補間式を用い、マニ
ピュレータ5を実際に動作させて軌道を生成する処理に
ついて説明する。図10は、マニピュレータ5と塗装ガ
ン7等の塗装機器の動作を制御する処理手順を示す図で
ある。この図に示す処理は、非常に短い一定時間毎(例
えば5ms毎)にコントローラ1において行われるもの
で、ここにいう一定時間とは、コントローラ1とマニピ
ュレータ5等との間で各可動部の回転角度データや動作
指令信号等の授受が行われる制御周期がこれに当たる。
ピュレータ5を実際に動作させて軌道を生成する処理に
ついて説明する。図10は、マニピュレータ5と塗装ガ
ン7等の塗装機器の動作を制御する処理手順を示す図で
ある。この図に示す処理は、非常に短い一定時間毎(例
えば5ms毎)にコントローラ1において行われるもの
で、ここにいう一定時間とは、コントローラ1とマニピ
ュレータ5等との間で各可動部の回転角度データや動作
指令信号等の授受が行われる制御周期がこれに当たる。
【0073】図10においては、まず、コントローラ1
が塗装ガン7の現在位置及び現在姿勢のフィードバック
値を取り込む(ステップS40)。すなわち、各可動部駆
動ユニットから供給されている各可動部の回転角度θ1
〜θ6を演算装置10がモータドライバD1〜D6、イン
ターフェイス13を介して取り込み、これらの取り込ん
だデータに基づいて塗装ガン7の現在位置(ガン先7x
の現在位置)と現在姿勢(塗装ガン7のねらい方向)を
算出して取得する。尚、この現在位置と現在姿勢は、幾
何学的手法により、各可動部の回転角度θ1〜θ6の関数
として算出することができる。
が塗装ガン7の現在位置及び現在姿勢のフィードバック
値を取り込む(ステップS40)。すなわち、各可動部駆
動ユニットから供給されている各可動部の回転角度θ1
〜θ6を演算装置10がモータドライバD1〜D6、イン
ターフェイス13を介して取り込み、これらの取り込ん
だデータに基づいて塗装ガン7の現在位置(ガン先7x
の現在位置)と現在姿勢(塗装ガン7のねらい方向)を
算出して取得する。尚、この現在位置と現在姿勢は、幾
何学的手法により、各可動部の回転角度θ1〜θ6の関数
として算出することができる。
【0074】次に、コントローラ1(演算装置10)
は、各種アラームデータを取り込む(ステップS41)。
ここに、アラームとは、マニピュレータ5や塗装機器に
おける種々の異常(部品の損傷やチューブの破損等)が
発生したときに発せられるものである。本実施形態では
特に説明しないが、塗装ロボットシステム等において
は、かかる種々の異常を検出するための手段が適宜設け
られ、異常が検出されたときにその異常発生を知らせる
データがアラームデータとしてコントローラ1へ供給さ
れる。ステップS41で取り込むアラームデータとは、こ
のような種々の異常についてのアラームデータのことを
意味する。
は、各種アラームデータを取り込む(ステップS41)。
ここに、アラームとは、マニピュレータ5や塗装機器に
おける種々の異常(部品の損傷やチューブの破損等)が
発生したときに発せられるものである。本実施形態では
特に説明しないが、塗装ロボットシステム等において
は、かかる種々の異常を検出するための手段が適宜設け
られ、異常が検出されたときにその異常発生を知らせる
データがアラームデータとしてコントローラ1へ供給さ
れる。ステップS41で取り込むアラームデータとは、こ
のような種々の異常についてのアラームデータのことを
意味する。
【0075】続いてステップS42へ進み、取り込んだア
ラームデータに基づいてアラームが発生しているかどう
かを判断する。このとき、アラームが発生していれば、
塗装ガン7の目標位置や目標姿勢、塗装ガン7の塗料噴
射動作や塗料供給装置の塗料供給動作等を指示する各種
指令信号のデータにロボット(マニピュレータ5及び塗
装機器)を停止させるパラメータ値をセットする。
ラームデータに基づいてアラームが発生しているかどう
かを判断する。このとき、アラームが発生していれば、
塗装ガン7の目標位置や目標姿勢、塗装ガン7の塗料噴
射動作や塗料供給装置の塗料供給動作等を指示する各種
指令信号のデータにロボット(マニピュレータ5及び塗
装機器)を停止させるパラメータ値をセットする。
【0076】一方、アラームが発生していなければステ
ップS42からステップS44へ進み、現在教示プログラム
の再生中であるかどうかを判断する。ここで、教示プロ
グラムの再生中でない場合にはステップS45へ進み、次
の目標位置と目標姿勢を現在の目標位置と目標姿勢のま
まとする。
ップS42からステップS44へ進み、現在教示プログラム
の再生中であるかどうかを判断する。ここで、教示プロ
グラムの再生中でない場合にはステップS45へ進み、次
の目標位置と目標姿勢を現在の目標位置と目標姿勢のま
まとする。
【0077】これに対し、教示プログラムの再生中であ
る場合にはステップS44からステップS46へ進み、カウ
ンタlの値を1インクリメントする。ここに、カウンタ
lは、補間式により目標位置及び目標姿勢を算出するた
めの無次元化した時間を示す変数であり、上述したよう
に生成される補間式における変数に相当する。
る場合にはステップS44からステップS46へ進み、カウ
ンタlの値を1インクリメントする。ここに、カウンタ
lは、補間式により目標位置及び目標姿勢を算出するた
めの無次元化した時間を示す変数であり、上述したよう
に生成される補間式における変数に相当する。
【0078】次に、ステップS47でカウンタlの値が総
補間数Tを超えたかどうかを判断する。ここに、総補間
数Tとは、現在使用している補間式に制御周期毎のカウ
ンタlの値を代入し、順次当該補間式による目標位置と
目標姿勢を求めて塗装ガン7を移動させる教示点間(位
置教示点と作業教示点の双方を含む全教示点のそれぞれ
の間のうちの一つ)の区間における補間点の総数であ
り、その区間での移動速度に応じて定まる。例えば、当
該教示点間の区間の長さをL、移動速度をV(長さ/制
御周期)とすれば、総補間点数TはL/Vである。これ
は、同区間を移動するのに要する時間を無次元化した制
御周期のカウント数値に相当することになるので、ステ
ップS46でインクリメントされたカウンタlの値が総補
間数Tを超えたかどうかを判断することは、塗装ガン7
が当該補間式によって軌道を規定される教示点間区間の
終了点に到達したかどうかを判断することに相当する。
補間数Tを超えたかどうかを判断する。ここに、総補間
数Tとは、現在使用している補間式に制御周期毎のカウ
ンタlの値を代入し、順次当該補間式による目標位置と
目標姿勢を求めて塗装ガン7を移動させる教示点間(位
置教示点と作業教示点の双方を含む全教示点のそれぞれ
の間のうちの一つ)の区間における補間点の総数であ
り、その区間での移動速度に応じて定まる。例えば、当
該教示点間の区間の長さをL、移動速度をV(長さ/制
御周期)とすれば、総補間点数TはL/Vである。これ
は、同区間を移動するのに要する時間を無次元化した制
御周期のカウント数値に相当することになるので、ステ
ップS46でインクリメントされたカウンタlの値が総補
間数Tを超えたかどうかを判断することは、塗装ガン7
が当該補間式によって軌道を規定される教示点間区間の
終了点に到達したかどうかを判断することに相当する。
【0079】従って、ステップS47において、カウンタ
lの値が総補間数Tを超えていた場合には、現在使用し
ている補間式によって軌道を生成すべき教示点間区間の
終了点に到達したものとして、進行区間始点Xsと進行
区間終点Xeを次の教示点に進めて上述した補間式生成
処理を行い、以後、新たに生成された補間式(但し、常
に新たな補間式が生成されるとは限らず、前補間式を継
続使用する場合もあるのは上述の通りである。)によっ
て軌道生成をすることができるようにするための処理を
行う。この処理では、まず、カウンタlの値を‘0’と
してクリアし(ステップS48)、次いで上記カウンタk
の値を1インクリメントする(ステップS49)。
lの値が総補間数Tを超えていた場合には、現在使用し
ている補間式によって軌道を生成すべき教示点間区間の
終了点に到達したものとして、進行区間始点Xsと進行
区間終点Xeを次の教示点に進めて上述した補間式生成
処理を行い、以後、新たに生成された補間式(但し、常
に新たな補間式が生成されるとは限らず、前補間式を継
続使用する場合もあるのは上述の通りである。)によっ
て軌道生成をすることができるようにするための処理を
行う。この処理では、まず、カウンタlの値を‘0’と
してクリアし(ステップS48)、次いで上記カウンタk
の値を1インクリメントする(ステップS49)。
【0080】次に、インクリメントされたカウンタkの
値が上述の作業点数mを超えたかどうかを判断する(ス
テップS50)。ここで、カウンタkの値が作業点数mを
超えていればこれを‘0’としてクリアし(ステップS
51)、その後、上述のカウンタiの値を1インクリメン
トする(ステップS52)。
値が上述の作業点数mを超えたかどうかを判断する(ス
テップS50)。ここで、カウンタkの値が作業点数mを
超えていればこれを‘0’としてクリアし(ステップS
51)、その後、上述のカウンタiの値を1インクリメン
トする(ステップS52)。
【0081】このように、ステップS48〜S52での処理
により、塗装ガン7が1つの教示点間区間の終了点に到
達する度に、補間式中の変数カウンタlがクリアされる
と共に、カウンタkの値がインクリメントされる。そし
て、カウンタkの値は作業点数mの値を超えたときにク
リアされ、これと同時にカウンタiの値がインクリメン
トされる。この結果、カウンタkの値は、上述したよう
に塗装ガン7が移動中の位置教示点間区間における到達
作業教示点数を示すものとなり、カウンタiの値は、塗
装ガン7が直前に到達した位置教示点の番号を示すこと
になる。又、ステップS52でインクリメントされた時点
でのカウンタiの値は、塗装ガン7が現在到達している
位置教示点の番号を示すことになる。
により、塗装ガン7が1つの教示点間区間の終了点に到
達する度に、補間式中の変数カウンタlがクリアされる
と共に、カウンタkの値がインクリメントされる。そし
て、カウンタkの値は作業点数mの値を超えたときにク
リアされ、これと同時にカウンタiの値がインクリメン
トされる。この結果、カウンタkの値は、上述したよう
に塗装ガン7が移動中の位置教示点間区間における到達
作業教示点数を示すものとなり、カウンタiの値は、塗
装ガン7が直前に到達した位置教示点の番号を示すこと
になる。又、ステップS52でインクリメントされた時点
でのカウンタiの値は、塗装ガン7が現在到達している
位置教示点の番号を示すことになる。
【0082】上述した図6のステップS5以下の処理
は、これら図10のステップS48〜S52での処理により
各カウンタ値の更新がなされる度に実行される。これに
より、図6のステップS5〜S15の処理によって塗装ガ
ン7がこれから侵入しようとする教示点間区間が上記進
行区間に設定され、その進行区間における作業内容(O
NかOFFか)がステップS16でチェックされ、そのチ
ェック結果に応じた補間式の生成がステップS17又はS
18(図7、図9)の処理によって行われて軌道が生成さ
れることになる。但し、上述したように、補間式の生成
処理を行っても、更新されたカウンタkが示す作業教示
点が塗装作業OFFの最初の点でない場合は、前回まで
使用していた補間式をそのまま継続して使用することに
なる。
は、これら図10のステップS48〜S52での処理により
各カウンタ値の更新がなされる度に実行される。これに
より、図6のステップS5〜S15の処理によって塗装ガ
ン7がこれから侵入しようとする教示点間区間が上記進
行区間に設定され、その進行区間における作業内容(O
NかOFFか)がステップS16でチェックされ、そのチ
ェック結果に応じた補間式の生成がステップS17又はS
18(図7、図9)の処理によって行われて軌道が生成さ
れることになる。但し、上述したように、補間式の生成
処理を行っても、更新されたカウンタkが示す作業教示
点が塗装作業OFFの最初の点でない場合は、前回まで
使用していた補間式をそのまま継続して使用することに
なる。
【0083】尚、図10のステップS52でカウンタiを
インクリメントした後に、ステップS53でカウンタiの
値が位置教示点の最終番号を超えたかどうかを判断し、
超えている場合には教示プログラムの再生が終了したと
してコントローラ1が動作終了信号を送信するので、こ
の場合には補間式生成等の処理を行わずにそのまま動作
を終了する(図6のステップS4)。
インクリメントした後に、ステップS53でカウンタiの
値が位置教示点の最終番号を超えたかどうかを判断し、
超えている場合には教示プログラムの再生が終了したと
してコントローラ1が動作終了信号を送信するので、こ
の場合には補間式生成等の処理を行わずにそのまま動作
を終了する(図6のステップS4)。
【0084】次に、ステップS55へ進み、補間式により
塗装ガン7を次に移動させるべき目標位置と目標姿勢を
算出する。この算出演算は、上記ステップS47でカウン
タlの値が総補間数Tを超えていた場合には上述のよう
にして生成された補間式とクリアされたカウンタlの値
を用いて行い、超えていなかった場合には前制御周期同
様の補間式と上記ステップS46でインクリメントされた
カウンタlの値を用いて行う。
塗装ガン7を次に移動させるべき目標位置と目標姿勢を
算出する。この算出演算は、上記ステップS47でカウン
タlの値が総補間数Tを超えていた場合には上述のよう
にして生成された補間式とクリアされたカウンタlの値
を用いて行い、超えていなかった場合には前制御周期同
様の補間式と上記ステップS46でインクリメントされた
カウンタlの値を用いて行う。
【0085】続いて、教示データに基づいて塗装ガン7
に対する塗料噴射動作のON/OFF指令データ等をセ
ットする(ステップS56)。尚、ON/OFF指令デー
タ以外の指令データには塗料の色彩切替を指示するデー
タ等があり、これらも併せてセットする。
に対する塗料噴射動作のON/OFF指令データ等をセ
ットする(ステップS56)。尚、ON/OFF指令デー
タ以外の指令データには塗料の色彩切替を指示するデー
タ等があり、これらも併せてセットする。
【0086】その後、ステップS40で取り込んだ現在位
置及び現在姿勢と、ステップS45で設定した目標位置及
び目標姿勢又はステップS55で算出した目標位置及び目
標姿勢とに基づき、演算装置10がモータドライバD1
〜D6へ出力すべきマニピュレータ5の動作に対する指
令信号を算出する(ステップS57)。
置及び現在姿勢と、ステップS45で設定した目標位置及
び目標姿勢又はステップS55で算出した目標位置及び目
標姿勢とに基づき、演算装置10がモータドライバD1
〜D6へ出力すべきマニピュレータ5の動作に対する指
令信号を算出する(ステップS57)。
【0087】そして、ステップS58へ進み、演算装置1
0がステップS57で算出した指令信号をインターフェイ
ス13を介してモータドライバD1〜D6へ出力する。こ
れにより、マニピュレータ5の各可動部へ動作指令信号
が供給され、マニピュレータ5の動作が制御される。
又、コントローラ1は、同時にステップS56でデータを
セットした指令信号を塗装機器に対して送信し、塗装機
器による塗装作業の実施内容も制御する。
0がステップS57で算出した指令信号をインターフェイ
ス13を介してモータドライバD1〜D6へ出力する。こ
れにより、マニピュレータ5の各可動部へ動作指令信号
が供給され、マニピュレータ5の動作が制御される。
又、コントローラ1は、同時にステップS56でデータを
セットした指令信号を塗装機器に対して送信し、塗装機
器による塗装作業の実施内容も制御する。
【0088】ここで、上記ステップS45で目標位置等を
設定した場合にあっては、ステップS58では前回同様の
目標位置等を指示する指令信号が出力されることにな
る。従って、この場合は指令信号が出力されてもマニピ
ュレータ5は動作しないが、これは上記図6のステップ
S2における待機状態の場合に相当するものである。
設定した場合にあっては、ステップS58では前回同様の
目標位置等を指示する指令信号が出力されることにな
る。従って、この場合は指令信号が出力されてもマニピ
ュレータ5は動作しないが、これは上記図6のステップ
S2における待機状態の場合に相当するものである。
【0089】又、上記ステップS43で指令信号のデータ
をセットした場合にあっては、ステップS58ではコント
ローラ1がその指令信号をマニピュレータ5と塗装機器
に対して送信し、ロボットの動作を停止させる。
をセットした場合にあっては、ステップS58ではコント
ローラ1がその指令信号をマニピュレータ5と塗装機器
に対して送信し、ロボットの動作を停止させる。
【0090】以後、制御周期毎に上記図10の処理が同
様に繰り返されると共に、ステップS48〜S52で各カウ
ンタ値が更新されれば軌道生成(補間式生成)の処理が
上述したように実行され、順次、教示点間を移動する塗
装ガン7の移動軌道とマニピュレータ5の動作軌道が生
成されていく。これにより、本塗装ロボットシステムで
は、塗装作業ONの教示点間区間(作業区間)では教示
データに基づく軌道が再生され、塗装作業OFFの教示
点間区間(非作業区間)では教示データ(教示点位置)
に基づくより短い軌道が再生されることになる。そし
て、この塗装作業OFFの教示点間区間において再生さ
れる軌道は教示データに基づく軌道をもとにして生成さ
れたものであるため、図8に示すように、塗装作業ON
の教示点間区間への出入り位置付近でも軌道が滑らかに
つながることになり、適切な軌跡精度を維持することが
できる。
様に繰り返されると共に、ステップS48〜S52で各カウ
ンタ値が更新されれば軌道生成(補間式生成)の処理が
上述したように実行され、順次、教示点間を移動する塗
装ガン7の移動軌道とマニピュレータ5の動作軌道が生
成されていく。これにより、本塗装ロボットシステムで
は、塗装作業ONの教示点間区間(作業区間)では教示
データに基づく軌道が再生され、塗装作業OFFの教示
点間区間(非作業区間)では教示データ(教示点位置)
に基づくより短い軌道が再生されることになる。そし
て、この塗装作業OFFの教示点間区間において再生さ
れる軌道は教示データに基づく軌道をもとにして生成さ
れたものであるため、図8に示すように、塗装作業ON
の教示点間区間への出入り位置付近でも軌道が滑らかに
つながることになり、適切な軌跡精度を維持することが
できる。
【0091】
【発明の効果】以上説明したように本発明によれば、作
業手段を移動させる軌道上で作業を行わない非作業区間
の教示点を判別し、その区間に始点及び終点の教示点以
外の教示点があったときには、それらの教示点に基づい
て当該区間についての軌道を新たに生成することとした
ので、作業を行う区間については教示点に従った軌道で
作業手段を移動させ、作業を行わない区間についてのみ
教示点に基づいて新たに生成した軌道で作業手段を移動
させることができる。これにより、新たな非作業区間の
軌道を生成してタクトタイムを短縮し、生産効率の向
上、消費電力の低減及びこれによるランニングコストの
低減等を図ることができるという効果が得られる。
業手段を移動させる軌道上で作業を行わない非作業区間
の教示点を判別し、その区間に始点及び終点の教示点以
外の教示点があったときには、それらの教示点に基づい
て当該区間についての軌道を新たに生成することとした
ので、作業を行う区間については教示点に従った軌道で
作業手段を移動させ、作業を行わない区間についてのみ
教示点に基づいて新たに生成した軌道で作業手段を移動
させることができる。これにより、新たな非作業区間の
軌道を生成してタクトタイムを短縮し、生産効率の向
上、消費電力の低減及びこれによるランニングコストの
低減等を図ることができるという効果が得られる。
【0092】ここで、新たな非作業区間の軌道は、作業
区間の軌道とつながるもともとの非作業区間の軌道を決
定する教示点に基づいて生成することとするので、軌道
再生時の作業区間における作業手段の軌跡精度を損なう
ことはなく、周辺機器やワーク等と干渉することもな
い。これにより、安全性も確保しつつ、上述のように生
産効率の向上や消費電力の低減等を図ることができる。
区間の軌道とつながるもともとの非作業区間の軌道を決
定する教示点に基づいて生成することとするので、軌道
再生時の作業区間における作業手段の軌跡精度を損なう
ことはなく、周辺機器やワーク等と干渉することもな
い。これにより、安全性も確保しつつ、上述のように生
産効率の向上や消費電力の低減等を図ることができる。
【0093】更に、非作業区間の軌道を軌道生成手段に
よって生成するので、教示の際には軌道上の教示点と作
業内容を教示し、作業を優先して適宜移動速度等を教示
するだけでよく、タクトタイムを短縮するための教示デ
ータの修正を行う必要はない。従って、教示修正時間の
短縮を図ることができるという効果も得られる。
よって生成するので、教示の際には軌道上の教示点と作
業内容を教示し、作業を優先して適宜移動速度等を教示
するだけでよく、タクトタイムを短縮するための教示デ
ータの修正を行う必要はない。従って、教示修正時間の
短縮を図ることができるという効果も得られる。
【0094】尚、請求項2記載の発明によれば、教示点
に従った当初の軌道より短い軌道を非作業区間の軌道と
して生成することとしたので、移動速度の大きさが同じ
でもタクトタイムを確実に短縮できる。
に従った当初の軌道より短い軌道を非作業区間の軌道と
して生成することとしたので、移動速度の大きさが同じ
でもタクトタイムを確実に短縮できる。
【図1】 本発明の一実施形態によるロボット制御装置
を適用した塗装ロボットシステム全体の外観構成を示す
図である。
を適用した塗装ロボットシステム全体の外観構成を示す
図である。
【図2】 同塗装ロボットシステムにおける信号の系統
図である。
図である。
【図3】 塗装作業の一例を模式的に示した図である。
【図4】 教示プログラムの形態の一例を示す図であ
る。
る。
【図5】 図4の教示プログラムの各部を構成するデー
タの具体例を示す図である。
タの具体例を示す図である。
【図6】 同塗装ロボットシステムにおける動作開始時
の処理と動作開始以降に行う軌道生成演算処理の手順を
示す図である。
の処理と動作開始以降に行う軌道生成演算処理の手順を
示す図である。
【図7】 図6のステップS18で行う処理Aの手順を示
す図である。
す図である。
【図8】 教示点の種々の配列例に対する軌道生成の様
子を示す図である。
子を示す図である。
【図9】 中間の位置教示点を省略して補間式を生成す
る処理の手順を示す図である。
る処理の手順を示す図である。
【図10】 マニピュレータ5と塗装機器の動作を制御
する処理手順を示す図である。
する処理手順を示す図である。
1 コントローラ 2 入力装置 5 マニピュレータ 6 色替えバルブ 7 塗装ガン 10 演算装置 11 記憶装置
Claims (2)
- 【請求項1】 ワークに対して作業を実施する作業手段
を有するロボットを制御するロボット制御装置におい
て、 前記作業手段を移動させる軌道上の教示点と前記作業手
段の前記軌道上における作業内容とに基づき、前記軌道
における前記作業手段の非作業区間の教示点を判別する
判別手段と、 前記判別手段の判別結果により、前記区間の始点及び終
点の教示点間に他の教示点があったとき、当該始点及び
終点の教示点と当該他の教示点とに基づいて当該区間に
ついての前記作業手段を移動させる軌道を新たに生成す
る軌道生成手段とを有することを特徴とするロボット制
御装置。 - 【請求項2】 請求項1記載のロボット制御装置におい
て、 前記軌道生成手段は、当該区間についての前記作業手段
を移動させる軌道として、当該始点及び終点の教示点と
当該他の教示点とに従った当初の軌道より短い軌道を生
成することを特徴とするロボット制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP10150261A JPH11345018A (ja) | 1998-05-29 | 1998-05-29 | ロボット制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP10150261A JPH11345018A (ja) | 1998-05-29 | 1998-05-29 | ロボット制御装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
JPH11345018A true JPH11345018A (ja) | 1999-12-14 |
Family
ID=15493083
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP10150261A Withdrawn JPH11345018A (ja) | 1998-05-29 | 1998-05-29 | ロボット制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPH11345018A (ja) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2012003749A (ja) * | 2010-06-18 | 2012-01-05 | Compal Communications Inc | 自動装置とその制御方法 |
JP2016172308A (ja) * | 2015-03-18 | 2016-09-29 | 蛇の目ミシン工業株式会社 | ロボット |
JPWO2017072979A1 (ja) * | 2015-10-30 | 2018-07-26 | 株式会社安川電機 | ロボット教示装置、コンピュータプログラム及びロボット教示方法 |
CN110977959A (zh) * | 2018-10-03 | 2020-04-10 | 卡西欧计算机株式会社 | 控制装置、机器人、控制方法以及存储介质 |
WO2023248602A1 (ja) * | 2022-06-20 | 2023-12-28 | 株式会社日立製作所 | ロボット教示装置およびロボット教示方法 |
-
1998
- 1998-05-29 JP JP10150261A patent/JPH11345018A/ja not_active Withdrawn
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2012003749A (ja) * | 2010-06-18 | 2012-01-05 | Compal Communications Inc | 自動装置とその制御方法 |
US8660691B2 (en) | 2010-06-18 | 2014-02-25 | Compal Communications, Inc. | Automatic machine and method for controlling the same |
JP2016172308A (ja) * | 2015-03-18 | 2016-09-29 | 蛇の目ミシン工業株式会社 | ロボット |
JPWO2017072979A1 (ja) * | 2015-10-30 | 2018-07-26 | 株式会社安川電機 | ロボット教示装置、コンピュータプログラム及びロボット教示方法 |
CN108349085A (zh) * | 2015-10-30 | 2018-07-31 | 株式会社安川电机 | 机器人教学装置、计算机程序和机器人教学方法 |
US11092950B2 (en) | 2015-10-30 | 2021-08-17 | Kabushiki Kaisha Yaskawa Denki | Robot teaching device, and robot teaching method |
CN110977959A (zh) * | 2018-10-03 | 2020-04-10 | 卡西欧计算机株式会社 | 控制装置、机器人、控制方法以及存储介质 |
WO2023248602A1 (ja) * | 2022-06-20 | 2023-12-28 | 株式会社日立製作所 | ロボット教示装置およびロボット教示方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4122652B2 (ja) | ロボットの制御装置 | |
JP4922584B2 (ja) | ロボットシステム | |
EP0144442A1 (en) | Method of controlling industrial robot along arc | |
US20110224815A1 (en) | Industrial Robot And Path Planning Method For Controlling The Movement Of An Industrial Robot | |
JPS63141110A (ja) | ロボットのデジタル制御装置 | |
US4967125A (en) | Tool posture control method for a robot | |
KR910009266B1 (ko) | 산업용 로보트의 속도 제어방법 및 장치 | |
JPWO2002066210A1 (ja) | ロボット制御装置 | |
CN114654446A (zh) | 一种机器人示教方法、装置、设备和介质 | |
JPH11345018A (ja) | ロボット制御装置 | |
JP2018164959A (ja) | ロボット装置 | |
JPH04235610A (ja) | 産業用ロボットの異常検出装置 | |
JPH08161015A (ja) | 多関節型ロボットの駆動制御方法 | |
CN112041128A (zh) | 机器人的教导方法和机器人的教导*** | |
JPH11188686A (ja) | ロボット制御装置 | |
JPH11191005A (ja) | ロボット制御装置 | |
JPH11277484A (ja) | 工業用ロボット | |
US5214748A (en) | Robot teaching/playback system | |
JPS62154006A (ja) | ロボツト制御装置 | |
JP3444313B2 (ja) | 工業用ロボットの制御装置 | |
JPH0420203B2 (ja) | ||
JP2000308990A (ja) | 工業用ロボット | |
JPH08194512A (ja) | ロボットの制御装置 | |
JPH1055207A (ja) | ロボット制御装置 | |
JP3644551B2 (ja) | ロボットの制御方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A300 | Withdrawal of application because of no request for examination |
Free format text: JAPANESE INTERMEDIATE CODE: A300 Effective date: 20050802 |