JPS6057407A - ロボツトコントロ−ラ - Google Patents

ロボツトコントロ−ラ

Info

Publication number
JPS6057407A
JPS6057407A JP16357683A JP16357683A JPS6057407A JP S6057407 A JPS6057407 A JP S6057407A JP 16357683 A JP16357683 A JP 16357683A JP 16357683 A JP16357683 A JP 16357683A JP S6057407 A JPS6057407 A JP S6057407A
Authority
JP
Japan
Prior art keywords
arm
acceleration
deceleration
curves
curve
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.)
Granted
Application number
JP16357683A
Other languages
English (en)
Other versions
JPH0623929B2 (ja
Inventor
Kenji Sakai
坂井 賢治
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.)
Seiko Epson Corp
Suwa Seikosha KK
Original Assignee
Seiko Epson Corp
Suwa Seikosha KK
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 Seiko Epson Corp, Suwa Seikosha KK filed Critical Seiko Epson Corp
Priority to JP58163576A priority Critical patent/JPH0623929B2/ja
Publication of JPS6057407A publication Critical patent/JPS6057407A/ja
Publication of JPH0623929B2 publication Critical patent/JPH0623929B2/ja
Anticipated expiration legal-status Critical
Expired - Lifetime legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Program-control systems
    • G05B19/02Program-control systems electric
    • G05B19/18Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of program data in numerical form
    • G05B19/416Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of program data in numerical form characterised by control of velocity, acceleration or deceleration

Landscapes

  • Engineering & Computer Science (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Numerical Control (AREA)
  • Manipulator (AREA)

Abstract

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

Description

【発明の詳細な説明】 本発明は組豆用ロボットコントローラに関する。
本発明の目的40ボツトの寿命に悪影響を与えることな
く加減速時間を短縮し、ロボットのスピードアップを図
ることにある。
ロボットのスピードアップを図るために、アームを軽く
したり、軸受構造を堅牢にしたり、または加減速曲線を
工夫したりすることは一般によく行なわれていることで
あるが、従来のロボットコントローラはただ一つの加減
速曲線しか持たなかったため、アームの姿勢にかかわら
ず移動距離が決まると一義的に移動時間も決まってしま
っていた。すなわちアームが最大限に伸びた状態ではロ
ボットの受ける衝撃が大きくなって寿命に悪影響を与え
、逆にアームが縮んだ状態では慣性が小さくなって負荷
的に余裕があるにもかかわらずスピードがおさえられる
という欠点があった。
本発明はかかる欠点を除去したもので、以下−実施例に
基づいて説明する。
第1図の1はいわゆる水平多関節型と呼ばれるロボット
で、2のモータが回転するとモータ2を中心に第1アー
ム3が揺動し、4のモータが回転するとモータ4全中尼
・に第2アーノ・5が」:4動する。
第1アーム3と第2アーム5とはDDA演算等によって
駆動量が違っても、同時に動き出し、同時に動き終るよ
うに2IlII同時制御される。
第2図はロボットを真上から見た図で第2アーム5の動
作範囲を示している。この動作範囲を6゜7.8の3つ
のエリアに分割する。
一方コントローラには第6図匹示すように加速度の異な
る加速曲線14,15゜16と減速曲線17@18.1
9がそれぞれメモリ12.15に記憶されている。
アームの駆動に際して駆動指令9が発生すると現在のア
ーム検出手段10によって第2アームの位置が現在6,
7.Bのどのエリアにあるかを検出し7、それぞれ加速
曲線14,15.16を選択する。また駆動後のアーム
姿勢検出手段11によって駆動後の第2アームの位置が
6.7.8のどのエリアにあるかを予想してそれぞれ減
速曲線17.18.19を選択し、加減速曲線生成手段
20によって先に選択したIJOI速曲線と合せて加減
速曲線21を生成する。
コントローラは7JI+減速曲線21にのっとって駆動
パルスを出力うる。
これをさらに具体的な例によって説明する。
第4図のPlからP2−\ロボットアームが駆動される
ものとすると、アーム先端がPlにちるとき第2アーム
の位置はエリア7にあり、慣性モーメントが中位である
ので加速曲線も加速度が中位の15を選択し、駆動後ア
ーム先端がP2へ行ったとき第2アームの位置はエリア
8にあって慣性モーメントが大きくなることが予想され
るので、減速曲線は加速度の小さい19を選択する。
以上の説明によって明らかなように、本発明では慣性モ
ーメントが小さいと加速度の大きい加減速を行い、慣性
モーメントが大きいと加速度の小さい加減速を行うので
ロボットアームに不要な衝撃を与えずに加減速時間を短
縮することができる。
ところで同時に2軸駆動のロボットでは第1アームと第
2アームの駆IJJb1tの比によって第5図に示すと
とく各軸の駆動パルス周波数が違う。ここでaは第1ア
ームの、駆動パルス数、b!”It第2アームの駆動パ
ルス数でちる。
第5図の例では(])と(2)とで第2アームの受ける
衝撃力はほぼ同じでを〕るが、第1アームの受ける衝撃
力は(2]の方が圧倒的に小さい。従ってもし第2アー
ムの駆動に余裕があれば(2)の」ろ合はもつと加速度
全土げても艮いということになる。
以上をかんがみ、第6図は第5図をさらに改良したもの
で、アームの駆動指令22が発生すると駆動前のアーム
姿勢検出手段23.駆動後のアーム姿勢検出手段24に
よってそれぞれ加速曲線25.26.27および減速曲
線28,29.50のうちから一つを選択することri
第6図と同様であるが、同時に駆動斌比較手段31によ
って第1アームの駆!IdImaと第2アームの駆動量
すとの比a/l)を計算し、大小判断32はその結果の
太きさを判断して一定値以下ならば先に選択した加速曲
線、減速曲線上さらに1ランクまたは2ランク加速度の
大きい曲線に変更して加減曲@33を生成する。
これを具体的な例に基ついて説明する。
第7図はロボットアームがP3からP4へ駆動されるさ
まを示しているが、駆動前の駆動後の第2アームの位置
は第4図の)9IIと同じであるので加速曲線26と減
速曲線30がいったん選択される。
同時にa/b を91痒しその結果が1/2以下なら加
速、減速曲線を1ランク加速度の大きいものに変更し、
1/4以下なら2ランク変更する。この」凸金は、1/
4 (a/b (1/2 であるので1ランクあがり加
速曲線は25、減速曲線は29となる。
ここでa/b値の比較に用いた基準値1/2や1/4は
加速、減速曲線の形状や各ランクでの加速度の違いによ
って最適値が設定される。
なお、第7図では同時制御軸が第1アームと第2アーム
の2軸であったが、アームの上T軸や手首水平回転軸等
が付加され、同時3軸、同時4軸駆動となった場合は、
アームの姿勢変化による負荷変動の影響を最も大きくう
ける第1アームの駆動パルス数をaとし、第2アームお
よび上下軸。
手首水平回転軸のうち駆動パルス数がその時最も多い軸
のパルス数をbとして演算を行なえば良い。
以上、水平多関節ロボットをIZQに説明したが、本発
明は垂直多関節ロボット、円筒座標ロボットにもそのま
ま1商用できる。
【図面の簡単な説明】
第1図は水平多関節ロボットを示す図である。 第2図は水平多1刈節ロボットを真上から(也で第2ア
ームの動作範囲を示した図である。第6図は本発明の一
実施例を示す図であり、第4図はロボットアームの動作
の一例を示す図である。第5図は第1.第2アームの各
軸分配パルス列を示した図であり、第6図は本発明の一
実施例を示す図であり、第7図はロボットアーム動作の
一1tiJを示す図である。 1・・・・・・水平多関節ロボット 2・・・・・・第1アーム揺動モータ 5・・・・・・第1アーム 4・・・・第2アーム揺動モータ 5・・・・・・第2アーム /1,7.8・・・・・・第2アームのエリア?922
・・・・・・L′イ乙勤指令 10.23・・・・・・現在のアーム姿勢検出手段11
.24・・・・・・駆動後のアーム姿勢検出手段12.
13・・・・・・メモリ 14.15,16,25,26.27・・・・・・加速
曲線17.18.19.28,29.30 ・=−・減
速曲線20・・・・・・加減速曲線生成手段 21.23・・・・・・加減速曲線 61・・・・・・a/b計算手段 52・・・・・・a/D大小判定手段 以 上 出願人 株式会社 諏訪精工舎 代理人弁理士最上 務 青斗図 矛1了−ム 予2’F−,IA c%) (Li−t b 才5 オフ1閏 矛1了−ム 會z7−ム (2) ^<<b 図 手続補正書(自発) w4.、5)) 、、 io 己2゜ 1、事件の表示 昭和58年特許願第165576号 2 発明の名称 ロボットコントa−ラ 3、補正をする者 事件との関係 出願人 東児都W[宿区西1/r宿2丁目4番1号(236)株
式会社 諏 訪 精 工 舎代表取締役 中 村 恒 
也 4代理人 〒104 東京都中央区にζ橋2−J’146番21号
株式会社 版部セイコー内 最上特許事務所6、補正の
対象 明細臀 手 続 it’ 正 τ11(1研、)1、 唱#′l
情求の範囲全別紙のU]」(補正する。 2、 明約目1)6頁3行目 「加減1111.11!53 、lとあ2)を、「加7
41逗41111糾53」に補正する。 s、on 4u+ v4811s行目 「21.23」とあるを、「21,33Jに補正する。 隻 −t ’l”F irF it^」にの範囲 +11 加速!1,1の曜なる加速曲mおよび減速曲線
を杓lタイβ1記干、傍するための制憶装置直と、駆虫
11前の了−7−姿勢および!lηφメ1後の予44了
−ム姿勢を検出するおのおの一つを選択し、て加減速曲
#を生成する手段とをイ11、生成された前P加減速曲
線にのっとってアーb f、c) l[べIIIハする
ことを特徴とするロボットコントローラ。 (21同11.¥Fに、四QI〕!されると!!数個の
駆!IIl軸のうちアームの姿勲労゛化によるvI荷変
動の影響を最も大きく蟹・ける輔の駆動パルス数とそれ
以外の軸の駆動バルヌ勃との比を計豹−する手段ケ有し
7、この計算結果が一足値り、下lらけFit配了−五
姿勢によってズベ択した加速、ン^ム、速曲線をより加
速電の大きいものに選択し面すことを4−s r+Xと
するロボットコントローラ。

Claims (2)

    【特許請求の範囲】
  1. (1)加速度の異なる加速曲線および減速曲線を複数個
    記憶するための記憶装置と、駆動前のアーム姿勢および
    駆動後の予想アーム姿勢を検出する手段と、前記検出結
    果に基づいて前記記憶装置の複数の加速の加速曲線およ
    び減速曲線のうちからおのおの一つを選択して加減速曲
    線を生成する手段とを有し、生成された前記加減速曲線
    にのっとってアームを駆動することを特徴とするロボッ
    トコントローラ。
  2. (2)同時に駆動される複数個の駆動軸のうちアームの
    姿勢変化による負荷変動の影響を最も大きく受ける軸の
    駆動パルス数とそれ以外の軸の駆動パルス数との比な計
    算する手段を有し、このi!i算結果が一定値以下なら
    ば前記アーム姿勢によって選択した加速、減速曲線に選
    択し直すことを49敬とするロボットコントローラ。
JP58163576A 1983-09-06 1983-09-06 ロボツトコントロ−ラ Expired - Lifetime JPH0623929B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP58163576A JPH0623929B2 (ja) 1983-09-06 1983-09-06 ロボツトコントロ−ラ

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP58163576A JPH0623929B2 (ja) 1983-09-06 1983-09-06 ロボツトコントロ−ラ

Publications (2)

Publication Number Publication Date
JPS6057407A true JPS6057407A (ja) 1985-04-03
JPH0623929B2 JPH0623929B2 (ja) 1994-03-30

Family

ID=15776531

Family Applications (1)

Application Number Title Priority Date Filing Date
JP58163576A Expired - Lifetime JPH0623929B2 (ja) 1983-09-06 1983-09-06 ロボツトコントロ−ラ

Country Status (1)

Country Link
JP (1) JPH0623929B2 (ja)

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6231406A (ja) * 1985-08-02 1987-02-10 Matsushita Electric Ind Co Ltd 多関節ロボツトの位置決め制御装置
JPS6261104A (ja) * 1985-09-11 1987-03-17 Fanuc Ltd 水平関節型ロボツトの加減速制御方式
JPS62251810A (ja) * 1986-04-24 1987-11-02 Seiko Epson Corp ロボツトア−ムの加減速制御装置
JPH01156804A (ja) * 1987-12-14 1989-06-20 Fanuc Ltd 産業用関接型ロボットにおける教示・再生方法
JPH04314107A (ja) * 1990-09-29 1992-11-05 Danfoss As 作業装置の運動制御方法および装置
JPH05297917A (ja) * 1992-04-21 1993-11-12 Mitsubishi Electric Corp 産業ロボット装置
US5367610A (en) * 1988-09-28 1994-11-22 Omron Tateisi Electronics Co. Fuzzy controller for selecting an input signal
JP2004291132A (ja) * 2003-03-26 2004-10-21 Kawasaki Heavy Ind Ltd 把持装置およびこれを備える多関節ロボット
CN114872035A (zh) * 2020-10-16 2022-08-09 深圳市华成工业控制股份有限公司 一种局部减速控制方法、运动速度的规划方法、运动路径的规划方法和数据更新方法

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5856785A (ja) * 1981-09-30 1983-04-04 株式会社三協精機製作所 工業用ロボツトの動作制御装置
JPS58222307A (ja) * 1982-06-21 1983-12-24 Mitsubishi Electric Corp 関節型ロボツトの制御方法

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5856785A (ja) * 1981-09-30 1983-04-04 株式会社三協精機製作所 工業用ロボツトの動作制御装置
JPS58222307A (ja) * 1982-06-21 1983-12-24 Mitsubishi Electric Corp 関節型ロボツトの制御方法

Cited By (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6231406A (ja) * 1985-08-02 1987-02-10 Matsushita Electric Ind Co Ltd 多関節ロボツトの位置決め制御装置
JPS6261104A (ja) * 1985-09-11 1987-03-17 Fanuc Ltd 水平関節型ロボツトの加減速制御方式
JPS62251810A (ja) * 1986-04-24 1987-11-02 Seiko Epson Corp ロボツトア−ムの加減速制御装置
JPH01156804A (ja) * 1987-12-14 1989-06-20 Fanuc Ltd 産業用関接型ロボットにおける教示・再生方法
US5367610A (en) * 1988-09-28 1994-11-22 Omron Tateisi Electronics Co. Fuzzy controller for selecting an input signal
USRE36421E (en) * 1988-09-28 1999-11-30 Omron Corporation Fuzzy controller for selecting an input signal
JPH04314107A (ja) * 1990-09-29 1992-11-05 Danfoss As 作業装置の運動制御方法および装置
JPH05297917A (ja) * 1992-04-21 1993-11-12 Mitsubishi Electric Corp 産業ロボット装置
JP2004291132A (ja) * 2003-03-26 2004-10-21 Kawasaki Heavy Ind Ltd 把持装置およびこれを備える多関節ロボット
CN114872035A (zh) * 2020-10-16 2022-08-09 深圳市华成工业控制股份有限公司 一种局部减速控制方法、运动速度的规划方法、运动路径的规划方法和数据更新方法
CN114872035B (zh) * 2020-10-16 2023-08-22 深圳市华成工业控制股份有限公司 运动速度和路径的规划方法及减速控制和数据更新的方法

Also Published As

Publication number Publication date
JPH0623929B2 (ja) 1994-03-30

Similar Documents

Publication Publication Date Title
Raibert Manipulator control using the configuration space method
US10744654B2 (en) Gripper control device, gripper control method, and gripper simulation device
US20110071677A1 (en) Force balancing mobile robotic system
US12576514B2 (en) Robot control method, robot, and control terminal
US20010045807A1 (en) System and method for using joint torque feedback to prevent oscillation in a flexible robotic manipulator
JPS603714A (ja) ロボツトの制御方法
JPH0623929B2 (ja) ロボツトコントロ−ラ
JP7263217B2 (ja) 制御装置、制御方法、及びロボットシステム
Filipovic et al. Complement of source equation of elastic line
CN114051441A (zh) 机器人机械手的端部执行器通过各种取向区域的触觉反馈
JPH04324507A (ja) 駆動装置の加減速制御方法及びロボットシステム
CN114063490A (zh) 一种智能仿生足式机器人控制系统及方法
CN112873208A (zh) 一种抗噪与动力学约束的机器人实时运动规划方法及装置
Leahy et al. The effects of dynamic models on robot control
CN118502269A (zh) 一种气浮平台目标追踪控制方法
US20050187669A1 (en) Method and apparatus for controlling vibration using accelerometer
CN109976188A (zh) 一种基于时间自动机的板球控制方法及系统
JPS618236A (ja) 移動体制御装置
Kiemel et al. Learning time-optimized path tracking with or without sensory feedback
JP2012130999A (ja) 制御装置およびロボットアームの制御方法
JP2705367B2 (ja) ロボットの制御装置
JPH0255803B2 (ja)
CN105467841A (zh) 一种类人机器人上肢运动的类神经控制方法
JP3596682B2 (ja) ロボットの加減速時間決定方法
JPS62251810A (ja) ロボツトア−ムの加減速制御装置