ステッピングモータ駆動制御装置
【課題】効率の良い駆動制御を実行する、発熱の少ない駆動制御装置であって、駆動方法の切り替え時における過渡現象を抑制する駆動制御装置を実現することを目的とする。
【解決手段】本発明は、マイクロステップ駆動と速度サーボ駆動とを切り替えてステッピングモータ１２を制御するステッピングモータ駆動制御装置１である。該装置１は、負荷推定器６によってマイクロステップ駆動時の負荷を推定し、該推定した負荷の値を用いて、マイクロステップ駆動から速度サーボ駆動に切り替えたときに前記負荷の値に見合った電流がステッピングモータ１２に流れるように、ステッピングモータ１２の駆動を制御している。
【解決手段】本発明は、マイクロステップ駆動と速度サーボ駆動とを切り替えてステッピングモータ１２を制御するステッピングモータ駆動制御装置１である。該装置１は、負荷推定器６によってマイクロステップ駆動時の負荷を推定し、該推定した負荷の値を用いて、マイクロステップ駆動から速度サーボ駆動に切り替えたときに前記負荷の値に見合った電流がステッピングモータ１２に流れるように、ステッピングモータ１２の駆動を制御している。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、ステッピングモータ駆動制御装置に関し、特に、複数の駆動方法を選択的に切り替えて実行するように制御するステッピングモータ駆動制御装置に関する。
【背景技術】
【０００２】
従来、ステッピングモータの駆動制御方法としては、マイクロステップ駆動や検出した回転子の位置をフィードバックする閉ループ制御などが一般的に知られている。閉ループ制御の一例としては、特許文献１が挙げられる。特許文献１においては、位置指示と回転子位置の偏差と、検出速度とからモータのトルク位置が常に最適になるように指令電流の大きさを決定している。
また、単一の駆動方法によるのではなく、複数の駆動方法を選択的に切り替えてモータを駆動制御する方法も知られている。一例として、指令パルスによって励磁切換えを行う通常のステッピングモータ駆動方式と、閉ループモードのＤＣモータ駆動方式とを選択的に切り替える駆動制御方法（例えば、特許文献２、３、４及び５）などが挙げられる。
【０００３】
特許文献２においては、通常のステッピングモータ駆動方式によってモータを駆動し、脱調が生じるとＤＣモータ駆動方式に駆動方法を切り替えている。そして、ＤＣモータ駆動方式によって脱調状態が解消されると、再び通常のステッピングモータ駆動方式に戻るように制御されている。
特許文献３においては、回転子位置と励磁位置から負荷角を算出し、負荷角に基づいてマイクロステップ駆動方式と定トルク方式とを切り替えている。
特許文献４では、特許文献３と同様の駆動方法の切り替えを実行すると共に、マイクロステップ駆動用制御器からの電流指示と位置サーボ用制御器からの電流指示に重みをつけ、合成した電流指示によってモータを駆動制御している。
特許文献５はマイクロステップ駆動方式とＤＣブラシレスモータ駆動方式とを切り替えて実行するステッピングモータ駆動制御装置を示している。
【特許文献１】特開昭５７−１０１５９７号公報
【特許文献２】特開平７−５９３９５号公報
【特許文献３】特開平１１−１１３２８９号公報
【特許文献４】特開２００４−３２８８２１号公報
【特許文献５】特開平１０−１５０７９８号公報
【発明の開示】
【発明が解決しようとする課題】
【０００４】
しかしながら、上記特許文献１〜５に開示されたステッピングモータの駆動制御においては、それぞれ次のような問題点がある。特許文献２及び特許文献３に開示された駆動制御装置は、脱調現象の回避を目的として、負荷に因らず一定電流を流してモータを駆動している。したがって、効率が悪く、発熱が大きいという問題があった。
これに対して、特許文献１は、位置および速度情報から電流の増減を行うため、効率は良い。しかしながら、電流の増減を急激に行うと駆動できない可能性があるため、速度偏差とモータに流れる電流から電流指示を決定する分配方法を実験から求めなければならない。
また、特許文献４では、位置サーボ制御を行った結果の電流指令を使用している。したがって、周波数特性が低くなり、負荷により不安定になる。電流指示値の比率を固定とすると、無負荷でもマイクロステップ駆動用の電流指示がゼロとならないため、通常の位置サーボより電流が増加し、効率の悪化を招く。また、駆動中に電流指示の比率を急変すると大きな過渡現象が生じる。
特許文献５の駆動制御装置は、負荷に変動があった場合、切り替え時に大きな過渡現象を生じ、負荷が重い場合には脱調現象を起こして駆動できない場合がある。
【０００５】
これらの従来技術の問題点に鑑みて、本発明の目的は、複数の駆動方法を切り替えてステッピングモータを駆動することにより、事前の実験を行うことなく効率の良い駆動制御を実行する、発熱の少ない駆動制御装置であって、前記駆動方法の切り替え時における過渡現象を抑制する駆動制御装置を実現することを目的とする。
【課題を解決するための手段】
【０００６】
上記目的を達成するために、本発明は、マイクロステップ駆動と速度サーボ駆動とを切り替えてステッピングモータを制御するステッピングモータ駆動制御装置であって、前記ステッピングモータに流れる実電流を検出する電流検出器と、位置指示から形成された速度指示と、検出した前記実電流とに基づいて、前記ステッピングモータの各相に流す駆動電流を決定する第１の駆動指令を形成する速度サーボ駆動手段と、予め設定又は算出された電流指示と、前記位置指示と、検出した前記実電流とに基づいて、前記ステッピングモータの各相に流す駆動電流を決定する第２の駆動指令を形成するマイクロステップ駆動手段と、前記マイクロステップ駆動時における前記ステッピングモータの負荷を推定して負荷推定値を得る負荷推定器とを備えている。前記速度サーボ制御手段は、マイクロステップ駆動から速度サーボ駆動に切り替えたときに、前記駆動電流を前記推定した負荷に見合う大きさに決定すべく、前記第１の駆動指令の形成要素として前記負荷推定値を用いるように構成されている。
【０００７】
一例として、前記ステッピングモータの回転子位置を検出する位置検出器を備え、前記負荷推定器は、検出した前記回転子位置と、前記位置指示との偏差から前記負荷推定値を算出する。
【０００８】
他の例として、前記速度サーボ駆動手段は、前記検出した実電流から前記ステッピングモータの回転子速度を推定し、該推定した回転子速度を用いて前記第１の駆動指令を形成する、位置センサレス駆動を実行し、前記負荷推定器は、前記第２の駆動指令と前記実電流とから前記ステッピングモータの回転子位置を推定して、該推定した回転子位置と前記位置指示との偏差から前記負荷推定値を算出する。
【０００９】
前記速度サーボ制御手段は、前記速度指示と前記回転子速度との偏差にＰＩ補償を施すことによって得られるトルク分電流指示を用いて前記第１の駆動指令を形成すると共に、前記速度サーボ駆動に切り替えたときに、前記負荷推定値を用いて前記ＰＩ補償のための積分要素の初期値を設定するように構成しても良い。
【００１０】
さらに、例えば、前記速度サーボ制御手段は、前記速度サーボ駆動時における前記ステッピングモータの負荷を推定して、速度サーボ駆動時における負荷推定値を算出し、前記マイクロステップ制御手段は、前記速度サーボ駆動からマイクロステップ駆動に切り替えたときに、前記速度サーボ駆動時の負荷に見合う前記駆動電流を決定するための前記第２の駆動指令を形成するように構成しても良い。
【発明の効果】
【００１１】
本発明に係るステッピングモータ駆動制御装置では、マイクロステップ駆動と速度サーボ駆動とを切り替えてステッピングモータを制御する。マイクロステップ駆動は、低速領域で高精度な位置決めを行なうことができる。一方、速度サーボ制御は要求トルクに見合うように電流を制御するため効率の良い駆動を実現する。
【００１２】
本発明では、マイクロステップ駆動と速度サーボ駆動とを切り替えてステッピングモータを制御するため、停止時及び低速領域においてマイクロステップ駆動を実行し、中・高速領域において速度サーボ駆動を実行することによって、位置決め精度が高く効率の良い駆動が可能となっている。また、本発明は、このような切り替え制御を採用しているため、上記特許文献１に対して指摘したような事前の実験によるデータは必要ない。
【００１３】
さらに、本発明は、マイクロステップ駆動から速度サーボ駆動に切り替えたときに、マイクロステップ駆動時におけるステッピングモータの負荷を推定して得られた負荷推定値を用いて、モータ駆動電流を決定するための駆動指令を形成している。したがって、マイクロステップ駆動から速度サーボ駆動に切り替えた瞬間及び直後において、前記駆動指令にマイクロステップ駆動時の負荷推定値が反映されるため、マイクロステップ駆動時の負荷に見合う電流がステッピングモータに流れる。したがって、マイクロステップ駆動から速度サーボ駆動に切り替えたときに生じる速度変動等の過渡現象を抑制して安定した駆動を実現することができる。
【発明を実施するための最良の形態】
【００１４】
以下、本発明の第１の実施形態を添付の図により説明する。図１に本実施形態に係るステッピングモータ駆動制御装置のブロック図を示す。ステッピングモータ駆動制御装置１では、外部から与えられた位置指示θ＊に基づいてＮ相ステッピングモータ１２の回転子位置制御が実行される。この位置制御に際しては、マイクロステップ駆動と速度サーボ駆動とが選択的に切り替えられる。本実施形態において、ステッピングモータ駆動制御装置１は、ステッピングモータ１２の停止時と低速領域においてマイクロステップ駆動を実行し、中・高速領域において速度サーボ駆動を実行するように構成されている。
【００１５】
まず、停止時はマイクロステップ駆動で位置を保持し、位置指示θ＊が入力されると、マイクロステップ駆動で始動する。その後、回転子の速度が中高速になると、駆動切替器７によって駆動方法を速度サーボ駆動に切り替える。停止位置に近づくと、ステッピングモータ１２は減速し、低速となったところで駆動切替器７によってマイクロステップ駆動に切り替え、停止位置で停止する。
【００１６】
ステッピングモータ１２の回転子速度は、位置検出器１３よって検出された回転子位置θｒに基づいて、速度検出器１０によって算出される。速度検出器１０によって算出された回転子速度ωｒは駆動切替器７に入力される。マイクロステップ駆動と速度サーボ駆動を切り替える基準値である速度閾値は予め設定されている。駆動切替器７は、速度検出器１０から取得した回転子速度ωｒと予め設定された速度閾値とを比較して、マイクロステップ駆動を実行するか、速度サーボ駆動を実行するかを判定して、切替信号を出力し、スイッチ８を介してマイクロステップ駆動と速度サーボ駆動とを切り替える。
【００１７】
［速度サーボ駆動時］
定常状態における速度サーボ駆動について以下に説明する。速度サーボ駆動中においては、スイッチ８は速度サーボ駆動部４とインバータ９とを接続するように作動している。
速度指示作成器２は位置指示θ＊から速度指示ωｓを算出して速度サーボ駆動部４に出力する。速度サーボ駆動部４は、速度指示ωｓと、ステッピングモータ１２に流れている実電流ｉＮと、速度検出器１０によって算出された回転子速度ωｒとに基づいて、速度サーボ駆動用指令ＶｓＮを算出して、インバータ９に出力する。ステッピングモータ１２に流れている実電流ｉＮは、電流検出器１１によって検出される。前記速度サーボ駆動用指令ＶｓＮは、ステッピングモータ１２の各相に流す駆動電流を決定するための指令値である。
【００１８】
本実施形態おける速度サーボ駆動部４は、定常状態において速度サーボ駆動を行なって速度サーボ駆動用指令ＶｓＮを形成する手段であればよく、特定の速度サーボ駆動を行なう手段に限定されるものではない。
【００１９】
速度サーボ駆動部４の一例を以下に簡単に説明する。速度サーボ駆動部４は、（図示しない）ＰＩ制御器を有する速度制御器を備えている。この速度制御器は、速度指示作成器２から出力された速度指示ωｓと、速度検出器１０から出力された回転子速度ωｒとの差分を算出し、該差分に対してＰＩ制御を行ない、トルク分電流指示を形成する。速度サーボ駆動部４は、形成されたトルク分電流指示と、予め設定され又は算出された推定励磁分電流指示と、回転子速度ωｒから算出された回転子位置（電気角）とから、速度サーボ駆動用指令ＶｓＮを算出して、スイッチ８を介してインバータ９に出力する。インバータ９は速度サーボ駆動用指令ＶｓＮを電力増幅し、ステッピングモータ１２を速度サーボ駆動する。
【００２０】
［マイクロステップ駆動時］
定常状態におけるマイクロステップ駆動について以下に説明する。マイクロステップ駆動中においては、スイッチ８はマイクロステップ駆動部３とインバータ９とを接続するように作動している。
マイクロステップ駆動部３には、電流指示（マイクロステップ駆動用設定電流値）ｉ＊と、位置指示θ＊と、電流検出器１１によって検出したステッピングモータ１２の実電流ｉＮとが入力される。マイクロステップ駆動部３は、位置指示θ＊からステッピングモータ１２の励磁電気角を算出して、該励磁電気角と、電流指示（マイクロステップ駆動用設定電流値）ｉ＊と、実電流ｉＮに基づいて、マイクロステップ駆動用指令ＶｍＮを形成して出力する。マイクロステップ駆動用指令ＶｍＮは、ステッピングモータ１２の各相に流す駆動電流を決定するための指令値である。算出されたマイクロステップ駆動用指令ＶｍＮは、スイッチ８を介してインバータ９に出力され、インバータ９はマイクロステップ駆動用指令ＶｍＮを電力増幅し、ステッピングモータ１２をマイクロステップ駆動する。
【００２１】
なお、負荷推定器６は、マイクロステップ駆動を実行している間、マイクロステップ駆動時の負荷の値を示す負荷推定値Ｔｍを算出している。この負荷推定値Ｔｍは、後述のように、マイクロステップ駆動から速度サーボ駆動への切替時において、駆動制御に用いられる。該負荷推定値Ｔｍの算出については、後の［マイクロステップ駆動から速度サーボ駆動への切替時］において詳述する。
【００２２】
［マイクロステップ駆動から速度サーボ駆動への切替時］
以下に、マイクロステップ駆動から速度サーボ駆動へ切り替えるときのステッピングモータ駆動制御装置１の動作について説明する。
ステッピングモータの駆動において、負荷のない場合には、マイクロステップ駆動と速度サーボ駆動の両駆動方式における電気角を合致させて切り替えを行うことで、速度変動のない切り替え動作を行うことができる。しかしながら、負荷がある場合には、過渡現象として速度変動が生じる。特にマイクロステップ駆動から速度サーボ駆動に切り替える場合には大きな速度変動を生じ、場合によっては制御不能となる。
【００２３】
多くの速度サーボ駆動は、積分器を備えた速度制御器を用いて、要求トルクに応じた電流を流すように電流を制御する。駆動方法切り替え時点では速度サーボ駆動を行っていないため、切替時のトルク分電流指示は、速度制御器における積分器の初期値によって決定される。すなわち、積分器の初期値がゼロに設定されている場合、切替時のトルク分電流指示はゼロになる。したがって、有負荷の場合、負荷に見合ったトルク分電流指示が形成されるまでに速度変動が生じる。
【００２４】
そこで、本発明においては、マイクロステップ駆動時の定常状態の負荷を推定し、マイクロステップ駆動から速度サーボ駆動へ切り替えたときに、推定した負荷に見合った電流がステッピングモータに流れるように制御を行なうことによって、マイクロステップ駆動から速度サーボ駆動への切替時における速度変動を抑制している。
【００２５】
本実施形態では、マイクロステップ駆動から速度サーボ駆動に切り替えたときに、マイクロステップ駆動時の負荷に見合った積分初期値を速度制御器の積分器に設定することによって、前記負荷に見合った電流がステッピングモータに流れるように制御している。
【００２６】
先に述べたようにマイクロステップ駆動時の負荷の値を示す負荷推定値Ｔｍは、マイクロステップ駆動時において負荷推定器６によって算出される。負荷推定器６に接続された偏差カウンタ５は、位置指示θ＊と、位置検出器１３によって検出された回転子位置θｒとを入力とし、位置指示θ＊と回転子位置θｒとの偏差ｄｍを負荷推定器６に出力する。負荷推定器６は、位置偏差ｄｍと電流指示ｉ＊からマイクロステップ駆動時における負荷推定値Ｔｍを算出して速度サーボ駆動部４に出力する。
【００２７】
マイクロステップ駆動から速度サーボ駆動に切り替えられると、速度サーボ駆動部４は、負荷推定値Ｔｍを負荷推定器６から取得して、速度制御器に備えられた積分器の初期値を負荷推定値Ｔｍに見合う値に設定する。ここで、負荷推定値Ｔｍは、マイクロステップ駆動から速度サーボ駆動へ切り替えられる直前に算出された負荷推定値Ｔｍである。前記積分初期値は、負荷推定値Ｔｍをトルク定数で除算して電流に換算し、さらに制御ゲインで除算することにより決定される。
【００２８】
このように、速度制御器の積分器の初期値をマイクロステップ駆動時の負荷の値に見合う値に設定することによって、マイクロステップ駆動から速度サーボ駆動へ切り替えた瞬間及び直後にマイクロステップ駆動時の負荷に見合う電流がステッピングモータに流れるように制御され、マイクロステップ駆動から速度サーボ駆動へ切り替えたときの速度変動を抑制することができる。
【００２９】
以上に説明したように、本実施形態では、マイクロステップ駆動と速度サーボ駆動とを選択的に切り替えている。
マイクロステップ駆動は、前述のように低速領域で高精度な位置決めを行なうことができる。しかしながら、一般的な性質として、負荷に因らず電流を一定に制御するため、軽負荷では効率が悪く、負荷が大きくなるにつれて効率が上昇し、脱調現象を起こす近傍で効率が最大になるという特徴を有する。実際の使用では、安全率を考慮して設定電流は必要トルクに見合う電流の２倍程度に設定される。したがって、マイクロステップ駆動のみでは、効率が悪くなってしまう。
【００３０】
一方、サーボ駆動方式においては、要求トルクに見合うように電流を制御するため、効率の良い駆動が可能である。ステッピングモータはサーボモータに用いられる表面磁石形同期電動機と同じモータモデルであるため、サーボモータと同様に制御できる。ステッピングモータをマイクロステップ駆動した場合と、速度サーボ駆動した場合のそれぞれについて、効率とトルクとの関係を図２に示す。図２からも明らかなように、サーボ駆動は、マイクロステップ駆動よりも運転効率が格段に良い。
このサーボ駆動のみによって、サーボモータと同様の位置制御を行い、負荷に対してステッピングモータと同様の応答を得るためには、制御ゲインを高くする必要がある。しかしながら、ゲインを高く設定すると慣性負荷により発振したり停止時の振動が増加してしまう。この問題に対処するためには複雑なゲイン設定を行なわなければならなくなる。
【００３１】
加えて、サーボモータの位置制御においては、電流制御と、速度制御と、位置制御との３重のマイナーループ制御を行うことが一般的である。電流制御を１００とすると速度制御の応答周波数は１０、位置制御の応答周波数は１というように応答周波数が下がる。前記位置制御を行ったサーボモータの慣性負荷によるステップ応答のシミュレーション結果を図３に示す。図３から明らかなように、慣性負荷が大きくなると振動現象が発散している。次に、前記速度制御を行ったサーボモータの慣性負荷によるステップ応答のシミュレーション結果を図４に示す。図４から明らかなように、速度制御においては図３の位置制御と比較して、オーバーシュートは増加するものの安定に制御されている。また、応答時間についても、位置制御よりも速度制御のほうが格段に速くなっている。
【００３２】
したがって、本実施形態においては、サーボ駆動方式として速度サーボ駆動を採用し、モータ回転子の速度に応じてマイクロステップ駆動と切り替えて制御することにより、位置決め精度が高く効率の良い駆動を実現している。この駆動制御においては、制御ゲインを高くしなくても良いため、複雑なゲイン設定を行なう必要はない。加えて、サーボ駆動方式として速度サーボ駆動を採用することにより、応答が速く安定した駆動制御を実現している。
【００３３】
さらに、前述のように、マイクロステップ駆動から速度サーボ駆動へ切り替わる際に、マイクロステップ駆動時の負荷に見合う電流がステッピングモータに流れるように制御されて、切り替え時の速度変動を抑制することができる。
したがって、いかなる負荷を負った場合でもスムーズな駆動方法の切替が可能となり、低速時のマイクロステップ駆動が有する利点を生かしつつ、損失の少ない高効率位置制御が実現できる。さらに、ステッピングモータ駆動制御装置１は、マイクロプロセッサによって制御が可能であると共に、位置検出器１３を用いているため、停止時まで脱調検出が可能である。
【００３４】
［第２の実施形態］
図５に第２の実施形態を示す。ステッピングモータ駆動制御装置２０は、第１の実施形態と同様に、Ｎ相ステッピングモータ３５の停止時と低速領域においてマイクロステップ駆動を実行し、中・高速領域において速度サーボ駆動を実行するように構成されている。駆動方法の切替は、第１の実施形態と同様に、駆動方法切替器２４によって実行される。駆動方法切替器２４から出力された切替信号に応じてスイッチ３１が切り替えられることによって、上記駆動方法が切り替えられる。図５においては、スイッチ３１はマイクロステップ駆動を選択している。
【００３５】
速度指示作成器２１に接続された速度制御器２２、第１の電流指示作成器２３、第１の電気角作成器２７は、第１の実施形態における速度サーボ駆動部４に対応する。第２の電気角作成器２９、第２の電流指示作成器３０は、第１の実施形態におけるマイクロステップ駆動部３に対応する。速度指示作成器２１、駆動切替器２４、負荷推定器２５、速度検出器２６、偏差カウンタ２８、スイッチ３１、インバータ３３、電流検出器３４、位置検出器３６は、第１の実施形態における速度指示作成器２、駆動切替器７、負荷推定器６、速度検出器１０、偏差カウンタ５、スイッチ８、インバータ９、電流検出器１１、位置検出器１３とそれぞれ同様の処理を実行する。
【００３６】
定常状態における速度サーボ駆動では、位置指示θ＊を入力とする速度指示作成器２１から出力された速度指示ωｓと、回転子位置θｒから速度検出器２６によって算出された回転子速度ωｒとが速度制御器２２に入力される。速度制御器２２は、ＰＩ制御器を備え、速度指示ωｓと回転子速度ωｒとの差分に対してＰＩ制御を行ない、トルク分電流指示を形成して第１の電流指示作成器２３に出力する。
【００３７】
第１の電流指示作成器２３は、トルク分電流指示と、回転子位置θｒから第１の電気角作成器２７によって作成された速度サーボ駆動のための電気角とから、速度サーボ駆動用の交流電流指示を形成して、スイッチ３１を介して、電流制御器３２に出力する。電流制御器３２は、交流電流指示と、電流検出器３４によって検出したステッピングモータ３５の実電流ｉＮとから速度サーボ駆動用指令ＶｓＮを形成して、インバータ３３に出力する。インバータ３３は速度サーボ駆動用指令ＶｓＮを電力増幅し、ステッピングモータ３５を速度サーボ駆動する。
【００３８】
定常状態におけるマイクロステップ駆動では、第２の電気角作成器２９が位置指示θ＊を入力としてマイクロステップ駆動用の電気角指示（励磁電気角）θｍを第２の電流指示作成器３０に出力する。電流指示作成器３０は、電気角指示θｍと電流指示ｉ＊からマイクロステップ駆動用の交流電流指示を形成して、スイッチ３１を介して電流制御器３２に出力する。電流制御器３２は、交流電流指示と、電流検出器３４によって検出したステッピングモータ３５の実電流ｉＮとからマイクロステップ駆動用指令ＶｍＮを形成して、インバータ３３に入力する。インバータ３３はマイクロステップ駆動用指令ＶｍＮを電力増幅し、ステッピングモータ３５をマイクロステップ駆動する。
【００３９】
マイクロステップ駆動から速度サーボ駆動に切り替わるときには、第１の実施形態と同様に、偏差カウンタ２８によって出力された位置指示θ＊と回転子位置θｒとの偏差ｄｍと、電流指示ｉ＊とから負荷推定器２５がマイクロステップ駆動時における負荷推定値Ｔｍを算出して速度制御器２２に出力する。
推定負荷値Ｔｍに見合った積分初期値が速度制御器２２の積分器に設定されて、マイクロステップ駆動から速度サーボ駆動に切り替わるときの速度変動が抑制される。
【００４０】
［第３の実施形態］
図６に第３の実施形態を示す。第３の実施形態に係るステッピングモータ駆動制御装置４０は、第２の実施形態における電流制御器３２の代わりに、速度サーボ駆動用電流制御器３２ａとマイクロステップ駆動用電流制御器３２ｂの２つの電流制御器を設けたものである。
速度サーボ駆動用電流制御器３２ａは、第１の電流指示作成器２３から出力された交流電流指示と、電流検出器３４によって検出したステッピングモータ３５の実電流ｉＮとから速度サーボ駆動用指令ＶｓＮを形成し、スイッチ３１を介してインバータ３３に出力するように構成されている。マイクロステップ駆動用電流制御器３２ｂは、第２の電流指示作成器３０から出力された交流電流指示と、電流検出器３４によって検出したステッピングモータ３５の実電流ｉＮとからマイクロステップ駆動用指令ＶｍＮを形成し、スイッチ３１を介してインバータ３３に入力するように構成されている。
【００４１】
図５を参照して説明した第２の実施形態においては、電流制御器３２が駆動方法切替スイッチ３１の後段に配置されているため、アナログ回路による電流制御も可能であり、高速な応答を実現することができる。これに対して、図６を参照して説明した第３の実施形態においては、電流制御器３２ａ，３２ｂが駆動方法切替スイッチ３１の前段に配置されているため、駆動指令を形成するための回路要素を全てデジタル回路によって構成することができる。
【００４２】
［第４の実施形態］
図７に第４の実施形態を示す。第４の実施形態に係るステッピングモータ駆動制御装置５０においては、位置検出器を設けずに、位置センサレス制御によって速度サーボ駆動を実現している。図７において、速度指示作成器５２に接続された減算器５３、速度制御器５４、電流制御器５５、適応オブザーバ５６、積分器５７、座標変換器５８は、第１の実施形態における速度サーボ駆動部４に対応する。電気角作成器５９、座標変換器６０、（図示しない）減算器を備えた電流制御器６１は第１の実施形態におけるマイクロステップ駆動部３に対応する。
【００４３】
定常状態のセンサレス駆動において、速度指示作成器５２は位置指示θ＊を入力として速度指示ωｓを算出して減算器５３に入力する。減算器５３は、速度指示作成器５２から出力された速度指示ωｓと、電流検出器６６によって検出された実電流ｉＮに基づいて推定された推定速度との差分を算出して速度制御器５４に出力する。速度制御器５４は、ＰＩ制御器を備え、入力された差分に対してＰＩ制御を行なってトルク分電流指示を形成し、該トルク分電流指示を電流制御器５５に出力している。
【００４４】
電流制御器５５は、ＰＩ制御器を備え、予め設定され又は算出された推定励磁分電流指示及びトルク分電流指示と、電流検出器６６によって検出された実電流から算出された励磁分電流及びトルク分電流との差分を算出してＰＩ制御を実行し、ｄｑ軸電圧指示Ｖｄｑｓを形成して出力している。ｄｑ軸電圧指示Ｖｄｑｓはスイッチ６４を介して座標変換器６７に入力される。座標変換器６７には、さらにスイッチ６５を介して、電流検出器６６によって検出された実電流ｉＮに基づいて推定された推定電気角が入力される。
【００４５】
座標変換器６７はｄｑ軸電圧指示Ｖｄｑｓと推定電気角とを入力としてｄｑ−３相変換を実行し、センサレス駆動用指令ＶｓＮをＰＷＭインバータ６８に入力する。ＰＷＭインバータ６８はセンサレス駆動用指令ＶｓＮを電力増幅し、ステッピングモータ５１をセンサレス駆動する。
【００４６】
前記推定速度及び前記推定電気角は、適応オブザーバ５６によって算出される。適応オブザーバ５６には電流検出器６６によって検出された実電流が座標変換器５８を介して入力される。座標変換器５８はフィードバックされた推定電気角と入力された実電流（相電流）とから、３相−ｄｑ変換を実行して、励磁分電流とトルク分電流（ｄｑ軸電流）とを算出して、適応オブザーバ５６に入力している。
【００４７】
適応オブザーバ５６は、入力された実電流（ｄｑ軸電流）と、電流制御器５５から出力されたｄｑ軸電圧指示Ｖｄｑｓの電圧とから推定速度を算出し、該推定速度を積分器５７を介して積分することによって推定電気角を算出している。
本実施形態のように、センサレス制御手段として適応オブザーバ５６を使用すると、各制御部分のゲイン設定が容易になる。
【００４８】
マイクロステップ駆動からセンサレス駆動に切り替えるときは、負荷推定器６２によって算出した負荷推定値Ｔｍに見合う積分初期値を速度制御器５４の積分器に設定する。本実施形態において、負荷推定器６２は、ステッピングモータ５１の各相への印加電圧、すなわち、マイクロステップ駆動指令ＶｍＮと、電流検出器６６で検出した実電流ｉＮとに基づいてステッピングモータ５１の回転子位置を推定し、推定した回転子位置と電気角作成器５９から出力された電気角指示θｍとの偏差から負荷角を求めて、マイクロステップ駆動時の負荷推定値Ｔｍを算出する。回転子位置の推定方法としては、例えば、特開２００４−１８０３５４号公報に開示された方法を用いることができる。
本実施形態では、電流制御器５５においてもＰＩ制御を実行しているため、電流制御器５５の積分器においても、負荷推定器６２で算出した負荷推定値Ｔｍに見合う積分初期値を設定する。
【００４９】
一般的に、マイクロステップ駆動からセンサレス駆動への切替時ほどではないが、センサレス駆動からマイクロステップ駆動へ切り替える際にも、速度変動が生じる可能性がある。本実施形態におけるステッピングモータ駆動制御装置５０は、センサレス駆動からマイクロステップ駆動への切替に起因する過渡現象についても抑制するために、以下のような処理を実行している。
【００５０】
センサレス駆動からマイクロステップ駆動への切替時に、電気角作成器５９が、センサレス駆動時におけるモータ５１の負荷の値を示す負荷推定値Ｔｓを、速度制御器５４から取得し、該推定負荷値Ｔｓと位置指示θ＊とに基づいて、該推定負荷値Ｔｓに見合う電流をステッピングモータ５１に流すように電気角指示θｍを形成する。速度制御器５４は前記速度指示ωｓと推定速度との差分に基づいて算出したトルク分電流に対して、予め与えられているモータ定数を乗じて負荷推定値Ｔｓを算出している。上記駆動方法の切替時に、電気角作成器５９が取得する負荷推定値Ｔｓは、センサレス駆動からマイクロステップ駆動へ切り替えられる直前に速度制御器５４によって算出された負荷推定値Ｔｓである。
【００５１】
電気角作成器５９には、さらに位置指示θ＊が入力される。この位置指示θ＊は、マイクロステップ駆動に切り替わる際に位置誤差調整器６９にも入力される。以下、位置誤差調整器６９について説明する。位置誤差調整器６９には、前記位置指示θ＊に加えて、適応オブザーバ５６から積分器５７を介して出力された推定電気角が入力される。
位置誤差調整器６９は、推定電気角と位置指示θ＊の偏差を算出して、電気角作成器５９に出力する。電気角作成器５９は入力された偏差を位置指示θ＊に加算する。電気角作成器５９は、前記偏差を加算した位置指示θ＊と負荷推定値Ｔｓとから、センサレス駆動時の負荷に見合う電流がモータ５１に流れるように、電気角指示（励磁電気角）θｍを形成して、座標変換器６０に出力している。
【００５２】
前記位置誤差調整器６９は、速度制御系であるセンサレス駆動と位置制御系であるマイクロステップ駆動とを切り替えるときに生じる演算誤差を解消する目的を有している。すなわち、センサレス駆動では、速度指示作成器５２を介して位置指示θ＊から速度指示ωｓを算出する等、位置と速度の変換を実行している。したがって、このような変換の過程で生じた演算誤差によって速度指示と位置指示の整合がとれなくなる可能性がある。
【００５３】
そこで、位置誤差調整器６９は、速度指示と位置指示の整合をとるために、入力された推定電気角と入力された位置指示θ＊との偏差を算出して、電気角作成器５９に出力している。そして、電気角作成器５９は該偏差を位置指示θ＊に加算して電気角指示θｍを形成している。これにより、マイクロステップ駆動に切り替えたときに、演算誤差等が解消された電気角指示θｍが出力されることになる。
【００５４】
［他の実施形態］
以上、本発明の実施形態について述べたが、本発明は既述の実施形態に限定されるものではなく、本発明の技術的思想に基づいて各種の変形及び変更が可能である。
例えば、上記実施形態における定常時の速度サーボ駆動及びマイクロステップ駆動は上記実施形態に限定されない。他の構成要素及び制御によって実行される様々な速度サーボ駆動及びマイクロステップ駆動を本発明に適用することができる。
【００５５】
上記第１〜第３の実施形態において、第４の実施形態と同様に、速度サーボ駆動からマイクロステップ駆動への切替に起因する過渡現象を抑制するための構成を備えても良い。この場合、第１〜第３の実施形態における速度制御器は、速度指示ωｓと回転子速度ωｒとの差分に基づいて算出したトルク分電流に対して、予め与えられているモータ定数を乗じて負荷推定値Ｔｓを算出する。負荷推定値Ｔｓを用いたマイクロステップ駆動用電気角の作成は第４の実施形態と同様の処理によって実行することができる。
【００５６】
上記第４の実施形態では、位置誤差調整器６９は、速度サーボ駆動からマイクロステップ駆動へ切り替えたときに動作している。しかしながら、位置誤差調整器６９は速度サーボ駆動中に動作して位置誤差を調整することもできる。この場合、位置誤差調整器６９は、速度サーボ駆動中において、位置指示θ＊と推定電気角の偏差を算出して速度指示作成器５２に出力する。速度指示作成器５２は該偏差を位置指示θ＊に加算して該偏差を加算した位置指示θ＊から速度指示を算出することによって、演算誤差等が補正された速度指示を出力する。このように、速度サーボ駆動中に速度指示作成器５２から出力される速度指示が位置誤差調整器６９を介してすでに調整されている場合には、マイクロステップ駆動へ切り替える際に、推定電気角の位置指示θ＊に対する誤差等を補正する必要はない。したがって、上記第４の実施形態において、速度サーボ駆動中に位置誤差調整器６９を介して上記速度指示を調整した場合には、位置誤差調整器６９は、前記偏差を電気角作成器５９に出力する必要はない。
【００５７】
上記第４の実施形態において、速度サーボ駆動時の負荷推定値Ｔｓは速度制御器５４においてトルク分電流に基づいて算出されているが、これに限定されない。例えば、座標変換器５８から出力されるトルク分電流に、任意の演算手段を介してモータ定数を乗じることによって速度サーボ駆動時の負荷推定値Ｔｓを算出し、該算出した負荷推定値Ｔｓを電気角作成器５９に入力するように構成しても良い。
【図面の簡単な説明】
【００５８】
【図１】第１の実施形態に係るステッピングモータ駆動制御装置のブロック図である。
【図２】マイクロステップ駆動を実行した場合と速度サーボ駆動を実行した場合における、効率とトルクの関係を示すグラフである。
【図３】サーボ駆動方式として位置制御を実行した場合における、サーボモータの慣性負荷によるステップ応答シミュレーションの結果を示すグラフである。
【図４】サーボ駆動方式として速度制御を実行した場合における、サーボモータの慣性負荷によるステップ応答シミュレーションの結果を示すグラフである。
【図５】第２の実施形態に係るステッピングモータ駆動制御装置のブロック図である。
【図６】第３の実施形態に係るステッピングモータ駆動制御装置のブロック図である。
【図７】第４の実施形態に係るステッピングモータ駆動制御装置のブロック図である。
【符号の説明】
【００５９】
１，２０，４０，５０ ステッピングモータ駆動制御装置
３ マイクロステップ駆動部
４ 速度サーボ駆動部
６，２５，６２ 負荷推定器
７，２４，６３ 駆動方法切替器
１１，３４，６６ 電流検出器
１２，３５，５１ ステッピングモータ
２，２１，５２ 速度指示作成器
２２，５４ 速度制御器
２７，２９，５９ 電気角作成器
３２，５５，６１ 電流制御器
５６ 適応オブザーバ
６９ 位置誤差調整器
【技術分野】
【０００１】
本発明は、ステッピングモータ駆動制御装置に関し、特に、複数の駆動方法を選択的に切り替えて実行するように制御するステッピングモータ駆動制御装置に関する。
【背景技術】
【０００２】
従来、ステッピングモータの駆動制御方法としては、マイクロステップ駆動や検出した回転子の位置をフィードバックする閉ループ制御などが一般的に知られている。閉ループ制御の一例としては、特許文献１が挙げられる。特許文献１においては、位置指示と回転子位置の偏差と、検出速度とからモータのトルク位置が常に最適になるように指令電流の大きさを決定している。
また、単一の駆動方法によるのではなく、複数の駆動方法を選択的に切り替えてモータを駆動制御する方法も知られている。一例として、指令パルスによって励磁切換えを行う通常のステッピングモータ駆動方式と、閉ループモードのＤＣモータ駆動方式とを選択的に切り替える駆動制御方法（例えば、特許文献２、３、４及び５）などが挙げられる。
【０００３】
特許文献２においては、通常のステッピングモータ駆動方式によってモータを駆動し、脱調が生じるとＤＣモータ駆動方式に駆動方法を切り替えている。そして、ＤＣモータ駆動方式によって脱調状態が解消されると、再び通常のステッピングモータ駆動方式に戻るように制御されている。
特許文献３においては、回転子位置と励磁位置から負荷角を算出し、負荷角に基づいてマイクロステップ駆動方式と定トルク方式とを切り替えている。
特許文献４では、特許文献３と同様の駆動方法の切り替えを実行すると共に、マイクロステップ駆動用制御器からの電流指示と位置サーボ用制御器からの電流指示に重みをつけ、合成した電流指示によってモータを駆動制御している。
特許文献５はマイクロステップ駆動方式とＤＣブラシレスモータ駆動方式とを切り替えて実行するステッピングモータ駆動制御装置を示している。
【特許文献１】特開昭５７−１０１５９７号公報
【特許文献２】特開平７−５９３９５号公報
【特許文献３】特開平１１−１１３２８９号公報
【特許文献４】特開２００４−３２８８２１号公報
【特許文献５】特開平１０−１５０７９８号公報
【発明の開示】
【発明が解決しようとする課題】
【０００４】
しかしながら、上記特許文献１〜５に開示されたステッピングモータの駆動制御においては、それぞれ次のような問題点がある。特許文献２及び特許文献３に開示された駆動制御装置は、脱調現象の回避を目的として、負荷に因らず一定電流を流してモータを駆動している。したがって、効率が悪く、発熱が大きいという問題があった。
これに対して、特許文献１は、位置および速度情報から電流の増減を行うため、効率は良い。しかしながら、電流の増減を急激に行うと駆動できない可能性があるため、速度偏差とモータに流れる電流から電流指示を決定する分配方法を実験から求めなければならない。
また、特許文献４では、位置サーボ制御を行った結果の電流指令を使用している。したがって、周波数特性が低くなり、負荷により不安定になる。電流指示値の比率を固定とすると、無負荷でもマイクロステップ駆動用の電流指示がゼロとならないため、通常の位置サーボより電流が増加し、効率の悪化を招く。また、駆動中に電流指示の比率を急変すると大きな過渡現象が生じる。
特許文献５の駆動制御装置は、負荷に変動があった場合、切り替え時に大きな過渡現象を生じ、負荷が重い場合には脱調現象を起こして駆動できない場合がある。
【０００５】
これらの従来技術の問題点に鑑みて、本発明の目的は、複数の駆動方法を切り替えてステッピングモータを駆動することにより、事前の実験を行うことなく効率の良い駆動制御を実行する、発熱の少ない駆動制御装置であって、前記駆動方法の切り替え時における過渡現象を抑制する駆動制御装置を実現することを目的とする。
【課題を解決するための手段】
【０００６】
上記目的を達成するために、本発明は、マイクロステップ駆動と速度サーボ駆動とを切り替えてステッピングモータを制御するステッピングモータ駆動制御装置であって、前記ステッピングモータに流れる実電流を検出する電流検出器と、位置指示から形成された速度指示と、検出した前記実電流とに基づいて、前記ステッピングモータの各相に流す駆動電流を決定する第１の駆動指令を形成する速度サーボ駆動手段と、予め設定又は算出された電流指示と、前記位置指示と、検出した前記実電流とに基づいて、前記ステッピングモータの各相に流す駆動電流を決定する第２の駆動指令を形成するマイクロステップ駆動手段と、前記マイクロステップ駆動時における前記ステッピングモータの負荷を推定して負荷推定値を得る負荷推定器とを備えている。前記速度サーボ制御手段は、マイクロステップ駆動から速度サーボ駆動に切り替えたときに、前記駆動電流を前記推定した負荷に見合う大きさに決定すべく、前記第１の駆動指令の形成要素として前記負荷推定値を用いるように構成されている。
【０００７】
一例として、前記ステッピングモータの回転子位置を検出する位置検出器を備え、前記負荷推定器は、検出した前記回転子位置と、前記位置指示との偏差から前記負荷推定値を算出する。
【０００８】
他の例として、前記速度サーボ駆動手段は、前記検出した実電流から前記ステッピングモータの回転子速度を推定し、該推定した回転子速度を用いて前記第１の駆動指令を形成する、位置センサレス駆動を実行し、前記負荷推定器は、前記第２の駆動指令と前記実電流とから前記ステッピングモータの回転子位置を推定して、該推定した回転子位置と前記位置指示との偏差から前記負荷推定値を算出する。
【０００９】
前記速度サーボ制御手段は、前記速度指示と前記回転子速度との偏差にＰＩ補償を施すことによって得られるトルク分電流指示を用いて前記第１の駆動指令を形成すると共に、前記速度サーボ駆動に切り替えたときに、前記負荷推定値を用いて前記ＰＩ補償のための積分要素の初期値を設定するように構成しても良い。
【００１０】
さらに、例えば、前記速度サーボ制御手段は、前記速度サーボ駆動時における前記ステッピングモータの負荷を推定して、速度サーボ駆動時における負荷推定値を算出し、前記マイクロステップ制御手段は、前記速度サーボ駆動からマイクロステップ駆動に切り替えたときに、前記速度サーボ駆動時の負荷に見合う前記駆動電流を決定するための前記第２の駆動指令を形成するように構成しても良い。
【発明の効果】
【００１１】
本発明に係るステッピングモータ駆動制御装置では、マイクロステップ駆動と速度サーボ駆動とを切り替えてステッピングモータを制御する。マイクロステップ駆動は、低速領域で高精度な位置決めを行なうことができる。一方、速度サーボ制御は要求トルクに見合うように電流を制御するため効率の良い駆動を実現する。
【００１２】
本発明では、マイクロステップ駆動と速度サーボ駆動とを切り替えてステッピングモータを制御するため、停止時及び低速領域においてマイクロステップ駆動を実行し、中・高速領域において速度サーボ駆動を実行することによって、位置決め精度が高く効率の良い駆動が可能となっている。また、本発明は、このような切り替え制御を採用しているため、上記特許文献１に対して指摘したような事前の実験によるデータは必要ない。
【００１３】
さらに、本発明は、マイクロステップ駆動から速度サーボ駆動に切り替えたときに、マイクロステップ駆動時におけるステッピングモータの負荷を推定して得られた負荷推定値を用いて、モータ駆動電流を決定するための駆動指令を形成している。したがって、マイクロステップ駆動から速度サーボ駆動に切り替えた瞬間及び直後において、前記駆動指令にマイクロステップ駆動時の負荷推定値が反映されるため、マイクロステップ駆動時の負荷に見合う電流がステッピングモータに流れる。したがって、マイクロステップ駆動から速度サーボ駆動に切り替えたときに生じる速度変動等の過渡現象を抑制して安定した駆動を実現することができる。
【発明を実施するための最良の形態】
【００１４】
以下、本発明の第１の実施形態を添付の図により説明する。図１に本実施形態に係るステッピングモータ駆動制御装置のブロック図を示す。ステッピングモータ駆動制御装置１では、外部から与えられた位置指示θ＊に基づいてＮ相ステッピングモータ１２の回転子位置制御が実行される。この位置制御に際しては、マイクロステップ駆動と速度サーボ駆動とが選択的に切り替えられる。本実施形態において、ステッピングモータ駆動制御装置１は、ステッピングモータ１２の停止時と低速領域においてマイクロステップ駆動を実行し、中・高速領域において速度サーボ駆動を実行するように構成されている。
【００１５】
まず、停止時はマイクロステップ駆動で位置を保持し、位置指示θ＊が入力されると、マイクロステップ駆動で始動する。その後、回転子の速度が中高速になると、駆動切替器７によって駆動方法を速度サーボ駆動に切り替える。停止位置に近づくと、ステッピングモータ１２は減速し、低速となったところで駆動切替器７によってマイクロステップ駆動に切り替え、停止位置で停止する。
【００１６】
ステッピングモータ１２の回転子速度は、位置検出器１３よって検出された回転子位置θｒに基づいて、速度検出器１０によって算出される。速度検出器１０によって算出された回転子速度ωｒは駆動切替器７に入力される。マイクロステップ駆動と速度サーボ駆動を切り替える基準値である速度閾値は予め設定されている。駆動切替器７は、速度検出器１０から取得した回転子速度ωｒと予め設定された速度閾値とを比較して、マイクロステップ駆動を実行するか、速度サーボ駆動を実行するかを判定して、切替信号を出力し、スイッチ８を介してマイクロステップ駆動と速度サーボ駆動とを切り替える。
【００１７】
［速度サーボ駆動時］
定常状態における速度サーボ駆動について以下に説明する。速度サーボ駆動中においては、スイッチ８は速度サーボ駆動部４とインバータ９とを接続するように作動している。
速度指示作成器２は位置指示θ＊から速度指示ωｓを算出して速度サーボ駆動部４に出力する。速度サーボ駆動部４は、速度指示ωｓと、ステッピングモータ１２に流れている実電流ｉＮと、速度検出器１０によって算出された回転子速度ωｒとに基づいて、速度サーボ駆動用指令ＶｓＮを算出して、インバータ９に出力する。ステッピングモータ１２に流れている実電流ｉＮは、電流検出器１１によって検出される。前記速度サーボ駆動用指令ＶｓＮは、ステッピングモータ１２の各相に流す駆動電流を決定するための指令値である。
【００１８】
本実施形態おける速度サーボ駆動部４は、定常状態において速度サーボ駆動を行なって速度サーボ駆動用指令ＶｓＮを形成する手段であればよく、特定の速度サーボ駆動を行なう手段に限定されるものではない。
【００１９】
速度サーボ駆動部４の一例を以下に簡単に説明する。速度サーボ駆動部４は、（図示しない）ＰＩ制御器を有する速度制御器を備えている。この速度制御器は、速度指示作成器２から出力された速度指示ωｓと、速度検出器１０から出力された回転子速度ωｒとの差分を算出し、該差分に対してＰＩ制御を行ない、トルク分電流指示を形成する。速度サーボ駆動部４は、形成されたトルク分電流指示と、予め設定され又は算出された推定励磁分電流指示と、回転子速度ωｒから算出された回転子位置（電気角）とから、速度サーボ駆動用指令ＶｓＮを算出して、スイッチ８を介してインバータ９に出力する。インバータ９は速度サーボ駆動用指令ＶｓＮを電力増幅し、ステッピングモータ１２を速度サーボ駆動する。
【００２０】
［マイクロステップ駆動時］
定常状態におけるマイクロステップ駆動について以下に説明する。マイクロステップ駆動中においては、スイッチ８はマイクロステップ駆動部３とインバータ９とを接続するように作動している。
マイクロステップ駆動部３には、電流指示（マイクロステップ駆動用設定電流値）ｉ＊と、位置指示θ＊と、電流検出器１１によって検出したステッピングモータ１２の実電流ｉＮとが入力される。マイクロステップ駆動部３は、位置指示θ＊からステッピングモータ１２の励磁電気角を算出して、該励磁電気角と、電流指示（マイクロステップ駆動用設定電流値）ｉ＊と、実電流ｉＮに基づいて、マイクロステップ駆動用指令ＶｍＮを形成して出力する。マイクロステップ駆動用指令ＶｍＮは、ステッピングモータ１２の各相に流す駆動電流を決定するための指令値である。算出されたマイクロステップ駆動用指令ＶｍＮは、スイッチ８を介してインバータ９に出力され、インバータ９はマイクロステップ駆動用指令ＶｍＮを電力増幅し、ステッピングモータ１２をマイクロステップ駆動する。
【００２１】
なお、負荷推定器６は、マイクロステップ駆動を実行している間、マイクロステップ駆動時の負荷の値を示す負荷推定値Ｔｍを算出している。この負荷推定値Ｔｍは、後述のように、マイクロステップ駆動から速度サーボ駆動への切替時において、駆動制御に用いられる。該負荷推定値Ｔｍの算出については、後の［マイクロステップ駆動から速度サーボ駆動への切替時］において詳述する。
【００２２】
［マイクロステップ駆動から速度サーボ駆動への切替時］
以下に、マイクロステップ駆動から速度サーボ駆動へ切り替えるときのステッピングモータ駆動制御装置１の動作について説明する。
ステッピングモータの駆動において、負荷のない場合には、マイクロステップ駆動と速度サーボ駆動の両駆動方式における電気角を合致させて切り替えを行うことで、速度変動のない切り替え動作を行うことができる。しかしながら、負荷がある場合には、過渡現象として速度変動が生じる。特にマイクロステップ駆動から速度サーボ駆動に切り替える場合には大きな速度変動を生じ、場合によっては制御不能となる。
【００２３】
多くの速度サーボ駆動は、積分器を備えた速度制御器を用いて、要求トルクに応じた電流を流すように電流を制御する。駆動方法切り替え時点では速度サーボ駆動を行っていないため、切替時のトルク分電流指示は、速度制御器における積分器の初期値によって決定される。すなわち、積分器の初期値がゼロに設定されている場合、切替時のトルク分電流指示はゼロになる。したがって、有負荷の場合、負荷に見合ったトルク分電流指示が形成されるまでに速度変動が生じる。
【００２４】
そこで、本発明においては、マイクロステップ駆動時の定常状態の負荷を推定し、マイクロステップ駆動から速度サーボ駆動へ切り替えたときに、推定した負荷に見合った電流がステッピングモータに流れるように制御を行なうことによって、マイクロステップ駆動から速度サーボ駆動への切替時における速度変動を抑制している。
【００２５】
本実施形態では、マイクロステップ駆動から速度サーボ駆動に切り替えたときに、マイクロステップ駆動時の負荷に見合った積分初期値を速度制御器の積分器に設定することによって、前記負荷に見合った電流がステッピングモータに流れるように制御している。
【００２６】
先に述べたようにマイクロステップ駆動時の負荷の値を示す負荷推定値Ｔｍは、マイクロステップ駆動時において負荷推定器６によって算出される。負荷推定器６に接続された偏差カウンタ５は、位置指示θ＊と、位置検出器１３によって検出された回転子位置θｒとを入力とし、位置指示θ＊と回転子位置θｒとの偏差ｄｍを負荷推定器６に出力する。負荷推定器６は、位置偏差ｄｍと電流指示ｉ＊からマイクロステップ駆動時における負荷推定値Ｔｍを算出して速度サーボ駆動部４に出力する。
【００２７】
マイクロステップ駆動から速度サーボ駆動に切り替えられると、速度サーボ駆動部４は、負荷推定値Ｔｍを負荷推定器６から取得して、速度制御器に備えられた積分器の初期値を負荷推定値Ｔｍに見合う値に設定する。ここで、負荷推定値Ｔｍは、マイクロステップ駆動から速度サーボ駆動へ切り替えられる直前に算出された負荷推定値Ｔｍである。前記積分初期値は、負荷推定値Ｔｍをトルク定数で除算して電流に換算し、さらに制御ゲインで除算することにより決定される。
【００２８】
このように、速度制御器の積分器の初期値をマイクロステップ駆動時の負荷の値に見合う値に設定することによって、マイクロステップ駆動から速度サーボ駆動へ切り替えた瞬間及び直後にマイクロステップ駆動時の負荷に見合う電流がステッピングモータに流れるように制御され、マイクロステップ駆動から速度サーボ駆動へ切り替えたときの速度変動を抑制することができる。
【００２９】
以上に説明したように、本実施形態では、マイクロステップ駆動と速度サーボ駆動とを選択的に切り替えている。
マイクロステップ駆動は、前述のように低速領域で高精度な位置決めを行なうことができる。しかしながら、一般的な性質として、負荷に因らず電流を一定に制御するため、軽負荷では効率が悪く、負荷が大きくなるにつれて効率が上昇し、脱調現象を起こす近傍で効率が最大になるという特徴を有する。実際の使用では、安全率を考慮して設定電流は必要トルクに見合う電流の２倍程度に設定される。したがって、マイクロステップ駆動のみでは、効率が悪くなってしまう。
【００３０】
一方、サーボ駆動方式においては、要求トルクに見合うように電流を制御するため、効率の良い駆動が可能である。ステッピングモータはサーボモータに用いられる表面磁石形同期電動機と同じモータモデルであるため、サーボモータと同様に制御できる。ステッピングモータをマイクロステップ駆動した場合と、速度サーボ駆動した場合のそれぞれについて、効率とトルクとの関係を図２に示す。図２からも明らかなように、サーボ駆動は、マイクロステップ駆動よりも運転効率が格段に良い。
このサーボ駆動のみによって、サーボモータと同様の位置制御を行い、負荷に対してステッピングモータと同様の応答を得るためには、制御ゲインを高くする必要がある。しかしながら、ゲインを高く設定すると慣性負荷により発振したり停止時の振動が増加してしまう。この問題に対処するためには複雑なゲイン設定を行なわなければならなくなる。
【００３１】
加えて、サーボモータの位置制御においては、電流制御と、速度制御と、位置制御との３重のマイナーループ制御を行うことが一般的である。電流制御を１００とすると速度制御の応答周波数は１０、位置制御の応答周波数は１というように応答周波数が下がる。前記位置制御を行ったサーボモータの慣性負荷によるステップ応答のシミュレーション結果を図３に示す。図３から明らかなように、慣性負荷が大きくなると振動現象が発散している。次に、前記速度制御を行ったサーボモータの慣性負荷によるステップ応答のシミュレーション結果を図４に示す。図４から明らかなように、速度制御においては図３の位置制御と比較して、オーバーシュートは増加するものの安定に制御されている。また、応答時間についても、位置制御よりも速度制御のほうが格段に速くなっている。
【００３２】
したがって、本実施形態においては、サーボ駆動方式として速度サーボ駆動を採用し、モータ回転子の速度に応じてマイクロステップ駆動と切り替えて制御することにより、位置決め精度が高く効率の良い駆動を実現している。この駆動制御においては、制御ゲインを高くしなくても良いため、複雑なゲイン設定を行なう必要はない。加えて、サーボ駆動方式として速度サーボ駆動を採用することにより、応答が速く安定した駆動制御を実現している。
【００３３】
さらに、前述のように、マイクロステップ駆動から速度サーボ駆動へ切り替わる際に、マイクロステップ駆動時の負荷に見合う電流がステッピングモータに流れるように制御されて、切り替え時の速度変動を抑制することができる。
したがって、いかなる負荷を負った場合でもスムーズな駆動方法の切替が可能となり、低速時のマイクロステップ駆動が有する利点を生かしつつ、損失の少ない高効率位置制御が実現できる。さらに、ステッピングモータ駆動制御装置１は、マイクロプロセッサによって制御が可能であると共に、位置検出器１３を用いているため、停止時まで脱調検出が可能である。
【００３４】
［第２の実施形態］
図５に第２の実施形態を示す。ステッピングモータ駆動制御装置２０は、第１の実施形態と同様に、Ｎ相ステッピングモータ３５の停止時と低速領域においてマイクロステップ駆動を実行し、中・高速領域において速度サーボ駆動を実行するように構成されている。駆動方法の切替は、第１の実施形態と同様に、駆動方法切替器２４によって実行される。駆動方法切替器２４から出力された切替信号に応じてスイッチ３１が切り替えられることによって、上記駆動方法が切り替えられる。図５においては、スイッチ３１はマイクロステップ駆動を選択している。
【００３５】
速度指示作成器２１に接続された速度制御器２２、第１の電流指示作成器２３、第１の電気角作成器２７は、第１の実施形態における速度サーボ駆動部４に対応する。第２の電気角作成器２９、第２の電流指示作成器３０は、第１の実施形態におけるマイクロステップ駆動部３に対応する。速度指示作成器２１、駆動切替器２４、負荷推定器２５、速度検出器２６、偏差カウンタ２８、スイッチ３１、インバータ３３、電流検出器３４、位置検出器３６は、第１の実施形態における速度指示作成器２、駆動切替器７、負荷推定器６、速度検出器１０、偏差カウンタ５、スイッチ８、インバータ９、電流検出器１１、位置検出器１３とそれぞれ同様の処理を実行する。
【００３６】
定常状態における速度サーボ駆動では、位置指示θ＊を入力とする速度指示作成器２１から出力された速度指示ωｓと、回転子位置θｒから速度検出器２６によって算出された回転子速度ωｒとが速度制御器２２に入力される。速度制御器２２は、ＰＩ制御器を備え、速度指示ωｓと回転子速度ωｒとの差分に対してＰＩ制御を行ない、トルク分電流指示を形成して第１の電流指示作成器２３に出力する。
【００３７】
第１の電流指示作成器２３は、トルク分電流指示と、回転子位置θｒから第１の電気角作成器２７によって作成された速度サーボ駆動のための電気角とから、速度サーボ駆動用の交流電流指示を形成して、スイッチ３１を介して、電流制御器３２に出力する。電流制御器３２は、交流電流指示と、電流検出器３４によって検出したステッピングモータ３５の実電流ｉＮとから速度サーボ駆動用指令ＶｓＮを形成して、インバータ３３に出力する。インバータ３３は速度サーボ駆動用指令ＶｓＮを電力増幅し、ステッピングモータ３５を速度サーボ駆動する。
【００３８】
定常状態におけるマイクロステップ駆動では、第２の電気角作成器２９が位置指示θ＊を入力としてマイクロステップ駆動用の電気角指示（励磁電気角）θｍを第２の電流指示作成器３０に出力する。電流指示作成器３０は、電気角指示θｍと電流指示ｉ＊からマイクロステップ駆動用の交流電流指示を形成して、スイッチ３１を介して電流制御器３２に出力する。電流制御器３２は、交流電流指示と、電流検出器３４によって検出したステッピングモータ３５の実電流ｉＮとからマイクロステップ駆動用指令ＶｍＮを形成して、インバータ３３に入力する。インバータ３３はマイクロステップ駆動用指令ＶｍＮを電力増幅し、ステッピングモータ３５をマイクロステップ駆動する。
【００３９】
マイクロステップ駆動から速度サーボ駆動に切り替わるときには、第１の実施形態と同様に、偏差カウンタ２８によって出力された位置指示θ＊と回転子位置θｒとの偏差ｄｍと、電流指示ｉ＊とから負荷推定器２５がマイクロステップ駆動時における負荷推定値Ｔｍを算出して速度制御器２２に出力する。
推定負荷値Ｔｍに見合った積分初期値が速度制御器２２の積分器に設定されて、マイクロステップ駆動から速度サーボ駆動に切り替わるときの速度変動が抑制される。
【００４０】
［第３の実施形態］
図６に第３の実施形態を示す。第３の実施形態に係るステッピングモータ駆動制御装置４０は、第２の実施形態における電流制御器３２の代わりに、速度サーボ駆動用電流制御器３２ａとマイクロステップ駆動用電流制御器３２ｂの２つの電流制御器を設けたものである。
速度サーボ駆動用電流制御器３２ａは、第１の電流指示作成器２３から出力された交流電流指示と、電流検出器３４によって検出したステッピングモータ３５の実電流ｉＮとから速度サーボ駆動用指令ＶｓＮを形成し、スイッチ３１を介してインバータ３３に出力するように構成されている。マイクロステップ駆動用電流制御器３２ｂは、第２の電流指示作成器３０から出力された交流電流指示と、電流検出器３４によって検出したステッピングモータ３５の実電流ｉＮとからマイクロステップ駆動用指令ＶｍＮを形成し、スイッチ３１を介してインバータ３３に入力するように構成されている。
【００４１】
図５を参照して説明した第２の実施形態においては、電流制御器３２が駆動方法切替スイッチ３１の後段に配置されているため、アナログ回路による電流制御も可能であり、高速な応答を実現することができる。これに対して、図６を参照して説明した第３の実施形態においては、電流制御器３２ａ，３２ｂが駆動方法切替スイッチ３１の前段に配置されているため、駆動指令を形成するための回路要素を全てデジタル回路によって構成することができる。
【００４２】
［第４の実施形態］
図７に第４の実施形態を示す。第４の実施形態に係るステッピングモータ駆動制御装置５０においては、位置検出器を設けずに、位置センサレス制御によって速度サーボ駆動を実現している。図７において、速度指示作成器５２に接続された減算器５３、速度制御器５４、電流制御器５５、適応オブザーバ５６、積分器５７、座標変換器５８は、第１の実施形態における速度サーボ駆動部４に対応する。電気角作成器５９、座標変換器６０、（図示しない）減算器を備えた電流制御器６１は第１の実施形態におけるマイクロステップ駆動部３に対応する。
【００４３】
定常状態のセンサレス駆動において、速度指示作成器５２は位置指示θ＊を入力として速度指示ωｓを算出して減算器５３に入力する。減算器５３は、速度指示作成器５２から出力された速度指示ωｓと、電流検出器６６によって検出された実電流ｉＮに基づいて推定された推定速度との差分を算出して速度制御器５４に出力する。速度制御器５４は、ＰＩ制御器を備え、入力された差分に対してＰＩ制御を行なってトルク分電流指示を形成し、該トルク分電流指示を電流制御器５５に出力している。
【００４４】
電流制御器５５は、ＰＩ制御器を備え、予め設定され又は算出された推定励磁分電流指示及びトルク分電流指示と、電流検出器６６によって検出された実電流から算出された励磁分電流及びトルク分電流との差分を算出してＰＩ制御を実行し、ｄｑ軸電圧指示Ｖｄｑｓを形成して出力している。ｄｑ軸電圧指示Ｖｄｑｓはスイッチ６４を介して座標変換器６７に入力される。座標変換器６７には、さらにスイッチ６５を介して、電流検出器６６によって検出された実電流ｉＮに基づいて推定された推定電気角が入力される。
【００４５】
座標変換器６７はｄｑ軸電圧指示Ｖｄｑｓと推定電気角とを入力としてｄｑ−３相変換を実行し、センサレス駆動用指令ＶｓＮをＰＷＭインバータ６８に入力する。ＰＷＭインバータ６８はセンサレス駆動用指令ＶｓＮを電力増幅し、ステッピングモータ５１をセンサレス駆動する。
【００４６】
前記推定速度及び前記推定電気角は、適応オブザーバ５６によって算出される。適応オブザーバ５６には電流検出器６６によって検出された実電流が座標変換器５８を介して入力される。座標変換器５８はフィードバックされた推定電気角と入力された実電流（相電流）とから、３相−ｄｑ変換を実行して、励磁分電流とトルク分電流（ｄｑ軸電流）とを算出して、適応オブザーバ５６に入力している。
【００４７】
適応オブザーバ５６は、入力された実電流（ｄｑ軸電流）と、電流制御器５５から出力されたｄｑ軸電圧指示Ｖｄｑｓの電圧とから推定速度を算出し、該推定速度を積分器５７を介して積分することによって推定電気角を算出している。
本実施形態のように、センサレス制御手段として適応オブザーバ５６を使用すると、各制御部分のゲイン設定が容易になる。
【００４８】
マイクロステップ駆動からセンサレス駆動に切り替えるときは、負荷推定器６２によって算出した負荷推定値Ｔｍに見合う積分初期値を速度制御器５４の積分器に設定する。本実施形態において、負荷推定器６２は、ステッピングモータ５１の各相への印加電圧、すなわち、マイクロステップ駆動指令ＶｍＮと、電流検出器６６で検出した実電流ｉＮとに基づいてステッピングモータ５１の回転子位置を推定し、推定した回転子位置と電気角作成器５９から出力された電気角指示θｍとの偏差から負荷角を求めて、マイクロステップ駆動時の負荷推定値Ｔｍを算出する。回転子位置の推定方法としては、例えば、特開２００４−１８０３５４号公報に開示された方法を用いることができる。
本実施形態では、電流制御器５５においてもＰＩ制御を実行しているため、電流制御器５５の積分器においても、負荷推定器６２で算出した負荷推定値Ｔｍに見合う積分初期値を設定する。
【００４９】
一般的に、マイクロステップ駆動からセンサレス駆動への切替時ほどではないが、センサレス駆動からマイクロステップ駆動へ切り替える際にも、速度変動が生じる可能性がある。本実施形態におけるステッピングモータ駆動制御装置５０は、センサレス駆動からマイクロステップ駆動への切替に起因する過渡現象についても抑制するために、以下のような処理を実行している。
【００５０】
センサレス駆動からマイクロステップ駆動への切替時に、電気角作成器５９が、センサレス駆動時におけるモータ５１の負荷の値を示す負荷推定値Ｔｓを、速度制御器５４から取得し、該推定負荷値Ｔｓと位置指示θ＊とに基づいて、該推定負荷値Ｔｓに見合う電流をステッピングモータ５１に流すように電気角指示θｍを形成する。速度制御器５４は前記速度指示ωｓと推定速度との差分に基づいて算出したトルク分電流に対して、予め与えられているモータ定数を乗じて負荷推定値Ｔｓを算出している。上記駆動方法の切替時に、電気角作成器５９が取得する負荷推定値Ｔｓは、センサレス駆動からマイクロステップ駆動へ切り替えられる直前に速度制御器５４によって算出された負荷推定値Ｔｓである。
【００５１】
電気角作成器５９には、さらに位置指示θ＊が入力される。この位置指示θ＊は、マイクロステップ駆動に切り替わる際に位置誤差調整器６９にも入力される。以下、位置誤差調整器６９について説明する。位置誤差調整器６９には、前記位置指示θ＊に加えて、適応オブザーバ５６から積分器５７を介して出力された推定電気角が入力される。
位置誤差調整器６９は、推定電気角と位置指示θ＊の偏差を算出して、電気角作成器５９に出力する。電気角作成器５９は入力された偏差を位置指示θ＊に加算する。電気角作成器５９は、前記偏差を加算した位置指示θ＊と負荷推定値Ｔｓとから、センサレス駆動時の負荷に見合う電流がモータ５１に流れるように、電気角指示（励磁電気角）θｍを形成して、座標変換器６０に出力している。
【００５２】
前記位置誤差調整器６９は、速度制御系であるセンサレス駆動と位置制御系であるマイクロステップ駆動とを切り替えるときに生じる演算誤差を解消する目的を有している。すなわち、センサレス駆動では、速度指示作成器５２を介して位置指示θ＊から速度指示ωｓを算出する等、位置と速度の変換を実行している。したがって、このような変換の過程で生じた演算誤差によって速度指示と位置指示の整合がとれなくなる可能性がある。
【００５３】
そこで、位置誤差調整器６９は、速度指示と位置指示の整合をとるために、入力された推定電気角と入力された位置指示θ＊との偏差を算出して、電気角作成器５９に出力している。そして、電気角作成器５９は該偏差を位置指示θ＊に加算して電気角指示θｍを形成している。これにより、マイクロステップ駆動に切り替えたときに、演算誤差等が解消された電気角指示θｍが出力されることになる。
【００５４】
［他の実施形態］
以上、本発明の実施形態について述べたが、本発明は既述の実施形態に限定されるものではなく、本発明の技術的思想に基づいて各種の変形及び変更が可能である。
例えば、上記実施形態における定常時の速度サーボ駆動及びマイクロステップ駆動は上記実施形態に限定されない。他の構成要素及び制御によって実行される様々な速度サーボ駆動及びマイクロステップ駆動を本発明に適用することができる。
【００５５】
上記第１〜第３の実施形態において、第４の実施形態と同様に、速度サーボ駆動からマイクロステップ駆動への切替に起因する過渡現象を抑制するための構成を備えても良い。この場合、第１〜第３の実施形態における速度制御器は、速度指示ωｓと回転子速度ωｒとの差分に基づいて算出したトルク分電流に対して、予め与えられているモータ定数を乗じて負荷推定値Ｔｓを算出する。負荷推定値Ｔｓを用いたマイクロステップ駆動用電気角の作成は第４の実施形態と同様の処理によって実行することができる。
【００５６】
上記第４の実施形態では、位置誤差調整器６９は、速度サーボ駆動からマイクロステップ駆動へ切り替えたときに動作している。しかしながら、位置誤差調整器６９は速度サーボ駆動中に動作して位置誤差を調整することもできる。この場合、位置誤差調整器６９は、速度サーボ駆動中において、位置指示θ＊と推定電気角の偏差を算出して速度指示作成器５２に出力する。速度指示作成器５２は該偏差を位置指示θ＊に加算して該偏差を加算した位置指示θ＊から速度指示を算出することによって、演算誤差等が補正された速度指示を出力する。このように、速度サーボ駆動中に速度指示作成器５２から出力される速度指示が位置誤差調整器６９を介してすでに調整されている場合には、マイクロステップ駆動へ切り替える際に、推定電気角の位置指示θ＊に対する誤差等を補正する必要はない。したがって、上記第４の実施形態において、速度サーボ駆動中に位置誤差調整器６９を介して上記速度指示を調整した場合には、位置誤差調整器６９は、前記偏差を電気角作成器５９に出力する必要はない。
【００５７】
上記第４の実施形態において、速度サーボ駆動時の負荷推定値Ｔｓは速度制御器５４においてトルク分電流に基づいて算出されているが、これに限定されない。例えば、座標変換器５８から出力されるトルク分電流に、任意の演算手段を介してモータ定数を乗じることによって速度サーボ駆動時の負荷推定値Ｔｓを算出し、該算出した負荷推定値Ｔｓを電気角作成器５９に入力するように構成しても良い。
【図面の簡単な説明】
【００５８】
【図１】第１の実施形態に係るステッピングモータ駆動制御装置のブロック図である。
【図２】マイクロステップ駆動を実行した場合と速度サーボ駆動を実行した場合における、効率とトルクの関係を示すグラフである。
【図３】サーボ駆動方式として位置制御を実行した場合における、サーボモータの慣性負荷によるステップ応答シミュレーションの結果を示すグラフである。
【図４】サーボ駆動方式として速度制御を実行した場合における、サーボモータの慣性負荷によるステップ応答シミュレーションの結果を示すグラフである。
【図５】第２の実施形態に係るステッピングモータ駆動制御装置のブロック図である。
【図６】第３の実施形態に係るステッピングモータ駆動制御装置のブロック図である。
【図７】第４の実施形態に係るステッピングモータ駆動制御装置のブロック図である。
【符号の説明】
【００５９】
１，２０，４０，５０ ステッピングモータ駆動制御装置
３ マイクロステップ駆動部
４ 速度サーボ駆動部
６，２５，６２ 負荷推定器
７，２４，６３ 駆動方法切替器
１１，３４，６６ 電流検出器
１２，３５，５１ ステッピングモータ
２，２１，５２ 速度指示作成器
２２，５４ 速度制御器
２７，２９，５９ 電気角作成器
３２，５５，６１ 電流制御器
５６ 適応オブザーバ
６９ 位置誤差調整器
【特許請求の範囲】
【請求項１】
マイクロステップ駆動と速度サーボ駆動とを切り替えてステッピングモータを制御するステッピングモータ駆動制御装置であって、
前記ステッピングモータに流れる実電流を検出する電流検出器と、
位置指示から形成された速度指示と、検出した前記実電流とに基づいて、前記ステッピングモータの各相に流す駆動電流を決定する第１の駆動指令を形成する速度サーボ駆動手段と、
予め設定又は算出された電流指示と、前記位置指示と、検出した前記実電流とに基づいて、前記ステッピングモータの各相に流す駆動電流を決定する第２の駆動指令を形成するマイクロステップ駆動手段と、
前記マイクロステップ駆動時における前記ステッピングモータの負荷を推定して負荷推定値を得る負荷推定器と
を備え、
前記速度サーボ制御手段は、マイクロステップ駆動から速度サーボ駆動に切り替えたときに、前記駆動電流を前記推定した負荷に見合う大きさに決定すべく、前記第１の駆動指令の形成要素として前記負荷推定値を用いるように構成されている、ステッピングモータ駆動制御装置。
【請求項２】
前記ステッピングモータの回転子位置を検出する位置検出器を備え、
前記負荷推定器は、検出した前記回転子位置と、前記位置指示との偏差から前記負荷推定値を算出することを特徴とする、請求項１に記載のステッピングモータ駆動制御装置。
【請求項３】
前記速度サーボ駆動手段は、前記検出した実電流から前記ステッピングモータの回転子速度を推定し、該推定した回転子速度を用いて前記第１の駆動指令を形成する、位置センサレス駆動を実行し、
前記負荷推定器は、前記第２の駆動指令と前記実電流とから前記ステッピングモータの回転子位置を推定して、該推定した回転子位置と前記位置指示との偏差から前記負荷推定値を算出することを特徴とする、請求項１に記載のステッピングモータ駆動制御装置。
【請求項４】
前記速度サーボ制御手段は、
前記速度指示と前記回転子速度との偏差にＰＩ補償を施すことによって得られるトルク分電流指示を用いて前記第１の駆動指令を形成すると共に、
前記速度サーボ駆動に切り替えたときに、前記負荷推定値を用いて前記ＰＩ補償のための積分要素の初期値を設定するように構成されていることを特徴とする、請求項１〜３のいずれか１項に記載のステッピングモータ駆動制御装置。
【請求項１】
マイクロステップ駆動と速度サーボ駆動とを切り替えてステッピングモータを制御するステッピングモータ駆動制御装置であって、
前記ステッピングモータに流れる実電流を検出する電流検出器と、
位置指示から形成された速度指示と、検出した前記実電流とに基づいて、前記ステッピングモータの各相に流す駆動電流を決定する第１の駆動指令を形成する速度サーボ駆動手段と、
予め設定又は算出された電流指示と、前記位置指示と、検出した前記実電流とに基づいて、前記ステッピングモータの各相に流す駆動電流を決定する第２の駆動指令を形成するマイクロステップ駆動手段と、
前記マイクロステップ駆動時における前記ステッピングモータの負荷を推定して負荷推定値を得る負荷推定器と
を備え、
前記速度サーボ制御手段は、マイクロステップ駆動から速度サーボ駆動に切り替えたときに、前記駆動電流を前記推定した負荷に見合う大きさに決定すべく、前記第１の駆動指令の形成要素として前記負荷推定値を用いるように構成されている、ステッピングモータ駆動制御装置。
【請求項２】
前記ステッピングモータの回転子位置を検出する位置検出器を備え、
前記負荷推定器は、検出した前記回転子位置と、前記位置指示との偏差から前記負荷推定値を算出することを特徴とする、請求項１に記載のステッピングモータ駆動制御装置。
【請求項３】
前記速度サーボ駆動手段は、前記検出した実電流から前記ステッピングモータの回転子速度を推定し、該推定した回転子速度を用いて前記第１の駆動指令を形成する、位置センサレス駆動を実行し、
前記負荷推定器は、前記第２の駆動指令と前記実電流とから前記ステッピングモータの回転子位置を推定して、該推定した回転子位置と前記位置指示との偏差から前記負荷推定値を算出することを特徴とする、請求項１に記載のステッピングモータ駆動制御装置。
【請求項４】
前記速度サーボ制御手段は、
前記速度指示と前記回転子速度との偏差にＰＩ補償を施すことによって得られるトルク分電流指示を用いて前記第１の駆動指令を形成すると共に、
前記速度サーボ駆動に切り替えたときに、前記負荷推定値を用いて前記ＰＩ補償のための積分要素の初期値を設定するように構成されていることを特徴とする、請求項１〜３のいずれか１項に記載のステッピングモータ駆動制御装置。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【公開番号】特開２０１０−２８９４９（Ｐ２０１０−２８９４９Ａ）
【公開日】平成２２年２月４日（２０１０．２．４）
【国際特許分類】
【出願番号】特願２００８−１８５９１４（Ｐ２００８−１８５９１４）
【出願日】平成２０年７月１７日（２００８．７．１７）
【出願人】（０００１０３７９２）オリエンタルモーター株式会社 (150)
【Ｆターム（参考）】
【公開日】平成２２年２月４日（２０１０．２．４）
【国際特許分類】
【出願日】平成２０年７月１７日（２００８．７．１７）
【出願人】（０００１０３７９２）オリエンタルモーター株式会社 (150)
【Ｆターム（参考）】
[ Back to top ]