JP3906668B2 - モータ制御装置 - Google Patents
モータ制御装置 Download PDFInfo
- Publication number
- JP3906668B2 JP3906668B2 JP2001327040A JP2001327040A JP3906668B2 JP 3906668 B2 JP3906668 B2 JP 3906668B2 JP 2001327040 A JP2001327040 A JP 2001327040A JP 2001327040 A JP2001327040 A JP 2001327040A JP 3906668 B2 JP3906668 B2 JP 3906668B2
- Authority
- JP
- Japan
- Prior art keywords
- speed
- unit
- simulated
- motor
- feedforward signal
- 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Control Of Electric Motors In General (AREA)
- Feedback Control In General (AREA)
Description
【発明の属する技術分野】
本発明は工作機械,ロボット等の駆動に用いられるモータの制御装置に関する。
【0002】
【従来の技術】
フィードバック制御部内の機械系を2慣性に近似した機械系模擬部を備え、位置指令を入力して前記機械系模擬部に対して位置制御及び速度制御を行い、前記機械系模擬部の位置、速度及びトルク指令を前記フィードフォワード信号として前記フィードバック制御部へ出力するフィードフォワード補償部と、前記フィードフォワード信号を入力し、制御対象が前記指令に一致するようにフィードバック制御を行うフィードバック制御部、を備えるモータ制御装置として、例えば、特開平6-30758号公報に開示されたものがある。この従来技術では、フィードバック制御部がモータ位置とモータ速度をフィードバックする場合は、モータを高応答に駆動できるということが示されている。
【0003】
【発明が解決しようとする課題】
しかし前記従来技術では、フィードフォワード補償部から出力するフィードフォワード信号がモータ位置とモータ速度であるため、フィードバック制御部がモータ位置とモータ速度をフィードバックする場合にしか適用できないという問題があった。
【0004】
また、フィードバック制御部が機械負荷位置とモータ速度をフィードバックする場合と機械負荷位置と機械負荷速度をフィードバックする場合は図6と図7に示すようなフィードフォワード補償部を用いて使い分ける必要があり、これを記憶するために多くのメモリを必要とするという問題点があった。
【0005】
【課題を解決するための手段】
上記問題点を解決するために、第1の発明は、フィードバック制御部内の機械系を2慣性で近似した機械系模擬部と、位置指令と前記機械系模擬部の模擬機械負荷速度及び模擬機械負荷位置を入力して模擬トルク指令を出力する模擬位置・速度制御部と、前記模擬トルク指令に基づいて模擬モータ位置を出力する模擬モータとを備え、前記位置指令に基づいて位置と速度を制御して位置フィードフォワード信号と速度フォワード信号と模擬トルク指令を出力するフィードフォワード補償部と、制御対象部と、前記制御対象部の位置と速度を入力してトルク指令を出力する位置・速度制御部と、前記トルク指令を受けて前記制御対象部を駆動する電流制御部を備え、前記位置フィードフォワード信号と前記速度フィードフォワード信号を入力すると前記制御対象部の前記位置が前記位置指令に一致するように位置制御と速度制御を行う前記フィードバック制御部と、を備えるモータ制御装置において、前記フィードフォワード補償部は、前記模擬モータ部の模擬モータ速度と前記模擬機械負荷速度を入力していずれかを前記速度フィードフォワード信号として出力する速度フィードフォワード信号切替部と、前記模擬モータ部の模擬モータ位置と前記模擬機械負荷位置を入力していずれかを前記位置フィードフォワード信号として出力する位置フィードフォワード信号切替部とを備えており、前記位置・速度制御部は、前記位置フィードフォワード信号と前記速度フィードフォワード信号と前記制御対象部の前記位置及び前記速度を入力し、前記位置フィードフォワード信号に前記位置が一致するように位置制御と速度制御をして前記トルク指令を出力し、前記電流制御部は前記トルク指令と前記模擬トルク指令が加算された第2トルク指令に基づいて前記制御対象部を駆動することを特徴としている。
第2の発明は、前記速度フィードフォワード信号切替部は速度フィードフォワード信号切替指令を受けることによって切替え、前記位置フィードフォワード信号切替部は位置フィードフォワード信号切替信号を受けることによって切替えることを特徴としている。
第3の発明は、前記位置フィードフォワード信号切替部は位置フィードフォワード信号切替指令がHiであれば前記模擬モータ位置を出力してLoであれば前記模擬機械負荷位置を出力し、前記速度フィードフォワード信号切替部は速度フィードフォワード信号切替指令がHiであれば前記模擬モータ速度を出力してLoであれば前記模擬機械負荷速度を出力することを特徴としている。
第4の発明は、前記機械系模擬部には、その速度を推定するオブザーバを備えていることを特徴としている。
【0006】
【発明の実施の形態】
以下、本発明の実施の形態を図に基づいて説明する。図1は、本発明のモータ制御装置の要部の構成を示すブロック図である。図において、11はフィードフォワード補償部であり、位置指令Prefと位置フィードフォワード信号切り替え指令Spff、速度フィードフォワード信号切り替え指令Svffを入力し、位置指令Prefに基づいて位置と速度の制御を行い、位置フィードフォワード信号Pffと速度フィードフォワード信号Vff、模擬トルク指令Trefmを出力する。12はフィードバック制御部であり、位置フィードフォワード信号Pffと速度フィードフォワード信号Vff、模擬トルク指令Trefmを入力し、これに基づいて制御対象を駆動する。13は切り替え指令発生部であり、フィードバック制御部12内のフィードバック形態に基づいてフィードフォワード補償部11へ位置フィードフォワード信号切り替え指令Spffと速度フィードフォワード信号切り替え指令Svffを出力する。
【0007】
次に、フィードフォワード補償部11について、その詳細をブロック図にした図2を用いて説明する。図において、111は模擬位置・速度制御部であり、位置指令Prefを入力すると、模擬負荷位置Plmと位置指令Prefが一致するように位置制御と速度制御を行い、模擬トルク指令Trefmを模擬モータ部112に出力する。模擬モータ部112は模擬トルク指令Trefmを入力するとこれに基づいて模擬モータ位置Pmmを模擬負荷機械部113と位置フィードフォワード信号切替部114へ出力するとともに、模擬モータ速度Vmmを速度フィードフォワード信号切替部115へ出力する。模擬負荷機械部113は模擬モータ位置Pmmを入力するとこれに基づいて模擬機械負荷位置Plmを求めて位置フィードフォワード信号切替部114と模擬位置・速度制御部111へ出力するとともに、模擬機械負荷速度Vlmを求めて速度フィードフォワード信号切替部115と模擬位置・速度制御部111へ出力する。位置フィードフォワード信号切替部114は模擬モータ位置Pmmと、模擬機械負荷位置Plm、位置フィードフォワード信号切り替え指令Spffを入力し、位置フィードフォワード信号切り替え指令Spffに基づいて位置フィードフォワード補償信号Pffを出力する。位置フィードフォワード信号切替部114は、位置フィードフォワード信号切り替え指令SpffがHiであれば模擬モータ位置Pmmを出力し、位置フィードフォワード信号切り替え指令SpffがLoであれば模擬機械負荷位置Plmを出力する。速度フィードフォワード信号切替部115は模擬モータ速度Vmmと、模擬機械負荷速度Vlm、速度フィードフォワード信号切り替え指令Svffを入力し、速度フィードフォワード信号切り替え指令Svffに基づいて速度フィードフォワード補償信号Vffを出力する。速度フィードフォワード信号切替部115は、速度フィードフォワード信号切り替え指令SvffがHiであれば模擬モータ速度Vmmを出力し、速度フィードフォワード信号切り替え指令SvffがLoであれば模擬機械負荷速度Vlmを出力する。
【0008】
次に、フィードバック制御部12について図3を用いて説明する。図3は、フィードバック制御部12内の詳細なブロック図である。図3において、121は位置・速度制御部であり、位置フィードフォワード補償信号Pffと速度フィードフォワード補償信号Vff、制御対象部124の位置Pfbと速度Vfbを入力し、位置フィードフォワード補償信号Pffに位置Pfbが一致するように位置制御と速度制御を行い、トルク指令Trefを加算器122へ出力する。加算器122は模擬トルク指令Trefmとトルク指令Trefを入力し、模擬トルク指令Trefmにトルク指令Trefを加えた値を第2トルク指令Tref2として電流制御部123に出力する。電流制御部123は第2トルク指令Tref2に基づいて制御対象部124を駆動する。制御対象部124は内部に検出器を備えており、その検出器で検出した位置Pfbと速度Vfbを位置・速度指令部121へ出力する。
【0009】
次に、制御対象部124の構成について、図4を用いて詳細に説明する。制御対象部124の構成には3つの種類があり、それぞれの構成を図4(a)、(b)、(c)に示している。これらの図において、1241は電流制御部123により駆動されるモータ、1242はモータ1241に連結されてモータ位置Pmとモータ速度Vmを検出する検出器、1243はモータ1241に連結されてモータ1241により駆動される機械負荷、1244は機械負荷1243に連結されて機械負荷位置Pfbと機械負荷速度Vfbを検出する検出器である。なお、機械負荷位置Pfbと機械負荷速度Vfbの両方の検出が困難な場合は検出器1244の代わりにオブザーバ等により機械負荷位置と機械負荷速度を推測してもよい。図4aの場合は、制御対象部124aはモータ位置Pmを位置Pfbとして出力し、モータ速度Vmを速度Vfbとして出力する。図4bの場合は、制御対象部124bは機械負荷位置Plを位置Pfbとして出力し、モータ速度Vmを速度Vfbとして出力する。図4cの場合は、制御対象部124cは機械負荷位置Plを位置Pfbとして出力し、機械負荷速度Vlを速度Vfbとして出力する。
【0010】
次に、切替指令発生部13について図5を用いて説明する。図5は切替指令発生部13の切り替えパターンを示す図である。切替指令発生部13は制御対象部124の構成によって図5の表に示すようなフィードフォワード信号を選択するように位置フィードフォワード信号切り替え指令Spffと速度フィードフォワード信号切り替え指令Svffを作成し、位置フィードフォワード信号切り替え指令Spffを位置フィードフォワード信号切替器114へ出力し、かつ速度フィードフォワード信号切り替え指令Svffを速度フィードフォワード信号切替器115へ出力する。
【0011】
【発明の効果】
以上述べたように、本発明によれば、モータ部模擬回路と機械系模擬回路を用いてフィードフォワード信号を作成し、制御対象のフィードバック信号がフィードフォワード信号に一致するように制御を行うモータ制御装置において、フィードフォワード補償部からフィードバック制御部へ出力するフィードフォワード信号を切り替えられるようにしたので、前記フィードバック制御部が機械負荷位置・機械負荷速度をフィードバックする場合と機械負荷位置・モータ速度をフィードバックする場合でも同じフィードフォワード制御系を用いて制御でき、多くのメモリを必要とせず、かつ、高応答にモータを駆動できるという効果がある。
【図面の簡単な説明】
【図1】本発明のモータ制御装置の要部の構成を示すブロック図
【図2】フィードフォワード補償部の内部ブロック図
【図3】フィードバック制御部の内部ブロック図
【図4】の制御対象部の3種類の内部ブロック図
【図5】切り替えパターンを説明する表
【図6】従来例のフィードフォワード補償部の構成を示すブロック図
【図7】従来例のフィードフォワード補償部の構成を示すブロック図
【符号の説明】
11…フィードフォワード補償部
12…フィードバック制御部
13…切替指令発生部
111…模擬位置・速度制御部
112…模擬モータ部
113…模擬機械負荷部
114…位置フィードフォワード信号切替部
115…速度フィードフォワード信号切替部
121…位置・速度制御部
122…加算器
123…電流制御部
124…制御対象部
1241…モータ
1242、1244…検出器
1243…機械負荷
Claims (4)
- フィードバック制御部内の機械系を2慣性で近似した機械系模擬部と、位置指令と前記機械系模擬部の模擬機械負荷速度及び模擬機械負荷位置を入力して模擬トルク指令を出力する模擬位置・速度制御部と、前記模擬トルク指令に基づいて模擬モータ位置を出力する模擬モータとを備え、前記位置指令に基づいて位置と速度を制御して位置フィードフォワード信号と速度フォワード信号と模擬トルク指令を出力するフィードフォワード補償部と、
制御対象部と、前記制御対象部の位置と速度を入力してトルク指令を出力する位置・速度制御部と、前記トルク指令を受けて前記制御対象部を駆動する電流制御部を備え、前記位置フィードフォワード信号と前記速度フィードフォワード信号を入力すると前記制御対象部の前記位置が前記位置指令に一致するように位置制御と速度制御を行う前記フィードバック制御部と、
を備えるモータ制御装置において、
前記フィードフォワード補償部は、前記模擬モータ部の模擬モータ速度と前記模擬機械負荷速度を入力していずれかを前記速度フィードフォワード信号として出力する速度フィードフォワード信号切替部と、前記模擬モータ部の模擬モータ位置と前記模擬機械負荷位置を入力していずれかを前記位置フィードフォワード信号として出力する位置フィードフォワード信号切替部とを備えており、
前記位置・速度制御部は、前記位置フィードフォワード信号と前記速度フィードフォワード信号と前記制御対象部の前記位置及び前記速度を入力し、前記位置フィードフォワード信号に前記位置が一致するように位置制御と速度制御をして前記トルク指令を出力し、
前記電流制御部は前記トルク指令と前記模擬トルク指令が加算された第2トルク指令に基づいて前記制御対象部を駆動する
ことを特徴とするモータ制御装置。 - 前記速度フィードフォワード信号切替部は速度フィードフォワード信号切替指令を受けることによって切替え、前記位置フィードフォワード信号切替部は位置フィードフォワード信号切替信号を受けることによって切替えることを特徴とする請求項1記載のモータ制御装置。
- 前記位置フィードフォワード信号切替部は位置フィードフォワード信号切替指令がHiであれば前記模擬モータ位置を出力してLoであれば前記模擬機械負荷位置を出力し、前記速度フィードフォワード信号切替部は速度フィードフォワード信号切替指令がHiであれば前記模擬モータ速度を出力してLoであれば前記模擬機械負荷速度を出力することを特徴とする請求項2に記載のモータ制御装置。
- 前記機械系模擬部には、その速度を推定するオブザーバを備えていることを特徴とする請求項1記載のモータ制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2001327040A JP3906668B2 (ja) | 2001-10-25 | 2001-10-25 | モータ制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2001327040A JP3906668B2 (ja) | 2001-10-25 | 2001-10-25 | モータ制御装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2003131703A JP2003131703A (ja) | 2003-05-09 |
JP3906668B2 true JP3906668B2 (ja) | 2007-04-18 |
Family
ID=19143320
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2001327040A Expired - Fee Related JP3906668B2 (ja) | 2001-10-25 | 2001-10-25 | モータ制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3906668B2 (ja) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR100652441B1 (ko) | 2005-10-28 | 2006-12-01 | 삼성전자주식회사 | 적응적 비회기를 이용한 스핀들 모터 구동 방법 및 그 장치 |
US20160021434A1 (en) | 2013-03-14 | 2016-01-21 | Micromachine Center | Sensor terminal |
-
2001
- 2001-10-25 JP JP2001327040A patent/JP3906668B2/ja not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP2003131703A (ja) | 2003-05-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP3230831B2 (ja) | モータ駆動制御装置 | |
KR940003005B1 (ko) | 동기형 교류 서보모터의 속도제어방법 | |
JP5947075B2 (ja) | 同期モータの制御装置、同期モータの制御方法 | |
JPH0969013A (ja) | サーボモータを用いたサーボ系の制御モード切り換え方法 | |
Murakami et al. | Robust motion control based on projection plane in redundant manipulator | |
CN112236270B (zh) | 机器人的力调节 | |
JP3322826B2 (ja) | サーボモータによる加圧制御方法及び装置 | |
JP3906668B2 (ja) | モータ制御装置 | |
JP2007336687A (ja) | モータ制御装置 | |
JP2000218577A (ja) | ロボット制御装置 | |
JPH0792702B2 (ja) | 制御装置 | |
JP2003345442A (ja) | 同期制御装置 | |
JP2005071086A (ja) | モーションコントロールシステム | |
JP3656745B2 (ja) | 電動機位置制御装置 | |
JPH11345010A (ja) | ロボットの制御装置 | |
JPH08286759A (ja) | 静摩擦を補償するロボット駆動制御方法 | |
JP3298329B2 (ja) | サーボ制御装置およびサーボ制御方法 | |
JPH104692A (ja) | 電動機の位置制御装置 | |
JPH08282598A (ja) | 人工衛星の姿勢制御装置 | |
JP2007144621A (ja) | ロボットの制御装置 | |
JP3435828B2 (ja) | 位相制御されるサーボ系の進角自動決定方法 | |
JP2000084878A (ja) | ロボットの制御装置 | |
JP2005269856A (ja) | モータ制御装置およびモータ制御方法 | |
JP3810461B2 (ja) | サーボアンプの並列運転方法 | |
JPH0784647A (ja) | 位置制御装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20040913 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20060818 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20060907 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20061019 |
|
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: 20061226 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20070108 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110126 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110126 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120126 Year of fee payment: 5 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120126 Year of fee payment: 5 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130126 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20150126 Year of fee payment: 8 |
|
LAPS | Cancellation because of no payment of annual fees |