(58)【調査した分野】(Int.Cl.,DB名)
【背景技術】
【0002】
サーボモータは、駆動装置のパワーアンプ(増幅器)から供給される駆動電流によって駆動する。一般的なパワーアンプは、リニアアンプとスイッチングアンプとに大別される。このうち、スイッチングアンプは、パワー素子(増幅素子)である出力スイッチング回路のスイッチング素子をオンオフ制御することによって、移動体に対する移動指令に従って指令装置から出力される指令信号に相応する駆動電流をサーボモータに供給する方式のパワーアンプである。
【0003】
現在の殆どのスイッチングアンプは、PWM方式(Pulse Width Modulation)によってスイッチング素子のオンオフの繰返し周波数であるスイッチング周波数が一定の状態の下で目標電流量の大きさに対応させて主にスイッチング素子のオン時間幅を変えることによって指令信号に相応する駆動電流をサーボモータに供給する構成を有している。
【0004】
ところで、三相交流同期モータでは、一次側電機子の三相各相の各励磁コイルにそれぞれ供給される位相が120度ずつずれている駆動電流は、電流値の総和が0になるようにパワーアンプから各励磁コイルに分配して出力される。例えば、特許文献1に開示されるように、パワーアンプは、位置速度制御系から出力された電流指令と、2相に設けられた電流検出器の値から算出される検出電流とを比較して目標電流量を生成し、その結果をPWM信号として各相の出力スイッチング回路に振り分けて供給するようにされている。
【0005】
PWM方式のパルス幅変調回路は、指令信号から三相各相の駆動電流の電流値の総和が0になるように各出力スイッチング回路毎のスイッチング素子のオン時間幅を演算してPWM信号を生成し、各相に分配して出力して各相のスイッチング回路毎に正極性スイッチと逆極性スイッチとを選択的に切り換えて導通する。
【0006】
したがって、スイッチングアンプでは、各出力スイッチング回路のスイッチング素子のスイッチング周波数が出力スイッチング回路から供給される駆動電流の振動の大きさに影響を与える。例えば、スイッチング周波数が高いほど、サーボモータに出力される駆動電流の振動の振幅が小さくなるとともに、指令信号に対する追従性が高くなる。その結果、指令信号に反応してサーボモータが指令信号のとおりに駆動するまでの応答速度がより速くなってサーボ制御における応答性能が向上する。
【発明を実施するための形態】
【0017】
図1は、本発明のサーボモータのパワーアンプの代表的な実施の形態を示す。サーボモータは、三相各相毎にそれぞれ設けられる励磁コイルで一次側電機子を構成する三相交流モータである。特に、実施の形態のパワーアンプにおけるサーボモータは、各励磁コイルをスター結線(Y結線)した構造であって、各相の推力の合計が指定の推力になるように同期をとって供給される構成の三相交流同期モータである。なお、二次側は、図示省略されている。
【0018】
本発明においては、パワーアンプ1と指令装置2を含んでモータ制御装置という。モータ制御装置は、サーボモータのフィードバック制御を行なう。モータ制御装置は、サーボモータの動作対象である移動装置の移動体を所望の移動量移動させる命令である移動指令を図示しない操作装置から受け取ってサーボモータを駆動する。本発明では、操作装置は、例えば、数値制御装置のような機器全体を操作するための制御手段を意味する。操作装置がなくても実施することができ、操作装置がないときは、移動指令を出力する手段をモータ制御装置に含ませるようにすることができる。
【0019】
指令装置2は、操作装置から移動指令X(t)を入力する。指令装置2は、サーボモータまたは移動体に並設される位置検出器から現在位置P(t)のデータを取得する。指令装置2は、必要に応じて速度検出器から現在速度V(t)のデータを取得する。指令装置2は、移動指令X(t)と現在位置P(t)とから位置偏差を得る。また、指令装置2は、移動指令X(t)の微分値である速度指令と現在位置P(t)の微分値である現在速度または速度検出器から得る現在速度V(t)とから速度偏差を得る。そして、指令装置2は、位置偏差と速度偏差に基づいて指令信号Qをパワーアンプ1に出力する
。
【0020】
パワーアンプ1は、
図1に示されるように、一次側電機子の三相各相のそれぞれに設けられる各励磁コイルL(Lu,Lv,Lw)をスター結線した構造の三相交流同期モータに電力を供給する。パワーアンプ1は、主に、電源回路3と、電流検出器4と、出力スイッチング回路5とで構成されている。電流検出器4は、三相中のU相とV相の2相の出力回路に設けられる。出力スイッチング回路5は、三相各相に設けられる。三相各相の各出力スイッチング回路5は、それぞれ、スイッチング素子駆動回路10を含む。
【0021】
電源回路3は、目標電流量に相応する所要の電力をサーボモータに供給する。電源回路3は、少なくとも、安定化回路30と、電流検出器4の複数の検出抵抗R
1あるいはホール素子のような電流検出子と、出力スイッチング回路5のパワー素子である複数のスイッチング素子SWと、を含む。電源回路3は、商用交流を整流して所定の直流電圧を出力し、または直接直流電源を入力する電圧源であって、三相交流同期モータの一次側電機子における励磁コイルLに駆動電流Iを供給する直流電源E
0を備えている。
【0022】
安定化回路30は、整流器(直流電源E
0)から出力される電源回路3における直流電圧の振動を除去して安定させる手段である。安定化回路30は、電源回路3の直流電圧の変化を吸収する所定の静電容量を有する電解コンデンサC
0と保護抵抗R
0との並列回路と、スイッチング素子SWの駆動にともなって発生するサージ電圧を吸収するための高応答性を有するフィルムコンデンサC
1とでなる。
【0023】
電流検出器4は、U相,V相,W相の三相のうちのU相とV相に設けられる。電流検出器4の電流検出子は、U相とV相の2相の出力回路の給電線SL
1,SL
2にそれぞれ設けられる。複数の電流検出器4は、各励磁コイルL(Lu,Lv)にそれぞれ供給される各駆動電流I(Iu,Iv)を検出して各々電流検出信号Si(Ui,Uv)を出力する。
【0024】
特に、実施の形態の電流検出器4は、出力スイッチング回路5の複数のスイッチング素子SWの高速のスイッチング動作に対応する速度で電流検出信号Si(Ui,Uv)を得るために、電流検出子として各励磁コイルL(Lu,Lv)に直列にそれぞれ検出抵抗R
1(Ru
1,Rv
1)を設けている。電流検出器4は、検出抵抗R
1(Ru
1,Rv
1)の両端にかかる電圧から所定期間に励磁コイルL(Lu,Lv)に供給される平均の駆動電流I(Iu,Iv)に対応する電流検出信号Si(Ui,Vi)を得る。
【0025】
三相中のU相とV相の2相の各出力回路に設けられる複数の電流検出器4は、それぞれ対応するスイッチング回路5のスイッチング素子駆動回路10に各電流検出信号Si(Ui,Vi)を出力する。検出抵抗R
1(Ru
1,Rv
1)は、駆動電流I(Iu,Iv)の電流値を制限することを目的としない可能な限り小さい抵抗値を有する。
【0026】
電流検出器4の電流検出子として電流プローブのような電流測定子を用いることができる。ただし、電流検出子が電流波形をより正確に測定するための電流測定子であるときは、測定される電流波形から電流検出信号を生成するので、電流検出子が検出抵抗である場合に比べて電流検出信号を得るまでにより長い時間を要する。そのため、電流測定子は、スイッチング素子SWにおける数100kHz以上の高周波のスイッチング周波数でのスイッチング動作が可能な範囲で電流検出子として使用されることが望ましい。
【0027】
出力スイッチング回路5は、U相,V相,W相の三相各相毎に設けられ、各励磁コイルL(Lu,Lv,Lw)にそれぞれ制御された駆動電流(Iu,Iv,Iw)を供給する。複数の出力スイッチング回路5は、それぞれ電源回路3の中に設けられているパワー素子である複数のスイッチング素子SWを含む。各スイッチング素子SWは、望ましくは、1MHz以上のスイッチング周波数でスイッチング動作できる特性を有する高速の電界効果トランジスタ(MOSFET)である。
【0028】
各出力スイッチング回路5の複数のスイッチング素子SWは、2個1組で両極性スイッチ20を形成する。スイッチング素子SWの両極性スイッチ20は、パワー素子を有し波形が制御された両極性の駆動電流Iを励磁コイルLに供給する出力回路である。両極性スイッチ20において、励磁コイルLの両端子のある一方の端子から他方の端子に流れる駆動電流Iの方向を順方向とするときに、このときの極性を正極性(正電位)とし、他方の端子から一方の端子に流れる駆動電流Iの方向を逆方向として、このときの極性を逆極性(負電位)とする。
【0029】
両極性スイッチ20は、具体的に、直流電源E
0の正極側と励磁コイルLの一端子との間に設けられ正極性スイッチである第1のスイッチング素子SW
1および直流電源E
0の負極側と励磁コイルLの上記同一端子との間に設けられ逆極性スイッチである第2のスイッチング素子SW
2との一対のスイッチング素子SWでなる。なお、正極性スイッチと逆極性スイッチは、それぞれ、スイッチング素子の負担を軽減するために、同時にオンオフする複数のスイッチング素子SWを直列に接続するように構成することができる。
【0030】
U相,V相,W相の三相の出力スイッチング回路5のうち、U相とV相の2相の各出力スイッチング回路5は、基本的に同じ構成を有し、それぞれ電流検出器4からフィードバック信号である電流検出信号Si(Ui,Vi)を入力して各スイッチング素子SWをスイッチング動作させる。W相のスイッチング回路5は、電流検出器4からのフィードバック信号を入力しない、いわゆるオープン制御回路である。
【0031】
具体的に、U相とV相の各出力スイッチング回路5においては、それぞれに設けられる各スイッチング素子駆動回路10は、移動指令X(t)に従う指令信号Q(Qu,Qw)に相応する目標電流量と電流検出器4から出力される電流検出信号Si(Ui,Vi)に相応する検出電流量との差に応じて制御信号Agate,Bgateを供給する。
【0032】
スイッチング素子駆動回路10は、上記制御信号Agate,Bgateを各励磁コイルL(Lu,Lv)に供給される駆動電流I(Iu,Iv)の極性に対応して両極性スイッチ20の第1のスイッチング素子SW
1(SWu
1,SWv
1)と第2のスイッチング素子SW
2(SWu
2,SWv
2)との何れか一方が導通するように予め定められた所定のスイッチング周波数のタイミングで各スイッチング素子SWに選択的に繰返し供給する。
【0033】
W相のスイッチング素子駆動回路10は、指令装置2から出力されてくる移動指令X(t)に従う指令信号Q(Qw)に相応する目標電流量に応じて所定のスイッチング周波数のタイミングで制御信号Agate,Bgateをそれぞれ出力し、駆動電流Iwの極性に対応して両極性スイッチ20の第1のスイッチング素子SW
1(SWw
1)と第2のスイッチング素子SW
2(SWw
2)を選択的に導通させる。
【0034】
U相,V相,W相の三相各相のスイッチング素子駆動回路10は、指令信号Qで示される目標電流量の極性が正極性であるときは、正極性スイッチである第1のスイッチング素子SW
1を所定のスイッチング周波数のタイミングでオンオフするように制御信号Agateを出力し、逆極性スイッチの第2のスイッチング素子SW
2に制御信号Agateを反転した制御信号Bgateを出力する。
【0035】
ここで、本発明において、制御信号Agate,Bgateを各スイッチング素子SWに供給または出力するということは、電気的に厳密には、出力電圧が“1”または“H”であるときにスイッチング素子SWをオンさせ、“0”または“L”であるときにスイッチング素子SWをオフさせるようにするという意味である。
【0036】
スイッチング素子駆動回路10は、目標電流量の極性が逆極性であるときは、逆極性スイッチである第2のスイッチング素子SW
2を所定のスイッチング周波数のタイミングでオンオフするように制御信号Bgateを出力し、正極性スイッチの第1のスイッチング素子SW1に制御信号Bgateを反転した制御信号Agateを出力する。
【0037】
実施の形態のスイッチング素子駆動回路10は、極性切換回路20の正極性スイッチと逆極性スイッチとを選択的に切り換えるときに、数マイクロ秒以下の僅かな時間だけ両極性スイッチ20の一対のスイッチング素子SWを強制的にオフさせるようにしている。本発明では、駆動電流Iの方向が変わるときに、極性切換回路20の全てのスイッチング素子をオフさせておく短い時間を“デッドタイム”という。
【0038】
実施の形態のパワーアンプ1では、スイッチング素子駆動回路10から制御信号が直接出力されるので、出力スイッチング回路5のスイッチング素子SWのスイッチング動作が実質的にキャリア周波数の制約を受けない。そのため、基本的にスイッチング素子SWを100kHz以上のスイッチング周波数でスイッチング動作させることができる。
【0039】
したがって、実施の形態のパワーアンプ1では、電流の振動の振幅をより小さくすることができる。電流の振動の振幅が小さいときは、全てのスイッチング素子SWがオフする時間的な損失を生じさせるデッドタイムを設けないようにすることができる。実施の形態の各出力スイッチング回路5におけるスイッチング素子駆動回路10は、必要に応じてデッドタイムを設定することができるように構成されている。
【0040】
図2および
図3は、実施の形態のパワーアンプにおける各信号の関係を示す。ただし、各信号の波形は、わかりやすくするために、部分的に強調するようにデフォルメされており、実際の波形を正確に表しているわけではない。
図3は、U相の励磁コイルに駆動電流を供給するスイッチング回路の各信号を示している。なお、W相の出力回路における各信号の関係は、制御信号が電流検出器の検出電流量に依存しない点を除いて、U相の出力回路と基本的に同じである。以下に、各図を適宜引用して、実施の形態のパワーアンプの動作を説明する。
【0041】
指令装置2は、操作装置から移動指令X(t)を入力し、フィードバック信号として図示しない位置検出器から現在位置P(t)を入力する。また、必要に応じて速度検出器から現在速度V(t)を入力する。指令装置2は、移動指令X(t)と現在位置P(t)と、現在速度(V)およびそれぞれの微分値と所定のゲインから演算した結果に基づいて指令信号Qを得る。
【0042】
指令装置2は、一次側電機子の励磁コイルLと図示しない二次側磁石との相対位置に対応して、指令信号Q(Qu,Qv,Qw)を三相各相の各励磁コイルL(Lu,Lv,Lw)にそれぞれ駆動電流(Iu,Iv,Iw)を供給する各出力スイッチング回路5のスイッチング素子駆動回路10に分配して出力する。
【0043】
各指令信号Q(Qu,Qv,Qw)は、
図2に示されるように、各励磁コイルL(Lu,Lv,Lw)にそれぞれ供給される駆動電流I(Iu,Iv,Iw)の電流値の総和が0である目標電流量に相当する。例えば、
図2示される時刻t
1では、位相が120度ずつずれている三相各相に供給されるべき駆動電流I(Iu+Iv+Iw=0)を得ることができる。
【0044】
U相とV相の各スイッチング素子駆動回路10は、指令装置2から分配して出力されてくる目標電流量に相応する指令信号Q(Qu,Qv)をそれぞれ入力する。また、各スイッチング駆動回路10は、それぞれ電流検出器4から検出電流量に相応する電流検出信号Si(Ui,Vi)を入力する。
【0045】
各スイッチング素子駆動回路10は、電流検出信号Siが示す検出電流量が指令信号Qが示す目標電流量未満であるときに出力値が“1”の比較信号を出力し、目標電流量以上であるときに出力値が“0”の比較信号を出力する。この比較信号に基づいて、制御信号Agate,Bgateが予め設定されているスイッチング周波数F(t)のタイミングで各スイッチング素子SWに供給される。
【0046】
三相各相の励磁コイルLがスター結線またはデルタ結線されているサーボモータが制御対象であるので、W相の励磁コイルLwに実際に供給される駆動電流Iwは、U相とV相の各励磁コイルLu,Lvに供給される駆動電流Iu,Ivによって決まる。したがって、W相の出力スイッチング回路5のスイッチング素子駆動回路10は、検出電流量に依存せずに供給されるべき電流制御量を示す指令信号Qwに従って制御信号Agate,Bgateを出力する。
【0047】
このように、実施の形態のパワーアンプは、スイッチング素子駆動回路において比較信号に基づいて制御信号を出力するので、パワーアンプには、指令装置において電流フィードバック信号を入力し、各出力スイッチング回路毎のスイッチング素子のオン時間幅を演算して電圧信号を生成し、各出力スイッチング回路に電圧信号を分配して出力するという一連の動作が要求されない。
【0048】
したがって、実施の形態のパワーアンプは、PWM方式のパワーアンプに比べて、より短い時間間隔で制御信号を連続的に繰返し供給することができる。そのため、実施の形態のパワーアンプでは、100kHz以上のより高いスイッチング周波数でスイッチング素子を動作させることができる。
【0049】
各出力スイッチング回路5において、駆動電流I(Iu,Iv,Iw)の方向が順方向であるときは、指令信号Q(Qu,Qv,Qw)に対応して両極性スイッチの正極性スイッチである第1のスイッチング素子SW
1(SWu
1,SWv
1,SWw
1)に出力値が“1”の制御信号Agateが出力される。一方、逆極性スイッチである第2のスイッチング素子SW
2(SWu
2,SWv
2,SWw
2)には、制御信号Agateを反転させた出力値が“0”の制御信号Bgateが出力される。
【0050】
デッドタイムが予め設定されているときは、スイッチング素子駆動回路10は、デッドタイムの期間だけ両極性スイッチ20の第1のスイッチング素子SW
1(SWu
1,SWv
1,SWw
1)と第2のスイッチング素子SW
2(SWu
2,SWv
2,SWw
2)とが同時にオンしないように、制御信号Agateまたは制御信号Bgateの出力値を“0”から“1”に切り換えるときに、切換えをデッドタイムの時間幅dtだけ遅延させる。
【0051】
出力値が“1”の制御信号Agateが供給された第1のスイッチング素子SW
1(SWu
1,SWv
1,SWw
1)でなる正極性スイッチが導通し、制御信号Agateが反転された出力値が“0”の制御信号Bgateが供給された第2のスイッチング素子SW
2(SWu
2,SWv
2,SWw
2)でなる逆極性スイッチが非導通であるとき、直流電源E
0から駆動電流I(Iu,Iv,Iw)が供給される。
【0052】
このとき、U相とV相の各出力スイッチング回路5においては、電流検出器4の電流検出信号Si(Ui,Vi)で示される検出電流量が指令信号Q(Qu,Qv)で示される目標電流量を超えた時点でスイッチング素子駆動回路10が制御信号Agateの出力値を“0”にし、デッドタイムの時間幅dtを経過した後に制御信号Bgateの出力を“1”にするので、正極性スイッチが非導通になり、逆極性スイッチが導通する。
【0053】
例えば、U相の出力スイッチング回路5においては、
図3に示されるように、デッドタイムの時間幅dtが経過した後に第1のスイッチング素子SWu
1に出力値が“1”の制御信号Agate(U)が出力されて正極性スイッチが導通する。一方、第2のスイッチング素子SWu
2に出力値が“0”の制御信号Bgate(/U)が出力されて正極性スイッチが導通する。その結果、電源回路3の立上がり特性に対応して駆動電流Iuが立ち上がる。
【0054】
駆動電流Iuが指令信号Quで示される目標電流量に到達すると、電流検出器4の電流検出信号Uiで示される検出電流量が目標電流量を超えるので、スイッチング素子駆動回路10における比較信号の出力値が“0”になり、制御信号Agate(U)の出力値が“0”になるとともに制御信号Bgate(/U)の出力値が“1”になる。その結果、駆動電流Iuが降下するので、比較信号の出力値が“1”になる。
【0055】
このとき、予め設定されている所定のスイッチング周波数F(t)に従うオフ期間中は、制御信号Agate(U)の出力値が“0”であるので、駆動電流Iuが降下を続ける。所定のスイッチング周波数F(t)に従うオン時間になると、第2のスイッチング素子SWu
2に出力値が“0”の制御信号Bgateが出力される。デッドタイム経過後、第1のスイッチング素子SWu
1に出力値が“1”の制御信号Agate(U)が供給され、正極性スイッチが再び導通する。
【0056】
このようにして、供給される駆動電流Iuが目標電流量Quであるように正極性スイッチが導通のときに逆極性スイッチが非導通であり、正極性スイッチが非導通のときに逆極性スイッチが導通であることを繰り返して、駆動電流Iuが上昇と下降を繰り返す。
【0057】
スイッチング周波数F(t)が高いほど指令信号Quに対して供給される駆動電流Iuの振動の振幅が小さくなり、指令信号Quに対する駆動電流Iuの追従性が高くなる。実施の形態のパワーアンプ1は、スイッチング素子が1MHzのスイッチング周波数でスイッチング動作できる性能を有し、予め設定される所定のスイッチング周波数が100kHz以上の高周波であるため、目標電流量Quに対する駆動電流Iuの誤差がより小さい。その結果、サーボ制御の応答性能が向上する。
【0058】
以上のように駆動電流が供給されるサーボモータは、予め設定されている加速度で加速して目標速度で駆動し、目標位置で停止するように減速して、目標位置で停止するように制御される。そして、サーボモータによって移動する移動体は、操作装置から与えられる移動指令X(t)に従う移動量を所定速度で移動して停止する。
【0059】
フィードバック制御されているサーボモータは、移動体をある目標位置に位置決めするために、移動体を目標位置に留めるように駆動する。このとき、移動体が高加速度で高速で移動するほど、制御における遅延時間によって移動体を目標位置に留めておくための反応が遅れる。そのため、サーボ制御の応答性能が高くなるほど、移動体を目標位置の近くに留めておくことができる。したがって、実施の形態のパワーアンプ1によると、高速で移動する移動体の位置決め精度をより高くすることができる。
【0060】
以上のように、本発明のサーボモータのパワーアンプによると、スイッチング周波数をより高くすることができ、サーボ制御の応答性能が向上し、ひいては移動体の位置決め精度を高くすることができる。すでに、いくつかの例が具体的に示されているが、本発明は、実施の形態のパワーアンプと同一の構成に限定されず、本発明の技術思想を逸脱しない範囲で、実施の形態のパワーアンプの構成を変形することができる。
【0061】
本発明のパワーアンプは、一次側電機子の励磁コイルが実質3線で結線されている結線構造のサーボモータに適用される。言い換えると、三相交流のU相とV相の2相において制御された駆動電流をそれぞれ供給するときに、残り1相のW相の駆動電流が決まるような態様のサーボモータに適する。例えば、実施の形態のパワーアンプにおいて、スター結線構造のサーボモータをデルタ結線構造(三角結線)のサーボモータに置き換えることができる。