(57)【要約】【課題】電流検出オフセットにより生ずるトルク変動を抑制するモータ制御装置を提供する。【解決手段】３相モータ２の各相電流を検出する電流検出器１１と、与えられた電流指令に対し各相電流を追従させる各相電圧指令を生成する電流制御器１２と、各相電圧指令に応じた電圧を３相モータ２に印加するパワー増幅器１３を備え、電流制御器１２内に各相電流検出値を電気角１周期の間積分する積分器と、積分器の出力から各相電流検出器のオフセット量を決定する補正量計算器とを備え、補正量計算器の出力を電流検出器１１の検出値から減算することで電流検出器１１のオフセット値を補正する。【選択図】図１
2006149045.tif 000002
【特許請求の範囲】
【請求項１】
３相モータの各相電流を検出する電流検出器と、与えられた電流指令に対し各相電流を追従させる各相電圧指令を生成する電流制御器と、各相電圧指令に応じた電圧を３相モータに印加するパワー増幅器を備えたモータ駆動装置において、前記電流制御器内に各相電流検出値を電気角１周期の間積分する積分器と、前記積分器の出力から各相電流検出器のオフセット量を決定する補正量計算器とを備え、前記補正量計算器の出力を電流検出器の検出値から減算することで電流検出器のオフセット値を補正するモータ駆動装置。
【請求項２】
積分器の入力に演算周期間のモータ移動量を乗じる請求項１記載のモータ駆動装置。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、モータ駆動装置における電流検出オフセットの補正に関するものである。
【背景技術】
【０００２】
モータ駆動装置を用いた電流制御は、サーボモータの高速・高応答制御のために、アナログ回路の時代から一般的に行われてきた。近年は、マイクロコンピュータやＬＳＩ技術の進歩で、電流制御もディジタル化が進み、アナログ制御では設計上もコスト上も実現困難であった複雑な制御が可能となり、サーボモータを用いる機器の高性能・高機能化に大きく貢献している。
【０００３】
ここで、一般的なモータ駆動装置の電流制御について図を用いて説明する。
【０００４】
図８において、モータ駆動装置１は、電流検出器１１を用いてサーボモータ２の３相電流を検出する。電流制御器１２は、３相電流検出値と位置検出器３からのモータ位置情報を用い、３相電流が電流指令に追従するよう３相電圧指令を生成し、パワー増幅器１３へ出力する。パワー増幅器１３は主電源４からの入力を制御することで、サーボモータ３に３相電圧指令どおりの電圧を印加する。
【０００５】
また、電流制御器１２は、ディジタル演算によるｄ−ｑ制御が用いられることが多い。３相電流検出値をｄ−ｑ変換器１２１により回転座標系であるｄ軸電流とｑ軸電流に変換し、ＰＩ制御器１２２で界磁成分であるｄ軸指令とトルク成分であるｑ軸指令と比較し、偏差をＰＩ演算することでｄ軸電圧指令とｑ軸電圧指令を生成する。逆ｄ−ｑ変換器１２３は、これらｄ指令とｑ軸電圧指令を３相座標系に逆変換し、３相電圧指令を生成する。
【０００６】
このような電流制御系において、電流検出器１１はカレントトランスや高精度抵抗器による電流から電圧への変換、オペアンプなどによる増幅、Ａ／Ｄ変換器による離散化と量子化により構成されることが多い。これらアナログ回路の温度特性や過渡特性は、電流検出値に実電流とのオフセットを生じさせる。
【０００７】
この電流検出オフセットは、モータの電気角周期と同期したトルク変動を引き起こすため、可変速制御が基本のサーボモータではトルク変動の周波数が常時変化し、通常の周波数特性が一定である位置制御や速度制御でこれを抑制するのは非常に困難であった。
【０００８】
この電流制御の始まりにまでさかのぼる古くからの課題に対しては、非常に多くの改善提案がなされてきた。これらを大別すると以下の２通りとなる。
【０００９】
１）相電流が０となるタイミングの電流検出値をオフセット値として記憶し補正する（例えば、特許文献１または特許文献２参照）。
【００１０】
２）電気角周期と同期したトルク変動を抽出し電流検出オフセット値を随時調整する（例えば、特許文献３または特許文献４参照）。
【特許文献１】特開平８−４７２８０号公報
【特許文献２】特開昭６２−２３３０８４号公報
【特許文献３】特開２００１−１８６７８４号公報
【特許文献４】特表２０００−０１４８６６号公報
【発明の開示】
【発明が解決しようとする課題】
【００１１】
上述した１）の方式では、３相電流が必ず０となるタイミングを作り出すために、正常な電流制御状態とは異なる制御状態を必要とする。したがって、正常な電流制御状態で電流検出オフセットが変化した場合には対処できない点が最大の課題である。
【００１２】
例えば、特許文献１では、モータへの電圧印加を遮断する電圧指令遮断手段を備え、３相電流が０の状態を作り出す。一方、特許文献２では、モータの１２０°通電で非通電状態となる残り６０°区間を利用して、そのときの電流検出値をオフセット値としている。
【００１３】
なお、現在市販されている一般的なモータ駆動装置は、電源投入時あるいは通電開始直前の非通電状態において、電流検出オフセットを測定するものが多い。これらはすべて通電開始後の電流検出オフセット変動に対処できない。
【００１４】
２）の方式では、サーボモータの速度が一定でない場合には、電気角周期と同期したトルク変動が一定周波数とならないため、その成分を抽出するのが非常に困難になるという課題がある。また、電流制御の外側に位置制御あるいは速度制御ループを構成する場合、トルク変動が電流制御の外部の要因によるものなのか、電流検出オフセットによるものかを識別するのが難しい点も課題である。
【００１５】
例えば、特許文献３では、トルク変動を抽出する条件として、速度変動とトルク変動が一定値以下でなくてはならないという制約がある。また、特許文献４では、変化するトルク変動周波数を抽出する周波数可変のバンドパスフィルタの設計や、ｄ−ｑ軸間の非干渉化が必要となるなど、オフセット測定処理が非常に複雑になる。
【００１６】
さらに、いずれの方式も、例えば電流検出オフセットによるトルク変動周波数と、モータと負荷の間の共振点により生じるトルク変動周波数が重なった場合、それら２つを区別することはできない。
【００１７】
本発明は上記の課題を解決するものであり、電流検出オフセットにより生ずるトルク変動を抑制するモータ制御装置を提供することを目的とする。
【課題を解決するための手段】
【００１８】
上記の課題を解決するために本発明は、３相モータの各相電流を検出する電流検出器と、与えられた電流指令に対し各相電流を追従させる各相電圧指令を生成する電流制御器と、各相電圧指令に応じた電圧を３相モータに印加するパワー増幅器を備えたモータ駆動装置において、前記電流制御器内に各相電流検出値を電気角１周期の間積分する積分器と、前記積分器の出力から各相電流検出器のオフセット量を決定する補正量計算器とを備え、前記補正量計算器の出力を電流検出器の検出値から減算することで電流検出器のオフセット値を補正するものである。
【００１９】
また、積分器の入力に演算周期間のモータ移動量を乗じるようにしてもよい。
【発明の効果】
【００２０】
本発明のモータ駆動装置によれば、各相電流検出値を電気角１周期の間積分することにより、一定速度・一定トルク指令の条件で、電流検出オフセットに比例する出力が得られ、正常な電流制御を行いながら電流検出オフセットの補正が可能となるため、駆動中の電流検出オフセットの変化にも対応可能となる。
【００２１】
また、電気角１周期の間にモータ速度が変動しても積分結果がほぼ一定に保たれるため、モータ速度変動が大きい場合にも電流検出オフセット補正が可能となる。
【発明を実施するための最良の形態】
【００２２】
３相モータの各相電流を検出する電流検出器と、与えられた電流指令に対し各相電流を追従させる各相電圧指令を生成する電流制御器と、各相電圧指令に応じた電圧を３相モータに印加するパワー増幅器を備えたモータ駆動装置において、前記電流制御器内に各相電流検出値を電気角１周期の間積分する積分器と、前記積分器の出力から各相電流検出器のオフセット量を決定する補正量計算器とを備え、前記補正量計算器の出力を電流検出器の検出値から減算することで電流検出器のオフセット値を補正するモータ駆動装置である。
【実施例１】
【００２３】
図１に示したモータ駆動装置の電流制御ブロック図は本発明の基本構成であり、従来の一般的なモータ駆動装置の電流制御ブロック（図８）に対して、モータ各相の電流検出値とモータ位置情報と補正後の電流検出値を入力とし、電流検出オフセット補正値を出力とする電流検出オフセット補正器１２４を電流検出器の数だけ備える点が異なっている。
【００２４】
図２は、この電流検出オフセット補正器１２４ａのブロック構成を示すもので、５は電気角１周期の間積分する電気角１周期積分器、６は各相電流検出器のオフセット量を決定する補正量計算器である。説明上、実際のサーボモータ２の１相分を表すブロック図も追記している。
【００２５】
電気角１周期積分器５は、モータ位置情報θから電気角を計算し、その１周期に当たる期間の電流検出値Ｉｕの積分結果を出力する。後述する理由により、この積分結果は電流検出オフセットＩｕ＿ｏｆｓ＊に比例する値となるため、補正量計算器６はこれを０に制御するための電流検出オフセット補正量Ｉｕ＿ｏｆｓを出力する機能を備えればよい。例えば、積分結果に一定のゲインを掛けた値を出力する、あるいは積分結果の符号に応じ一定量の補正値を加減算するなどが考えられる。
【００２６】
次に、電流検出値Ｉｕの電気角１周期の積分結果が、なぜ電流検出オフセットＩｕ＿ｏｆｓ＊に比例するのかを説明する。ここで記号に＊が付いている値はモータ駆動装置では直接観測できない値である。
【００２７】
図３は電流制御が完全に行われた場合の各波形と電気角１周期分の積分結果を示したものである。電流制御により実電流Ｉｕ＊がオフセットＩｕ＿ｏｆｓ＊を打ち消す直流成分をもった波形に制御されるため、電流検出値Ｉｕは見た目上オフセットのない波形となり、積分値も０となる。この状態では、電流検出値Ｉｕの積分結果からはＩｕ＿ｏｆｓ＊の情報を読み出すことはできない。しかしながら、電流制御系には遅れが存在し、完全な制御は実現できないのが通常である。その場合の各波形を図４に示す。図３との違いは、実電流波形Ｉｕ＊がオフセットＩｕ＿ｏｆｓ＊を打ち消す直流成分を十分に持っていないことである。これは、電流制御系に存在する遅れにより制御しきれていないためである。この場合、電流検出値Ｉｕには、ΔＩｕ−ΔＩｕ’分のオフセットが存在し、積分結果はＩｕ＿ｏｆｓ＊と相関のある値となる。
【００２８】
したがって、補正量計算器６を用いて電流検出オフセット補正量Ｉｕ＿ｏｆｓを変化させると、電流検出オフセット量ΔＩｕが等価的に０に近づくように小さくなり、最終的には全ての積分結果が０に収束することで、電流検出オフセットの補正が完了する。
【実施例２】
【００２９】
実施例２はモータの速度指令が一定でない場合に有効であり、実施例１の電流検出オフセット補正器とはブロック構成が異なる。
【００３０】
図５に示すように、電流検出オフセット補正器１２４ｂは、実施例１で説明した電気角１周期積分器５、補正量計算器６に加えて、モータ位置θの演算周期間の差分からモータ速度を算出し、電流検出値Ｉｕと乗じる速度乗算器７を備えており、その出力を電気角１周期積分器５に入力している。
【００３１】
このモータ速度の乗算により、モータ速度が一定でない場合もモータ速度が一定の場合と同じ電流検出オフセット補正ができる。これについて図６を用いて説明する。
【００３２】
図６において、ａ）はモータ速度がω０で一定の場合の電流検出値Ｉｕを示している。前述のとおり電気角１周期分の積分結果はＴ×（ΔＩｕ−ΔＩｕ’）となる。しかし、ｂ）のようにモータ速度が半周期の間はω０で、残り半周期の間ω０／２と変化した場合、前半の半周期の積分結果は２Ａｕ／ω０だが、モータ速度に逆比例して後半の半周期の時間は２倍になるため積分結果は−４Ａｕ／ω０となる。したがって電気角１周期分の積分結果はＴ×（ΔＩｕ−ΔＩｕ’）−２Ａｕ／ω０という値になってしまう。
【００３３】
ここで、積分結果がモータ速度に逆比例することに注目すると、電流検出値Ｉｕにモータ速度ωｍを乗ずることで、このモータ速度による積分時間の伸縮の影響を打ち消せることが分かる。乗算結果Ｉｕ×ωｍをｃ）に示すが、モータ速度が１／２となってために積分時間が２倍になった分を、乗算結果の振幅が１／２となることで打ち消していることが分かる。
【００３４】
この等価性は数式でも表せる。電流検出値Ｉｕをモータ位置θの関数と考えると、Ｉｕ（ｔ）＝Ｉ（θ（ｔ））となる。このθ（ｔ）は、時間ｔにおけるモータ位置θを示しており、モータ速度ω（ｔ）は、モータ位置θ（ｔ）の微分なので乗算結果は、Ｉｕ（ｔ）×ω（ｔ）＝Ｉ（θ（ｔ））×ｄθ（ｔ）／ｄｔとなる。さらに、この式の両辺を時間ｔで不定積分すると、∫（Ｉｕ（ｔ）×ω（ｔ））ｄｔ＝∫（Ｉ（θ（ｔ））×ｄθ（ｔ）／ｄｔ）ｄｔ＝∫（Ｉ（θ））ｄθとなる。
【００３５】
この式を見ると、時間ｔとの関連が全くなくなっていることが分かる。すなわち速度ω（ｔ）が変化しても、乗算結果の電気角１周期分の積分結果は常に同じとなる。
【００３６】
この結果は電流検出値Ｉｕだけでなく、電気角の関数で表せる電圧指令Ｖｕなどすべての値に適用できるため、図５における各部の値は図７のように表せる。横軸が時間から位置に置き換わっている点が重要で、モータ速度への依存性がなくなっていることを示している。
【００３７】
上述した各実施例から明らかなように、駆動中の電流検出オフセット変化にリアルタイムで対応することができるため、電流検出オフセットが要因となる電気角周期と同期したトルク変動を大幅に抑制することができる。また加減速時などのモータ速度の変動にもロバストな電流検出オフセット測定を実現できる。
【産業上の利用可能性】
【００３８】
本発明のモータ駆動装置は、３相モータに限定されず、電流フィードバック制御を行うリニアモータやＤＣモータなどにも有用である。
【図面の簡単な説明】
【００３９】
【図１】本発明のモータ駆動装置における電流制御ブロック図
【図２】本発明の実施例１における電流検出オフセット補正器のブロック図
【図３】本発明の実施例１における電流制御系に遅れがない場合の各波形の説明図
【図４】本発明の実施例１における電流制御系に遅れがある場合の各波形の説明図
【図５】本発明の実施例２における電流検出オフセット補正器のブロック図
【図６】（ａ）速度一定における速度乗算器の効果説明図、（ｂ）速度が一定でない場合の速度乗算器の効果説明図、（ｃ）モータ速度を乗算した場合の速度乗算器の効果説明図
【図７】本発明の実施例４における測定動作説明図
【図８】従来のモータ駆動装置における電流制御ブロック図
【符号の説明】
【００４０】
１  モータ駆動装置
１１  電流検出器
１２  電流制御器
１２１  ｄ−ｑ変換器
１２２  ＰＩ制御器
１２３  逆ｄ−ｑ変換器
１２４、１２４ａ、１２４ｂ  電流検出オフセット補正器
１３  パワー増幅器
２  ３相モータ
３  位置検出器
４  主電源
５  電気角１周期積分器
６  補正量計算器
７  速度乗算器
【図１】
2006149045.tif 000003
【図２】
2006149045.tif 000004
【図３】
2006149045.tif 000005
【図４】
2006149045.tif 000006
【図５】
2006149045.tif 000007
【図６】
2006149045.tif 000008
【図７】
2006149045.tif 000009
【図８】
2006149045.tif 000010