JPS61248104A - マニピユレ−タの制御装置 - Google Patents

マニピユレ−タの制御装置

Info

Publication number
JPS61248104A
JPS61248104A JP60088735A JP8873585A JPS61248104A JP S61248104 A JPS61248104 A JP S61248104A JP 60088735 A JP60088735 A JP 60088735A JP 8873585 A JP8873585 A JP 8873585A JP S61248104 A JPS61248104 A JP S61248104A
Authority
JP
Japan
Prior art keywords
control
model
positioning
manipulator
parameter
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
JP60088735A
Other languages
English (en)
Inventor
Toru Takahashi
徹 高橋
Kunihiko Kurami
倉見 邦彦
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.)
Nissan Motor Co Ltd
Original Assignee
Nissan Motor 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 Nissan Motor Co Ltd filed Critical Nissan Motor Co Ltd
Priority to JP60088735A priority Critical patent/JPS61248104A/ja
Priority to US06/853,900 priority patent/US4771389A/en
Publication of JPS61248104A publication Critical patent/JPS61248104A/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/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/19Numerical 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 positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path
    • G05B19/21Numerical 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 positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an incremental digital measuring device
    • G05B19/23Numerical 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 positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an incremental digital measuring device for point-to-point control
    • G05B19/231Numerical 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 positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an incremental digital measuring device for point-to-point control the positional error is used to control continuously the servomotor according to its magnitude
    • G05B19/232Numerical 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 positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an incremental digital measuring device for point-to-point control the positional error is used to control continuously the servomotor according to its magnitude with speed feedback only
    • 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/33Director till display
    • G05B2219/33074Calculation loop, first one slow changing value, then several quick varying values

Landscapes

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

Abstract

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

Description

【発明の詳細な説明】 [発明の技術分野] この発明は、マニピュレータの動作を制御する装置に関
し、特に高速・高精度の位置決め制御を可能にしたマニ
ピュレータの制御装置に関する。
[発明の技術的背景とその問題点] 近年、例えば人間の上肢の機能に類似した機能を有する
産業用ロボット、即ちマニピュレータの制御装置におい
て、電子計算機の技術的発展につれ、制御手段としてマ
イクロコンピュータ等を利用した制御装置が種々提案さ
れている。このような装置としては、例えば第4図に示
すようなものがある。
第4図は従来のマニピュレータの制御装置のブロック図
の一例を示す。同図において、51はマニピュレータ5
3を制御対象として、例えばマニピュレータ53の関節
角θを目標関節角θrとなるよう位置決め制御を行うモ
デル追従形制御装置で、具体的には、例えばマイクロコ
ンピュータ等で構成されるものである。この制御袋@5
1は規範モデル55.積分器57.ゲイン倍装置59゜
61.63、及び比較器65.67を有しており、マニ
ピュレータ53の関節角θ及び関節角速度θ、並びに規
範モデルで生成される関節角θM及び関節角速度θMか
ら、次式によりマニピュレータ53の制御入力Uを決定
し、マニピュレータの関節角θを制御するものである。
ここで、F+ 、F2 、F3は夫々ゲイン倍装置59
,61.63の制御ゲイン、eは比較器65の出力であ
りe−θ−θMである。
ところで、このような従来のマニピュレータの制御装置
における各軸の規範モデル55は例えば次式で示すよう
な2次系伝達関数のモデルとして任意に構成することが
できる。
つまり、規範モデル55は、■式で表わされるモデルの
伝達関数T(S)におけるパラメータa1゜a2,1(
を規定することにより、目標関節角θ「に対応したモデ
ルの関節角θM及び関節角速度θMを生成するのである
しかし、この従来のマニピュレータの制御装置にあって
は、規範モデル55のパラメータの規定方法が固定され
ているため、各軸の始点から終点までのステップ幅θW
が異なる場合、換言すれば各軸の目標関節角θrが異な
る場合には、第5図に示すように、規範モデル55の動
特性は同じであるが、各軸の制御による移動開始から目
標関節角θ「に対して許容範囲±Δθに収まるまでの所
要時間(所謂位置決め時間)Trに差が生じ、各軸の位
置決め時間が不均一となり、位置決め近くでのマニピュ
レータのアームの動きが不規則となり、所wIPTP動
作による高速位置決め制御が難しいという問題があった
[発明の目的] この発明は、上記に鑑みてなされたもので、その目的と
しては、各軸の位置決め時間を均一にしたマニピュレー
タの制御装置を提供することにある。
[発明の概要] この発明は、上記目的を達成するため、第1図に示すご
とくマニピュレータの各軸関節角及び関節角速度を規範
モデルとして生成し、モデル追従制御方式により位置決
め制御を行う装置において、予め設定された位置決め時
間に応じて前記規範モデルのパラメータを決定するモデ
ル設定手段1と、前記規範モデルのパラメータに応じて
制御ゲインを決定する制御ゲイン設定手段3とを有する
ことを特徴とするマニピュレータの制御装置。
[発明の実施例] 以下、図面を用いてこの発明の詳細な説明する。
第2図は、この発明の一実施例に係るマニピュレータの
制御装置の構成図である。この制御l装置は、例えばマ
ニピュレータのアームの関節角θを目標関節角θrとな
るよう位置決め制御を行なう装置である。同図における
構成は、マニピュレータのアームを駆動するDCモータ
−27と、関節角速度θを検出するタコジェネレータ2
9と、関節角θを検出するカウンタ31と、関節角速度
θ及び関節角θを入力して後述する処理を行うマイクロ
コレピユータ(MPU)21と、l1lIII入力値を
アナログ信号に変換して出力するD/A変換器23と、
サーボアンプ25とを有する構成となっている。尚、2
3乃至31は各関節軸毎に設けられるものであり、第2
図は、代表的な1つの関節軸についてのみ図示したもの
である。
すなわち、このような構成によればMPU21としては
、所定の周期毎に関節角θを求め、また関節角θの時間
変化から関節角速度δを求め、所定の制御手法に従って
制御入力Uを決定し、DCモータ−27を制御すること
により、DCモータ−27により駆動されるマニピュレ
ータのアームの関節角θを目標関節角θrとなるよう位
置決め1lI1111Iを行なうことができるのである
次に、本実施例に係るマニピュレータ制御装置の作用原
理を図を用いて説明する。
ここで、本実施例に係るマニピュレータの制御装置をブ
ロック構成にて図示すれば、従来と同様、第4図に示す
ブロック構成となる。すなわち、各軸の目標関節角θr
を入力しモデルの関節角θM及び関節角速度θMを時々
刻々生成する規範モデル55と、定常オフセット除去用
の積分器57と、モデル追従制御させるためのゲイン倍
装置59゜61.63と、比較器65.67を有するブ
ロック構成となる。
このようなモデル追従制御系においては、ある軸の規範
モデル55を例えば次式に示すような2次系伝達関数の
モデルとして記述できる。
まず、あるP T P tijl mにおいて、所定の
位置決め時間Trに対して各軸の規範モデルの整定時間
がTrに一致するように規範モデル55のパラメータa
を決定する。例えば、ある軸の始点から終点までのステ
ップ幅をθWとする時、θW′−θW−Δθに達するま
での時間がT「となる様なパラメータaを求め規範モデ
ル55を決定すればよい。
系の伝達関数が0式で表わされる時、ステップ応答は次
式となる。
θ(f ) −(e−’ −2e″+ e−2dJ−)
6w −・・■ここで、【−T「で、θ(1)−θW′
となるaを求めると、次式のように(Tr 、θW)の
関数となる。
次に、■式で決定されるパラメータaに基づいて、モデ
ル追従制御ゲインF+ 、F2 、F3を求める。 今
、規範モデルを状態方程式表示で記述すると次式となる
同様にマニピュレータ53は次式で記述される。
また、位置偏差eを次式で定義する。
e=θ−8M             ・・・■■、
■、■式より次式で記述される拡大系が得られる。
ここで、次式で記述される二次形式評価関数Jを最小と
する制御系を設計する。
J=5′:(e2+λfi2)dt        −
@)(λ:vA整パラメータ) 積分型最通レギュレータの論理に従って、0式を最小に
する最適制御人力Uを求めると、次式となる。
ここに、制御ゲインF+ 、F2 、F3は、マニピュ
レータ53 (A、B、C)、規範モデル(AM 。
BM、CM)、及び調整パラメータλから、例えばp 
otter氏等の手法等により導出される。ここで、マ
ニピュレータ53 (A、B、C)及び調整パラメータ
λを固定とする時、制御ゲインF+ 。
F2 、F3はパラメータaの関数となる。
従って、先ず位置決め時間Trと移動角θWに応じて規
範モデルにおけるパラメータaを決定し、次に、パラメ
ータaに応じた制御ゲインF+ 、 F2、F3を決定
することで、各軸の位置決め時間のばらつきがなくなり
、高速位費決め制御が可能となるのである。
尚、パラメータaの決定に際しては、予め適当な(Tr
 、θW)の組み合わせからaの値を求めて、二次元テ
ーブルの形でMPU21内部のメモリに記憶し、−次補
間等によりaを決定することにすれば、計算時間は短縮
され、高速制御が可能となる。また、制御ゲインF+ 
、F2 、F3の決定に際しても同様に、予め適当なa
に対する制御ゲインF+ 、F2 、F3を求めてテー
ブル化し、記憶しておくことにより計算時間の短縮が計
れる。
次に、上述した原理を踏まえて、本実施例の作用を第3
図のフローチャートを用いて説明する。
先ず、位置決め制御の目標関節角θr1位置決め時間T
r、目標関節角θ「に対する許容範囲Δθを設定する(
ステップ110)。次に、関節角空間のある始点から終
点の各軸に分解された始終点の差、即ちステップ幅θW
を算出する(ステップ120)。次に、設定された位置
決め時間Trとステップ幅θWに応じて、■式で記述さ
れる規範モデルのパラメータaを、予めa−f(Tr。
θW)により作成されたパラメータaのテーブルよりル
ックアップして決定する(ステップ130)。この決定
されたパラメータaはステップ幅θWに対し、位置決め
時間がTrとなる様算出された値である。次に、このパ
ラメータaに応じた制御ゲインF+ 、F2 、F3を
、予めF+=<1+(a)、 F2 =lJ2  (a
 )、 F3 =(J+  (a )により作成された
制御、ゲインF+ 、F2 、F3のテーブルよりルッ
クアップして決定ザる(ステップ14o)。この決定さ
れた制御ゲインF+ 、F2 、F3は、規範モデル5
5に対し最適に追従する様計算された値である。次に、
決定された規範モデルより、モデルのI11節角θM及
び関節角速度δMを算出する(ステップ150)。次に
、算出決定された諸量により、モデル・追従のためのフ
ィードバック制御計算を行い、制御入力Uを算出しくス
テップ160)、これをD/A変換器23に出力する(
ステップ170)。次に、現在のマニピュレータ53の
関節角θが、目標関節角θrに対する許容範囲Δθ内に
所定時間数まっているか否かを判断しくステップ180
) 、収まっていなければ、ステップ150に戻り制御
を続け、収まっていれば、位置決めと判断し制御を終了
する。
[発明の効果] 以上説明したように、この発明によれば、マニピュレー
タの各軸の関節角及び関節角速度を規範モデルとして生
成し、モデル追従制御方式により位置決め制御を行う装
置において、モデル設定手段1により予め設定された位
置決め時間に応じて前記規範モデルのパラメータを決定
し、制御ゲイン設定手段3により前記規範モデルのパラ
メータに応じて制御ゲインを決定することとしたので、
マニピュレータの各軸の位置決め時間が均一となり、位
置決め近くでのアームの動きの安定した制御ができ、結
果としてPTP動作による高速位置決め制御が可能とな
る。
【図面の簡単な説明】
第1図はクレーム対応図、第2図は本発明の一実施例に
係るマニピュレータの制御装置の構成図、第3図は当該
装置の処理フローチャート、第4図は従来のマニピュレ
ータの制御装置のブロック図、第5図は従来のマニピュ
レータの制御装置の作用を説明するための図である。 1・・・モデル設定手段 2・・・制御ゲイン設定手段 特許出願人     日産自動車株式会社グ’jk−c
Φ

Claims (1)

    【特許請求の範囲】
  1. マニピュレータの各軸の関節角及び関節角速度を規範モ
    デルとして生成し、モデル追従制御方式により位置決め
    制御を行う装置において、予め設定された位置決め時間
    に応じて前記規範モデルのパラメータを決定するモデル
    設定手段と、前記規範モデルのパラメータに応じて制御
    ゲインを決定する制御ゲイン設定手段とを有することを
    特徴とするマニピュレータの制御装置。
JP60088735A 1985-04-26 1985-04-26 マニピユレ−タの制御装置 Pending JPS61248104A (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP60088735A JPS61248104A (ja) 1985-04-26 1985-04-26 マニピユレ−タの制御装置
US06/853,900 US4771389A (en) 1985-04-26 1986-04-21 Control method and unit for controlling a manipulator

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP60088735A JPS61248104A (ja) 1985-04-26 1985-04-26 マニピユレ−タの制御装置

Publications (1)

Publication Number Publication Date
JPS61248104A true JPS61248104A (ja) 1986-11-05

Family

ID=13951177

Family Applications (1)

Application Number Title Priority Date Filing Date
JP60088735A Pending JPS61248104A (ja) 1985-04-26 1985-04-26 マニピユレ−タの制御装置

Country Status (2)

Country Link
US (1) US4771389A (ja)
JP (1) JPS61248104A (ja)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6411773A (en) * 1987-07-06 1989-01-17 Kobe Steel Ltd Method of controlling industrial robot
CN109159104A (zh) * 2018-08-31 2019-01-08 杭州电子科技大学 一种水下机器人的多自由度机械手

Families Citing this family (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4866641A (en) * 1987-04-24 1989-09-12 Laser Alignment, Inc. Apparatus and method for controlling a hydraulic excavator
JP2707087B2 (ja) * 1987-09-09 1998-01-28 ファナック株式会社 ロボット制御装置
US5189618A (en) * 1989-06-28 1993-02-23 Nippondenso Co., Ltd. Automotive cruise control system for controlling vehicle to run at constant speed
JP2887948B2 (ja) * 1991-06-26 1999-05-10 株式会社デンソー 車両用速度制御装置
US5602968A (en) * 1994-05-02 1997-02-11 The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration Task space angular velocity blending for real-time trajectory generation
US5572809A (en) * 1995-03-30 1996-11-12 Laser Alignment, Inc. Control for hydraulically operated construction machine having multiple tandem articulated members
JPH10133703A (ja) * 1996-10-31 1998-05-22 Fujitsu Ltd 適応的ロバスト制御装置
US5953838A (en) * 1997-07-30 1999-09-21 Laser Alignment, Inc. Control for hydraulically operated construction machine having multiple tandem articulated members
US6152238A (en) 1998-09-23 2000-11-28 Laser Alignment, Inc. Control and method for positioning a tool of a construction apparatus
US20020019722A1 (en) * 2000-07-19 2002-02-14 Wim Hupkes On-line calibration process
US7457698B2 (en) * 2001-08-31 2008-11-25 The Board Of Regents Of The University And Community College System On Behalf Of The University Of Nevada, Reno Coordinated joint motion control system
US8065060B2 (en) * 2006-01-18 2011-11-22 The Board Of Regents Of The University And Community College System On Behalf Of The University Of Nevada Coordinated joint motion control system with position error correction

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS54134406A (en) * 1978-04-11 1979-10-18 Tdk Corp Magnetic recording medium
JPS5635206A (en) * 1979-08-31 1981-04-07 Hitachi Ltd Gain control device for servo-group driving unit
JPS5745604A (en) * 1980-09-03 1982-03-15 Hitachi Ltd Servo system driving device
JPS57121706A (en) * 1981-01-22 1982-07-29 Agency Of Ind Science & Technol Adaptive servomechanism to standard model
JPS58134308A (ja) * 1982-02-04 1983-08-10 Mitsubishi Electric Corp マニピユレ−タの制御装置
JPS58169203A (ja) * 1982-03-30 1983-10-05 Fujitsu Ltd 移動体の適応制御方式
JPS6063620A (ja) * 1983-09-16 1985-04-12 Komatsu Ltd サ−ボ制御方法

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4243923A (en) * 1979-01-22 1981-01-06 Massachusetts Institute Of Technology Servo-controlled mobility device
US4280182A (en) * 1979-05-14 1981-07-21 John Mickowski Microcomputer control system
JPS5685106A (en) * 1979-12-14 1981-07-11 Hitachi Ltd Robot teaching method
US4401930A (en) * 1980-12-30 1983-08-30 Toyota Jidosha Kogyo Kabushiki Kaisha Method of sensing position of movable body and apparatus therefor
JPS57197613A (en) * 1981-05-29 1982-12-03 Fanuc Ltd Measuring method by numerical control device
US4578749A (en) * 1982-06-23 1986-03-25 Kabushiki Kaisha Toyota Chuo Kenkyusho Method for measuring driving amount of motor and apparatus therefor
US4608651A (en) * 1982-10-28 1986-08-26 Kabushiki Kaisha Kobe Seiko Sho Control system for direct teaching/playback type robots
JPS59107884A (ja) * 1982-12-10 1984-06-22 株式会社日立製作所 ロボツトの制御方式

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS54134406A (en) * 1978-04-11 1979-10-18 Tdk Corp Magnetic recording medium
JPS5635206A (en) * 1979-08-31 1981-04-07 Hitachi Ltd Gain control device for servo-group driving unit
JPS5745604A (en) * 1980-09-03 1982-03-15 Hitachi Ltd Servo system driving device
JPS57121706A (en) * 1981-01-22 1982-07-29 Agency Of Ind Science & Technol Adaptive servomechanism to standard model
JPS58134308A (ja) * 1982-02-04 1983-08-10 Mitsubishi Electric Corp マニピユレ−タの制御装置
JPS58169203A (ja) * 1982-03-30 1983-10-05 Fujitsu Ltd 移動体の適応制御方式
JPS6063620A (ja) * 1983-09-16 1985-04-12 Komatsu Ltd サ−ボ制御方法

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6411773A (en) * 1987-07-06 1989-01-17 Kobe Steel Ltd Method of controlling industrial robot
CN109159104A (zh) * 2018-08-31 2019-01-08 杭州电子科技大学 一种水下机器人的多自由度机械手

Also Published As

Publication number Publication date
US4771389A (en) 1988-09-13

Similar Documents

Publication Publication Date Title
JPS61248104A (ja) マニピユレ−タの制御装置
Torfs et al. Comparison of two feedforward design methods aiming at accurate trajectory tracking of the end point of a flexible robot arm
JPS63314606A (ja) 多関節ロボットの制御装置
JP2014136260A (ja) 制御装置
CN110955192A (zh) 伺服控制装置、机器人及伺服控制方法
JPH05118302A (ja) サーボモータの制御装置
JPH02217904A (ja) 位置決め制御装置
US6341244B1 (en) Method and control structure for controlling moments in numerically controlled elastic (and therefore oscillation-capable) multiple mass systems
JPH03289385A (ja) モータ制御のゲイン調整方法
Shen et al. Uncalibrated visual servoing of planar robots
JP2691591B2 (ja) 力制御ロボットの制御方式
JPH07121239A (ja) ロボット装置の制御方法
JP2002258904A (ja) 非線形制御対象のフィードバック制御方法
JP2707149B2 (ja) 速度、位置のロバスト的制御装置
JP2709766B2 (ja) サーボモータのフィードフォワード制御方式
KR100194144B1 (ko) 피이드포워드에 의한 서보모터의 위치 제어방법 및 제어기
Braun et al. Performance Comparison between Position Controllers for a Robotic Arm Manipulator
JPS61217802A (ja) ロボツト制御装置
JPH03269703A (ja) 指令補正方法
JP3528377B2 (ja) パルスモータの制御方法およびその装置
Dahl Path constrained robot control with limited torques-experimental evaluation
Tarn et al. Nonlinear feedback method of robot control: A preliminary experimental study
JP2004102556A (ja) 位置決め制御装置
JPH04306712A (ja) マニピュレータの制御装置
Brock The Positioning of the Electromechanical System Using Sliding Mode Control without a Reaching Phase