減速機異常診断方法及び減速機異常診断装置
【課題】本発明は、定量的な判断基準を導入することで、異常の診断を正確に行うことができる減速機異常診断方法及び減速機異常診断装置を提供する。
【解決手段】モータを駆動源として相対的に回転運動する一対の被駆動部材が一定速度で相対回転しているときに取得されたトルク指令と速度フィードバックとに基づいて、減速機に関する外乱推定値を推定するオブザーバ２３と、外乱推定値の周波数成分からクランク軸の回転周波数の定数倍に対応する特定スペクトルを抽出するスペクトル特定手段２４と、スペクトル特定手段２４により特定された特定スペクトルの振幅としきい値とを比較し、特定スペクトルの振幅がしきい値を超えた場合を異常と診断し、特定スペクトルの振幅がしきい値と同程度ないしそれより小さい場合を正常と診断する診断手段２５とを備える。
【解決手段】モータを駆動源として相対的に回転運動する一対の被駆動部材が一定速度で相対回転しているときに取得されたトルク指令と速度フィードバックとに基づいて、減速機に関する外乱推定値を推定するオブザーバ２３と、外乱推定値の周波数成分からクランク軸の回転周波数の定数倍に対応する特定スペクトルを抽出するスペクトル特定手段２４と、スペクトル特定手段２４により特定された特定スペクトルの振幅としきい値とを比較し、特定スペクトルの振幅がしきい値を超えた場合を異常と診断し、特定スペクトルの振幅がしきい値と同程度ないしそれより小さい場合を正常と診断する診断手段２５とを備える。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、入力軸と出力軸の中間にあって回転を伝達し、前記入力軸の回転に比例して回転する中間軸要素、例えば、内歯歯車に噛み合う外歯歯車を偏心回転させるためのクランク軸を有する減速機の異常を診断する減速機異常診断方法及び減速機異常診断装置に関するものである。
【背景技術】
【０００２】
減速機異常診断方法として、診断対象部分に取り付けられたセンサの情報に基づいて減速機の異常を診断する方法がある。この診断方法は、非破壊的にロボットや工作機械などの異常の発見を行うことができる点で非常に有効な方法である半面、異常を生じた後の事後的な発見となるため種々の不都合があった。例えば、減速機を直して、ロボットを復旧させるまで非常に多くの時間がかかっていた。また、生産現場において、ロボットなど稼働しているときに異常が発見された場合には、ロボットが復旧するまで生産ラインを停止させなければならなかった。
【０００３】
そこで、事前に異常を予知することで、上記問題を回避することができる異常診断方法の一例として、特許文献１に開示されている方法が知られている。この発見方法は、ロボットの自由端に設けた振動センサによって診断対象となる関節部の振動パターンを検出し、検出された振動パターンを正常なロボットの振動パターンと比較し、その比較結果を判断することで関節部の異常を事前に予知するものである。関節部の異常は、軸受や歯車や減速機の摩耗劣化などによる異常である。関節部の異常は、異常時と正常時の振動波形の周波数成分の平均値、ピーク値などを比較することによって診断されるようになっている。
【０００４】
【特許文献１】特開平５−５２７１２号公報
【発明の開示】
【発明が解決しようとする課題】
【０００５】
上記従来の方法では、センサにより検出された信号には種々のノイズが含まれているため、関節部の診断に有効とされる信号のみが直接的に抽出されず、検出された信号から異常の発生を正確に予知することができない心配があった。言い換えると、従来の方法は、センサにより検出された信号の周波数成分と正常時の周波数成分との差が大きければ故障間近とするものであるが、診断検出信号にノイズなどが含まれている場合には、関節部の異常を反映させる信号とノイズとが混ざった状態となり、関節部の異常時と正常時の違いを明確に区別できない恐れがあった。
【０００６】
また、センサにより検出された信号は重力の影響を受けて変化するため、関節部の位置・姿勢によっては、検出された信号の大きさが一定せず、診断結果の信頼性が損なわれるという問題があった。
【０００７】
また、ロボットや工作機械などに異常を検出するためのセンサを取り付ける必要があり、センサ購入費用の分だけ余計にコストがかかるという問題があった。
【０００８】
本発明は、定量的な判断基準を導入することで、異常の診断を正確に行うことができ、これにより機械の稼働率を高めて生産性を向上することができる減速機異常診断方法及び減速機異常診断装置を提供することを目的とする。
【課題を解決するための手段】
【０００９】
上記問題を解決するため、本発明の請求項１の発明は、入力軸と出力軸の中間にあって回転を伝達し、前記入力軸の回転に比例して回転する中間軸要素を有する減速機の異常を診断する減速機異常診断方法において、モータを駆動源として相対的に回転運動する一対の被駆動部材が一定速度で相対回転しているときに取得されたトルク指令と速度フィードバックとに基づいて、前記減速機に関する外乱推定値をオブザーバにより推定し、周波数解析により得られた前記外乱推定値の周波数成分から前記中間軸要素の回転周波数の定数倍に対応する特定スペクトルを抽出し、該特定スペクトルの振幅としきい値とを比較し、前記特定スペクトルの振幅が前記しきい値を超えた場合を異常と診断し、前記特定スペクトルの振幅が前記しきい値と同程度ないしそれより小さい場合を正常と診断することを特徴とする。
【００１０】
請求項２の発明は、入力軸と出力軸の中間にあって回転を伝達し、前記入力軸の回転に比例して回転する中間軸要素を有する減速機の異常を診断する減速機異常診断方法において、モータを駆動源として相対的に回転運動する一対の被駆動部材が一定速度で相対回転しているときに取得された速度フィードバックに基づいて加速度を算出し、周波数解析により得られた前記加速度の周波数成分から前記中間軸要素の回転周波数の定数倍に対応する特定スペクトルを抽出し、該特定スペクトルの振幅としきい値とを比較し、前記特定スペクトルの振幅が前記しきい値を超えた場合を異常と診断し、前記特定スペクトルの振幅が前記しきい値と同程度ないしそれより小さい場合を正常と診断することを特徴とする。
【００１１】
請求項３の発明は、請求項１又は２に記載の減速機異常診断方法において、前記しきい値は、前記中間軸要素が正常であるときに、周波数解析により得られた前記外乱推定値又は前記加速度の周波数成分から前記中間軸要素の回転周波数の定数倍に対応して抽出されたスペクトルの振幅に相当する。
【００１２】
請求項４の発明は、請求項１〜３の何れか１項に記載の減速機異常診断方法において、前記特定スペクトルの振幅が前記しきい値を超えたとき、前記減速機が異常である情報を外部に出力する。
【００１３】
請求項５の発明は、請求項４に記載の減速機異常診断方法において、前記減速機を備えたロボットのモデルを表示する表示装置の画面上で、前記減速機を示す部分のみを強調表示して異常を知らせる。
【００１４】
請求項６の発明は、請求項１〜５のいずれか１項に記載の減速機異常診断方法において、前記減速機の異常を診断する際に、前記減速機を備えたロボットのモデルを表示する表示装置の画面上で、前記減速機を示す部分を指定して異常の診断を開始する。
【００１５】
請求項７の発明は、入力軸と出力軸の中間にあって回転を伝達し、前記入力軸の回転に比例して回転する中間軸要素を有する減速機の異常を診断する減速機異常診断装置において、モータを駆動源として相対的に回転運動する一対の被駆動部材が一定速度で相対回転しているときに取得されたトルク指令と速度フィードバックとに基づいて、前記減速機の入力側で前記減速機に関する外乱推定値を推定するオブザーバと、前記外乱推定値の周波数成分から前記中間軸要素の回転周波数の定数倍に対応する特定スペクトルを抽出するスペクトル特定手段と、前記スペクトル特定手段により特定された前記特定スペクトルの振幅としきい値とを比較し、前記特定スペクトルの振幅が前記しきい値を超えた場合を異常と診断し、前記特定スペクトルの振幅が前記しきい値と同程度ないしそれより小さい場合を正常と診断する診断手段と、を備えることを特徴とする。
【発明の効果】
【００１６】
本願の請求項１又は７記載の発明によれば、減速機の動作状態を反映させる外乱推定値を用いて診断することで、ノイズがデータに含まれることを排除することができ、これにより、減速機の異常を直接的かつ正確に診断することができる。また、外乱推定値はオブザーバにより推定されるから、重力の影響を含まないデータを取得することができ、これにより、ロボットや工作機械などの位置・姿勢に影響されずに、減速機の異常を正確に診断することができる。中間軸要素の回転周波数の定数倍に対応する周波数で外乱推定値の特定スペクトルを抽出することで、減速機の異常を診断するための最適なスペクトルをサンプリングすることができる。したがって、定量的な判断基準に基づいて、減速機の異常の診断を正確に実施することができる。これにより、機械の稼働率を高めて生産性を向上することができる。
【００１７】
請求項２記載の発明によれば、減速機の動作状態を反映させる加速度を用いることによっても、減速機の異常を正確に診断することができる。したがって、請求項１記載の発明と同様の効果を奏し、定量的な判断基準に基づいて、減速機の異常の診断を正確に行うことができる。
【００１８】
請求項３記載の発明によれば、特定スペクトルの振幅がしきい値と同程度ないしはそれより小さいときは、減速機が正常であると診断することができる。逆に、特定スペクトルの振幅がしきい値を超えるときは、減速機が異常であると判断することができる。
【００１９】
請求項４記載の発明によれば、アラームライトやアラーム音などにより、減速機が異常である情報を外部に出力することで、工場の作業者等が減速機の異常を認識することができる。
【００２０】
請求項５記載の発明によれば、減速機の異常を視覚的に認識することができ、作業性が向上する。また、請求項６記載の発明によれば、表示装置の画面上で減速機を示す部分を指定することで異常の診断を開始することができるから、ロボットに対して減速機の異常診断を容易に開始することができる。
【発明を実施するための最良の形態】
【００２１】
以下に本発明の実施の形態の具体例を図面を用いて詳細に説明する。図１は、本発明に係る減速機異常診断装置の一実施形態を含むシステム構成図である。減速機異常診断装置２は、入力軸としてのクランク軸の故障などの異常を図示しない減速機の異常と擬制する診断装置であり、ロボット５を制御する装置本体３と、装置本体３との間で信号の送受信を行う端末装置４とから構成されている。この減速機異常診断装置２と、モータと一体の減速機を備えたロボット５とから減速機異常診断システム１が構成されている。ロボット５と装置本体３は動力線７と信号線８を介して電気的に相互接続し、装置本体３と端末装置４はＬＡＮケーブル９を介して電気的に相互接続している。以下において、各構成要素について説明する。
【００２２】
ロボット５は、嵌合部品の嵌合作業を行うために用いられる一般的なものであり、ベース１０と、ベース１０に続く胴体部１１と、第１の関節部１２を介して胴体部１１に続く上腕部１３と、第２の関節部１４を介して上腕部１３に続く前腕部１５と、第３の関節部１６を介して前腕部１５に続く手首要素１７と、手首要素２７に続くハンドツール１８とからなっている。ハンドツール１８は、相対向する一対の把持爪１９ａ，１９ｂを備えており、この一対の把持爪１９ａ，１９ｂの間でワーク２０が把持されるようになっている。
【００２３】
第１，２，３の関節部１２，１４，１６は、各関節部を介して隣接する動作部材（被駆動部材）を相対的に回転動作させる部分であり、減速機を有するモータを備えている。モータの回転は減速機で減速され、隣接する動作部材が相対的に回転動作するようになっている。動作部材とは、上腕部１３、前腕部１５、手首要素１７に相当する。減速機は、一般的なものであり、筒壁に固定して設けられた内歯歯車と、この内歯歯車に噛み合う外歯歯車と、外歯歯車に嵌合して外歯歯車を偏心回転させるクランク軸（中間軸要素）とを備えている。クランク軸は、モータの出力軸に連結されている。内歯歯車は、外歯歯車より歯数が一つだけ多くなっている。このため、外歯歯車がクランク軸と共に１回転することで、内歯歯車が１ピッチ分だけ反対方向に回転する。したがって、この減速機構では、少なくとも外歯歯車の歯数の逆数を減速比として入力回転を減速するようになっている。
【００２４】
ロボット５にケーブル９を介して接続する装置本体３は、従来と同様の構成であり、図示しないプロセッサ、ＲＯＭ、ＲＡＭ、不揮発性メモリ、各種インターファース、送信制御回路や受信制御回路などで構成されたデジタルサーボ回路を備えている。各種メモリ、各種インターフェース、デジタルサーボ回路は、システムバスを介してプロセッサに接続している。デジタルサーボ回路は、サーボモータを帰還データに基づいて、位置ループ制御、速度ループ制御すると共に、トランジスタインバータ等のサーボアンプからの電流フィードバック信号に基づいて電流ループ制御する回路である。インターフェースには、センサや、ディスプレイモニタや、ＣＣＤカメラなどを接続することができる。
【００２５】
端末装置４は、本体２１と、ディスプレイ２２とを備えたパーソナルコンピュータに相当するものであり、外乱推定値を推定するオブザーバ２３と、外乱推定値の周波数成分からクランク軸の回転周波数の定数倍に対応する特定スペクトルを抽出するスペクトル特定手段２４と、特定スペクトルの振幅とクランク軸が正常であるときの振幅に基づいたしきい値とを比較し判断する診断手段２５とを備えている。
【００２６】
本体２１にはシステムプログラムや動作プログラムなどが記憶されていて、マニュアル操作の場合は、オペレータが図示しないキーボートを介して必要な情報を入力することで異常診断動作プログラムが起動し、オブザーバ２３、スペクトル特定手段２４、診断手段２５がそれぞれ機能するようになっている。
【００２７】
オブザーバ２３は、モータにより相対的に回転運動する一対の動作部材が一定速度（一定周期）で相対回転しているときに取得されたトルク指令と速度フィードバックとに基づいて、減速機に関する外乱トルク（外乱推定値）を推定するためのものである。
【００２８】
スペクトル特定手段２４は、外乱トルクの時系列データを周波数解析することによって得られた周波数成分から、一対の動作部材が一定速度で相対回転しているときのクランク軸の回転周波数の定数倍に対応する特定された対象スペクトル（特定スペクトル）を抽出するものである。
【００２９】
診断手段２５は、クランク軸が正常に動作しているときの外乱トルクを周波数解析することによって得られるしきい値としての基準スペクトｓルと、スペクトル特定手段により特定された対象スペクトルとを比較し、総合的又は選択的に対象スペクトルの振幅が基準スペクトルを超えた場合を異常と診断し、診断対象スペクトルの振幅が基準スペクトルの振幅と同程度ないしそれより小さい場合を正常と診断するものである。
【００３０】
次に、図１に示すロボット５を対象とし、図３のフローチャートに基づき、減速機の異常診断方法をフローチャートに従って説明する。図１に示すロボット５は、３軸の回転軸を有するロボットであるが、説明の都合上、任意の軸の関節部に注目して異常診断の説明をすることとする。
【００３１】
診断対象となる減速機は、前段及び後段減速機構を備え、前段減速機構によりモータ出力軸のＮ回転をクランク軸のｎ回転に減速し、さらに、後段減速機構によりクランク軸のｎ回転を出力側（内歯歯車側）の１回転に減速するものとする。すなわち、この減速機は、モータの回転数を１／Ｎの減速比で減速するものとする。
【００３２】
ステップＳ１では、端末装置４は装置本体３から所定のサンプリング周期Δｔ毎に速度フィードバック値及びトルク指令値を受信する。ステップＳ２では、オブザーバ２３により、受信された速度フィードバック値及びトルク指令値からクランク軸の回転周期と同期する周期成分を含む外乱トルクを推定する。ステップＳ３では、速度フィードバック値、トルク指令値、推定された外乱トルクは、時系列データとして記憶する。
【００３３】
次に、ステップＳ４で、速度フィードバック値ｖがしきい値Ｌｖより大きく、かつ、関節部が一定速度で相対回転しているときの対象データを抽出する。図４には、対象データ抽出ルーチンを詳細に示す図を示す。図示するように、先ず、速度フィードバック値から加速度ａを算出する。この加速度ａが、予め設定されたしきい値Ｌａ内に、一定のサンプリング期間Ｔｄ以上に亘って連続して収まっているときを、関節部が一定速度で相対回転しているときとみなし、この一定期間Ｔｄ内の外乱トルクの時系列データを抽出する。抽出する外乱トルクのデータ数Ｎｐは、少なくともクランク軸が１回転する周期Ｔｐをサンプリング周期Δｔで除した値以上とする。すなわち、データ数Ｎｐは、Ｔｐ／ΔＡ以上とする。クランク軸が１回転する周期は、クランク軸の回転周波数Ｖｐの逆数として算出する。
【００３４】
次に、ステップＳ５で、クランク軸の回転周波数Ｖｐは、一定期間Ｔｄ内で抽出された最初の速度フィードバック値ｖｏに、クランク軸のｎ回転をモータ出力軸のＮ回転で除した値、すなわち、減速比ｎ／Ｎを乗じることで算出する（Ｖｐ＝ｖｏ×（ｎ／Ｎ））。
【００３５】
必要なデータ数の外乱トルクのデータ配列が用意された後、ステップＳ６で、周波数解析（フーリエ解析）を行い、ステップＳ７で、クランク軸の回転周波数Ｖｐの整数倍（Ｖｐ，２×Ｖｐ３×Ｖｐ，Ｎｐ×Ｖｐ）に対応する周期成分として特定された対象スペクトルの振幅（Ｆ（１），Ｆ（２），Ｆ（３），・・・，Ｆ（Ｎｐ））を求める。
【００３６】
一方、診断の基準となる基準スペクトルは、同様の方法で、減速機が正常（クランク軸が正常）に動作しているときのスペクトル（Ｆ０１，Ｆ０２,Ｆ０３，・・・，Ｆ０Ｎ）にマージン（余裕分）を加えた値をしきい値（Ｌｆ１，Ｌｆ２，Ｌｆ３，・・・，ＬｆＮ）として求める。なお、マージンを小さく設定すれば、異常の予知（故障の兆候）でなく、異常の発見（故障の発見）に使用することができる。
【００３７】
最後に、ステップＳ８で、診断対象スペクトルの振幅と基準スペクトルの振幅とを比較して、例えば、一つでも診断対象スペクトルの振幅が基準スペクトルの振幅を超えた場合を異常とみなし、ステップＳ９でアラーム音を出力する。なお、アラーム音を出力すると同時にロボットを非常停止する機能を加えれば、故障時にロボット５を停止させる装置として使用することができる。
【００３８】
なお、異常診断のための動作プログラムを所定時間Ｔ毎に定期的に起動させて、診断対象スペクトルの増分値を算出し、この増分値を基準となるしきい値と比較して、異常診断をすることもできる。すなわち、（今回のＦ（１）−前回のＦ（１）)／Ｔ，（今回のＦ（２）−前回のＦ（２））／Ｔ，・・・，（今回のＦ（Ｎｐ）−前回のＦ（Ｎｐ））／Ｔを判断に使っても良い。
【００３９】
以上により、本実施形態によれば、クランク軸の異常を外乱推定値を用いて予知することで、ノイズの影響や重力の影響を排除することができ、定量的な判断基準に基づいて、減速機の異常を直接的かつ正確に予知することができる。また、異常診断を定期的に行うことで、クランク軸の交換時期が事前に認識されるため、ロボット５のメンテナンスや復旧などの作業性を大幅に高めることができる。
【００４０】
なお、本発明は上記実施形態に限定されるものではなく、種々変更して実施することができる。本実施形態では、ロボット５に備えられた減速機の異常が診断されているが、工作機械や車両に備えられた減速機の異常を診断することもできる。また、本実施形態では、トルク指令と速度フィードバックから推定された外乱推定値の周波数成分に基づいて減速機の異常が診断されているが、回転運動する一対の動作部材が一定速度で相対回転しているときの速度フィードバックから算出された加速度の周波数成分に基づいて、減速機の異常を診断することもできる。
【００４１】
また、本実施形態では、減速機が異常であると診断された場合はアラーム音を出力するようになっているが、減速機を備えたロボット５のモデルを表示する端末装置４のディスプレイ２２の画面上で、減速機を示す部分のみを強調表示して異常を知らせることも可能である。
【００４２】
また、本実施形態では、キーボートを介して必要な情報を入力することで動作プログラムが起動するようになっているが、減速機を備えたロボット５のモデルを表示するディスプレイ２２の画面上で、減速機を示す部分をポインティングデバイスなどで指定して動作プログラムを起動することもできる。
【図面の簡単な説明】
【００４３】
【図１】本発明に係る減速機異常診断装置の一実施形態を含むシステム構成図である。
【図２】同じく減速機異常診断装置の構成図である。
【図３】同じく減速機異常診断方法の処理の流れを示すフローチャートである。
【図４】図３のステップＳ４の詳細を示す説明図である。
【符号の説明】
【００４４】
２ 減速機異常診断装置
３ 装置本体
４ 端末装置
５ ロボット
１２ 第１の関節部
１４ 第２の関節部
１６ 第３の関節部
２３ オブザーバ
２４ スペクトル特定手段
２５ 診断手段
【技術分野】
【０００１】
本発明は、入力軸と出力軸の中間にあって回転を伝達し、前記入力軸の回転に比例して回転する中間軸要素、例えば、内歯歯車に噛み合う外歯歯車を偏心回転させるためのクランク軸を有する減速機の異常を診断する減速機異常診断方法及び減速機異常診断装置に関するものである。
【背景技術】
【０００２】
減速機異常診断方法として、診断対象部分に取り付けられたセンサの情報に基づいて減速機の異常を診断する方法がある。この診断方法は、非破壊的にロボットや工作機械などの異常の発見を行うことができる点で非常に有効な方法である半面、異常を生じた後の事後的な発見となるため種々の不都合があった。例えば、減速機を直して、ロボットを復旧させるまで非常に多くの時間がかかっていた。また、生産現場において、ロボットなど稼働しているときに異常が発見された場合には、ロボットが復旧するまで生産ラインを停止させなければならなかった。
【０００３】
そこで、事前に異常を予知することで、上記問題を回避することができる異常診断方法の一例として、特許文献１に開示されている方法が知られている。この発見方法は、ロボットの自由端に設けた振動センサによって診断対象となる関節部の振動パターンを検出し、検出された振動パターンを正常なロボットの振動パターンと比較し、その比較結果を判断することで関節部の異常を事前に予知するものである。関節部の異常は、軸受や歯車や減速機の摩耗劣化などによる異常である。関節部の異常は、異常時と正常時の振動波形の周波数成分の平均値、ピーク値などを比較することによって診断されるようになっている。
【０００４】
【特許文献１】特開平５−５２７１２号公報
【発明の開示】
【発明が解決しようとする課題】
【０００５】
上記従来の方法では、センサにより検出された信号には種々のノイズが含まれているため、関節部の診断に有効とされる信号のみが直接的に抽出されず、検出された信号から異常の発生を正確に予知することができない心配があった。言い換えると、従来の方法は、センサにより検出された信号の周波数成分と正常時の周波数成分との差が大きければ故障間近とするものであるが、診断検出信号にノイズなどが含まれている場合には、関節部の異常を反映させる信号とノイズとが混ざった状態となり、関節部の異常時と正常時の違いを明確に区別できない恐れがあった。
【０００６】
また、センサにより検出された信号は重力の影響を受けて変化するため、関節部の位置・姿勢によっては、検出された信号の大きさが一定せず、診断結果の信頼性が損なわれるという問題があった。
【０００７】
また、ロボットや工作機械などに異常を検出するためのセンサを取り付ける必要があり、センサ購入費用の分だけ余計にコストがかかるという問題があった。
【０００８】
本発明は、定量的な判断基準を導入することで、異常の診断を正確に行うことができ、これにより機械の稼働率を高めて生産性を向上することができる減速機異常診断方法及び減速機異常診断装置を提供することを目的とする。
【課題を解決するための手段】
【０００９】
上記問題を解決するため、本発明の請求項１の発明は、入力軸と出力軸の中間にあって回転を伝達し、前記入力軸の回転に比例して回転する中間軸要素を有する減速機の異常を診断する減速機異常診断方法において、モータを駆動源として相対的に回転運動する一対の被駆動部材が一定速度で相対回転しているときに取得されたトルク指令と速度フィードバックとに基づいて、前記減速機に関する外乱推定値をオブザーバにより推定し、周波数解析により得られた前記外乱推定値の周波数成分から前記中間軸要素の回転周波数の定数倍に対応する特定スペクトルを抽出し、該特定スペクトルの振幅としきい値とを比較し、前記特定スペクトルの振幅が前記しきい値を超えた場合を異常と診断し、前記特定スペクトルの振幅が前記しきい値と同程度ないしそれより小さい場合を正常と診断することを特徴とする。
【００１０】
請求項２の発明は、入力軸と出力軸の中間にあって回転を伝達し、前記入力軸の回転に比例して回転する中間軸要素を有する減速機の異常を診断する減速機異常診断方法において、モータを駆動源として相対的に回転運動する一対の被駆動部材が一定速度で相対回転しているときに取得された速度フィードバックに基づいて加速度を算出し、周波数解析により得られた前記加速度の周波数成分から前記中間軸要素の回転周波数の定数倍に対応する特定スペクトルを抽出し、該特定スペクトルの振幅としきい値とを比較し、前記特定スペクトルの振幅が前記しきい値を超えた場合を異常と診断し、前記特定スペクトルの振幅が前記しきい値と同程度ないしそれより小さい場合を正常と診断することを特徴とする。
【００１１】
請求項３の発明は、請求項１又は２に記載の減速機異常診断方法において、前記しきい値は、前記中間軸要素が正常であるときに、周波数解析により得られた前記外乱推定値又は前記加速度の周波数成分から前記中間軸要素の回転周波数の定数倍に対応して抽出されたスペクトルの振幅に相当する。
【００１２】
請求項４の発明は、請求項１〜３の何れか１項に記載の減速機異常診断方法において、前記特定スペクトルの振幅が前記しきい値を超えたとき、前記減速機が異常である情報を外部に出力する。
【００１３】
請求項５の発明は、請求項４に記載の減速機異常診断方法において、前記減速機を備えたロボットのモデルを表示する表示装置の画面上で、前記減速機を示す部分のみを強調表示して異常を知らせる。
【００１４】
請求項６の発明は、請求項１〜５のいずれか１項に記載の減速機異常診断方法において、前記減速機の異常を診断する際に、前記減速機を備えたロボットのモデルを表示する表示装置の画面上で、前記減速機を示す部分を指定して異常の診断を開始する。
【００１５】
請求項７の発明は、入力軸と出力軸の中間にあって回転を伝達し、前記入力軸の回転に比例して回転する中間軸要素を有する減速機の異常を診断する減速機異常診断装置において、モータを駆動源として相対的に回転運動する一対の被駆動部材が一定速度で相対回転しているときに取得されたトルク指令と速度フィードバックとに基づいて、前記減速機の入力側で前記減速機に関する外乱推定値を推定するオブザーバと、前記外乱推定値の周波数成分から前記中間軸要素の回転周波数の定数倍に対応する特定スペクトルを抽出するスペクトル特定手段と、前記スペクトル特定手段により特定された前記特定スペクトルの振幅としきい値とを比較し、前記特定スペクトルの振幅が前記しきい値を超えた場合を異常と診断し、前記特定スペクトルの振幅が前記しきい値と同程度ないしそれより小さい場合を正常と診断する診断手段と、を備えることを特徴とする。
【発明の効果】
【００１６】
本願の請求項１又は７記載の発明によれば、減速機の動作状態を反映させる外乱推定値を用いて診断することで、ノイズがデータに含まれることを排除することができ、これにより、減速機の異常を直接的かつ正確に診断することができる。また、外乱推定値はオブザーバにより推定されるから、重力の影響を含まないデータを取得することができ、これにより、ロボットや工作機械などの位置・姿勢に影響されずに、減速機の異常を正確に診断することができる。中間軸要素の回転周波数の定数倍に対応する周波数で外乱推定値の特定スペクトルを抽出することで、減速機の異常を診断するための最適なスペクトルをサンプリングすることができる。したがって、定量的な判断基準に基づいて、減速機の異常の診断を正確に実施することができる。これにより、機械の稼働率を高めて生産性を向上することができる。
【００１７】
請求項２記載の発明によれば、減速機の動作状態を反映させる加速度を用いることによっても、減速機の異常を正確に診断することができる。したがって、請求項１記載の発明と同様の効果を奏し、定量的な判断基準に基づいて、減速機の異常の診断を正確に行うことができる。
【００１８】
請求項３記載の発明によれば、特定スペクトルの振幅がしきい値と同程度ないしはそれより小さいときは、減速機が正常であると診断することができる。逆に、特定スペクトルの振幅がしきい値を超えるときは、減速機が異常であると判断することができる。
【００１９】
請求項４記載の発明によれば、アラームライトやアラーム音などにより、減速機が異常である情報を外部に出力することで、工場の作業者等が減速機の異常を認識することができる。
【００２０】
請求項５記載の発明によれば、減速機の異常を視覚的に認識することができ、作業性が向上する。また、請求項６記載の発明によれば、表示装置の画面上で減速機を示す部分を指定することで異常の診断を開始することができるから、ロボットに対して減速機の異常診断を容易に開始することができる。
【発明を実施するための最良の形態】
【００２１】
以下に本発明の実施の形態の具体例を図面を用いて詳細に説明する。図１は、本発明に係る減速機異常診断装置の一実施形態を含むシステム構成図である。減速機異常診断装置２は、入力軸としてのクランク軸の故障などの異常を図示しない減速機の異常と擬制する診断装置であり、ロボット５を制御する装置本体３と、装置本体３との間で信号の送受信を行う端末装置４とから構成されている。この減速機異常診断装置２と、モータと一体の減速機を備えたロボット５とから減速機異常診断システム１が構成されている。ロボット５と装置本体３は動力線７と信号線８を介して電気的に相互接続し、装置本体３と端末装置４はＬＡＮケーブル９を介して電気的に相互接続している。以下において、各構成要素について説明する。
【００２２】
ロボット５は、嵌合部品の嵌合作業を行うために用いられる一般的なものであり、ベース１０と、ベース１０に続く胴体部１１と、第１の関節部１２を介して胴体部１１に続く上腕部１３と、第２の関節部１４を介して上腕部１３に続く前腕部１５と、第３の関節部１６を介して前腕部１５に続く手首要素１７と、手首要素２７に続くハンドツール１８とからなっている。ハンドツール１８は、相対向する一対の把持爪１９ａ，１９ｂを備えており、この一対の把持爪１９ａ，１９ｂの間でワーク２０が把持されるようになっている。
【００２３】
第１，２，３の関節部１２，１４，１６は、各関節部を介して隣接する動作部材（被駆動部材）を相対的に回転動作させる部分であり、減速機を有するモータを備えている。モータの回転は減速機で減速され、隣接する動作部材が相対的に回転動作するようになっている。動作部材とは、上腕部１３、前腕部１５、手首要素１７に相当する。減速機は、一般的なものであり、筒壁に固定して設けられた内歯歯車と、この内歯歯車に噛み合う外歯歯車と、外歯歯車に嵌合して外歯歯車を偏心回転させるクランク軸（中間軸要素）とを備えている。クランク軸は、モータの出力軸に連結されている。内歯歯車は、外歯歯車より歯数が一つだけ多くなっている。このため、外歯歯車がクランク軸と共に１回転することで、内歯歯車が１ピッチ分だけ反対方向に回転する。したがって、この減速機構では、少なくとも外歯歯車の歯数の逆数を減速比として入力回転を減速するようになっている。
【００２４】
ロボット５にケーブル９を介して接続する装置本体３は、従来と同様の構成であり、図示しないプロセッサ、ＲＯＭ、ＲＡＭ、不揮発性メモリ、各種インターファース、送信制御回路や受信制御回路などで構成されたデジタルサーボ回路を備えている。各種メモリ、各種インターフェース、デジタルサーボ回路は、システムバスを介してプロセッサに接続している。デジタルサーボ回路は、サーボモータを帰還データに基づいて、位置ループ制御、速度ループ制御すると共に、トランジスタインバータ等のサーボアンプからの電流フィードバック信号に基づいて電流ループ制御する回路である。インターフェースには、センサや、ディスプレイモニタや、ＣＣＤカメラなどを接続することができる。
【００２５】
端末装置４は、本体２１と、ディスプレイ２２とを備えたパーソナルコンピュータに相当するものであり、外乱推定値を推定するオブザーバ２３と、外乱推定値の周波数成分からクランク軸の回転周波数の定数倍に対応する特定スペクトルを抽出するスペクトル特定手段２４と、特定スペクトルの振幅とクランク軸が正常であるときの振幅に基づいたしきい値とを比較し判断する診断手段２５とを備えている。
【００２６】
本体２１にはシステムプログラムや動作プログラムなどが記憶されていて、マニュアル操作の場合は、オペレータが図示しないキーボートを介して必要な情報を入力することで異常診断動作プログラムが起動し、オブザーバ２３、スペクトル特定手段２４、診断手段２５がそれぞれ機能するようになっている。
【００２７】
オブザーバ２３は、モータにより相対的に回転運動する一対の動作部材が一定速度（一定周期）で相対回転しているときに取得されたトルク指令と速度フィードバックとに基づいて、減速機に関する外乱トルク（外乱推定値）を推定するためのものである。
【００２８】
スペクトル特定手段２４は、外乱トルクの時系列データを周波数解析することによって得られた周波数成分から、一対の動作部材が一定速度で相対回転しているときのクランク軸の回転周波数の定数倍に対応する特定された対象スペクトル（特定スペクトル）を抽出するものである。
【００２９】
診断手段２５は、クランク軸が正常に動作しているときの外乱トルクを周波数解析することによって得られるしきい値としての基準スペクトｓルと、スペクトル特定手段により特定された対象スペクトルとを比較し、総合的又は選択的に対象スペクトルの振幅が基準スペクトルを超えた場合を異常と診断し、診断対象スペクトルの振幅が基準スペクトルの振幅と同程度ないしそれより小さい場合を正常と診断するものである。
【００３０】
次に、図１に示すロボット５を対象とし、図３のフローチャートに基づき、減速機の異常診断方法をフローチャートに従って説明する。図１に示すロボット５は、３軸の回転軸を有するロボットであるが、説明の都合上、任意の軸の関節部に注目して異常診断の説明をすることとする。
【００３１】
診断対象となる減速機は、前段及び後段減速機構を備え、前段減速機構によりモータ出力軸のＮ回転をクランク軸のｎ回転に減速し、さらに、後段減速機構によりクランク軸のｎ回転を出力側（内歯歯車側）の１回転に減速するものとする。すなわち、この減速機は、モータの回転数を１／Ｎの減速比で減速するものとする。
【００３２】
ステップＳ１では、端末装置４は装置本体３から所定のサンプリング周期Δｔ毎に速度フィードバック値及びトルク指令値を受信する。ステップＳ２では、オブザーバ２３により、受信された速度フィードバック値及びトルク指令値からクランク軸の回転周期と同期する周期成分を含む外乱トルクを推定する。ステップＳ３では、速度フィードバック値、トルク指令値、推定された外乱トルクは、時系列データとして記憶する。
【００３３】
次に、ステップＳ４で、速度フィードバック値ｖがしきい値Ｌｖより大きく、かつ、関節部が一定速度で相対回転しているときの対象データを抽出する。図４には、対象データ抽出ルーチンを詳細に示す図を示す。図示するように、先ず、速度フィードバック値から加速度ａを算出する。この加速度ａが、予め設定されたしきい値Ｌａ内に、一定のサンプリング期間Ｔｄ以上に亘って連続して収まっているときを、関節部が一定速度で相対回転しているときとみなし、この一定期間Ｔｄ内の外乱トルクの時系列データを抽出する。抽出する外乱トルクのデータ数Ｎｐは、少なくともクランク軸が１回転する周期Ｔｐをサンプリング周期Δｔで除した値以上とする。すなわち、データ数Ｎｐは、Ｔｐ／ΔＡ以上とする。クランク軸が１回転する周期は、クランク軸の回転周波数Ｖｐの逆数として算出する。
【００３４】
次に、ステップＳ５で、クランク軸の回転周波数Ｖｐは、一定期間Ｔｄ内で抽出された最初の速度フィードバック値ｖｏに、クランク軸のｎ回転をモータ出力軸のＮ回転で除した値、すなわち、減速比ｎ／Ｎを乗じることで算出する（Ｖｐ＝ｖｏ×（ｎ／Ｎ））。
【００３５】
必要なデータ数の外乱トルクのデータ配列が用意された後、ステップＳ６で、周波数解析（フーリエ解析）を行い、ステップＳ７で、クランク軸の回転周波数Ｖｐの整数倍（Ｖｐ，２×Ｖｐ３×Ｖｐ，Ｎｐ×Ｖｐ）に対応する周期成分として特定された対象スペクトルの振幅（Ｆ（１），Ｆ（２），Ｆ（３），・・・，Ｆ（Ｎｐ））を求める。
【００３６】
一方、診断の基準となる基準スペクトルは、同様の方法で、減速機が正常（クランク軸が正常）に動作しているときのスペクトル（Ｆ０１，Ｆ０２,Ｆ０３，・・・，Ｆ０Ｎ）にマージン（余裕分）を加えた値をしきい値（Ｌｆ１，Ｌｆ２，Ｌｆ３，・・・，ＬｆＮ）として求める。なお、マージンを小さく設定すれば、異常の予知（故障の兆候）でなく、異常の発見（故障の発見）に使用することができる。
【００３７】
最後に、ステップＳ８で、診断対象スペクトルの振幅と基準スペクトルの振幅とを比較して、例えば、一つでも診断対象スペクトルの振幅が基準スペクトルの振幅を超えた場合を異常とみなし、ステップＳ９でアラーム音を出力する。なお、アラーム音を出力すると同時にロボットを非常停止する機能を加えれば、故障時にロボット５を停止させる装置として使用することができる。
【００３８】
なお、異常診断のための動作プログラムを所定時間Ｔ毎に定期的に起動させて、診断対象スペクトルの増分値を算出し、この増分値を基準となるしきい値と比較して、異常診断をすることもできる。すなわち、（今回のＦ（１）−前回のＦ（１）)／Ｔ，（今回のＦ（２）−前回のＦ（２））／Ｔ，・・・，（今回のＦ（Ｎｐ）−前回のＦ（Ｎｐ））／Ｔを判断に使っても良い。
【００３９】
以上により、本実施形態によれば、クランク軸の異常を外乱推定値を用いて予知することで、ノイズの影響や重力の影響を排除することができ、定量的な判断基準に基づいて、減速機の異常を直接的かつ正確に予知することができる。また、異常診断を定期的に行うことで、クランク軸の交換時期が事前に認識されるため、ロボット５のメンテナンスや復旧などの作業性を大幅に高めることができる。
【００４０】
なお、本発明は上記実施形態に限定されるものではなく、種々変更して実施することができる。本実施形態では、ロボット５に備えられた減速機の異常が診断されているが、工作機械や車両に備えられた減速機の異常を診断することもできる。また、本実施形態では、トルク指令と速度フィードバックから推定された外乱推定値の周波数成分に基づいて減速機の異常が診断されているが、回転運動する一対の動作部材が一定速度で相対回転しているときの速度フィードバックから算出された加速度の周波数成分に基づいて、減速機の異常を診断することもできる。
【００４１】
また、本実施形態では、減速機が異常であると診断された場合はアラーム音を出力するようになっているが、減速機を備えたロボット５のモデルを表示する端末装置４のディスプレイ２２の画面上で、減速機を示す部分のみを強調表示して異常を知らせることも可能である。
【００４２】
また、本実施形態では、キーボートを介して必要な情報を入力することで動作プログラムが起動するようになっているが、減速機を備えたロボット５のモデルを表示するディスプレイ２２の画面上で、減速機を示す部分をポインティングデバイスなどで指定して動作プログラムを起動することもできる。
【図面の簡単な説明】
【００４３】
【図１】本発明に係る減速機異常診断装置の一実施形態を含むシステム構成図である。
【図２】同じく減速機異常診断装置の構成図である。
【図３】同じく減速機異常診断方法の処理の流れを示すフローチャートである。
【図４】図３のステップＳ４の詳細を示す説明図である。
【符号の説明】
【００４４】
２ 減速機異常診断装置
３ 装置本体
４ 端末装置
５ ロボット
１２ 第１の関節部
１４ 第２の関節部
１６ 第３の関節部
２３ オブザーバ
２４ スペクトル特定手段
２５ 診断手段
【特許請求の範囲】
【請求項１】
入力軸と出力軸の中間にあって回転を伝達し、前記入力軸の回転に比例して回転する中間軸要素を有する減速機の異常を診断する減速機異常診断方法において、
モータを駆動源として相対的に回転運動する一対の被駆動部材が一定速度で相対回転しているときに取得されたトルク指令と速度フィードバックとに基づいて、前記減速機に関する外乱推定値をオブザーバにより推定し、
周波数解析により得られた前記外乱推定値の周波数成分から前記中間軸要素の回転周波数の定数倍に対応する特定スペクトルを抽出し、
該特定スペクトルの振幅としきい値とを比較し、
前記特定スペクトルの振幅が前記しきい値を超えた場合を異常と診断し、前記特定スペクトルの振幅が前記しきい値と同程度ないしそれより小さい場合を正常と診断する、減速機異常診断方法。
【請求項２】
入力軸と出力軸の中間にあって回転を伝達し、前記入力軸の回転に比例して回転する中間軸要素を有する減速機の異常を診断する減速機異常診断方法において、
モータを駆動源として相対的に回転運動する一対の被駆動部材が一定速度で相対回転しているときに取得された速度フィードバックに基づいて加速度を算出し、
周波数解析により得られた前記加速度の周波数成分から前記中間軸要素の回転周波数の定数倍に対応する特定スペクトルを抽出し、
該特定スペクトルの振幅としきい値とを比較し、
前記特定スペクトルの振幅が前記しきい値を超えた場合を異常と診断し、前記特定スペクトルの振幅が前記しきい値と同程度ないしそれより小さい場合を正常と診断する、減速機異常診断方法。
【請求項３】
前記しきい値は、前記中間軸要素が正常であるときに、周波数解析により得られた前記外乱推定値又は前記加速度の周波数成分から前記中間軸要素の回転周波数の定数倍に対応して抽出されたスペクトルの振幅に相当する請求項１又は２に記載の減速機異常診断方法。
【請求項４】
前記特定スペクトルの振幅が前記しきい値を超えたとき、前記減速機が異常である情報を外部に出力する請求項１〜３の何れか１項に記載の減速機異常診断方法。
【請求項５】
前記減速機を備えたロボットのモデルを表示する表示装置の画面上で、前記減速機を示す部分のみを強調表示して異常を知らせる請求項４に記載の減速機異常診断方法。
【請求項６】
前記減速機の異常を診断する際に、前記減速機を備えたロボットのモデルを表示する表示装置の画面上で、前記減速機を示す部分を指定して異常の診断を開始する請求項１〜５のいずれか１項に記載の減速機異常診断方法。
【請求項７】
入力軸と出力軸の中間にあって回転を伝達し、前記入力軸の回転に比例して回転する中間軸要素を有する減速機の異常を診断する減速機異常診断装置において、
モータを駆動源として相対的に回転運動する一対の被駆動部材が一定速度で相対回転しているときに取得されたトルク指令と速度フィードバックとに基づいて、前記減速機の入力側で前記減速機に関する外乱推定値を推定するオブザーバと、
前記外乱推定値の周波数成分から前記中間軸要素の回転周波数の定数倍に対応する特定スペクトルを抽出するスペクトル特定手段と、
前記スペクトル特定手段により特定された前記特定スペクトルの振幅としきい値とを比較し、前記特定スペクトルの振幅が前記しきい値を超えた場合を異常と診断し、前記特定スペクトルの振幅が前記しきい値と同程度ないしそれより小さい場合を正常と診断する診断手段と、
を備える減速機異常診断装置。
【請求項１】
入力軸と出力軸の中間にあって回転を伝達し、前記入力軸の回転に比例して回転する中間軸要素を有する減速機の異常を診断する減速機異常診断方法において、
モータを駆動源として相対的に回転運動する一対の被駆動部材が一定速度で相対回転しているときに取得されたトルク指令と速度フィードバックとに基づいて、前記減速機に関する外乱推定値をオブザーバにより推定し、
周波数解析により得られた前記外乱推定値の周波数成分から前記中間軸要素の回転周波数の定数倍に対応する特定スペクトルを抽出し、
該特定スペクトルの振幅としきい値とを比較し、
前記特定スペクトルの振幅が前記しきい値を超えた場合を異常と診断し、前記特定スペクトルの振幅が前記しきい値と同程度ないしそれより小さい場合を正常と診断する、減速機異常診断方法。
【請求項２】
入力軸と出力軸の中間にあって回転を伝達し、前記入力軸の回転に比例して回転する中間軸要素を有する減速機の異常を診断する減速機異常診断方法において、
モータを駆動源として相対的に回転運動する一対の被駆動部材が一定速度で相対回転しているときに取得された速度フィードバックに基づいて加速度を算出し、
周波数解析により得られた前記加速度の周波数成分から前記中間軸要素の回転周波数の定数倍に対応する特定スペクトルを抽出し、
該特定スペクトルの振幅としきい値とを比較し、
前記特定スペクトルの振幅が前記しきい値を超えた場合を異常と診断し、前記特定スペクトルの振幅が前記しきい値と同程度ないしそれより小さい場合を正常と診断する、減速機異常診断方法。
【請求項３】
前記しきい値は、前記中間軸要素が正常であるときに、周波数解析により得られた前記外乱推定値又は前記加速度の周波数成分から前記中間軸要素の回転周波数の定数倍に対応して抽出されたスペクトルの振幅に相当する請求項１又は２に記載の減速機異常診断方法。
【請求項４】
前記特定スペクトルの振幅が前記しきい値を超えたとき、前記減速機が異常である情報を外部に出力する請求項１〜３の何れか１項に記載の減速機異常診断方法。
【請求項５】
前記減速機を備えたロボットのモデルを表示する表示装置の画面上で、前記減速機を示す部分のみを強調表示して異常を知らせる請求項４に記載の減速機異常診断方法。
【請求項６】
前記減速機の異常を診断する際に、前記減速機を備えたロボットのモデルを表示する表示装置の画面上で、前記減速機を示す部分を指定して異常の診断を開始する請求項１〜５のいずれか１項に記載の減速機異常診断方法。
【請求項７】
入力軸と出力軸の中間にあって回転を伝達し、前記入力軸の回転に比例して回転する中間軸要素を有する減速機の異常を診断する減速機異常診断装置において、
モータを駆動源として相対的に回転運動する一対の被駆動部材が一定速度で相対回転しているときに取得されたトルク指令と速度フィードバックとに基づいて、前記減速機の入力側で前記減速機に関する外乱推定値を推定するオブザーバと、
前記外乱推定値の周波数成分から前記中間軸要素の回転周波数の定数倍に対応する特定スペクトルを抽出するスペクトル特定手段と、
前記スペクトル特定手段により特定された前記特定スペクトルの振幅としきい値とを比較し、前記特定スペクトルの振幅が前記しきい値を超えた場合を異常と診断し、前記特定スペクトルの振幅が前記しきい値と同程度ないしそれより小さい場合を正常と診断する診断手段と、
を備える減速機異常診断装置。
【図１】
【図２】
【図３】
【図４】
【図２】
【図３】
【図４】
【公開番号】特開２００８−３２４７７（Ｐ２００８−３２４７７Ａ）
【公開日】平成２０年２月１４日（２００８．２．１４）
【国際特許分類】
【出願番号】特願２００６−２０４８８６（Ｐ２００６−２０４８８６）
【出願日】平成１８年７月２７日（２００６．７．２７）
【出願人】（３９０００８２３５）ファナック株式会社 (1,110)
【Ｆターム（参考）】
【公開日】平成２０年２月１４日（２００８．２．１４）
【国際特許分類】
【出願日】平成１８年７月２７日（２００６．７．２７）
【出願人】（３９０００８２３５）ファナック株式会社 (1,110)
【Ｆターム（参考）】
[ Back to top ]