(57)【要約】【課題】機械システムにおける捻じれ要素によって生じる捻じれ摩擦を同定する。【解決手段】本発明に係る摩擦同定装置１０は、機械装置２２に入力されるトルクＴｔを検出するトルク検出部１１と、前記トルク検出部１１から得られる機械装置２２に入力されるトルクＴｔから捻じれトルクＴＳを算出する捻じれトルク算出器１９と、前記捻じれトルクＴＳと捻じれトルク推定値ＴＳ^との偏差が小さくなるように推定捻じれ摩擦ＤＳ^を調整する推定捻じれ摩擦調整部１５と、モータ回転速度と機械装置回転速度の差分である捻じれ速度ωＳと捻じれ要素のバネ定数ＫＳと前記推定捻じれ摩擦調整部１５より得られる推定捻じれ摩擦ＤＳ^に基づき、捻じれトルク推定値ＴＳ^を演算する捻じれトルク推定部１４とを、備える。【選択図】図１
2020173116.tif 000002
【特許請求の範囲】
【請求項１】
機械装置とモータが捻じれ要素を介して接続されている機械システムの摩擦同定装置であって、前記機械装置に入力されるトルクを検出するトルク検出部と、前記機械装置に入力されるトルクから算出される捻じれトルクと、モータ回転速度と機械装置回転速度との差である捻じれ速度と、前記捻じれ要素のバネ定数と、推定捻じれ摩擦に基づき、捻じれトルク推定値を演算する捻じれトルク推定部と、前記捻じれトルクと前記捻じれトルク推定値との偏差が小さくなるように前記推定捻じれ摩擦を調整する推定捻じれ摩擦調整部と、を備えることを特徴とする摩擦同定装置。
【請求項２】
請求項１に記載の摩擦同定装置において、前記推定捻じれ摩擦調整部は、前記捻じれトルクと前記捻じれトルク推定値の実効値を演算して差分を計算し、前記推定捻じれ摩擦を調整することを特徴とする摩擦同定装置。
【請求項３】
請求項１に記載の摩擦同定装置において、前記トルク検出部から得られる機械装置に入力されるトルクをフィルタに入力し共振周波数の周波数成分のみを取り出すことによって前記捻じれトルクを演算することを特徴とする摩擦同定装置。
【請求項４】
請求項１に記載の摩擦同定装置において、前記トルク検出部から得られる機械装置に入力されるトルクと前記機械装置の慣性および摩擦を用いて前記機械装置回転速度を演算することを特徴とする摩擦同定装置。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、モータと機械装置が捻じれ要素によって結合されている機械システムの特性、とりわけ捻じれ要素によって生じる捻じれ摩擦を同定する摩擦同定装置に関する。
【背景技術】
【０００２】
機械装置をモータにより駆動する際には、装置の特性を正確に把握することが重要である。とりわけ、モータと機械装置との間の共振による振動の特性を測定することが重要である。そこで、このような特性を測定するための技術が検討されている。
【０００３】
例えば、特許文献１には、モータトルク指令値から捻じれトルクまでの伝達関数とモータトルク指令値から機械装置回転速度の伝達関数の比を計算することで機械装置の特性を測定する技術が記載されている。
【先行技術文献】
【特許文献】
【０００４】
【特許文献１】特許第６１４９９４８号公報
【発明の概要】
【発明が解決しようとする課題】
【０００５】
特許文献１に記載されている技術では、制御対象の摩擦は、モータと機械装置の摩擦という形で同定されている。しかし、実際にはモータと機械装置の摩擦以外に、捻じれ要素による捻じれ摩擦が別に存在する。
そのため、特許文献１に記載されている技術では、モータと機械装置を結合するカップリングなどの捻じれ要素による捻じれ摩擦が考慮されておらず、正しいモデル化ができず共振時における特性に誤差が生じてしまう。
【０００６】
上記のような問題点を鑑みてなされた本発明の目的は、モータと機械装置を結合する捻じれ要素によって生じる捻じれ摩擦を考慮して機械システムをモデル化し、前記捻じれ要素の捻じれ摩擦を同定する摩擦同定装置を提供することを目的とする。
【課題を解決するための手段】
【０００７】
上記課題を解決するため、本発明に係る摩擦同定装置は、機械装置を駆動するモータと機械装置が捻じれ要素を介して結合された機械システムの特性を同定する装置であって、前記機械装置に入力されるトルクを検出するトルク検出部と、前記トルク検出部の出力から算出される捻じれトルクと捻じれトルク推定部から算出される捻じれトルク推定値との偏差が小さくなるように推定捻じれ摩擦を調整する推定捻じれ摩擦調整部と、モータ回転速度と機械装置回転速度の差分である捻じれ速度と前記捻じれ要素のバネ定数と前記推定捻じれ摩擦調整部より出力される前記推定捻じれ摩擦に基づき、前記捻じれトルク推定値を演算する捻じれトルク推定部とを、備える。
【０００８】
また、本発明に係る摩擦同定装置において、前記推定捻じれ摩擦調整部は、前記捻じれトルク測定値と前記捻じれトルク推定値との実効値を演算して用いることが好ましい。
【０００９】
また、本発明に係る摩擦同定装置において、前記捻じれトルクは、前記トルク検出部から得られる機械装置に入力されるトルクをフィルタに入力し、共振周波数の成分のみを取り出すことによって算出することを特徴とする。
【００１０】
また、本発明に係る摩擦同定装置において、前記機械装置回転速度は、前記トルク検出部から得られる機械装置に入力されるトルクと機械装置の慣性および摩擦から算出することを特徴とする。
【発明の効果】
【００１１】
本発明に係る摩擦同定装置によれば、モータと機械装置を結合するカップリングなどの捻じれ要素によって生じる摩擦を同定でき、正確な共振特性のモデルを得ることができる。
【図面の簡単な説明】
【００１２】
【図１】本発明の一実施形態に係る摩擦同定装置の概要を示す図である。
【図２】本発明の請求項１の実施形態（実施例１）を示す構成図である。
【図３】本発明の請求項３の実施形態（実施例２）を示す構成図である。
【図４】本発明の請求項４の実施形態（実施例３）を示す構成図である。
【発明を実施するための形態】
【００１３】
以下、本発明を実施するための形態について、図面を参照しながら説明する。
【００１４】
図１は、本発明の一実施形態に係る摩擦同定装置の概要を示す図である。本実施形態に係る摩擦同定装置は、モータと機械装置とがカップリングなどの捻じれ要素により結合され、捻じれ要素を介してモータにより機械装置が駆動される機械システムにおいて、モータと機械装置との間に介在するカップリングなどの捻じれ要素によって生じる捻じれ摩擦を同定するものである。
【実施例１】
【００１５】
図２は本発明の一実施形態に係る摩擦同定装置１０の構成例を示す図である。上述したようなモータと機械装置とがカップリングなどの捻じれ要素により結合された機械システムは、図２に示す２慣性系モデル２０に近似することができる。まず、この２慣性系モデル２０について説明する。２慣性系モデル２０は、モータ２１と、機械装置２２と、捻じれ要素２３とを含む。
【００１６】
モータ２１は、モータの機械的要素（慣性および摩擦）を示す。モータ２１の伝達関数は１／（ＪＭｓ＋ＤＭ）で表される。ＪＭはモータ２１の慣性モーメントであり、ＤＭはモータ２１の摩擦であり、ｓはラプラス演算子である。モータ２１は、減算器２４により演算されるモータ出力トルクＴＭと捻じれトルクＴＳとの差が入力され、モータ回転速度ωＭを出力する。
【００１７】
機械装置２２は、機械装置の機械的要素（慣性および摩擦）を示す。機械装置２２の伝達関数は、１／（ＪＬｓ＋ＤＬ）で表される。ＪＬは機械装置２２の慣性モーメントであり、ＤＬは機械装置２２の摩擦である。機械装置２２は、加算器２５により演算される捻じれトルクＴＳと機械装置側の負荷トルクである負荷トルクＴＬとの和が入力され、機械装置回転速度ωＬを出力する。
【００１８】
捻じれ要素２３の伝達特性は、（ＫＳ／ｓ＋ＤＳ）で表される。ＫＳはばね定数であり、ＤＳは捻じれ摩擦である。捻じれ要素２３は、減算器２６により演算されるモータ回転速度ωＭと機械装置回転速度ωＬとの差である捻じれ速度ωＳが入力され、捻じれトルクＴＳとして出力する。
【００１９】
図２に示す２慣性系モデル２０において、捻じれトルクは以下の式（１）で表される。
【００２０】
【数１】
2020173116.tif 000003
【００２１】
式（１）より、バネ定数ＫＳが既知でモータ回転速度ωＭと機械装置回転速度ωＬが回転数検出装置などによって検出あるいは推定できる場合、未知数は捻じれ摩擦ＤＳのみとなる。
【００２２】
次に、本実施形態に係る摩擦同定装置１０の構成について説明する。
【００２３】
図２に示す摩擦同定装置１０は、トルク検出部１１と、減算器１２と、減算器１３と、捻じれトルク推定部１４と、推定捻じれ摩擦調整部１５とを備える。
【００２４】
トルク検出部１１は、捻じれ要素２３と機械装置２２の間に設けられ、機械装置２２に入力されるトルクＴｔを検出する。トルク検出部１１としては、例えばトルク計を用いることができる。
【００２５】
減算器１２は負荷トルクＴＬと検出部によるトルクＴｔとを減算し捻じれトルクＴＳとして出力する。
【００２６】
減算器１３はモータ回転速度ωＭと機械装置回転速度ωＬとを減算し捻じれ速度ωＳとして出力する。モータ回転速度ωＭと機械装置回転速度ωＬの検出には、例えばエンコーダなどの角度検出器から得た位置情報を用いて算出することができる。
【００２７】
捻じれトルク推定部１４は、減算器１３による捻じれ速度ωＳと、捻じれ要素のバネ定数ＫＳと後述する推定捻じれ摩擦調整部１５による推定捻じれ摩擦ＤＳ^から式（２）を演算し、捻じれトルク推定値ＴＳ^を出力する。なお、ａ＾は、ａの上に＾が付された記号を表すものとする。
【００２８】
【数２】
2020173116.tif 000004
【００２９】
推定捻じれ摩擦調整部１５は、減算器１２による捻じれトルクＴＳと、捻じれトルク推定部１４による捻じれトルク推定値ＴＳ^の偏差が小さくなるように、捻じれトルク推定部１４による捻じれトルク推定値ＴＳ^の演算に用いられる推定捻じれ摩擦ＤＳ^を調整する。
【００３０】
捻じれ摩擦ＤＳと推定捻じれ摩擦ＤＳ^の偏差は、以下の式（３）のように捻じれトルクＴＳと捻じれトルク推定値ＴＳ^の偏差に現れることになる。上述したように、推定捻じれ摩擦調整部１５により推定捻じれ摩擦ＤＳ^を調整することで捻じれトルクＴＳと捻じれトルク推定値ＴＳ^の偏差を小さくすることできる。すなわち、捻じれトルクＴＳと捻じれトルク推定値ＴＳ^の偏差がゼロになると、捻じれ要素による捻じれ摩擦ＤＳと推定捻じれ摩擦ＤＳ^の偏差もゼロになる。従って、モータと機械装置との間との共振特性を表す上で重要なパラメータである捻じれ要素による捻じれ摩擦ＤＳを同定することができる。
【００３１】
【数３】
2020173116.tif 000005
【００３２】
なお、推定捻じれ摩擦調整部１５は、捻じれトルクＴＳの実効値と捻じれトルク推定値ＴＳ^の実効値を演算し、それらを用いて捻じれトルクＴＳと捻じれトルク推定値ＴＳ^の偏差を演算することが好ましい。
【実施例２】
【００３３】
図３は請求項３の実施例を示したもので、図２と異なるところは、フィルタ１６を設け、機械装置に入力されるトルクＴｔをフィルタ１６に入力し共振周波数の周波数成分のみを取り出すことでフィルタ１６の出力を捻じれトルクとして得ることである。また、フィルタ１６による捻じれトルクＴＳの位相ずれを補償するために位相調整器１７によって捻じれ速度ωＳの位相を調整することである。他は図２と同様である。
【００３４】
すなわち、フィルタ１６は、機械装置に入力されるトルクＴｔの低周波数成分を除去し、共振周波数の周波数成分を取得できるように適切に設定されたフィルタとして使用される。このように構成したことにより、負荷トルクＴＬを取得できない場合でも、捻じれ摩擦ＤＳの同定が可能となる。
【実施例３】
【００３５】
図４は請求項４の実施例を示したものである。図２と異なるのは、速度演算器１８を設け、トルク検出部１１より得られる機械装置に入力されるトルクＴｔを速度演算器１８に入力することによって以下の式（４）より機械装置回転速度推定値ωＬ＾を得ることである。他は図２と同様である。このように構成したことにより、機械装置側に速度検出装置が設けられない場合でも捻じれ摩擦ＤＳの同定が可能となる。
【００３６】
【数４】
2020173116.tif 000006
【００３７】
上述の実施形態は代表的な例として説明したが、本発明の趣旨および範囲内で、多くの変更および置換が可能であることは当業者に明らかである。したがって、本発明は、上述の実施形態によって制限するものと解するべきではなく、特許請求の範囲から逸脱することなく、種々の変形および変更が可能である。
【符号の説明】
【００３８】
１０    摩擦同定装置
１１    トルク検出部
１２,１３,２４,２６    減算器
１４    捻じれトルク推定部
１５    推定捻じれ摩擦調整部
１６    フィルタ
１７    位相調整器
１８    速度演算器
１９    捻じれトルク算出器
２０    ２慣性系モデル
２１    モータ
２２    機械装置
２３    捻じれ要素
２５    加算器
【図１】
2020173116.tif 000007
【図２】
2020173116.tif 000008
【図３】
2020173116.tif 000009
【図４】
2020173116.tif 000010