JP2007115000A - 電動機の制御装置 - Google Patents
電動機の制御装置 Download PDFInfo
- Publication number
- JP2007115000A JP2007115000A JP2005305430A JP2005305430A JP2007115000A JP 2007115000 A JP2007115000 A JP 2007115000A JP 2005305430 A JP2005305430 A JP 2005305430A JP 2005305430 A JP2005305430 A JP 2005305430A JP 2007115000 A JP2007115000 A JP 2007115000A
- Authority
- JP
- Japan
- Prior art keywords
- electric motor
- acceleration
- control device
- information
- mathematical model
- 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
Links
Images
Landscapes
- Feedback Control In General (AREA)
Abstract
【課題】物体移動系の高精度で比較的単純な数式モデルに基づいて、物体上の所望点(例えば加工点)の動作(速度、振動等)を高精度に制御できるようにする。
【解決手段】制御装置10は、物体12を移動させる電動機14を制御するものであって、物体の加速度を検出する加速度検出部16と、電動機の運転情報を取得する運転情報取得部18と、加速度検出部が検出した物体の加速度情報D1と運転情報取得部が取得した電動機の運転情報D2とに基づいて、物体の移動系Sの数式モデルMを決定するシステム同定部20と、システム同定部が決定した数式モデルを用いて、電動機の運転を制御する制御部22とを備える。システム同定部は、電動機の運転情報を操作入力とし、物体の加速度情報を観測出力として、移動系の高精度で比較的単純な数式モデルを決定でき、制御部は、そのような数式モデルを用いて、物体上の所望点の動作を適確に推定できる。
【選択図】図1
【解決手段】制御装置10は、物体12を移動させる電動機14を制御するものであって、物体の加速度を検出する加速度検出部16と、電動機の運転情報を取得する運転情報取得部18と、加速度検出部が検出した物体の加速度情報D1と運転情報取得部が取得した電動機の運転情報D2とに基づいて、物体の移動系Sの数式モデルMを決定するシステム同定部20と、システム同定部が決定した数式モデルを用いて、電動機の運転を制御する制御部22とを備える。システム同定部は、電動機の運転情報を操作入力とし、物体の加速度情報を観測出力として、移動系の高精度で比較的単純な数式モデルを決定でき、制御部は、そのような数式モデルを用いて、物体上の所望点の動作を適確に推定できる。
【選択図】図1
Description
本発明は、電動機の制御装置に関する。
工作機械等の加工機において、加工対象物(本願でワークと称する)を移動させながら加工を行なう場合には、機構部の振動等を考慮した上で、ワークの被加工部位(本願で加工点と称する)の動作を適確に制御することが、高精度加工を実現するために要求される。このような加工点の動作制御に関しては、従来、ワークを移動させる駆動源としての電動機の出力の位置や速度、或いはワークを支持するテーブル等の支持部材の位置や速度を、専用の検出器により検出するとともに、電動機から加工点までのワーク移動系の数式モデル(ばね要素等を含む)を作成して、検出値と数式モデルとに基づき、加工点の動作(速度、振動等)を推定する手法が行なわれている。
上記した従来の加工点動作制御においては、ワーク移動系の状態を観測する検出器が、電動機やワーク支持部材に関連して、事実上の制御対象である加工点から離れた位置に設置されている。したがって、数式モデルを作成する際に、検出器と加工点との間の介在物の動作情報(速度、振動等)を、何らかの手段により取得する必要がある。この種の動作情報取得手段としては、電動機とワークとの間に存在する機構部の、設計データを用いた構造解析が知られている。この場合、構造解析の結果から、理論式により数式モデルを作成することができる。また他の動作情報取得手段として、電動機とワークとの間に存在する機構部を殴打して振動解析を行なうハンマリングも知られている。この場合、電動機やワーク支持部材の速度検出値における振動を解析することにより、機構部の共振周波数を測定でき、この共振周波数に基づいて数式モデルを作成することができる。
なお、関連技術として、特許文献1は、電動機の制御装置において、電動機搭載設備の数学モデルを用いることにより、電動機の高精度の位置決め制御を実現する構成を開示する。この構成によれば、複数の振動モードを有する設備に対しても、条件に応じた適切なゲイン設定を行なって、制御特性を改善することができる。
前述した従来の加工点動作制御において、検出器と加工点との間の介在物の動作情報を取得する手段として、電動機とワークとの間の機構部の構造解析を行なう場合は、数式モデルを理論式から導き出すことになるから、作成した数式モデルと現実のワーク移動系との間の誤差が大きくなり易い。このような誤差を低減しようとすると、数式モデルが複雑化する傾向があり、実用水準の制御応答性を確保するためには、制御装置に極めて高度な演算能力が求められることになる。
他方、介在物の動作情報取得手段として、電動機とワークとの間の機構部に対しハンマリングを行なう場合は、動作情報として機構部の共振周波数だけが得られるので、数式モデルを精度良く作成することは困難である。なお、前述した特許文献1に開示される電動機制御は、数式モデルを用いてワーク上の加工点の動作制御を行なう際の、検出器と加工点との間の介在物に起因するモデル化誤差の問題を解決するものではない。
ワーク移動系の数式モデルの精度を向上させるためには、ワーク移動系の状態を観測する検出器を、事実上の制御対象であるワーク上の加工点に可及的に接近させて設置することが有効である。しかし、テーブル等のワーク支持部材の位置や速度を検出するリニアスケール、ロータリースケール等の従来の検出器は、一般に、設置時の機械構造的制約が多く、加工点の近くに設置することが困難であった。
本発明の目的は、物体を移動させる駆動源としての電動機の制御装置において、物体移動系の高精度で比較的単純な数式モデルに基づいて、物体上の所望点(例えば加工点)の動作(速度、振動等)を推定でき、以って、高度な演算能力を要することなく実用水準の制御応答性を確保して、物体上の所望点の高精度の動作制御を実現できる制御装置を提供することにある。
上記目的を達成するために、請求項1に記載の発明は、物体を移動させる電動機の制御装置であって、物体の加速度を検出する加速度検出部と、電動機の運転情報を取得する運転情報取得部と、加速度検出部が検出した物体の加速度情報と運転情報取得部が取得した電動機の運転情報とに基づいて、物体の移動系の数式モデルを決定するシステム同定部と、システム同定部が決定した数式モデルを用いて、電動機の運転を制御する制御部と、を具備することを特徴とする制御装置を提供する。
請求項2に記載の発明は、請求項1に記載の制御装置において、運転情報取得部が取得する運転情報は、電動機の電流情報を含む制御装置を提供する。
請求項3に記載の発明は、請求項2に記載の制御装置において、電流情報は、電動機に指令される電流指令値である制御装置を提供する。
請求項4に記載の発明は、請求項2に記載の制御装置において、電流情報は、電動機で検出される電流検出値である制御装置を提供する。
請求項5に記載の発明は、請求項1又は2に記載の制御装置において、運転情報取得部が取得する運転情報は、電動機の速度情報を含む制御装置を提供する。
請求項6に記載の発明は、請求項5に記載の制御装置において、速度情報は、電動機に指令される速度指令値である制御装置を提供する。
請求項7に記載の発明は、請求項5に記載の制御装置において、速度情報は、電動機で検出される速度検出値である制御装置を提供する。
請求項8に記載の発明は、請求項1〜7のいずれか1項に記載の制御装置において、数式モデルは、伝達関数及びARXモデルのうちいずれかを用いて作成される制御装置を提供する。
請求項9に記載の発明は、請求項8に記載の制御装置において、数式モデルが、二慣性系モデルに近似される制御装置を提供する。
請求項10に記載の発明は、請求項1〜9のいずれか1項に記載の制御装置において、物体が、加工機によって加工されるワークであり、加速度検出部は、ワークの加工点に近接する領域の加速度を検出する制御装置を提供する。
請求項1に記載の発明によれば、物体の移動系の観測出力として、制御対象である物体の加速度情報を採用するので、物体と電動機との間の介在物(例えば工作機械の機構部)の動作情報(速度、振動等)を、加速度情報から間接的に取得できる。そして、システム同定部は、移動系の操作入力である電動機の運転情報と、観測出力である加速度情報とに基づき、移動系の高精度で比較的単純な数式モデルを決定でき、制御部は、そのような数式モデルを用いて、物体上の所望点(例えば加工点)の動作(速度、振動等)を適確に推定した上で、電動機の運転を制御できる。したがって、高度な演算能力を要することなく実用水準の制御応答性を確保しながら、物体と電動機との間の介在物の振動等を考慮に入れて、物体上の所望点に対する高精度の動作制御を実現することができる。
請求項2に記載の発明によれば、電動機の電流と加速度とが比例関係を有すると近似することにより、電動機加速度(操作入力)から物体加速度(観測出力)までの物体移動系の数式モデルを決定することができる。
請求項3に記載の発明によれば、外乱を含まない電流情報に基づいて数式モデルを決定できる。
請求項4に記載の発明によれば、電流フィードバックを省略した数式モデルを決定できる。
請求項5に記載の発明によれば、電動機速度又は電動機電流(操作入力)から物体加速度(観測出力)までの物体移動系の数式モデルを決定することができる。
請求項6に記載の発明によれば、外乱を含まない速度情報に基づいて数式モデルを決定できる。
請求項7に記載の発明によれば、速度フィードバックを省略した数式モデルを決定できる。
請求項8に記載の発明によれば、制御上の扱いが容易な数式モデルを作成できる。
請求項9に記載の発明によれば、数式モデルの次数を下げることができるので、高度な演算能力が不要になる。
請求項10に記載の発明によれば、加工機によるワークの高精度加工を実現することができる。
以下、添付図面を参照して、本発明の実施の形態を詳細に説明する。全図面に渡り、対応する構成要素には共通の参照符号を付す。
図面を参照すると、図1は、本発明に係る電動機の制御装置10の基本構成を機能ブロック図で示す。制御装置10は、物体12を移動させる駆動源としての電動機14を制御するものであって、物体12の加速度を検出する加速度検出部16と、電動機14の運転情報を取得する運転情報取得部18と、加速度検出部16が検出した物体12の加速度情報D1と運転情報取得部18が取得した電動機14の運転情報D2とに基づいて、物体12の移動系Sの数式モデルMを決定するシステム同定部20と、システム同定部20が決定した数式モデルMを用いて、電動機14の運転を制御する制御部22とを備えて構成される。
図面を参照すると、図1は、本発明に係る電動機の制御装置10の基本構成を機能ブロック図で示す。制御装置10は、物体12を移動させる駆動源としての電動機14を制御するものであって、物体12の加速度を検出する加速度検出部16と、電動機14の運転情報を取得する運転情報取得部18と、加速度検出部16が検出した物体12の加速度情報D1と運転情報取得部18が取得した電動機14の運転情報D2とに基づいて、物体12の移動系Sの数式モデルMを決定するシステム同定部20と、システム同定部20が決定した数式モデルMを用いて、電動機14の運転を制御する制御部22とを備えて構成される。
上記構成を有する制御装置10では、物体12の移動系Sの観測出力として、制御対象である物体12の加速度情報D1を採用するので、物体12と電動機14との間の介在物(例えば工作機械の機構部)の動作情報(速度、振動等)を、加速度情報D1から間接的に取得することができる。そして、システム同定部20は、移動系Sの操作入力である電動機14の運転情報D2と、観測出力である加速度情報D1とに基づき、移動系Sの高精度で比較的単純な数式モデルMを決定することができ、制御部22は、そのような数式モデルMを用いて、物体12上の所望点(例えば加工点)の動作(速度、振動等)を適確に推定した上で、電動機14の運転を制御することができる。したがって制御装置10によれば、高度な演算能力を要することなく実用水準の制御応答性を確保しながら、物体12と電動機14との間の介在物の振動等を考慮に入れて、物体12上の所望点に対する高精度の動作制御を実現することができる。
ここで、加速度検出部16は、ひずみゲージ型、サーボ型、圧電素子型等の、公知の加速度センサの構成を有することができる。いずれの加速度センサも、ワークテーブル等の物体支持部材の位置や速度を検出するリニアスケール、ロータリースケール等の検出器に比べて、設置時の機械構造的制約が少ないので、事実上の制御対象である物体12上の所望点(例えば加工点)に可及的に接近させて設置できる。そして、そのように設置した加速度検出部16が検出した加速度情報D1を、システム同定に用いることにより、物体12上の所望点(例えば加工点)に可及的に接近した部位と電動機14との間で、物体移動系Sをモデル化した数式モデルMを作成することができる。このような数式モデルMは、事実上の制御対象である物体12上の所望点の近傍部位における実測データに基づいて作成したものであるから、現実の物体移動系Sに対する誤差が極めて小さくなり、しかも、理論式に基づいた数式モデルよりも有意に簡略化されたものとなる。
図2は、本発明に係る制御装置10を適用した物体移動系Sの1つの具体例を示す。図示の例では、物体12は、加工機(図示せず)によって加工されるワーク12であり、加速度検出部16を構成する加速度センサ16は、ワーク12の加工点Pに近接する領域に設置されて、その領域の加速度を検出する。電動機14は、その出力軸に連結された送りねじ機構24を介して、ワーク12を担持するテーブル26を直線的に往復移動させる。運転情報取得部18は、電動機14に設置される電流検出回路やエンコーダ等の検出器18から構成される。
システム同定部20は、加速度センサ16が検出したワーク12の加速度情報D1と検出器18が検出した電動機14の運転情報D2とに基づいて、ワーク12の移動系Sの数式モデルMを決定し、制御部22は、その数式モデルMを用いて電動機14の運転を制御する。それにより、制御装置10は、送りねじ機構24、テーブル26及びワーク12の振動等を考慮に入れて、ワーク12の加工点Pの動作を適確に制御することができ、以って、加工機による高精度加工を実現することができる。
上記した基本構成を有する制御装置10において、運転情報取得部18が取得する運転情報D2は、電動機14の電流情報を含むことができる。この場合、システム同定部20は、電動機14の加速度を物体移動系Sの操作入力とし、加速度検出部16が検出した物体12の加速度を物体移動系Sの観測出力として、以下のように数式モデルMを決定することができる。
まず、電動機14において、電流∝トルク(∝は比例関係を表す)と近似すると、トルク∝力(=トルク×距離)∝加速度(=力/質量)であるから、電流∝加速度と近似できる。すなわち、電動機14において、電流=k×加速度となるので、電流及び加速度の測定値からkを求めることができる。
次に、電動機14に対し、任意の加速度(=電流×1/k)を様々な周波数で入力し、それぞれに対応する物体12の加速度を、加速度検出部16で検出する。そこで、加速度の入力から出力への変化量(=物体加速度/電動機加速度)と、加速度の位相差(すなわち電動機加速度(操作入力)の周期に対する物体加速度(観測出力)の位相のずれ量)とを算出することにより、『電動機加速度−物体加速度』に関する周波数特性(周波数に対するゲイン及び位相遅れの関係)を得ることができる。そして、得られた周波数特性を表わす伝達関数を求めることにより、電動機加速度から物体加速度までの数式モデルMを決定することができる。
なお、上記構成において、運転情報取得部18が取得する電動機14の電流情報は、電動機14に指令される電流指令値であってもよいし、電動機14で検出される電流検出値であってもよい。
運転情報取得部18が取得する運転情報D2は、電動機14の速度情報を含むこともできる。この場合、システム同定部20は、電動機14の速度を1階微分して電動機加速度を算出し、この電動機加速度に対し上記した演算を行なうことにより、電動機速度(操作入力)から物体加速度(観測出力)までの数式モデルMを決定することができる。
また、運転情報取得部18が取得する運転情報D2は、電動機14の電流情報と速度情報との双方を含むこともできる。この場合、システム同定部20は、電流∝加速度と近似する前述した手法に代えて、電流情報及び速度情報を用いて電動機電流から電動機速度までの数式モデルを決定し、これに上記した電動機速度から物体加速度までの数式モデルを付加することで、電動機電流(操作入力)から物体加速度(観測出力)までの数式モデルMを決定することができる。
なお、上記構成において、運転情報取得部18が取得する電動機14の速度情報は、電動機14に指令される速度指令値であってもよいし、電動機14で検出される速度検出値であってもよい。
上記構成を有する制御装置10において、システム同定部20が決定する数式モデルMは、伝達関数及びARXモデル(autoregressive model with exogenous input)のうちの、いずれかを用いて作成することができる。この場合、数式モデルMを、二慣性系モデルに近似することが有利である。
以上の説明から明らかなように、本発明によれば、物体を移動させる駆動源としての電動機の制御装置において、物体移動系の高精度で比較的単純な数式モデルに基づいて、物体上の所望点(例えば加工点)の動作(速度、振動等)を推定でき、以って、高度な演算能力を要することなく実用水準の制御応答性を確保して、物体上の所望点の高精度の動作制御を実現できる制御装置が提供される。本発明に係る制御装置は、工作機械等の加工機においてワークを移動させる駆動源としての電動機の制御装置として好適に適用できるが、それに限らず、物体移動系の観測出力を検出する検出器を物体の所望点に設置できない状況下で、機構部の振動等を考慮に入れて当該所望点を適確に制御することが要求される用途において、前述した格別の作用効果を奏するものである。
10 制御装置
12 物体
14 電動機
16 加速度検出部
18 運転情報取得部
20 システム同定部
22 制御部
12 物体
14 電動機
16 加速度検出部
18 運転情報取得部
20 システム同定部
22 制御部
Claims (10)
- 物体を移動させる電動機の制御装置であって、
物体の加速度を検出する加速度検出部と、
電動機の運転情報を取得する運転情報取得部と、
前記加速度検出部が検出した前記物体の加速度情報と前記運転情報取得部が取得した前記電動機の運転情報とに基づいて、前記物体の移動系の数式モデルを決定するシステム同定部と、
前記システム同定部が決定した前記数式モデルを用いて、前記電動機の運転を制御する制御部と、
を具備することを特徴とする制御装置。 - 前記運転情報取得部が取得する前記運転情報は、前記電動機の電流情報を含む、請求項1に記載の制御装置。
- 前記電流情報は、前記電動機に指令される電流指令値である、請求項2に記載の制御装置。
- 前記電流情報は、前記電動機で検出される電流検出値である、請求項2に記載の制御装置。
- 前記運転情報取得部が取得する前記運転情報は、前記電動機の速度情報を含む、請求項1又は2に記載の制御装置。
- 前記速度情報は、前記電動機に指令される速度指令値である、請求項5に記載の制御装置。
- 前記速度情報は、前記電動機で検出される速度検出値である、請求項5に記載の制御装置。
- 前記数式モデルは、伝達関数及びARXモデルのうちいずれかを用いて作成される、請求項1〜7のいずれか1項に記載の制御装置。
- 前記数式モデルが、二慣性系モデルに近似される、請求項8に記載の制御装置。
- 前記物体が、加工機によって加工されるワークであり、前記加速度検出部は、該ワークの加工点に近接する領域の加速度を検出する、請求項1〜9のいずれか1項に記載の制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2005305430A JP2007115000A (ja) | 2005-10-20 | 2005-10-20 | 電動機の制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2005305430A JP2007115000A (ja) | 2005-10-20 | 2005-10-20 | 電動機の制御装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2007115000A true JP2007115000A (ja) | 2007-05-10 |
Family
ID=38097119
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2005305430A Pending JP2007115000A (ja) | 2005-10-20 | 2005-10-20 | 電動機の制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2007115000A (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2012057235A1 (ja) * | 2010-10-27 | 2012-05-03 | 株式会社牧野フライス製作所 | 数値制御方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH01209510A (ja) * | 1988-02-17 | 1989-08-23 | Toshiba Corp | ロボットの制御装置 |
WO2001082462A1 (fr) * | 2000-04-20 | 2001-11-01 | Kabushiki Kaisha Yaskawa Denki | Commande de moteur |
-
2005
- 2005-10-20 JP JP2005305430A patent/JP2007115000A/ja active Pending
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH01209510A (ja) * | 1988-02-17 | 1989-08-23 | Toshiba Corp | ロボットの制御装置 |
WO2001082462A1 (fr) * | 2000-04-20 | 2001-11-01 | Kabushiki Kaisha Yaskawa Denki | Commande de moteur |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2012057235A1 (ja) * | 2010-10-27 | 2012-05-03 | 株式会社牧野フライス製作所 | 数値制御方法 |
CN103180790A (zh) * | 2010-10-27 | 2013-06-26 | 株式会社牧野铣床制作所 | 数值控制方法 |
JP5566469B2 (ja) * | 2010-10-27 | 2014-08-06 | 株式会社牧野フライス製作所 | 数値制御方法 |
US9360849B2 (en) | 2010-10-27 | 2016-06-07 | Makino Milling Machine Co., Ltd. | Numerical control method |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
TWI540402B (zh) | 馬達控制裝置 | |
JP5209810B1 (ja) | イナーシャと摩擦係数とばね定数を同時に推定する機能を備える電動機の制御装置 | |
JP4283214B2 (ja) | 機械先端点の制御装置 | |
JP5127934B2 (ja) | 機械運動軌跡測定装置、数値制御工作機械および機械運動軌跡測定方法 | |
JP4581096B2 (ja) | 摩擦補償方法、摩擦補償器及びモータ制御装置 | |
US10564032B2 (en) | Vibration mode determining apparatus | |
EP1505463B1 (en) | Position control device and position control method for machine tools | |
CN109085802B (zh) | 电动机的控制装置 | |
JPWO2019043852A1 (ja) | 数値制御システムおよびモータ制御装置 | |
US20150323924A1 (en) | Servo control device | |
US9921568B2 (en) | Trajectory measuring device, numerical control device, and trajectory measuring method | |
JP2014219911A (ja) | シミュレーション装置およびシミュレーションプログラム | |
JP2007115000A (ja) | 電動機の制御装置 | |
WO2020217282A1 (ja) | サーボ制御装置 | |
KR101209779B1 (ko) | 로봇의 부하 추정 방법 | |
CN107272576B (zh) | 进给轴控制装置中的频率特性测定方法 | |
JP6310944B2 (ja) | 機械装置の設計改善作業を支援する方法及び装置 | |
JP4664576B2 (ja) | サーボ制御装置 | |
JP5334932B2 (ja) | パラメータ設定方法およびパラメータ設定装置 | |
CN112236729A (zh) | 数控装置 | |
JP2008543250A (ja) | リニア駆動装置の位置制御方法及び/又は速度制御方法 | |
JP5225060B2 (ja) | 機械運動測定装置 | |
Chong et al. | AR-CM NCTF Control for Precision Positioning Systems--Concept and Results | |
Briones et al. | Position and force control of a parallel robot capaman 2 bis parallel robot for drilling tasks | |
JP4632171B2 (ja) | モータ制御装置および制御方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20080611 |
|
A131 | Notification of reasons for refusal |
Effective date: 20100126 Free format text: JAPANESE INTERMEDIATE CODE: A131 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20100128 |
|
A02 | Decision of refusal |
Effective date: 20100601 Free format text: JAPANESE INTERMEDIATE CODE: A02 |