特許第6603285号(P6603285)IP Force 特許公報掲載プロジェクト 2022.1.31 β版

知財求人 - 知財ポータルサイト「IP Force」

▶ ファナック株式会社の特許一覧

(19)【発行国】日本国特許庁(JP)
(12)【公報種別】特許公報(B2)
(11)【特許番号】6603285
(24)【登録日】2019年10月18日
(45)【発行日】2019年11月6日
(54)【発明の名称】モータ制御装置
(51)【国際特許分類】
   H02P 21/06 20160101AFI20191028BHJP
   H02P 21/22 20160101ALI20191028BHJP
   G05B 19/19 20060101ALI20191028BHJP
【FI】
   H02P21/06
   H02P21/22
   G05B19/19 K
【請求項の数】6
【全頁数】17
(21)【出願番号】特願2017-202804(P2017-202804)
(22)【出願日】2017年10月19日
(65)【公開番号】特開2019-75961(P2019-75961A)
(43)【公開日】2019年5月16日
【審査請求日】2019年1月18日
【早期審査対象出願】
(73)【特許権者】
【識別番号】390008235
【氏名又は名称】ファナック株式会社
(74)【代理人】
【識別番号】100106002
【弁理士】
【氏名又は名称】正林 真之
(74)【代理人】
【識別番号】100165157
【弁理士】
【氏名又は名称】芝 哲央
(74)【代理人】
【識別番号】100160794
【弁理士】
【氏名又は名称】星野 寛明
(72)【発明者】
【氏名】橋本 章太郎
(72)【発明者】
【氏名】森田 有紀
【審査官】 尾家 英樹
(56)【参考文献】
【文献】 特開2014−048761(JP,A)
【文献】 特開2017−046487(JP,A)
【文献】 特開2012−044835(JP,A)
(58)【調査した分野】(Int.Cl.,DB名)
H02P 21/00− 31/00
(57)【特許請求の範囲】
【請求項1】
工作機械の主軸を駆動する誘導モータを制御するモータ制御装置であって、
前記工作機械の動作プログラムに基づく動作指令に従って、前記主軸の回転位置又は回転速度、及び前記誘導モータの2次磁束を制御する主軸制御部と、
前記動作プログラムを先読みして、前記誘導モータの2次磁束を増加させる必要がある動作指令の変化を事前に検知する事前検知部と、
前記事前検知部で前記動作指令の変化が検知された場合に、前記主軸制御部に、前記動作指令の変化に先行して前記誘導モータの2次磁束を増加させる事前変更部と、
を備える、モータ制御装置。
【請求項2】
前記主軸制御部は、前記誘導モータの2次磁束を制御する励磁電流指令と、前記誘導モータのトルクを制御するトルク電流指令とに基づいて、誘導モータのベクトル制御を行い、
前記事前変更部は、前記励磁電流指令、又は前記励磁電流指令を生成するための磁束指令を増加させることにより、前記誘導モータの2次磁束を増加させる、
請求項1に記載のモータ制御装置。
【請求項3】
前記動作指令の変化に先行して前記誘導モータの2次磁束を増加させる変更タイミングを設定値として設定する設定部を更に備え、
前記事前変更部は、前記設定部で設定された設定値に基づいて、前記誘導モータの2次磁束を増加させる、
請求項1又は2に記載のモータ制御装置。
【請求項4】
前記事前検知部は、前記設定部で設定された変更タイミングを経過するときに、前記動作指令の変化を検知する
請求項3に記載のモータ制御装置。
【請求項5】
前記誘導モータの2次磁束の変化に関する時定数を記憶する記憶部を更に備え、
前記設定部は、前記記憶部に記憶された時定数に基づく前記変更タイミングを前記設定値として設定する、
請求項3又は4に記載のモータ制御装置。
【請求項6】
前記動作指令の変化は、前記主軸の回転速度を制御するための速度指令の増加、又は、前記速度指令から前記主軸の回転位置を制御するための位置指令への動作指令の変更である、請求項1〜5の何れか1項に記載のモータ制御装置。
【発明の詳細な説明】
【技術分野】
【0001】
本発明は、工作機械の主軸を駆動する誘導モータを制御するモータ制御装置に関する。
【背景技術】
【0002】
工作機械の主軸モータとして、誘導モータが用いられることがある。特許文献1及び2には、このような誘導モータを制御するモータ制御装置が記載されている。
特許文献1には、誘導モータに供給する1次電流を、磁束生成のための励磁電流と、トルク電流とに分けて制御するベクトル制御に関する技術が記載されている。
特許文献2には、速度指令に基づく速度制御と位置指令に基づく位置制御との制御モードを切り換える技術が記載されている。
【先行技術文献】
【特許文献】
【0003】
【特許文献1】特開2013−223329号公報
【特許文献2】特開2008−306798号公報
【発明の概要】
【発明が解決しようとする課題】
【0004】
誘導モータは、固定子(ステータ)コイルに励磁電流を流して回転磁界を発生させると共に、回転子(ロータ)に誘導電流を発生させ、その電磁力により、回転子が回転磁界の回転を追いかけるように回転するモータである。誘導モータには、固定子コイルに励磁電流が流れることにより発熱が伴うという欠点がある。この欠点の回避を目的として、誘導モータに対する負荷が軽く、高いトルクが必要とされない場合に、回転磁界の磁束又は励磁電流を弱める磁束弱め技術がある。
【0005】
ところで、速度指令に基づく速度制御時に、加減速を行う場合、大きなトルクが必要となる。そのため、磁束弱め技術を用いた場合、誘導モータの磁束を弱めることによりトルクが小さくなった状態で加減速を行うと、速度指令に従って励磁電流を増加した直後は、磁束が十分に立ち上がっていないために十分なトルクを得ることができず、加速時間が延びてしまう。すなわち、制御の応答性が低下してしまう。
【0006】
また、位置指令に基づく位置制御では、軽負荷時でも高い応答性が求められる。そのため、磁束弱め技術を用いた場合、誘導モータの磁束を弱めることによりトルクが小さくなった状態で速度制御から位置制御に切り換えると、速度指令から位置指令への変更に従って励磁電流を増加した直後は、磁束が十分に立ち上がっていないために十分なトルクを得ることができず、位置制御の応答性が低下してしまう。
【0007】
本発明は、発熱の低減と制御の高い応答性との両立を図るモータ制御装置を提供することを目的とする。
【課題を解決するための手段】
【0008】
(1) 本発明に係るモータ制御装置(例えば、後述のモータ制御装置1、1A)は、工作機械の主軸を駆動する誘導モータ(例えば、後述の誘導モータ2)を制御するモータ制御装置であって、前記工作機械の動作プログラムに基づく動作指令に従って、前記主軸の回転位置又は回転速度、及び前記誘導モータの2次磁束を制御する主軸制御部(例えば、後述の主軸制御部200)と、前記動作プログラムを先読みして、前記誘導モータの2次磁束を増加させる必要がある動作指令の変化を事前に検知する事前検知部(例えば、後述の事前検知部10)と、前記事前検知部で前記動作指令の変化が検知された場合に、前記主軸制御部に、前記動作指令の変化に先行して前記誘導モータの2次磁束を増加させる事前変更部(例えば、後述の事前変更部20)と、を備える。
【0009】
(2) (1)に記載のモータ制御装置において、前記主軸制御部は、前記誘導モータの2次磁束を制御する励磁電流指令と、前記誘導モータのトルクを制御するトルク電流指令とに基づいて、誘導モータのベクトル制御を行い、前記事前変更部は、前記励磁電流指令、又は前記励磁電流指令を生成するための磁束指令を増加させることにより、前記誘導モータの2次磁束を増加させてもよい。
【0010】
(3) (1)又は(2)に記載のモータ制御装置は、前記動作指令の変化に先行して前記誘導モータの2次磁束を増加させる変更タイミングを設定値として設定する設定部(例えば、後述する設定部12)を更に備え、前記事前変更部は、前記設定部で設定された設定値に基づいて、前記誘導モータの2次磁束を増加させてもよい。
【0011】
(4) (3)に記載のモータ制御装置において、前記事前検知部は、前記設定部で設定された変更タイミングを経過するときに、前記動作指令の変化を検知してもよい。
【0012】
(5) (3)又は(4)に記載のモータ制御装置は、前記誘導モータの2次磁束の変化に関する時定数を記憶する記憶部(例えば、後述する記憶部11)を更に備え、前記設定部は、前記記憶部に記憶された時定数に基づく前記変更タイミングを前記設定値として設定してもよい。
【0013】
(6) (1)〜(5)のいずれかに記載のモータ制御装置において、前記動作指令の変化は、前記主軸の回転速度を制御するための速度指令の増加、又は、前記速度指令から前記主軸の回転位置を制御するための位置指令への動作指令の変更でであってもよい。
【発明の効果】
【0014】
本発明によれば、発熱の低減と制御の高い応答性との両立を図るモータ制御装置を提供することができる。
【図面の簡単な説明】
【0015】
図1A】第1実施形態に係るモータ制御装置の構成の一例を示す図である。
図1B】第1実施形態に係るモータ制御装置の構成の他の一例を示す図である。
図2A図1A及び図1Bに示す主軸制御部の電流制御部の構成の一例を示す図である。
図2B図1A及び図1Bに示す主軸制御部の電流制御部の構成の他の一例を示す図である。
図3】誘導モータの磁束弱め制御の概略図である。
図4】速度指令の変化(増加)時の誘導モータの励磁電流と2次磁束の概略図である。
図5】第1実施形態に係るモータ制御装置による先読み動作の概略図である。
図6】第1実施形態に係るモータ制御装置による先読み動作のフローチャートである。
図7A】第2実施形態に係るモータ制御装置の構成の一例を示す図である。
図7B】第2実施形態に係るモータ制御装置の構成の他の一例を示す図である。
図8】速度制御時の誘導モータの磁束弱め制御と位置制御時の誘導モータの磁束制御の概略図である。
図9A】速度制御から位置制御への変更時の誘導モータの励磁電流と2次磁束の概略図である。
図9B】誘導モータの磁束ブースト制御の概略図である。
図10】第1実施形態に係るモータ制御装置による先読み動作の概略図である。
図11】第2実施形態に係るモータ制御装置による先読み動作のフローチャートである。
【発明を実施するための形態】
【0016】
以下、添付の図面を参照して本発明の実施形態の一例について説明する。なお、各図面において同一又は相当の部分に対しては同一の符号を附すこととする。
【0017】
(第1実施形態)
図1Aは、第1実施形態に係るモータ制御装置の構成の一例を示す図である。図1Aに示すモータ制御装置1は、スピンドル加工機のような工作機械の主軸を回転駆動する誘導モータ2を制御するための装置である。モータ制御装置1は、数値制御部(CNC)100と、主軸制御部200と、駆動部300とを備える。
【0018】
数値制御部100は、工作機械の動作プログラム(加工プログラムともいう。)を記憶している。なお、数値制御部100は、外部装置に記憶されている工作機械の動作プログラムを取得するようにしてもよい。
数値制御部100は、この動作プログラムに基づいて、主軸の回転速度を制御するための速度指令vcmdを生成し、主軸制御部200に供給する。
【0019】
主軸制御部200は、数値制御部100からの速度指令vcmdに従って、誘導モータ2を駆動制御する。主軸制御部200は、速度制御部220と電流制御部230とを備える。
【0020】
速度制御部220は、数値制御部100からの速度指令vcmdと、誘導モータ2に設けられたエンコーダ3で検出された誘導モータ2の実速度(速度FB)vaとの差分に基づいてトルク指令Tcmdを生成する。
【0021】
電流制御部230は、速度制御部220からのトルク指令Tcmdと、エンコーダ3からの実速度vaと、駆動部300に設けられた電流検出器310で検出された駆動部300の出力電流、すなわち誘導モータ2を駆動するための実電流(電流FB、駆動電流)Iu,Iv,Iwとに基づいて、駆動部300を駆動するための電圧指令Vu,Vv,Vwを生成する。
【0022】
数値制御部100及び主軸制御部200は、例えば、DSP(Digital Signal Processor)、FPGA(Field−Programmable Gate Array)等の演算プロセッサで構成される。数値制御部100及び主軸制御部200の機能は、例えば記憶部に格納された所定のソフトウェア(プログラム)を実行することで実現される。数値制御部100及び主軸制御部200の機能は、ハードウェアとソフトウェアとの協働で実現されてもよいし、ハードウェア(電子回路)のみで実現されてもよい。
【0023】
駆動部300は、電流制御部230からの電圧指令Vu,Vv,Vwに基づいて、誘導モータ2を駆動するための実電流(駆動電流)Iu,Iv,Iwを生成する。
駆動部300は、例えば、商用3相交流電力を直流電力に変換するコンバータと、コンバータからの直流電力を3相交流電力に変換するインバータとにより構成される。この場合、電圧指令Vu,Vv,Vwはインバータの制御電圧として用いられる。
【0024】
図2Aは、図1に示す主軸制御部200における電流制御部230の構成の一例を示す図であり、図2Bは、図1に示す主軸制御部200における電流制御部230の構成の他の一例を示す図である。
図2A及び図2Bに示す電流制御部230(すなわち主軸制御部200)は、誘導モータ2の1次電流すなわち駆動電流を、磁束生成のための励磁電流(d相電流)と、トルク生成のためのトルク電流(q相電流)とに分けて制御するベクトル制御を行う。
【0025】
図2Aに示す電流制御部230は、磁束指令発生部231と、減算器232,235,238と、磁束制御部233と、磁束推定部234と、励磁電流制御部236と、トルク電流指令発生部237と、トルク電流制御部239と、2相−3相変換部240とを備える。
【0026】
磁束指令発生部231は、トルク指令Tcmdと誘導モータ2の実速度(速度FB)vaとに基づいて、誘導モータ2の磁束生成のための磁束指令Φcmdを生成する。
【0027】
減算器232は、磁束指令Φcmdと、磁束推定部234で推定された誘導モータ2の2次磁束の推定値Φ2dとの差分を求める。
磁束制御部233は、減算器232で求められた磁束指令Φcmdと磁束推定値Φ2dとの差分に基づいて、励磁電流指令(d相電流指令)Idcmdを生成する。
磁束推定部234は、磁束制御部233で生成された励磁電流指令Idcmdと、例えば記憶部(図示省略)に格納された誘導モータ2の相互インダクタンスMと、誘導モータ2の回路定数で決まる時定数τ=L/Rとに基づいて、下式(1)より誘導モータ2の2次磁束Φ2dを推定する。
【数1】
なお、磁束推定部234は、励磁電流指令Idcmdに代えて誘導モータ2の励磁電流(d相電流)のフィードバックI1dを用い、下式(2)より誘導モータ2の2次磁束Φ2dを推定してもよい。
【数2】
【0028】
このように、磁束指令発生部231、減算器232、磁束制御部233及び磁束推定部234は、上式(1)又は上式(2)のように時定数τ=L/Rの1次遅れを考慮して励磁電流指令Idcmd又は励磁電流I1dから誘導モータ2の2次磁束Φ2dを推定し、磁束指令Φcmdと磁束推定値Φ2dとの偏差から励磁電流指令Idcmdを生成する。
【0029】
減算器235は、磁束制御部233で生成された励磁電流指令Idcmdと、2相−3相変換部240によって実電流Iu,Iv,Iwが変換された励磁電流(d相電流)のフィードバックI1dとの差分を求める。
励磁電流制御部236は、励磁電流指令Idcmdと励磁電流のフィードバックI1dとの差分に基づいて、d相電圧指令Vdcmdを生成する。
【0030】
トルク電流指令発生部237は、トルク指令Tcmdに基づいてトルク電流指令(q相電流指令)Iqcmdを生成する。
【0031】
減算器238は、トルク電流指令発生部237で生成されたトルク電流指令Iqcmdと、2相−3相変換部240によって実電流Iu,Iv,Iwが変換されたトルク電流(q相電流)のフィードバックI1qとの差分を求める。
トルク電流制御部239は、トルク電流指令Iqcmdとトルク電流のフィードバックI1qとの差分に基づいて、q相電圧指令Vqcmdを生成する。
【0032】
2相−3相変換部240は、d相電圧指令Vdcmdとq相電圧指令Vqcmdとを、uvw各相の電圧指令Vu,Vv,Vwに変換する。また、2相−3相変換部240は、uvw各相の実電流Iu,Iv,Iwを、励磁電流(d相電流)I1d及びトルク電流(q相実電流)I1qに変換する。
【0033】
図2Bに示す電流制御部230は、図2Aに示す電流制御部230において、磁束指令発生部231、減算器232、磁束制御部233及び磁束推定部234に代えて励磁電流指令発生部241を備える。
励磁電流指令発生部241は、トルク指令Tcmdと誘導モータ2の実速度(速度FB)vaとに基づいて、励磁電流指令(d相電流指令)Idcmdを生成する。
【0034】
このように、図2Bに示す電流制御部230では、励磁電流指令発生部241により励磁電流を直接指令することで間接的に誘導モータ2の2次磁束Φ2dを制御する。
ここで、上式(2)に示すように、誘導モータ2では、励磁電流(d相電流)I1dを供給しても、2次磁束Φ2dは時定数τ=L/Rだけ遅れて立ち上がる。
この点に関し、図2Aに示す電流制御部230では、磁束指令発生部231、減算器232、磁束制御部233及び磁束推定部234により、時定数τ=L/Rの1次遅れを考慮して励磁電流から誘導モータ2の2次磁束Φ2dを推定し、磁束指令Φcmdと磁束推定値Φ2dとの偏差から励磁電流指令Idcmdを生成する。これにより、図2Aの電流制御部230は、図2Bの電流制御部230よりも、励磁電流変化時の過渡状態における誘導モータ2の制御性を向上できる。
【0035】
ところで、モータ制御装置1は、誘導モータ2の発熱低減のため、誘導モータ2の負荷が軽く高トルクが必要とされない場合(軽負荷時)には、誘導モータ2の2次磁束(励磁電流)を小さく制御する(磁束弱め制御)。例えば、図2Aに示す電流制御部230では、磁束指令発生部231により、図3に示すように、トルク指令が小さくなるにつれて磁束指令を次第に小さくするように、トルク指令に応じて磁束指令を変更する。また、図2Bに示す電流制御部230では、励磁電流指令発生部241により、図3に示すように、トルク指令が小さくなるにつれて励磁電流指令を次第に小さくするように、トルク指令に応じて磁束指令を変更する。
【0036】
例えば、磁束弱め制御により磁束指令又は励磁電流指令を30%にしているときに停止状態から加速動作を行うと、トルク指令は0%から100%に変化するため、磁束指令又は励磁電流指令は30%から100%に変化する。このとき、図4に示すように、実際の2次磁束Φ2dは、励磁電流I1d、すなわち磁束指令又は励磁電流指令に対して時定数τ=L/Rで遅れて立ち上がる。
【0037】
誘導モータ2のトルクTは、下式(3)に示すように2次磁束Φ2dとトルク電流(q相電流)I1qの積で表される。
【数3】
Np:極対数
そのため、加速時のような大きなトルクが必要な場合、すなわち速度指令が増加する場合、磁束指令又は励磁電流指令を増加した直後は、2次磁束Φ2dが十分に立ち上がっていないために十分なトルクを出力することができず、磁束の立ち上がりを待つ必要がある。磁束の立ち上がりを待たずに加速する場合、加速時間が延びてしまう。
【0038】
そこで、本実施形態では、図5に示すように、動作プログラムを先読みして速度指令の変化(増加)を事前に検知し、速度指令が変化(増加)する時刻t1までに2次磁束が十分に立ち上がるように、時刻t1よりも所定時間だけ早い時刻t0において磁束指令又は励磁電流指令を増加させる。
【0039】
具体的には、図1Aに示すように、数値制御部100は、事前検知部10、記憶部11及び設定部12を備え、主軸制御部200は、事前変更部20を備える。
【0040】
記憶部11は、図4及び図5に示すような誘導モータ2の2次磁束Φ2dの変化に関する時定数、すなわち上式(2)に示すように誘導モータ2の回路定数で決まる時定数τ=L/Rを記憶する。記憶部11は、例えばEEPROM等の書き換え可能なメモリである。
【0041】
設定部12は、速度指令vcmdの変化に先行して誘導モータ2の2次磁束Φ2dを増加させる変更タイミングを設定値として設定する。設定部12は、図5に示すように、速度指令vcmdが変化(増加)する時刻t1までに2次磁束Φ2dが十分に立ち上がるように、磁束指令又は励磁電流指令を増加させる変更タイミングを設定する。本実施形態では、設定部12は、時刻t1よりも所定時間だけ早い時刻t0において磁束指令又は励磁電流指令を増加させるために、所定時間(t1−t0)を設定値として設定する。
例えば、設定部12は、設定値(t1−t0)を、記憶部11に記憶された誘導モータ2の時定数τ=L/Rに基づいて、時定数τの3倍以上の時間に設定してもよい。これにより、速度指令vcmdが変化(増加)する時刻t1までに、誘導モータ2の2次磁束Φ2dを90%以上まで立ち上げることができる(励磁電流0%から100%への変化時)。
設定部12は、設定値(t1−t0)を、時定数τの4倍以上7倍以下の時間に設定することが好ましい。設定値(t1−t0)を時定数τの4倍以上の時間に設定すると、速度指令vcmdが変化(増加)する時刻t1までに、誘導モータ2の2次磁束Φ2dを98%以上まで立ち上げることができる(励磁電流0%から100%への変化時)。また、設定値(t1−t0)を時定数τの7倍程度の時間に設定すると、時刻t1までに誘導モータ2の2次磁束Φ2dを約100%まで立ち上げることができる(励磁電流0%から100%への変化時)。
なお、設定部12は、設定値(t1−t0)を、使用する誘導モータによらず固定値に設定してもよい。
【0042】
事前検知部10は、動作プログラムを先読みして、速度指令の変化(増加)、すなわち誘導モータ2の2次磁束を増加させる必要がある動作指令の変化を事前に検知する。本実施形態では、事前検知部10は、現在から速度指令の変化(増加)までの時間が設定部12で設定された設定値以下である速度指令の変化(増加)を検知する。換言すれば、事前検知部10は、設定部12で設定された変更タイミングを経過するときに、速度指令の変化(増加)を検知する。事前検知部10は、検知結果を示す検知信号を事前変更部20に送信する。
【0043】
事前変更部20は、検知信号が示す検知結果に基づいて、事前検知部10で速度指令の変化(増加)が検知された場合に、速度指令の変化(増加)に先行して磁束指令又は励磁電流指令を増加させることにより、誘導モータ2の2次磁束を増加させる。
例えば、事前変更部20は、図1A及び図2Aに示すように、電流制御部230における磁束指令発生部231に変更指令を行う。これにより、磁束指令発生部231は、図5に示すように、速度指令の変化(増加)に先行して磁束指令を増加する。
また、事前変更部20は、図1A及び図2Bに示すように、電流制御部230における励磁電流指令発生部241に変更指令を行う。これにより、励磁電流指令発生部241は、図5に示すように、速度指令の変化(増加)に先行して励磁電流指令を増加する。
【0044】
なお、本実施形態では、図1Bに示すように、主軸制御部200が、事前検知部10、設定部12及び記憶部11を備えてもよい。
【0045】
次に、図6を参照して、第1実施形態に係るモータ制御装置1による先読み動作について説明する。
【0046】
まず、事前検知部10は、動作プログラムを先読みして(S1)、現在から速度指令の変化(増加)までの時間を計測し(S2)、計測した時間が設定部12で設定された設定値以下であるか否かを判定する(S3)。
【0047】
計測した時間が設定値以下である場合、すなわち、事前検知部10が速度指令の変化(増加)を事前に検知した場合、事前変更部20は、磁束指令又は励磁電流指令を増加させ、誘導モータ2の2次磁束を増加させる(S4)。
【0048】
一方、計測した時間が設定値よりも長い場合、すなわち、事前検知部10が速度指令の変化(増加)を検知したがまだ早い場合、或いは、事前検知部10が速度指令の変化(増加)を検知しない場合、先読み動作を終了する。
【0049】
モータ制御装置1は、例えば設定部12で設定された設定値よりも十分に短い時間間隔で、上述したステップS1〜S4の動作を繰り返す。
【0050】
以上説明したように、第1実施形態のモータ制御装置1によれば、動作プログラムを先読みして速度指令の変化(増加)を事前に検知し、速度指令の変化(増加)に先行して磁束指令又は励磁電流指令を増加させ、誘導モータ2の2次磁束を増加させる。これにより、誘導モータの発熱の低減のために誘導モータ2の軽負荷時に磁束弱め制御を行っても、速度指令の変化(増加)時には、誘導モータ2の2次磁束を十分に立ち上げることができ、十分なトルクを得られ、加速時間を短縮できる。
このように、第1実施形態のモータ制御装置1によれば、誘導モータ2の軽負荷時の磁束弱め制御による誘導モータ2の発熱の低減と、速度指令の変化(増加)時の誘導モータ2の加速時間の短縮、すなわち制御の高い応答性との両立を図ることができる。
【0051】
(第2実施形態)
第1実施形態では、速度指令に基づく速度制御において加速動作を行うモータ制御装置について説明した。第2実施形態では、速度指令に基づく速度制御と位置指令に基づく位置制御との制御モード切換を行うモータ制御装置について説明する。
【0052】
図7Aは、第2実施形態に係るモータ制御装置の構成の一例を示す図である。図7Aに示すモータ制御装置1Aは、図1Aに示すモータ制御装置1において数値制御部100及び主軸制御部200に代えて数値制御部100A及び主軸制御部200Aを備える。
【0053】
数値制御部100Aは、動作プログラム(加工プログラム)に基づいて、速度指令に基づく速度制御モードと位置指令に基づく位置制御モードとの制御モードの切り換えを行う。速度制御モード時、数値制御部100Aは、主軸の回転速度を制御するための速度指令vcmdを生成し、主軸制御部200に供給する。また、位置制御モード時、数値制御部100Aは、主軸の回転位置を制御するための位置指令Pcmdを生成し、主軸制御部200に供給する。
【0054】
主軸制御部200Aは、速度制御モード時、数値制御部100Aからの速度指令vcmdに従って、誘導モータ2を駆動制御する。また、主軸制御部200Aは、位置制御モード時、数値制御部100Aからの位置指令Pcmdに従って、誘導モータ2を駆動制御する。主軸制御部200Aは、図1Aに示す主軸制御部200において位置制御部210と制御切換部212とを更に備える。
【0055】
位置制御部210は、数値制御部100Aからの位置指令Pcmdと、誘導モータ2に設けられたエンコーダ3で検出された誘導モータ2の位置(回転位置)のフィードバックPaとの差分に基づいて速度指令vcmdを生成する。
【0056】
制御切換部212は、例えば数値制御部100からの制御モード切換信号に基づいて、位置制御部210からの速度指令vcmdと数値制御部100からの速度指令vcmdとを切り換える。具体的には、制御切換部212は、速度制御モード時、数値制御部100からの速度指令vcmdを速度制御部220に供給する。また、制御切換部212は、位置制御モード時、位置制御部210からの速度指令vcmdを速度制御部220に供給する。
【0057】
上述したように、速度指令に基づく速度制御時、モータ制御装置1は、誘導モータ2の発熱低減のため、誘導モータ2の負荷が軽く高トルクが必要とされない場合(軽負荷時)には、誘導モータ2の2次磁束(励磁電流)を小さく制御する(磁束弱め制御)。
一方、位置指令に基づく位置制御では軽負荷時でも高い応答性が求められるため、軽負荷時の磁束指令又は励磁電流指令を大きく設定する。例えば、図2Aに示す電流制御部230では、磁束指令発生部231により、図8に示すように、トルク指令によらず常に磁束指令を100%に設定する。また、図2Bに示す電流制御部230では、励磁電流指令発生部241により、図8に示すように、トルク指令によらず常に励磁電流指令を100%に設定する。
【0058】
例えば、停止状態(軽負荷時)の速度制御モードにおいて磁束弱め制御により磁束指令又は励磁電流指令を30%にしているときに速度制御モードから位置制御モードに切り換えると、磁束指令又は励磁電流指令は30%から100%に変化する。このとき、図4に示すように、実際の2次磁束Φ2dは、励磁電流I1d、すなわち磁束指令又は励磁電流指令に対して時定数τ=L/Rで遅れて立ち上がる。
【0059】
上述したように、誘導モータ2のトルクTは、上式(3)に示すように2次磁束Φ2dとトルク電流(q相電流)I1qの積で表される。
そのため、図9Aに示すように、速度制御モードから位置制御モードへ制御モードが変更する場合、磁束指令又は励磁電流指令を増加した直後(時刻t1直後)は、2次磁束Φ2dが十分に立ち上がっていないために十分なトルクを出力することができず、位置制御の応答性が低下してしまう。
そのため、制御モード切換時、2次磁束が十分に立ち上がるまで待ってから動作を開始する必要があった(時刻t2)。制御モード切換時に毎回この待ち時間が発生すると、加工時間が長くなってしまう。
【0060】
この点に関し、制御モード切換時に磁束指令又は励磁電流指令を100%以上に大きくすることで2次磁束の立ち上がりを早める技術がある(磁束増幅、磁束ブースト)(特許文献2参照)。
例えば、図2Aに示す電流制御部230では、磁束指令発生部231により、図9Bに示すように、磁束指令30%の速度制御モードから磁束指令100%の位置制御モードに切り換えるときに、所定時間だけ磁束指令を例えば200%に増幅する(時刻t1)。また、図2Bに示す電流制御部230では、励磁電流指令発生部241により、図9Bに示すように、励磁電流指令30%の速度制御モードから励磁電流指令100%の位置制御モードに切り換えるときに、所定時間だけ励磁電流指令を例えば200%に増幅する(時刻t1)。これにより、2次磁束の立ち上がりを早め、位置制御の動作開始を早めることができる(時刻t2)。
しかし、励磁電流を急激に変化させることで生じるトルク変動が静止摩擦力よりも大きくなってしまい、励磁電流増幅時に誘導モータ2が動いてしまうという問題がある。
【0061】
そこで、本実施形態でも、図10に示すように、動作プログラムを先読みして速度指令から位置指令への動作指令の変更(制御モード切換信号)を事前に検知し、速度指令から位置指令へ動作指令が変更する時刻t1までに2次磁束が十分に立ち上がるように、時刻t1よりも所定時間だけ早い時刻t0において磁束指令又は励磁電流指令を増加させる。
【0062】
具体的には、図7Aに示すように、数値制御部100Aは、図1Aに示す数値制御部100と同様に、事前検知部10、記憶部11及び設定部12を備える。また、主軸制御部200Aは、図1Aに示す主軸制御部200と同様に、事前変更部20を備える。
【0063】
事前検知部10は、動作プログラムを先読みして、速度指令から位置指令への動作指令の変更、すなわち誘導モータ2の2次磁束を増加させる必要がある動作指令の変化を事前検知する。本実施形態では、事前検知部10は、現在から動作指令の変更までの時間が設定部12で設定された設定値以下である動作指令の変更を検知する。換言すれば、事前検知部10は、設定部12で設定された変更タイミングを経過するときに、速度指令から位置指令への動作指令の変更を検知する。事前検知部10は、検知結果を示す検知信号を事前変更部20に送信する。
【0064】
事前変更部20は、検知信号が示す検知結果に基づいて、事前検知部10で速度指令から位置指令への動作指令の変更が事前に検知された場合に、速度指令から位置指令への動作指令の変更に先行して磁束指令又は励磁電流指令を増加させることにより、誘導モータ2の2次磁束を増加させる。
例えば、事前変更部20は、図7A及び図2Aに示すように、電流制御部230における磁束指令発生部231に変更指令を行う。これにより、磁束指令発生部231は、図10に示すように、速度指令から位置指令への動作指令の変更に先行して磁束指令を増加する。
また、事前変更部20は、図7A及び図2Bに示すように、電流制御部230における励磁電流指令発生部241に変更指令を行う。これにより、励磁電流指令発生部241は、図10に示すように、速度指令から位置指令への動作指令の変更に先行して励磁電流指令を増加する。
【0065】
なお、本実施形態でも、図7Bに示すように、主軸制御部200Aが、事前検知部10、記憶部11及び設定部12を備えてもよい。
【0066】
次に、図11を参照して、第2実施形態に係るモータ制御装置1Aによる先読み動作について説明する。
【0067】
まず、事前検知部10は、動作プログラムを先読みして(S1)、現在から、速度指令から位置指令への動作指令の変更までの時間を計測し(S12)、計測した時間が設定部12で設定された設定値以下であるか否かを判定する(S3)。
【0068】
計測した時間が設定値以下である場合、すなわち、事前検知部10が速度指令から位置指令への動作指令の変更を事前に検知した場合、事前変更部20は、磁束指令又は励磁電流指令を増加させ、誘導モータ2の2次磁束を増加させる(S4)。
【0069】
一方、計測した時間が設定値よりも長い場合、すなわち、事前検知部10が速度指令から位置指令への動作指令の変更を検知したがまだ早い場合、或いは、事前検知部10が速度指令から位置指令への動作指令の変更を検知しない場合、先読み動作を終了する。
【0070】
モータ制御装置1Aは、例えば設定部12で設定された設定値よりも十分に短い時間間隔で、上述したステップS1,S12,S3及びS4の動作を繰り返す。
【0071】
以上説明したように、第2実施形態のモータ制御装置1Aによれば、動作プログラムを先読みして速度指令から位置指令への動作指令の変更を事前に検知し、速度指令から位置指令への変更に先行して磁束指令又は励磁電流指令を増加させ、誘導モータ2の2次磁束を増加させる。これにより、速度制御時に、誘導モータの発熱の低減のために誘導モータ2の軽負荷時に磁束弱め制御を行っても、速度制御から位置制御への制御モード切換時には、誘導モータ2の2次磁束を十分に立ち上げることができ、十分なトルクを得られ、加速時間を短縮できる。
このように、第2実施形態のモータ制御装置1Aによれば、誘導モータ2の軽負荷時の磁束弱めによる誘導モータ2の発熱の低減と、速度指令から位置指令への動作指令の変更時の誘導モータ2の位置制御の高い応答性との両立を図ることができる。
【0072】
また、第2実施形態のモータ制御装置1Aによれば、磁束増幅(磁束ブースト)技術を使用する必要がないので、速度指令から位置指令への動作指令の変更時に誘導モータ2が動くことがない。
【0073】
以上、本発明の実施形態について説明したが、本発明は上述した実施形態に限定されることなく、種々の変更及び変形が可能である。
【符号の説明】
【0074】
1,1A モータ制御装置
2 誘導モータ
3 エンコーダ
10 事前検知部
11 記憶部
12 設定部
20 事前変更部
100,100A 数値制御部
200,200A 主軸制御部
210 位置制御部
212 制御切換部
220 速度制御部
230 電流制御部
231 磁束指令発生部
232,235,238 減算器
233 磁束制御部
234 磁束推定部
236 励磁電流制御部
237 トルク電流指令発生部
239 トルク電流制御部
240 2相−3相変換部
241 励磁電流指令発生部
300 駆動部
310 電流検出器
図1A
図1B
図2A
図2B
図3
図4
図5
図6
図7A
図7B
図8
図9A
図9B
図10
図11