永久磁石同期電動機の永久磁石の不可逆減磁が発生したか否かを検出する制御装置
【課題】永久磁石同期電動機の駆動軸の動作範囲が制限された場合でも永久磁石同期電動機の磁石の不可逆減磁が発生したか否かを適切に検出することができる制御装置を提供する。
【解決手段】正弦波状指令信号生成部１７は、永久磁石同期電動機３へのトルク指令に対する正弦波状指令信号を生成する。推定トルク定数計算部２３は、正弦波状指令信号の複数周期に亘る同一の動作状態での複数の電流値と複数の加速度値から取得した電流代表値及び加速度代表値と、永久磁石同期電動機３に関連する予め設定されたイナーシャとから、永久磁石同期電動機３に関連する推定トルク定数を計算する。減磁検出部２４は、推定トルク定数と永久磁石同期電動機３に関連する予め設定されたトルク定数との差分に基づいて、永久磁石同期電動機３の永久磁石３４ａ，３４ｂ，３４ｃ，３４ｄに不可逆減磁が発生したか否かを検出する。
【解決手段】正弦波状指令信号生成部１７は、永久磁石同期電動機３へのトルク指令に対する正弦波状指令信号を生成する。推定トルク定数計算部２３は、正弦波状指令信号の複数周期に亘る同一の動作状態での複数の電流値と複数の加速度値から取得した電流代表値及び加速度代表値と、永久磁石同期電動機３に関連する予め設定されたイナーシャとから、永久磁石同期電動機３に関連する推定トルク定数を計算する。減磁検出部２４は、推定トルク定数と永久磁石同期電動機３に関連する予め設定されたトルク定数との差分に基づいて、永久磁石同期電動機３の永久磁石３４ａ，３４ｂ，３４ｃ，３４ｄに不可逆減磁が発生したか否かを検出する。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、工作機械等においてワークや工具のような被駆動体を動作させる永久磁石同期電動機の永久磁石の不可逆減磁が発生したか否かを検出する制御装置に関する。
【背景技術】
【０００２】
従来、ステータとロータのうちのいずれか一方に永久磁石が設けられた回転型サーボモータ、ステータとスライダのうちのいずれか一方に永久磁石が設けられたリニアサーボモータ、ステータとバイブレータのうちのいずれか一方に永久磁石が設けられた振動型サーボモータ等の永久磁石同期電動機が、種々の分野で広く用いられている。
【０００３】
永久磁石同期電動機において、永久磁石同期電動機の永久磁石の異常な温度上昇、永久磁石同期電動機の巻線に流れる異常な駆動電流等が原因で永久磁石同期電動機の永久磁石に不可逆減磁が発生することがある。
【０００４】
この場合、永久磁石電動機が所定のトルクを生成することができないので、永久磁石動機電動機によって動作する被駆動体の実際の移動軌跡は、ＣＮＣ（数値制御装置）等の上位制御装置によって指令される被駆動体の移動軌跡から外れ、軌跡精度の悪化や、場合によっては被駆動体の破損を引き起こす可能性がある。
【０００５】
したがって、永久磁石電動機の永久磁石の不可逆減磁が原因で引き起こされる加減速能力の低下による軌跡精度の悪化や、場合によっては被駆動体の破損を回避するためには、永久磁石同期電動機の永久磁石の不可逆減磁が発生したか否かを検出する必要がある。
【０００６】
従来、永久磁石同期電動機の永久磁石の不可逆減磁を検出するために、永久磁石動機電動機の被駆動体の算出イナーシャと、永久磁石電動機に固有の既定イナーシャとを、永久磁石電動機のロータの回転角度に基づいて検出された磁極位置ごとに比較して、減磁が生じている永久磁石の位置を特定する制御装置が提案されている（例えば、特許文献１）。
【先行技術文献】
【特許文献】
【０００７】
【特許文献１】特許第３８５７４４２５号公報
【発明の概要】
【発明が解決しようとする課題】
【０００８】
しかしながら、従来の制御装置では、算出イナーシャと既定イナーシャとを永久磁石の位置ごとに比較するので、永久磁石電動機のロータを少なくとも１電気角以上回転させる必要がある。したがって、工作機械等において永久磁石同期電動機を用いて被駆動物を円弧運動させる場合のように、永久磁石同期電動機の駆動軸の動作範囲が制限され、永久磁石電動機のロータを１電気角以上回転させることができないときには、永久磁石同期電動機の永久磁石の不可逆減磁の位置を特定することができない。さらに従来の制御装置では、イナーシャを推定することで間接的に減磁を検出している。この場合、トルク定数と検出電流の積を、検出加速度で割ることで算出するが、一般に加速度は速度の差分から求めるためノイズが入りやすく、除算による誤差を含みやすい。よって、加速度が小さい場合には演算精度が大きく悪化する場合があった。
【０００９】
本発明の目的は、永久磁石同期電動機の駆動軸の動作範囲が制限された場合でも永久磁石同期電動機の永久磁石の不可逆減磁が発生したか否かを適切に検出することができる制御装置を提供することである。さらに、トルク定数を推定することで、減磁を直接的に検出する。この場合、イナーシャと検出加速度の積を、検出電流で割って求めるので、除算による誤差を含みにくいので精度的に優れた制御装置を提供できる。
【課題を解決するための手段】
【００１０】
本発明による制御装置は、永久磁石同期電動機への位置指令信号、速度指令信号及びトルク指令信号のうちのいずれか一つに対する正弦波状指令信号を生成する正弦波状指令信号生成部と、前記永久磁石同期電動機に流れる電流値を取得する電流値取得部と、前記永久磁石同期電動機の加速度値を取得する加速度値取得部と、前記正弦波状指令信号の複数周期に亘る同一の動作状態での複数の前記電流値と複数の前記加速度値から取得した電流代表値及び加速度代表値と、前記永久磁石同期電動機に関連する予め設定されたイナーシャとから、前記永久磁石同期電動機に関連する推定トルク定数を計算する推定トルク定数計算部と、前記推定トルク定数と前記永久磁石同期電動機に関連する予め設定されたトルク定数との差分に基づいて、前記永久磁石同期電動機の永久磁石に不可逆減磁が発生したか否かを検出する減磁検出部と、を備える。
【００１１】
好適には、本発明による制御装置は、前記永久磁石同期電動機の速度値又は速度の極性に応じた摩擦を計算する摩擦計算部と、前記摩擦に応じて前記電流値を補正した補正電流値を生成する補正電流値生成部と、を更に備える。
【００１２】
好適には、本発明による制御装置は、前記永久磁石同期電動機に流れる電流値のオフセット成分を除去するオフセット成分除去部を更に備える。
【００１３】
好適には、前記減磁検出部は、前記差分を複数の減磁レベルと比較し、前記永久磁石同期電動機の永久磁石に不可逆減磁が発生した場合にアラームを生成し又は前記永久磁石同期電動機の動作を制限するために、前記差分と前記複数の減磁レベルとの比較結果を出力する。
【００１４】
好適には、前記減磁検出部は、前記推定トルク定数及び前記予め設定されたトルク定数に基づいて前記永久磁石同期電動機のトルク定数の減少率を計算し、前記減少率に基づいて前記永久磁石同期電動機の速度ゲインを変更する減少率計算及び速度ゲイン変更部を有する。
【発明の効果】
【００１５】
本発明によれば、正弦波状指令信号の複数周期に亘る同一の動作状態での複数の電流値と複数の加速度値から取得した電流代表値及び加速度代表値と、永久磁石同期電動機に関連する予め設定されたイナーシャとから、永久磁石同期電動機に関連する推定トルク定数を計算し、推定トルク定数と永久磁石同期電動機に関連する予め設定されたトルク定数との差分に基づいて、永久磁石同期電動機の永久磁石に不可逆減磁が発生したか否かを検出する。これによって、永久磁石同期電動機は、推定トルク定数計算時に正弦波状指令信号に応じた周期動作を短時間行うことになるので、推定トルク定数計算時の永久磁石同期電動機の動作範囲を小さくすることができる。このように永久磁石同期電動機の動作範囲を小さくすることができるので、永久磁石電動機のロータを１電気角以上回転させる必要がなくなる。したがって、永久磁石同期電動機の駆動軸の動作範囲が制限された場合でも永久磁石同期電動機のロータの磁石の不可逆減磁を適切に検出することができる。
【図面の簡単な説明】
【００１６】
【図１】本発明の第１の実施の形態の制御装置を有するシステムのブロック図である。
【図２】本発明の第１の実施の形態の制御装置の動作のフローチャートである。
【図３】本発明の第２の実施の形態の制御装置を有するシステムのブロック図である。
【図４】本発明の第３の実施の形態の制御装置を有するシステムのブロック図である。
【発明を実施するための形態】
【００１７】
本発明による制御装置の実施の形態を、図面を参照しながら説明する。なお、図面中、同一構成要素には同一符号を付す。
図１は、本発明の第１の実施の形態の制御装置を有するシステムのブロック図である。図１において、制御装置１は、制御装置１に接続されたＣＮＣ（数値制御装置）等の上位制御装置２からの作業工程に応じた指令信号に基づいて、永久磁石同期電動機３の位置、速度、トルク等を制御する。制御装置１の制御により、永久磁石同期電動機３に接続されたテーブル、アーム、それらに着脱されるワーク等の被駆動体４が所定の運動（例えば、円弧運動）を行うようになる。
【００１８】
制御装置１が永久磁石同期電動機３の位置、速度、トルク等を制御するために、永久磁石同期電動機３の速度（回転速度）を検出し、検出した速度を制御装置１に供給する検出器５を設ける。検出器５を、例えば、永久磁石同期電動機３の速度に比例したパルスを生成するエンコーダとする。
【００１９】
永久磁石同期電動機３は、例えば、工作機械においてワークを保持するテーブルの位置や姿勢を変えるためのもの、ロボットのアームを回転操作させるもの等であってもよい。本実施の形態では、永久磁石同期電動機３を、検出器５が取り付けられた回転軸３１を有するロータ３２と、ロータ３２を取り囲むように配置されたステータ３３とを有する回転型サーボモータとする。
【００２０】
ロータ３２は、９０°間隔で配置された４個の永久磁石３４ａ，３４ｂ，３４ｃ，３４ｄを有する。永久磁石３４ａ，３４ｂ，３４ｃ，３４ｄは、ステータ３３側の端部がロータ３２の回転方向に対して互いに９０°ずつ離れるとともに、永久磁石３４ａ，３４ｂ，３４ｃ，３４ｄの外側の端部が交互にＮ極、Ｓ極、Ｎ極及びＳ極となるように配置される。
【００２１】
ステータ３３は、１２０°間隔で配置され、Ｕ相、Ｖ相及びＷ相の交流電流がそれぞれ供給される３個のコイル３５ｕ，３５ｖ，３５ｗを有する。したがって、永久磁石同期電動機３は、３相同期電動機として機能する。
【００２２】
本実施の形態によれば、制御装置１は、後に詳細に説明するように、永久磁石３４ａ，３４ｂ，３４ｃ，３４ｄに不可逆減磁が発生したか否かを検出し、不可逆減磁が発生したか否かについての検出結果を上位制御装置２に出力し、上位制御装置２は、永久磁石３４ａ，３４ｂ，３４ｃ，３４ｄに不可逆減磁が発生した場合にアラームを生成し又は永久磁石同期電動機３の動作を制限する。また、本実施の形態では、後に詳細に説明するように、上位制御装置２は、アラームを生成するためにＬＥＤ等のランプ６を点灯させ、永久磁石同期電動機３の動作を停止させる。
【００２３】
制御装置１は、位置制御部１１と、速度制御部１２と、加算器１３と、電流制御部１４と、アンプ１５と、正弦波指令信号周波数設定部１６と、正弦波指令信号生成部１７と、電流値取得部１８と、速度値取得部１９と、サンプリングデータ記憶部２０と、加速度取得部２１と、既知データ記憶部２２と、推定トルク２３と、減磁検出部２４と、を備える。
【００２４】
なお、制御装置１の各部及び上位制御装置２は、便宜上別個の構成として示しているが、別個のハードウェアに対応するものでなくてもよく、各部間の明確な区分を持たないハードウェアによって実現されるものであってもソフトウェアによって実現されるものであってもよい。なお、ソフトウェアによって実現される場合、各部を、別個のソフトウェア部分として構成することもできるが、各部間の明確な区分を持たないソフトウェアによって実現されるものであってもよい。
【００２５】
位置制御部１１は、設定された位置ゲインに基づいて、上位制御装置２からの位置指令信号と、検出器５からの速度のフィードバック信号を積分することによって生成される位置のフィードバック信号とに応じた動作を行う。速度制御部１２は、設定された速度ゲインに基づいて、位置制御部１１からの速度指令信号と、検出器５からの速度のフィードバック信号とに応じた動作を行う。加算器１３は、一方の入力部に入力される速度制御部１２からのトルク指令信号と、他方の入力部に入力される後述する正弦波状指令信号とを加算し、加算器１３の出力信号を電流制御部１４に供給する。
【００２６】
電流制御部１４は、加算器１３の出力信号と、アンプ１５からの電流のフィードバック信号とに応じた動作を行う。アンプ１５は、アンプ１５に入力される電流制御部１４の出力信号に応じて、永久磁石同期電動機３への供給電力を制御する。本実施の形態において、電流のフィードバック信号とは、３相同期電動機として機能する永久磁石同期電動機３の３相電流フィードバックをサンプリングし、検出器５によって取得される位相情報を用いて、３相交流電流値から２相交流電流値にｄｑ変換した結果の有効電流であるｑ相電流フィードバックを意味する。
【００２７】
正弦波状指令信号周波数設定部１６は、正弦波状指令信号生成部１７が生成する正弦波状指令信号の周波数を所定の周波数（例えば、１０Ｈｚ）に設定する。正弦波状指令信号生成部１７は、正弦波状指令信号周波数設定部１６によって設定された周波数を有する正弦波状指令信号を、加算器１３の他方の入力部に供給する。
【００２８】
電流値取得部１８は、アンプ５からの電流フィードバックの信号を電流値として所定のサンプリング周期Ｔ（例えば、Ｔ＝１０ミリ秒）で取得し、電流フィードバック値としてサンプリングデータ記憶部２０に記憶させる。速度値取得部１９は、検出器５からの速度フィードバックの信号を速度値として所定のサンプリング周期Ｔ（例えば、Ｔ＝１０ミリ秒）で取得し、速度フィードバック値としてサンプリングデータ記憶部２０に記憶させる。
【００２９】
加速度値取得部２１は、サンプリングデータ記憶部２０に記憶された速度フィードバック値から加速度値を計算し、計算した加速度値をサンプリングデータ記憶部２０に記憶させる。本実施の形態では、加速度値取得部２１は、今回のサンプリングで取得した速度フィードバック値ｖ（ｎ）と前回のサンプリングで取得した速度フィードバック値ｖ（ｎ−１）との差分から加速度値ａ＝（Ｖ（ｎ）−ｖ（ｖｎ−１））／Ｔを計算する。
【００３０】
既知データ記憶部２２には、永久磁石３４ａ，３４ｂ，３４ｃ，３４ｄに不可逆減磁が発生したか否かを検出するための基準となる少なくとも一つの減磁レベルと、永久磁石同期電動機３に関連する予め設定されたトルク定数、すなわち、永久磁石同期電動機３の実際のトルク定数又は被駆動体４を取り付けた永久磁石同期電動機３の実際のトルク定数と、永久磁石同期電動機３に関連する予め設定されたイナーシャ、すなわち、永久磁石同期電動機３の実際のイナーシャ又は永久磁石同期電動機３の実際のイナーシャと被駆動体４の実際のイナーシャとの和に相当するイナーシャが記憶されている。
【００３１】
本実施の形態では、既知データ記憶部２２には、減磁レベル１と、減磁レベル１より低い減磁レベル２と、被駆動体４を取り付けた永久磁石同期電動機３の実際のトルク定数Ｋｔと、永久磁石同期電動機３の実際のイナーシャと被駆動体４の実際のイナーシャとの和に相当するイナーシャＪが記憶されている。
【００３２】
推定トルク定数計算部２３は、正弦波状指令信号生成部１７によって生成された正弦波状指令波形の数周期分（例えば、２０周期分）について、サンプリングデータ記憶部２０に記憶された電流フィードバック値の最大値及び最小値を抽出する。すなわち、正弦波状指令信号に応じてトルク指令信号値を周期変動させることによって、正弦波指令信号の周期ごとに電流フィードバック値に最大ピーク及び最小ピークが生じるので、推定トルク定数計算部２３は、最大ピークの値及び最小ピークの値を抽出する。
【００３３】
電流フィードバック値の最大値及び最小値の抽出後、推定トルク計算部２３は、電流フィードバック値の最大値の平均値である平均Ｉｍａｘ及び電流フィードバック値の最小値の平均値である平均Ｉｍｉｎを求める。そして、推定トルク計算部２３は、電流フィードバック値の最大値の絶対値及び電流フィードバック信号の最小値の絶対値の平均をとった平均電流Ｉを電流代表値として求める。したがって、平均電流Ｉは、（｜平均Ｉｍａｘ｜＋｜平均Ｉｍｉｎ｜）／２となる。
【００３４】
同様に、推定トルク定数計算部２３は、正弦波状指令信号生成部１７によって生成された正弦波状指令波形の数周期分（例えば、２０周期分）について、サンプリングデータ記憶部２０に記憶された加速度値の最大値及び最小値を抽出する。すなわち、正弦波状指令信号に応じてトルク指令信号値を周期変動させることによって、正弦波指令信号の周期ごとに加速度値に最大ピーク及び最小ピークが生じるので、推定トルク定数計算部２３は、最大ピークの値及び最小ピークの値を抽出する。
【００３５】
加速度値の最大値及び最小値の抽出後、推定トルク計算部２３は、加速度値の最大値の平均値である平均Ａｍａｘ及び加速度値の最小値の平均値である平均Ａｍｉｎを求める。そして、推定トルク計算部２３は、加速度値の最大値の絶対値及び加速度信号の最小値の絶対値の平均をとった平均加速度ａを加速度代表値として求める。したがって、平均加速度ａは、（｜平均Ａｍａｘ｜＋｜平均Ａｍｉｎ｜）／２となる。
【００３６】
なお、正弦波状指令信号に応じた電流フィードバック値及び加速度値を抽出するので、速度制御部１２から出力されるトルク指令信号がゼロでない場合には、推定トルク計算部２３は、その影響分を補正する。
【００３７】
平均電流Ｉ及び平均加速度ａを求めた後、推定トルク計算部２３は、推定トルク定数Ｋｓを、Ｋｓ＝Ｊ・ａ／Ｉの式に従って求める。その後、減磁検出部２４は、推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分を求め、推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル１より大きいか否か及び推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル２より大きいか否かを判断する。
【００３８】
推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル１より大きい場合、減磁検出部２４は、推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル１より大きい旨の情報を比較結果として上位制御装置２に供給し、上位制御装置２は、永久磁石同期電動機３の動作を制限する。本実施の形態では、推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル１より大きい場合、上位制御装置２は、アンプ１５の電源をオフにし、永久磁石同期電動機３の動作を停止させる。
【００３９】
推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル１より小さいが減磁レベル２より大きい場合、減磁検出部２４は、推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル１より小さいが減磁レベル２より大きい旨の情報を比較結果として上位制御装置２に供給し、上位制御装置２は、アラームを生成する。本実施の形態では、推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル１より小さいが減磁レベル２より大きい場合、上位制御装置２は、ランプ６を点灯させる。
【００４０】
図２は、本発明の第１の実施の形態の制御装置の動作のフローチャートである。このフローチャートは、上位制御装置２からの減磁検出処理の起動指令信号を制御装置１が受信した後に実行される。
【００４１】
ステップＳ１において、正弦波状指令信号生成部１７は、正弦波状指令信号を生成する。次に、ステップＳ２において、電流値取得部１８が電流フィードバックの信号を電流値として取得するとともに、速度値取得部１９が速度フィードバックの信号を速度値として取得する。
【００４２】
次に、ステップＳ３において、推定トルク計算部２３は、指定された周期Ｔが経過したか否か判断する。指定された周期Ｔが経過していない場合、ステップＳ２に戻る。それに対し、指定された周期Ｔが経過した場合、ステップＳ４において、推定トルク計算部２３は、正弦波状指令信号の複数周期としての周期Ｔに亘る同一の動作状態（例えば、被駆動体４の円弧運動）での複数の電流値と複数の加速度値から取得した電流代表値としての平均電流Ｉ及び加速度代表値としての平均加速度ａを取得する。
【００４３】
次に、ステップＳ５において、推定トルク定数計算部２３は、推定トルク定数Ｋｓを、Ｋｓ＝Ｊ・ａ／Ｉの式に従って求める。次に、ステップＳ６において、減磁検出部２４は、推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル１より大きいか否かを判断する。
【００４４】
推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル１より大きい場合、ステップＳ７において、減磁検出部２４は、推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル１より大きい旨の情報を比較結果として上位制御装置２に供給し、上位制御装置２は、アンプ１５の電源をオフにし、永久磁石同期電動機３の動作を停止させ、処理を終了する。
【００４５】
推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル１以下である場合、ステップＳ８において、減磁検出部２４は、推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル２より大きいか否かを判断する。推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル２より大きい場合、ステップＳ９において、減磁検出部２４は、推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル１より小さいが減磁レベル２より大きい旨の情報を比較結果として上位制御装置２に供給し、上位制御装置２は、ランプ６を点灯させ、処理を終了する。なお、推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル２以下である場合、そのまま処理を終了する。
【００４６】
本実施の形態によれば、永久磁石同期電動機３は、推定トルク定数計算時に正弦波状指令信号に応じた周期動作を短時間行うことになるので、推定トルク定数計算時の永久磁石同期電動機３の動作範囲を小さくすることができる。このように永久磁石同期電動機３の動作範囲を小さくすることができるので、ロータ３２を１回以上回転させる必要がなくなる。したがって、円弧動作のように駆動軸３１の動作範囲が制限された場合でも磁石３４ａ，３４ｂ，３４ｃ，３４ｄの不可逆減磁を適切に検出することができる。
【００４７】
また、複数周期に亘る電流フィードバックの信号及び速度フィードバックの信号を用いるので、複数周期間での平均化によってノイズの影響を軽減することができる。さらに、複数の減磁レベルを設定することによって、減磁レベルに応じた対策を講じることができるので、安全性が向上する。
【００４８】
図３は、本発明の第２の実施の形態の制御装置を有するシステムのブロック図である。図３において、制御装置１’は、図１の制御装置１の構成要素の他に、摩擦計算部２５と、補正電流値生成部２６と、オフセット成分除去部２７と、を更に備える。
【００４９】
摩擦計算部２５は、速度値取得部１９で取得した速度値又は速度の極性に応じた摩擦（粘性摩擦及びクーロン摩擦）を計算する。補正電流値生成部２６は、摩擦計算部２５で計算した摩擦に応じて、電流値取得部１８で取得した電流値を補正し、補正電流値を生成する。オフセット成分除去部２７は、補正電流値生成部２６で生成した補正電流値のオフセット成分を除去する。なお、オフセット成分除去部２７は、例えば、ハイパスフィルタによって構成される。
【００５０】
なお、摩擦計算部２５による摩擦の計算、補正電流値生成部２６による補正電流値の生成及びオフセット成分除去部２７による補正電流値のオフセット成分の除去は、図２のフローチャートのステップＳ４で行われる。
【００５１】
永久磁石同期電動機３に重力等の一定の力が加わる場合、永久磁石同期電動機３に流れる電流値にオフセット成分が生じるが、本実施の形態によれば、電流値のオフセット成分をオフセット成分除去部２７で除去することによって、推定トルク定数計算部２３による推定トルク定数Ｋｓの計算精度が向上する。また、本実施の形態によれば、摩擦計算部２５で計算した摩擦に応じて、電流値取得部１８で取得した電流値を補正しているので、推定トルク定数計算部２３による推定トルク定数Ｋｓの計算精度が更に向上する。
【００５２】
図４は、本発明の第３の実施の形態の制御装置を有するシステムのブロック図である。図４において、制御装置１”は、図１の制御装置１の構成要素の他に、減少率計算及び速度ゲイン変更部２８を更に備える。
【００５３】
減少率計算及び速度ゲイン変更部２８は、減少率σをσ＝Ｋｓ／Ｋｔの式に従って計算し、減少率σに基づいて永久磁石同期電動機３の速度ゲインを変更する。例えば、減少率計算及び速度ゲイン変更部２８は、速度積分ゲインＫ１及び速度比例ゲインＫ２を、Ｋ１＝Ｋ１／σおよびＫ２＝Ｋ２／σの式に従ってそれぞれ変更する。
【００５４】
なお、減少率計算及び速度ゲイン変更部２８による減少率σの計算及び速度ゲインの変更は、図２のフローチャートのステップＳ９で行われる。
【００５５】
本実施の形態によれば、推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が比較的小さい場合、例えば、推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル１より小さいが減磁レベル２より大きい場合、速度ゲインを変更することによって、永久磁石同期電動機３の動作を安定化することができる。速度ゲインは実際のトルク定数Ｋｔに反比例するので、推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が比較的小さい場合、推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分に反比例するように速度ゲインを大きくすることによって、永久磁石同期電動機３の動作を安定化することができる。
【００５６】
本発明は、上記実施の形態に限定されるものではなく、幾多の変更及び変形が可能である。例えば、上記実施の形態において、永久磁石同期電動機３として、ロータ３２に永久磁石３４ａ，３４ｂ，３４ｃ，３４ｄが設けられた回転型サーボモータを用いた場合について説明したが、ステータに永久磁石が設けられた回転型サーボモータ、ステータとスライダのうちのいずれか一方に永久磁石が設けられたリニアサーボモータ、ステータとバイブレータのうちのいずれか一方に永久磁石が設けられた振動型サーボモータ等を、永久磁石同期電動機３として用いることができる。
【００５７】
また、上記実施の形態において、正弦波状指令信号をトルク指令信号に加算する場合について説明したが、正弦波状指令信号を、トルク指令信号に加算する代わりに位置指令信号又は速度指令信号に加算することができる。なお、永久磁石同期電動機３を含めた被駆動体の剛性が高い場合には、正弦波状指令信号をトルク指令信号に加算するのが好ましく、この場合トルク指令信号の周波数は高くできる。周波数を高くできると大きな加速度が得られるので精度が向上し、またロータの回転角度が小さくでき、さらに推定時間が短くできる。一方、剛性が低い場合は、バックラッシやばね等のロストモーションの影響で、推定精度が悪化する。そこで信号周波数を低くする必要があるが、信号周波数を低くすると速度制御、位置制御の影響で十分な加速が得られなくなる。この場合、位置指令信号又は速度指令信号に加算するのが好ましい。
【００５８】
また、上記実施の形態において、正弦波状指令信号の周期ごとの電流フィードバック値の最大値の絶対値及び電流フィードバック信号の最小値の絶対値を複数周期間で平均化した平均電流Ｉを電流代表値として求めるとともに、周期ごとの加速度値の最大値の絶対値及び加速度信号の最小値の絶対値を複数周期間で平均化した平均加速度ａを加速度代表値として求める場合について説明したが、電流代表値及び加速度代表値は、これらに限定されない。例えば、正弦波状指令信号の複数周期間に亘る電流フィードバック値の絶対値を積算したものを電流代表値として求めるとともに、正弦波状指令信号の複数周期間に亘る加速度フィードバック値の絶対値を積算したものを加速度代表値として求めることもできる。
【００５９】
さらに、アラームを生成するためにランプ６を用いる場合について説明したが、アラームを生成するために液晶ディスプレイ（ＬＥＤ）、ブザー等を用いることもできる。
【符号の説明】
【００６０】
１，１’，１” 制御装置
２ 上位制御装置
３ 磁石同期電動機
４ 被駆動体
５ 検出器
６ ランプ
１１ 位置制御部
１２ 速度制御部
１３ 加算器
１４ 電流制御部
１５ アンプ
１６ 正弦波状指令信号周波数設定部
１７ 正弦波状指令信号生成部
１８ 電流値取得部
１９ 速度値取得部
２０ サンプリングデータ記憶部
２１ 加速度取得部
２２ 既知データ記憶部
２３ 推定トルク定数計算部
２４ 減磁検出部
２５ 摩擦計算部
２６ 補正電流値生成部
２７ オフセット成分除去部
２８ 減少率計算及び速度ゲイン変更部
３１ 回転軸
３２ ロータ
３３ ステータ
３４ａ，３４ｂ，３４ｃ，３４ｄ 永久磁石
３５ｕ，３５ｖ，３５ｗ コイル
【技術分野】
【０００１】
本発明は、工作機械等においてワークや工具のような被駆動体を動作させる永久磁石同期電動機の永久磁石の不可逆減磁が発生したか否かを検出する制御装置に関する。
【背景技術】
【０００２】
従来、ステータとロータのうちのいずれか一方に永久磁石が設けられた回転型サーボモータ、ステータとスライダのうちのいずれか一方に永久磁石が設けられたリニアサーボモータ、ステータとバイブレータのうちのいずれか一方に永久磁石が設けられた振動型サーボモータ等の永久磁石同期電動機が、種々の分野で広く用いられている。
【０００３】
永久磁石同期電動機において、永久磁石同期電動機の永久磁石の異常な温度上昇、永久磁石同期電動機の巻線に流れる異常な駆動電流等が原因で永久磁石同期電動機の永久磁石に不可逆減磁が発生することがある。
【０００４】
この場合、永久磁石電動機が所定のトルクを生成することができないので、永久磁石動機電動機によって動作する被駆動体の実際の移動軌跡は、ＣＮＣ（数値制御装置）等の上位制御装置によって指令される被駆動体の移動軌跡から外れ、軌跡精度の悪化や、場合によっては被駆動体の破損を引き起こす可能性がある。
【０００５】
したがって、永久磁石電動機の永久磁石の不可逆減磁が原因で引き起こされる加減速能力の低下による軌跡精度の悪化や、場合によっては被駆動体の破損を回避するためには、永久磁石同期電動機の永久磁石の不可逆減磁が発生したか否かを検出する必要がある。
【０００６】
従来、永久磁石同期電動機の永久磁石の不可逆減磁を検出するために、永久磁石動機電動機の被駆動体の算出イナーシャと、永久磁石電動機に固有の既定イナーシャとを、永久磁石電動機のロータの回転角度に基づいて検出された磁極位置ごとに比較して、減磁が生じている永久磁石の位置を特定する制御装置が提案されている（例えば、特許文献１）。
【先行技術文献】
【特許文献】
【０００７】
【特許文献１】特許第３８５７４４２５号公報
【発明の概要】
【発明が解決しようとする課題】
【０００８】
しかしながら、従来の制御装置では、算出イナーシャと既定イナーシャとを永久磁石の位置ごとに比較するので、永久磁石電動機のロータを少なくとも１電気角以上回転させる必要がある。したがって、工作機械等において永久磁石同期電動機を用いて被駆動物を円弧運動させる場合のように、永久磁石同期電動機の駆動軸の動作範囲が制限され、永久磁石電動機のロータを１電気角以上回転させることができないときには、永久磁石同期電動機の永久磁石の不可逆減磁の位置を特定することができない。さらに従来の制御装置では、イナーシャを推定することで間接的に減磁を検出している。この場合、トルク定数と検出電流の積を、検出加速度で割ることで算出するが、一般に加速度は速度の差分から求めるためノイズが入りやすく、除算による誤差を含みやすい。よって、加速度が小さい場合には演算精度が大きく悪化する場合があった。
【０００９】
本発明の目的は、永久磁石同期電動機の駆動軸の動作範囲が制限された場合でも永久磁石同期電動機の永久磁石の不可逆減磁が発生したか否かを適切に検出することができる制御装置を提供することである。さらに、トルク定数を推定することで、減磁を直接的に検出する。この場合、イナーシャと検出加速度の積を、検出電流で割って求めるので、除算による誤差を含みにくいので精度的に優れた制御装置を提供できる。
【課題を解決するための手段】
【００１０】
本発明による制御装置は、永久磁石同期電動機への位置指令信号、速度指令信号及びトルク指令信号のうちのいずれか一つに対する正弦波状指令信号を生成する正弦波状指令信号生成部と、前記永久磁石同期電動機に流れる電流値を取得する電流値取得部と、前記永久磁石同期電動機の加速度値を取得する加速度値取得部と、前記正弦波状指令信号の複数周期に亘る同一の動作状態での複数の前記電流値と複数の前記加速度値から取得した電流代表値及び加速度代表値と、前記永久磁石同期電動機に関連する予め設定されたイナーシャとから、前記永久磁石同期電動機に関連する推定トルク定数を計算する推定トルク定数計算部と、前記推定トルク定数と前記永久磁石同期電動機に関連する予め設定されたトルク定数との差分に基づいて、前記永久磁石同期電動機の永久磁石に不可逆減磁が発生したか否かを検出する減磁検出部と、を備える。
【００１１】
好適には、本発明による制御装置は、前記永久磁石同期電動機の速度値又は速度の極性に応じた摩擦を計算する摩擦計算部と、前記摩擦に応じて前記電流値を補正した補正電流値を生成する補正電流値生成部と、を更に備える。
【００１２】
好適には、本発明による制御装置は、前記永久磁石同期電動機に流れる電流値のオフセット成分を除去するオフセット成分除去部を更に備える。
【００１３】
好適には、前記減磁検出部は、前記差分を複数の減磁レベルと比較し、前記永久磁石同期電動機の永久磁石に不可逆減磁が発生した場合にアラームを生成し又は前記永久磁石同期電動機の動作を制限するために、前記差分と前記複数の減磁レベルとの比較結果を出力する。
【００１４】
好適には、前記減磁検出部は、前記推定トルク定数及び前記予め設定されたトルク定数に基づいて前記永久磁石同期電動機のトルク定数の減少率を計算し、前記減少率に基づいて前記永久磁石同期電動機の速度ゲインを変更する減少率計算及び速度ゲイン変更部を有する。
【発明の効果】
【００１５】
本発明によれば、正弦波状指令信号の複数周期に亘る同一の動作状態での複数の電流値と複数の加速度値から取得した電流代表値及び加速度代表値と、永久磁石同期電動機に関連する予め設定されたイナーシャとから、永久磁石同期電動機に関連する推定トルク定数を計算し、推定トルク定数と永久磁石同期電動機に関連する予め設定されたトルク定数との差分に基づいて、永久磁石同期電動機の永久磁石に不可逆減磁が発生したか否かを検出する。これによって、永久磁石同期電動機は、推定トルク定数計算時に正弦波状指令信号に応じた周期動作を短時間行うことになるので、推定トルク定数計算時の永久磁石同期電動機の動作範囲を小さくすることができる。このように永久磁石同期電動機の動作範囲を小さくすることができるので、永久磁石電動機のロータを１電気角以上回転させる必要がなくなる。したがって、永久磁石同期電動機の駆動軸の動作範囲が制限された場合でも永久磁石同期電動機のロータの磁石の不可逆減磁を適切に検出することができる。
【図面の簡単な説明】
【００１６】
【図１】本発明の第１の実施の形態の制御装置を有するシステムのブロック図である。
【図２】本発明の第１の実施の形態の制御装置の動作のフローチャートである。
【図３】本発明の第２の実施の形態の制御装置を有するシステムのブロック図である。
【図４】本発明の第３の実施の形態の制御装置を有するシステムのブロック図である。
【発明を実施するための形態】
【００１７】
本発明による制御装置の実施の形態を、図面を参照しながら説明する。なお、図面中、同一構成要素には同一符号を付す。
図１は、本発明の第１の実施の形態の制御装置を有するシステムのブロック図である。図１において、制御装置１は、制御装置１に接続されたＣＮＣ（数値制御装置）等の上位制御装置２からの作業工程に応じた指令信号に基づいて、永久磁石同期電動機３の位置、速度、トルク等を制御する。制御装置１の制御により、永久磁石同期電動機３に接続されたテーブル、アーム、それらに着脱されるワーク等の被駆動体４が所定の運動（例えば、円弧運動）を行うようになる。
【００１８】
制御装置１が永久磁石同期電動機３の位置、速度、トルク等を制御するために、永久磁石同期電動機３の速度（回転速度）を検出し、検出した速度を制御装置１に供給する検出器５を設ける。検出器５を、例えば、永久磁石同期電動機３の速度に比例したパルスを生成するエンコーダとする。
【００１９】
永久磁石同期電動機３は、例えば、工作機械においてワークを保持するテーブルの位置や姿勢を変えるためのもの、ロボットのアームを回転操作させるもの等であってもよい。本実施の形態では、永久磁石同期電動機３を、検出器５が取り付けられた回転軸３１を有するロータ３２と、ロータ３２を取り囲むように配置されたステータ３３とを有する回転型サーボモータとする。
【００２０】
ロータ３２は、９０°間隔で配置された４個の永久磁石３４ａ，３４ｂ，３４ｃ，３４ｄを有する。永久磁石３４ａ，３４ｂ，３４ｃ，３４ｄは、ステータ３３側の端部がロータ３２の回転方向に対して互いに９０°ずつ離れるとともに、永久磁石３４ａ，３４ｂ，３４ｃ，３４ｄの外側の端部が交互にＮ極、Ｓ極、Ｎ極及びＳ極となるように配置される。
【００２１】
ステータ３３は、１２０°間隔で配置され、Ｕ相、Ｖ相及びＷ相の交流電流がそれぞれ供給される３個のコイル３５ｕ，３５ｖ，３５ｗを有する。したがって、永久磁石同期電動機３は、３相同期電動機として機能する。
【００２２】
本実施の形態によれば、制御装置１は、後に詳細に説明するように、永久磁石３４ａ，３４ｂ，３４ｃ，３４ｄに不可逆減磁が発生したか否かを検出し、不可逆減磁が発生したか否かについての検出結果を上位制御装置２に出力し、上位制御装置２は、永久磁石３４ａ，３４ｂ，３４ｃ，３４ｄに不可逆減磁が発生した場合にアラームを生成し又は永久磁石同期電動機３の動作を制限する。また、本実施の形態では、後に詳細に説明するように、上位制御装置２は、アラームを生成するためにＬＥＤ等のランプ６を点灯させ、永久磁石同期電動機３の動作を停止させる。
【００２３】
制御装置１は、位置制御部１１と、速度制御部１２と、加算器１３と、電流制御部１４と、アンプ１５と、正弦波指令信号周波数設定部１６と、正弦波指令信号生成部１７と、電流値取得部１８と、速度値取得部１９と、サンプリングデータ記憶部２０と、加速度取得部２１と、既知データ記憶部２２と、推定トルク２３と、減磁検出部２４と、を備える。
【００２４】
なお、制御装置１の各部及び上位制御装置２は、便宜上別個の構成として示しているが、別個のハードウェアに対応するものでなくてもよく、各部間の明確な区分を持たないハードウェアによって実現されるものであってもソフトウェアによって実現されるものであってもよい。なお、ソフトウェアによって実現される場合、各部を、別個のソフトウェア部分として構成することもできるが、各部間の明確な区分を持たないソフトウェアによって実現されるものであってもよい。
【００２５】
位置制御部１１は、設定された位置ゲインに基づいて、上位制御装置２からの位置指令信号と、検出器５からの速度のフィードバック信号を積分することによって生成される位置のフィードバック信号とに応じた動作を行う。速度制御部１２は、設定された速度ゲインに基づいて、位置制御部１１からの速度指令信号と、検出器５からの速度のフィードバック信号とに応じた動作を行う。加算器１３は、一方の入力部に入力される速度制御部１２からのトルク指令信号と、他方の入力部に入力される後述する正弦波状指令信号とを加算し、加算器１３の出力信号を電流制御部１４に供給する。
【００２６】
電流制御部１４は、加算器１３の出力信号と、アンプ１５からの電流のフィードバック信号とに応じた動作を行う。アンプ１５は、アンプ１５に入力される電流制御部１４の出力信号に応じて、永久磁石同期電動機３への供給電力を制御する。本実施の形態において、電流のフィードバック信号とは、３相同期電動機として機能する永久磁石同期電動機３の３相電流フィードバックをサンプリングし、検出器５によって取得される位相情報を用いて、３相交流電流値から２相交流電流値にｄｑ変換した結果の有効電流であるｑ相電流フィードバックを意味する。
【００２７】
正弦波状指令信号周波数設定部１６は、正弦波状指令信号生成部１７が生成する正弦波状指令信号の周波数を所定の周波数（例えば、１０Ｈｚ）に設定する。正弦波状指令信号生成部１７は、正弦波状指令信号周波数設定部１６によって設定された周波数を有する正弦波状指令信号を、加算器１３の他方の入力部に供給する。
【００２８】
電流値取得部１８は、アンプ５からの電流フィードバックの信号を電流値として所定のサンプリング周期Ｔ（例えば、Ｔ＝１０ミリ秒）で取得し、電流フィードバック値としてサンプリングデータ記憶部２０に記憶させる。速度値取得部１９は、検出器５からの速度フィードバックの信号を速度値として所定のサンプリング周期Ｔ（例えば、Ｔ＝１０ミリ秒）で取得し、速度フィードバック値としてサンプリングデータ記憶部２０に記憶させる。
【００２９】
加速度値取得部２１は、サンプリングデータ記憶部２０に記憶された速度フィードバック値から加速度値を計算し、計算した加速度値をサンプリングデータ記憶部２０に記憶させる。本実施の形態では、加速度値取得部２１は、今回のサンプリングで取得した速度フィードバック値ｖ（ｎ）と前回のサンプリングで取得した速度フィードバック値ｖ（ｎ−１）との差分から加速度値ａ＝（Ｖ（ｎ）−ｖ（ｖｎ−１））／Ｔを計算する。
【００３０】
既知データ記憶部２２には、永久磁石３４ａ，３４ｂ，３４ｃ，３４ｄに不可逆減磁が発生したか否かを検出するための基準となる少なくとも一つの減磁レベルと、永久磁石同期電動機３に関連する予め設定されたトルク定数、すなわち、永久磁石同期電動機３の実際のトルク定数又は被駆動体４を取り付けた永久磁石同期電動機３の実際のトルク定数と、永久磁石同期電動機３に関連する予め設定されたイナーシャ、すなわち、永久磁石同期電動機３の実際のイナーシャ又は永久磁石同期電動機３の実際のイナーシャと被駆動体４の実際のイナーシャとの和に相当するイナーシャが記憶されている。
【００３１】
本実施の形態では、既知データ記憶部２２には、減磁レベル１と、減磁レベル１より低い減磁レベル２と、被駆動体４を取り付けた永久磁石同期電動機３の実際のトルク定数Ｋｔと、永久磁石同期電動機３の実際のイナーシャと被駆動体４の実際のイナーシャとの和に相当するイナーシャＪが記憶されている。
【００３２】
推定トルク定数計算部２３は、正弦波状指令信号生成部１７によって生成された正弦波状指令波形の数周期分（例えば、２０周期分）について、サンプリングデータ記憶部２０に記憶された電流フィードバック値の最大値及び最小値を抽出する。すなわち、正弦波状指令信号に応じてトルク指令信号値を周期変動させることによって、正弦波指令信号の周期ごとに電流フィードバック値に最大ピーク及び最小ピークが生じるので、推定トルク定数計算部２３は、最大ピークの値及び最小ピークの値を抽出する。
【００３３】
電流フィードバック値の最大値及び最小値の抽出後、推定トルク計算部２３は、電流フィードバック値の最大値の平均値である平均Ｉｍａｘ及び電流フィードバック値の最小値の平均値である平均Ｉｍｉｎを求める。そして、推定トルク計算部２３は、電流フィードバック値の最大値の絶対値及び電流フィードバック信号の最小値の絶対値の平均をとった平均電流Ｉを電流代表値として求める。したがって、平均電流Ｉは、（｜平均Ｉｍａｘ｜＋｜平均Ｉｍｉｎ｜）／２となる。
【００３４】
同様に、推定トルク定数計算部２３は、正弦波状指令信号生成部１７によって生成された正弦波状指令波形の数周期分（例えば、２０周期分）について、サンプリングデータ記憶部２０に記憶された加速度値の最大値及び最小値を抽出する。すなわち、正弦波状指令信号に応じてトルク指令信号値を周期変動させることによって、正弦波指令信号の周期ごとに加速度値に最大ピーク及び最小ピークが生じるので、推定トルク定数計算部２３は、最大ピークの値及び最小ピークの値を抽出する。
【００３５】
加速度値の最大値及び最小値の抽出後、推定トルク計算部２３は、加速度値の最大値の平均値である平均Ａｍａｘ及び加速度値の最小値の平均値である平均Ａｍｉｎを求める。そして、推定トルク計算部２３は、加速度値の最大値の絶対値及び加速度信号の最小値の絶対値の平均をとった平均加速度ａを加速度代表値として求める。したがって、平均加速度ａは、（｜平均Ａｍａｘ｜＋｜平均Ａｍｉｎ｜）／２となる。
【００３６】
なお、正弦波状指令信号に応じた電流フィードバック値及び加速度値を抽出するので、速度制御部１２から出力されるトルク指令信号がゼロでない場合には、推定トルク計算部２３は、その影響分を補正する。
【００３７】
平均電流Ｉ及び平均加速度ａを求めた後、推定トルク計算部２３は、推定トルク定数Ｋｓを、Ｋｓ＝Ｊ・ａ／Ｉの式に従って求める。その後、減磁検出部２４は、推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分を求め、推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル１より大きいか否か及び推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル２より大きいか否かを判断する。
【００３８】
推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル１より大きい場合、減磁検出部２４は、推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル１より大きい旨の情報を比較結果として上位制御装置２に供給し、上位制御装置２は、永久磁石同期電動機３の動作を制限する。本実施の形態では、推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル１より大きい場合、上位制御装置２は、アンプ１５の電源をオフにし、永久磁石同期電動機３の動作を停止させる。
【００３９】
推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル１より小さいが減磁レベル２より大きい場合、減磁検出部２４は、推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル１より小さいが減磁レベル２より大きい旨の情報を比較結果として上位制御装置２に供給し、上位制御装置２は、アラームを生成する。本実施の形態では、推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル１より小さいが減磁レベル２より大きい場合、上位制御装置２は、ランプ６を点灯させる。
【００４０】
図２は、本発明の第１の実施の形態の制御装置の動作のフローチャートである。このフローチャートは、上位制御装置２からの減磁検出処理の起動指令信号を制御装置１が受信した後に実行される。
【００４１】
ステップＳ１において、正弦波状指令信号生成部１７は、正弦波状指令信号を生成する。次に、ステップＳ２において、電流値取得部１８が電流フィードバックの信号を電流値として取得するとともに、速度値取得部１９が速度フィードバックの信号を速度値として取得する。
【００４２】
次に、ステップＳ３において、推定トルク計算部２３は、指定された周期Ｔが経過したか否か判断する。指定された周期Ｔが経過していない場合、ステップＳ２に戻る。それに対し、指定された周期Ｔが経過した場合、ステップＳ４において、推定トルク計算部２３は、正弦波状指令信号の複数周期としての周期Ｔに亘る同一の動作状態（例えば、被駆動体４の円弧運動）での複数の電流値と複数の加速度値から取得した電流代表値としての平均電流Ｉ及び加速度代表値としての平均加速度ａを取得する。
【００４３】
次に、ステップＳ５において、推定トルク定数計算部２３は、推定トルク定数Ｋｓを、Ｋｓ＝Ｊ・ａ／Ｉの式に従って求める。次に、ステップＳ６において、減磁検出部２４は、推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル１より大きいか否かを判断する。
【００４４】
推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル１より大きい場合、ステップＳ７において、減磁検出部２４は、推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル１より大きい旨の情報を比較結果として上位制御装置２に供給し、上位制御装置２は、アンプ１５の電源をオフにし、永久磁石同期電動機３の動作を停止させ、処理を終了する。
【００４５】
推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル１以下である場合、ステップＳ８において、減磁検出部２４は、推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル２より大きいか否かを判断する。推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル２より大きい場合、ステップＳ９において、減磁検出部２４は、推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル１より小さいが減磁レベル２より大きい旨の情報を比較結果として上位制御装置２に供給し、上位制御装置２は、ランプ６を点灯させ、処理を終了する。なお、推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル２以下である場合、そのまま処理を終了する。
【００４６】
本実施の形態によれば、永久磁石同期電動機３は、推定トルク定数計算時に正弦波状指令信号に応じた周期動作を短時間行うことになるので、推定トルク定数計算時の永久磁石同期電動機３の動作範囲を小さくすることができる。このように永久磁石同期電動機３の動作範囲を小さくすることができるので、ロータ３２を１回以上回転させる必要がなくなる。したがって、円弧動作のように駆動軸３１の動作範囲が制限された場合でも磁石３４ａ，３４ｂ，３４ｃ，３４ｄの不可逆減磁を適切に検出することができる。
【００４７】
また、複数周期に亘る電流フィードバックの信号及び速度フィードバックの信号を用いるので、複数周期間での平均化によってノイズの影響を軽減することができる。さらに、複数の減磁レベルを設定することによって、減磁レベルに応じた対策を講じることができるので、安全性が向上する。
【００４８】
図３は、本発明の第２の実施の形態の制御装置を有するシステムのブロック図である。図３において、制御装置１’は、図１の制御装置１の構成要素の他に、摩擦計算部２５と、補正電流値生成部２６と、オフセット成分除去部２７と、を更に備える。
【００４９】
摩擦計算部２５は、速度値取得部１９で取得した速度値又は速度の極性に応じた摩擦（粘性摩擦及びクーロン摩擦）を計算する。補正電流値生成部２６は、摩擦計算部２５で計算した摩擦に応じて、電流値取得部１８で取得した電流値を補正し、補正電流値を生成する。オフセット成分除去部２７は、補正電流値生成部２６で生成した補正電流値のオフセット成分を除去する。なお、オフセット成分除去部２７は、例えば、ハイパスフィルタによって構成される。
【００５０】
なお、摩擦計算部２５による摩擦の計算、補正電流値生成部２６による補正電流値の生成及びオフセット成分除去部２７による補正電流値のオフセット成分の除去は、図２のフローチャートのステップＳ４で行われる。
【００５１】
永久磁石同期電動機３に重力等の一定の力が加わる場合、永久磁石同期電動機３に流れる電流値にオフセット成分が生じるが、本実施の形態によれば、電流値のオフセット成分をオフセット成分除去部２７で除去することによって、推定トルク定数計算部２３による推定トルク定数Ｋｓの計算精度が向上する。また、本実施の形態によれば、摩擦計算部２５で計算した摩擦に応じて、電流値取得部１８で取得した電流値を補正しているので、推定トルク定数計算部２３による推定トルク定数Ｋｓの計算精度が更に向上する。
【００５２】
図４は、本発明の第３の実施の形態の制御装置を有するシステムのブロック図である。図４において、制御装置１”は、図１の制御装置１の構成要素の他に、減少率計算及び速度ゲイン変更部２８を更に備える。
【００５３】
減少率計算及び速度ゲイン変更部２８は、減少率σをσ＝Ｋｓ／Ｋｔの式に従って計算し、減少率σに基づいて永久磁石同期電動機３の速度ゲインを変更する。例えば、減少率計算及び速度ゲイン変更部２８は、速度積分ゲインＫ１及び速度比例ゲインＫ２を、Ｋ１＝Ｋ１／σおよびＫ２＝Ｋ２／σの式に従ってそれぞれ変更する。
【００５４】
なお、減少率計算及び速度ゲイン変更部２８による減少率σの計算及び速度ゲインの変更は、図２のフローチャートのステップＳ９で行われる。
【００５５】
本実施の形態によれば、推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が比較的小さい場合、例えば、推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が減磁レベル１より小さいが減磁レベル２より大きい場合、速度ゲインを変更することによって、永久磁石同期電動機３の動作を安定化することができる。速度ゲインは実際のトルク定数Ｋｔに反比例するので、推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分が比較的小さい場合、推定トルク定数Ｋｓと実際のトルク定数Ｋｔとの差分に反比例するように速度ゲインを大きくすることによって、永久磁石同期電動機３の動作を安定化することができる。
【００５６】
本発明は、上記実施の形態に限定されるものではなく、幾多の変更及び変形が可能である。例えば、上記実施の形態において、永久磁石同期電動機３として、ロータ３２に永久磁石３４ａ，３４ｂ，３４ｃ，３４ｄが設けられた回転型サーボモータを用いた場合について説明したが、ステータに永久磁石が設けられた回転型サーボモータ、ステータとスライダのうちのいずれか一方に永久磁石が設けられたリニアサーボモータ、ステータとバイブレータのうちのいずれか一方に永久磁石が設けられた振動型サーボモータ等を、永久磁石同期電動機３として用いることができる。
【００５７】
また、上記実施の形態において、正弦波状指令信号をトルク指令信号に加算する場合について説明したが、正弦波状指令信号を、トルク指令信号に加算する代わりに位置指令信号又は速度指令信号に加算することができる。なお、永久磁石同期電動機３を含めた被駆動体の剛性が高い場合には、正弦波状指令信号をトルク指令信号に加算するのが好ましく、この場合トルク指令信号の周波数は高くできる。周波数を高くできると大きな加速度が得られるので精度が向上し、またロータの回転角度が小さくでき、さらに推定時間が短くできる。一方、剛性が低い場合は、バックラッシやばね等のロストモーションの影響で、推定精度が悪化する。そこで信号周波数を低くする必要があるが、信号周波数を低くすると速度制御、位置制御の影響で十分な加速が得られなくなる。この場合、位置指令信号又は速度指令信号に加算するのが好ましい。
【００５８】
また、上記実施の形態において、正弦波状指令信号の周期ごとの電流フィードバック値の最大値の絶対値及び電流フィードバック信号の最小値の絶対値を複数周期間で平均化した平均電流Ｉを電流代表値として求めるとともに、周期ごとの加速度値の最大値の絶対値及び加速度信号の最小値の絶対値を複数周期間で平均化した平均加速度ａを加速度代表値として求める場合について説明したが、電流代表値及び加速度代表値は、これらに限定されない。例えば、正弦波状指令信号の複数周期間に亘る電流フィードバック値の絶対値を積算したものを電流代表値として求めるとともに、正弦波状指令信号の複数周期間に亘る加速度フィードバック値の絶対値を積算したものを加速度代表値として求めることもできる。
【００５９】
さらに、アラームを生成するためにランプ６を用いる場合について説明したが、アラームを生成するために液晶ディスプレイ（ＬＥＤ）、ブザー等を用いることもできる。
【符号の説明】
【００６０】
１，１’，１” 制御装置
２ 上位制御装置
３ 磁石同期電動機
４ 被駆動体
５ 検出器
６ ランプ
１１ 位置制御部
１２ 速度制御部
１３ 加算器
１４ 電流制御部
１５ アンプ
１６ 正弦波状指令信号周波数設定部
１７ 正弦波状指令信号生成部
１８ 電流値取得部
１９ 速度値取得部
２０ サンプリングデータ記憶部
２１ 加速度取得部
２２ 既知データ記憶部
２３ 推定トルク定数計算部
２４ 減磁検出部
２５ 摩擦計算部
２６ 補正電流値生成部
２７ オフセット成分除去部
２８ 減少率計算及び速度ゲイン変更部
３１ 回転軸
３２ ロータ
３３ ステータ
３４ａ，３４ｂ，３４ｃ，３４ｄ 永久磁石
３５ｕ，３５ｖ，３５ｗ コイル
【特許請求の範囲】
【請求項１】
永久磁石同期電動機への位置指令信号、速度指令信号及びトルク指令信号のうちのいずれか一つに対する正弦波状指令信号を生成する正弦波状指令信号生成部と、
前記永久磁石同期電動機に流れる電流値を取得する電流値取得部と、
前記永久磁石同期電動機の加速度値を取得する加速度値取得部と、
前記正弦波状指令信号の複数周期に亘る同一の動作状態での複数の前記電流値と複数の前記加速度値から取得した電流代表値及び加速度代表値と、前記永久磁石同期電動機に関連する予め設定されたイナーシャとから、前記永久磁石同期電動機に関連する推定トルク定数を計算する推定トルク定数計算部と、
前記推定トルク定数と前記永久磁石同期電動機に関連する予め設定されたトルク定数との差分に基づいて、前記永久磁石同期電動機の永久磁石に不可逆減磁が発生したか否かを検出する減磁検出部と、
を備える制御装置。
【請求項２】
前記永久磁石同期電動機の速度値又は速度の極性に応じた摩擦を計算する摩擦計算部と、
前記摩擦に応じて前記電流値を補正した補正電流値を生成する補正電流値生成部と、
を更に備える請求項１に記載の制御装置。
【請求項３】
前記永久磁石同期電動機に流れる電流値のオフセット成分を除去するオフセット成分除去部を更に備える請求項１又は２に記載の制御装置。
【請求項４】
前記減磁検出部は、前記差分を複数の減磁レベルと比較し、前記永久磁石同期電動機の永久磁石に不可逆減磁が発生した場合にアラームを生成し又は前記永久磁石同期電動機の動作を制限するために、前記差分と前記複数の減磁レベルとの比較結果を出力する請求項１から３のうちのいずれか１項に記載の制御装置。
【請求項５】
前記減磁検出部は、前記推定トルク定数及び前記予め設定されたトルク定数に基づいて前記永久磁石同期電動機のトルク定数の減少率を計算し、前記減少率に基づいて前記永久磁石同期電動機の速度ゲインを変更する減少率計算及び速度ゲイン変更部を有する請求項１から４のうちのいずれか１項に記載の制御装置。
【請求項１】
永久磁石同期電動機への位置指令信号、速度指令信号及びトルク指令信号のうちのいずれか一つに対する正弦波状指令信号を生成する正弦波状指令信号生成部と、
前記永久磁石同期電動機に流れる電流値を取得する電流値取得部と、
前記永久磁石同期電動機の加速度値を取得する加速度値取得部と、
前記正弦波状指令信号の複数周期に亘る同一の動作状態での複数の前記電流値と複数の前記加速度値から取得した電流代表値及び加速度代表値と、前記永久磁石同期電動機に関連する予め設定されたイナーシャとから、前記永久磁石同期電動機に関連する推定トルク定数を計算する推定トルク定数計算部と、
前記推定トルク定数と前記永久磁石同期電動機に関連する予め設定されたトルク定数との差分に基づいて、前記永久磁石同期電動機の永久磁石に不可逆減磁が発生したか否かを検出する減磁検出部と、
を備える制御装置。
【請求項２】
前記永久磁石同期電動機の速度値又は速度の極性に応じた摩擦を計算する摩擦計算部と、
前記摩擦に応じて前記電流値を補正した補正電流値を生成する補正電流値生成部と、
を更に備える請求項１に記載の制御装置。
【請求項３】
前記永久磁石同期電動機に流れる電流値のオフセット成分を除去するオフセット成分除去部を更に備える請求項１又は２に記載の制御装置。
【請求項４】
前記減磁検出部は、前記差分を複数の減磁レベルと比較し、前記永久磁石同期電動機の永久磁石に不可逆減磁が発生した場合にアラームを生成し又は前記永久磁石同期電動機の動作を制限するために、前記差分と前記複数の減磁レベルとの比較結果を出力する請求項１から３のうちのいずれか１項に記載の制御装置。
【請求項５】
前記減磁検出部は、前記推定トルク定数及び前記予め設定されたトルク定数に基づいて前記永久磁石同期電動機のトルク定数の減少率を計算し、前記減少率に基づいて前記永久磁石同期電動機の速度ゲインを変更する減少率計算及び速度ゲイン変更部を有する請求項１から４のうちのいずれか１項に記載の制御装置。
【図１】
【図２】
【図３】
【図４】
【図２】
【図３】
【図４】
【公開番号】特開２０１３−２７２８７（Ｐ２０１３−２７２８７Ａ）
【公開日】平成２５年２月４日（２０１３．２．４）
【国際特許分類】
【出願番号】特願２０１１−１６３３０２（Ｐ２０１１−１６３３０２）
【出願日】平成２３年７月２６日（２０１１．７．２６）
【出願人】（３９０００８２３５）ファナック株式会社 (1,110)
【Ｆターム（参考）】
【公開日】平成２５年２月４日（２０１３．２．４）
【国際特許分類】
【出願日】平成２３年７月２６日（２０１１．７．２６）
【出願人】（３９０００８２３５）ファナック株式会社 (1,110)
【Ｆターム（参考）】
[ Back to top ]