特許 7585846 モータ制御装置

(19)【発行国】日本国特許庁(JP)

(12)【公報種別】特許公報(B2)

(11)【特許番号】

(24)【登録日】2024-11-11

(45)【発行日】2024-11-19

(54)【発明の名称】モータ制御装置

(51)【国際特許分類】

   H02P 21/22 20160101AFI20241112BHJP

   H02P 6/16 20160101ALI20241112BHJP

   H02P 21/18 20160101ALI20241112BHJP

【ＦＩ】

H02P21/22

H02P6/16

H02P21/18

【請求項の数】 6

(21)【出願番号】P 2021021210

(22)【出願日】2021-02-12

(65)【公開番号】P2022123717

(43)【公開日】2022-08-24

【審査請求日】2023-12-12

(73)【特許権者】

【識別番号】000002945

【氏名又は名称】オムロン株式会社

(74)【代理人】

【識別番号】110002860

【氏名又は名称】弁理士法人秀和特許事務所

(72)【発明者】

【氏名】海田 僧太

(72)【発明者】

【氏名】福原 仁

(72)【発明者】

【氏名】大野 悌

【審査官】池田 貴俊

(56)【参考文献】

【文献】国際公開第２０１８／１５４６２１（ＷＯ，Ａ１）

【文献】国際公開第２０１７／０２６０６１（ＷＯ，Ａ１）

【文献】特開２０００－１９１２４８（ＪＰ，Ａ）

(58)【調査した分野】(Int.Cl.，ＤＢ名)

Ｈ０２Ｐ ２１／２２

Ｈ０２Ｐ ６／１６

Ｈ０２Ｐ ２１／１８

(57)【特許請求の範囲】

【請求項1】

所定の偏荷重が掛かるように構成された制御軸用のモータを駆動制御するモータ制御装置であって、
前記モータの可動子の動作に関連するフィードバック信号が入力される複数の制御器を含むフィードバック系を有する制御部と、
前記モータの磁極位置の検出処理が行われる前において、制動装置による前記可動子の制動状態を解消させたときに前記フィードバック系により得られる前記フィードバック信号に基づいて、前記偏荷重と該モータの固定子から可動子が受ける駆動力を釣り合わせるように、前記制御部を介して該モータに制御電流を印加する処理部と、
を備える、モータ制御装置。

【請求項2】

前記処理部は、前記フィードバック系により得られる前記可動子の速度情報に基づいて前記制御電流を印加する、
請求項１に記載のモータ制御装置。

【請求項3】

前記処理部は、前記複数の制御器に含まれる速度制御器に対して前記可動子を停止させるための速度指令が入力された状態で、該可動子の速度情報に基づいて前記制御電流を印加する、
請求項２に記載のモータ制御装置。

【請求項4】

前記可動子の速度情報は、該可動子の速度、及び移動方向に関する情報を含む、
請求項２又は請求項３に記載のモータ制御装置。

【請求項5】

前記処理部により前記偏荷重と前記駆動力とが釣り合うまでに、前記可動子の速度が所定速度を超えた場合、前記制動装置により該可動子に対して制動力を付与する、
請求項１から請求項４の何れか１項に記載のモータ制御装置。

【請求項6】

前記モータは、永久磁石同期型の回転モータ、又は永久磁石同期型のリニアモータである、
請求項１から請求項５の何れか１項に記載のモータ制御装置。

【発明の詳細な説明】

【技術分野】

【0001】

本発明は、モータ制御装置に関する。

【背景技術】

【0002】

永久磁石同期モータは、高効率、省スペース等の利点を有することから普及が進んでおり、回転モータのみならずリニアモータとしても広く利用されている。永久磁石同期型の回転モータは、永久磁石を有する可動子（回転子）の磁極位置に応じた電圧を印加しないとトルクを発生できない等の問題があるので、磁極位置を正確に把握することが重要である。また、永久磁石型のリニアモータでは、一般的には固定子側に永久磁石を配置するが、回転モータの場合と同じように、可動子と固定子との相関において磁極位置を適切に把握して電圧印加を行わなければならない。周知のように、エンコーダを用いれば、その出力信号である位置信号に基づいてモータの速度及び磁極位置を演算することが可能であるが、インクリメンタルエンコーダを用いる場合には、電源投入時は初期磁極位置が不明であるため、この初期磁極位置を正確に検出して安定に起動する必要がある。

【0003】

また、モータの可動子に偏荷重が掛かっている場合、当該偏荷重により可動子が変位してしまうため偏荷重による影響を考慮して磁極位置の検出を行わなければならない。例えば、特許文献１に開示されている装置では、同期モータの電機子コイルに流す励磁電流によって決まる界磁位相の基準位相を中心に４種類の位相の電流を印加し、それぞれでのロータの角速度に基づいてモータの磁極位置が算出される。

【先行技術文献】

【特許文献】

【0004】

【文献】特開２００２－２４７８８１号公報

【文献】特開２０１９－９２２７１号公報

【発明の概要】

【発明が解決しようとする課題】

【0005】

偏荷重が作用する制御軸においてモータの磁極位置を検出する場合、その偏荷重がモータの可動子に作用して変位することを考慮した上で検出処理を行わなければ、正確な磁極位置の検出が困難となる。上記の特許文献１に示す技術によれば、４種類の電流印加を行い、それぞれにおいてロータの角速度を検出する必要があるため、電流印加を切り替える度にブレーキ等の制動手段で制動力を利かせる必要がある。そのため、磁極位置の検出に際して制動手段を制御しなければならず、検出に要する労力は小さくはない。

【0006】

本発明は、このような問題に鑑みてなされたものであり、偏荷重が掛かるように構成された制御軸用のモータの磁極位置の検出を容易に実現し得る技術を提供することを目的とする。

【課題を解決するための手段】

【0007】

本発明の一側面に係るモータ制御装置は、所定の偏荷重が掛かるように構成された制御軸用のモータを駆動制御するモータ制御装置であって、前記モータの可動子の動作に関連するフィードバック信号が入力される複数の制御器を含むフィードバック系を有する制御部と、前記モータの磁極位置の検出処理が行われる前において、制動装置による前記可動子の制動状態を解消させたときに前記フィードバック系により得られる前記フィードバック信号に基づいて、前記偏荷重と該モータの固定子から可動子が受ける駆動力を釣り合わせるように、前記制御部を介して該モータに制御電流を印加する処理部と、を備える。

【0008】

上記モータ制御装置の制御部は、複数の制御器を含むフィードバック系を有しており、これらの制御器によってモータのサーボ制御が実現される。当該フィードバック系は特定の形態のものに限定されない。複数の制御器には、モータへの駆動電流を供給するインバータ等の電力変換器への電圧指令を生成する電流制御器や、電流制御器より上位側の制御器として、位置制御器や速度制御器が含まれてもよい。

【0009】

ここで、モータの可動子の制動状態を解消させた時点では、まだモータの磁極位置は検出されていない。そして、制動状態が解消されると偏荷重の作用により、モータの可動子が所定の方向に変位し続けることになる。そこで、所定の偏荷重を受ける場において、フィードバック系により得られるフィードバック信号を利用することで、変位している可動子を停止させるべくモータの固定子と可動子との間に駆動力を発生させるために、モータへの制御電流の印加処理が処理部によって行われる。なお、この時点ではモータの磁極位置の検出は行われていないため、モータ制御装置が暫定的に保持する磁極位置を前提として上記制御電流の印加が行われればよい。

【0010】

上記電流制御の印加処理によれば、磁極位置の検出がまだ行われていない状態であっても、フィードバック信号を利用することで可動子側に発生させる磁極を、釣り合いに適した状態に速やかに形成することができる。そのため、可動子と固定子との間に、可動子を止めるための引力又は斥力を速やかに発生させ、磁極位置の検出処理に適した状況、すなわち検出処理を行う際に可動子に作用する偏荷重の影響を可及的に排除した状況を形成でき、その検出に要する労力を軽減できる。更に、偏荷重が作用する制御軸においては、制動状態の解消後は偏荷重により可動子が特定の方向に変位し続ける状態になるため、上記のように速やかに釣り合い状態を形成することで、可動子の好ましくない変位（例えば、垂直軸での自由落下）を好適に回避することができる。なお、上記電流制御の印加処理により釣り合い状態が形成されれば、周知の磁極位置の検出技術や、本願で開示する新規な磁極位置の検出技術を適用することができる。

【0011】

ここで、上記モータ制御装置において、前記処理部は、前記フィードバック系により得られる前記可動子の速度情報に基づいて前記制御電流を印加してもよい。この場合、前記処理部は、前記複数の制御器に含まれる速度制御器に対して前記可動子を停止させるための速度指令が入力された状態で、該可動子の速度情報に基づいて前記制御電流を印加してもよい。また、前記可動子の速度情報は、該可動子の速度、及び移動方向に関する情報を含んでもよい。このように速度情報を利用する形態に代えて、もしくは速度情報とともに、例えば、フィードバック系により得られる可動子の位置情報や加速度情報を利用して、制御電流を印加するようにしてもよい。

【0012】

ここで、上述までのモータ制御装置において、前記処理部により前記偏荷重と前記駆動力とが釣り合うまでに、前記可動子の速度が所定速度を超えた場合、前記制動装置により該可動子に対して制動力を付与してもよい。このような構成を採用することで、何らかの理由で偏荷重の影響により可動子の速度が過度に上昇した場合、再度制動力を付与することで、可動子を停止させ安全を保つことができる。

【0013】

また、上述までのモータ制御装置に係る技術思想は、永久磁石同期型の回転モータ、永久磁石同期型のリニアモータの何れにも適用することができる。

【発明の効果】

【0014】

偏荷重が掛かるように構成された制御軸用のモータの磁極位置の検出を容易に実現することができる。

【図面の簡単な説明】

【0015】

【図1】本発明の実施形態に係るサーボドライバを含むサーボシステムの概略構成を示す図である。

【図2】サーボドライバが有するフィードバック系の制御構造を示す図である。

【図3】サーボドライバが有する電流制御器の制御構造を示す図である。

【図4】垂直軸において、ブレーキの解放後、可動子の釣り合い状態を形成するための方法の説明図である。

【図5】本発明のサーボドライバによるモータの磁極位置の推定方法を説明するための第１の図である。

【図6】本発明のサーボドライバによるモータの磁極位置の推定方法を説明するための第２の図である。

【図7】本発明のサーボドライバによるモータの磁極位置の推定処理の流れを示すフローチャートである。

【図8】モータの磁極位置の推定処理において、制御電流の増加推移を示す図である。

【発明を実施するための形態】

【0016】

以下、本発明の実施の形態について、図面を参照しながら詳細に説明する。なお、図中同一または相当部分には同一符号を付して、その説明は繰り返さない。本開示では、サーボシステムの一つの例示的形態として、産業用システムを示す。しかしながら、本発明に係るサーボシステムの用途は特に限定されるものではない。なお、本願明細書で示される位相は、特段の記載がない場合は、電気角に基づくものである。

【0017】

＜実施例１＞
図１は、本発明の実施の形態に係るサーボドライバ４を含む制御システムの概略構成図である。制御システムは、ネットワーク１と、モータ２と、負荷装置３と、サーボドライバ４と、ＰＬＣ(Programmable Logic Controller)５とを備える。当該制御システムでは
、ＰＬＣ５で動作指令信号が生成され、それがネットワーク１を介してサーボドライバ４に届けられる。そして、サーボドライバ４は、その動作指令信号に従って制御対象とされる負荷装置３を駆動するように構成されたモータ２をサーボ制御する。ここで、負荷装置３としては、各種の機械装置（例えば、産業用ロボットのアームや搬送装置）が例示でき、モータ２はその負荷装置３を駆動するアクチュエータとして負荷装置３に取り付けられている。例えば、モータ２は、ＡＣサーボモータである。

【0018】

モータ２にはエンコーダ２１が取り付けられており、エンコーダ２１によりモータ２の動作に関するパラメータ信号がサーボドライバ４の制御部４０にフィードバック送信されている。エンコーダ２１は、インクリメンタル方式のエンコーダである。制御部４０にフィードバック送信されるパラメータ信号（以下、フィードバック信号という）は、たとえばモータ２の可動子位置についての位置情報、その可動子の速度の情報等を含む。また、モータ２は、負荷装置３における垂直軸（Ｚ軸）を駆動するためのアクチュエータであり、制動のためのブレーキ装置２２を備えている。なお、ブレーキ装置２２は、モータ２とは別体に、負荷装置３の垂直軸に対して制動力を付与するように構成されてもよい。ブレーキ２２の制動及びその解除は、図示しないブレーキ信号線を介してサーボドライバ４からの制御信号により実行される。

【0019】

また、サーボドライバ４の制御部４０は、ＰＬＣ５からの動作指令信号およびエンコーダ２１からのフィードバック信号に基づいてモータ２のサーボ制御を行い、インバータ６を介してモータ２に駆動電流を供給する。この供給電流は、交流電源７からインバータ６に対して送られる交流電力が利用される。本実施例では、インバータ６は三相交流を受けるタイプのものであるが、単相交流を受けるタイプのものでもよい。なお、サーボドライ
バ４の制御部４０は、位置制御器４１、速度制御器４２、電流制御器４３を含むフィードバック系を備えている。

【0020】

ここで、図２に基づいて、サーボドライバ４の制御部４０が有するフィードバック系の制御構造について説明する。制御部４０のフィードバック系は、位置制御器４１、速度制御器４２、電流制御器４３を備えている。位置制御器４１は、例えば、比例制御（Ｐ制御）を行う。具体的には、ＰＬＣ５からの位置指令Ｐ＿ｒｅｆとモータ２の位置現在値Ｐ＿ａｃｔとの偏差である位置偏差に、所定の位置比例ゲインを乗ずることにより速度指令Ｖ＿ｒｅｆを算出する。なお、位置現在値Ｐ＿ａｃｔは、エンコーダ２１の出力が位置検出器４５に入力されて得られる、モータ２の現在位置を意味するパラメータである。

【0021】

速度制御器４２は、例えば、比例積分制御（ＰＩ制御）を行う。具体的には、位置制御器４１により算出された速度指令Ｖ＿ｒｅｆとモータ２の速度現在値Ｖ＿ａｃｔとの偏差である速度偏差の積分量に所定の速度積分ゲインを乗じ、その算出結果と当該速度偏差の和に所定の速度比例ゲインを乗ずることにより、トルク指令τ＿ｒｅｆを算出する。また、速度制御器４２はＰＩ制御に代えてＰ制御を行ってもよい。なお、速度現在値Ｖ＿ａｃｔは、位置検出器４５の出力が速度検出器４６に入力されて得られる、モータ２の現在速度を意味するパラメータである。

【0022】

電流制御器４３は、速度制御器４２により算出されたトルク指令τ＿ｒｅｆと、モータ２の位置現在値Ｐ＿ａｃｔ及び速度現在値Ｖ＿ａｃｔと、インバータ６からモータ２に供給されている駆動電流とに基づいて電流指令を生成し、当該電流指令に基づいて三相交流モータの各相に対応する電圧指令をインバータ６に出力する。当該電圧指令を受けたインバータ６は、モータ２の各相（Ｕ相、Ｖ相、Ｗ相）に駆動電圧を印加しモータ２を駆動制御する。なお、モータ２に供給されている駆動電流は、電流検出器４４により検出される。図２においては、モータ２の各相に対応する構成は簡略化されて記載されているが、実際には電流検出器４４は、モータ２の各相の巻線に流れる電流を検出し、その各相の電流の値を電流制御器４３に返している。電流制御器４３は、トルク指令に関するフィルタ（１次のローパスフィルタ）や一又は複数のノッチフィルタを含んでもよい。

【0023】

次に、図３に基づいて、電流制御器４３において形成されている制御構造について説明する。電流制御器４３においてはベクトル制御が行われている。そこで、電流制御器４３に入力されたトルク指令τ＿ｒｅｆは、先ず電流指令演算器５１に入力される。電流指令演算器５１には、更にモータ２の速度現在値Ｖ＿ａｃｔが入力され、ｄ軸電流指令Ｉｄ＿ｒｅｆとｑ軸電流指令Ｉｑ＿ｒｅｆが生成される。そして、ｄ軸電流指令Ｉｄ＿ｒｅｆと、モータ２に現在流れているｄ軸電流Ｉｄとの偏差がｄ軸電流制御器５２に入力され、ｑ軸電流指令Ｉｑ＿ｒｅｆと、モータ２に現在流れているｑ軸電流Ｉｑとの偏差がｑ軸電流制御器５３に入力される。なお、モータ２に現在流れているｄ軸電流Ｉｄとｑ軸電流Ｉｑは、電流検出器４４によって検出されたモータ２のＵ相、Ｖ相、Ｗ相を流れる電流Ｉｕ、Ｉｖ、Ｉｗが電流座標変換器５６に入力され、そこでｄｑ変換処理を施すことで算出される。

【0024】

ｄ軸電流制御器５２は、モータ２の物性パラメータを考慮して、入力されたｄ軸電流の偏差から、ｄ軸に関する電圧指令Ｖｄを算出し、同じように、ｑ軸電流制御器５３は、モータ２の物性パラメータを考慮して、入力されたｑ軸電流の偏差から、ｑ軸に関する電圧指令Ｖｑを算出する。算出された電圧指令Ｖｄ、Ｖｑは電圧座標変換器５４に入力される。電圧座標変換器５４は、入力されたｄ軸に関する電圧指令とｑ軸に関する電圧指令に対して、ｄｑ軸から三相への変換処理を施し、モータ２の各相への印加電圧の電圧指令Ｖｕ、Ｖｖ、Ｖｗを生成する。これらの電圧指令はＰＷＭ演算部５５に引き渡され、そこでインバータ６への指令として形成され、インバータ６に送られる。

【0025】

このように構成されるサーボドライバ４において、その電源を一度ＯＦＦにし、その後、再び電源を投入したとき、モータ２のエンコーダ２１はインクリメンタル方式のエンコーダであるため、モータ２のサーボ制御を開始する前に、その磁極位置を検出しなければならない。磁極位置を正確に検出しなければモータ２の好適なサーボ制御が困難となり、また、一般的には、電源投入後には速やかで安全なモータ２の稼働が望まれる。そこで、モータ２の磁極位置の検出処理に要する時間を可及的に短くし、且つ、その検出処理の間にモータ２の出力軸の不要な動きを抑制できる磁極位置の検出処理の原理について、以下に説明する。

【0026】

ここで、図１に示すように、モータ２は負荷装置３の垂直軸を駆動するアクチュエータである。そのため、垂直軸における駆動対象の重力に起因する偏荷重がモータ２の出力軸に掛かっている。本実施形態では、偏荷重が鉛直方向に掛かるものとする。したがって、例えば、サーボドライバ４への電力供給が停止した状態から電力の供給を再開した時点、すなわち、サーボドライバ４の電源投入時においては、モータ２の磁極位置が正確に検出されていない状態、すなわち、サーボドライバ４が暫定的に保持しているｄ軸とq軸は、
モータ２の可動子（ロータ）に基づいて理論的に設定される軸とずれた状態となっている。そのため、モータ２の好適なサーボ制御のために、磁極位置の検出処理を行う必要がある。なお、磁極位置の検出処理は、電源投入時ではなく、電源投入後にユーザが必要とする任意のタイミングで行われてもよい。

【0027】

ここで、サーボドライバ４の電源がオフにされモータ２が停止している間、モータ２の出力軸を制動するためにブレーキ装置２２により所定の制動力が出力軸に付与されている。そして、モータ２をサーボ制御するためにサーボドライバ４の電源が投入されると、ブレーキ装置２２による制動状態が解除されるが、その場合、偏荷重が作用することで、負荷装置３における移動体（モータ２により駆動される物体）が鉛直方向に落下し、それに伴いモータ２の可動子が変位する。

【0028】

本実施形態の磁極位置の検出処理においては、ブレーキ装置２２による制動の解除後に、モータ２の可動子に掛かる偏荷重と、モータ２の固定子側から受ける駆動力（磁力）とが釣り合った状態で行われる。そこで、図４に基づいて、当該釣り合い状態を形成するための手法について説明する。図４は、ブレーキ装置２２による制動が解除され、偏荷重によりモータ２の可動子が変位を開始したときの、固定子に対する可動子の位置や姿勢を、時間の経過とともに重ねて模式的に記載したものである。図４において、固定子には永久磁石が設けられ、その磁極はＮ極とＳ極が交互に配置されている。一方で、可動子に形成される磁極は、巻線等のコイルにより制御可能に形成される。また、図４においては、本願開示を理解しやすくするために、モータ２の可動子と固定子を永久磁石同期型のリニアモータの形態に従って記載しているが、これにはモータ２として永久磁石同期型の回転モータを排除する意図は無い。モータ２が永久磁石同期型の回転モータであっても原理的には図４に示す形態で表現できることは、当業者であれば理解できる。

【0029】

ここで、図４の左側（ａ）には、従来技術の形態による釣り合い状態の形成の様子が示されている。従来技術においては、ブレーキ装置２２による制動が解除された後、可動子の巻線に流れる制御電流の位相は一定とされる。この場合、その磁極の向きは固定されたまま、偏荷重に従って可動子は固定子に対して変位していく。このとき、可動子の磁極と固定子の磁極とによって引力ｆ１が発生した状態が示されている。この引力ｆ１の垂直方向の分力をｆ１１、水平方向の分力をｆ１２とすると、分力ｆ１１は、偏荷重ｆ２に抗するように発生する。したがって、分力ｆ１１と偏荷重ｆ２が釣り合えば可動子を固定子に対して固定することができる。しかし、従来技術においては、可動子の磁極の向きが固定されているため、固定子側に発生する磁極との間で生じる引力や斥力によって可動子の動
きを止める状態を速やかに形成する機会が限られる。そのため、落下により可動子の速度が上昇すると必ずしも可動子を止めることができるわけではない。例えば、図４（ａ）に示す状態で、分力ｆ１１がｆ２より小さい場合、可動子は止まらず、偏荷重によって更に加速し落下していく。また、瞬時的に分力ｆ１１がｆ２と釣り合ったとしても、落下速度が大きくなると、速度の影響で可動子はすぐに止まることは困難であり、その結果、次の固定子側に引き込まれる位置まで落下し続けてしまうと、可動子の速度が更に上昇し、可動子を止めにくくなる。

【0030】

これに対して、本願開示では、図４の右側（ｂ）に示すように、ブレーキ装置２２による制動が解除された後、制御部４０のフィードバック系のフィードバック信号に基づいて、可動子の磁極の向きを好適にサーボ制御しながら、偏荷重に従って可動子は固定子に対して変位していく。具体的には、図２及び図３に示すフィードバック系において、速度指令Ｖ＿ｒｅｆとして速度０の信号を入力するとともに、フィードバックされる速度現在値Ｖ＿ａｃｔと速度指令Ｖ＿ｒｅｆに基づいて電流制御器４３による電流制御が行われ、可動子の巻線に制御電流が印加される。これにより、可動子と固定子との間に、可動子を止めるための引力又は斥力を速やかに発生させる。図４（ｂ）では、可動子の磁極と固定子の磁極とによって斥力ｆ３が発生した状態が示されている。この斥力ｆ３の垂直方向の分力をｆ３１、水平方向の分力をｆ３２とすると、分力ｆ３１は、偏荷重ｆ４に抗するように発生する。そして、分力ｆ３１と偏荷重ｆ４が釣り合えば可動子を固定子に対して固定することができる。図４（ｂ）の形態では、速やかに好適な引力又は斥力を発生させることができるため、図４（ａ）に示すように可動子の速度が大きく上昇してしまう前にその速度を効果的に低減させ、好適にモータ２の可動子に掛かる偏荷重と、モータ２の固定子側から受ける駆動力とを釣り合わせることができる。

【0031】

なお、上記の制御部４０のフィードバック系のフィードバック信号に基づいた可動子の磁極の向きの制御について、速度現在値Ｖ＿ａｃｔが利用されているが、当該速度現在値Ｖ＿ａｃｔは、可動子の速度及びその移動方向に関する情報を含んでいることは理解できる。また、可動子の速度に関する情報の他に、可動子の位置に関する情報（例えば、位置現在値Ｐ＿ａｃｔ）や可動子の加速度に関する情報（例えば、速度現在値Ｖ＿ａｃｔを更に微分して算出される値）も利用して可動子の磁極の向きの制御を行ってもよい。可動子の位置に関する情報を利用する場合には、位置指令Ｐ＿ｒｅｆとして固定位置とするための信号を入力し、可動子の加速度に関する情報を利用する場合には、トルク指令τ＿ｒｅｆとしてトルク０の信号を入力すればよい。

【0032】

図４（ｂ）に示すようにモータ２の可動子に掛かる偏荷重と、モータ２の固定子側から受ける駆動力とを釣り合わせることで、モータ２の磁極位置の検出処理を安定的に行うことができる。次に、図５及び図６に基づいて、モータ２の磁極位置の検出処理について説明する。図５において、モータ２の固定子側に設定された直交座標をα軸、β軸で表している。上述したフィードバック系による制御電流が印加されて、上記の釣り合い状態が形成されているときの、印加電流の電流指令をＩｒｅｆとする。この時点では、サーボドライバ４は図５に示すｄ軸及びｑ軸の正確な位置は把握しておらず、暫定的に保持している磁極情報に基づいて電流指令Ｉｒｅｆを出力している。

【0033】

図５においては、電流指令演算器５１によって生成された電流指令Ｉｒｅｆに対応する電流がベクトルＶ１で表されている。そして、ベクトルＶ１の方向をα’軸とし、それに直交する方向をβ’軸とする。また、α’軸とｄ軸とが為す角をθｂａｒとする。ここで、ベクトルＶ１のｄ軸成分のベクトルをＶ２とし、ｑ軸成分のベクトルをＶ３とすると、当該ベクトルＶ３で表されるｑ軸電流が、偏荷重と釣り合うための駆動力を発生させる電流成分となる。図５に示すベクトルの相関を見ると、ベクトルＶ１とベクトルＶ２の為す角θｂａｒを算出することで、電流指令Ｉｒｅｆの位相を基にｄ軸、ｑ軸の位置を検出可
能であることが理解できる。

【0034】

次に、図６では、図５に示すα’軸とβ’軸とによる直交座標に、改めてベクトルＶ１（電流指令Ｉｒｅｆに対応）、ベクトルＶ２（ｄ軸電流指令に対応）、ベクトルＶ３（ｑ軸電流指令に対応）を配置する。ここで、上記釣り合い状態の形成のためのフィードバック系による制御を維持した状態で、電流指令Ｉｒｅｆの位相を固定したままその指令値を増加させる。図６においては、増加された電流指令Ｉｒｅｆ’に対応する電流はベクトルＶ１０で表されている。このように制御部４０が有するフィードバック系により釣り合いを維持した状態で電流指令を増加させる処理を「第１処理」とする。

【0035】

ここで、第１処理により電流指令がＩｒｅｆからＩｒｅｆ’に増加されてもフィードバック系により釣り合い状態が維持されるため、モータ２の可動子が変位（回転）することになる。この回転について説明する。電流指令がＩｒｅｆ’に増加されると、偏荷重に対応するｑ軸電流を流すべくｑ軸電流指令Ｉｑ’が形成されるとともに、ｄ軸電流を流すべくｄ軸電流指令Ｉｄ’が一義的に形成される。ｄ軸電流指令Ｉｄ’及びｑ軸電流指令Ｉｑ’に対応する電流がそれぞれベクトルＶ２０、Ｖ３０で表されている。そして、ベクトルＶ２０はベクトルＶ２に対してΔθずれており、同じようにベクトルＶ３０はベクトルＶ３に対してΔθずれている。したがって、このベクトルのずれΔθ（電気角）に対応する分だけ、モータ２の可動子が変位することになる。

【0036】

そこで、第１処理により可動子が変位した変位量（上記のΔθに相当する）と、第１処理で増加された制御電流（上記のベクトルＶ１０による電流）とに基づいて、モータ２の磁極位置を算出する第２処理が行われる。上記の通り、モータ２の磁極位置は、θｂａｒを算出すればよい。具体的には、偏荷重への釣り合いの観点からベクトルＶ３とベクトルＶ３０の大きさは等しくなることから、下記の式１が成立する。

【数1】

・・・（式１）
そして、式１に基づいて、θｂａｒを導出する式２は下記の通りとなる。

【数2】

・・・（式２）
したがって、電流指令Ｉｒｅｆ、Ｉｒｅｆ’、変位量Δθに基づいて、式２からθｂａｒが算出できる。そして、電流指令Ｉｒｅｆの位相とθｂａｒに基づいて、モータ２の磁極位置を算出することができる。

【0037】

続いて、サーボドライバ４の電源投入時に実行されるモータ２の磁極位置の検出処理の流れについて、図７に基づいて説明する。図７に示す検出処理は、サーボドライバ４の電源投入時に、サーボドライバ４の制御部４０において所定の制御プログラムが実行されることで実現される。先ずＳ１０１では、モータ２が有するブレーキ装置２２に対して解除指令が送られ、ブレーキ装置２２による制動状態が解除される。この結果、モータ２の可動子に偏荷重が掛かることになり、その偏荷重による変位が生じ始める。そこで、続くＳ１０２では、図４（ｂ）に基づいて説明したように、制御部４０のフィードバック系において、速度指令Ｖ＿ｒｅｆとして速度０の信号を入力するとともに、フィードバックされ
る速度現在値Ｖ＿ａｃｔと速度指令Ｖ＿ｒｅｆに基づいて電流制御器４３による電流制御が行われる。この結果、モータ２に制御電流が印加され、速やかに可動子と固定子との間に可動子を停止させるための駆動力が生じる。

【0038】

ただし、何らかの理由で、上記駆動力によっても可動子の速度が十分に低減されなかった場合、可動子が可動範囲の端部まで落下して負荷装置３を破損させてしまう恐れがある。そこで、Ｓ１０３では、Ｓ１０２で行われている電流制御において可動子の速度が所定速度を超えたか否かが判定される。所定速度とは、上記駆動力によって可動子を停止させることが困難となる落下速度であり、事前の実験等によって適宜設定すればよい。そして、Ｓ１０３で肯定判定されると、処理はＳ１０７へ進み、ブレーキ装置２２を作動させてその制動力によって可動子を停止させ、本検出処理を終了する。一方で、Ｓ１０３で否定判定されるとＳ１０４へ進み、Ｓ１０４では、可動子に掛かる偏荷重と上記駆動力とが釣り合って、可動子が停止したか否かが判定される。当該釣り合いは、フィードバック系における速度現在値Ｖ＿ａｃｔを利用して判定できる。Ｓ１０４で肯定判定すると処理はＳ１０５へ進み、否定判定するとＳ１０２以降の処理が繰り返される。

【0039】

そして、Ｓ１０５では、上述した第１処理が行われ、続いてＳ１０６では、上述した第２処理が行われる。これらの処理の結果、負荷装置３において偏荷重が掛かる垂直軸を駆動するモータ２の磁極位置が正確に検出されることになる。また、第１処理及び第２処理による磁極位置の検出処理では、モータ２の可動子は上記Δθに対応する分だけしか変位しないため、磁極位置の検出処理に要する時間も短くできる。なお、上記の第１処理では、電流指令ＩｒｅｆをＩｒｅｆ’に増加させるが、その増加を急峻に行うと、モータ２の可動子のΔθの変位が振動的となり、モータ２の磁極位置の検出精度に好ましくない影響を及ぼし得る。そこで、第１処理における電流指令の増加（ＩｒｅｆからＩｒｅｆ’への増加）については、図８に示すように、所定の時定数Ｔｄで当該ＩｒｅｆからＩｒｅｆ’に至るように、電圧座標変換器５４から電圧指令を出力するようにすればよい。

【0040】

なお、本願の開示は、モータ２が永久磁石同期型の回転モータの場合、永久磁石同期型のリニアモータの場合の何れにも適用することができる。

【0041】

また、図４（ｂ）に基づいて説明した上記手法により、可動子に掛かる偏荷重と、可動子と固定子との間の駆動力とを釣り合わせる処理を行ったが、その釣り合い状態が形成された場合は、図５及び図６に基づいて説明した形態以外の、公知のモータの磁極位置の検出処理を採用することも可能である。

【0042】

＜付記１＞
所定の偏荷重が掛かるように構成された制御軸用のモータ（２）を駆動制御するモータ制御装置（４）であって、
前記モータの可動子の動作に関連するフィードバック信号が入力される複数の制御器を含むフィードバック系を有する制御部と、
前記モータの磁極位置の検出処理が行われる前において、制動装置（２２）による前記可動子の制動状態を解消させたときに前記フィードバック系により得られる前記フィードバック信号に基づいて、前記偏荷重と該モータの固定子から可動子が受ける駆動力を釣り合わせるように、前記制御部を介して該モータに制御電流を印加する処理部と、
を備える、モータ制御装置。

【符号の説明】

【0043】

２ モータ
３ 負荷装置
４ サーボドライバ
５ ＰＬＣ
６ インバータ
２１ エンコーダ
２２ ブレーキ装置
４１ 位置制御器
４２ 速度制御器
４３ 電流制御器

【図1】

【図2】

【図3】

【図4】

【図5】

【図6】

【図7】

【図8】