JP2002199771A - アクチュエータ装置 - Google Patents

アクチュエータ装置

Info

Publication number
JP2002199771A
JP2002199771A JP2001347996A JP2001347996A JP2002199771A JP 2002199771 A JP2002199771 A JP 2002199771A JP 2001347996 A JP2001347996 A JP 2001347996A JP 2001347996 A JP2001347996 A JP 2001347996A JP 2002199771 A JP2002199771 A JP 2002199771A
Authority
JP
Japan
Prior art keywords
rotor
torque
phase
rotor shaft
current
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2001347996A
Other languages
English (en)
Other versions
JP3402597B2 (ja
Inventor
Shinji Ishii
眞二 石井
Yoshihiro Kuroki
義博 黒木
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Sony Corp
Original Assignee
Sony Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Sony Corp filed Critical Sony Corp
Priority to JP2001347996A priority Critical patent/JP3402597B2/ja
Publication of JP2002199771A publication Critical patent/JP2002199771A/ja
Application granted granted Critical
Publication of JP3402597B2 publication Critical patent/JP3402597B2/ja
Anticipated expiration legal-status Critical
Expired - Lifetime legal-status Critical Current

Links

Landscapes

  • Control Of Motors That Do Not Use Commutators (AREA)
  • Permanent Magnet Type Synchronous Machine (AREA)
  • Brushless Motors (AREA)
  • Control Of Ac Motors In General (AREA)

Abstract

(57)【要約】 【課題】アクチュエータシステムの構成を簡易化させ得
るアクチュエータ装置を実現し難かった。 【解決手段】アクチュエータ装置において、ステータに
駆動電流を供給する駆動回路と、予め与えられた制御ゲ
インパラメータを用いて駆動回路に与える電流指令値を
算出する演算手段とをハウジングに設けるようにした。
またアクチュエータ装置において、ハウジングに設けら
れ、ステータに駆動電流を供給する駆動回路と、ハウジ
ングに設けられ、予め与えられた制御ゲインパラメータ
を用いて駆動回路に与える電流指令値を決定する演算手
段と、トルク増幅手段に設けられ、出力軸の回転角度を
検出する回転角度検出手段とを設け、演算手段が、予め
与えられたトルク増幅手段の数学的モデルを用いて回転
角度検出手段の検出結果からトルク増幅手段の出力軸に
与えられた外力の推定値を算出し、当該推定結果に応じ
て電流指令値を決定するようにした。

Description

【発明の詳細な説明】
【0001】
【発明の属する技術分野】本発明はアクチュエータ装置
に関し、例えばAC(Alternating Current )サーボモ
ータに適用して好適なものである。
【0002】
【従来の技術】従来、ACサーボモータにおいては、回
転自在に枢支されたロータと、当該ロータを取り囲むよ
うに所定間隔で固定配設された複数のステータ鉄心及び
各ステータ鉄心にそれぞれ巻回された複数のコイルから
なるステータとがモータケース内部に一体に収納される
ことにより構成されている。
【0003】またACサーボモータにおいては、通常、
モータケースの外部におけるロータの軸(以下、これを
ロータ軸と呼ぶ)の反回転トルク出力側にロータ軸の回
転位置を検出する回転位置センサが設けられている。
【0004】そしてこのようなACサーボモータを用い
たアクチュエータシステムでは、ACサーボモータとは
別体にコントローラが設けられ、このコントローラにお
いてACサーボモータの回転位置センサから出力される
センサ信号を利用しながら所望回転出力を得るための各
種演算処理を実行し、当該演算結果に基づく駆動電流を
コントローラからACサーボモータに与えるようにして
当該ACサーボモータを回転制御するようになされてい
た。
【0005】
【発明が解決しようとする課題】ところがかかるアクチ
ュエータシステムでは、コントローラ及びACサーボモ
ータ間を接続するケーブルとして、回転駆動用(コイル
用)に3本、回転位置センサ用に4本から12本の合計7
本から15本の比較的太い線材を必要とし、しかもこの線
材として、ノイズ等の影響や機械的振動による断線対策
を考慮した特殊なケーブル仕様のものが必要となる問題
があった。
【0006】またかかるアクチュエータシステムにおい
ては、このようなACサーボモータ及びコントローラ間
の配線に加えて、当該コントローラ及びさらに上位のコ
ントローラ間の交信用配線等が必要であり、このためシ
ステム全体としての配線が多いことから構成が煩雑で組
立性が悪い問題があった。
【0007】さらにかかるアクチュエータシステムにお
いては、構造的にACサーボモータのロータ及び回転位
置センサが離れた位置に配置されるために、高精度かつ
高速に位置決めを行い得るようにするためにはACサー
ボモータのロータ軸を太くし、かつその結合部の構造材
としても機械的剛性の高いものが必要となるために、シ
ステム全体として重くかつ大きくなる問題があった。
【0008】さらにかかるアクチュエータシステムにお
いては、回転位置センサが大きく、重いために、高速な
位置決めを行い得るようにするためには、ACサーボモ
ータとして大きいものが必要となり、しかもその軸受け
として高剛性のものが必要となる問題があった。
【0009】さらにかかるアクチュエータシステムにお
いては、ACサーボモータが駆動時に発熱するために当
該ACサーボモータに与える駆動電流の最大値が制限さ
れるが、実際上は最大の駆動電流値に対して安全率を含
んだ低い電流しかACサーボモータに与えることができ
ないために、出力トルクに制限を受ける問題があった。
【0010】本発明は以上の点を考慮してなされたもの
で、アクチュエータシステムの構成を簡易化させると共
に、性能を向上させながら容易に小型化させ得るアクチ
ュエータ装置を提案しようとするものである。
【0011】
【課題を解決するための手段】かかる課題を解決するた
め本発明においては、回転自在に枢支されたロータと、
ロータにトルクを発生させるステータとがハウジング内
に収納されたアクチュエータ装置において、ステータに
駆動電流を供給する駆動回路と、予め与えられた制御ゲ
インパラメータを用いて駆動回路に与える電流指令値を
算出する演算手段とをハウジングに設けるようにした。
この結果、このアクチュエータ装置では、当該アクチュ
エータ装置を制御する演算手段を一体とすることができ
る。
【0012】また本発明においては、回転自在に枢支さ
れたロータと、ロータにトルクを発生させるステータ
と、ロータ及びステータを収納するハウジングと、ロー
タに発生したトルクを増幅して出力軸を介して出力する
トルク増幅手段を有するアクチュエータ装置において、
ハウジングに設けられ、ステータに駆動電流を供給する
駆動回路と、ハウジングに設けられ、予め与えられた制
御ゲインパラメータを用いて駆動回路に与える電流指令
値を決定する演算手段と、トルク増幅手段に設けられ、
出力軸の回転角度を検出する回転角度検出手段とを設
け、演算手段が、予め与えられたトルク増幅手段の数学
的モデルを用いて回転角度検出手段の検出結果からトル
ク増幅手段の出力軸に与えられた外力の推定値を算出
し、当該推定結果に応じて電流指令値を決定するように
した。この結果、このアクチュエータ装置では、当該ア
クチュエータ装置を制御する演算手段を一体とすること
ができる。
【0013】
【発明の実施の形態】以下図面について、本発明の一実
施の形態を詳述する。
【0014】(1)本実施の形態によるACサーボモー
タの構成 図1において、1は全体として本実施の形態によるAC
サーボモータを示し、回転トルクを発生させるモータ部
2と、当該モータ部2において発生された回転トルクを
増幅して出力するトルク増幅部3とから構成されてい
る。
【0015】モータ部2においては、金属等の導電材か
らなるモータケース4の内部に回転軸受け5A、5Bに
より回転自在に枢支されたロータ軸6が設けられ、当該
ロータ軸6にロータ基体7及び図2(B)及び(C)の
ように4極に着磁されたリング状の永久磁石でなるロー
タマグネット8が同軸に一体化されることによりロータ
9が形成されている。
【0016】またモータケース4の内側には、図3及び
図4(A)に示すように、ロータ9を取り囲むように6
つのステータ鉄心10A〜10Fが等間隔(60〔°〕間
隔)で固着されると共に、これら各ステータ鉄心10
(10A〜10F)には、それぞれ巻線が施されること
によりコイル11(11A〜11F)が形成されてい
る。
【0017】これによりモータ部2においては、180
〔°〕対向する2つのコイル11(11A及び11D、
11B及び11E、11C及び11F)の組(合計3組
ある)をそれぞれU相、V相及びW相として、これらU
相、V相及びW相の各コイル11にそれぞれ120 〔°〕
ずつ位相がずれた駆動電流を印加して各コイル11に駆
動電流の電流値に応じた強さの磁界を発生させることに
よってロータ9を介して駆動電流の電流値に応じた大き
さの回転トルクを発生させることができるようになされ
ている。
【0018】一方トルク増幅部3においては、図1及び
図5(A)〜(C)に示すように、モータケース4の先
端部に着脱自在に固定されたギアケース12を有する。
そしてこのギアケース12の内部には、当該ギアケース
12の内側面に固定された環状の内歯車13と、ロータ
軸6の先端部に固定された太陽歯車14と、内歯車13
及び太陽歯車14間に120 〔°〕間隔で配置された第1
〜第3の遊星歯車15A〜15Cとからなる遊星歯車機
構16が設けられている。
【0019】また遊星歯車機構16の第1〜第3の遊星
歯車15A〜15Cの各軸17A〜17Cは、それぞれ
ギアケース12の先端に回転自在に配置された出力軸1
8に固定されている。
【0020】これによりこのトルク増幅部3において
は、モータ部2からロータ軸6を介して与えられる回転
トルクを、遊星歯車機構16を介して増幅して出力軸1
8に伝達し、当該出力軸18を介して外部に出力し得る
ようになされている。
【0021】またトルク増幅部3には、出力軸18に固
着された環状の樹脂マグネット19と、当該樹脂マグネ
ット19の外周面と対向するようにギアケース12の外
周面に固着された第1及び第2の磁気センサ(以下、ホ
ール素子とする)20A、20Bとからなる1回転絶対
角度センサ21が設けられている。
【0022】この場合樹脂マグネット19は、図5
(A)のように2極にかつ一周に亘って磁束密度φ(θ
g )が図6のように変化するように着磁されると共に、
第1及び第2のホール素子20A、20Bは、図5
(B)のように90〔°〕の位相差をもってギアケース1
2の外周面に固着されている。
【0023】これにより1回転絶対角度センサ21にお
いては、出力軸18の回転変位を、当該出力軸18の回
転に伴う第1及び第2のホール素子20A、20Bの配
設位置における磁束密度φ(θg )の変化として検出
し、検出結果を第1及び第2のホール素子20A、20
Bからそれぞれ図7に示すようなそれぞれsin(θ
g)及びcos(θg )で与えられる波形の第1及び第
2の1回転絶対角度センサ信号S1A、S1Bとして出
力することができるようになされている。
【0024】かかる構成に加えこのACサーボモータ1
の場合、モータ部2のモータケース4の内部には、ロー
タ軸6の磁極角度を検出するロータ軸磁極角度センサ2
2と、外部の上位コントローラ(図示せず)からの指令
に基づいて出力軸6の回転角度、回転速度及び回転トル
ク等を制御する制御基板23と、制御基板23の制御の
もとにモータ部2の各コイル11に駆動電流を供給する
パワー基板24とが収納されている。
【0025】この場合ロータ軸磁極角度センサ22は、
ロータ9のロータ基体7の前端面に固着された樹脂マグ
ネット25と、制御基板23に搭載された第1〜第4の
磁気センサ(以下、ホール素子とする)26A〜26D
とから形成されている。そして樹脂マグネット25は、
図2(B)及び(C)に示すように、ロータ9のロータ
マグネット8と同じ4極に着磁され、当該ロータマグネ
ット8と同位相でロータ基体7に固着されている。
【0026】また第1〜第4のホール素子26A〜26
Dは、図8(B)に示すように、ロータ軸6と同心円上
に、第1及び第2のホール素子26A、26Bが180
〔°〕対向し、かつ第3及び第4のホール素子26C、
26Dがこれら第1及び第2のホール素子26A、26
Bと同じ方向に45〔°〕位相がずれた位置に位置するよ
うに制御基板23に搭載されている。
【0027】これによりこのロータ軸回転角度センサ2
2においては、ロータ軸6の磁極角度を、当該ローラ軸
6と一体に回転する樹脂マグネット25の回転に伴う第
1〜第4のホール素子26A〜26Dの配設位置におけ
る磁束密度の変化として検出し得るようになされてい
る。
【0028】なおロータ軸6の磁極角度とは、ロータ軸
6の機械的な回転角度にロータマグネット8の磁極数の
半分の値を掛けた角度((2)式参照)と定義する。こ
の実施の形態においては、ロータマグネット8が4極に
着磁されているため、磁気角度は0から2πまでの範囲
の値をとる。
【0029】一方制御基板23は、図1、図2(A)、
図8及び図9に示すように、環状に形成されたプリント
配線板の一面側に1チップマイクロコンピュータ27及
びクロック発生用の水晶発振器28が搭載されると共
に、他面側に上述のロータ軸回転角度センサ22の第1
〜第4のホール素子26A〜26Dと、樹脂マグネット
25の温度を検出する温度センサ29とが搭載されるこ
とにより構成されている。
【0030】そしてこの制御基板23においては、図9
のようにロータ軸磁極角度センサ22における第1及び
第2のホール素子26A、26Bの出力と、第3及び第
4のホール素子26C、26Dの出力とをそれぞれ第1
及び第2の減算回路30A、30Bを介して加算して第
1及び第2のロータ軸磁極角度センサ信号S2A、S2
Bとして1チップマイクロコンピュータ27に取り込
み、かつ1回転絶対角度センサ21(図1、図5
(C))からケーブル31(図1)を介して供給される
第1及び第2の1回転絶対角度センサ信号S1A、S1
Bを1チップマイクロコンピュータ27に取り込み得る
ようになされている。
【0031】また制御基板23においては、2本の電源
ライン、1本の汎用のパラレル通信ライン、2本のRS
−232Cシリアル通信ライン及び3本の同期式シリア
ル通信ラインを有する第2のケーブル32(図1)を通
じて上位コントローラと接続されており、かくして1チ
ップマイクロコンピュータ27がこの第2のケーブル3
2を介して駆動電圧を入力し、かつ上位コントローラと
交信することができるようになされている。
【0032】そして1チップマイクロコンピュータ27
は、この第2のケーブル32を介して上位コントローラ
から与えられる出力軸18(図1)の回転角度、回転速
度又は回転トルクの指定値(以下、これらをそれぞれ指
定回転角度、指定回転速度及び指定回転トルクと呼ぶ)
と、第1及び第2の1回転絶対角度センサ信号S1A、
S1Bと、第1及び第2のロータ軸磁極角度センサ信号
S2A、S2Bと、後述のようにパワー基板24から供
給される第1〜第3の駆動電流検出信号S3A〜S3C
とに基づいて、U相、V相及びW相の各コイル11にそ
れぞれ印加すべき駆動電流の電流値(以下、これらをそ
れぞれ第1〜第3の電流指令値と呼ぶ)を算出し、これ
ら算出した第1〜第3の電流指令値を第3のケーブル3
3を介してパワー基板24に送出するようになされてい
る。
【0033】パワー基板24においては、図1、図4
(B)及び(C)に示すように、環状に形成されたプリ
ント配線板の一面側に図10に示すコイル駆動ブロック
34を形成する複数のパワートランジスタチップ35が
搭載されることにより構成されている。
【0034】そしてこのコイル駆動ブロック34は、制
御基板23の1チップマイクロコンピュータ27から与
えられる第1〜第3の電流指令値に基づいて、モータ部
2のU相、V相及びW相の各コイル11に対してそれぞ
れ対応する電流値の駆動電流を印加することによりモー
タ部2のロータ9を回転駆動させる。
【0035】またこの際コイル駆動ブロック34は、こ
のときU相、V相及びW相の各コイル11にそれぞれ印
加されている駆動電流の電流値をそれぞれ検出し、検出
結果を第1〜第3の駆動電流検出信号S3A〜S3Cと
して第3のケーブル33(図1)を介して制御基板23
に送出する。
【0036】このようにしてこのACサーボモータ1で
は、制御基板23の1チップマイクロコンピュータ27
及びパワー基板24のコイル駆動ブロック34からなる
制御回路によって、上位コントローラから与えられた指
定回転角度、指定回転速度又は指定回転トルクに応じて
モータ部2を駆動する。
【0037】(2)1チップマイクロコンピュータ27
及びコイル駆動ブロック34の構成 ここで1チップマイクロコンピュータ27は、図11に
示すように、演算処理ブロック40、レジスタ41、ロ
ータ軸回転角度検出処理ブロック42、トルク−3相電
流信号変換処理ブロック43、電流制御処理ブロック4
4及び第1〜第4のアナログ/ディジタル変換回路45
〜48から構成されている。
【0038】そして1チップマイクロコンピュータ27
では、1回転絶対角度センサ21(図1、図5(C))
から供給される第1及び第2の1回転絶対角度センサ信
号S1A、S1Bを第3のアナログ/ディジタル変換回
路47においてディジタル変換し、得られた第1及び第
2の1回転絶対角度センサデータD1A、D1Bをレジ
スタ41に格納する。
【0039】また1チップマイクロコンピュータ27で
は、第1及び第2の減算回路30A、30B(図9)か
ら与えられるロータ軸磁極角度センサ22の出力に基づ
く第1及び第2のロータ軸磁極角度センサ信号S2A、
S2Bを第2のアナログ/ディジタル変換回路46にお
いてディジタル変換し、得られた第1及び第2のロータ
軸磁極角度センサデータD2A、D2Bをロータ軸回転
角度検出処理ブロック42に入力する。
【0040】ロータ軸回転角度検出処理ブロック42
は、供給される第1及び第2のロータ軸磁極角度センサ
データD2A、D2Bに基づいてロータ軸6の磁極回転
角度(以下、これをロータ軸磁極回転角度と呼ぶ)Pml
と、磁極角度θp とを検出し、ロータ軸回転角度Pmlを
レジスタ41に格納すると共に磁極角度θp をトルク−
3相電流信号変換処理ブロック43に送出する。
【0041】なおロータ軸6の磁極回転角度(ロータ軸
磁極回転角度Pml)とは、ロータ軸6の回転に伴い第1
〜第4のホール素子26A〜26Dにより検出される樹
脂マグネット25の隣接する一対のN極及びS極による
磁極変化を1周期(0〜2π)とする角度と定義する。
この実施の形態においては樹脂マグネット25が4極に
着磁されているため、ロータ軸磁極回転角度Pmlは0か
ら4πまでの範囲の値をとる。
【0042】そして演算処理ブロック40は、このよう
にしてレジスタ41に格納された第1及び第2の1回転
絶対角度センサデータD1A、D1B並びにロータ軸磁
極回転角度Pmlと、上位コントローラから与えられる指
定回転角度、指定回転速度又は指定回転トルクとに基づ
いて、目標とする回転トルク(以下、これを目標回転ト
ルクと呼ぶ)T0 を演算し、演算結果をレジスタ41に
格納する。
【0043】このレジスタ41に格納された目標トルク
T0 は、トルク−3相電流信号変換処理ブロック43に
より読み出される。そしてトルク−3相電流信号変換処
理ブロック43は、この目標トルクT0 と、ロータ軸回
転角度検出処理ブロック42から与えられるロータ軸6
の磁極角度θp とに基づいて、モータ部2におけるU
相、V相、W相の各コイル11にそれぞれ印加すべき駆
動電流の電流値を表す上述の第1〜第3の電流指令値U
r 、Vr 、Wr をそれぞれ算出し、これを電流制御処理
ブロック44に送出する。
【0044】またこのとき電流制御処理ブロック44に
は、第1のアナログ/ディジタル変換回路45から、パ
ワー基板24から与えられる第1〜第3の駆動電流検出
信号S3A〜S3Cをディジタル変換することにより得
られた第1〜第3の駆動電流検出データD3A、D3B
が与えられる。
【0045】かくして電流制御処理ブロック44は、こ
れら第1〜第3の電流指令値Ur 、Vr 、Wr と、第1
〜第3の駆動電流検出データD3A、D3Bとに基づい
て、第1〜第3の電流指令値Ur 、Vr 、Wr に対して
電圧変動に対する補償処理を含む所定の信号処理を施し
た後これをPWM(Pulse Width Modulation)変調し、
得られた第1〜第3のPWM信号S4A〜S4Cを第3
のケーブル33を介してこれをパワー基板24のコイル
駆動ブロック34に送出する。
【0046】なお第3のケーブル33には、第1〜第3
のPWM信号S4A〜S4C用にそれぞれ2本のライン
が設けられている。そして電流制御処理ブロック44
は、出力軸18(図1)を正転駆動するときには第1〜
第3のPWM信号S4A〜S4Cをそれぞれ一方の第1
のラインを介してパワー基板24のコイル駆動ブロック
34に送出すると共に、第1〜第3のPWM信号S4A
〜S4Cにおける論理「0」レベルの信号(以下、これ
らを第1〜第3の基準信号と呼ぶ)S5A〜S5Cを他
方の各第2のラインをそれぞれ介してパワー基板24の
コイル駆動ブロック34に送出する。
【0047】また電流制御処理ブロック44は、出力軸
18を逆転駆動するときには第1〜第3のPWM信号S
4A〜S4Cをそれぞれ第2のラインを介してパワー基
板24のコイル駆動ブロック34に送出すると共に、第
1〜第3の基準信号S5A〜S5Cをそれぞれ各第1の
ラインを介してパワー基板24のコイル駆動ブロック3
4に送出する。
【0048】コイル駆動ブロック34においては、図1
0に示すように、U相、V相、W相の各コイル11にそ
れぞれ対応させて、それぞれ4個の増幅器50A〜50
Cからなる同様構成の第1〜第3のゲートドライブ回路
51A〜51Cと、それぞれ2個のPNP型トランジス
タTR1、TR2及び2個のNPN型トランジスタTR
3、TR4からなる同様構成の第1〜第3のインバータ
回路52A〜52Cから構成されている。
【0049】そしてこのコイル駆動ブロック34では、
U相、V相及びW相の各第1のラインがそれぞれ対応す
る第1〜第3のゲートドライブ回路51A〜51Cの第
1及び第3の増幅器50A、50Cをそれぞれ介して対
応する第1〜第3のインバータ回路52A〜52Cの第
2のPNP型トランジスタTR2のベース及び第1のN
PN型トランジスタTR3のベースと接続され、U相、
V相及びW相の各第2のラインがそれぞれ対応する第1
〜第3のゲートドライブ回路52A〜52Cの第2及び
第4の増幅器50B、50Dをそれぞれ介して対応する
第1〜第3のインバータ回路52A〜52Cの第2のP
NP型トランジスタTR2のベース及び第1のNPN型
トランジスタTR4のベースと接続されている。
【0050】またこのコイル駆動ブロック34では、モ
ータ部2のU相、V相及びW相の各コイル11がそれぞ
れ対応する第1〜第3のインバータ回路52A〜52C
における第1のPNP型トランジスタTR1のコレクタ
及び第1のNPN型トランジスタTR3のコレクタの接
続中点と、第2のPNP型トランジスタTR2のコレク
タ及び第2のNPN型トランジスタTR4のコレクタの
接続中点との間に接続されている。
【0051】これによりこのコイル駆動ブロック34に
おいては、U相、V相及びW相の各相毎に、第1又は第
2のラインを介して与えられる第1〜第3のPWM信号
S4A〜S4Cをそれぞれ対応する第1〜第3のインバ
ータ回路52A〜52Cにおいてアナログ波形の駆動電
流Iu 、Iv 、Iw に変換し、これらをそれぞれ対応す
るU相、V相及びW相の各コイル11に印加することが
できるようになされている。
【0052】またコイル駆動ブロック34においては、
U相、V相及びW相の各コイル11に供給する駆動電流
Iu 、Iv 、Iw の大きさを第1〜第3のインバータ回
路52A〜52Cにそれぞれ設けられたコイルからなる
電流センサ53により検出し、検出結果を上述のように
第1〜第3の第1〜第3の駆動電流検出信号S3A〜S
3Cとして制御基板23の1チップマイクロコンピュー
タ27の第1のアナログ/ディジタル変換回路45(図
11)に送出するようになされている。
【0053】(3)1チップマイクロコンピュータ27
の各処理ブロックの詳細構成 ここで、1チップマイクロコンピュータ27の演算処理
ブロック40、ロータ軸回転角度検出処理ブロック4
2、トルク−3相電流信号変換処理ブロック43及び電
流制御処理ブロック44について、それぞれ構成を詳細
に説明する。
【0054】(3−1)演算処理ブロック40の詳細構
成 まず演算処理ブロック40は、図11からも明らかなよ
うに、CPU(Central Processing Unit )60と、各
種プログラムが格納されたROM(Read OnlyMemory)
61と、CPU60のワークメモリとしてのRAM(Ra
ndom Access Memory)62と、汎用のパラレル通信に対
応したパラレル通信用入出力回路63と、上位コントロ
ーラとの間の入出力インターフェース回路でなるシリア
ル通信用入出力回路64と、サーボ割込みのための1
〔ms〕周期のサーボ割込信号S10及びPWM周期であ
る50〔μm 〕周期のPWMパルス信号S11を発生する
カウンタ・タイマ・コントロール回路65と、カウンタ
・タイマ・コントロール回路65からサーボ割込信号S
10が正しく発生されているかをCPU60が判断する
ための1〔ms〕周期以上の所定周期の基準信号でなるウ
ォッチドッグ信号S12を発生するウォッチドッグ信号
発生回路66とがCPUバス67を介して相互に接続さ
れることにより構成されている。
【0055】この場合CPU60は、シリアル通信用入
出力回路64を介して上位コントローラから電源電圧
(5〔V〕)が供給されると、まずROM61に格納さ
れた初期プログラムに基づいて、パラレル通信用入出力
回路63、シリアル通信用入出力回路64、カウンタ・
タイマ・コントロール回路65、ロータ軸回転角度検出
処理ブロック42、トルク−3相電流信号変換処理ブロ
ック43、電流制御処理ブロック44に対する各種初期
値やパラメータの設定処理等の立上がり処理を実行す
る。
【0056】またCPU60は、この結果としてカウン
タ・タイマ・コントロール回路65から与えられるサー
ボ割込信号S10及びROM61に格納された対応する
プログラムに基づいて、上述のように目標回転トルクT
0 を生成するモータ回転制御演算処理や、進相制御処
理、温度補償制御処理及びシリアル通信制御処理を1
〔ms〕内に時分割的に実行する。なおこれら各処理モー
ド時におけるCPU60の処理については後述する。
【0057】ここでシリアル通信用入出力回路64の構
成について説明する。このシリアル通信用入出力回路6
4においては、RS−232Cシリアル通信方式及び同
期式シリアル通信方式のいずれにも対応できるように構
成されている。
【0058】実際上シリアル通信用入出力回路64は、
例えばRS−232Cシリアル通信方式での通信時に
は、2本のラインを用いて送信信号としてのTXD信
号、受信信号としてのRXD信号を送受することにより
通信を行う。このときデータ転送速度は9600〔ビット/
秒〕、転送データ長は8ビット、ストップビット1ビッ
ト及びスタートビット1ビットで、パリティビットなし
のデータ構造により転送フォーマットで上位コントロー
ラとの通信が行われる。
【0059】またシリアル通信用入出力回路64は、同
期式シリアル通信方式での通信時には、3本のラインを
用いて送信信号としてのTXD信号、受信信号としての
RXD信号及び同期クロック信号を送受することにより
通信を行う。このときデータ転送速度は800 又は1500
〔キロビット/秒〕、同期キャラクタデータは2バイ
ト、転送データ長は1バイト(8ビット)から数十バイ
トのデータ構造による転送フォーマットで上記コントロ
ーラとの通信が行われる。
【0060】そしてこの通信方式では、高速にデータ通
信を行えるため実時間でコマンドを与えることができ
る。なおNバイトのデータを転送する場合、1フレーム
のデータ構造は、「同期キャラクタ1+同期キャラクタ
2+データ1(8ビット)+データ2(8ビット)+…
…+データN(8ビット)+同期キャラクタ1+同期キ
ャラクタ2」のような構造となる。
【0061】(3−2)ロータ軸回転角度検出処理ブロ
ック42の詳細構成 次にロータ軸回転角度検出処理ブロック42の構成を詳
細に説明する。なおその前提として、先にロータ軸磁極
角度センサ22(図1)の構成について説明する。
【0062】まずロータ軸磁極角度センサ22において
は、樹脂マグネット25が、ロータマグネット8と同極
に着磁され、当該ロータマグネット8と同位相でロータ
基体7に固着されている。そして樹脂マグネット25の
着磁パターンは、最大磁束密度をφ0 として、磁束密度
φ(θp )が図12及び次式
【0063】
【数1】
【0064】となるように選定されている。
【0065】ここでθp はロータ軸6の磁束角度であ
る。そしてこの磁極角度θp とロータ軸6の機械的な回
転角度θm との関係は、磁極数をP(本実施の形態にお
いては4)として次式
【0066】
【数2】
【0067】と表すことができる。
【0068】一方ロータ軸磁極角度センサ22の第1〜
第4のホール素子26A〜26Dは、図8(B)につい
て上述したように樹脂マグネット25と対向し、かつロ
ータ軸6と同心円上の次式
【0069】
【数3】
【0070】
【数4】
【0071】
【数5】
【0072】
【数6】
【0073】で与えられる位置に位置するように制御基
板23に搭載されている。
【0074】なお(3)式〜(6)式において、θ0 は
1つのコイル11の位置を原点とする座標位置を示し、
以下においては1つのU相のコイル11Aの極中心位置
をθ0 =0とする(図4(A)参照)。さらに座標位置
θ0 が次式
【0075】
【数7】
【0076】で与えられるその隣のコイル11B、11
FをV相とし、座標位置θ0 が次式
【0077】
【数8】
【0078】で与えられるコイル11F、11CをW相
とする。なお極中心位置がθ0 =0のコイル11Aと18
0 〔°〕対向するコイル11DはU相となる。
【0079】因にステータ鉄心10(図3)の極数Ps
(本実施の形態においては4)と、樹脂マグネット25
の磁極数Pとの関係は、次式
【0080】
【数9】
【0081】で与えられる。
【0082】そして上述のように配置された第1〜第4
のホール素子26A〜26Dの出力Sh1、Sh2、Sh3、
Sh4は、これら第1〜第4の素子26A〜26Dのセン
サ感度係数をG0 、ロータ軸6の回転角度をθm として
それぞれ次式
【0083】
【数10】
【0084】
【数11】
【0085】
【数12】
【0086】
【数13】
【0087】のようになる。従ってロータ軸6が1回転
するとき、第1〜第4のホール素子26A〜26Dの出
力Sh1、Sh2、Sh3、Sh4の信号レベルが樹脂マグネッ
ト25の磁極数Pに比例して変化する。
【0088】ただし実際上は組み立ての際にロータ軸6
と、第1〜第4のホール素子26A〜26Dのセンサ面
との直角度に精度誤差が生じたり、同心度に誤差が生じ
るため、これら誤差をそれぞれφe1、φe2、θe1、θe2
として、第1〜第4のホール素子26A〜26Dの実際
の出力Sh1′、Sh2′、Sh3′、Sh4′は、それぞれ次
【0089】
【数14】
【0090】
【数15】
【0091】
【数16】
【0092】
【数17】
【0093】となる。
【0094】そしてこれら実際の第1及び第2のホール
素子26A、26Bの各出力Sh1′、Sh2′を加算した
第1のセンサ信号Sh12 (本実施の形態においては、図
9の第1のロータ軸磁極角度センサ信号S2Aに相当)
と、第3及び第4のホール素子26C、26Dの各出力
Sh3′、Sh4′を加算した第2のセンサ信号Sh34 (本
実施の形態においては、図9の第2のロータ軸磁極角度
センサ信号S2Bに相当)は、θe1、θe2が十分に小さ
いものとして、それぞれ次式
【0095】
【数18】
【0096】
【数19】
【0097】として表すことができる。なおこの第1及
び第2のセンサ信号Sh12 、Sh34 の波形を図13に示
す。
【0098】そしてこれら第1及び第2のセンサ信号S
h12 、Sh34 に基づいて、以下の手順によりロータ軸6
の磁極角度θp 及びロータ軸磁極回転速度Pmlを求める
ことができる。
【0099】すなわち、まずその初期値を0として磁極
角度演算値θx を設定し、次式
【0100】
【数20】
【0101】を演算する。
【0102】そしてEθx =0とならない場合には、θ
x を次式
【0103】
【数21】
【0104】により算出する。ここでKrp1は比例ゲイ
ン、Kri1は積分ゲインをそれぞれ示し、ともに正の定
数である。
【0105】この算出したθx を用いて(20)式を再
び演算し、この後Eθx =0となるまでこれを繰り返
す。この結果Eθx はゼロ値に収束してゆき、このとき
θx が次式
【0106】
【数22】
【0107】として与えられ、これがすなわちロータ軸
磁極回転角度Pmlに相当する。
【0108】またこのようにしてロータ軸磁極回転角度
Pmlが得られると、ロータ軸磁極回転角度Pmlと、磁極
角度θp との間に次式
【0109】
【数23】
【0110】の関係があることから、ロータ軸磁極回転
角度Pmlに基づいて磁極角度θp も求めることができ
る。なお(23)式においてNx は0以上の整数を表
す。
【0111】かかる原理に基づいてロータ軸回転角度検
出処理ブロック42は、図14に示すように構成されて
いる。そしてこのロータ軸回転角度検出処理ブロック4
2では、ロータ軸磁極角度センサ22から第2のアナロ
グ/ディジタル変換回路46を介して与えられる第1及
び第2のロータ軸磁極角度センサデータD2A、D2B
を演算器70に入力する。
【0112】このとき演算器70には、後述のように関
数変換器71から先行して算出した磁極角度演算値θx
の正弦値(sinθx )及び余弦値(cosθx )が与
えられる。
【0113】かくして演算器70は、第1及び第2のロ
ータ軸磁極角度センサデータD2A、D2Bと、先行し
て算出した磁極角度演算値θx の正弦値及び余弦値とに
基づいて(20)式を演算することにより、(2)式で
与えられる磁極角度θp と、そのときのθx との誤差を
演算し、演算結果を第1の乗算器72に送出する。
【0114】そしてこの乗算結果には、この後第1の乗
算器72において次式
【0115】
【数24】
【0116】(ただしSはラプラス演算子)で与えられ
る積分ゲインが乗算され、第2の乗算器73において比
例ゲインKrp1が乗算され、加算器74において1/S
(Sはラプラス演算子)が乗算される。
【0117】この結果加算器74から磁極角度演算値θ
x が出力されて、これが関数変換器71に送出されると
共に、磁極角度演算器75に与えられる。かくして磁極
角度演算器75は、このときの磁極角度演算値θx の値
をロータ軸磁極角度Pmlとしてレジスタ41(図11)
に格納する。
【0118】またこのとき磁極角度演算器75は、これ
と共に(23)式におけるNx の値を0から順番に増加
させながら0から2πまでの範囲に入るθp の値を求
め、これを磁気角度θp としてトルク−3相電流信号変
換処理ブロック43に送出する。
【0119】このようにしてロータ軸回転角度検出処理
ブロック42では、第1及び第2のロータ軸磁極角度セ
ンサデータD2A、D2Bに基づいて磁極角度θp 及び
ロータ軸磁極回転角度Pmlを検出する。
【0120】なおロータ軸回転角度検出処理ブロック4
2において、上述のような磁気角度θp 及びロータ軸磁
極回転角度Pm1の演算処理は、演算処理ブロック40の
カウンタ・タイマ・コントロール回路65から与えられ
るPWMパルス信号S11に基づいて行われる。
【0121】従ってこのロータ軸回転角度検出処理ブロ
ック42から出力される磁気角度θp 及びロータ軸磁極
回転角度Pm1は、PWMパルス信号S11の周期である
50〔μs 〕毎に更新される。
【0122】(3−3)トルク−3相電流信号変換処理
ブロック43の詳細構成 トルク−3相電流信号変換処理ブロック43は、図15
に示すように、レジスタ41(図11)に格納された目
標回転トルクT0 を後述のPWMパルス周期(50〔μs
〕周期)で読み出し、当該目標回転トルクT0 と、ロ
ータ軸回転角度検出処理ブロック42(図14)から与
えられる磁極角度θp とに基づいて次式
【0123】
【数25】
【0124】
【数26】
【0125】
【数27】
【0126】を演算することにより、第1〜第3の電流
指令値Ur 、Vr 及びWr を算出し、これらを電流制御
処理ブロック44(図11)に送出する。
【0127】なおこの第1〜第3の電流指令値Ur 、V
r 及びWr の演算処理は、演算処理ブロック40のカウ
ンタ・タイマ・コントロール回路65から与えられるP
WMパルス信号S11に基づいて行われる。従ってこれ
ら第1〜第3の電流指令値Ur 、Vr 及びWr もPWM
パルス信号S11の周期である50〔μs 〕毎に更新され
る。
【0128】(3−4)電流制御処理ブロック44の詳
細構成 一方電流制御処理ブロック44には、図16に示すよう
に、U相、V相及びW相の各コイル11にそれぞれ対応
させて、減算回路80A〜80C、第1及び第2の乗算
回路81A〜81C、82A〜82C及びPWM変換器
83A〜83Cからなる第1〜第3の信号処理系84A
〜84Cが設けられている。
【0129】そしてこの電流制御処理ブロック44で
は、これら第1〜第3の信号処理系84A〜84Cにお
いて、トルク−3相電流信号変換処理ブロック43(図
15)から与えられる第1〜第3の電流指令値Ur 、V
r 、Wr と、パワー基板24から与えられる第1〜第3
の駆動電流検出信号S3A〜S3Cとに基づいて、電圧
変動の補償処理を含む所定の信号処理を施しながら、第
1〜第3のPWM信号S4A〜S4C及び第1〜第3の
基準信号S5A〜S5Cを生成し得るようになされてい
る。
【0130】実際上第1〜第3の信号処理系84A〜8
4Cにおいては、それぞれ供給される第1〜第3の電流
指令値Ur 、Vr 及びWr と、第1〜第3の駆動電流検
出信号S3A〜S3Cとの誤差を減算回路80A〜80
Cにおいて検出し、検出結果を第1の乗算回路81A〜
81Cに送出する。
【0131】そして第1〜第3の信号処理系84A〜8
4Cでは、この後この誤差を0に収束させるため、この
誤差に対して各第1の乗算回路81A〜81Cにおいて
ラプラス演算子をSとして次式
【0132】
【数28】
【0133】で与えられる積分ゲインを乗算し、乗算結
果に第2の乗算回路82A〜82Cにおいて比例ゲイン
Krpを乗算する。
【0134】そしてこのようにして得られたそれぞれ次
【0135】
【数29】
【0136】
【数30】
【0137】
【数31】
【0138】で与えられる各第2の乗算回路82A〜8
2Cから出力される値X1 、X2 、X3 が、それぞれU
相、V相及びW相の各コイル11に実際に印加すべき駆
動電流の電流値であり、これら値X1 、X2 、X3 がそ
れぞれ対応するPWM変換器83A〜83Cに与えられ
る。
【0139】そして各PWM変換器83A〜83Cは、
それぞれ供給される値X1 、X2 、X3 に基づいて、そ
れぞれ50〔μs 〕周期のパルスのパルス幅を制御するこ
とにより第1〜第3のPWM信号S4A〜S4Cと、第
1〜第3の基準信号S5A〜S5Cとを発生する。
【0140】実際上各PWM変換器83A〜83Cは、
図17に示すように、それぞれ供給される値X1 、X2
、X3 を図示しない内部レジスタにセットし、値X1
、X2、X3 が正のときには、当該値X1 、X2 、X3
を演算処理ブロック40のカウンタ・タイマ・コントロ
ール回路65から与えられる50〔μs 〕周期のPWMパ
ルス信号S11の立ち上がりエッジ毎に第1のPWMパ
ルス信号発生回路85A内のダウンカウンタ(図示せ
ず)にセットする。
【0141】そしてこのダウンカウンタは、演算処理ブ
ロック40(図11)のCPUクロック(0.1 〔μs
〕)の立ち上がりエッジ毎にカウンタ値を減少させて
ゼロ値で停止する。従って第1のPWMパルス信号発生
回路85Aの出力は、ダウンカウンタのカウント値がゼ
ロ値になるまで出力が論理「1」レベル、カウンタ値が
ゼロ値となってからは論理「0」レベルとなる。
【0142】また次のPWMパルス信号S11の立ち上
がりエッジで再びレジスタに格納された値X1 、X2 、
X3 が第1のPWMパルス信号発生回路85Aのダウン
カウンタに再びセットされて上述の処理が繰り返され
る。
【0143】従って第1のPWMパルス信号発生回路8
5Aからは、レジスタに格納される値X1 、X2 、X3
が更新されるまで、当該値X1 、X2 、X3 に比例した
一定のパルス幅Tonの第1〜第3のPWM信号S4A〜
S4Cが出力され、第2のPWMパルス信号発生回路8
5Aからは、論理「0」レベルの基準信号S5A〜S5
Cが出力される。
【0144】一方、各PWM変換器83A〜83Cにお
いては、値X1 、X2 、X3 が負の値であった場合には
その絶対値を演算して正の整数に変換した後、この値を
第2のPWMパルス信号発生回路85B内のダウンカウ
ンタ(図示せず)にセットする。
【0145】この結果このときには第2のPWMパルス
信号発生回路85Bからは、上述の第1のPWMパルス
信号発生回路85Aと同様にして、レジスタに格納され
る値X1 、X2 、X3 が更新されるまで、当該値X1 、
X2 、X3 に比例した一定のパルス幅Tonの第1〜第3
のPWM信号S4A〜S4Cが出力される。またこのと
き第1のPWMパルス信号発生回路85Bからは、論理
「0」レベルの基準信号S5A〜S5Cが出力される。
【0146】このようにして第1〜第3のPWM変換器
83A〜83Cにおいては、供給される値X1 、X2 、
X3 に応じたパルス幅Tonの第1〜第3のPWM信号S
4A〜S4C及び第1〜第3の基準信号S5A〜S5C
を生成し、これをそれぞれ第3のケーブル33を介して
パワー基板24のコイル駆動ブロック34に送出するよ
うになされている。
【0147】(4)コイル駆動電流と出力トルクの関係 ここでこのACサーボモータ1におけるモータ部2のU
相、V相及びW相の各コイル11に印加する駆動電流I
u 、Iv 、Iw と、出力軸18を介して外部に出力され
る回転トルク(以下、出力トルクと呼ぶ)との関係につ
いて説明する。
【0148】まずU相、V相及びW相の各コイル11に
駆動電流Iu 、Iv 、Iw を印加したときにおけるこれ
らU相、V相及びW相の各コイル11の交差する磁束密
度をφu 、φv 、φw とすると、出力トルクT(θp )
は、モータ部2のロータ軸6の磁極角度θp を用いて次
【0149】
【数32】
【0150】のように与えられる。なおこの(32)式
において、K0 は各コイル11に駆動電流Iu 、Iv 、
Iw を印加したときの一定の係数値を表す。
【0151】ここでU相、V相及びW相の各コイル11
に印加する駆動電流Iu 、Iv 、Iw は、上述のように
それぞれ次式
【0152】
【数33】
【0153】
【数34】
【0154】
【数35】
【0155】のように制御され、このため各磁束密度は
φu 、φv 、φw はそれぞれ次式、
【0156】
【数36】
【0157】
【数37】
【0158】
【数38】
【0159】となる。
【0160】従って出力トルクT(θp )は、これら
(33)式〜(38)式を(32)式に代入して、次式
【0161】
【数39】
【0162】と表すことができる。
【0163】従ってこのACサーボモータ1では、各コ
イル11に印加する駆動電流Iu 、Iv 、Iw の大きさ
に比例した出力トルクが得られることが分かる。
【0164】(5)ACサーボモータ1におけるソフト
ウェア制御 次にこのACサーボモータ1の演算処理ブロック40
(図11)におけるソフトウェア制御について説明す
る。
【0165】演算処理ブロック40では、上述のように
CPU60がカウンタ・タイマ・コントロール回路65
から与えられるサーボ割込信号S10及びROM61に
格納された対応するプログラムに基づいて、1〔ms〕内
に時分割的にモータ回転制御演算処理、進相制御処理、
温度補償制御処理及びシリアル通信制御処理を実行す
る。以下、これら各処理モード時におけるCPU60の
処理について説明する。
【0166】(5−1)モータ回転制御演算処理モード
時におけるCPU60の処理 モータ回転制御演算処理モード時におけるCPU60の
処理は、上述のように上位コントローラから与えられる
指定回転位置、指定回転速度又は指定回転トルクの値の
指定に応じた目標回転トルクT0 を算出することであ
る。
【0167】そしてCPU60は、この目標回転トルク
T0 を、上位コントローラから指定回転位置Pref が与
えられている場合には、ロータ軸回転角度検出処理ブロ
ック42によりレジスタ41に格納されるロータ軸磁極
回転角度Pm1に基づいて出力軸18(図1)の回転位置
Pm を算出すると共に、この回転位置Pm を用いて次式
【0168】
【数40】
【0169】
【数41】
【0170】をそれぞれ演算することにより、指定回転
位置Pref に対する目標の回転速度Vmrefと、出力軸の
現在の回転速度Vm とを算出する。そしてこのようにし
て得られた(40)式及び(41)式から次式
【0171】
【数42】
【0172】の演算を実行することにより目標回転トル
クT0 を算出する。
【0173】また上位コントローラから指定回転速度V
ref が与えられている場合には、(41)式を用いて出
力軸18の現在の回転速度Vm を算出し、この回転速度
Vmに基づいて次式
【0174】
【数43】
【0175】を演算することにより目標回転トルクT0
を算出する。また上位コントローラから指定回転トルク
Tref が与えられている場合には、これをそのまま目標
回転トルクT0 とする。
【0176】なおこれら(40)〜(43)式におい
て、Sはラプラス演算子を示し、Kpp、Kvi及びKvpは
それぞれ上位コントローラにより設定される制御ゲイン
パラメータを表す。この制御ゲインパラメータKpp、K
vi及びKvpの値を変化させることにより、指定回転角度
Pref や指定回転速度Vref に対するACサーボモータ
1の応答を変化させることができる。
【0177】因にこのようなモータ回転制御演算処理モ
ード時におけるCPU60の具体的な処理手順を図18
に示す。
【0178】CPU60は、上位コントローラから指定
回転角度Pref が与えられた場合、まずレジスタ41に
格納された第1及び第2の絶対角度センサデータD1
A、D1Bに基づいてロータ軸6の磁極回転数(以下、
ロータ軸磁極回転数と呼ぶ)Nm を算出する(ステップ
SP1)。
【0179】なおロータ軸磁極回転数Nm とは、ロータ
軸6の回転に伴いロータ軸磁極角度センサ22の第1〜
第4のホール素子26A〜26Dにより検出される樹脂
マグネット25の隣接する一対のN極及びS極による磁
束変化を1回転とする回転数と定義する。この実施の形
態においては、樹脂マグネット25は4極に着磁されて
いるため、ロータ軸6が機械的に1回転するとロータ軸
磁極回転数Nm は2となる。
【0180】そしてこのロータ軸磁極回転数Nm は、図
19に示すロータ軸磁極回転数検出処理手順に従って、
それぞれsinθg 、cosθg で表される第1及び第
2の1回転絶対角度センサ信号S1A、S1Bの位相θ
g をレジスタ41に格納された第1及び第2の絶対角度
センサデータD1A、D1Bに基づいてソフトウエア処
理により算出し(ステップSP1A)、この位相θg に
トルク増幅部3の遊星ギア機構部16のギア比Nを乗算
し(ステップSP1B)、この乗算結果を2πで割り算
してその割算結果の整数部分にロータ軸磁極角度センサ
22(図1)の樹脂マグネット25の磁極数(本実施の
形態においては4)の半分の値Np を乗算する(ステッ
プSP1C)ことにより得ることができる。
【0181】またCPU60は、図18に示すように、
このようにして算出したロータ軸磁極回転数Nm と、レ
ジスタ41に格納されたロータ軸磁極回転角度データP
m1とに基づき、次式
【0182】
【数44】
【0183】で与えられるPm0を初期値として、次式
【0184】
【数45】
【0185】の演算を実行することによりそのときの出
力軸18の回転角度Pm を算出する(ステップSP
2)。
【0186】そしてCPU60は、指定回転角度Pref
からこの回転角度Pm を減算することにより、指定回転
角度Pref に対する誤差(以下、これを回転角度誤差と
呼ぶ)Pe を検出する(ステップSP3)。
【0187】続いてCPU60は、この回転角度誤差P
e に比例ゲインKppを乗算することにより、指定回転角
度Pref に対する目標回転角度Vmrefを算出する(ステ
ップSP4)。
【0188】次いでCPU60は、レジスタ41に格納
されたロータ軸磁極回転角度Pm1を微分することにより
そのときの出力軸の回転速度Vm を算出する(ステップ
SP5)と共に、この後ステップSP4において算出し
た目標回転速度VmrefからステップSP5において算出
した回転速度Vm を減算することにより速度誤差Veを
算出する(ステップSP6)。
【0189】続いてCPU60は、この速度誤差Ve に
次式
【0190】
【数46】
【0191】で与えられる速度積分ゲイン及び比例ゲイ
ンKvpを順次乗算する(ステップSP7及びステップS
P8)。これにより目標回転トルクT0 を得ることがで
きる。
【0192】なおCPU60は、モータ回転制御演算処
理モード時、上位コントローラから指定回転速度Vref
が与えられているときにはこの処理をステップSP6に
から開始し、回転トルクTref が与えられているときに
はこれをそのまま目標回転トルクT0 としてレジスタ4
1に格納する。
【0193】(5−2)進相制御処理モード時における
CPU60の処理 まず進相制御について説明する。モータ部2のU相、V
相及びW相の各コイル11に供給する各駆動電流Iu 、
Iv 、Iw は、それぞれトルク−3相電流信号変換処理
ブロック43及び電流制御処理ブロック44においてそ
れぞれ(33)式、(34)式及び(35)式となるよ
うに制御される。
【0194】このとき例えばロータ9が高速に回転して
いると、パワー基板24の各インバータ回路52A〜5
2Cにこれら(33)式、(34)式及び(35)式の
ような駆動電流Iu 、Iv 、Iw が与えられても実際に
U相、V相及びW相の各コイル11に流れる駆動電流I
u 、Iv 、Iw はコイル11のインピーダンスにより遅
れが生じ、この結果出力トルクが低下する。
【0195】進相制御とは、この問題を改善するために
次式
【0196】
【数47】
【0197】
【数48】
【0198】
【数49】
【0199】のようにU相、V相及びW相の各コイル1
1に印加する駆動電流Iu 、Iv 、Iw の位相を予めロ
ータ9の回転速度に応じた補正値θoff 分だけ進ませて
おく制御のことである。
【0200】そして実際上CPU60は、この進相制御
処理として補正値θoff を例えば図18におけるステッ
プSP5において算出した回転速度Vm を利用して、次
【0201】
【数50】
【0202】により算出してこれらをトルク−3相電流
信号変換処理ブロック43に与えることにより、当該ト
ルク−3相電流信号変換処理ブロック43において発生
させる第1〜第3の電流指令値Ur 、Vr 、Wr をそれ
ぞれ(47)式〜(49)式のように補正値θoff 分だ
け進相させるように制御する。
【0203】なお(50)式においてKv は、出力軸1
8の回転速度の大きさと、進相補正の量との関係を決め
るゲインで、モータ部2の各コイル11の仕様により決
定される定数である。
【0204】(5−3)温度補償制御処理モード時にお
けるCPU60の処理 永久磁石を用いたACサーボモータでは、コイルに流れ
る電流による発熱や渦電流損による発熱が生じる。こう
した熱により永久磁石の磁気特性が変化する。一般的に
高温の雰囲気でコイル電流を流し、高い磁束密度を加え
ると永久磁石は減磁してしまう。このためコイル電流の
最大値は、安全性をもたせるために一般的に低く抑えら
れた設計となっている。
【0205】温度補償制御とは、温度により許容される
最大電流を制御することにより永久磁石のもつ磁気特性
を有効に利用する制御である。
【0206】この実施の形態の場合、図9に示すよう
に、制御基板23の温度センサ29から出力される温度
センサ信号S14が1チップマイクロコンピュータ27
の第4のアナログ/ディジタル変換回路48を介して温
度センサデータD14としてレジスタ41に格納され
る。
【0207】そしてCPU60は、この温度センサデー
タD14の値THに基づいて、(33)式〜(35)式
におけるI0 の最大値Imax を次式
【0208】
【数51】
【0209】により演算し、この演算結果に基づいてト
ルク−3相電流信号変換処理ブロック43を制御するこ
とにより、モータ部2のU相、V相及びW相の各コイル
11に流す駆動電流Iu 、Iv 、Iw の上限を設定す
る。なおKthは、永久磁石(本実施の形態においてはロ
ータ9のロータマグネット8(図1))の温度特性に応
じて決まる温度係数である。
【0210】(5−4)シリアル通信処理モード時にお
けるCPU60の処理 CPU60は、シリアル通信処理モード時、上位コント
ローラとの間で通信を行い、制御コマンドや変更パラメ
ータを入力し、またはモニタ用に内部信号を送信する。
【0211】(5−5)外力推定処理モード時における
CPU60の処理 ここでこのACサーボモータ1の場合、演算処理ブロッ
ク40では、上述のようなモータ回転制御演算処理、進
相制御処理、温度補償制御処理及びシリアル通信制御処
理に加えて、出力軸18に与えられる外力(負荷トル
ク)の大きさを推定し得るようになされている。
【0212】この場合一般的なモータにおける出力トル
クTm と、ロータの機械的な回転角度θm と、出力軸に
与えられる外力Td と、ギア機構の出力角度(以下、出
力軸の回転角度とする)θg との関係は、図20のよう
に表すことができる。
【0213】すなわちロータの機械的な回転角度θm
は、出力トルクTm からギア機構の構造的な負荷トルク
Tdmを減算し、その減算結果に次式
【0214】
【数52】
【0215】を乗算することにより算出することができ
る。なおJm はロータの慣性モーメントを表し、Dm は
ロータの軸受け等との摩擦係数を表す。
【0216】また出力軸の回転角度θg は、外力Td
と、ギア機構の構造的な負荷トルクTdmにギア機構のギ
ア比Nを乗算した乗算結果(以下、これを構造的出力軸
負荷トルクと呼ぶ)Tdlとを加算し、この加算結果Tdl
に次式
【0217】
【数53】
【0218】を乗算することにより算出することができ
る。なおJl はギア機構における慣性モーメント、Dl
はギア機構内における摩擦係数、Sはラプラス演算子を
それぞれ示す。
【0219】そしてギア機構の構造的な負荷Tdmは、出
力軸の回転角度θg にギア機構におけるギア比Nを乗算
した乗算結果をモータロータの機械的な回転角度θm か
ら減算し、減算結果にギア機構におけるばね係数Kg を
乗算することにより算出することができる。
【0220】かかる原理に基づいて、CPU60は、図
21に示す以下の手順に従って外部から出力軸18に与
えられる外力の大きさを推定する。
【0221】すなわちCPU60は、まず外力の推定値
(以下、これを外力推定値と呼ぶ)Tdeとして適当な大
きさの初期値を発生し、当該外力推定値Tdeと、遊星歯
車機構16の構造的出力軸負荷トルクTdlとの加算結果
に次式
【0222】
【数54】
【0223】を乗算することにより出力軸18の数学モ
デル的な回転角度θgmを算出する。
【0224】そして演算により求められる実際の出力軸
18の回転角度θg からこの回転角度θgmを減算するこ
とにより、実際の回転角度θg に対する数学モデルの回
転角度θgmの誤差(以下、これをモデル誤差と呼ぶ)E
θg を算出すると共に、このモデル誤差Eθg に次式
【0225】
【数55】
【0226】で与えられる推定ゲインを乗算することに
より外力推定値Tdeを算出する。なおこの(55)式に
おいて、Ka は一定の正の係数値である。
【0227】そしてCPU60は、この後外力推定値T
deを新たに得られた外力推定値Tdeに順次更新しながら
上述の演算処理を繰り返す。この結果このような演算処
理を繰り返すことによってモデル誤差Eθg はゼロ値に
収束してゆき、これに伴って外力推定値Tdeも実際に出
力軸18に与えられる外力の大きさに近づいてゆく。
【0228】そしてモデル誤差Eθg が0となったとき
の外力推定値Tdeが実際に出力軸18に与えられている
外力と推定することができ、CPU60はこの値を演算
により得られた外力推定値Tdeとする。
【0229】そしてCPU60は、この後この外力推定
値Tdeを上位コントローラに送信したり、または上位コ
ントローラの制御のもとに、この外力推定値Tdeに基づ
いて、出力軸18に与えられる外力に拮抗した出力トル
クの発生及び出力トルク制御や、外力を上回る出力トル
クの発生及び出力制御、又は外力を下回る出力トルクの
発生及び出力制御を実行する。
【0230】なおこの実施の形態の場合においては、上
述のように1回転絶対角度センサ21により検出される
出力軸18の回転変位に基づいて当該出力軸18に与え
られる外力の大きさを推定するようになされている。こ
のためトルク増幅部3の減速機構(遊星歯車機構16)
は、出力軸18に与えられる外力に比例して入力軸(ロ
ータ軸6)が変位を生じるのに十分な可逆駆動性(バッ
クドライバビリティ)をもつように構築されている。
【0231】(6)本実施の形態の動作及び効果 以上の構成において、このACサーボモータ1では、上
位コントローラから与えられる指定回転角度、指定回転
速度又は指定回転トルクに基づいて制御基板23の1チ
ップマイクロコンピュータ27においてU相、V相及び
W相の各コイル11に印加すべき駆動電流Iu 、Iv 、
Iw の値でなる第1〜第3の電流指令値Ur 、Vr 、W
r をそれぞれ算出し、当該算出した第1〜第3の電流指
令値Ur、Vr 、Wr に基づく第1〜第3のPWM信号
S4A〜S4Cをパワー基板24のコイル駆動ブロック
34に送出する。
【0232】そしてパワー基板24のコイル駆動ブロッ
ク34は、供給される第1〜第3のPWM信号S4A〜
S4Cに基づいて駆動電流Iu 、Iv 、Iw を生成し、
これをU相、V相及びW相の各コイル11に印加するよ
うにしてロータ9を回転駆動する。
【0233】そしてこのACサーボモータ1では、上述
のようにロータ9の回転を制御する制御手段としての制
御基板23及びパワー基板24が、ロータ9や、ステー
タ鉄心10A及びコイル11からなるステータと一体に
モータケース4の内部に収納されているため、外部との
接続配線量を格段的に減少させることができると共に、
アクチュエータシステム全体としての配線量をも減少さ
せることができる。
【0234】またこの場合において、PWM変換器83
A〜83C(スイッチング素子)が導電材からなるモー
タケース4の内部に収納されており、このため例えば従
来のACサーボモータのようにPWM信号(スイッチン
グ信号)を外部からACサーボモータに与える場合に比
べてスイッチングノイズが外部に悪影響を及ぼすのを格
段的に低減することができる。またこのことからACサ
ーボモータ1と上位コントローラとを接続する第2のケ
ーブル32として比較的一般的なものを使用することが
できる。
【0235】さらにこのACサーボモータ1では、ロー
タ軸磁極角度センサ22をモータケース4内部における
ロータ9の近傍に配置し、当該ロータ軸磁極角度センサ
22の出力に基づいてロータの回転角度θm を求めるよ
うにしているため、ロータ軸6を太くすることなく高精
度かつ高速の位置決めを行い得るようにすることがで
き、その分全体として小型に構築することができる。
【0236】またこのようにロータ軸磁極角度センサ2
2をモータケース4内部におけるロータ9の近傍に配置
しているため、機械的な変動が少なく、ロータ軸6の回
転角度を安定して検出するもことができる。
【0237】さらにこのACサーボモータ1では、温度
センサ29をモータケース4内部におけるロータマグネ
ット8の近傍に設けられているため、当該温度センサ2
9の出力に基づいて、ロータマグネット8の磁気特性に
応じて実際に各コイル11に印加できる駆動電流Iu 、
Iv 、Iw の上限を正確にかつ容易に求めることがで
き、その分駆動電流Iu 、Iv 、Iw の上限を従来のよ
うに安全性を含んで設定する場合に比べて、当該上限を
上昇させて最大出力トルクを増加させることができる。
【0238】さらにこのACサーボモータ1では、ロー
タ9及び当該ロータ9の回転を制御する制御回路とが平
面上に配置されているため、小型偏平に構築することが
できる。
【0239】さらにこのACサーボモータ1では、構造
が簡単でかつ部品点数が少ないため、製造時における組
立作業や調整作業を容易化させ得る利点もある。
【0240】以上の構成によれば、上位コントローラの
制御のもとにモータ部2の回転を制御する制御基板23
及びパワー基板24をロータ9及びスタータと一体にモ
ータケース4の内部に収納するようにしたことによりA
Cサーボモータ1の外部との接続配線量を格段的に減少
させることができると共に、アクチュエータシステム全
体としての配線量をも減少させることができ、かくして
アクチュエータシステム全体としての構成を簡易化させ
得るACサーボモータを実現できる。
【0241】またロータ軸6の回転角度を検出するロー
タ軸磁極角度センサ22をモータケース4内部における
ロータ9の近傍に配置するようにしたことにより、ロー
タ軸6を太くすることなく高精度かつ高速位置決めを行
い得るようにすることができ、かくして性能を向上させ
ながら小型化をも図ることのできるACサーボモータを
実現できる。
【0242】さらに温度センサ29をモータケース4内
部におけるロータマグネット8の近傍に設けるようにし
たことにより、当該温度センサ29の出力に基づいて、
ロータマグネット8の磁気特性に応じて実際に各コイル
11に印加できる駆動電流Iu 、Iv 、Iw の上限を正
確にかつ容易に求めることができ、その分駆動電流Iu
、Iv 、Iw の上限を従来のように安全性を含んで設
定する場合に比べて、当該上限を上昇させて最大出力ト
ルクを増加させることができ、かくして性能を向上させ
得るACサーボモータを実現できる。
【0243】(7)他の実施の形態 なお上述の実施の形態においては、本発明をACサーボ
モータに適用するようにした場合について述べたが、本
発明はこれに限らず、要は、回転自在に枢支された回転
軸(本実施の形態においてはロータ軸6)と、回転軸を
回転駆動する駆動手段(本実施の形態においてはロータ
9と、ステータ鉄心10及びコイルからなるステータ)
とがハウジング(本実施の形態においてはモータケース
4)内に収納されたアクチュエータ装置であるのなら
ば、この他種々のアクチュエータ装置に広く適用するこ
とができる。
【0244】また上述の実施の形態においては、例えば
ロータマグネット8を4極に着磁するようにした場合に
ついて述べたが、本発明はこれに限らず、例えば8極や
これ以外の極数に着磁するようにしても良い。
【0245】さらに上述の実施の形態においては、ロー
タ9の回転を制御する制御手段としての制御基板23及
びパワー基板24を別体に形成するようにした場合につ
いて述べたが、本発明はこれに限らず、一体に形成する
ようにしても良い。
【0246】さらに上述の実施の形態においては、1チ
ップマイクロコンピュータ27が上位コントローラから
与えられる指定回転角度、指定回転速度又は指定回転ト
ルクに基づいてロータ9の回転を制御するようにした場
合について述べたが、本発明はこれに限らず、例えば予
めプログラムされている回転角度や、回転速度又は回転
トルクの変化パターンに基づいてロータ9の回転を制御
するようにしても良い。
【0247】さらに上述の実施の形態においては、ロー
タ軸6の回転変位を検出する回転軸回転変位検出手段と
してのロータ軸磁極角度センサ22を、所定パターンで
着磁さた樹脂マグネット25(第1の構成部)と、第1
〜第4のホール素子26A〜26D(第2の構成部)と
で構成するようにした場合について述べたが、本発明は
これに限らず、この他種々の構成を広く適用することが
できる。
【0248】さらに上述の実施の形態においては、ロー
タ軸6の回転変位として、ロータ軸6の磁極角度θp を
検出するようにした場合について述べたが、本発明はこ
れに限らず、磁極角度θp 以外の回転変位情報を検出す
るようにしても良い。
【0249】さらに上述の実施の形態においては、ロー
タ部2においてパワー基板24から供給される駆動電流
Iu 、Iv 、Iw の電流値に応じた大きさの磁界を発生
させる磁界発生手段としてコイル11を適用するように
した場合について述べたが、本発明はこれに限らず、こ
の他種々の磁界発生手段を広く適用することができる。
【0250】さらに上述の実施の形態においては、U
相、V相及びW相の各コイル11に印加する駆動電流I
u 、Iv 、Iw の電流値を検出する駆動電流値検出手段
をコイル53(図10)により構成するようにした場合
について述べたが、本発明はこれに限らず、この他種々
の構成の駆動電流値検出手段を広く適用することができ
る。
【0251】さらに上述の実施の形態においては、制御
基板23の1チップコンピュータ27に、上位コントロ
ーラとの通信するためのシリアル通信機能としてRS−
232Cシリアル通信機能及び同期式シリアル通信機能
をもたせるようにした場合について述べたが、本発明は
これに限らず、これ以外のシリアル通信機能をもたせる
ようにしても良い。
【0252】さらに上述の実施の形態においては、モー
タ部2において発生された回転トルクを増幅するトルク
増幅手段を、図5に示すような遊星歯車機構16により
構成するようにした場合について述べたが、本発明はこ
れに限らず、この他種々の構成を広く適用することがで
きる。
【0253】さらに上述の実施の形態においては、出力
軸18の回転変位を検出する出力軸回転変位検出手段と
しての1回転絶対角度センサ21を樹脂マグネット19
と、第1及び第2のホール素子20A、20Bとにより
構成するようにした場合について述べたが、本発明はこ
れに限らず、この他種々の構成を広く適用することがで
きる。
【0254】さらに上述の実施の形態においては、1回
転絶対角度センサ21から出力される第1及び第2の1
回転絶対角度センサ信号S1A、S1Bと、ロータ軸磁
極角度センサ22の出力に基づく第1及び第2のロータ
軸磁極角度センサ信号S2A、S2Bとに基づいて外部
から出力軸18に与えられる負荷トルク(外力)を検出
する演算手段を、1チップマイクロコンピュータ27に
より構成するようにした場合について述べたが、本発明
はこれに限らず、これを1チップマイクロコンピュータ
27と別体に設けるようにしても良い。
【0255】さらに上述の実施の形態においては、パワ
ー基板24において検出されたU相、V相及びW相の各
コイル11に印加される各駆動電流Iu 、Iv 、Iw に
基づいて各駆動電流Iu 、Iv 、Iw の電流値をフィー
ドバック制御するようにして、電源電圧の変動の影響を
減少させるようにした場合について述べたが、本発明は
これに限らず、オープンループ制御によりV相及びW相
の各コイル11に印加される各駆動電流Iu 、Iv 、I
w の電流値を制御するようにしても良い。
【0256】実際上、このような方法としては、電源電
圧Vcmの大きさを検出し、当該検出結果に基づいて電流
制御処理ブロック44におけるゲインGv を次式
【0257】
【数56】
【0258】のように可変するようにすれば良い。
【0259】
【発明の効果】上述のように本発明によれば、回転自在
に枢支されたロータと、ロータにトルクを発生させるス
テータとがハウジング内に収納されたアクチュエータ装
置において、ステータに駆動電流を供給する駆動回路
と、予め与えられた制御ゲインパラメータを用いて駆動
回路に与える電流指令値を算出する演算手段とをハウジ
ングに設けるようにしたことにより、当該アクチュエー
タ装置を制御する演算手段を一体とすることができ、か
くしてアクチュエータシステムの構成を簡易化させ得る
アクチュエータ装置を実現できる。
【0260】また本発明においては、回転自在に枢支さ
れたロータと、ロータにトルクを発生させるステータ
と、ロータ及びステータを収納するハウジングと、ロー
タに発生したトルクを増幅して出力軸を介して出力する
トルク増幅手段を有するアクチュエータ装置において、
ハウジングに設けられ、ステータに駆動電流を供給する
駆動回路と、ハウジングに設けられ、予め与えられた制
御ゲインパラメータを用いて駆動回路に与える電流指令
値を決定する演算手段と、トルク増幅手段に設けられ、
出力軸の回転角度を検出する回転角度検出手段とを設
け、演算手段が、予め与えられたトルク増幅手段の数学
的モデルを用いて回転角度検出手段の検出結果からトル
ク増幅手段の出力軸に与えられた外力の推定値を算出
し、当該推定結果に応じて電流指令値を決定するように
したことにより、当該アクチュエータ装置を制御する演
算手段を一体とすることができ、アクチュエータシステ
ムの構成を簡易化させ得るアクチュエータ装置を実現で
きる。
【図面の簡単な説明】
【図1】本実施の形態によるACサーボモータの構成を
示す断面図である。
【図2】ロータ及びロータ軸磁極角度センサの構成を示
す略線図である。
【図3】ロータ及びステータ鉄心の位置関係を示す略線
図である。
【図4】ステータ及びパワー基板の構成を示す略線図で
ある。
【図5】トルク増幅部の構成を示す略線図である。
【図6】1回転絶対角度センサにおける樹脂マグネット
の着磁パターンの説明に供する特性曲線図である。
【図7】1回転絶対角度センサ信号の波形を示す特性曲
線図である。
【図8】制御基板の構成を示す略線図である。
【図9】制御基板の構成を示すブロック図である。
【図10】パワー基板の構成を示す回路図である。
【図11】1チップマイクロコンピュータの構成を示す
ブロック図である。
【図12】ロータ軸磁極角度センサにおける樹脂マグネ
ットの着磁パターンの説明に供する特性曲線図である。
【図13】第1及び第2のセンサ信号(第1及び第2の
ロータ軸磁極角度センサ信号)の波形を示す特性曲線図
である。
【図14】ロータ軸回転角度検出処理ブロックの構成を
示すブロック図である。
【図15】トルク−3相電流信号変換処理ブロックの構
成を示すブロック図である。
【図16】電流制御処理ブロックの構成を示すブロック
図である。
【図17】PWM変換器の処理の説明に供する略線図で
ある。
【図18】モータ回転制御処理モード時におけるCPU
の演算処理の説明に供するブロック図である。
【図19】モータ軸磁極回転数検出処理手順を示すブロ
ック図である。
【図20】ロータ及びギア機構の関係の数学モデルを示
すブロック図である。
【図21】外力推定処理モード時におけるCPUの演算
処理の説明に供するブロック図である。
【符号の説明】
1……ACサーボモータ、2……モータ部、3……トル
ク増幅部、4……モータケース、6……ロータ軸、8…
…ロータマグネット、9……ロータ、10、10A〜1
0F……ステータ鉄心、11、11A〜11F……コイ
ル、16……遊星歯車機構、18……出力軸、19、2
5……樹脂マグネット、20A、20B、26A〜26
D……ホール素子、21……1回転絶対角度センサ、2
2……ロータ軸磁極角度センサ、23……制御基板、2
4……パワー基板、27……1チップマイクロコンピュ
ータ、29……温度センサ、31〜33……ケーブル、
34……コイル駆動ブロック、40……演算処理ブロッ
ク、42……ロータ軸回転角度検出ブロック、43……
トルク−3相電流信号変換処理ブロック、44……電流
制御処理ブロック、52A〜52C……インバータ回
路、60……CPU、64……シリアル通信用入出力回
路、83A〜83C……PWM変換器、S1A、S1B
……1回転絶対角度センサ信号、S2A、S2B……ロ
ータ軸磁極角度センサ信号、S3A〜S3C……駆動電
流検出信号、S4A〜S4B……PWM信号、S13…
…温度センサ信号、Ur 、Vr 、Wr ……電流指令値、
Iu 、Iv 、Iw ……駆動電流、θp ……磁気角度、P
m1……ロータ軸磁極回転角度、Pref ……指定回転角
度、Vref ……指定回転速度、Tref ……指定回転トル
ク、T0 ……目標回転トルク、Tde……外力推定値。
───────────────────────────────────────────────────── フロントページの続き (51)Int.Cl.7 識別記号 FI テーマコート゛(参考) H02P 6/16 H02K 11/00 C E H02P 6/02 341N Fターム(参考) 5H019 BB01 BB05 BB15 BB19 BB22 CC03 DD01 FF01 5H560 BB04 BB12 DA02 DC02 DC04 DC05 DC12 EB01 SS01 TT12 TT15 TT16 UA02 XA02 XA04 XA05 XA10 XA12 5H576 CC01 DD02 DD07 EE11 GG01 GG02 GG04 GG08 HA02 HB01 JJ03 JJ04 JJ16 JJ17 JJ25 LL22 LL39 LL43 MM09 MM12 5H611 AA01 BB01 BB06 BB08 PP01 QQ04 TT01 UA01 5H621 BB10 HH01 HH02 JK14 JK15

Claims (3)

    【特許請求の範囲】
  1. 【請求項1】回転自在に枢支されたロータと、上記ロー
    タにトルクを発生させるステータとがハウジング内に収
    納されたアクチュエータ装置において、 上記ステータに駆動電流を供給する駆動回路と、 予め与えられた制御ゲインパラメータを用いて上記駆動
    回路に与える電流指令値を算出する演算手段とを上記ハ
    ウジングに具えることを特徴とするアクチュエータ装
    置。
  2. 【請求項2】上記ハウジング内に設けられ、上記ロータ
    を構成する駆動用の永久磁石の温度を検出する温度検出
    手段を具え、 上記演算手段は、 予め与えられた上記永久磁石の温度特性に応じて決まる
    温度係数を用い、上記温度検出手段の検出結果に基づい
    て上記電流指令値を決定することを特徴とする請求項1
    に記載のアクチュエータ装置。
  3. 【請求項3】回転自在に枢支されたロータと、上記ロー
    タにトルクを発生させるステータと、上記ロータ及び上
    記ステータを収納するハウジングと、上記ロータに発生
    した上記トルクを増幅して出力軸を介して出力するトル
    ク増幅手段を有するアクチュエータ装置において、 上記ハウジングに設けられ、上記ステータに駆動電流を
    供給する駆動回路と、 上記ハウジングに設けられ、予め与えられた制御ゲイン
    パラメータを用いて上記駆動回路に与える電流指令値を
    決定する演算手段と、 上記トルク増幅手段に設けられ、上記出力軸の回転角度
    を検出する回転角度検出手段とを具え、 上記演算手段が、 予め与えられた上記トルク増幅手段の数学的モデルを用
    いて上記回転角度検出手段の検出結果から上記トルク増
    幅手段の上記出力軸に与えられた外力の推定値を算出
    し、当該推定結果に応じて上記電流指令値を決定するこ
    とを特徴とするアクチュエータ装置。
JP2001347996A 1999-02-10 2001-11-13 アクチュエータ装置 Expired - Lifetime JP3402597B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2001347996A JP3402597B2 (ja) 1999-02-10 2001-11-13 アクチュエータ装置

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
JP3338699 1999-02-10
JP11-33386 1999-02-10
JP2001347996A JP3402597B2 (ja) 1999-02-10 2001-11-13 アクチュエータ装置

Related Parent Applications (1)

Application Number Title Priority Date Filing Date
JP2000038097A Division JP3332226B2 (ja) 1999-02-10 2000-02-09 アクチュエータ装置

Publications (2)

Publication Number Publication Date
JP2002199771A true JP2002199771A (ja) 2002-07-12
JP3402597B2 JP3402597B2 (ja) 2003-05-06

Family

ID=26372070

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2001347996A Expired - Lifetime JP3402597B2 (ja) 1999-02-10 2001-11-13 アクチュエータ装置

Country Status (1)

Country Link
JP (1) JP3402597B2 (ja)

Cited By (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2005237168A (ja) * 2004-02-23 2005-09-02 Yaskawa Electric Corp アンプ一体型アクチュエータ装置およびロボットアーム
US7166981B2 (en) 2004-03-29 2007-01-23 Sanyo Electric Co., Ltd. Actuator, motor unit and controller unit
JP2008224618A (ja) * 2007-03-15 2008-09-25 Olympus Imaging Corp レーザスキャナ及び投光器
WO2009030350A3 (de) * 2007-08-28 2009-08-06 Sew Eurodrive Gmbh & Co Elektromotor mit winkelsensor
JP2010273494A (ja) * 2009-05-25 2010-12-02 Hitachi Automotive Systems Ltd モータ駆動装置
JP2012147669A (ja) * 2012-04-23 2012-08-02 Keihin Corp 回転式アクチュエータ
JP2013031263A (ja) * 2011-07-27 2013-02-07 Jtekt Corp 電動モータおよびこれを備える車両
JP2017112733A (ja) * 2015-12-16 2017-06-22 オムロン株式会社 ブラシレスモータ
CN108429404A (zh) * 2017-02-15 2018-08-21 发那科株式会社 电动机
US11624521B2 (en) 2017-09-11 2023-04-11 Mitsubishi Electric Corporation Electric motor and air-conditioning apparatus including same

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4543369B2 (ja) * 2004-02-23 2010-09-15 株式会社安川電機 アンプ一体型アクチュエータ装置およびロボットアーム
JP2005237168A (ja) * 2004-02-23 2005-09-02 Yaskawa Electric Corp アンプ一体型アクチュエータ装置およびロボットアーム
US7166981B2 (en) 2004-03-29 2007-01-23 Sanyo Electric Co., Ltd. Actuator, motor unit and controller unit
JP2008224618A (ja) * 2007-03-15 2008-09-25 Olympus Imaging Corp レーザスキャナ及び投光器
WO2009030350A3 (de) * 2007-08-28 2009-08-06 Sew Eurodrive Gmbh & Co Elektromotor mit winkelsensor
JP2010273494A (ja) * 2009-05-25 2010-12-02 Hitachi Automotive Systems Ltd モータ駆動装置
JP2013031263A (ja) * 2011-07-27 2013-02-07 Jtekt Corp 電動モータおよびこれを備える車両
JP2012147669A (ja) * 2012-04-23 2012-08-02 Keihin Corp 回転式アクチュエータ
JP2017112733A (ja) * 2015-12-16 2017-06-22 オムロン株式会社 ブラシレスモータ
CN108429404A (zh) * 2017-02-15 2018-08-21 发那科株式会社 电动机
JP2018133921A (ja) * 2017-02-15 2018-08-23 ファナック株式会社 軸受の動作状態検出用のセンサを備える電動機
US10461608B2 (en) 2017-02-15 2019-10-29 Fanuc Corporation Motor having sensor for detecting operating state of bearing
US11624521B2 (en) 2017-09-11 2023-04-11 Mitsubishi Electric Corporation Electric motor and air-conditioning apparatus including same

Also Published As

Publication number Publication date
JP3402597B2 (ja) 2003-05-06

Similar Documents

Publication Publication Date Title
US6548981B1 (en) Actuator
JP3332226B2 (ja) アクチュエータ装置
JP4879649B2 (ja) 電動機の制御装置
JP3467961B2 (ja) 回転電機の制御装置
US5834918A (en) Self-tuning tracking controller for permanent-magnet synchronous motors
US7538510B2 (en) Controller for motor
KR102588927B1 (ko) 모터 제어방법
JP3402597B2 (ja) アクチュエータ装置
JP3661864B2 (ja) ステッピングモータの駆動装置
CN101286725A (zh) 同步电机矢量控制系统中电机旋转速度和转子位置推测方法
CN110729940A (zh) 一种永磁同步电机初始相位检测方法
US6885970B2 (en) Saliency-based position estimation in permanent magnet synchronous motors
JP3397013B2 (ja) 同期モータの制御装置
EP0104909B1 (en) Servomotor control method and apparatus therefor
CN110601633A (zh) 一种永磁同步电机初始相位检测系统
JP6780855B2 (ja) サーボアクチュエータ
CN102403937A (zh) 永磁同步电机中齿槽力矩的测量及抑制系统与实现方法
JP2004320847A (ja) ステッピングモータ制御方法とステッピングモータ制御装置
JP2002051595A (ja) 電動機の制御装置
JPH10337100A (ja) 磁石埋込型同期電動機の制御方法及び装置
JP2004274855A (ja) ローター位置検出調整方法及びローター位置検出調整装置
US5200682A (en) Motor current phase delay compensating method and apparatus thereof
JP2004336949A (ja) モータ駆動制御方法及びモータ駆動制御装置
Qian et al. Periodic torque ripples minimization in PMSM using learning variable structure control based on a torque observer
JPH03178590A (ja) ブラシレス同期電動機の制御装置

Legal Events

Date Code Title Description
TRDD Decision of grant or rejection written
R151 Written notification of patent or utility model registration

Ref document number: 3402597

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20080229

Year of fee payment: 5

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20090228

Year of fee payment: 6

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20100228

Year of fee payment: 7

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20100228

Year of fee payment: 7

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20110228

Year of fee payment: 8

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20120229

Year of fee payment: 9

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130228

Year of fee payment: 10

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

EXPY Cancellation because of completion of term