JP2003303022A - 位置決め制御装置 - Google Patents

位置決め制御装置

Info

Publication number
JP2003303022A
JP2003303022A JP2002109699A JP2002109699A JP2003303022A JP 2003303022 A JP2003303022 A JP 2003303022A JP 2002109699 A JP2002109699 A JP 2002109699A JP 2002109699 A JP2002109699 A JP 2002109699A JP 2003303022 A JP2003303022 A JP 2003303022A
Authority
JP
Japan
Prior art keywords
speed
positioning
elastic deformation
command
target position
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
JP2002109699A
Other languages
English (en)
Other versions
JP3982308B2 (ja
Inventor
Kazuhiro Tsuruta
和寛 鶴田
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.)
Yaskawa Electric Corp
Original Assignee
Yaskawa Electric 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 Yaskawa Electric Corp filed Critical Yaskawa Electric Corp
Priority to JP2002109699A priority Critical patent/JP3982308B2/ja
Publication of JP2003303022A publication Critical patent/JP2003303022A/ja
Application granted granted Critical
Publication of JP3982308B2 publication Critical patent/JP3982308B2/ja
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Landscapes

  • Feedback Control In General (AREA)
  • Control Of Position Or Direction (AREA)

Abstract

(57)【要約】 【課題】メカの持つ弾性変形を考慮し、高精度な位置決
め装置を提供する。 【解決手段】位置制御部1と、速度制御部2と、電流制
御部3と、モ−タ位置を検出する検出部6と、トルク指
令とモ−タ速度を入力し、外乱を推定する外乱推定部7
と、を備える位置決め制御装置において、外乱推定部7
内で推定される推定外乱力を基に、目標位置に到達した
時点で位置決め機構内に残存する弾性変形量を推定し、
目標位置に弾性変形量を加えた位置を新たな目標位置と
して位置決め制御を行い、新たな目標位置に到達した
後、弾性変形量分戻す位置制御を行う。

Description

【発明の詳細な説明】
【0001】
【発明の属する技術分野】本発明は、ロボットや工作機
械等の制御装置、特に、高精度位置決め動作を必要とす
る位置決め制御装置に関する。
【0002】
【従来の技術】位置決め制御を行う場合、目標位置に高
速かつ高精度に到達するため、制御系のフィードバック
ゲインを上げる方法、制御対象をモデル化して、そのモ
デルに追従するように制御を行う方法、などが一般的で
ある。フィードバックゲインを上げることにより、メカ
特性の影響を抑えることが可能になるばかりでなく、高
速・高精度応答を実現できる。また、制御対象のモデル
を積極的に用いて、予めメカ特性を補償して制御を行う
ことにより、フィードバックゲインをそれほど上げるこ
となく、高速・高精度応答を実現できる。また、特開平
10−164879では、サーボモータの電流とねじれ
量の関係を予め求めておき、検出電流に基づき、ねじれ
量補償値を速度指令に加える装置が開示されている。
【0003】
【発明が解決しようとする課題】ところ前記従来の技術
では、位置決め停止した状態において、メカの持つ弾性
変形の影響を考慮していないため、停止した位置を保持
するための保持トルクが必要であるばかりでなく、弾性
変形した状態でメカを固定するため、メカを劣化する恐
れがある。また、停止した状態から動き出す際、動き出
す方向によって、弾性変形をさらに増大させる方向か、
弾性変形を解除する方向かによって、弾性変形が外乱と
して働く特性が異なるため、非常に小さい移動量の位置
決め動作に影響するという問題がある。また、サーボモ
ータの電流からねじれ量補償値を求め、このねじれ補正
量を速度指令に加える装置では、位置決めした場合に、
ねじれた状態を保持するためのトルクが必要であるとい
う問題がある。上記課題を解決するため、本発明の位置
決め制御装置は、メカの持つ弾性変形を考慮し、高精度
な位置決め装置を提供するものである。
【0004】
【課題を解決するための手段】本発明の請求項1記載の
位置決め制御装置は、位置指令を入力として、モ−タ位
置が前記位置指令に一致するように速度指令を速度制御
部に出力する位置制御部と、前記速度指令を入力とし
て、モ−タ速度が前記速度指令に一致するようにトルク
指令を電流制御部に出力する速度制御部と、前記トルク
指令を入力として、電流制御を行い、モ−タを駆動する
電流制御部と、モ−タ位置を検出する検出部と、前記ト
ルク指令と前記モ−タ速度を入力として、外乱を推定す
る外乱推定部と、を備える位置決め制御装置において、
前記外乱推定部内で推定される推定外乱力を基に、目標
位置に到達した時点で位置決め機構内に残存する弾性変
形量を推定し、前記目標位置に前記弾性変形量を加えた
位置を新たな目標位置として位置決め制御を行い、前記
新たな目標位置に達した後、前記弾性変形量分戻す位置
制御を行うことを特徴とするものである。
【0005】また、本発明の請求項2記載の位置決め制
御装置は、前記弾性変形量を、位置決めが行われる際の
減速開始速度、または減速度の関数とすることを特徴と
するものである。
【0006】また、本発明の請求項3記載の位置決め制
御装置は、前記目標位置と一致して位置決め停止した状
態での外乱力Csを、減速が開始する速度Vdstの関数と
し、 Cs = Vdst / α…(1) 但し,α(α≧0)は予め求められた定数 で表し、弾性変形量Xを、 X = Cs / K…(2) 但し,K(K≧0)はばね定数 とすることを特徴とするものである。
【0007】また、本発明の請求項4記載の位置決め制
御装置は、前記目標位置と一致して位置決め停止した状
態での外乱力Csを、減速度Decの関数とし、 Cs = Dec / β…(3) 但し,β(β≧0)は予め求められた定数 で表し、弾性変形量Xを、 X = Cs / K…(2) 但し,K(K≧0)はばね定数 とすることを特徴とするものである。
【0008】
【発明の実施の形態】以下、実施例について具体的に説
明する。図1は、本発明の基本的な考え方を説明するブ
ロック図で、図中、位置制御部1では、位置指令Prefを
入力しモ−タ位置Pfbが位置指令Prefに一致するように
速度指令Vrefを速度制御部2に出力する。速度制御部2
では、速度指令Vrefを入力しモ−タ速度Vfbが速度指令V
refに一致するようにトルク指令Trefを電流制御部3に
出力する。電流制御部3では、電流を制御しモ−タ4を
駆動する。モ−タ4には機構部5が取り付けてある。こ
の機構部5は、モータ4の軸およびその他減速機等の接
続部を含むものである。検出器6はモ−タ位置を検出す
る。外乱推定部7は、トルク指令とモータ速度を入力
し、推定外乱Csを算出する。差分器8はモ−タ位置から
モ−タ速度を算出する。次に、外乱推定部7について詳
細を示す。外乱推定部7はモータ速度Vfbとトルク指令T
refを入力し、速度ゼロ時のトルク指令を基に、弾性変
形量を推定する。位置指令補正部9は、外乱推定部7で
推定された弾性変形量に基づいて補正位置指令ΔPrefを
加算器aに出力し、加算器aは位置指令Prefに補正位置
指令ΔPrefを加えた位置指令を位置制御部1に出力す
る。この位置指令に基づいて位置制御が行われ、位置決
め停止した時点で、位置補正部9は、弾性変形分の補正
位置指令を減らすために補正位置指令(−ΔPref)を出
力し、目標とする位置指令Prefに(−ΔPref)を加えた
位置指令に対して再び位置制御を行う。したがって、最
終的に位置決めされた位置では、弾性変形することが無
いため、弾性変形による保持トルクやメカに負担をかけ
ることなく、位置決め停止することが出来る。
【0009】次に、推定外乱Csと弾性変形量について説
明する。図2は、リニアモータを用いた位置決め時にお
いて、減速開始速度Vdstが異なる場合の位置決め停止時
の保持力F(トルク)と速度Vfbをモニタしている。図
中、Vr1, Vr2, Vr3は速度指令であり、F1, F2, F3は駆
動力であり、Vfb1, Vfb2, Vfb3は速度であり、それぞれ
最高速度が2.5mm/s, 5mm/s, 10mm/sである。なお、加減
速度は一定(0.01G)にしている。位置決め停止時の保持
力は、減速開始速度が2.5mm/s,5.0mm/s,10mm/sの場合
が各々F1=5.08N,F2=4.97N,F3=4.80N であり、減速開
始速度が小さいほど位置決め停止時の保持力(トルク)
が大きいことがわかる。従って、保持力と減速開始速度
の関係は、 Cs = Vdst / α…(1) 但し、α(α≧0)は予め求められた定数である。で表
される。
【0010】さらに、位置決め停止した状態で、保持力
を強制的にゼロにした場合のリニアモータのテーブル変
位量を測定した結果を図3に示す。図からわかるように
ばね特性を示しながらテーブルが戻されており、テーブ
ル変位量は、減速開始速度が2.5mm/s,5.0mm/s,10mm/s
の場合が各々19.6μm,18.3μm,17.0μmであり、減速開
始速度が小さいほどテーブル変位量が大きいことがわか
る。このテーブル変位はばね特性を示していることか
ら、弾性変形量と考えられ、弾性変位量Xと保持力の関
係は、 X = Cs / K…(2) 但し,K(K≧0)はばね定数である。 と表すことが出来る。
【0011】本実験では、ばね定数はK=0.27N/μmであ
った。以上の実験結果を整理すると、減速開始速度が小
さいほど位置決め停止時の保持力が大きくなり、弾性変
形量も大きくなることがわかる。なお、ここでは、減速
開始速度の違いによる例を説明したが、減速度が変わっ
た場合も同様に、減速度が小さいほど位置決め停止時の
保持力が大きくなり、弾性変形量も大きくなることが実
験で確かめられており、この場合は、保持力と減速度の
関係は、 Cs = Dec / β…(3) 但し、β(β≧0)は予め求められた定数である。 で表される。減速開始速度と弾性変形量、減速度と弾性
変形量の関係は、本説明のように関数として表しても良
いし、減速開始する速度や減速度を変えて、実験的に求
めても良い。本発明は、この弾性変形が起こることを考
慮し、予め弾性変形量分だけ目標位置を行き過ぎる方向
にずらし、弾性変形を解除するように位置を戻すこと
で、最終的な位置決めを実施するものである。
【0012】
【発明の効果】以上に説明したように、本発明によれ
ば、位置決め停止時におけるメカの弾性変形を避けるこ
とが出来るため、位置を保持するための余分なトルクが
必要でないばかりでなく、その位置からどちらの方向に
動作した場合も同じ応答が得られるため、非常に少ない
移動量において高精度な位置決め応答を得ることが出来
る位置決め制御装置が提供できる。
【図面の簡単な説明】
【図1】本発明の基本的な考え方を説明するブロック図
【図2】位置決め停止時の応答例
【図3】保持力を強制的にゼロとした場合のテーブル変
位量の例
【符号の説明】
1:位置制御部 2:速度制御部 3:電流制御部 4:モ−タ 5:機構部 6:検出器 7:外乱推定部 8:差分器 9:位置補正部 a:加算器

Claims (4)

    【特許請求の範囲】
  1. 【請求項1】位置指令を入力として、モ−タ位置が前記
    位置指令に一致するように速度指令を速度制御部に出力
    する位置制御部と、前記速度指令を入力として、モ−タ
    速度が前記速度指令に一致するようにトルク指令を電流
    制御部に出力する速度制御部と、前記トルク指令を入力
    として、電流制御を行い、モ−タを駆動する電流制御部
    と、モ−タ位置を検出する検出部と、前記トルク指令と
    前記モ−タ速度を入力として、外乱を推定する外乱推定
    部と、を備える位置決め制御装置において、前記外乱推
    定部内で推定される推定外乱力を基に、目標位置に到達
    した時点で位置決め機構内に残存する弾性変形量を推定
    し、前記目標位置に前記弾性変形量を加えた位置を新た
    な目標位置として位置決め制御を行い、前記新たな目標
    位置に達した後、前記弾性変形量分戻す位置制御を行う
    ことを特徴とする位置決め制御装置。
  2. 【請求項2】前記弾性変形量を、位置決めが行われる際
    の減速開始速度、または減速度の関数とすることを特徴
    とする請求項1記載の位置決め制御装置。
  3. 【請求項3】前記目標位置と一致して位置決め停止した
    状態での外乱力Csを、減速が開始する速度Vdstの関数と
    し、 Cs = Vdst / α…(1) 但し,α(α≧0)は予め求められた定数 で表し、弾性変形量Xを、 X = Cs / K…(2) 但し,K(K≧0)はばね定数 とすることを特徴とする請求項2記載の位置決め制御装
    置。
  4. 【請求項4】前記目標位置と一致して位置決め停止した
    状態での外乱力Csを、減速度Decの関数とし、 Cs = Dec / β…(3) 但し,β(β≧0)は予め求められた定数 で表し、弾性変形量Xを、 X = Cs / K…(2) 但し,K(K≧0)はばね定数 とすることを特徴とする請求項2記載の位置決め制御装
    置。
JP2002109699A 2002-04-11 2002-04-11 位置決め制御装置 Expired - Fee Related JP3982308B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2002109699A JP3982308B2 (ja) 2002-04-11 2002-04-11 位置決め制御装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2002109699A JP3982308B2 (ja) 2002-04-11 2002-04-11 位置決め制御装置

Publications (2)

Publication Number Publication Date
JP2003303022A true JP2003303022A (ja) 2003-10-24
JP3982308B2 JP3982308B2 (ja) 2007-09-26

Family

ID=29393091

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2002109699A Expired - Fee Related JP3982308B2 (ja) 2002-04-11 2002-04-11 位置決め制御装置

Country Status (1)

Country Link
JP (1) JP3982308B2 (ja)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2011230199A (ja) * 2010-04-23 2011-11-17 Hitachi Via Mechanics Ltd ドリル穴明け制御方法、プログラム及びドリル穴明機
CN103853099A (zh) * 2012-11-30 2014-06-11 发那科株式会社 具有被驱动体的位置修正功能的伺服控制装置

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2011230199A (ja) * 2010-04-23 2011-11-17 Hitachi Via Mechanics Ltd ドリル穴明け制御方法、プログラム及びドリル穴明機
CN103853099A (zh) * 2012-11-30 2014-06-11 发那科株式会社 具有被驱动体的位置修正功能的伺服控制装置
JP2014109785A (ja) * 2012-11-30 2014-06-12 Fanuc Ltd 被駆動体の位置補正機能を有するサーボ制御装置
US10247301B2 (en) 2012-11-30 2019-04-02 Fanuc Corporation Servo control system with position compensation function for driven member

Also Published As

Publication number Publication date
JP3982308B2 (ja) 2007-09-26

Similar Documents

Publication Publication Date Title
JP2709969B2 (ja) サーボモータの制御方法
JP2004213472A (ja) 制御装置
JP4741637B2 (ja) サーボモータの駆動制御装置及び駆動制御方法
CN109085802B (zh) 电动机的控制装置
JP3506157B2 (ja) 電動機の位置制御装置
JP2005056254A (ja) 工作機械の位置制御装置及び工作機械の位置制御方法
JP4453526B2 (ja) サーボ制御装置
JP4424350B2 (ja) 位置制御装置及びその制御方法
JP2007219812A (ja) サーボモータの制御装置
JP2005086841A (ja) モータ制御装置
JPH10329063A (ja) ロボット制御装置
JP2003058213A (ja) 数値制御装置
EP1271274B1 (en) Servo controlling device and method
US5517100A (en) Method of controlling a servo motor
JP6370866B2 (ja) サーボモータ制御装置、サーボモータ制御方法、及びサーボモータ制御用プログラム
CN107894749B (zh) 伺服电动机控制装置及其方法、计算机可读取的记录介质
WO2002025390A1 (fr) Procede de servocommande
JPS605306A (ja) サ−ボ制御装置
JP4183057B2 (ja) 数値制御システム
JP2003303022A (ja) 位置決め制御装置
KR970005566B1 (ko) 백클래시(Backlash) 가속 제어 방법
JPH10105247A (ja) サーボモータのオーバーシュート防止方法
JP5660482B2 (ja) 工作機械の送り駆動系の制御方法及び制御装置
JPH08202405A (ja) ロバスト適応制御方法
JP2003169488A (ja) サーボモータの制御装置及び制御方法

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20050309

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20070511

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20070612

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20070625

FPAY Renewal fee payment (prs date is renewal date of database)

Free format text: PAYMENT UNTIL: 20100713

Year of fee payment: 3

R150 Certificate of patent (=grant) or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150

FPAY Renewal fee payment (prs date is renewal date of database)

Year of fee payment: 3

Free format text: PAYMENT UNTIL: 20100713

FPAY Renewal fee payment (prs date is renewal date of database)

Year of fee payment: 4

Free format text: PAYMENT UNTIL: 20110713

FPAY Renewal fee payment (prs date is renewal date of database)

Year of fee payment: 5

Free format text: PAYMENT UNTIL: 20120713

FPAY Renewal fee payment (prs date is renewal date of database)

Year of fee payment: 6

Free format text: PAYMENT UNTIL: 20130713

LAPS Cancellation because of no payment of annual fees