JPS61271501A - Ptp教示型ロボツトの加減速制御方式 - Google Patents

Ptp教示型ロボツトの加減速制御方式

Info

Publication number
JPS61271501A
JPS61271501A JP11355885A JP11355885A JPS61271501A JP S61271501 A JPS61271501 A JP S61271501A JP 11355885 A JP11355885 A JP 11355885A JP 11355885 A JP11355885 A JP 11355885A JP S61271501 A JPS61271501 A JP S61271501A
Authority
JP
Japan
Prior art keywords
acceleration
deceleration
robot
control
locus
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
JP11355885A
Other languages
English (en)
Inventor
Toshio Inoue
井上 俊男
Nobuaki Imamura
信昭 今村
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.)
Kobe Steel Ltd
Original Assignee
Kobe Steel Ltd
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 Kobe Steel Ltd filed Critical Kobe Steel Ltd
Priority to JP11355885A priority Critical patent/JPS61271501A/ja
Publication of JPS61271501A publication Critical patent/JPS61271501A/ja
Pending legal-status Critical Current

Links

Landscapes

  • Numerical Control (AREA)
  • Manipulator (AREA)

Abstract

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

Description

【発明の詳細な説明】 「発明の利用分野」 本発明はFTP教示型ロボットの加減速制御方式に係り
、特に直線的作業軌跡の始端部及び/又は終端部にサイ
クロイド曲線を通用して加減速時の急激な速度、加速度
の変化を防止して、軌跡精度の向上を図るものである。
「従来技術及びその問題点」 ロボットの動きをコントロールする際、その制御系にど
んな補償を施すかが重要であると共に、ロボットの制御
系にどんな目標値を作り与えるかも、また重要である。
つまりいくら性能の良い制御系を構成したとしても物理
法則に反する様な制御指令を与えたのではロボットを滑
らかに、精度良く動かすことは不可能である。
ロボット手先先端を第3図の様にp、、piヤ1゜Pi
t2と等速で運動させようとすると、その関節角目標値
は一般に第4図の様にAI 、  AL++こAL+4
゜Ai+zの2つの曲線(破線)をつないだものとなる
しかし、この関節角目標値の曲線は、第5図(a)、 
 (b)の破線が示す様に、角速度が不連線、角加速度
が無限大となり、この目標値通りロボットを写生運動さ
せることは不可能である。
また、この目標値通り運動させようとすると、無理な目
標値を与えるがため、これがアーム先端の再生運動軌跡
悪化の原因となる。
そこで例えば、従来の塗装ロボットでは、第6図の様に
作業空間内で一定加速度αに従ってアーム先端の速度パ
ターンを設定し、この速度パターンから一定周期(T+
)毎の作業空間内の該当位置p、、p2.p、を計算し
て座標逆変換を施して空間内の加速時の位置目標値を求
めている。
ところが、一般に座標逆変換には、逆三角関数を含む多
くの複雑な演算を必要とするため、マイクロコンピュー
タで、リアタイムで処理するには、サンプリング制御周
期(T、)に比べてはるかに時間を要するのが現状であ
る。そこで第7図に示す様に、作業空間内の位置目標値
(Po、P+、p、、p、、・・・)に該当する関節角
位置目標値(0゜(po ) 、  θ+(P+)、 
 θ2(P2)・・・)をさらにサンプリング制御周期
(T、)毎に直線補間して制御目標値を作り出している
従って関節位置目標値の変化は、直線の組み合わせによ
る加減速となり、速度はステップ状になる。特に速度に
対して設定加速度が大きくなればなる程それは著しくな
り、ロボットを清らかに加減速することが難しい。
「発明の目的」 従って本発明の目的はロボットの作業軌跡に対応する目
標値を作成する際、その始端部と終端部にサイクロイド
カム曲線を適用し、ロボットに急激な加速度が作用しな
い様にして清らかに精度よくロボットが動くよう制御す
ることである6「発明の構成」 上記目的を達成するために本発明が採用する主たる手段
は、断続的な教示点を結んだ直線的作業軌跡に従って再
生されるFTP教示型ロボットの加速時又は減速時の制
御方式において、上記直線的作業軌跡の始端部及び/又
は終端部における目標軌跡をサイクロイド曲線に従って
補正する如くなした点である。
「実施例」 続いて本発明を具体化した実施例につき第1図及び第2
図を参照して説明し、本発明の理解に供する。ここに第
1図は本発明の一実施例に係る制御方式の処理手順を示
すフロー図、第2図はサイクロイド曲線の変位(S)、
速度(V)、加速度(A)、fl動(J)の時間的変化
を示すグラフである。
尚以下の実施例は本発明の具体的−例にすぎず、本発明
の技術的範囲を限定するものではない。
サイクロイド曲線は第2図に示す様に加速度(A)曲線
が1周期の正弦曲線で表される曲線である。
サイクロイド曲線は連続条件を満足するカム曲線として
高速に通し、振動に対しても優れた性質をもっている。
また数学的にも次式の通り簡明である。
S−T  (1/2)・tt −5in 2yrTロボ
ツトの関節角目標値作成への通用に際して加速時にこの
曲線の前半分(Kl)、減速時に後半分(K、)を利用
するものとする(第2図参照)。
本発明は上記のようなサイクロイド曲線に従った作業位
置の変化を教示によって得られた直線的作業軌跡の始端
部(加速部)と終端部(減速部)に与えて加減速時の急
激な動きを和らげようとするものであり、例えば第1図
に示したフロー図のような手順で処理される。
第3図に示すように空間上のP□+  Pie1+  
Pi+2、・・・の断続的作業点が教示されているとし
て、オペレータが再生開始ボタンを押すと、第1図に示
す手順でP工、pLnt間の作業軌跡の計算−アクチェ
エータの駆動−PL4L  PL・2間の作業軌跡の計
算−アクチェエータの駆動−のように処理が進行する。
まず教示点P’g I  PL?1間の距ML、を次式
に従って計算する(31)。
ただしx、y、z座標系での作業空間ロボットアーム先
端位置は P、”” (Pt、x +  i、y +  P 1,
2 )次に次式(ii−1〜4)に従ってロボットアー
ム先端点の速度の方向余弦dを計算する(32)。
d x”(P4,1. X −PL 、 X)/L1 
”’ H+ −1)d y −(P j+ + 、y−
P工、y)/Lt・・・(ii −2)d 2−(Pj
o、z 、  P 1.2)/ L+ ’・ (ii−
3)d−(dX、dy、dt )     ・・・ (
ii−4)次いでS3において教示点PLからr’Lt
4までロボットアーム先端が移動する間の座標変換の回
数Nを計算する。
ただし ■lにロボットアーム先端速度 T、:座標逆変換周期 (intは整数化処理の意味) 通常T、は前記のように座標変換に時間がかかるため制
御周期T、よりかなり長くかかる。
そこで本実施例においては1回目の座標変換周期に対応
する作業軌跡(作業軌跡の始端部)にサイクロイド曲線
化処理(サイクロイド曲線の前半部通用)を施して緩加
速制御を行い、またN回目の座標変換周期に対応する作
業軌跡(作業軌跡の終端部)にサイクロイド曲線化処理
(サイクロイド曲線の後半部通用)を施して緩減速制御
を行い、その中間については通常の等速制御を行うよう
にしている。
即ち上記座標変換回数Nを用いて直角座標位置PL(1
)I P五(2)・ ”<3)・ °゛Pム(N−1)
”五(−戸 P、。1,1汝ら各補間点に対応する関節
角制御位置目標値を座標逆変換により求める(S4)、
これらの逆座標変換手順は周知であるので説明を省略す
る。
次いでS5において現在の制御周期番号jが1か否かを
判定する。j=1の場合には次の(iv −1〜3)式
により制御周期により細かく補間された関節角制御位置
目標値θIを算出する。
ただしf :座標逆変換 Ts    I     Ts × !14’Tt  ”  2Vsi’(2”44s’
   リ1−(iv −3)ただしl−1〜2 (”/
rs ) こうして得られた関節角制御目標値が次々に出力されて
サイクロイド曲線状に変化する作業軌跡に沿って緩加速
制御によるロボットアーム先端の駆動が行われる(SI
O)。
またj=2〜N−1の場合には(S7)、次の式に従っ
て等速制御される(3B)。
Q(j電D−θ(j−j−リ θl −〇(j−」−〇+  □、/T、1 −=  
(iv −6)ただし1畷1〜1/T5 更にj−N、即ちP□〜P田の作業軌跡の終端部では、 →−→− θI 1θ(」叩−1片(今r−N)  θO−M−リ
)f  。
−m!lIn  (2π (O,s十j]τ4r)J 
−Gv−B)りt、Ltt −1〜2 (r+7.5)
に従って関節制御目標値θlが算出され(S9)、サイ
クロイド曲線の後半部に沿って緩減速制御が行われる(
310) 。
上記実施例では1つの直線軌跡の最初と最後の座標変換
周期区間にサイクロイド曲線化処理を施しているが、こ
れは−例であって、より長い区間或いは短い区間につい
てサイクロイド曲線化処理を施してもよい。
「発明の効果」 本発明は以上述べた如く、断続的な教示点を結んだ直線
的作業軌跡に従って再生されるFTP教示型ロボットの
加速時又は減速時の制御方式において、上記直線的作業
軌跡の始端部及び/又は終端部における目標軌跡をサイ
クロイド曲線に従って補正することを特徴とするFTP
教示型ロボットの加減速制御方式であるから、加減速の
ない制御と較べてはもとより、また直線的な加減速を行
った場合と較べても軌跡精度、速度変動2等のいずれの
点においても著しい向上が得られる。またサイクロイド
曲線は数式的にも簡単で演算も容易であるので、マイク
ロコンピュータによる高速演算にも通し、比較的低価格
のマイクロコンピュータによる正確な制御が可能となる
【図面の簡単な説明】
第1図は本発明の一実施例に係る方式を実行させるため
のフロー図、第2図はサイクロイド曲線の変位(S)、
速度(V)、加速度(A)、躍動(J)を示すグラフ、
第3図はロボットアーム先端の教示点の位置を示す斜視
図、第4図は第3図の位置変化に対応するある関節角θ
、の変化を示すグラフ、第5図(a)、  (b)は第
4図の位置変化に対応する角速度、角加速度の変化を示
すグラフ、第6図、第7図はそれぞれ従来の緩加減速制
iHを説明するためのグラフである。 (符号の説明) P、P  ・・・教示点   N:座標逆変換回数J:
座橿逆変換の番号 81〜510・・・ステップ v、:移動速度。 第6図 O 第7図 第2図 V−2,00 第1図 し ■ じ 手続ネiff正書(方式、自発) 昭和61年 5月12日 2、発明の名称 FTP教示型ロボットの加減速制御方式3、補正をする
者 事件との関係 特許出願人 住所 〒651 神戸市中央区脇浜町1丁目3番18号
名称 (119)株式会社 ン巾戸3m多岡所代表者 
     !吹  冬 彦 4、代理人 〒530 住所 大服市北区南森町2丁目3番36号富永ビル5、
補正命令の日付 自発 6、補正の対象 7、補正の内容 !1発明の詳細な説明の欄の補正 明細書に次の補正を行う fil  第2ページ第13行目に「不連線」とあるの
を「不連続」に訂正する。 (2)第3ページ第7行目に「リアタイム」とあるのを
「リアルタイム」に訂正する。 (3)  第5ページ第11行目に rS=T−(1/2)  ・tc ・ 5in2 πT
Jとあるのを rs=7 1/ (2・π)・sin (2πT) J
に訂正する。 ■1図面の補正 第5図tarを別紙のように訂正する。 8、添付書類の目録

Claims (1)

    【特許請求の範囲】
  1. (1)断続的な教示点を結んだ直線的作業軌跡に従って
    再生されるPTP教示型ロボットの加速時又は減速時の
    制御方式において、 上記直線的作業軌跡の始端部及び/又は終端部における
    目標軌跡をサイクロイド曲線に従って補正することを特
    徴とするPTP教示型ロボットの加減速制御方式。
JP11355885A 1985-05-27 1985-05-27 Ptp教示型ロボツトの加減速制御方式 Pending JPS61271501A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP11355885A JPS61271501A (ja) 1985-05-27 1985-05-27 Ptp教示型ロボツトの加減速制御方式

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP11355885A JPS61271501A (ja) 1985-05-27 1985-05-27 Ptp教示型ロボツトの加減速制御方式

Publications (1)

Publication Number Publication Date
JPS61271501A true JPS61271501A (ja) 1986-12-01

Family

ID=14615328

Family Applications (1)

Application Number Title Priority Date Filing Date
JP11355885A Pending JPS61271501A (ja) 1985-05-27 1985-05-27 Ptp教示型ロボツトの加減速制御方式

Country Status (1)

Country Link
JP (1) JPS61271501A (ja)

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS54114686A (en) * 1978-02-28 1979-09-06 Toyo Electric Mfg Co Ltd Positional controller
JPS5856785A (ja) * 1981-09-30 1983-04-04 株式会社三協精機製作所 工業用ロボツトの動作制御装置
JPS5913046A (ja) * 1982-07-13 1984-01-23 Daihatsu Motor Co Ltd ロツカ−ア−ムのパツド部材
JPS59168508A (ja) * 1983-03-15 1984-09-22 Matsushita Electric Ind Co Ltd 高速位置決め制御装置
JPS59175947A (ja) * 1983-03-22 1984-10-05 Toshiba Mach Co Ltd トランスフア装置
JPS6083386A (ja) * 1983-10-14 1985-05-11 Hitachi Ltd ピエゾ素子の駆動制御方法およびその装置
JPS61196804A (ja) * 1985-02-25 1986-09-01 Sumitomo Rubber Ind Ltd 航空機用タイヤ

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS54114686A (en) * 1978-02-28 1979-09-06 Toyo Electric Mfg Co Ltd Positional controller
JPS5856785A (ja) * 1981-09-30 1983-04-04 株式会社三協精機製作所 工業用ロボツトの動作制御装置
JPS5913046A (ja) * 1982-07-13 1984-01-23 Daihatsu Motor Co Ltd ロツカ−ア−ムのパツド部材
JPS59168508A (ja) * 1983-03-15 1984-09-22 Matsushita Electric Ind Co Ltd 高速位置決め制御装置
JPS59175947A (ja) * 1983-03-22 1984-10-05 Toshiba Mach Co Ltd トランスフア装置
JPS6083386A (ja) * 1983-10-14 1985-05-11 Hitachi Ltd ピエゾ素子の駆動制御方法およびその装置
JPS61196804A (ja) * 1985-02-25 1986-09-01 Sumitomo Rubber Ind Ltd 航空機用タイヤ

Similar Documents

Publication Publication Date Title
CN107263484B (zh) 机器人关节空间点到点运动的轨迹规划方法
CN110497411B (zh) 一种工业机器人协同运动控制方法
CN112757306B (zh) 一种机械臂逆解多解选择和时间最优轨迹规划算法
Zhao et al. A real-time look-ahead interpolation methodology with curvature-continuous B-spline transition scheme for CNC machining of short line segments
KR880002556B1 (ko) 곡면 생성방법
WO1995004312A1 (en) Method and system for path planning in cartesian space
CN111633668B (zh) 一种用于机器人加工三维自由曲面的运动控制方法
CN109304711A (zh) 串联机器人轨迹规划方法
JPH04111006A (ja) ロボットの経路補間方法
CN117290636A (zh) 一种scara机器人不等式约束模型构建方法及模型验证方法
Li et al. Accurate interpolation and contouring control algorithm based on FIR filters for the corner transition
CN113485370A (zh) 一种并联机器人动态拾放轨迹规划方法及系统
KR101743795B1 (ko) 위치제어 시스템에서 곡선보간 방법
JPS61271501A (ja) Ptp教示型ロボツトの加減速制御方式
JP3204042B2 (ja) ロボットの軌道の生成装置
JP4146549B2 (ja) 軌跡制御方法及び軌跡制御方法を記録した記録媒体
JP2790643B2 (ja) 数値制御装置
Chen et al. Smooth geodesic interpolation for five-axis machine tools
JP3690424B2 (ja) 数値制御方法及びその装置
Gao et al. A fixed-distance Cartesian path planning algorithm for 6-DOF industrial robots
Ward et al. Accurate TCP Position and Orientation Trajectory Generation in 6DOF Robotic Manipulators and CNC Machine Tools using FIR Filtering and Haversine Synchronisation
Ma et al. The kinematic analysis and trajectory planning study of high-speed SCARA robot handling operation
Li et al. Time-Optimal Velocity Planning of Single-Axis Multipoint Motion With Global Dynamic Programming Algorithm
CN113478479B (zh) 一种基于工业机器人五次多项式轨迹规划中间点的加速度选取方法
JPH0468646B2 (ja)