知財求人 - 知財ポータルサイト「IP Force」
(19)【発行国】日本国特許庁(JP)
(12)【公報種別】特許公報(B2)
(11)【特許番号】
(24)【登録日】2024-11-11
(45)【発行日】2024-11-19
(54)【発明の名称】機械定数推定装置及びモータ制御装置
(51)【国際特許分類】
H02P 29/00 20160101AFI20241112BHJP
【ＦＩ】
H02P29/00
【請求項の数】
10
(21)【出願番号】P 2021089125
(22)【出願日】2021-05-27
(65)【公開番号】P2022181905
(43)【公開日】2022-12-08
【審査請求日】2024-04-15
(73)【特許権者】
【識別番号】000005234
【氏名又は名称】富士電機株式会社
(74)【代理人】
【識別番号】100107766
【弁理士】
【氏名又は名称】伊東 忠重
(74)【代理人】
【識別番号】100070150
【弁理士】
【氏名又は名称】伊東 忠彦
(72)【発明者】
【氏名】林 崇
(72)【発明者】
【氏名】野村 哲也
【審査官】若林 治男
(56)【参考文献】
【文献】特開２０２０－１９４３７５（ＪＰ，Ａ）
【文献】特開２０００－３４６７３８（ＪＰ，Ａ）
【文献】国際公開第２００６／０５１６５１（ＷＯ，Ａ１）
【文献】特開２００６－２１７７２９（ＪＰ，Ａ）
(58)【調査した分野】(Int.Cl.，ＤＢ名)
Ｈ０２Ｐ ２９／００
(57)【特許請求の範囲】
【請求項1】
モータ及び当該モータにより駆動される機械負荷の慣性、粘性係数、及びクーロン摩擦からなる機械定数を推定する機械定数推定装置において、前記モータの始動後にその速度絶対値が所定の推定開始速度を超えた時点で前記モータのトルク、加速度、速度、及び速度符号のうち何れか二つの積を被積分関数とする数値積分を開始し、かつ、前記モータが減速してその速度絶対値が前記推定開始速度以下になった時点で数値積分を終了する積分手段と、
前記積分手段による積分値に基づいて、前記モータの加減速期間における慣性推定値Ｊ１、粘性係数推定値Ｄ１、及びクーロン摩擦推定値Ｔｆ１を演算する推定値演算手段と、
前記慣性推定値Ｊ１、前記粘性係数推定値Ｄ１、及び前記クーロン摩擦推定値Ｔｆ１にそれぞれ対応する重みＷＪ１，ＷＤ１，ＷＴｆ１を演算する手段と、
前記加減速期間における前記慣性推定値Ｊ１及び前記重みＷＪ１を用いて当該加減速期間以前に演算した慣性推定平均値Ｊ２及び積算重みＷＪ２を更新し、更新後の慣性推定平均値Ｊ２を慣性推定結果として出力する慣性推定値平均手段と、
前記加減速期間における前記粘性係数推定値Ｄ１及び前記重みＷＤ１を用いて当該加減速期間以前に演算した粘性係数推定平均値Ｄ２及び積算重みＷＤ２を更新し、更新後の粘性係数推定平均値Ｄ２を粘性係数推定結果として出力する粘性係数推定値平均手段と、
前記加減速期間における前記クーロン摩擦推定値Ｔｆ１及び前記重みＷＴｆ１を用いて当該加減速期間以前に演算したクーロン摩擦推定平均値Ｔｆ２及び積算重みＷＴｆ２を更新し、更新後のクーロン摩擦推定平均値Ｔｆ２をクーロン摩擦推定結果として出力するクーロン摩擦推定値平均手段と、
を備えたことを特徴とする機械定数推定装置。
【請求項2】
請求項１に記載した機械定数推定装置において、前記推定値演算手段は、
前記モータの加減速期間ｔにおける加速度ａ（ｔ）、速度ｖ（ｔ）、速度符号ｓｉｇｎ（ｖ（ｔ））、及びトルクＴ（ｔ）をそれぞれｘ１（ｔ），ｘ２（ｔ），ｘ３（ｔ），ｙ（ｔ）とした時に、前記ｘ１（ｔ），ｘ２（ｔ），ｘ３（ｔ），ｙ（ｔ）のうち何れか二つの積を被積分関数とするｍｉｊ＝∫｛ｘｉ（ｔ）ｘｊ（ｔ）｝ｄｔ及びｑｉ＝∫｛ｘｉ（ｔ）ｙ（ｔ）｝ｄｔ（ただし、ｉ，ｊ＝１～３）を用いて、下記の数式１により慣性推定値Ｊ１、粘性係数推定値Ｄ１、及びクーロン摩擦推定値Ｔｆ１を演算することを特徴とする機械定数推定装置。
【数1】
【請求項3】
請求項１または２に記載した機械定数推定装置において、前記被積分関数を求めるためのトルク、加速度、及び速度が、同じ時定数のローパスフィルタを演算した後の値であることを特徴とする機械定数推定装置。
【請求項4】
請求項１または２に記載した機械定数推定装置において、前記重みＷＪ１が、前記モータの加速度の絶対値に対して単調増加する値を数値積分した値であり、前記重みＷＤ１が、前記モータの速度の絶対値に対して単調増加する値を数値積分した値であり、かつ、前記重みＷＴｆ１が、前記モータの速度にも加速度にも依存しない値を数値積分した値であることを特徴とする機械定数推定装置。
【請求項5】
請求項３に記載した機械定数推定装置において、前記重みＷＪ１が、前記ローパスフィルタによる演算後の前記モータの加速度の絶対値に対して単調増加する値を数値積分した値であり、前記重みＷＤ１が、前記ローパスフィルタによる演算後の前記モータの速度の絶対値に対して単調増加する値を数値積分した値であり、かつ、前記重みＷＴｆ１が、前記モータの速度にも加速度にも依存しない値を数値積分した値であることを特徴とする機械定数推定装置。
【請求項6】
請求項４または５に記載した機械定数推定装置において、前記慣性推定値平均手段は、
前記慣性推定値Ｊ１及び前記重みＷＪ１が新たに得られるたびに、前記積算重みＷＪ２の前回値と前記重みＷＪ１の今回値との加算値を所定の上限値ＷＪｍａｘにより制限した値を前記積算重みＷＪ２の今回値としたうえで、
慣性推定平均値Ｊ２の今回値＝慣性推定平均値Ｊ２の前回値＋（重みＷＪ１の今回値／積算重みＷＪ２の今回値）×（慣性推定値Ｊ１の今回値－慣性推定平均値Ｊ２の前回値）
を演算することを特徴とする機械定数推定装置。
【請求項7】
請求項４～６の何れか１項に記載した機械定数推定装置において、前記粘性係数推定値平均手段は、
前記粘性係数推定値Ｄ１及び前記重みＷＤ１が新たに得られるたびに、前記積算重みＷＤ２の前回値と前記重みＷＤ１の今回値との加算値を所定の上限値ＷＤｍａｘにより制限した値を前記積算重みＷＤ２の今回値としたうえで、
粘性係数推定平均値Ｄ２の今回値＝粘性係数推定平均値Ｄ２の前回値＋（重みＷＤ１の今回値／積算重みＷＤ２の今回値）×（粘性係数推定値Ｄ１の今回値－粘性係数推定平均値Ｄ２の前回値）
を演算することを特徴とする機械定数推定装置。
【請求項8】
請求項４～７の何れか１項に記載した機械定数推定装置において、前記クーロン摩擦推定値平均手段は、
前記クーロン摩擦推定値Ｔｆ１及び前記重みＷＴｆ１が新たに得られるたびに、前記積算重みＷＴｆ２の前回値と前記重みＷＴｆ１の今回値との加算値を所定の上限値ＷＴｆｍａｘにより制限した値を前記積算重みＷＴｆ２の今回値としたうえで、
クーロン摩擦推定平均値Ｔｆ２の今回値＝クーロン摩擦推定平均値Ｔｆ２の前回値＋（重みＷＴｆ１の今回値／積算重みＷＴｆ２の今回値）×（クーロン摩擦推定値Ｔｆ１の今回値－クーロン摩擦推定平均値Ｔｆ２の前回値）
を演算することを特徴とする機械定数推定装置。
【請求項9】
請求項１～８の何れか１項に記載した機械定数推定装置において、前記慣性推定平均値Ｊ２、前記粘性係数推定平均値Ｄ２及び前記クーロン摩擦推定平均値Ｔｆ２、並びに、前記積算重みＷＪ２，ＷＤ２，ＷＴｆ２を、不揮発性メモリに記憶すると共に外部から初期化可能としたことを特徴とする機械定数推定装置。
【請求項10】
請求項１～９の何れか１項に記載の機械定数推定装置により推定した前記機械定数を用いて、前記モータを制御することを特徴とするモータ制御装置。
【発明の詳細な説明】
【技術分野】
【0001】
本発明は、モータ及びその機械負荷の機械定数を推定する機械定数推定装置、並びに、この機械定数推定装置を備えたモータ制御装置に関する。
【背景技術】
【0002】
機械負荷を駆動するモータを良好に速度制御するためには、モータ及びその機械負荷の慣性や、粘性係数（粘性摩擦係数），クーロン摩擦等の負荷トルクを取得して速度制御条件に反映することが必要になる。
また、モータが同じ機械負荷を駆動し続ける場合でも負荷トルクが変化する時があり、このような場合には、運転条件によらず慣性等の機械定数を推定できると都合が良い。
また、モータが同じ機械負荷を駆動し続ける場合でも負荷トルクが変化する時があり、このような場合には、運転条件によらず慣性等の機械定数を推定できると都合が良い。
【0003】
ここで、非特許文献１には、負荷トルクが、速度に依存しない符号関数型のクーロン摩擦と速度に比例する粘性係数との和によって表されることを前提として、クーロン摩擦、粘性係数と共に慣性を推定する方法が開示されている。
この文献では、正負対称な周期信号を速度指令として与え、図８（非特許文献１の図４）に示すように、トルク指令ｕ及び角速度ωに基づく信号τｅ，ｑ０，ｑ０ ’，ｑ１を互いに掛け合わせて得た値を同文献記載の数式（Eqs.（３７）～（４４））により周期間隔で積分して行列Φの要素φ１１，φ１３，φ２２，φ２３，φ３３ 、及びベクトルＶの要素ｖ１，ｖ２，ｖ３を求め、その後に演算Φ－１Ｖを行うことで慣性を含む機械定数を同定している。
この文献では、正負対称な周期信号を速度指令として与え、図８（非特許文献１の図４）に示すように、トルク指令ｕ及び角速度ωに基づく信号τｅ，ｑ０，ｑ０ ’，ｑ１を互いに掛け合わせて得た値を同文献記載の数式（Eqs.（３７）～（４４））により周期間隔で積分して行列Φの要素φ１１，φ１３，φ２２，φ２３，φ３３ 、及びベクトルＶの要素ｖ１，ｖ２，ｖ３を求め、その後に演算Φ－１Ｖを行うことで慣性を含む機械定数を同定している。
【0004】
また、特許文献１には、トルク指令微分値、モータ加速度、モータ躍度等を同一特性のローパスフィルタを介し適応同定演算して慣性及び粘性係数を同定するモータ制御装置が記載されている。更に、特許文献２には、駆動機械の始動後の時間に応じて更新される重み信号を用いて重み付けした速度、加速度、トルクを最小二乗演算部に入力して、慣性及び粘性係数を推定する駆動機械の機械定数同定装置が記載されている。
【先行技術文献】
【特許文献】
【0005】
【非特許文献】
【0006】
【文献】粟屋伊智郎他，「クーロン摩擦が作用する機械運動系のパラメータ同定法」，日本機械学会論文集（Ｃ編）５９巻５６７号 （１９９３年），ｐ. １０８－１１４
【発明の概要】
【発明が解決しようとする課題】
【0007】
非特許文献１に記載された機械定数の同定方法によると、例えば、慣性の所望の推定精度が得られにくい小さな加速度でモータを駆動した場合でも、推定精度に関係なく慣性推定値が更新される。或いは、粘性係数の所望の推定精度が得られにくい小さな最大速度でモータを駆動した場合でも、推定精度に関係なく慣性推定値が更新される。
つまり、より信頼性の高い推定結果が過去に得られていたとしても、推定値は信頼性の低い最新の推定結果に更新されてしまうことがある。更に、機械定数はできるだけ精度良く推定できることが望ましい一方で、短時間のうちに機械定数を推定したい場合もあるが、非特許文献１に記載された方法では、推定精度の向上と推定時間の短縮とを両立させるのが難しかった。
つまり、より信頼性の高い推定結果が過去に得られていたとしても、推定値は信頼性の低い最新の推定結果に更新されてしまうことがある。更に、機械定数はできるだけ精度良く推定できることが望ましい一方で、短時間のうちに機械定数を推定したい場合もあるが、非特許文献１に記載された方法では、推定精度の向上と推定時間の短縮とを両立させるのが難しかった。
【0008】
また、特許文献１に係る従来技術では、モータの回転速度が低い場合でも高速かつ高精度に慣性及び粘性係数を同定し、特許文献２に係る従来技術では、駆動機械を始動してから所定時間が経過するまでの期間は重みを小さくすることでクーロン摩擦に起因する推定誤差を小さくしている。
しかしながら、これらの特許文献１，２には、クーロン摩擦を推定する手段については特に開示されていない。
しかしながら、これらの特許文献１，２には、クーロン摩擦を推定する手段については特に開示されていない。
【0009】
そこで、本発明の解決課題は、機械定数の推定に当たってモータ速度や加速度が適切でない場合でも、推定値の悪化を招きにくい形で慣性、粘性係数、及びクーロン摩擦を高精度かつ短時間で推定可能とした機械定数推定装置と、この推定装置により推定した機械定数を用いてモータの速度制御等を行うモータ制御装置を提供することにある。
【課題を解決するための手段】
【0010】
上記課題を解決するため、請求項１に係る機械定数推定装置は、モータ及び当該モータにより駆動される機械負荷の慣性、粘性係数、及びクーロン摩擦からなる機械定数を推定する機械定数推定装置において、
前記モータの始動後にその速度絶対値が所定の推定開始速度を超えた時点で前記モータのトルク、加速度、速度、及び速度符号のうち何れか二つの積を被積分関数とする数値積分を開始し、かつ、前記モータが減速してその速度絶対値が前記推定開始速度以下になった時点で数値積分を終了する積分手段と、
前記積分手段による積分値に基づいて、前記モータの加減速期間における慣性推定値Ｊ１、粘性係数推定値Ｄ１、及びクーロン摩擦推定値Ｔｆ１を演算する推定値演算手段と、
前記慣性推定値Ｊ１、前記粘性係数推定値Ｄ１、及び前記クーロン摩擦推定値Ｔｆ１にそれぞれ対応する重みＷＪ１，ＷＤ１，ＷＴｆ１を演算する手段と、
前記加減速期間における前記慣性推定値Ｊ１及び前記重みＷＪ１を用いて当該加減速期間以前に演算した慣性推定平均値Ｊ２及び積算重みＷＪ２を更新し、更新後の慣性推定平均値Ｊ２を慣性推定結果として出力する慣性推定値平均手段と、
前記加減速期間における前記粘性係数推定値Ｄ１及び前記重みＷＤ１を用いて当該加減速期間以前に演算した粘性係数推定平均値Ｄ２及び積算重みＷＤ２を更新し、更新後の粘性係数推定平均値Ｄ２を粘性係数推定結果として出力する粘性係数推定値平均手段と、
前記加減速期間における前記クーロン摩擦推定値Ｔｆ１及び前記重みＷＴｆ１を用いて当該加減速期間以前に演算したクーロン摩擦推定平均値Ｔｆ２及び積算重みＷＴｆ２を更新し、更新後のクーロン摩擦推定平均値Ｔｆ２をクーロン摩擦推定結果として出力するクーロン摩擦推定値平均手段と、
を備えたことを特徴とする。
前記モータの始動後にその速度絶対値が所定の推定開始速度を超えた時点で前記モータのトルク、加速度、速度、及び速度符号のうち何れか二つの積を被積分関数とする数値積分を開始し、かつ、前記モータが減速してその速度絶対値が前記推定開始速度以下になった時点で数値積分を終了する積分手段と、
前記積分手段による積分値に基づいて、前記モータの加減速期間における慣性推定値Ｊ１、粘性係数推定値Ｄ１、及びクーロン摩擦推定値Ｔｆ１を演算する推定値演算手段と、
前記慣性推定値Ｊ１、前記粘性係数推定値Ｄ１、及び前記クーロン摩擦推定値Ｔｆ１にそれぞれ対応する重みＷＪ１，ＷＤ１，ＷＴｆ１を演算する手段と、
前記加減速期間における前記慣性推定値Ｊ１及び前記重みＷＪ１を用いて当該加減速期間以前に演算した慣性推定平均値Ｊ２及び積算重みＷＪ２を更新し、更新後の慣性推定平均値Ｊ２を慣性推定結果として出力する慣性推定値平均手段と、
前記加減速期間における前記粘性係数推定値Ｄ１及び前記重みＷＤ１を用いて当該加減速期間以前に演算した粘性係数推定平均値Ｄ２及び積算重みＷＤ２を更新し、更新後の粘性係数推定平均値Ｄ２を粘性係数推定結果として出力する粘性係数推定値平均手段と、
前記加減速期間における前記クーロン摩擦推定値Ｔｆ１及び前記重みＷＴｆ１を用いて当該加減速期間以前に演算したクーロン摩擦推定平均値Ｔｆ２及び積算重みＷＴｆ２を更新し、更新後のクーロン摩擦推定平均値Ｔｆ２をクーロン摩擦推定結果として出力するクーロン摩擦推定値平均手段と、
を備えたことを特徴とする。
【0011】
請求項２に係る機械定数推定装置は、請求項１に記載した機械定数推定装置において、
前記推定値演算手段が、
前記モータの加減速期間ｔにおける加速度ａ（ｔ）、速度ｖ（ｔ）、速度符号ｓｉｇｎ（ｖ（ｔ））、及びトルクＴ（ｔ）をそれぞれｘ１（ｔ），ｘ２（ｔ），ｘ３（ｔ），ｙ（ｔ）とした時に、前記ｘ１（ｔ），ｘ２（ｔ），ｘ３（ｔ），ｙ（ｔ）のうち何れか二つの積を被積分関数とするｍｉｊ＝∫｛ｘｉ（ｔ）ｘｊ（ｔ）｝ｄｔ及びｑｉ＝∫｛ｘｉ（ｔ）ｙ（ｔ）｝ｄｔ（ただし、ｉ，ｊ＝１～３）を用いて、特許請求の範囲に記載の数式１により慣性推定値Ｊ１、粘性係数推定値Ｄ１、及びクーロン摩擦推定値Ｔｆ１を演算することを特徴とする。
前記推定値演算手段が、
前記モータの加減速期間ｔにおける加速度ａ（ｔ）、速度ｖ（ｔ）、速度符号ｓｉｇｎ（ｖ（ｔ））、及びトルクＴ（ｔ）をそれぞれｘ１（ｔ），ｘ２（ｔ），ｘ３（ｔ），ｙ（ｔ）とした時に、前記ｘ１（ｔ），ｘ２（ｔ），ｘ３（ｔ），ｙ（ｔ）のうち何れか二つの積を被積分関数とするｍｉｊ＝∫｛ｘｉ（ｔ）ｘｊ（ｔ）｝ｄｔ及びｑｉ＝∫｛ｘｉ（ｔ）ｙ（ｔ）｝ｄｔ（ただし、ｉ，ｊ＝１～３）を用いて、特許請求の範囲に記載の数式１により慣性推定値Ｊ１、粘性係数推定値Ｄ１、及びクーロン摩擦推定値Ｔｆ１を演算することを特徴とする。
【0012】
請求項３に係る機械定数推定装置は、請求項１または２に記載した機械定数推定装置において、前記被積分関数を求めるためのトルク、加速度、及び速度が、同じ時定数のローパスフィルタを演算した後の値であることを特徴とする。
【0013】
請求項４に係る機械定数推定装置は、請求項１または２に記載した機械定数推定装置において、前記重みＷＪ１が、前記モータの加速度の絶対値に対して単調増加する値を数値積分した値であり、前記重みＷＤ１が、前記モータの速度の絶対値に対して単調増加する値を数値積分した値であり、かつ、前記重みＷＴｆ１が、前記モータの速度にも加速度にも依存しない値を数値積分した値であることを特徴とする。
【0014】
請求項５に係る機械定数推定装置は、請求項３に記載した機械定数推定装置において、前記重みＷＪ１が、前記ローパスフィルタによる演算後の前記モータの加速度の絶対値に対して単調増加する値を数値積分した値であり、前記重みＷＤ１が、前記ローパスフィルタによる演算後の前記モータの速度の絶対値に対して単調増加する値を数値積分した値であり、かつ、前記重みＷＴｆ１が、前記モータの速度にも加速度にも依存しない値を数値積分した値であることを特徴とする。
【0015】
請求項６に係る機械定数推定装置は、請求項４または５に記載した機械定数推定装置において、前記慣性推定値平均手段は、前記慣性推定値Ｊ１及び前記重みＷＪ１が新たに得られるたびに、前記積算重みＷＪ２の前回値と前記重みＷＪ１の今回値との加算値を所定の上限値ＷＪｍａｘにより制限した値を前記積算重みＷＪ２の今回値としたうえで、
慣性推定平均値Ｊ２の今回値＝慣性推定平均値Ｊ２の前回値＋（重みＷＪ１の今回値／積算重みＷＪ２の今回値）×（慣性推定値Ｊ１の今回値－慣性推定平均値Ｊ２の前回値）
を演算することを特徴とする。
慣性推定平均値Ｊ２の今回値＝慣性推定平均値Ｊ２の前回値＋（重みＷＪ１の今回値／積算重みＷＪ２の今回値）×（慣性推定値Ｊ１の今回値－慣性推定平均値Ｊ２の前回値）
を演算することを特徴とする。
【0016】
請求項７に係る機械定数推定装置は、請求項４～６の何れか１項に記載した機械定数推定装置において、前記粘性係数推定値平均手段は、前記粘性係数推定値Ｄ１及び前記重みＷＤ１が新たに得られるたびに、前記積算重みＷＤ２の前回値と前記重みＷＤ１の今回値との加算値を所定の上限値ＷＤｍａｘにより制限した値を前記積算重みＷＤ２の今回値としたうえで、
粘性係数推定平均値Ｄ２の今回値＝粘性係数推定平均値Ｄ２の前回値＋（重みＷＤ１の今回値／積算重みＷＤ２の今回値）×（粘性係数推定値Ｄ１の今回値－粘性係数推定平均値Ｄ２の前回値）
を演算することを特徴とする。
粘性係数推定平均値Ｄ２の今回値＝粘性係数推定平均値Ｄ２の前回値＋（重みＷＤ１の今回値／積算重みＷＤ２の今回値）×（粘性係数推定値Ｄ１の今回値－粘性係数推定平均値Ｄ２の前回値）
を演算することを特徴とする。
【0017】
請求項８に係る機械定数推定装置は、請求項４～７の何れか１項に記載した機械定数推定装置において、前記クーロン摩擦推定値平均手段は、前記クーロン摩擦推定値Ｔｆ１及び前記重みＷＴｆ１が新たに得られるたびに、前記積算重みＷＴｆ２の前回値と前記重みＷＴｆ１の今回値との加算値を所定の上限値ＷＴｆｍａｘにより制限した値を前記積算重みＷＴｆ２の今回値としたうえで、
クーロン摩擦推定平均値Ｔｆ２の今回値＝クーロン摩擦推定平均値Ｔｆ２の前回値＋（重みＷＴｆ１の今回値／積算重みＷＴｆ２の今回値）×（クーロン摩擦推定値Ｔｆ１の今回値－クーロン摩擦推定平均値Ｔｆ２の前回値）
を演算することを特徴とする。
クーロン摩擦推定平均値Ｔｆ２の今回値＝クーロン摩擦推定平均値Ｔｆ２の前回値＋（重みＷＴｆ１の今回値／積算重みＷＴｆ２の今回値）×（クーロン摩擦推定値Ｔｆ１の今回値－クーロン摩擦推定平均値Ｔｆ２の前回値）
を演算することを特徴とする。
【0018】
請求項９に係る機械定数推定装置は、請求項１～８の何れか１項に記載した機械定数推定装置において、前記慣性推定平均値Ｊ２、前記粘性係数推定平均値Ｄ２及び前記クーロン摩擦推定平均値Ｔｆ２、並びに、前記積算重みＷＪ２，ＷＤ２，ＷＴｆ２を、不揮発性メモリに記憶すると共に外部から初期化可能としたことを特徴とする。
【0019】
請求項１０に係るモータ制御装置は、請求項１～９の何れか１項に記載の機械定数推定装置により推定した前記機械定数を用いて、前記モータを制御することを特徴とする。
【発明の効果】
【0020】
本発明によれば、例えばモータ速度や加速度が小さいため機械定数を適切に推定することが難しい場合でも、推定値の悪化を招きにくい形で機械定数を高精度かつ短時間で推定することができる。
【図面の簡単な説明】
【0021】
【図1】本発明の実施形態に係る機械定数推定装置の概要を示すブロック図である。
【図3】機械定数推定部の各実施例における積分開始・終了判定手段の構成図である。
【図5】機械定数推定部の各実施例における慣性推定値平均手段の構成図である。
【図6】機械定数推定部の各実施例における粘性係数推定値平均手段の構成図である。
【図7】機械定数推定部の各実施例におけるクーロン摩擦推定値平均手段の構成図である。
【図8】非特許文献１に記載された従来技術の説明図である。
【発明を実施するための形態】
【0022】
以下、図に沿って本発明の実施形態を説明する。
図１は、本実施形態に係る機械定数推定装置の概要を示すブロック図である。この機械定数推定装置は、機械負荷が接続されたモータ（両者をまとめてモータ・機械負荷２００とする）の速度及びトルクに基づいて、モータ・機械負荷２００の慣性、粘性係数及びクーロン摩擦を推定する。
図１は、本実施形態に係る機械定数推定装置の概要を示すブロック図である。この機械定数推定装置は、機械負荷が接続されたモータ（両者をまとめてモータ・機械負荷２００とする）の速度及びトルクに基づいて、モータ・機械負荷２００の慣性、粘性係数及びクーロン摩擦を推定する。
【0023】
図１において、速度制御部１００は、モータ・機械負荷２００から得たモータ速度が速度指令に一致するようにトルクを出力する。ここで、トルクとは、トルク指令でも良いし、モータへの通電電流を検出して得たトルク推定値でも良い。
モータ速度及びトルクは、機械定数推定部３００に入力されている。機械定数推定部３００では、後述する動作により慣性、粘性係数及びクーロン摩擦を推定すると共に重み付け処理を行ってこれらの平均値Ｊ２，Ｄ２，Ｔｆ２を演算する。
なお、速度制御部１００及び機械定数推定部３００は、例えばマイクロコンピュータ等の演算処理装置及びそのプログラムによって実現されるものである。
モータ速度及びトルクは、機械定数推定部３００に入力されている。機械定数推定部３００では、後述する動作により慣性、粘性係数及びクーロン摩擦を推定すると共に重み付け処理を行ってこれらの平均値Ｊ２，Ｄ２，Ｔｆ２を演算する。
なお、速度制御部１００及び機械定数推定部３００は、例えばマイクロコンピュータ等の演算処理装置及びそのプログラムによって実現されるものである。
【0024】
図２は、機械定数推定部３００の第１実施例（機械定数推定部３００Ａ）を示す構成図である。
図２において、前記モータ・機械負荷２００から得たモータ速度が、機械定数推定部３００Ａ内の積分開始・終了判定手段３２０、微分手段３０１、及び符号判定手段３０２に与えられ、モータのトルクが乗算手段３０３に与えられている。また、外部からのリセット指令が、後述の慣性推定値平均手段３４０、粘性係数推定値平均手段３６０、及びクーロン摩擦推定値平均手段３８０に入力されている。
図２において、前記モータ・機械負荷２００から得たモータ速度が、機械定数推定部３００Ａ内の積分開始・終了判定手段３２０、微分手段３０１、及び符号判定手段３０２に与えられ、モータのトルクが乗算手段３０３に与えられている。また、外部からのリセット指令が、後述の慣性推定値平均手段３４０、粘性係数推定値平均手段３６０、及びクーロン摩擦推定値平均手段３８０に入力されている。
【0025】
いま、モータ加速度をａ（ｔ）、モータ速度をｖ（ｔ）、モータ速度の符号をｓｉｇｎ（ｖ（ｔ））、トルクをＴ（ｔ）とし、これらをそれぞれｘ１（ｔ），ｘ２（ｔ），ｘ３（ｔ），ｙ（ｔ）とおくと、微分手段３０１の出力であるモータ加速度ｘ１（ｔ）、モータ速度ｘ２（ｔ）、符号判定手段３０２の出力である速度符号ｘ３（ｔ）、及びトルクｙ（ｔ）が、乗算手段３０３に入力される。
【0026】
乗算手段３０３では、ｘ１（ｔ），ｘ２（ｔ），ｘ３（ｔ），ｙ（ｔ）のうち二つのパラメータを用いて、ｘｉ（ｔ）ｘｊ（ｔ）及びｘｉ（ｔ）ｙ（ｔ）（ｉ，ｊ＝１～３）を演算する。なお、乗算手段３０３における演算には、ｘ１（ｔ）２，ｘ２（ｔ）２，ｘ３（ｔ）２の演算（すなわち、ｉ＝ｊ＝１，ｉ＝ｊ＝２，ｉ＝ｊ＝３）も含む。
乗算手段３０３による乗算結果は、次段の積分手段３０４にそれぞれ入力される。
乗算手段３０３による乗算結果は、次段の積分手段３０４にそれぞれ入力される。
【0027】
積分手段３０４では、一定期間にわたってｍｉｊ＝∫｛ｘｉ（ｔ）ｘｊ（ｔ）｝ｄｔ、及び、ｑｉ＝∫｛ｘｉ（ｔ）ｙ（ｔ）｝ｄｔという数値積分を行い、これらの演算結果を推定値演算手段３１１に送る。
なお、実際の数値積分では、例えば、
ｍｉｊ＝Σ｛ｘｉ（ｎ）ｘｊ（ｎ）｝，ｑｉ＝Σ｛ｘｉ（ｎ）ｙ（ｎ）｝
という演算を行ってｍｉｊ，ｑｉを定義し、ｎ点目のデータが得られた時点で、
ｍｉｊ←ｍｉｊ＋ｘｉ（ｎ）ｘｊ（ｎ），
ｑｉ←ｑｉ＋ｘｉ（ｎ）ｙ（ｎ）
として、ｍｉｊ，ｑｉをそれぞれ更新する。
なお、実際の数値積分では、例えば、
ｍｉｊ＝Σ｛ｘｉ（ｎ）ｘｊ（ｎ）｝，ｑｉ＝Σ｛ｘｉ（ｎ）ｙ（ｎ）｝
という演算を行ってｍｉｊ，ｑｉを定義し、ｎ点目のデータが得られた時点で、
ｍｉｊ←ｍｉｊ＋ｘｉ（ｎ）ｘｊ（ｎ），
ｑｉ←ｑｉ＋ｘｉ（ｎ）ｙ（ｎ）
として、ｍｉｊ，ｑｉをそれぞれ更新する。
【0028】
図３は、図２における積分開始・終了判定手段３２０の構成図である。
図３において、絶対値演算手段３２１はモータ速度の絶対値を演算して比較手段３２２に送り、比較手段３２２は、予め設定された推定開始速度と速度絶対値とを比較する。
そして、速度絶対値が推定開始速度を上回った時点で、比較手段３２２から指示生成手段３２３を介して図２の積分手段３０４に積分開始指示を送り、速度絶対値が前記推定開始速度以下になった時点で、比較手段３２２から指示生成手段３２４を介して積分手段３０４に積分終了指示を送る。上記の積分開始指示から積分終了指示までの期間が積分期間となる。また、指示生成手段３２４からは、図２の推定値演算手段３１１に対する慣性推定値Ｊ１、粘性係数推定値Ｄ１、クーロン摩擦推定値Ｔｆ１の更新指示、及び、慣性推定値平均手段３４０、粘性係数推定値平均手段３６０、クーロン摩擦推定値平均手段３８０に対する重みＷＪ１，ＷＤ１，ＷＴｆ１の更新指示も出力されている。
図３において、絶対値演算手段３２１はモータ速度の絶対値を演算して比較手段３２２に送り、比較手段３２２は、予め設定された推定開始速度と速度絶対値とを比較する。
そして、速度絶対値が推定開始速度を上回った時点で、比較手段３２２から指示生成手段３２３を介して図２の積分手段３０４に積分開始指示を送り、速度絶対値が前記推定開始速度以下になった時点で、比較手段３２２から指示生成手段３２４を介して積分手段３０４に積分終了指示を送る。上記の積分開始指示から積分終了指示までの期間が積分期間となる。また、指示生成手段３２４からは、図２の推定値演算手段３１１に対する慣性推定値Ｊ１、粘性係数推定値Ｄ１、クーロン摩擦推定値Ｔｆ１の更新指示、及び、慣性推定値平均手段３４０、粘性係数推定値平均手段３６０、クーロン摩擦推定値平均手段３８０に対する重みＷＪ１，ＷＤ１，ＷＴｆ１の更新指示も出力されている。
【0029】
積分開始・終了判定手段３２０による積分開始指示・積分終了指示、及び、更新指示の各時点を上記のようにした理由は、以下の通りである。
モータが機械負荷を駆動する場合、ゼロ速度近傍ではヒステリシスを伴った負荷トルクを生じることが少なくない。推定値演算手段３１１が機械定数を正しく推定するためには、積分手段３０４が積分を行う期間から上記のヒステリシス領域を除外する必要がある。そこで、モータの始動後に速度絶対値が所定の推定開始速度を上回ってから積分を開始し、その後にモータが減速して速度絶対値が上記推定開始速度以下になった時点で積分を停止するように積分期間を設定すると共に各パラメータの更新指示を行うことにより、当該積分期間における慣性推定値Ｊ１、粘性係数推定値Ｄ１、クーロン摩擦推定値Ｔｆ１、及び、重みＷＪ１，ＷＤ１，ＷＴｆ１を確定することとした。
この場合、積分終了指示時点及び積分開始指示時点のモータ速度絶対値を等しくする（すなわち同一の推定開始速度を用いる）ことにより、負荷トルクに非線形性があった場合の各推定値の誤差を低減することができる。
モータが機械負荷を駆動する場合、ゼロ速度近傍ではヒステリシスを伴った負荷トルクを生じることが少なくない。推定値演算手段３１１が機械定数を正しく推定するためには、積分手段３０４が積分を行う期間から上記のヒステリシス領域を除外する必要がある。そこで、モータの始動後に速度絶対値が所定の推定開始速度を上回ってから積分を開始し、その後にモータが減速して速度絶対値が上記推定開始速度以下になった時点で積分を停止するように積分期間を設定すると共に各パラメータの更新指示を行うことにより、当該積分期間における慣性推定値Ｊ１、粘性係数推定値Ｄ１、クーロン摩擦推定値Ｔｆ１、及び、重みＷＪ１，ＷＤ１，ＷＴｆ１を確定することとした。
この場合、積分終了指示時点及び積分開始指示時点のモータ速度絶対値を等しくする（すなわち同一の推定開始速度を用いる）ことにより、負荷トルクに非線形性があった場合の各推定値の誤差を低減することができる。
【0030】
なお、モータ速度や通電電流の検出誤差等に起因して、速度信号、その微分値の加速度信号、トルク信号をそのまま用いて演算することが問題になる場合には、図４に示す第２実施例の機械定数推定部３００Ｂのように、モータ速度及びトルクに対してローパスフィルタ３１２，３１３をそれぞれ演算した結果を用いると良い。この場合、ローパスフィルタ３１２，３１３の時定数は等しくすることが望ましい。
【0031】
図２に戻って、推定値演算手段３１１は、積分手段３０４が演算したｍｉｊ，ｑｉ（ｉ，ｊ＝１～３）を用いて、モータの１回の加減速期間における慣性推定値Ｊ１、粘性係数推定値Ｄ１、及びクーロン摩擦推定値Ｔｆ１を数式１により演算する。
【数1】
【0032】
この数式１は、運動方程式がＴ（ｔ）＝Ｊ（ｄｖ／ｄｔ）＋Ｄｖ＋Ｔｆｓｉｇｎ（ｖ）と表される系について、１回の加減速期間に関して最小二乗法によりパラメータＪ１，Ｄ１，Ｔｆ１を求めることに相当する。
【0033】
上記について、具体的に説明する。最小二乗法では、
積分値Ｉ＝∫{Ｔ（ｔ）－Ｊ（ｄｖ／ｄｔ）－Ｄｖ－Ｔｆｓｉｇｎ（ｖ）}２ｄｔ
が最小となるＪ，Ｄ，Ｔｆを求める。そのために、積分値ＩをＪ，Ｄ，Ｔｆでそれぞれ偏微分した値をゼロとおいて整理すると、数式２が得られる。
積分値Ｉ＝∫{Ｔ（ｔ）－Ｊ（ｄｖ／ｄｔ）－Ｄｖ－Ｔｆｓｉｇｎ（ｖ）}２ｄｔ
が最小となるＪ，Ｄ，Ｔｆを求める。そのために、積分値ＩをＪ，Ｄ，Ｔｆでそれぞれ偏微分した値をゼロとおいて整理すると、数式２が得られる。
【数2】
【0034】
上記の数式２を、前述のｘ１（ｔ），ｘ２（ｔ），ｘ３（ｔ），ｙ（ｔ）を用いて置き換えると、数式３が得られる。
数式３における積分演算∫ｄｔを積算演算Σに置き換えると、数式４が得られる。
【数3】
【数4】
【0035】
更に、前述したｍｉｊ＝Σ｛ｘｉ（ｎ）ｘｊ（ｎ）｝，ｑｉ＝Σ｛ｘｉ（ｎ）ｙ（ｎ）｝のｎ点目のデータｘｉ（ｎ），ｘｊ（ｎ），ｙ（ｎ）を時刻ｔにおけるデータｘｉ（ｔ），ｘｊ（ｔ），ｙ（ｔ）にそれぞれ置き換えると、ｍｉｊ＝Σ｛ｘｉ（ｔ）ｘｊ（ｔ）｝，ｑｉ＝Σ｛ｘｉ（ｔ）ｙ（ｔ）｝となるから、数式４は数式５のように表すことができる。
この数式５を変形すると数式６が得られ、数式６におけるＪをＪ１、ＤをＤ１、ＴｆをＴｆ１とおけば、前述の数式１によって慣性推定値Ｊ１、粘性係数推定値Ｄ１、及びクーロン摩擦推定値Ｔｆ１を求めることができる。
【数5】
【数6】
【0036】
一方、図２に示すように、モータ加速度ｘ１（ｔ）は第１の被積分値生成手段３０５に入力されてｘ１（ｔ）の絶対値に対し単調増加する被積分値ｆ１が生成され、モータ速度ｘ２（ｔ）は第２の被積分値生成手段３０７に入力されてｘ２（ｔ）の絶対値に対し単調増加する被積分値ｆ２が生成される。また、第３の被積分値生成手段３０９からは、モータの加速度にも速度にも依存しない被積分値ｆ３が生成される。ここで、例えば、ｆ１をｘ１（ｔ）の二乗、ｆ２をｘ２（ｔ）の二乗とし、ｆ３は単に１としても良い。
【0037】
上記の被積分値ｆ１，ｆ２，ｆ３は積分手段３０６，３０８，３１０によりそれぞれ積分され、その結果が重みＷＪ１，ＷＤ１，ＷＴｆ１として慣性推定値平均手段３４０、粘性係数推定値平均手段３６０、クーロン摩擦推定値平均手段３８０にそれぞれ入力されている。
慣性推定値平均手段３４０、粘性係数推定値平均手段３６０、及びクーロン摩擦推定値平均手段３８０は、推定値演算手段３１１から送られた慣性推定値Ｊ１、粘性係数推定値Ｄ１、及びクーロン摩擦推定値Ｔｆ１に対し、下記のように重みＷＪ１，ＷＤ１，ＷＴｆ１を用いた重み付け演算を行って各推定平均値Ｊ２，Ｄ２，Ｔｆ２を算出する。
慣性推定値平均手段３４０、粘性係数推定値平均手段３６０、及びクーロン摩擦推定値平均手段３８０は、推定値演算手段３１１から送られた慣性推定値Ｊ１、粘性係数推定値Ｄ１、及びクーロン摩擦推定値Ｔｆ１に対し、下記のように重みＷＪ１，ＷＤ１，ＷＴｆ１を用いた重み付け演算を行って各推定平均値Ｊ２，Ｄ２，Ｔｆ２を算出する。
【0038】
以下、慣性推定値平均手段３４０、粘性係数推定値平均手段３６０、及びクーロン摩擦推定値平均手段３８０の構成及び動作について説明する。
例えば、慣性が小さく加速度も小さい場合、前述した推定値演算手段３１１による推定演算を行っても、１回の加減速運転だけでは十分な精度で慣性を推定できないことが考えられる。また、最大速度が小さい加減速運転を行った場合も、１回の加減速運転だけでは十分な精度で粘性係数を推定できないことが考えられ、更に、加減速運転期間がごく短い場合には、その１回の加減速運転だけでは十分な精度でクーロン摩擦を推定できないことが考えられる。
例えば、慣性が小さく加速度も小さい場合、前述した推定値演算手段３１１による推定演算を行っても、１回の加減速運転だけでは十分な精度で慣性を推定できないことが考えられる。また、最大速度が小さい加減速運転を行った場合も、１回の加減速運転だけでは十分な精度で粘性係数を推定できないことが考えられ、更に、加減速運転期間がごく短い場合には、その１回の加減速運転だけでは十分な精度でクーロン摩擦を推定できないことが考えられる。
【0039】
同じようなパターンの加減速運転を繰り返す場合には、加減速運転ごとに得られた各推定値に対して単純移動平均を施す等の方法により推定精度を上げることができる。しかし、繰り返し運転ではない状況で各機械定数の推定精度を向上させたい場合には、加減速運転ごとにそれぞれの推定の信頼性が異なってくる。
そこで、この実施形態では、慣性推定値平均手段３４０、粘性係数推定値平均手段３６０、及びクーロン摩擦推定値平均手段３８０による下記の動作により推定精度を向上させている。
そこで、この実施形態では、慣性推定値平均手段３４０、粘性係数推定値平均手段３６０、及びクーロン摩擦推定値平均手段３８０による下記の動作により推定精度を向上させている。
【0040】
まず、慣性推定値平均手段３４０について、図５を参照しつつ説明する。
なお、リセット指令が入力されるまでは、切替手段３４４，３４８は図示する状態にあるものとする。この点は、後述する図６の切替手段３６４，３６８、図７の切替手段３８４，３８８についても同様である。
なお、リセット指令が入力されるまでは、切替手段３４４，３４８は図示する状態にあるものとする。この点は、後述する図６の切替手段３６４，３６８、図７の切替手段３８４，３８８についても同様である。
【0041】
図５において、慣性推定値平均手段３４０は、１回の加減速期間で慣性推定値Ｊ１及び重みＷＪ１が新たに得られるたびに、慣性推定平均値Ｊ２及び重みＷＪ２を更新するように動作する。なお、重みＷＪ２は、常に重みＷＪ１の今回値（最新値）と前回値とを加算した値として求められるので、以下では「積算重みＷＪ２」ということとする。
図５に示すように、前回値保持手段３４３により保持された積算重みＷＪ２の前回値と重みＷＪ１の今回値（最新値）とを加減算手段３４１により加算し、その結果を予め設定された上限値ＷＪｍａｘにより制限して積算重みＷＪ２の今回値を得る。そして、除算手段３４２により重みＷＪ１の今回値を積算重みＷＪ２の今回値にて除算し、その結果を乗算手段３４６に入力する。
図５に示すように、前回値保持手段３４３により保持された積算重みＷＪ２の前回値と重みＷＪ１の今回値（最新値）とを加減算手段３４１により加算し、その結果を予め設定された上限値ＷＪｍａｘにより制限して積算重みＷＪ２の今回値を得る。そして、除算手段３４２により重みＷＪ１の今回値を積算重みＷＪ２の今回値にて除算し、その結果を乗算手段３４６に入力する。
【0042】
また、前回値保持手段３４９により保持された慣性推定平均値Ｊ２の前回値と慣性推定値Ｊ１の今回値との偏差を加減算手段３４５により求め、その偏差を乗算手段３４６に入力して除算手段３４２の出力と乗算する。更に、乗算手段３４６の出力と慣性推定平均値Ｊ２の前回値とを加減算手段３４７により加算し、その結果を慣性推定平均値Ｊ２の今回値として出力する。
【0043】
以上の動作を数式で表現すると、以下の通りである。
Ｊ２今回値
＝Ｊ２前回値＋（ＷＪ１今回値／ＷＪ２今回値）×（Ｊ１今回値－Ｊ２前回値）
なお、積算重みＷＪ２及び慣性推定平均値Ｊ２は、外部からのリセット指令により切替手段３４４，３４８を「０」側に切り替えることにより、実質的に前回値保持手段３４３，３４９等を含むループを除去することで初期化を可能にしている。具体的には、例えば機械負荷を付け替えた際に切替手段３４４，３４８を「０」側に切り替えてＷＪ２，Ｊ２を初期化し、その後は不揮発性メモリ等の記憶手段にＷＪ２，Ｊ２を記憶しながら更新する。また、システムを再起動した際には、再起動後の運転に先立って上記記憶手段からＷＪ２，Ｊ２の値を読み込むようにする。
Ｊ２今回値
＝Ｊ２前回値＋（ＷＪ１今回値／ＷＪ２今回値）×（Ｊ１今回値－Ｊ２前回値）
なお、積算重みＷＪ２及び慣性推定平均値Ｊ２は、外部からのリセット指令により切替手段３４４，３４８を「０」側に切り替えることにより、実質的に前回値保持手段３４３，３４９等を含むループを除去することで初期化を可能にしている。具体的には、例えば機械負荷を付け替えた際に切替手段３４４，３４８を「０」側に切り替えてＷＪ２，Ｊ２を初期化し、その後は不揮発性メモリ等の記憶手段にＷＪ２，Ｊ２を記憶しながら更新する。また、システムを再起動した際には、再起動後の運転に先立って上記記憶手段からＷＪ２，Ｊ２の値を読み込むようにする。
【0044】
慣性推定平均値Ｊ２の更新方法について、更に詳しく説明する。
まず、加減算手段３４１によりＷＪ２前回値とＷＪ１今回値とを加算した値が上限値ＷＪｍａｘ以下にとどまった場合は、
Ｊ２今回値
＝Ｊ２前回値＋{ＷＪ１今回値／（ＷＪ２前回値＋ＷＪ１今回値）}×（Ｊ１今回値－Ｊ２前回値）
＝（Ｊ２前回値×ＷＪ２前回値＋Ｊ１今回値×ＷＪ１今回値）／（ＷＪ２前回値＋ＷＪ１今回値）
となる。
これは、過去の加減速運転全てのデータを使って重み付け平均値を求めることに相当し、慣性推定精度が得られにくいパターンの加減速運転の場合（例えば、加速度が小さい運転の場合）ほど、図２におけるｘ１（ｔ）が小さくなって重みＷＪ１が小さく抑えられるため、信頼性の高い慣性推定平均値Ｊ２を得ることができる。
まず、加減算手段３４１によりＷＪ２前回値とＷＪ１今回値とを加算した値が上限値ＷＪｍａｘ以下にとどまった場合は、
Ｊ２今回値
＝Ｊ２前回値＋{ＷＪ１今回値／（ＷＪ２前回値＋ＷＪ１今回値）}×（Ｊ１今回値－Ｊ２前回値）
＝（Ｊ２前回値×ＷＪ２前回値＋Ｊ１今回値×ＷＪ１今回値）／（ＷＪ２前回値＋ＷＪ１今回値）
となる。
これは、過去の加減速運転全てのデータを使って重み付け平均値を求めることに相当し、慣性推定精度が得られにくいパターンの加減速運転の場合（例えば、加速度が小さい運転の場合）ほど、図２におけるｘ１（ｔ）が小さくなって重みＷＪ１が小さく抑えられるため、信頼性の高い慣性推定平均値Ｊ２を得ることができる。
【0045】
しかし、ＷＪ２前回値とＷＪ１今回値とを加算した値に何ら制限を設けずに運転を続けていくと、ＷＪ２はやがて無限大になって除算手段３４２の出力がゼロに近付いていくため、新たな加減速運転が行われても慣性推定平均値Ｊ２が更新されなくなる。
そこで、図５に示すように、ＷＪ２前回値とＷＪ１今回値との加算結果を上限値ＷＪｍａｘ以下に制限することで、加減速運転を継続していくに連れて最新の運転結果が慣性推定平均値Ｊ２に反映されるようにした。
そこで、図５に示すように、ＷＪ２前回値とＷＪ１今回値との加算結果を上限値ＷＪｍａｘ以下に制限することで、加減速運転を継続していくに連れて最新の運転結果が慣性推定平均値Ｊ２に反映されるようにした。
【0046】
ここで、重みを定義せずに、
Ｊ２今回値＝Ｊ２前回値＋定数×（Ｊ１今回値－Ｊ２前回値） （０＜定数＜１）
によりＪ２今回値を求める場合について検討する。
このように演算する場合でも、加減速運転を重ねていけば慣性推定精度は上がっていく。しかし、この場合、加減速運転回数が（３／定数）程度に達するまでは、Ｊ２今回値は真値より小さい値になってしまう。また、慣性推定に適さないような低加速度または短時間の加減速運転が行われるような場合にも、その結果をもって他の運転パターンと同様に慣性推定値が更新されてしまう。
Ｊ２今回値＝Ｊ２前回値＋定数×（Ｊ１今回値－Ｊ２前回値） （０＜定数＜１）
によりＪ２今回値を求める場合について検討する。
このように演算する場合でも、加減速運転を重ねていけば慣性推定精度は上がっていく。しかし、この場合、加減速運転回数が（３／定数）程度に達するまでは、Ｊ２今回値は真値より小さい値になってしまう。また、慣性推定に適さないような低加速度または短時間の加減速運転が行われるような場合にも、その結果をもって他の運転パターンと同様に慣性推定値が更新されてしまう。
【0047】
これに対して、本実施形態では、例えば機械負荷を付け替えた時点でリセット指令によりＷＪ２，Ｊ２の値を初期化することで、加減速運転回数が少なくても真値に近い慣性推定値が得られ、高精度な慣性推定平均値Ｊ２を短時間で得ることができる。
また、加速度ｘ１（ｔ）の絶対値に対して単調増加するｆ１を数値積分して重みＷＪ１を求め、この重みＷＪ１と積算重みＷＪ２とを用いて慣性推定値Ｊ１を更新しているため、慣性推定に適さない運転に対しても慣性推定平均値Ｊ２が乱れにくくなる。
また、加速度ｘ１（ｔ）の絶対値に対して単調増加するｆ１を数値積分して重みＷＪ１を求め、この重みＷＪ１と積算重みＷＪ２とを用いて慣性推定値Ｊ１を更新しているため、慣性推定に適さない運転に対しても慣性推定平均値Ｊ２が乱れにくくなる。
【0048】
次に、図６は粘性係数推定値平均手段３６０の構成を示している。
この粘性係数推定値平均手段３６０は、１回の加減速期間で粘性係数推定値Ｄ１及び重みＷＤ１が新たに得られるたびに、粘性係数推定平均値Ｄ２及び積算重みＷＤ２を更新するように動作する。
この粘性係数推定値平均手段３６０は、１回の加減速期間で粘性係数推定値Ｄ１及び重みＷＤ１が新たに得られるたびに、粘性係数推定平均値Ｄ２及び積算重みＷＤ２を更新するように動作する。
【0049】
図６に示す粘性係数推定値平均手段３６０において、３６１，３６５，３６７は加減算手段、３６２は除算手段、３６３，３６９は前回値保持手段、３６４，３６８は切替手段、３６６は乗算手段、ＷＤｍａｘはＷＤ２前回値とＷＤ１今回値との加算結果に設定された上限値である。この粘性係数推定値平均手段３６０の全体的な動作は、入出力信号を除けば慣性推定値平均手段３４０と同様である。
粘性係数の推定に当たっては、速度ｘ２（ｔ）の絶対値に対して単調増加するｆ２を数値積分して得た重みＷＤ１と積算重みＷＤ２とを用いて粘性係数推定値Ｄ１を更新することにより粘性係数推定平均値Ｄ２を求めているため、最大速度が小さい運転のように粘性係数の推定に適さないパターンの運転に対しても粘性係数推定平均値Ｄ２が乱れにくくなる。
粘性係数の推定に当たっては、速度ｘ２（ｔ）の絶対値に対して単調増加するｆ２を数値積分して得た重みＷＤ１と積算重みＷＤ２とを用いて粘性係数推定値Ｄ１を更新することにより粘性係数推定平均値Ｄ２を求めているため、最大速度が小さい運転のように粘性係数の推定に適さないパターンの運転に対しても粘性係数推定平均値Ｄ２が乱れにくくなる。
【0050】
また、図７はクーロン摩擦推定値平均手段３８０の構成を示している。
このクーロン摩擦推定値平均手段３８０は、１回の加減速期間でクーロン摩擦推定値Ｔｆ１及び重みＷＴｆ１が新たに得られるたびに、クーロン摩擦推定平均値Ｔｆ２及び積算重みＷＴｆ２を更新するように動作する。
このクーロン摩擦推定値平均手段３８０は、１回の加減速期間でクーロン摩擦推定値Ｔｆ１及び重みＷＴｆ１が新たに得られるたびに、クーロン摩擦推定平均値Ｔｆ２及び積算重みＷＴｆ２を更新するように動作する。
【0051】
図７に示すクーロン摩擦推定値平均手段３８０において、３８１，３８５，３８７は加減算手段、３８２は除算手段、３８３，３８９は前回値保持手段、３８４，３８８は切替手段、３８６は乗算手段、ＷＴｆｍａｘはＷＴｆ２前回値とＷＴｆ１今回値との加算結果に設定された上限値である。このクーロン摩擦推定値平均手段３８０の全体的な動作は、入出力信号を除けば前述の慣性推定値平均手段３４０や粘性係数推定値平均手段３６０と同様である。
クーロン摩擦の推定に当たっては、加速度ｘ１（ｔ）にも速度ｘ２（ｔ）にも依存しない値ｆ３を数値積分して得た重みＷＴｆ１と積算重みＷＴｆ２とを用いてクーロン摩擦推定値Ｔｆ１を更新し、これによってクーロン摩擦推定平均値Ｔｆ２を求めているため、クーロン摩擦の推定に適さないような運転が行われた場合でもクーロン摩擦推定平均値Ｔｆ２が乱れにくくなる。
クーロン摩擦の推定に当たっては、加速度ｘ１（ｔ）にも速度ｘ２（ｔ）にも依存しない値ｆ３を数値積分して得た重みＷＴｆ１と積算重みＷＴｆ２とを用いてクーロン摩擦推定値Ｔｆ１を更新し、これによってクーロン摩擦推定平均値Ｔｆ２を求めているため、クーロン摩擦の推定に適さないような運転が行われた場合でもクーロン摩擦推定平均値Ｔｆ２が乱れにくくなる。
【0052】
以上のように、本実施形態の機械定数推定装置によれば、モータ速度や加速度、加減速運転期間が機械定数の推定に不適切であるような運転パターンであったとしも、推定値の悪化を招きにくい形で機械定数を高精度かつ短時間で推定することができる。
更に、この機械定数推定装置をモータ制御装置に実装し、機械負荷に応じて加減速期間ごとに推定した機械定数をモータの速度制御やトルク制御に反映させることにより、機械駆動システムにおける追従誤差や振動を低減することが可能になる。
更に、この機械定数推定装置をモータ制御装置に実装し、機械負荷に応じて加減速期間ごとに推定した機械定数をモータの速度制御やトルク制御に反映させることにより、機械駆動システムにおける追従誤差や振動を低減することが可能になる。
【符号の説明】
【0053】
１００：速度制御部
２００：モータ・機械負荷
３００，３００Ａ，３００Ｂ：機械定数推定部
３０１：微分手段
３０２：符号判定手段
３０３：乗算手段
３０４，３０６，３０８，３１０：積分手段
３０５，３０７，３０９：被積分値生成手段
３１１：推定値演算手段
３１２，３１３：ローパスフィルタ
３２０：積分開始・終了判定手段
３２１：絶対値演算手段
３２２：比較手段
３２３，３２４：指示生成手段
３４０：慣性推定値平均手段
３４１，３４５，３４７：加減算手段
３４２：除算手段
３４３，３４９：前回値保持手段
３４６：乗算手段
３４４，３４８：切替手段
３６０：粘性係数推定値平均手段
３６１，３６５，３６７：加減算手段
３６２：除算手段
３６３，３６９：前回値保持手段
３６６：乗算手段
３６４，３６８：切替手段
３８０：クーロン摩擦推定値平均手段
３８１，３８５，３８７：加減算手段
３８２：除算手段
３８３，３８９：前回値保持手段
３８６：乗算手段
３８４，３８８：切替手段
２００：モータ・機械負荷
３００，３００Ａ，３００Ｂ：機械定数推定部
３０１：微分手段
３０２：符号判定手段
３０３：乗算手段
３０４，３０６，３０８，３１０：積分手段
３０５，３０７，３０９：被積分値生成手段
３１１：推定値演算手段
３１２，３１３：ローパスフィルタ
３２０：積分開始・終了判定手段
３２１：絶対値演算手段
３２２：比較手段
３２３，３２４：指示生成手段
３４０：慣性推定値平均手段
３４１，３４５，３４７：加減算手段
３４２：除算手段
３４３，３４９：前回値保持手段
３４６：乗算手段
３４４，３４８：切替手段
３６０：粘性係数推定値平均手段
３６１，３６５，３６７：加減算手段
３６２：除算手段
３６３，３６９：前回値保持手段
３６６：乗算手段
３６４，３６８：切替手段
３８０：クーロン摩擦推定値平均手段
３８１，３８５，３８７：加減算手段
３８２：除算手段
３８３，３８９：前回値保持手段
３８６：乗算手段
３８４，３８８：切替手段
【図1】
【図2】
【図3】
【図4】
【図5】
【図6】
【図7】
【図8】