JPS6142008A - ロボツトの経路制御装置 - Google Patents

ロボツトの経路制御装置

Info

Publication number
JPS6142008A
JPS6142008A JP16413384A JP16413384A JPS6142008A JP S6142008 A JPS6142008 A JP S6142008A JP 16413384 A JP16413384 A JP 16413384A JP 16413384 A JP16413384 A JP 16413384A JP S6142008 A JPS6142008 A JP S6142008A
Authority
JP
Japan
Prior art keywords
robot
point
filters
coordinate
digital filter
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
JP16413384A
Other languages
English (en)
Inventor
Haruhiro Tokida
晴弘 常田
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.)
Nidec Instruments Corp
Original Assignee
Sankyo Seiki Manufacturing Co 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 Sankyo Seiki Manufacturing Co Ltd filed Critical Sankyo Seiki Manufacturing Co Ltd
Priority to JP16413384A priority Critical patent/JPS6142008A/ja
Publication of JPS6142008A publication Critical patent/JPS6142008A/ja
Pending 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/418Total factory control, i.e. centrally controlling a plurality of machines, e.g. direct or distributed numerical control [DNC], flexible manufacturing systems [FMS], integrated manufacturing systems [IMS] or computer integrated manufacturing [CIM]
    • G05B19/4181Total factory control, i.e. centrally controlling a plurality of machines, e.g. direct or distributed numerical control [DNC], flexible manufacturing systems [FMS], integrated manufacturing systems [IMS] or computer integrated manufacturing [CIM] characterised by direct numerical control [DNC]
    • 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
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/34Director, elements to supervisory
    • G05B2219/34042Filter
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/43Speed, acceleration, deceleration control ADC
    • G05B2219/43048Step change in reference, soft start, smoothing reference
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02PCLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Landscapes

  • Engineering & Computer Science (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Human Computer Interaction (AREA)
  • General Engineering & Computer Science (AREA)
  • Quality & Reliability (AREA)
  • Numerical Control (AREA)
  • Manipulator (AREA)
  • Control Of Position Or Direction (AREA)

Abstract

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

Description

【発明の詳細な説明】 発明の技術分野 本発明は、ロボットの運動経路を制御するための装置に
関する。
従来技術 ポイントッーポイント方式の運動経路制御では、原則と
して通過点の途中の経路は問題とされない。
しかし、実際の動作時において、あるポイントの近くを
通過したいという場合がある0例えば、第1図に示すよ
うに、速度を落とすことなく、障害物をよけて、ポイン
トP1からポイントP3へ移動させるとき、その途中の
ポイントP2の近くを経由してポイントP3へ移動させ
る必要がある。
この場合、ポイントP2では位置決めの必要はないが、
完全な経路(点線)に対してどれだけずれるかを明確に
定義できる必要がある。
従来の制御方式では、ポイントP2の位置決め終了範囲
(ボジシッンゾーン)を広く採ることにより、指令値が
ポイントP2に到達した時点で、動作点が2点鎖線で示
す円のポジシランゾーンの範囲に入っておれば、動作点
がポイントP2に到達したものとみなし、次のポイント
P3への指令を与え始めることによって、ある範囲内で
滑らかな軌跡が得られる。
しかし、上記の制御方法では、指令値がポイン)P2に
到達した時点で、実際の動作点がポイントP21より内
側にあると、動作点がポジションゾーンの円弧を描き始
めるのはボジシッンゾーンの設定値より内側に入ってし
まうため、ポジションゾーンが大きく採れないことにな
る。また、ボジシッンゾーンがどの大きさまで採れるか
は、口、ポットのサーボ系の特性に依存するため、スピ
ードや負荷などによって、曲がり始める点が変化してし
まう、さらに、速度変化が起こりやすいため、滑らかな
運動が困難となる。
また、他の制御方法として、第2図に示すように、動作
点がある範囲に入った時点で、新たな運動方向を演算に
より求める方法や、目標のポイントからある距離に近づ
いたときに、動作点の方向を変える方法などが採用され
ている。
しかし、これらの方法では、実際の軌跡を演算するため
、円弧方程式を解かな(てはならず、また位置検出や指
令方向の変更などが必要とされるため、制御方式、しい
ては制御回路が複雑となる。
このような実情から、ロボットの動作点を簡単な手段に
よって、滑らかな曲線で補間できる手段が望まれている
発明の目的およびその解決手段 したがって、本発明の目的は、複雑な演算を必要とせず
、ロボットの動作経路を滑らかな曲線に設定できるよう
にし、かつ速度および加速度の急変を抑えながら、運動
軌跡のずれを予め明確に定義できるようにすることであ
る。
上記目的のもとに、本発明は、ロボットの運動指令部と
ロボット駆動部との間に各座標系の成分毎にディジタル
フィルタを介在させ、このディジタルフィルタの立ち上
がりおよび立ち下がりの遅れ特性を利用して、ロボット
の動作点の経路に滑らかな曲線の軌跡を実現するように
している。
発明の構成 次に、第3図および第4図に基づいて本発明の詳細な説
明する。
このロボットの経路制御装置1は、従来のものと同様に
、運動指令部2、座標変換器5および各座標出力X、Y
毎に設けられたサーボ制御系のロボット駆動部6.7を
備えており、特にその運動指令部2と座標変換s5との
間に座標出力x、 y毎にディジタルフィルタ3.4を
備えている。
第4図は、このディジタルフィルタ3.4の構成を示し
ている。このディジタルフィルタ3.4の入力端は、内
部の減算器8、乗算器9および加算器lOを経て、出力
端に接続されており、またこの加算l1110の出力端
は、減算器8および加算器10の他の入力端にも接続さ
れている。このディジタルフィルタ3.4は、例えばコ
ンピュータ制御下にあって、サンプリング周期で演算を
行い、座標出力X、Yを入力とし、座標出力X’ 、Y
’を発生する。このディジタルフィルタ3.4は、遅れ
要素として働き、積分回路のアナログフィルタの伝達関
数1/(1+sT)に近い特性を持っている。したがっ
て、そのステップ応答は、第5図に示すように、時間軸
を上で、指数関数的に立ち上がり、また立ち下がること
になる。
発明の作用 次に、上記経路制御装置1の作用を説明する。
今、第6図Aに示すように、ロボットの移動経路がポイ
ントP1−ポイントP2→ポイントP3の順に移動する
ものとすれば、各ポイントP1、P2では、運動指令部
2が座標出力x、yの各成分の出力信号を発生し、これ
をそれぞれのディジタルフィルタ3.4.に送り込んで
いる。これらのディジタルフィルタ3.4は、所定のサ
ンプリング周期でポイントPiからポイントP2に至る
間で、座標出力X、Yの各成分を細分割し、時l111
遅れの座標出力x’ 、y’を発生し、これを座標変換
器5に送り込む、この1回のサンプリング周期(一定の
単位時間)の位置の変化量が速度と対応しており、した
がって座標出力x’ 、y’ は、速度に対応した出力
となっている。また、補間ビ。
チは、1回のサンプリング毎の変化量(距M)を指すこ
とになる。
このようにして、座標出力X、Yは、第6図B1Cのよ
うにディジタルフィルタ3.4を通過する過程で、時間
軸を上で遅れた座標出力X’ 、Y’に変化する。この
結果、ロボット動作点の軌跡は、第6図りに示すように
、直線に内接する指数関数的な滑らかな曲線となってい
る。
これらのディジタルフィルタ3.4の遅れ時間(時定数
)は、乗算器9の係数1 / aの値およびサンプリン
グ周期(一定の単位時間)を変化させることによって、
自由に調整できる。しかもその軌跡は、ディジタルフィ
ルタ3.4の時定数によって一義的に決定されるため、
指数関数的な曲線の軌跡も、その時定数によって設定で
きる。実際の運動経路が直線から外れる位置またはそれ
に接する位置は、サンプリング周期をT3とし、ディジ
タルフィルタ3.4の時定数をTとしたとき、下記の式
によって求められる。
T/TsX(補間ピッチ) 発明の変形例 なお、これらのディジタルフィルタ3.4の係数1 /
 aは、座標出力Xまたは座標出力Y毎に独立に設定す
ることもできる。また、この発明は、X−Y平面座標系
に限らず、x−y−z立体座標系にも応用できる。さら
にディジタルフィルタ3.4の具体的な構成は、所定の
遅れ特性によって、その都度変化するから、実施例のも
のに当然限定されない。
発明の効果 本発明では、下記の特有の効果が得られる。
ロボットの動作指令位置が連続的に変化するため、ロボ
ット駆動部(サーボモータ)に過大な電流が流れず、滑
らかな運動特性が得られる0曲がり始める点が所定の指
令値のもとでは常に一定であり、しかもその時定数を変
えることによって、所定の位置に設定できるから、動作
経路が予め確定できる。また、その時定数が動作中にも
変更可能であるから、自由な運動補間が可能となる。
ロボットの起動時または停止にディジタルフィルタの時
定数によって、可変速制御が自動的に行われるため、指
令値の側で可変速制御が必要とされず、アナログ的な遅
れ要素による制御動作の乱れが少ない、複雑な計算や位
置決め終了範囲を可変とするためのハードウエーアなど
が必要とされないため、制御部分が簡略化できる。この
ような機能がディジタルフィルタによって得られるから
、ノイズ、温度変化や精度についての問題がなくなり、
またマイクロコンピュータによる制御が可能となる。
【図面の簡単な説明】
第1図および第2図は従来の連動経路制御方式の説明図
、第3図は本発明のロボットの経路制御装置のブロック
線図、第4図はディジタルフィルタのブロック線図、第
5図はディジタルフィルタのステップ応答の特性図、第
6図A、B、CJDは動作時の特性を示すグラフである
。 l・・ロボットの経路制御装置、2・・運動指令部、3
.4・・ディジタルフィルタ、5・・座標変換器、6.
7・・ロボット駆動部、8・・減算器、9・・乗算器、
1o・・加算器。 特 許 出 願 人 株式会社三協精機製作所第1図 
   第2図 第6図 A −t−

Claims (1)

    【特許請求の範囲】
  1. 座標系の各成分毎の出力をディジタルフィルタに入力し
    、このディジタルフィルタの出力をロボット駆動部に入
    力してロボットを動作させるロボットの経路制御装置。
JP16413384A 1984-08-03 1984-08-03 ロボツトの経路制御装置 Pending JPS6142008A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP16413384A JPS6142008A (ja) 1984-08-03 1984-08-03 ロボツトの経路制御装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP16413384A JPS6142008A (ja) 1984-08-03 1984-08-03 ロボツトの経路制御装置

Publications (1)

Publication Number Publication Date
JPS6142008A true JPS6142008A (ja) 1986-02-28

Family

ID=15787368

Family Applications (1)

Application Number Title Priority Date Filing Date
JP16413384A Pending JPS6142008A (ja) 1984-08-03 1984-08-03 ロボツトの経路制御装置

Country Status (1)

Country Link
JP (1) JPS6142008A (ja)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05204420A (ja) * 1992-01-29 1993-08-13 Mitsubishi Electric Corp 2つの主軸を有する工作機械の制御装置
JP2020097083A (ja) * 2018-12-18 2020-06-25 日本電産サンキョー株式会社 ロボットの制御装置及び制御方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5354679A (en) * 1976-10-27 1978-05-18 Hitachi Seiko Ltd Acceleration and deceleration speed cotrol system
JPS554462A (en) * 1978-06-26 1980-01-12 Toshihiro Sekido Door
JPS5990107A (ja) * 1982-11-13 1984-05-24 Fanuc Ltd 加減速回路
JPS59114604A (ja) * 1982-12-22 1984-07-02 Yaskawa Electric Mfg Co Ltd 産業用ロボツトの加減速制御方式
JPS59168513A (ja) * 1983-03-16 1984-09-22 Fanuc Ltd 加減速制御方式

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5354679A (en) * 1976-10-27 1978-05-18 Hitachi Seiko Ltd Acceleration and deceleration speed cotrol system
JPS554462A (en) * 1978-06-26 1980-01-12 Toshihiro Sekido Door
JPS5990107A (ja) * 1982-11-13 1984-05-24 Fanuc Ltd 加減速回路
JPS59114604A (ja) * 1982-12-22 1984-07-02 Yaskawa Electric Mfg Co Ltd 産業用ロボツトの加減速制御方式
JPS59168513A (ja) * 1983-03-16 1984-09-22 Fanuc Ltd 加減速制御方式

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05204420A (ja) * 1992-01-29 1993-08-13 Mitsubishi Electric Corp 2つの主軸を有する工作機械の制御装置
JP2020097083A (ja) * 2018-12-18 2020-06-25 日本電産サンキョー株式会社 ロボットの制御装置及び制御方法

Similar Documents

Publication Publication Date Title
CN100580592C (zh) 一种基于滤波技术的数控系统加减速控制方法
JPH11249724A (ja) ロボット制御のための経路計画装置及び経路計画方法
CN109313429A (zh) S型速度规划方法、装置、系统、机器人以及数控机床
JPS6142008A (ja) ロボツトの経路制御装置
JPH04254294A (ja) 予め定められた飛行パラメータ限界の範囲内で航空機の指令された操作を制御するための装置および方法
JP2003241811A (ja) 産業用ロボットの経路計画方法及び経路計画装置
CN108563122B (zh) 一种移动机器人速度平滑插值方法
KR100819654B1 (ko) 비대칭 에스 커브를 이용한 모터 제어 방법
JP3809097B2 (ja) サーボモータの制御装置及び制御方法
WO1989002111A1 (fr) Systeme d'interpolation de developpante
JPH07120215B2 (ja) ロボットの制御方法
JPH07210233A (ja) ロボットの軌道の補間方法と補間装置
JP3214514B2 (ja) 位置決め制御方法およびその装置
JP3802692B2 (ja) サーボ制御装置
JP3210948B2 (ja) 加減速パターン生成装置及び方法
JP2703099B2 (ja) 産業用ロボットのコンベア追従方法
JP2521449B2 (ja) 軌跡制御装置
JP2702559B2 (ja) 数値制御装置の補間方式
JPH02137006A (ja) 速度制御装置
KR100427522B1 (ko) 연속이동경로 생성방법
JPH05181537A (ja) スライディングモード制御方法および装置
JPH0127441B2 (ja)
JPH0991020A (ja) 教示ロボット制御方法
SU894673A1 (ru) Регул тор с переменной структурой
JPH08132369A (ja) ロボット制御装置