外乱補償装置
【課題】モータに作用する負荷トルクの変動だけでなく、前記モータの電機子インダクタンス、直流抵抗（発熱により大きく変動する）および逆起電力定数の影響の変動をも補償できる外乱補償装置を提供する。
【解決手段】モータ３の回転速度を検出する速度センサ１１と、モータ３の電機子インダクタンスＬ、直流抵抗Ｒおよび逆起電力Ｅｅｍｆがモータ３の回転動作に与える影響を反映させた影響合成信号ω（ＪＬｓ２＋ＪＲｓ＋ＫｔＫｅｍｆ）を、回転速度ωから生成する合成信号生成部１３と、影響合成信号に基づいて、前記電力供給指令値Ｅｉを補正する補正部１５と、を備える。
【解決手段】モータ３の回転速度を検出する速度センサ１１と、モータ３の電機子インダクタンスＬ、直流抵抗Ｒおよび逆起電力Ｅｅｍｆがモータ３の回転動作に与える影響を反映させた影響合成信号ω（ＪＬｓ２＋ＪＲｓ＋ＫｔＫｅｍｆ）を、回転速度ωから生成する合成信号生成部１３と、影響合成信号に基づいて、前記電力供給指令値Ｅｉを補正する補正部１５と、を備える。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、モータの回転動作を制御する制御装置に組み込まれ、該モータに作用する負荷トルクの変動を補償する外乱補償装置に関する。
【背景技術】
【０００２】
図２に基づいて、従来の外乱補償装置について説明する。図２は、モータ２１の制御装置２３に組み込まれる従来の外乱補償装置２０を示すブロック線図である。
図２と以下の説明で用いる記号についての定義は下記の通りである。下記において［］内は単位である。
Ｉｉ：電流制御指令値
Ｉ：モータ２１に供給される電流値［Ａ］
Ｋｔ：モータ２１のトルク定数［Ｎｍ／Ａ］
Ｊｍ：モータ２１の慣性（イナーシャ）［ｋｇ・ｍ２］
ＴＬ：モータ２１に作用する負荷トルク［Ｎｍ］
ω：モータ２１の回転角速度［ｒａｄ／ｓ］
ωｃ：カットオフ周波数［ｒａｄ／ｓ］
ｓ：ラプラス演算子
【０００３】
制御装置２３は、前記モータ２１に電力を供給するモータドライバ２５と、該モータドライバ２５に電流制御指令値Ｉｉを出力する指令部２７と、を備える。前記モータドライバ２５は、電流制御指令値Ｉｉに基づいた電流を前記モータ２１へ供給する。
【０００４】
モータ２１について説明する。モータ２１に、モータドライバ２５から電流Ｉが供給されることで、ＩＫｔのトルクがモータ２１に与えられる。その一方、摩擦や負荷などの負荷トルクＴＬがモータ２１に作用する。従って、モータ２１に作用する正味のトルクは、ＩＫｔ−ＴＬとなる。この場合、モータ２１の回転角速度ωは、（ＩＫｔ−ＴＬ）／Ｊｍｓとなる。
【０００５】
外乱補償装置２０は、上述のモータ２１の回転角速度ω＝（ＩＫｔ−ＴＬ）／Ｊｍｓに基づいて、電流制御指令値Ｉｉを補正することで、上述の負荷トルクを補償する。外乱補償装置２０は、指令トルク算出部２９と、速度センサ３１と、速度トルク換算部３３と、偏差算出部３５と、単位調節部３７と、補正部３９とを備える。
指令トルク算出部２９は、モータドライバ２５が前記モータ２１へ供給する電流値Ｉとトルク定数Ｋｔとの積によりトルク値ＩＫｔを算出する。
速度センサ３１は、モータ２１の回転角速度ωを検出する。
速度トルク換算部３３は、回転角速度ωとＪｍｓとの積によりトルク値ωＪｍｓを算出する。
偏差算出部３５は、指令トルク算出部２９からのトルク値ＩＫｔと、速度トルク換算部３３からのトルク値ωＪｍｓとのトルク偏差ＩＫｔ−ωＪｍｓを算出して出力する。
単位調節部３７は、偏差算出部３５からのトルク偏差ＩＫｔ−ωＪｍｓに１／Ｋｔを乗算した値（ＩＫｔ−ωＪｍｓ）／Ｋｔを算出する。
補正部３９は、単位調節部３７からの出力（ＩＫｔ−ωＪｍｓ）／Ｋｔを、電流制御指令値Ｉｉに加算することで、電流制御指令値Ｉｉを補正する。
なお、符号４１はローパスフィルタを示す。
【０００６】
上述した外乱補償装置２０の構成では、速度トルク換算部３３が算出したトルク値ωＪｍｓは、負荷トルクや摩擦や慣性モーメントなどを含めた負荷トルクが反映されたものであるので、補正部３９が、（ＩＫｔ−ωＪｍｓ）／Ｋｔを、電流制御指令値Ｉｉに加算することで、負荷トルク変動の影響を取り除くことが可能である。
【０００７】
上述のような外乱補償装置２０は例えば下記の非特許文献１に記載されている。また、本願に対する他の先行技術文献として、下記の特許文献１〜４がある。
【特許文献１】特開平０３−１５５３８３号公報
【特許文献２】特開平１１−２８５２８３号公報
【特許文献３】特開２００２−３６６２０３号公報
【特許文献４】特開２００７−２３３９１７号公報
【非特許文献１】日本ロボット学会誌 Ｖｏｌ．１１ Ｎｏ．４， ｐｐ．４８６〜４９３，１９９３年５月
【発明の開示】
【発明が解決しようとする課題】
【０００８】
しかし、図２の構成では、モータの電機子インダクタンス、直流抵抗、逆起電力定数が考慮されておらず、これらの影響の変動を取り除くことができない。
そこで、本発明の目的は、モータに作用する負荷トルクの変動だけでなく、前記モータの電機子インダクタンス、直流抵抗（発熱により大きく変動する）および逆起電力定数の影響の変動をも補償できる外乱補償装置を提供することにある。
【課題を解決するための手段】
【０００９】
上記目的を達成するため、本発明によると、モータの回転動作を制御する制御装置に組み込まれ、該モータに作用する負荷トルクの変動を補償する外乱補償装置であって、
前記制御装置は、
前記モータに電圧を印加するモータドライバと、
該モータドライバに電力供給指令値を出力する指令部と、を備え、前記モータドライバは、電力供給指令値に基づいて前記モータに電圧を印加し、
前記外乱補償装置は、
前記モータの回転速度を検出する速度センサと、
前記モータの電機子インダクタンス、直流抵抗および逆起電力が前記回転動作に与える影響を反映させた影響合成信号を、前記回転速度から生成する合成信号生成部と、
前記影響合成信号に基づいて、前記電力供給指令値を補正する補正部と、を備える、ことを特徴とする外乱補償装置が提供される。
【００１０】
上述した本発明による外乱補償装置によると、合成信号生成部が、前記モータの電機子インダクタンス、直流抵抗および逆起電力が前記回転動作に与える影響を反映させた影響合成信号を、負荷トルク変動の影響を受けた前記回転速度から生成し、前記補正部が、前記影響合成信号に基づいて、前記電力供給指令値を補正するので、モータの負荷トルク変動だけでなく、前記モータの電機子インダクタンス、直流抵抗および逆起電力定数の影響の変動をも補償して取り除くように前記電力供給指令値を補正することができる。よって、より広い補償効果が得られる外乱補償装置が実現される。
【００１１】
本発明の好ましい実施形態によると、モータドライバが電力供給指令値に基づいて前記モータに印加する前記電圧の値をＥとし、前記モータのトルク定数をＫｔとし、前記モータの電機子インダクタンスをＬとし、前記モータの直流抵抗をＲとし、前記モータの逆起電力定数をＫｅｍｆとし、前記モータの慣性をＪｍとし、前記回転速度である前記モータの回転角速度をωとし、ラプラス演算子をｓとし、αを１または他の値の定数として、
前記補正部は、前記影響合成信号として、αω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）を算出する。
【００１２】
後述するように、ω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）は、前記モータの電機子インダクタンス、直流抵抗および逆起電力が前記回転動作に与える影響を反映させた信号である。従って、このような影響合成信号に基づいて、前記電力供給指令値を補正することで、前記モータの電機子インダクタンス、直流抵抗および逆起電力定数の影響の変動をも補償して取り除くように前記電力供給指令値を補正することができる。
【００１３】
具体的には、前記補正部は次の構成により、前記電力供給指令値を補正してよい。
【００１４】
βを１または他の値の定数として、前記電圧ＥがβＥｉである場合に、
前記補正部は、
偏差ΔＤ＝αβＥｉＫｔ−αω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）を算出する偏差算出部と、
前記偏差ΔＤを前記電力供給指令値Ｅｉに加算する加算部と、を有する。
【発明の効果】
【００１５】
上述した本発明によると、モータに作用する負荷トルクの変動だけでなく、前記モータの電機子インダクタンス、直流抵抗および逆起電力定数の影響の変動をも補償できる。
【発明を実施するための最良の形態】
【００１６】
本発明を実施するための最良の実施形態を図面に基づいて説明する。なお、各図において共通する部分には同一の符号を付し、重複した説明を省略する。
【００１７】
図１は、本発明の実施形態による外乱補償装置１０を示すブロック線図である。
本実施形態による外乱補償装置１０は、モータ３の回転動作を制御する制御装置５に組み込まれ、該モータ３に作用する負荷トルクの変動を補償するものである。
【００１８】
最初に、図１と以下の説明で用いる記号について説明する。各記号の定義は下記の通りである。下記において［］内は単位である。
Ｅｉ：電力供給指令値
Ｅ：モータ３に供給される電圧値［Ｖ］
Ｅｅｍｆ：モータ３の逆起電圧［Ｖ］
Ｉ：モータ３に供給される電流値［Ｖ］
ＴＬ：モータ３の負荷トルク［Ｎｍ］
ωｍ：モータ３の回転角速度［ｒａｄ／ｓ］
θｍ：モータ３の回転角［ｒａｄ］
Ｋｔ：モータ３のトルク定数［Ｎｍ／Ａ］
Ｌ：モータ３の電機子のインダクタンス［Ｈ］
Ｒ：モータ３の直流抵抗［Ｒ］
Ｊｍ：モータ３の慣性（イナーシャ）［ｋｇ・ｍ２］
Ｋｅｍｆ：逆起電力定数［Ｖ／（ｒａｄ／ｓ）］
ζ：減衰比
ωｃ：カットオフ周波数［ｒａｄ／ｓ］
ｓ：ラプラス演算子
【００１９】
前記制御装置５は、前記モータ３に電力を供給するモータドライバ７と、該モータドライバ７に電力供給指令値Ｅｉを出力する指令部９と、を備える。前記モータドライバ７は、前記電力供給指令値Ｅｉに基づいて前記モータ３へ電圧Ｅを供給する。βを１または他の値の定数として、電圧Ｅは、Ｅ＝βＥｉであってよいが、簡単のため、以下の説明においてβ＝１とする。
なお、前記制御装置５は、モータ３の回転角速度ω、モータ３の回転角θなどに基づいて、電力供給指令値Ｅｉを指令部９から出力するものであってよい。前記制御装置５の制御方式としては、例えば、フィードバック制御、フィードフォワード制御などを採用してよい。
【００２０】
前記外乱補償装置１０は、速度センサ１１と、合成信号生成部１３と、補正部１５とを備える。
【００２１】
速度センサ１１は、前記モータ３の回転速度（この例では、回転角速度ω）を検出する。
【００２２】
合成信号生成部１３は、前記モータ３の電機子インダクタンスＬ、直流抵抗Ｒおよび逆起電力Ｅｅｍｆが前記回転動作に与える影響を反映させた影響合成信号を、速度センサ１１が検出した前記回転速度（この例では、回転角速度ω）から生成する。
図１の例では、合成信号生成部１３は、前記回転角速度ωと（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）との積により、ω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）を影響合成信号として算出し出力する。ここで、αを１または他の値の定数として、合成信号生成部１３は、αω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）を影響合成信号を出力してよいが、簡単のため、以下の説明において、α＝１とする。
【００２３】
補正部１５は、前記影響合成信号に基づいて、前記電力供給指令値Ｅｉを補正する。
図１の例では、補正部１５は、次のように電力供給指令値Ｅｉを補正する。補正部１５は、単位変換部１５ａと、偏差算出部１５ｂと、単位逆変換部１５ｃと、加算部１５ｄを有する。
【００２４】
単位変換部１５ａは、モータドライバ７がモータ３に印加する電圧Ｅの単位を影響合成信号の単位と同じにするために、当該電圧値Ｅとトルク定数Ｋｔとの積により、ＥＫｔを算出して出力する。
【００２５】
偏差算出部１５ｂは、単位変換部１５ａの出力ＥＫｔと、合成信号生成部１３の出力ω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）との偏差ＥＫｔ−ω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）を算出して出力する。
【００２６】
単位逆変換部１５ｃは、偏差算出部１５ｂの出力を、単位変換により電力供給指令値Ｅｉに換算するため、偏差算出部１５ｂの出力ＥＫｔ−ω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）と、トルク定数の逆数１／Ｋｔとの積により、{ＥＫｔ−ω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）}／Ｋｔを算出して出力する。なお、図１の例のように、単位逆変換部１５ｃは、２次ローパスフィルタ１５ｅを通過した偏差算出部１５ｂの出力と、トルク定数の逆数１／Ｋｔとの積により、{ＥＫｔ−ω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）}／Ｋｔを算出して出力するのがよい。
【００２７】
加算部１５ｄは、モータドライバ７がモータ３に印加する電圧値Ｅと、単位逆変換部１５ｃの出力{ＥＫｔ−ω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）}／Ｋｔとを加算することで、Ｅ＋{ＥＫｔ−ω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）}／Ｋｔを算出して出力する。この加算部１５ｄの出力Ｅ＋{ＥＫｔ−ω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）}／Ｋｔが、補正された電力供給指令値Ｅｉとしてモータドライバ７に入力される。
【００２８】
なお、外乱補償装置１０における演算で使用されるＪｍ、Ｌ、Ｒ、Ｋｅｍｆ，Ｋｔは、ノミナル値（公称値）であってよい。
【００２９】
合成信号生成部１３と補正部１５による作用効果を、モータ３のインダクタンス等の影響を受けた電圧などに関連させて説明する。
（電圧について）
モータ３には、モータドライバ７により電圧Ｅが印加される。その一方で、モータ３には、モータ３の回転運動による逆起電力Ｅｅｍｆ＝ωＫｅｍｆが発生する。従って、モータ３に印加される正味の電圧値は、Ｅ−Ｅｅｍｆ＝Ｅ−ωＫｅｍｆとなる。
（電流について）
モータ３に印加される正味の電圧はＥ−ωＫｅｍｆであり、モータ３の直流抵抗はＲ、モータ３のインダクタンスはＬであるので、ラプラス演算子をｓとして、モータ３に流れる電流は、（Ｅ−ωＫｅｍｆ）／（Ｌｓ＋Ｒ）となる。
（トルクについて）
モータ３に流れる電流は、（Ｅ−ωＫｅｍｆ）／（Ｌｓ＋Ｒ）であるので、トルク定数をＫｔとして、電流によりモータ３に与えられるトルクは、Ｋｔ（Ｅ−ωＫｅｍｆ）／（Ｌｓ＋Ｒ）となる。その一方で、モータ３には負荷トルクＴＬが作用するので、モータ３の正味のトルクは、Ｋｔ（Ｅ−ωＫｅｍｆ）／（Ｌｓ＋Ｒ）−ＴＬとなる。
（回転角速度について）
モータ３の正味のトルクは、Ｋｔ（Ｅ−ωＫｅｍｆ）／（Ｌｓ＋Ｒ）−ＴＬであるので、モータ３のイナーシャをＪｍとし、ラプラス演算子をｓとして、モータ３の回転角速度ωは、ω＝｛Ｋｔ（Ｅ−ωＫｅｍｆ）／（Ｌｓ＋Ｒ）−ＴＬ｝／Ｊｍｓとなる。
（影響合成信号について）
ω＝｛Ｋｔ（Ｅ−ωＫｅｍｆ）／（Ｌｓ＋Ｒ）−ＴＬ｝／Ｊｍｓを変形すると、
ＥＫｔ＝ω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）＋ＴＬ（Ｌｓ＋Ｒ）
となる。
この式において、左辺のＥＫｔを電気的エネルギに換算して考えると、電気的エネルギが、右辺の第１項のエネルギと、右辺の第２項のエネルギに変換されたとみなせる。このうち、右辺の第１項は、モータ３の運動エネルギとみなせることができ、右辺の第２項は、負荷トルク、電機子インダクタンスおよび直流抵抗の影響により失われたエネルギとみなすことができる。
従って、右辺の第２項ＴＬ（Ｌｓ＋Ｒ）に相当する値だけ、モータ３に供給する電圧Ｅ（すなわち、電力供給指令値Ｅｉ）を増加させることで、負荷トルク、電機子インダクタンスおよび直流抵抗の影響の変動を取り除くことができる。なお、直流抵抗は、発熱により大きく変動する。
具体的には、合成信号生成部１３と補正部１５により、上述のように、ＴＬ（Ｌｓ＋Ｒ）に相当する値だけ増加させる補正を、すなわち、ＴＬ（Ｌｓ＋Ｒ）／Ｋｔ＝{ＥＫｔ−ω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）}／Ｋｔだけ増加させる補正を、電力供給指令値Ｅｉに対し行うことで、負荷トルク、電機子インダクタンスおよび直流抵抗の影響の変動を取り除くことができる。
【００３０】
本実施形態による外乱補償装置１０によると、合成信号生成部１３が、前記モータ３の電機子インダクタンス、直流抵抗および逆起電力が前記回転動作に与える影響を反映させた影響合成信号を、負荷トルクの影響を受けた前記回転速度から生成し、前記補正部１５が、前記影響合成信号に基づいて、前記電力供給指令値Ｅｉを補正するので、モータ３の負荷トルクの変動だけでなく、前記モータ３の電機子インダクタンス、直流抵抗および逆起電力定数の影響の変動をも補償して取り除くように前記電力供給指令値Ｅｉを補正することができる。よって、より広い補償効果が得られる外乱補償装置１０が実現される。
また、上述したように、ω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）は、前記モータ３の電機子インダクタンス、直流抵抗および逆起電力が前記回転動作に与える影響を反映させた信号である。従って、このような影響合成信号に基づいて、前記電力供給指令値Ｅｉを補正することで、前記モータ３の電機子インダクタンス、直流抵抗および逆起電力定数の影響の変動をも補償して取り除くように前記電力供給指令値Ｅｉを補正することができる。
【００３１】
本発明は上述した実施の形態に限定されず、本発明の要旨を逸脱しない範囲で種々変更を加え得ることは勿論である。
【００３２】
上述では、簡単のため、β＝１、α＝１として説明したが、β、αは１以外の定数であってもよい。この場合、Ｅ＝βＥｉとなり、合成信号生成部１３は、αω（ＪＬｓ２＋ＪＲｓ＋ＫｔＫｅｍｆ）を影響合成信号として出力する。また、この場合、単位変換部１５ａは、αＫｔを電圧Ｅに乗算して、αＥＫｔを算出して出力し、単位逆変換部１５ｃは、１／αβＫｔを偏差算出部１５ｂからの出力に乗算する。この場合、他の構成は上述と同じであってよい。
【図面の簡単な説明】
【００３３】
【図１】本発明の実施形態による外乱補償装置を示すブロック線図である。
【図２】従来の外乱補償装置を示すブロック線図である。
【符号の説明】
【００３４】
３ モータ、５ 制御装置、７ モータドライバ、９ 指令部、
１０ 外乱補償装置、１１ 速度センサ、１３ 合成信号生成部、
１５ 補正部、１５ａ 単位変換部、１５ｂ 偏差算出部、
１５ｃ 単位逆変換部、１５ｄ 加算部、１５ｅ ２次ローパスフィルタ
２０ 外乱補償装置、２１ モータ、２３ 制御装置、
２５ モータドライバ、２７ 指令部、２９ 指令トルク算出部、
３１ 速度センサ、３３ 速度トルク換算部、３５ 偏差算出部、
３７ 単位調整部、３９ 補正部、４１ ローパスフィルタ
【技術分野】
【０００１】
本発明は、モータの回転動作を制御する制御装置に組み込まれ、該モータに作用する負荷トルクの変動を補償する外乱補償装置に関する。
【背景技術】
【０００２】
図２に基づいて、従来の外乱補償装置について説明する。図２は、モータ２１の制御装置２３に組み込まれる従来の外乱補償装置２０を示すブロック線図である。
図２と以下の説明で用いる記号についての定義は下記の通りである。下記において［］内は単位である。
Ｉｉ：電流制御指令値
Ｉ：モータ２１に供給される電流値［Ａ］
Ｋｔ：モータ２１のトルク定数［Ｎｍ／Ａ］
Ｊｍ：モータ２１の慣性（イナーシャ）［ｋｇ・ｍ２］
ＴＬ：モータ２１に作用する負荷トルク［Ｎｍ］
ω：モータ２１の回転角速度［ｒａｄ／ｓ］
ωｃ：カットオフ周波数［ｒａｄ／ｓ］
ｓ：ラプラス演算子
【０００３】
制御装置２３は、前記モータ２１に電力を供給するモータドライバ２５と、該モータドライバ２５に電流制御指令値Ｉｉを出力する指令部２７と、を備える。前記モータドライバ２５は、電流制御指令値Ｉｉに基づいた電流を前記モータ２１へ供給する。
【０００４】
モータ２１について説明する。モータ２１に、モータドライバ２５から電流Ｉが供給されることで、ＩＫｔのトルクがモータ２１に与えられる。その一方、摩擦や負荷などの負荷トルクＴＬがモータ２１に作用する。従って、モータ２１に作用する正味のトルクは、ＩＫｔ−ＴＬとなる。この場合、モータ２１の回転角速度ωは、（ＩＫｔ−ＴＬ）／Ｊｍｓとなる。
【０００５】
外乱補償装置２０は、上述のモータ２１の回転角速度ω＝（ＩＫｔ−ＴＬ）／Ｊｍｓに基づいて、電流制御指令値Ｉｉを補正することで、上述の負荷トルクを補償する。外乱補償装置２０は、指令トルク算出部２９と、速度センサ３１と、速度トルク換算部３３と、偏差算出部３５と、単位調節部３７と、補正部３９とを備える。
指令トルク算出部２９は、モータドライバ２５が前記モータ２１へ供給する電流値Ｉとトルク定数Ｋｔとの積によりトルク値ＩＫｔを算出する。
速度センサ３１は、モータ２１の回転角速度ωを検出する。
速度トルク換算部３３は、回転角速度ωとＪｍｓとの積によりトルク値ωＪｍｓを算出する。
偏差算出部３５は、指令トルク算出部２９からのトルク値ＩＫｔと、速度トルク換算部３３からのトルク値ωＪｍｓとのトルク偏差ＩＫｔ−ωＪｍｓを算出して出力する。
単位調節部３７は、偏差算出部３５からのトルク偏差ＩＫｔ−ωＪｍｓに１／Ｋｔを乗算した値（ＩＫｔ−ωＪｍｓ）／Ｋｔを算出する。
補正部３９は、単位調節部３７からの出力（ＩＫｔ−ωＪｍｓ）／Ｋｔを、電流制御指令値Ｉｉに加算することで、電流制御指令値Ｉｉを補正する。
なお、符号４１はローパスフィルタを示す。
【０００６】
上述した外乱補償装置２０の構成では、速度トルク換算部３３が算出したトルク値ωＪｍｓは、負荷トルクや摩擦や慣性モーメントなどを含めた負荷トルクが反映されたものであるので、補正部３９が、（ＩＫｔ−ωＪｍｓ）／Ｋｔを、電流制御指令値Ｉｉに加算することで、負荷トルク変動の影響を取り除くことが可能である。
【０００７】
上述のような外乱補償装置２０は例えば下記の非特許文献１に記載されている。また、本願に対する他の先行技術文献として、下記の特許文献１〜４がある。
【特許文献１】特開平０３−１５５３８３号公報
【特許文献２】特開平１１−２８５２８３号公報
【特許文献３】特開２００２−３６６２０３号公報
【特許文献４】特開２００７−２３３９１７号公報
【非特許文献１】日本ロボット学会誌 Ｖｏｌ．１１ Ｎｏ．４， ｐｐ．４８６〜４９３，１９９３年５月
【発明の開示】
【発明が解決しようとする課題】
【０００８】
しかし、図２の構成では、モータの電機子インダクタンス、直流抵抗、逆起電力定数が考慮されておらず、これらの影響の変動を取り除くことができない。
そこで、本発明の目的は、モータに作用する負荷トルクの変動だけでなく、前記モータの電機子インダクタンス、直流抵抗（発熱により大きく変動する）および逆起電力定数の影響の変動をも補償できる外乱補償装置を提供することにある。
【課題を解決するための手段】
【０００９】
上記目的を達成するため、本発明によると、モータの回転動作を制御する制御装置に組み込まれ、該モータに作用する負荷トルクの変動を補償する外乱補償装置であって、
前記制御装置は、
前記モータに電圧を印加するモータドライバと、
該モータドライバに電力供給指令値を出力する指令部と、を備え、前記モータドライバは、電力供給指令値に基づいて前記モータに電圧を印加し、
前記外乱補償装置は、
前記モータの回転速度を検出する速度センサと、
前記モータの電機子インダクタンス、直流抵抗および逆起電力が前記回転動作に与える影響を反映させた影響合成信号を、前記回転速度から生成する合成信号生成部と、
前記影響合成信号に基づいて、前記電力供給指令値を補正する補正部と、を備える、ことを特徴とする外乱補償装置が提供される。
【００１０】
上述した本発明による外乱補償装置によると、合成信号生成部が、前記モータの電機子インダクタンス、直流抵抗および逆起電力が前記回転動作に与える影響を反映させた影響合成信号を、負荷トルク変動の影響を受けた前記回転速度から生成し、前記補正部が、前記影響合成信号に基づいて、前記電力供給指令値を補正するので、モータの負荷トルク変動だけでなく、前記モータの電機子インダクタンス、直流抵抗および逆起電力定数の影響の変動をも補償して取り除くように前記電力供給指令値を補正することができる。よって、より広い補償効果が得られる外乱補償装置が実現される。
【００１１】
本発明の好ましい実施形態によると、モータドライバが電力供給指令値に基づいて前記モータに印加する前記電圧の値をＥとし、前記モータのトルク定数をＫｔとし、前記モータの電機子インダクタンスをＬとし、前記モータの直流抵抗をＲとし、前記モータの逆起電力定数をＫｅｍｆとし、前記モータの慣性をＪｍとし、前記回転速度である前記モータの回転角速度をωとし、ラプラス演算子をｓとし、αを１または他の値の定数として、
前記補正部は、前記影響合成信号として、αω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）を算出する。
【００１２】
後述するように、ω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）は、前記モータの電機子インダクタンス、直流抵抗および逆起電力が前記回転動作に与える影響を反映させた信号である。従って、このような影響合成信号に基づいて、前記電力供給指令値を補正することで、前記モータの電機子インダクタンス、直流抵抗および逆起電力定数の影響の変動をも補償して取り除くように前記電力供給指令値を補正することができる。
【００１３】
具体的には、前記補正部は次の構成により、前記電力供給指令値を補正してよい。
【００１４】
βを１または他の値の定数として、前記電圧ＥがβＥｉである場合に、
前記補正部は、
偏差ΔＤ＝αβＥｉＫｔ−αω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）を算出する偏差算出部と、
前記偏差ΔＤを前記電力供給指令値Ｅｉに加算する加算部と、を有する。
【発明の効果】
【００１５】
上述した本発明によると、モータに作用する負荷トルクの変動だけでなく、前記モータの電機子インダクタンス、直流抵抗および逆起電力定数の影響の変動をも補償できる。
【発明を実施するための最良の形態】
【００１６】
本発明を実施するための最良の実施形態を図面に基づいて説明する。なお、各図において共通する部分には同一の符号を付し、重複した説明を省略する。
【００１７】
図１は、本発明の実施形態による外乱補償装置１０を示すブロック線図である。
本実施形態による外乱補償装置１０は、モータ３の回転動作を制御する制御装置５に組み込まれ、該モータ３に作用する負荷トルクの変動を補償するものである。
【００１８】
最初に、図１と以下の説明で用いる記号について説明する。各記号の定義は下記の通りである。下記において［］内は単位である。
Ｅｉ：電力供給指令値
Ｅ：モータ３に供給される電圧値［Ｖ］
Ｅｅｍｆ：モータ３の逆起電圧［Ｖ］
Ｉ：モータ３に供給される電流値［Ｖ］
ＴＬ：モータ３の負荷トルク［Ｎｍ］
ωｍ：モータ３の回転角速度［ｒａｄ／ｓ］
θｍ：モータ３の回転角［ｒａｄ］
Ｋｔ：モータ３のトルク定数［Ｎｍ／Ａ］
Ｌ：モータ３の電機子のインダクタンス［Ｈ］
Ｒ：モータ３の直流抵抗［Ｒ］
Ｊｍ：モータ３の慣性（イナーシャ）［ｋｇ・ｍ２］
Ｋｅｍｆ：逆起電力定数［Ｖ／（ｒａｄ／ｓ）］
ζ：減衰比
ωｃ：カットオフ周波数［ｒａｄ／ｓ］
ｓ：ラプラス演算子
【００１９】
前記制御装置５は、前記モータ３に電力を供給するモータドライバ７と、該モータドライバ７に電力供給指令値Ｅｉを出力する指令部９と、を備える。前記モータドライバ７は、前記電力供給指令値Ｅｉに基づいて前記モータ３へ電圧Ｅを供給する。βを１または他の値の定数として、電圧Ｅは、Ｅ＝βＥｉであってよいが、簡単のため、以下の説明においてβ＝１とする。
なお、前記制御装置５は、モータ３の回転角速度ω、モータ３の回転角θなどに基づいて、電力供給指令値Ｅｉを指令部９から出力するものであってよい。前記制御装置５の制御方式としては、例えば、フィードバック制御、フィードフォワード制御などを採用してよい。
【００２０】
前記外乱補償装置１０は、速度センサ１１と、合成信号生成部１３と、補正部１５とを備える。
【００２１】
速度センサ１１は、前記モータ３の回転速度（この例では、回転角速度ω）を検出する。
【００２２】
合成信号生成部１３は、前記モータ３の電機子インダクタンスＬ、直流抵抗Ｒおよび逆起電力Ｅｅｍｆが前記回転動作に与える影響を反映させた影響合成信号を、速度センサ１１が検出した前記回転速度（この例では、回転角速度ω）から生成する。
図１の例では、合成信号生成部１３は、前記回転角速度ωと（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）との積により、ω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）を影響合成信号として算出し出力する。ここで、αを１または他の値の定数として、合成信号生成部１３は、αω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）を影響合成信号を出力してよいが、簡単のため、以下の説明において、α＝１とする。
【００２３】
補正部１５は、前記影響合成信号に基づいて、前記電力供給指令値Ｅｉを補正する。
図１の例では、補正部１５は、次のように電力供給指令値Ｅｉを補正する。補正部１５は、単位変換部１５ａと、偏差算出部１５ｂと、単位逆変換部１５ｃと、加算部１５ｄを有する。
【００２４】
単位変換部１５ａは、モータドライバ７がモータ３に印加する電圧Ｅの単位を影響合成信号の単位と同じにするために、当該電圧値Ｅとトルク定数Ｋｔとの積により、ＥＫｔを算出して出力する。
【００２５】
偏差算出部１５ｂは、単位変換部１５ａの出力ＥＫｔと、合成信号生成部１３の出力ω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）との偏差ＥＫｔ−ω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）を算出して出力する。
【００２６】
単位逆変換部１５ｃは、偏差算出部１５ｂの出力を、単位変換により電力供給指令値Ｅｉに換算するため、偏差算出部１５ｂの出力ＥＫｔ−ω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）と、トルク定数の逆数１／Ｋｔとの積により、{ＥＫｔ−ω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）}／Ｋｔを算出して出力する。なお、図１の例のように、単位逆変換部１５ｃは、２次ローパスフィルタ１５ｅを通過した偏差算出部１５ｂの出力と、トルク定数の逆数１／Ｋｔとの積により、{ＥＫｔ−ω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）}／Ｋｔを算出して出力するのがよい。
【００２７】
加算部１５ｄは、モータドライバ７がモータ３に印加する電圧値Ｅと、単位逆変換部１５ｃの出力{ＥＫｔ−ω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）}／Ｋｔとを加算することで、Ｅ＋{ＥＫｔ−ω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）}／Ｋｔを算出して出力する。この加算部１５ｄの出力Ｅ＋{ＥＫｔ−ω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）}／Ｋｔが、補正された電力供給指令値Ｅｉとしてモータドライバ７に入力される。
【００２８】
なお、外乱補償装置１０における演算で使用されるＪｍ、Ｌ、Ｒ、Ｋｅｍｆ，Ｋｔは、ノミナル値（公称値）であってよい。
【００２９】
合成信号生成部１３と補正部１５による作用効果を、モータ３のインダクタンス等の影響を受けた電圧などに関連させて説明する。
（電圧について）
モータ３には、モータドライバ７により電圧Ｅが印加される。その一方で、モータ３には、モータ３の回転運動による逆起電力Ｅｅｍｆ＝ωＫｅｍｆが発生する。従って、モータ３に印加される正味の電圧値は、Ｅ−Ｅｅｍｆ＝Ｅ−ωＫｅｍｆとなる。
（電流について）
モータ３に印加される正味の電圧はＥ−ωＫｅｍｆであり、モータ３の直流抵抗はＲ、モータ３のインダクタンスはＬであるので、ラプラス演算子をｓとして、モータ３に流れる電流は、（Ｅ−ωＫｅｍｆ）／（Ｌｓ＋Ｒ）となる。
（トルクについて）
モータ３に流れる電流は、（Ｅ−ωＫｅｍｆ）／（Ｌｓ＋Ｒ）であるので、トルク定数をＫｔとして、電流によりモータ３に与えられるトルクは、Ｋｔ（Ｅ−ωＫｅｍｆ）／（Ｌｓ＋Ｒ）となる。その一方で、モータ３には負荷トルクＴＬが作用するので、モータ３の正味のトルクは、Ｋｔ（Ｅ−ωＫｅｍｆ）／（Ｌｓ＋Ｒ）−ＴＬとなる。
（回転角速度について）
モータ３の正味のトルクは、Ｋｔ（Ｅ−ωＫｅｍｆ）／（Ｌｓ＋Ｒ）−ＴＬであるので、モータ３のイナーシャをＪｍとし、ラプラス演算子をｓとして、モータ３の回転角速度ωは、ω＝｛Ｋｔ（Ｅ−ωＫｅｍｆ）／（Ｌｓ＋Ｒ）−ＴＬ｝／Ｊｍｓとなる。
（影響合成信号について）
ω＝｛Ｋｔ（Ｅ−ωＫｅｍｆ）／（Ｌｓ＋Ｒ）−ＴＬ｝／Ｊｍｓを変形すると、
ＥＫｔ＝ω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）＋ＴＬ（Ｌｓ＋Ｒ）
となる。
この式において、左辺のＥＫｔを電気的エネルギに換算して考えると、電気的エネルギが、右辺の第１項のエネルギと、右辺の第２項のエネルギに変換されたとみなせる。このうち、右辺の第１項は、モータ３の運動エネルギとみなせることができ、右辺の第２項は、負荷トルク、電機子インダクタンスおよび直流抵抗の影響により失われたエネルギとみなすことができる。
従って、右辺の第２項ＴＬ（Ｌｓ＋Ｒ）に相当する値だけ、モータ３に供給する電圧Ｅ（すなわち、電力供給指令値Ｅｉ）を増加させることで、負荷トルク、電機子インダクタンスおよび直流抵抗の影響の変動を取り除くことができる。なお、直流抵抗は、発熱により大きく変動する。
具体的には、合成信号生成部１３と補正部１５により、上述のように、ＴＬ（Ｌｓ＋Ｒ）に相当する値だけ増加させる補正を、すなわち、ＴＬ（Ｌｓ＋Ｒ）／Ｋｔ＝{ＥＫｔ−ω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）}／Ｋｔだけ増加させる補正を、電力供給指令値Ｅｉに対し行うことで、負荷トルク、電機子インダクタンスおよび直流抵抗の影響の変動を取り除くことができる。
【００３０】
本実施形態による外乱補償装置１０によると、合成信号生成部１３が、前記モータ３の電機子インダクタンス、直流抵抗および逆起電力が前記回転動作に与える影響を反映させた影響合成信号を、負荷トルクの影響を受けた前記回転速度から生成し、前記補正部１５が、前記影響合成信号に基づいて、前記電力供給指令値Ｅｉを補正するので、モータ３の負荷トルクの変動だけでなく、前記モータ３の電機子インダクタンス、直流抵抗および逆起電力定数の影響の変動をも補償して取り除くように前記電力供給指令値Ｅｉを補正することができる。よって、より広い補償効果が得られる外乱補償装置１０が実現される。
また、上述したように、ω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）は、前記モータ３の電機子インダクタンス、直流抵抗および逆起電力が前記回転動作に与える影響を反映させた信号である。従って、このような影響合成信号に基づいて、前記電力供給指令値Ｅｉを補正することで、前記モータ３の電機子インダクタンス、直流抵抗および逆起電力定数の影響の変動をも補償して取り除くように前記電力供給指令値Ｅｉを補正することができる。
【００３１】
本発明は上述した実施の形態に限定されず、本発明の要旨を逸脱しない範囲で種々変更を加え得ることは勿論である。
【００３２】
上述では、簡単のため、β＝１、α＝１として説明したが、β、αは１以外の定数であってもよい。この場合、Ｅ＝βＥｉとなり、合成信号生成部１３は、αω（ＪＬｓ２＋ＪＲｓ＋ＫｔＫｅｍｆ）を影響合成信号として出力する。また、この場合、単位変換部１５ａは、αＫｔを電圧Ｅに乗算して、αＥＫｔを算出して出力し、単位逆変換部１５ｃは、１／αβＫｔを偏差算出部１５ｂからの出力に乗算する。この場合、他の構成は上述と同じであってよい。
【図面の簡単な説明】
【００３３】
【図１】本発明の実施形態による外乱補償装置を示すブロック線図である。
【図２】従来の外乱補償装置を示すブロック線図である。
【符号の説明】
【００３４】
３ モータ、５ 制御装置、７ モータドライバ、９ 指令部、
１０ 外乱補償装置、１１ 速度センサ、１３ 合成信号生成部、
１５ 補正部、１５ａ 単位変換部、１５ｂ 偏差算出部、
１５ｃ 単位逆変換部、１５ｄ 加算部、１５ｅ ２次ローパスフィルタ
２０ 外乱補償装置、２１ モータ、２３ 制御装置、
２５ モータドライバ、２７ 指令部、２９ 指令トルク算出部、
３１ 速度センサ、３３ 速度トルク換算部、３５ 偏差算出部、
３７ 単位調整部、３９ 補正部、４１ ローパスフィルタ
【特許請求の範囲】
【請求項１】
モータの回転動作を制御する制御装置に組み込まれ、該モータに作用する負荷トルクの変動を補償する外乱補償装置であって、
前記制御装置は、
前記モータに電圧を印加するモータドライバと、
該モータドライバに電力供給指令値を出力する指令部と、を備え、前記モータドライバは、電力供給指令値に基づいて前記モータに電圧を印加し、
前記外乱補償装置は、
前記モータの回転速度を検出する速度センサと、
前記モータの電機子インダクタンス、直流抵抗および逆起電力が前記回転動作に与える影響を反映させた影響合成信号を、前記回転速度から生成する合成信号生成部と、
前記影響合成信号に基づいて、前記電力供給指令値を補正する補正部と、を備える、ことを特徴とする外乱補償装置。
【請求項２】
モータドライバが電力供給指令値に基づいて前記モータに印加する前記電圧の値をＥとし、前記モータのトルク定数をＫｔとし、前記モータの電機子インダクタンスをＬとし、前記モータの直流抵抗をＲとし、前記モータの逆起電力定数をＫｅｍｆとし、前記モータの慣性をＪｍとし、前記回転速度である前記モータの回転角速度をωとし、ラプラス演算子をｓとし、αを１または他の値の定数として、
前記補正部は、前記影響合成信号として、αω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）を算出する、ことを特徴とする請求項１に記載の外乱補償装置。
【請求項３】
βを１または他の値の定数として、前記電圧ＥがβＥｉである場合に、
前記補正部は、
偏差ΔＤ＝αβＥｉＫｔ−αω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）を算出する偏差算出部と、
前記偏差ΔＤを前記電力供給指令値Ｅｉに加算する加算部と、を有する、ことを特徴とする請求項２に記載の外乱補償装置。
【請求項１】
モータの回転動作を制御する制御装置に組み込まれ、該モータに作用する負荷トルクの変動を補償する外乱補償装置であって、
前記制御装置は、
前記モータに電圧を印加するモータドライバと、
該モータドライバに電力供給指令値を出力する指令部と、を備え、前記モータドライバは、電力供給指令値に基づいて前記モータに電圧を印加し、
前記外乱補償装置は、
前記モータの回転速度を検出する速度センサと、
前記モータの電機子インダクタンス、直流抵抗および逆起電力が前記回転動作に与える影響を反映させた影響合成信号を、前記回転速度から生成する合成信号生成部と、
前記影響合成信号に基づいて、前記電力供給指令値を補正する補正部と、を備える、ことを特徴とする外乱補償装置。
【請求項２】
モータドライバが電力供給指令値に基づいて前記モータに印加する前記電圧の値をＥとし、前記モータのトルク定数をＫｔとし、前記モータの電機子インダクタンスをＬとし、前記モータの直流抵抗をＲとし、前記モータの逆起電力定数をＫｅｍｆとし、前記モータの慣性をＪｍとし、前記回転速度である前記モータの回転角速度をωとし、ラプラス演算子をｓとし、αを１または他の値の定数として、
前記補正部は、前記影響合成信号として、αω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）を算出する、ことを特徴とする請求項１に記載の外乱補償装置。
【請求項３】
βを１または他の値の定数として、前記電圧ＥがβＥｉである場合に、
前記補正部は、
偏差ΔＤ＝αβＥｉＫｔ−αω（ＪｍＬｓ２＋ＪｍＲｓ＋ＫｔＫｅｍｆ）を算出する偏差算出部と、
前記偏差ΔＤを前記電力供給指令値Ｅｉに加算する加算部と、を有する、ことを特徴とする請求項２に記載の外乱補償装置。
【図１】
【図２】
【図２】
【公開番号】特開２０１０−１５４６７４（Ｐ２０１０−１５４６７４Ａ）
【公開日】平成２２年７月８日（２０１０．７．８）
【国際特許分類】
【出願番号】特願２００８−３３０５７５（Ｐ２００８−３３０５７５）
【出願日】平成２０年１２月２５日（２００８．１２．２５）
【出願人】（５００３０２５５２）株式会社ＩＨＩエアロスペース (298)
【Ｆターム（参考）】
【公開日】平成２２年７月８日（２０１０．７．８）
【国際特許分類】
【出願日】平成２０年１２月２５日（２００８．１２．２５）
【出願人】（５００３０２５５２）株式会社ＩＨＩエアロスペース (298)
【Ｆターム（参考）】
[ Back to top ]