JP2002091570A - サーボ制御方法 - Google Patents

サーボ制御方法

Info

Publication number
JP2002091570A
JP2002091570A JP2000284444A JP2000284444A JP2002091570A JP 2002091570 A JP2002091570 A JP 2002091570A JP 2000284444 A JP2000284444 A JP 2000284444A JP 2000284444 A JP2000284444 A JP 2000284444A JP 2002091570 A JP2002091570 A JP 2002091570A
Authority
JP
Japan
Prior art keywords
command
motor
speed
torque command
function
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.)
Abandoned
Application number
JP2000284444A
Other languages
English (en)
Other versions
JP2002091570A5 (ja
Inventor
Atsushi Hagiwara
萩原  淳
Atsushi Imazu
篤志 今津
Kenichi Yasuda
賢一 安田
Ryuichi Oguro
龍一 小黒
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 JP2000284444A priority Critical patent/JP2002091570A/ja
Priority to EP01963570A priority patent/EP1338937A4/en
Priority to PCT/JP2001/007851 priority patent/WO2002025390A1/ja
Priority to US10/380,827 priority patent/US20030173928A1/en
Priority to KR1020037003929A priority patent/KR100842978B1/ko
Priority to CNB018158528A priority patent/CN100343767C/zh
Priority to TW090123112A priority patent/TW525045B/zh
Publication of JP2002091570A publication Critical patent/JP2002091570A/ja
Publication of JP2002091570A5 publication Critical patent/JP2002091570A5/ja
Abandoned 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/00Programme-control systems
    • G05B19/02Programme-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 programme 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 programme 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
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D3/00Control of position or direction
    • G05D3/12Control of position or direction using feedback
    • 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/41Servomotor, servo controller till figures
    • G05B2219/41428Feedforward of position and speed

Abstract

(57)【要約】 【課題】 ばね要素を介して結合される2慣性系以上の
柔軟構造物の場合、指令と負荷は完全に追従しない、ま
た、複雑な計算を必要とするため、計算量が膨大になる
といった問題があった。 【解決手段】 フィードフォワードを用いるサーボ制御
方法において、負荷の位置とモータの位置をそれぞれ高
次微分可能な関数で表し、動作条件4とメカのパラメー
タ5から、前記高次微分可能な関数を決定し、決定され
た前記高次微分可能な関数から前記モータの位置、速
度、トルク指令を算出し、算出されたモータの位置、速
度、トルク指令をフィードフォワード指令とすること、
または決定された前記高次微分可能な関数からモータの
トルク指令を算出し、算出されたトルク指令をメカのモ
デルに入力し、得られたモータの位置、速度および前記
トルク指令をフィードフォワード指令とすることを特徴
とする。

Description

【発明の詳細な説明】
【0001】
【発明の属する技術分野】本発明は、工作機の送り軸や
ロボットアーム等を駆動するサーボモータの制御方法に
関し、特に指令追従性を向上させるためにフィードフォ
ワート制御を行う方法に関する。
【0002】
【従来の技術】指令追従性能を向上させる手法としてフ
ィードフォワード制御が用いられることがよくある。そ
の際に従来方式では、位置指令を微分したものを速度フ
ィードフォワード指令値とし、もう一度微分したものを
トルクフィードフォワード指令値とする方法が一般的で
あった。 (従来例1)特許第2762364号公報「サーボモー
タのフィードフォワード制御方法」にも以下のように開
示されている。図4が従来方式の構成を示すブロック図
である。図4において、まず、位置指令θrefと実位
置θfbの偏差に1の位置ループゲインKpを乗じたも
のを速度指令Vrefとする。次に微分部41で位置指
令値θrefを微分したものに係数αを乗じたものを速
度フィードフォワード指令Vffとし、速度指令Vre
fに加算する。次に速度指令Vrefと実速度Vfbの
偏差を求め2の速度ループ処理を施し電流指令値Ire
fを求める。次に、微分部42で速度フィードフォワー
ド指令Vffを微分し係数βを乗じたものを電流フィー
ドフォワードIffとし、電流指令に加算する方法を用
いている。この方法では、速度ループや電流ループの応
答性が向上し、サーボ系の応答遅れが改善される効果が
あると書かれている。 (従来例2)また、別の従来例として、特開平10−1
49210号公報「位置決め制御系の指令作成方法」で
は、図5に示すような構成をとり、指令生成部51で制御
系とメカまで含めた伝達関数を逆に解き、位置指令から
負荷の位置までの伝達関数を1とする位置指令を作成す
ることで、指令追従性を向上させ、完全追従を実現する
方法が開示されている。図5に示す記号は図4と同じで
ある。
【0003】
【発明が解決しようとする課題】しかしながら従来の2
つの方法では以下に挙げる問題があった。 (問題点1) 従来例1で示した方法では、制御するメ
カがサーボモータと剛体結合されている場合は問題ない
が、ばね要素を介して結合される2慣性系以上の柔軟構
造物の場合、メカのばね要素を考慮していない指令が入
力されることになり、モータは指令通りに追従したとし
ても負荷側が振動するという問題が発生する。結果とし
て、指令と負荷は完全に追従しないという問題があっ
た。 (問題点2) 従来例2で示した方法では、従来例1の
問題点を解決するためにシステム全体の伝達特性を考慮
して指令を生成するため、2慣性系以上の柔軟構造物の
場合も完全追従を行うことが可能であるが、制御系まで
含んだ伝達関数を用いているため、外乱応答の改善など
で、速度ループの応答を変更するといったような制御系
の特性を変更したときは、もう一度、逆伝達関数を解か
ねばならず、手間がかかるという問題が有った。また、
複雑な計算を必要とするため、計算量が膨大になるとい
った問題もあった。
【0004】
【課題を解決するための手段】前記課題を解決するため
に本発明は、フィードフォワードを用いるサーボ制御方
法において、負荷の位置とモータの位置をそれぞれ高次
微分可能な関数で表し、動作条件とメカのパラメータか
ら、前記高次微分可能な関数を決定し、決定された高次
微分可能な関数からモータの位置、速度、トルク指令を
算出し、算出されたモータの位置、速度、トルク指令値
をフィードフォワード指令とする。また、請求項2に示
す構成ではフィードフォワードを用いるサーボ制御方法
において、負荷の位置とモータの位置をそれぞれ高次微
分可能な関数で表し、動作条件とメカのパラメータか
ら、前記高次微分可能な関数を決定し、決定された高次
微分可能な関数からモータのトルク指令を算出し、算出
されたトルク指令をメカのモデルに入力し、得られたモ
ータの位置、速度および前記トルク指令をフィードフォ
ワード指令とする。また、前記高次微分可能な関数は1
5次の多項式としてもよい。また、前記動作条件は移動
距離と移動時間としてもよい。また、前記高次微分可能
な関数を決定する際に、制御するメカの運動方程式を用
いてもよい。
【0005】
【発明の実施の形態】本発明の実施例を図に基づいて説
明する。ここで、制御するメカは2慣性系で近似できる
ものとする。図1は本発明の実施の形態を示すブロック
図である。図1において、1は位置ループ比例ゲインK
p、2は速度ループ、3はモータの位置、速度、トルク
指令を計算する指令生成部分である。4は所望の動作条
件であり、メモリに格納されている。5はメカのパラメ
ータであり、メモリに格納されている。2の速度ループ
内は比例積分制御行うものとする。また、4の動作条件
としては請求項4にも記載されているように、移動距離
distと移動時間teが入力され格納されている。5
のメカのパラメータとしては、モータイナーシャJ1、
負荷イナーシャJ2、ばね定数Kc、減衰係数DLが入
力されて格納されているものとする。メモリに格納され
ている4の動作条件と5のメカパラメータを使用して3
の指令生成部でモータ位置指令θref、モータ速度指
令Vffおよび、モータトルク指令値Tffを算出し、
制御入力とする。以下に、3の指令生成部での処理内容
を図3のフローチャートを用いて、順に詳しく説明す
る。 Step1: メカの位置Xl(t)とモータ位置Xm
(t)をそれぞれ式(1)のような15次の多項式とし
ておく。15次にする理由は、以下で述べる境界条件が
16個存在するためである。
【0006】
【数1】
【0007】Step2: 動作条件とメカのパラメー
タを取得。 ・ 動作条件 : dist、te ・ メカのパラメータ : J1、J2、Kc、DL Step3: 式(2)に示す境界条件と、式(3)に
示すメカの運動方程式を解くことにより係数a0〜a1
5、b0〜b15を求める。境界条件としては、モータ
と負荷それぞれにおいて、 動作開始時(t=0) :位置=速度=加速度=加加速
度=0、 動作終了時(t=te):位置=dist、速度=加速
度=加加速度=0となり、式(2)に示すよう16個の
条件となる。
【0008】
【数2】
【0009】また、2慣性系のメカの、運動方程式は式
(3)のようになる。
【0010】
【数3】
【0011】以上、(2)、(3)式より係数a0〜a
15、b0〜b15を求める。 Step4: Step3で求めた係数から、モータ位
置指令値Xm(0)(t)が求まり、それを微分すること
で、モータ速度指令値Xm(1)(t)が求まる。最後に
トルク指令値Tref(t)は 式(4)のように求ま
る。 Tref(t) = J1・ Xm(2)(t) + J2・ Xl(2)(t) ・・・(4) この方法では、問題点1を解決するために、メカの運動
特性を考慮して、指令を生成しているため、負荷側を振
動なく完全に指令に追従させることが可能である。ま
た、制御系を含む伝達関数ではなく、メカの運動方程式
からのみ指令を生成するので、問題点2で挙げた、制御
ゲインの変更に際しても全く影響を受けず、指令を変更
する必要がない。次に請求項2に示す実施例2の方法を
図2を使用して説明する。指令の払い出しがハード構成
上、1入力と限定されている場合は、実施例1のよう
に、モータ位置指令、モータ速度指令、モータトルク指
令の3つの入力が不可能である。このような場合は、ま
ず、実施例1の手順でトルク指令値Tref(t)を導
出する。次に、図2の6に示すように、コントローラ内
に予めメカのモデルを有しておき、そのメカモデルに導
出されたトルク指令を入力し、モデル内で計算されるモ
ータ位置、モータ速度を、フィードフォワード指令値と
すればよい。この方法では、制御計算部に入力するのは
トルク指令のみでよく、また、実施例1と同等の効果が
得られる。また、上で説明した2つの実施例ではモータ
位置、モータ速度、モータトルク指令をフィードフォワ
ードする方法を説明したが、当然トルク指令の替わりに
電流指令を求めフィードフォワードしてもよい。
【0012】
【発明の効果】以上述べたように、本発明によれば、ま
ず、メカの位置とモータの位置を高次微分可能な多項式
で表し、動作条件(移動距離と移動時間)から求まる境
界条件および、メカの運動方程式から、多項式の係数を
決定し、最後に、モータ位置指令、モータ速度指令、モ
ータトルク指令を算出し、それらをフィードフォワード
指令値として使用することで、柔軟構造物を指令に完全
に追従させることが可能になるという効果がある。ま
た、本発明によれば、制御系のゲイン等を変更した場合
も、同じ指令が使用できるので、オフライン処理であら
かじめ、フィードフォワード指令を計算しておく場合な
ども、再計算などの手間がかからないという効果があ
る。
【図面の簡単な説明】
【図1】本発明の実施例1の構成を示すブロック図
【図2】本発明の実施例2の構成を説明するブロック図
【図3】本発明の処理手順を説明するフローチャート
【図4】従来例1の構成を説明するブロック図
【図5】従来例2の構成を説明するブロック図
【符号の説明】
1 位置ループ比例ゲイン 2 速度ループ 3 指令生成部 4 動作条件 5 メカパラメータ 6 メカモデル計算部 41,42 微分部 θref 位置指令 θfb 実位置 Vref 速度指令 Vfb 実速度 Vff 速度フィードフォワード指令 Iref 電流指令 Iff 電流フィードフォワード指令
───────────────────────────────────────────────────── フロントページの続き (72)発明者 小黒 龍一 福岡県北九州市八幡西区黒崎城石2番1号 株式会社安川電機内 Fターム(参考) 3F059 FB01 FB21 FB29 FC02 FC14 5H004 GA08 GA09 GA30 GB16 HA07 HB07 HB08 JA13 JA23 KB32 5H303 AA01 AA10 CC03 DD01 DD21 JJ01 KK17 KK28 5H550 AA18 BB02 BB10 DD01 GG01 GG03 JJ24

Claims (5)

    【特許請求の範囲】
  1. 【請求項1】 フィードフォワードを用いるサーボ制御
    方法において、負荷の位置とモータの位置をそれぞれ高
    次微分可能な関数で表し、動作条件とメカのパラメータ
    から、前記高次微分可能な関数を決定し、決定された前
    記高次微分可能な関数から前記モータの位置、速度、ト
    ルク指令を算出し、算出されたモータの位置、速度、ト
    ルク指令をフィードフォワード指令とすることを特徴と
    するサーボ制御方法。
  2. 【請求項2】 フィードフォワードを用いるサーボ制御
    方法において、負荷の位置とモータの位置をそれぞれ高
    次微分可能な関数で表し、動作条件とメカのパラメータ
    から、前記高次微分可能な関数を決定し、決定された前
    記高次微分可能な関数からモータのトルク指令を算出
    し、算出されたトルク指令をメカのモデルに入力し、得
    られたモータの位置、速度および前記トルク指令をフィ
    ードフォワード指令とすることを特徴とするサーボ制御
    方法。
  3. 【請求項3】 前記高次微分可能な関数は15次の多項
    式とすることを特徴とする請求項1又は請求項2記載の
    サーボ制御方法。
  4. 【請求項4】 前記動作条件は移動距離と移動時間であ
    ることを特徴とする請求項1又は請求項2記載のサーボ
    制御方法。
  5. 【請求項5】 前記高次微分可能な関数を決定する際に
    制御するメカの運動方程式を用いることを特徴とする請
    求項1又は請求項2記載のサーボ制御方法。
JP2000284444A 2000-09-20 2000-09-20 サーボ制御方法 Abandoned JP2002091570A (ja)

Priority Applications (7)

Application Number Priority Date Filing Date Title
JP2000284444A JP2002091570A (ja) 2000-09-20 2000-09-20 サーボ制御方法
EP01963570A EP1338937A4 (en) 2000-09-20 2001-09-10 SERVO CONTROL PROCESS
PCT/JP2001/007851 WO2002025390A1 (fr) 2000-09-20 2001-09-10 Procede de servocommande
US10/380,827 US20030173928A1 (en) 2000-09-20 2001-09-10 Servo control method
KR1020037003929A KR100842978B1 (ko) 2000-09-20 2001-09-10 서보 제어방법
CNB018158528A CN100343767C (zh) 2000-09-20 2001-09-10 伺服系统的控制方法
TW090123112A TW525045B (en) 2000-09-20 2001-09-19 Servo control method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2000284444A JP2002091570A (ja) 2000-09-20 2000-09-20 サーボ制御方法

Publications (2)

Publication Number Publication Date
JP2002091570A true JP2002091570A (ja) 2002-03-29
JP2002091570A5 JP2002091570A5 (ja) 2007-04-26

Family

ID=18768651

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2000284444A Abandoned JP2002091570A (ja) 2000-09-20 2000-09-20 サーボ制御方法

Country Status (7)

Country Link
US (1) US20030173928A1 (ja)
EP (1) EP1338937A4 (ja)
JP (1) JP2002091570A (ja)
KR (1) KR100842978B1 (ja)
CN (1) CN100343767C (ja)
TW (1) TW525045B (ja)
WO (1) WO2002025390A1 (ja)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007084027A (ja) * 2005-09-23 2007-04-05 C & S Kokusai Kenkyusho:Kk パワーステアリング電動駆動装置
US7627387B2 (en) 2005-04-08 2009-12-01 Mitsubishi Denki Kabushiki Kaisha Position command generating device

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP1785792A1 (en) 2005-11-11 2007-05-16 C.C.M. Beheer B.V. Method and system for control of a compliant system
JP4673326B2 (ja) * 2007-01-11 2011-04-20 オークマ株式会社 回転軸の位置制御装置
JP4807600B2 (ja) * 2009-08-18 2011-11-02 村田機械株式会社 移動体システム
KR101793685B1 (ko) 2011-09-19 2017-11-06 한화지상방산 주식회사 회전축 제어 시스템
CN104348393A (zh) * 2013-07-23 2015-02-11 广东美的制冷设备有限公司 空调器、变频调速系统及其控制方法
JP6106582B2 (ja) * 2013-12-09 2017-04-05 山洋電気株式会社 モータ制御装置
CN111872942B (zh) * 2020-08-07 2023-06-20 四川福莫斯工业技术有限公司 一种多轴机器人的扭矩前馈方法

Family Cites Families (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2559279B2 (ja) * 1989-11-30 1996-12-04 三菱電機株式会社 サーボモータの重畳・同期運転誤差補正装置
KR940003005B1 (ko) * 1991-01-26 1994-04-09 삼성전자 주식회사 동기형 교류 서보모터의 속도제어방법
JP2810246B2 (ja) * 1991-02-25 1998-10-15 オークマ株式会社 駆動制御装置
DE69223236T2 (de) * 1991-09-09 1998-03-19 Fanuc Ltd Verfahren zur steuerung eines servomotors mit vorwärtskopplung
JP3084928B2 (ja) * 1992-05-29 2000-09-04 三菱電機株式会社 電動機の位置制御装置
JPH06147468A (ja) * 1992-11-16 1994-05-27 Sanden Corp 気化式燃焼装置の制御方法
JP3296527B2 (ja) * 1994-08-05 2002-07-02 株式会社安川電機 モータ速度制御装置
CN1187887A (zh) * 1995-06-14 1998-07-15 霍尼韦尔公司 在多变量预测控制器中加入独立前馈控制的方法
JPH11265202A (ja) * 1998-01-14 1999-09-28 Sony Corp 制御方法および制御装置
JP3313643B2 (ja) * 1998-04-30 2002-08-12 東芝機械株式会社 バイト工具によるオービット加工におけるサーボ制御方法およびオービット加工用のサーボ制御装置
JP2000148210A (ja) * 1998-11-12 2000-05-26 Toyota Central Res & Dev Lab Inc ゲイン算出装置
JP3621278B2 (ja) * 1998-12-10 2005-02-16 三菱電機株式会社 サーボ制御装置
US7433144B2 (en) * 1999-03-04 2008-10-07 Convolve, Inc. Dynamic system control method
US6961628B2 (en) * 1999-04-16 2005-11-01 Siemens Energy & Automation, Inc. Method and apparatus for tuning compensation parameters
US6470225B1 (en) * 1999-04-16 2002-10-22 Siemens Energy & Automation, Inc. Method and apparatus for automatically tuning feedforward parameters
SE0001312D0 (sv) * 2000-04-10 2000-04-10 Abb Ab Industrirobot
US6677722B2 (en) * 2001-04-19 2004-01-13 Toshiba Kikai Kabushiki Kaisha Servo control method
JP4875413B2 (ja) * 2006-06-22 2012-02-15 グンゼ株式会社 衣類

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7627387B2 (en) 2005-04-08 2009-12-01 Mitsubishi Denki Kabushiki Kaisha Position command generating device
US7778716B2 (en) 2005-04-08 2010-08-17 Mitsubishi Denki Kabushiki Kaisha Position command generating device
DE102005059530B4 (de) * 2005-04-08 2016-10-20 Mitsubishi Denki K.K. Befehlsgenerierungsvorrichtung
JP2007084027A (ja) * 2005-09-23 2007-04-05 C & S Kokusai Kenkyusho:Kk パワーステアリング電動駆動装置

Also Published As

Publication number Publication date
EP1338937A1 (en) 2003-08-27
TW525045B (en) 2003-03-21
KR100842978B1 (ko) 2008-07-01
KR20030036802A (ko) 2003-05-09
US20030173928A1 (en) 2003-09-18
WO2002025390A1 (fr) 2002-03-28
EP1338937A4 (en) 2004-03-17
CN1633629A (zh) 2005-06-29
CN100343767C (zh) 2007-10-17

Similar Documents

Publication Publication Date Title
JPH05216504A (ja) バネ系を含む制御対象に対する適応的スライディングモード制御方式
JP3506157B2 (ja) 電動機の位置制御装置
JP2004213472A (ja) 制御装置
JPH02297602A (ja) 非線形項補償を含むスライディングモード制御方式
JPWO2006011519A1 (ja) サーボ制御装置
JP2009512042A (ja) 機械の移動可能な機械要素の移動案内のための方法および装置
WO2007046257A1 (ja) モータ制御装置及び方法及びプログラム記憶媒体
JPH05134758A (ja) サーボモータの制御方式
JPH07104856A (ja) 振動制御方法
JPH0969013A (ja) サーボモータを用いたサーボ系の制御モード切り換え方法
JP2002091570A (ja) サーボ制御方法
JPH10329063A (ja) ロボット制御装置
WO1997012306A1 (fr) Procede de commande en temps minimal base sur la tache, destine a un robot
CN110941242A (zh) 电动机控制装置
JP6469320B1 (ja) サーボ制御装置
JPH03289385A (ja) モータ制御のゲイン調整方法
KR970002259B1 (ko) 서보모터의 제어방법
JPH0392911A (ja) スライディングモード制御によるロボット制御方法
JP2003084804A (ja) 最適指令作成装置
JPH0580805A (ja) Pi制御ループをベースにした適応スライデイングモード制御方式
JP2011175308A (ja) 工作機械の送り駆動系の制御方法及び制御装置
WO1990013857A1 (fr) Procede de commande de mode de glissement
JPS6140616A (ja) 位置制御方式
JP4078396B2 (ja) 位置決め制御装置
JPH0475113A (ja) 制御装置

Legal Events

Date Code Title Description
A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20070309

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20070309

A762 Written abandonment of application

Free format text: JAPANESE INTERMEDIATE CODE: A762

Effective date: 20090312