JPH0277905A - ロボット移動用プログラム修正方法 - Google Patents

ロボット移動用プログラム修正方法

Info

Publication number
JPH0277905A
JPH0277905A JP23093488A JP23093488A JPH0277905A JP H0277905 A JPH0277905 A JP H0277905A JP 23093488 A JP23093488 A JP 23093488A JP 23093488 A JP23093488 A JP 23093488A JP H0277905 A JPH0277905 A JP H0277905A
Authority
JP
Japan
Prior art keywords
point
robot
interpolation
program
deviation
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
Application number
JP23093488A
Other languages
English (en)
Inventor
Hideaki Kawamura
英明 川村
Haruyuki Ishikawa
石川 晴行
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Fanuc Corp
Original Assignee
Fanuc Corp
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Fanuc Corp filed Critical Fanuc Corp
Priority to JP23093488A priority Critical patent/JPH0277905A/ja
Publication of JPH0277905A publication Critical patent/JPH0277905A/ja
Pending legal-status Critical Current

Links

Landscapes

  • Numerical Control (AREA)

Abstract

(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。

Description

【発明の詳細な説明】 〈産業上の利用分野〉 本発明はロボット移動用プログラム修正方法に係り、特
に経路誤差を小さくできるロボット移動用プログラム修
正方法に関する。
〈従来技術〉 従来、ロボッ1−の軌跡制御を行うには、まずロボット
移動用プログラムにより特定されるブロックの始点と終
点の座標値をロボット各軸値から直交座標値(例えばX
軸、Y軸、Z軸の座標値)に変換し、次いで、ブロック
始点と終点を結ぶ例えば直線上をロボット移動させる場
合には、該ブロック始点と終点間を所定のサンプリング
周期(補間周期)Tsの間に移動する距離dで複数分割
する。しかる後、直交座標値で得られる各分割点(補間
点)の座標値を、ロボット各軸値に逆変換し、逆変換し
て得られたロボット各軸への指令データに加減速のフィ
ルタ処理を施してサーボへ出力し、ロボットがブロック
始点から各補間点をたどってブロック終点に至るように
通路制御が行われる。なお、加減速のフィルタ処理は、
各補間点のロボット各軸への指令データを所定の分配周
期T、(通常TsはToの整数倍となるように決定され
ている)毎にパルス補間演算を行ってパルスを発生し、
該パルス補間により作られたパルス列を加減速回路に入
力し1周波数がブロック始点。
終点それぞれ漸増、漸減するパルス列に変換し、該パル
ス列をサーボ回路に入力する。
〈発明が解決しようとする課題〉 ところで、従来技術では各軸ごとに加減速フィルタの「
たまり」や「サーボ遅れ」が発生する。
そして、この「たまり」や「サーボ遅れ」によりロボッ
トは目標の軌跡からずれた軌跡を移動してしまうという
問題点があった。特に、各軸についての「たまり」、「
サーボ遅れ」の差が大きくなる程、また移動速度が大き
くなるほど軌跡のずれが大きくなるという問題点があっ
た。
以上から本発明の目的は、加減速の「たまり」。
サーボ系の「サーボ遅れ」等の影響による軌跡のずれを
修正することができ、経路誤差を小さくできるロボット
移動用プログラム修正方法を提供することである。
〈課題を解決するための手段〉 第1図は本発明の概略説明図である。
Psはブロック始点、Peはブロック終点、piは補間
点、Pziはロボットが実際に通過するポイント、P 
21は補正後の補間点である。
く作用〉 ロボット移動用のプログラムにより特定されるブロック
始点Psと終点Pe間に1つ以上の補間点piを生成し
、該補間点piを通過するように軌跡制御を行った時ロ
ボットが実際に通過するポイントであって前記補間点P
iに対応するポイントP11の位置をシミュレートし、
シミュレートされたポイントPxiの位置と制御プログ
ラムにより規定された補間点Piの位置との偏差を求め
、該偏差が設定値より大きい場合には設定値以下となる
ように補間点P0の位置を補間点Patの位置に補正し
、該補正した補間点Pziが目標位置となるようにロボ
ット移動用のプログラムを修正し、ブロック始点Psと
終点Pe間に補間点P2□を挿入したプログラムを作成
する。
〈実施例〉 第2図は本発明のロボット移動用プログラム修正方法を
実現するロボット制御装置のブロック図。
第3図は直線加減速特性図、第4図はサーボ遅れ特性図
、第5図は本発明にかがるプログラム修正方法の処理の
流れ図、第6図は本発明により修正されたプログラム例
である。
第2図において、1はプロセッサであり、後述するプロ
グラム修正処理を行って経路誤差の少ないプログラムを
作成すると共に、該プログラムの通路データを用いて周
知の通路制御処理を行う。
2はロボット移動用プログラムを修正するための制御プ
ログラムや該移動用プログラムに基いて数値制御処理等
を実行する制御プログラムを記憶するROM、3はロボ
ット移動用プログラムや処理結果等を記憶するRAM、
4は操作盤である65はロボット各軸ごとに設けられた
パルス補間器である。
6はロボット各軸ごとに設けられた加減速回路であり、
パルス補間器5から出力される補間パルスの立上り時に
加速し、立下り時に減速する。なお、加減速回路6は9
例えば第3図に示す時定数T□ を有する直線加減速特
性に従って加減速制御を行う。
7はサーボ回路、8はサーボモータであり1図示もない
が位置および速度フィードバック構成になっており、全
体として例えば第4図に示すように時定数T2を有する
一時遅れ特性を有している。
9はロボットIOとロボット制御装置の本体間のデータ
授受を司るインタフェース回路である。
以下、第5図に示す流れ図を参照しながら本発明の詳細
な説明する。なお、各ブロックの始点PSと終点Peを
特定するロボット移動用プログラム(第6図(a))は
すでに作成されてRAM3に格納されであるものとする
操作盤4からロボット移動用プログラムの修正起動が掛
るとプロセッサ1はRAM3より第jブロック(jの初
期値は1)の始点Ps□と終点Pe。
の位置データを読み取る(ステップ1o1)。
続いてプロセッサ1は、このブロック始点Ps工と終点
Pe1の座標値をロボット座標系から直交座標系に変換
し1次いで補間周期Tsの間に移動する距1lilld
(=F−Ts、ただしFは送り速度)テブロック始点、
終点間を分割し、各分割点(補間点Pi  (i=1,
2・・・)の直交座標系における座標値を求め、しかる
後補間点P1の座標値をロボット各軸値に逆変換してそ
の座標値をRAM3に、第6図(b)に示すように記憶
する(ステップ102)。− 次に、時間Ts経過毎に補間点PiのデータをPZ−4
Pziによりセットしくステップ103)、該補間点P
21(すなわちpt)を通過するように軌跡制御を行っ
た時ロボットが実際に通過するポイントであって前記補
間点P2□(Pi )に対応するポイントPLiの位置
を、下記計算式(1)によりシミュレートする(ステッ
プ104)。
S  (A (P21) )→Pxi・・・・・・<I
)なお、Sは各軸サーボ遅れに依存する評価分、Aは各
相加減速のフィルタに依存する評価分を表す関数であり
、あらかじめ測定結果より求めておく。
次いで、シミュレートされたポイントPziの位置と制
御プログラムにより規定された補間点piの位置との偏
差ΔPiを、計算式 %式%() より求め(ステップ105)、該偏差ΔPtとあらかじ
め決められた経路誤差(ずれ)の許容値とを比較しくス
テップ106)、ずれが許容値より大きい場合には許容
値以下となるように補間点P2土の位置を、計算式 %式%() により補正しくステップ107)、以後ステップ104
以降の処理を繰り返し、偏差ΔPiを許容値以下に設定
する。なお、補正量となる関数f(Δpt)は、使用す
る機種とか選択するモータに合わせて実験的に設定され
る。
一方、ステップ106の判断でずれが許容値より小さい
場合には、第6図(c)に示すように、計算式(1)に
より補正した補間点P21が目標位置となるように補間
点P0の補正処理を行う(ステップ108)、。
上記のように、偏差ΔP1に応じて補正量f(ΔPt)
を決め、該偏差ΔPiが生じた時点で当初目標としてい
た補間点Piの位置に経路誤差を起こす補間点P21を
、プログラム上の補間点位置として補正する。
以後、補間点の補正処理が全て終了する迄(ステップ]
09)各補間点について補正を行い、補正処理により得
られた補間点Psiを補間周期Ts毎の目標位置とする
ように移動用プログラムを修正し、ブロック始点Psと
終点Pe間に補間点P2□を挿入したプログラムを作成
する(第6図(c)参照フ。こうすることにより実際の
ロボットの位置制御時に元の目標とする軌跡(補間点I
) i を結んだ軌跡)が得られる。
なお1以上の補正処理は全ブロックについて行われる。
〈発明の効果〉 以上本発明によれば、ロボット移動用のプログラムによ
り特定されるブロック始点と終点間に1つ以上の補間点
を挿入し、該補間点を通過するように軌跡制御を行った
時ロボットが実際に通過するポイントであって前記補間
点に対応するポイントの位置をシミュレートし、シミュ
レートされたポイントの位置と制御プログラムにより規
定された補間点位置間の偏差を求め、該偏差が設定値よ
り大きい場合には設定値以下となるように前記補間点の
位置を補正し、該補正した補間点が目標位置となるよう
にロボット移動用のプログラムを修正するように構成し
たから、加減速の[たまり」。
サーボ系の「サーボ遅れ」等の影響による軌跡のずれを
小さく修正することができ、軌跡精度を向上させること
ができる。
また、本発明はロボットを実際に動作させる前にオフラ
インで行われるので、リアルタイムでは制御素子の演算
能力上プログラムの修正が間に合わないような場合でも
、容易にプログラムを修正することができる。
【図面の簡単な説明】
第1図は本発明の概略説明図、 第2図は本発明のロボット移動用プログラム修正方法を
実現するロボット制御装置のブロック図、第3図は直線
加減速特性図。 第4図はサーボ遅れ特性図、 第5図は本発明にかかるプログラム修正方法の処理の流
れ図、 第6図は本発明により修正されたプログラム例、Ps 
 ・・ブロック始点、 Pe  ・・ブロック終点、 Po ・・補間点、 Pli・・ロボッ1へが実際に通過するポイント、P2
1・・補正後の補間点。 特許出願人        ファナック株式会社代理人
          弁理士  齋藤千幹第1図 第3聞 第5図 第6図 (σ)     (b)(’)

Claims (1)

  1. 【特許請求の範囲】 ロボット移動用のプログラムにより特定されるブロック
    始点と終点間に1つ以上の補間点を生成し、 該補間点を通過するように軌跡制御を行った時ロボット
    が実際に通過するポイントであって前記補間点に対応す
    るポイントの位置をシミュレートし、 シミュレートされたポイントの位置と制御プログラムに
    より規定された補間点位置間の偏差を求め、 該偏差が設定値より大きい場合には設定値以下となるよ
    うに前記補間点の位置を補正し、該補正した補間点が目
    標位置となるようにロボット移動用のプログラムを修正
    することを特徴とするロボット移動用プログラム修正方
    法。
JP23093488A 1988-09-14 1988-09-14 ロボット移動用プログラム修正方法 Pending JPH0277905A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP23093488A JPH0277905A (ja) 1988-09-14 1988-09-14 ロボット移動用プログラム修正方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP23093488A JPH0277905A (ja) 1988-09-14 1988-09-14 ロボット移動用プログラム修正方法

Publications (1)

Publication Number Publication Date
JPH0277905A true JPH0277905A (ja) 1990-03-19

Family

ID=16915585

Family Applications (1)

Application Number Title Priority Date Filing Date
JP23093488A Pending JPH0277905A (ja) 1988-09-14 1988-09-14 ロボット移動用プログラム修正方法

Country Status (1)

Country Link
JP (1) JPH0277905A (ja)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5985087B1 (ja) * 2015-04-27 2016-09-06 三菱電機株式会社 数値制御装置
JPWO2023058191A1 (ja) * 2021-10-07 2023-04-13

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5983209A (ja) * 1982-11-05 1984-05-14 Hitachi Ltd ロボツトの制御方式
JPS6178589A (ja) * 1984-09-27 1986-04-22 Sony Corp クリ−ムはんだ
JPS6324402A (ja) * 1986-07-17 1988-02-01 Matsushita Electric Ind Co Ltd ロボツトの軌跡制御装置

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5983209A (ja) * 1982-11-05 1984-05-14 Hitachi Ltd ロボツトの制御方式
JPS6178589A (ja) * 1984-09-27 1986-04-22 Sony Corp クリ−ムはんだ
JPS6324402A (ja) * 1986-07-17 1988-02-01 Matsushita Electric Ind Co Ltd ロボツトの軌跡制御装置

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5985087B1 (ja) * 2015-04-27 2016-09-06 三菱電機株式会社 数値制御装置
WO2016174716A1 (ja) * 2015-04-27 2016-11-03 三菱電機株式会社 数値制御装置
JPWO2023058191A1 (ja) * 2021-10-07 2023-04-13

Similar Documents

Publication Publication Date Title
US9757834B2 (en) Track control apparatus
CN103513612B (zh) 控制工业机器人与变位机协调运动的系统及方法
JP6548830B2 (ja) 指令値生成装置
GB1471541A (en) Generation of two-and three-dimensional spacial forms
CN101422837A (zh) 电弧焊接机器人的控制装置及其方法
JP2017102617A (ja) 補正装置、補正装置の制御方法、情報処理プログラム、および記録媒体
CN105892402A (zh) 机械臂点到点运动控制方法
CN112338903A (zh) 一种基于模型设计的机械臂控制方法
Feng et al. Design of a real-time adaptive NURBS interpolator with axis acceleration limit
US10139803B2 (en) Instruction value generation device
KR101983946B1 (ko) 모델 지원식 오차 보상을 사용한 공작물들의 기계가공
CN108472808B (zh) 多个机器人的同步
CN104020717A (zh) 基于参数同步的五轴等距双nurbs刀具路径插补方法
US12304077B2 (en) Modeling of controlled object
JP3294900B2 (ja) 制御装置
CN114800523B (zh) 机械臂轨迹修正方法、系统、计算机及可读存储介质
JPH0277905A (ja) ロボット移動用プログラム修正方法
CN117666476B (zh) 一种数控机床的控制方法、系统及电子设备
CN110716451B (zh) 一种基于实时操作系统和fpga的仿真转台前馈控制方法
CN104020718A (zh) 一种nurbs曲线参考模型自适应实时插补方法
Das et al. Genetic algorithm based optimal PI controller for position control of Maxon S-DC motor with dSPACE
CN113467378A (zh) Cnc时间轴对正的方法
JP2005085111A (ja) 機械システムの制御方法及び装置
JPH0962325A (ja) ロボット到達可否判断装置
JPS6326890B2 (ja)