JPS63254503A - ロボツト制御装置 - Google Patents
ロボツト制御装置Info
- Publication number
- JPS63254503A JPS63254503A JP8833387A JP8833387A JPS63254503A JP S63254503 A JPS63254503 A JP S63254503A JP 8833387 A JP8833387 A JP 8833387A JP 8833387 A JP8833387 A JP 8833387A JP S63254503 A JPS63254503 A JP S63254503A
- Authority
- JP
- Japan
- Prior art keywords
- processing task
- robot
- interpolation
- point
- arithmetic
- 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
- 238000004364 calculation method Methods 0.000 abstract description 18
- 125000004122 cyclic group Chemical group 0.000 abstract description 2
- 238000000034 method Methods 0.000 description 5
- 238000010586 diagram Methods 0.000 description 4
- 230000006870 function Effects 0.000 description 3
- GNFTZDOKVXKIBK-UHFFFAOYSA-N 3-(2-methoxyethoxy)benzohydrazide Chemical compound COCCOC1=CC=CC(C(=O)NN)=C1 GNFTZDOKVXKIBK-UHFFFAOYSA-N 0.000 description 1
- 241001416181 Axis axis Species 0.000 description 1
- FGUUSXIOTUKUDN-IBGZPJMESA-N C1(=CC=CC=C1)N1C2=C(NC([C@H](C1)NC=1OC(=NN=1)C1=CC=CC=C1)=O)C=CC=C2 Chemical compound C1(=CC=CC=C1)N1C2=C(NC([C@H](C1)NC=1OC(=NN=1)C1=CC=CC=C1)=O)C=CC=C2 FGUUSXIOTUKUDN-IBGZPJMESA-N 0.000 description 1
- 238000007796 conventional method Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000006386 memory function Effects 0.000 description 1
Landscapes
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【発明の詳細な説明】
(産業上の利用分野)
本発明は、教示再生型の工業用ロボットの軌跡制御を行
なうロボット制御装置に関する。
なうロボット制御装置に関する。
(従来の技術)
産業用ロボットを所要の目的に従って機能させるために
は、あらかじめその作業を産業川口ボットに教え込ませ
る教示4!1俺、作業データを記憶する記憶機能、この
データを基にしてロボットハンドを所定の速度で軌跡制
御しながら作動させる再生機能が必要とされる。こうし
た現在の教示再生型のロボットでは、従来の軌跡制御の
ための演算方式としては、通路上の離散的な点列の位置
を予め教示し、各教示点に対応してlブ°ロックのロボ
ット指令データを作成し、再生時に1ブロツクづつロボ
ット指令データを読み出し、該データにノ。(づいてハ
ンドを移動させるようにしていた。
は、あらかじめその作業を産業川口ボットに教え込ませ
る教示4!1俺、作業データを記憶する記憶機能、この
データを基にしてロボットハンドを所定の速度で軌跡制
御しながら作動させる再生機能が必要とされる。こうし
た現在の教示再生型のロボットでは、従来の軌跡制御の
ための演算方式としては、通路上の離散的な点列の位置
を予め教示し、各教示点に対応してlブ°ロックのロボ
ット指令データを作成し、再生時に1ブロツクづつロボ
ット指令データを読み出し、該データにノ。(づいてハ
ンドを移動させるようにしていた。
この場合に、動作目標位置のデータをアームの各軸傾と
して記憶しているロボット制御装置では、データメモリ
に記憶された軌跡制御の起点と終点(及び経由点)の値
から通路上の分割点をオンラインで計算しながらロボッ
トの動作制御を行なっている。
して記憶しているロボット制御装置では、データメモリ
に記憶された軌跡制御の起点と終点(及び経由点)の値
から通路上の分割点をオンラインで計算しながらロボッ
トの動作制御を行なっている。
(発明が解決しようとする問題点)
一般に多軸のロボットを軌跡制御する場合に、移動指令
の出力の精度を高めようとすると、分割点を増やして補
間間隔を短縮しなければならないが、従来のロボット制
御装置では、通路上の分割点の座標値の計算結果を記憶
するバッファメモリと、計算された分割点を次の動作目
標点として移動処理するためのバッファメモリとの間で
のデータ転送を行なっており、現在目標としている分割
−瓦に関する移動指令の出力が終了するまで、次の分割
点に関する演算の実行ができず、その結果移動処理にお
けるパルス分配の速度によっては、ひとつの分割点の演
算終了から次の分割点の演算量′始までにアイドルタイ
ムが生じることがある。
の出力の精度を高めようとすると、分割点を増やして補
間間隔を短縮しなければならないが、従来のロボット制
御装置では、通路上の分割点の座標値の計算結果を記憶
するバッファメモリと、計算された分割点を次の動作目
標点として移動処理するためのバッファメモリとの間で
のデータ転送を行なっており、現在目標としている分割
−瓦に関する移動指令の出力が終了するまで、次の分割
点に関する演算の実行ができず、その結果移動処理にお
けるパルス分配の速度によっては、ひとつの分割点の演
算終了から次の分割点の演算量′始までにアイドルタイ
ムが生じることがある。
このように各軸のサーボ回路(サーボLSI)への分配
パルスの書込みと、分割点に関する演算とが並行して行
なわれるので、本来なら軌跡精度を高めるうえでは分割
点を増やす必要があるにもかかわらず、CPUにおける
演算処理能力が十分に発揮されないという問題点があっ
た。また、演算用バッファから移動処理用バッファへの
データ転送にも時間がかかり、分割点の数が制約される
という問題点もあった。
パルスの書込みと、分割点に関する演算とが並行して行
なわれるので、本来なら軌跡精度を高めるうえでは分割
点を増やす必要があるにもかかわらず、CPUにおける
演算処理能力が十分に発揮されないという問題点があっ
た。また、演算用バッファから移動処理用バッファへの
データ転送にも時間がかかり、分割点の数が制約される
という問題点もあった。
本発明は、上記1を情に鑑みてなされたもので、演算時
間の無駄を除去してロボットの軌跡制御を粘度良く実行
するようにしたロボット制御装置を提供することを目的
にしている。
間の無駄を除去してロボットの軌跡制御を粘度良く実行
するようにしたロボット制御装置を提供することを目的
にしている。
(問題点を解決するための手段)
本発明のロボット制御装置は、教示された通路上の離散
的な点列データに基づいてロボットの軌跡制御を行なう
ロボット制御装置において、前記点列データの補間点情
報の演算処理タスクを実行する手段と、補間点情報を格
納する記憶手段と、この記憶手段の補間点情報により移
動処理タスクを実行する手段と、前記演算処理タスクと
移動処理タスクとを互いに独立に制御する制御手段とを
Aflし、前記記憶手段を演算処理タスクと移動処理と
の共用バッファとして使用するようにしたものである。
的な点列データに基づいてロボットの軌跡制御を行なう
ロボット制御装置において、前記点列データの補間点情
報の演算処理タスクを実行する手段と、補間点情報を格
納する記憶手段と、この記憶手段の補間点情報により移
動処理タスクを実行する手段と、前記演算処理タスクと
移動処理タスクとを互いに独立に制御する制御手段とを
Aflし、前記記憶手段を演算処理タスクと移動処理と
の共用バッファとして使用するようにしたものである。
(作用)
すなわち、この発明のロボット制御装置では、記憶手段
に格納された補間点情報を演算処理タスク側と移動処理
タスク側とで互いに独立に制御するので、演算処理タス
クは複数の補間点の計算を、移動処理とは無関係に連続
して実行することができる。
に格納された補間点情報を演算処理タスク側と移動処理
タスク側とで互いに独立に制御するので、演算処理タス
クは複数の補間点の計算を、移動処理とは無関係に連続
して実行することができる。
(実施例)
以下、本発明の一実施例を図面を参照して説明する。
第1図は、本発明のロボット制御装置の一実施例を示す
ブロック図である。ロボット指令データメモリRCDM
は、処理装置RPυと接続されていて。
ブロック図である。ロボット指令データメモリRCDM
は、処理装置RPυと接続されていて。
そこには既に一連のロボット指令データが教示操作によ
って記憶されている。このロボット指令データは、通路
上のgl散的な点列をロボットの各軸傾として表現する
位置データ群と、それぞれのデータ群の実行順序を識別
するブロック番号とかうなる。教示操作盤↑Bは、モー
ドセレクトスイッチを有し、再生モードと教示モードと
を選択するできる。リードオンリメモリROMは、処理
袋mRPUを制御する制御プログラムを記憶しており、
再生モードが選択されているとき、ロボット指令データ
メモリRCDMからデータを1ブロツクづつ読み出して
、各軸傾からロボットのTCPの直交座標値に変換する
演算処理などを制御する。
って記憶されている。このロボット指令データは、通路
上のgl散的な点列をロボットの各軸傾として表現する
位置データ群と、それぞれのデータ群の実行順序を識別
するブロック番号とかうなる。教示操作盤↑Bは、モー
ドセレクトスイッチを有し、再生モードと教示モードと
を選択するできる。リードオンリメモリROMは、処理
袋mRPUを制御する制御プログラムを記憶しており、
再生モードが選択されているとき、ロボット指令データ
メモリRCDMからデータを1ブロツクづつ読み出して
、各軸傾からロボットのTCPの直交座標値に変換する
演算処理などを制御する。
図には、1軸分のみのサーボモータSNを示しているが
、各軸のサーボ回路は、処理袋at RPUで演算され
た各軸インクリメンタル量から分配パルスを出力するパ
ルス分配器PDC、サーボモータ囲を制御するサーボユ
ニットSVu、サーボモータ5lllから回転信号をフ
ィードバックするパルス発生器PC等から構成され、ハ
ンドが所定敬移動する毎に残移動?や現在位置を各軸毎
に処理?cfi RPUにて演算し、データメモリON
に記憶する。
、各軸のサーボ回路は、処理袋at RPUで演算され
た各軸インクリメンタル量から分配パルスを出力するパ
ルス分配器PDC、サーボモータ囲を制御するサーボユ
ニットSVu、サーボモータ5lllから回転信号をフ
ィードバックするパルス発生器PC等から構成され、ハ
ンドが所定敬移動する毎に残移動?や現在位置を各軸毎
に処理?cfi RPUにて演算し、データメモリON
に記憶する。
B旧士、第2図に示すようなブロック構成を有するバッ
ファメモリで、処理装置RPUとパルス分配器POCと
の間に接続されている。このバッファメモリBMは、n
個分の補間点情報を格納できる大きさのサイクリックウ
ィンドウで且つ各補間点毎に独立の記憶領域を構成して
おり、nはロボット指令データメモリRCDMから1ブ
ロツクづつ読み出される移動軌跡上の2点間での最大補
間点数に対応する。演算処理タスクは、補間点の座標を
求めそれを順次に逆変換して各軸傾を求める計算で、ロ
ボットに対するパルス分配を制御する移動処理とは無関
係に、つまり同期を取らずに進められ、1つの補間点に
関する計算が終了したとき演算用ポインタPaを1つ先
に進める。y:F)t=各軸軸傾到達するようにパルス
分配器PDCを制御して軌跡制御を実行する移動処理タ
スクも、演算処理タスクとは独立に移動処理を行ない、
目標の分割点へ到達した時点で次の目標点への移動に先
立ち実行用ポインタpbを1つ先に進める。
ファメモリで、処理装置RPUとパルス分配器POCと
の間に接続されている。このバッファメモリBMは、n
個分の補間点情報を格納できる大きさのサイクリックウ
ィンドウで且つ各補間点毎に独立の記憶領域を構成して
おり、nはロボット指令データメモリRCDMから1ブ
ロツクづつ読み出される移動軌跡上の2点間での最大補
間点数に対応する。演算処理タスクは、補間点の座標を
求めそれを順次に逆変換して各軸傾を求める計算で、ロ
ボットに対するパルス分配を制御する移動処理とは無関
係に、つまり同期を取らずに進められ、1つの補間点に
関する計算が終了したとき演算用ポインタPaを1つ先
に進める。y:F)t=各軸軸傾到達するようにパルス
分配器PDCを制御して軌跡制御を実行する移動処理タ
スクも、演算処理タスクとは独立に移動処理を行ない、
目標の分割点へ到達した時点で次の目標点への移動に先
立ち実行用ポインタpbを1つ先に進める。
こうして、上記共用バッファとして構成されたバッファ
メモリBMをサイクリックに使用すれば、演算処理タス
クは、自分のポインタPaが移動処理タスクを管理する
実行用ポインタpbに追いつかれないことだけを確認す
ればよく、実際の移動処理とは関係なく処理袋21RP
υで次々に任意側の補間点の計算を行なうことができる
。そして、移動処理タスクの側でも、自分のポインタp
bより演算用ポインタPaが先にあることだけを確認し
て、指令された軌跡に沿った移動制御を実行できる。
メモリBMをサイクリックに使用すれば、演算処理タス
クは、自分のポインタPaが移動処理タスクを管理する
実行用ポインタpbに追いつかれないことだけを確認す
ればよく、実際の移動処理とは関係なく処理袋21RP
υで次々に任意側の補間点の計算を行なうことができる
。そして、移動処理タスクの側でも、自分のポインタp
bより演算用ポインタPaが先にあることだけを確認し
て、指令された軌跡に沿った移動制御を実行できる。
第3図のフローチャートは、上記実施例の軌跡制御演算
の手順の一例を示している。ステップaでデータメモリ
RCDMから起点と終点の点列データを読み出したあと
は、演算処理タスクと移動処理タスクとをそれぞれ独立
にステップb、ステップCとして進めることが可能で、
ステップbの後に演算用ポインタPaを1歩進しくステ
ップd)、ステップCの後に実行用ポインタpbを同様
に1歩進しくステップe)ておくことで、あとは各ポイ
ンタPa、Pbの関係をステップfで、Pa>Pbのみ
を確認して次々と各タスクを実行していくことができる
。ステップgで演算処理タスクの終了が確認され、ステ
ップhで移動処理タスクの終了も確認されれば、当初に
与えられた起点と終点との間での軌跡制御が終了し、バ
ッファメモリBMの内容はクリヤされる。
の手順の一例を示している。ステップaでデータメモリ
RCDMから起点と終点の点列データを読み出したあと
は、演算処理タスクと移動処理タスクとをそれぞれ独立
にステップb、ステップCとして進めることが可能で、
ステップbの後に演算用ポインタPaを1歩進しくステ
ップd)、ステップCの後に実行用ポインタpbを同様
に1歩進しくステップe)ておくことで、あとは各ポイ
ンタPa、Pbの関係をステップfで、Pa>Pbのみ
を確認して次々と各タスクを実行していくことができる
。ステップgで演算処理タスクの終了が確認され、ステ
ップhで移動処理タスクの終了も確認されれば、当初に
与えられた起点と終点との間での軌跡制御が終了し、バ
ッファメモリBMの内容はクリヤされる。
なお、このバッファメモリの記憶容量は、各補間点毎に
独立の記憶領域を構成しているものであれば、移動軌跡
上の2点間の最大補間点数nに対応する容量で十分であ
り、また、データ転送に要する時間が従来のものに比べ
て短縮されることから、必ずしもそれ程の容量は必要と
されない。
独立の記憶領域を構成しているものであれば、移動軌跡
上の2点間の最大補間点数nに対応する容量で十分であ
り、また、データ転送に要する時間が従来のものに比べ
て短縮されることから、必ずしもそれ程の容量は必要と
されない。
(発明の効果)
以上説明したように、本発明によれば、演算処理タスク
側でのバッファと移動処理タスク側でのバッファとを共
用する構成として、演算時間の無駄を除去したので、ロ
ボットの軌跡制御に必要な点列データの読み出し処理を
高速に行なうことができ、制御精度を向上するうえで有
効なロボット制御装置を提供できる。
側でのバッファと移動処理タスク側でのバッファとを共
用する構成として、演算時間の無駄を除去したので、ロ
ボットの軌跡制御に必要な点列データの読み出し処理を
高速に行なうことができ、制御精度を向上するうえで有
効なロボット制御装置を提供できる。
第1図は、本発明の一実施例を示すブロック図、第2図
は、バッファメモリの一構成例を示す説明図、第3図は
、同実施例装置の動作を示す説明図である。 RPU・・・処理装置、RCDM・・・ロボット指令デ
ータメモリ、Bト・・バッファメモリ、TB・・・教示
操作盤。 特許出願人 ファナック株式会社 代 理 人 弁理士 辻 實第1図 第3図
は、バッファメモリの一構成例を示す説明図、第3図は
、同実施例装置の動作を示す説明図である。 RPU・・・処理装置、RCDM・・・ロボット指令デ
ータメモリ、Bト・・バッファメモリ、TB・・・教示
操作盤。 特許出願人 ファナック株式会社 代 理 人 弁理士 辻 實第1図 第3図
Claims (2)
- (1)教示された通路上の離散的な点列データに基づい
てロボットの軌跡制御を行なうロボット制御装置におい
て、前記点列データの補間点情報の演算処理タスクを実
行する手段と、補間点情報を格納する記憶手段と、この
記憶手段の補間点情報により移動処理タスクを実行する
手段と、前記演算処理タスクと移動処理タスクとを互い
に独立に制御する制御手段とを具備し、前記記憶手段を
演算処理タスクと移動処理との共用バッファとして使用
するようにしたことを特徴とするロボット制御装置。 - (2)前記記憶手段は、移動軌跡上の2点間の最大補間
点数の補間点情報を記憶する記憶容量を有し、且つ各補
間点毎に独立の記憶領域を有することを特徴とする特許
請求の範囲第(1)項に記載のロボット制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP8833387A JPS63254503A (ja) | 1987-04-10 | 1987-04-10 | ロボツト制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP8833387A JPS63254503A (ja) | 1987-04-10 | 1987-04-10 | ロボツト制御装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
JPS63254503A true JPS63254503A (ja) | 1988-10-21 |
Family
ID=13939946
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP8833387A Pending JPS63254503A (ja) | 1987-04-10 | 1987-04-10 | ロボツト制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPS63254503A (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111026037A (zh) * | 2019-11-26 | 2020-04-17 | 西安航天精密机电研究所 | 基于windows平台工业机器人运动控制器及控制方法 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS61256406A (ja) * | 1985-05-10 | 1986-11-14 | Hitachi Ltd | 制御装置 |
-
1987
- 1987-04-10 JP JP8833387A patent/JPS63254503A/ja active Pending
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS61256406A (ja) * | 1985-05-10 | 1986-11-14 | Hitachi Ltd | 制御装置 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111026037A (zh) * | 2019-11-26 | 2020-04-17 | 西安航天精密机电研究所 | 基于windows平台工业机器人运动控制器及控制方法 |
CN111026037B (zh) * | 2019-11-26 | 2021-01-08 | 西安航天精密机电研究所 | 基于windows平台工业机器人运动控制器及控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US4262336A (en) | Multi-axis contouring control system | |
US4528632A (en) | Industrial articulated robot linear interpolation control device | |
EP0130570B1 (en) | Method and apparatus for controlling a robot hand along a predetermined path | |
KR950000814B1 (ko) | 로보트의 동작지시 방법 및 제어장치 | |
JPS6233604B2 (ja) | ||
CN113084792B (zh) | 关节奇异区域的确定方法、机器人及存储装置 | |
WO2022034848A1 (ja) | 数値制御システム及びロボット制御方法 | |
JP3168682B2 (ja) | 数値制御装置 | |
CN111195913A (zh) | 机器人处理方法、装置及工业机器人 | |
US4912383A (en) | Method of controlling a robot | |
JPS63254503A (ja) | ロボツト制御装置 | |
JPS61170807A (ja) | 数値制御装置 | |
JPS62251901A (ja) | 多軸ロボツトの経路制御装置 | |
JPH0797290B2 (ja) | 複数ア−ムの制御装置 | |
CN116529035A (zh) | 数值控制装置以及数值控制*** | |
JP2610996B2 (ja) | 多関節ロボット制御装置 | |
JPS58155189A (ja) | 産業用ロボツトの位置制御装置 | |
JP2574313B2 (ja) | 教示再生型マニピュレ−タの制御装置 | |
JPH0962322A (ja) | 多軸ロボットの制御装置及びその制御方法 | |
JPH0623928B2 (ja) | ロボツトハンドの軌道修正方法 | |
JP2703099B2 (ja) | 産業用ロボットのコンベア追従方法 | |
JPS63254502A (ja) | ロボツト制御装置 | |
JPH083739B2 (ja) | ロボットの速度プログラム決定方法 | |
JPH02218573A (ja) | 工業用ロボットの制御方法 | |
JPH07114408A (ja) | ロボットの制御装置 |