JP2010107361A - Abrasion detection device of gear - Google Patents

Abrasion detection device of gear Download PDF

Info

Publication number
JP2010107361A
JP2010107361A JP2008279785A JP2008279785A JP2010107361A JP 2010107361 A JP2010107361 A JP 2010107361A JP 2008279785 A JP2008279785 A JP 2008279785A JP 2008279785 A JP2008279785 A JP 2008279785A JP 2010107361 A JP2010107361 A JP 2010107361A
Authority
JP
Japan
Prior art keywords
angle
command signal
rotation
wear
gear
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
JP2008279785A
Other languages
Japanese (ja)
Other versions
JP5195292B2 (en
Inventor
Hiroshi Yamaguchi
博司 山口
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.)
Denso Wave Inc
Original Assignee
Denso Wave Inc
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 Denso Wave Inc filed Critical Denso Wave Inc
Priority to JP2008279785A priority Critical patent/JP5195292B2/en
Publication of JP2010107361A publication Critical patent/JP2010107361A/en
Application granted granted Critical
Publication of JP5195292B2 publication Critical patent/JP5195292B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Measurement Of Length, Angles, Or The Like Using Electric Or Magnetic Means (AREA)

Abstract

<P>PROBLEM TO BE SOLVED: To detect abrasion of a gear more accurately by utilizing a control system of a motor. <P>SOLUTION: In this abrasion detection device of a gear, when a motor connected directly to either gear of a pair of mutually-mating gears is driven rotatively as much as a command angle by a control means, an actual rotation angle of the motor is detected by a rotation sensor, and the command angle is compared with the detected angle, and if the command angle is larger than the detected angle and the detected angle is smaller than a threshold angle determined beforehand, it is determined that the gear is not abraded, and if the command angle is larger than the detected angle and the detected angle is larger than the threshold angle determined beforehand, it is determined that the gear is abraded. <P>COPYRIGHT: (C)2010,JPO&INPIT

Description

本発明は歯車を駆動するモータを僅か回転させることによって歯車の摩耗を検出する構成の歯車の摩耗検出装置に関する。   The present invention relates to a gear wear detection apparatus configured to detect gear wear by slightly rotating a motor that drives the gear.

互いに噛み合う一対の歯車の摩耗を検出する方法として、特許文献1,2に開示された方法がある。特許文献1の方法は、歯車を駆動するモータの電流値を積分してその積分値の中から最大負荷量を選択し、この最大負荷量と、1サイクルでの歯車の噛み合い回数と、所定時間内のサイクル回数とを歯車磨耗量を求める式に代入して摩耗量を算出するというものである。   As a method for detecting wear of a pair of gears meshing with each other, there are methods disclosed in Patent Documents 1 and 2. In the method of Patent Document 1, the current value of the motor that drives the gear is integrated, and the maximum load amount is selected from the integrated value. The maximum load amount, the number of meshing of the gear in one cycle, and a predetermined time. The amount of wear is calculated by substituting the number of cycles in the equation for determining the amount of gear wear.

特許文献2の方法は、アーム先端のツールの位置座標データとアームの姿勢データとツールおよびアームの重量データから歯車の角度関数や角加速度関数などを算出すると共に、1サイクル中の歯車の歯面の噛み合い回数する。また、データ入力部から入力されるデータに基づいて、サイクル時間をパラメータとする負荷トルク関数と負荷慣性モーメント関数とを算出し、角加速度センサとから1サイクル中の歯車の負荷変動を導く。そして、噛合い回数と負荷変動から最大負荷を算出し、歯車摩耗量を算出するというものである。
特開平7−100782号公報 特開平9−136287号公報
The method of Patent Document 2 calculates a gear angle function, an angular acceleration function, and the like from the position coordinate data of the tool at the tip of the arm, the posture data of the arm, and the weight data of the tool and the arm, and the tooth surface of the gear in one cycle. The number of times of meshing. Also, based on data input from the data input unit, a load torque function and a load moment of inertia function using the cycle time as parameters are calculated, and the load variation of the gear during one cycle is derived from the angular acceleration sensor. Then, the maximum load is calculated from the number of meshes and the load variation, and the gear wear amount is calculated.
Japanese Patent Application Laid-Open No. 7-100782 JP-A-9-136287

特許文献1,2の摩耗量検出方法では、新たなセンセを付加することなく、モータを制御するための制御系を利用して歯車の摩耗量を検出することができる。しかしながら、これらの方法は、負荷量や歯面の噛み合い回数などから歯車の摩耗を計算する方法であって、摩耗量を直接的に検出するものではないため、正確性の点で問題がある。   In the wear amount detection methods of Patent Documents 1 and 2, the wear amount of the gear can be detected using a control system for controlling the motor without adding a new sense. However, these methods are methods for calculating the wear of the gear from the load amount and the number of meshing of the tooth surfaces, and do not directly detect the wear amount.

本発明は上記の事情に鑑みてなされたもので、その目的は、新たなセンサを付加することなく、モータの制御系を利用して歯車の摩耗をより正確に検出することができる歯車の摩耗検出装置を提供することにある。   The present invention has been made in view of the above circumstances, and its object is to wear gears that can more accurately detect gear wear using a motor control system without adding a new sensor. It is to provide a detection device.

請求項1では、互いに噛み合う一対の歯車のうちの一方の歯車に直結されたモータが制御手段によって指令角度だけ回転駆動されたとき、当該モータの実際の回転角度を回転センサによって検出し、それら指令角度と検出角度とを比較して、指令角度が検出角度よりも大きく、且つ、検出角度が予め定められた閾値角度以下とされたとき、摩耗なしと判定し、指令角度が検出角度よりも大きく、且つ、検出角度が予め定められた閾値角度を超えているとされたとき、摩耗ありと判定するので、新たなセンサを付加することなく、モータの制御系を利用して歯車の摩耗の有無を検出することができる。   In claim 1, when a motor directly connected to one of a pair of gears meshing with each other is driven to rotate by a command angle by the control means, an actual rotation angle of the motor is detected by a rotation sensor, and the command When the command angle is greater than the detection angle and the detection angle is less than or equal to a predetermined threshold angle, it is determined that there is no wear, and the command angle is greater than the detection angle. And, when the detected angle exceeds a predetermined threshold angle, it is determined that there is wear, so there is no wear of gears using the motor control system without adding a new sensor. Can be detected.

請求項2では、モータを正方向および逆方向に同じ角度だけ回転させる正回転指令信号および逆回転指令信号を出力することを、正回転指令信号に対する回転センサの検出角度と逆回転指令信号に対する回転センサの検出角度との差が所定値内となるまで繰り返すので、一方の歯車の1枚の歯が、他方の歯車の2枚の歯の間の中央に位置するように、当該他方の歯車を動かすことができる。したがって、請求項1の磨耗有り無しの計測を、歯の偏りのない状態で行い得るようになるので、計測の正確性が増す。   According to a second aspect of the present invention, the output of the forward rotation command signal and the reverse rotation command signal for rotating the motor in the forward direction and the reverse direction by the same angle means that the detected angle of the rotation sensor with respect to the forward rotation command signal and the rotation with respect to the reverse rotation command signal. Since it repeats until the difference with the detection angle of the sensor is within a predetermined value, the other gear is set so that one tooth of one gear is located at the center between the two teeth of the other gear. Can move. Therefore, the measurement with and without wear according to claim 1 can be performed in a state where there is no bias in the teeth, so that the accuracy of the measurement is increased.

請求項3では、モータの正回転および逆回転のそれぞれに対して、回転センサが所定時間継続して同じ角度を検出するか否かを判断し、所定時間継続して同じ角度を検出しないときには、モータを、前回よりも大きい角度だけ正逆回転させるので、摩耗があっても、その摩耗量が大きくても、一方の歯車の1枚の歯が、他方の歯車の2枚の歯の間の中央に位置するように、他方の歯車を動かすことができる。   In claim 3, for each of the forward rotation and reverse rotation of the motor, it is determined whether or not the rotation sensor continuously detects the same angle for a predetermined time, and when the same angle is not detected for a predetermined time continuously, Since the motor is rotated forward and backward by an angle larger than the previous time, even if there is wear or the wear amount is large, one tooth of one gear is between two teeth of the other gear. The other gear can be moved to be centered.

請求項4では、正回転指令信号または逆回転指令信号に対して、回転センサが所定時間継続して同じ角度を検出するとき、正回転指令信号および逆回転指令信号に応じた指令角度と正回転指令信号および逆回転指令信号に対する回転センサの検出角度を比較するので、一方の歯車の1枚の歯が他方の歯車の2枚の歯の間の中央に位置する状態から、回転指令信号によって正逆回転する状態が得られ、摩耗の有無をより正確に検出できる。更に、請求項4では、摩耗量を角度で量的に検出することが可能となる。   In claim 4, when the rotation sensor detects the same angle continuously for a predetermined time with respect to the normal rotation command signal or the reverse rotation command signal, the command angle and the normal rotation according to the normal rotation command signal and the reverse rotation command signal Since the detection angle of the rotation sensor with respect to the command signal and the reverse rotation command signal is compared, from the state where one tooth of one gear is located at the center between the two teeth of the other gear, the rotation command signal A reverse rotating state is obtained, and the presence or absence of wear can be detected more accurately. Furthermore, in claim 4, it becomes possible to detect the amount of wear quantitatively by angle.

請求項5では、判定手段が摩耗ありと判定したとき、回転センサの検出角度から摩耗量を演算するので、どの程度摩耗したのかを具体的に知ることができる。   According to the fifth aspect, when the determination means determines that there is wear, the wear amount is calculated from the detection angle of the rotation sensor, so that it is possible to specifically know how much wear has occurred.

以下、本発明をロボットのアーム駆動装置における歯車減速装置に適用した一実施形態につき図面を参照しながら説明する。例えば、垂直多関節型ロボットでは、各アームは、互いに回転関節によって連結されている。そして、各アームは、アーム駆動装置によって回転駆動される。
図2は、アーム駆動装置1の一例を示しており、例えば、駆動対象アームの前段のアーム2内に配設されている。このアーム駆動装置1は、モータ3を駆動源とする歯車減速装置4を主体とするもので、入力軸としてのモータ3の回転軸5、中間軸6および出力軸7を備え、入力軸4に取着された小歯車8、中間軸6に取着された大歯車9、同じく中間軸6に取着された小歯車10、出力軸7に取着された大歯車11から構成されている。
Hereinafter, an embodiment in which the present invention is applied to a gear reduction device in an arm drive device of a robot will be described with reference to the drawings. For example, in a vertical articulated robot, the arms are connected to each other by a rotating joint. Each arm is rotationally driven by an arm driving device.
FIG. 2 shows an example of the arm drive device 1, which is disposed, for example, in the arm 2 at the front stage of the arm to be driven. The arm drive device 1 is mainly composed of a gear reduction device 4 having a motor 3 as a drive source, and includes a rotation shaft 5, an intermediate shaft 6 and an output shaft 7 of the motor 3 as input shafts. The small gear 8 is attached, the large gear 9 is attached to the intermediate shaft 6, the small gear 10 is attached to the intermediate shaft 6, and the large gear 11 is attached to the output shaft 7.

これら歯車8〜11のうち、回転軸5の小歯車8と中間軸6の大歯車9が噛合し、中間軸6の小歯車10と出力軸7の大歯車11が噛合している。したがって、回転軸5の回転は、1組の小歯車8と大歯車9によって減速されて中間軸6に伝えられ、この中間軸6の回転が更に別の1組の小歯車10と大歯車11によって減速されて出力軸7に伝えられる。そして、この出力軸7の回転によって次段のアーム(図示せず)が回転駆動される。   Among these gears 8 to 11, the small gear 8 of the rotary shaft 5 and the large gear 9 of the intermediate shaft 6 are engaged, and the small gear 10 of the intermediate shaft 6 and the large gear 11 of the output shaft 7 are engaged. Accordingly, the rotation of the rotary shaft 5 is decelerated by the pair of small gears 8 and the large gear 9 and transmitted to the intermediate shaft 6, and the rotation of the intermediate shaft 6 is further separated into another set of the small gear 10 and the large gear 11. And is transmitted to the output shaft 7. The next stage arm (not shown) is rotationally driven by the rotation of the output shaft 7.

図1はモータ3の制御系を示すブロック図である。この図1に示すように、制御装置12は、CPU13、駆動回路(駆動手段)14、位置検出回路(位置検出手段)15を備えている。そして、CPU13には、ロボット全体のシステムプログラムなどを記憶したROM16、RAM17、操作盤18、パーソナルコンピュータ19を接続するためのインターフェース20が接続されている。   FIG. 1 is a block diagram showing a control system of the motor 3. As shown in FIG. 1, the control device 12 includes a CPU 13, a drive circuit (drive means) 14, and a position detection circuit (position detection means) 15. The CPU 13 is connected to an interface 20 for connecting a ROM 16, a RAM 17, an operation panel 18, and a personal computer 19 that store system programs for the entire robot.

上記位置検出回路15は、モータ3の回転位置を検出するためのもので、この位置検出回路15には、モータ3の回転軸5の回転を検出するための回転センサとしてのロータリエンコーダ21が接続されている。なお、図2には、モータ3およびロータリエンコーダ21は、1個ずつしか図示していないが、実際には、各関節に対して一対一の関係で複数設けられているものである。   The position detection circuit 15 is for detecting the rotational position of the motor 3, and a rotary encoder 21 as a rotation sensor for detecting the rotation of the rotary shaft 5 of the motor 3 is connected to the position detection circuit 15. Has been. In FIG. 2, only one motor 3 and one rotary encoder 21 are illustrated, but in reality, a plurality of motors 3 and rotary encoders 21 are provided in a one-to-one relationship with each joint.

モータ3を回転駆動する場合、CPU13は、回転指令信号を駆動回路14に出力する。これに対し、位置検出回路15は、従来の制御構成と同様に、ロータリエンコーダ21の検出信号によってモータ3の回転角度を検出し、その検出角度信号をフィードバック信号としてCPU13および駆動回路14に与える。駆動回路14は、CPU13からの回転指令信号に応じた指令角度と、位置検出回路15からのフィードバック信号に応じた検出角度とを比較し、その比較結果に応じてモータ3の回転を制御する。具体的には、駆動回路14は、指令角度と検出角度とを比較し、その差分に応じた駆動電流をモータ3に供給する。これにより、モータ3は、回転軸5をCPU13の指令角度と同一の回転角度となるように回転させる。したがって、CPU13は、位置検出回路15および駆動回路14の指令角度と検出角度とを比較して差分を出す加減算部と共に、モータ3を指令角度だけ回転するように制御する制御手段として機能する。   When the motor 3 is driven to rotate, the CPU 13 outputs a rotation command signal to the drive circuit 14. On the other hand, the position detection circuit 15 detects the rotation angle of the motor 3 based on the detection signal of the rotary encoder 21 and supplies the detected angle signal to the CPU 13 and the drive circuit 14 as a feedback signal, as in the conventional control configuration. The drive circuit 14 compares the command angle according to the rotation command signal from the CPU 13 with the detection angle according to the feedback signal from the position detection circuit 15 and controls the rotation of the motor 3 according to the comparison result. Specifically, the drive circuit 14 compares the command angle and the detected angle, and supplies a drive current corresponding to the difference to the motor 3. Thereby, the motor 3 rotates the rotating shaft 5 so that it may become the same rotation angle as the command angle of CPU13. Therefore, the CPU 13 functions as a control unit that controls the motor 3 to rotate by the command angle, together with an addition / subtraction unit that compares the command angle of the position detection circuit 15 and the drive circuit 14 with the detection angle and outputs a difference.

一方、パーソナルコンピュータ19は、周知のように、CPU、ROM、RAMなどを有した制御部と、キーボードやマウスなどからなる操作部と、液晶ディスプレイなどからなる表示部(いずれも図示せず)とを有する。このパソコン19には、互いに噛み合う一対の歯車の摩耗量を演算するためのプログラム(摩耗測定プログラム)が格納されている。   On the other hand, as is well known, the personal computer 19 includes a control unit having a CPU, a ROM, a RAM, an operation unit including a keyboard and a mouse, and a display unit (none of which is shown) including a liquid crystal display. Have The personal computer 19 stores a program (wear measurement program) for calculating the wear amount of a pair of gears meshing with each other.

次に、このパソコン19の摩耗測定プログラムを用いて歯車の摩耗を検出する場合の制御内容を図3のフローチャートをも参照して説明する。歯車減速装置4は、互いに噛み合う一対の歯車の組を2組有しているが、摩耗測定対象となる一対の歯車は、モータ3に直結された小歯車8とこの小歯車8に噛合する大歯車9である。ここで、モータ3に直結とは、入力軸をモータ3の回転軸5とは別の軸から構成し、この入力軸にモータ3の回転軸5を継手を介して結合したものも含むものとする。   Next, the control contents when the gear wear is detected using the wear measurement program of the personal computer 19 will be described with reference to the flowchart of FIG. The gear reduction device 4 has two sets of a pair of gears that mesh with each other. The pair of gears that are subject to wear measurement are a small gear 8 that is directly connected to the motor 3 and a large gear that meshes with the small gear 8. Gear 9. Here, the direct connection to the motor 3 includes that in which the input shaft is composed of a shaft different from the rotation shaft 5 of the motor 3 and the rotation shaft 5 of the motor 3 is coupled to the input shaft via a joint.

本実施形態では、CPU13から回転指令信号を出力し、そのときのモータ3の回転軸5の実際の回転角度をロータリエンコーダ21によって検出する。そして、回転指令信号に応じた指令角度とロータリエンコーダ21の検出角度とを比較することによって摩耗の有無を判定し、更に、摩耗量を演算しようとするものである。回転指令信号としては、モータ3の回転軸5を、停止位置(基準位置)を角度0とし、この角度0の基準位置から正方向の角度+θnだけ回転させて元の基準位置に戻す正回転指令信号と、基準位置から逆方向の角度−θnだけ回転させて元の基準位置に戻す逆回転指令信号とを1組にして出力する。この1組の正回転指令信号の指令角度+θnと逆回転指令信号の指令角度−θnとは、回転方向が互いに逆となるだけで、その角度の大きさは同一である。   In the present embodiment, a rotation command signal is output from the CPU 13, and the actual rotation angle of the rotating shaft 5 of the motor 3 at that time is detected by the rotary encoder 21. Then, the presence / absence of wear is determined by comparing the command angle corresponding to the rotation command signal with the detected angle of the rotary encoder 21, and the wear amount is further calculated. As the rotation command signal, the rotation shaft 5 of the motor 3 is rotated at the stop position (reference position) by the angle 0, and is rotated from the reference position at this angle 0 by the positive angle + θn to return to the original reference position. A signal and a reverse rotation command signal for rotating the reference position by an angle −θn in the reverse direction and returning to the original reference position are output as one set. The command angle + θn of the pair of forward rotation command signals and the command angle −θn of the reverse rotation command signal are the same in the magnitude of the angles except that the rotation directions are opposite to each other.

この1組の正回転指令信号の指令角度+θnおよび逆回転指令信号の指令角度−θnの絶対値の大小は、添え字nで示される数字(n=1,2,3……)で表すこととし、|θ1|<|θ2|<|θ3|<……のように数値が大きいほど大きい角度であるとする。なお、|θ1|、|θ2|、|θ3|、……は、予めパソコン19のROM(指令角度記憶手段)に記憶されているものとする。この指令角度の絶対値のうち、最も小さい|θ1|は、一対の歯車8,9の歯が摩耗量0のときのバックラッシュ内での小歯車8の回転角度の半分の大きさよりも所定量βだけ大きな値に設定されている。   The magnitudes of the absolute values of the command angle + θn of the pair of forward rotation command signals and the command angle −θn of the reverse rotation command signal are represented by numbers (n = 1, 2, 3,...) Indicated by the subscript n. It is assumed that the larger the value is, the larger the angle is, such as | θ1 | <| θ2 | <| θ3 | <. It is assumed that | θ1 |, | θ2 |, | θ3 |,... Are stored in advance in a ROM (command angle storage means) of the personal computer 19. Among the absolute values of the command angle, the smallest | θ1 | is a predetermined amount larger than half the rotation angle of the small gear 8 within the backlash when the teeth of the pair of gears 8 and 9 have a wear amount of 0. The value is set larger by β.

ここで、以下の説明において、指令角度θ1のように示した場合は、絶対値での大きさを表し、+θ1、−θ1のように示した場合には、正回転指令信号の指令角度、逆回転指令信号の指令信号を表すものとする。また、CPU13は、回転指令信号が、例えば+θ1、−θ1の指令角度を内容とするものである場合、いきなり+θ1、−θ1の指令角度を出力するのではなく、+θ1、−θ1となるまで、或いは、+θ1、−θ1の位置から基準位置に戻るまで、一定の率で漸増或いは漸減する指令角度をごく短い時間間隔で出力するものである。したがって、正回転指令信号および逆回転指令信号の指令角度の波形は、三角形となる。   Here, in the following description, the command angle θ1 indicates the absolute value, and + θ1 and −θ1 indicate the command angle of the forward rotation command signal, It shall represent the command signal of a rotation command signal. In addition, when the rotation command signal includes, for example, command angles of + θ1 and −θ1, the CPU 13 does not output the command angles of + θ1 and −θ1 suddenly but until + θ1 and −θ1. Alternatively, a command angle that gradually increases or decreases at a constant rate from the position of + θ1 or −θ1 to the reference position is output at a very short time interval. Therefore, the command angle waveforms of the forward rotation command signal and the reverse rotation command signal are triangular.

さて、モータ3に直結された小歯車8と、この小歯車8に噛み合う大歯車9の摩耗の有無を検出するために、パソコン19をロボットの制御装置12のインターフェース20に接続して摩耗測定プログラムを起動させる。すると、まず、パソコン19は、指令信号の大きさを示す数値nを1にセットし(図3のステップS1)、指令する回転角度の大きさをθ1に定めて制御装置12のCPU13に対し、指令角度が+θ1の正回転指令信号と、−θ1の逆回転指令信号を出力するようにコマンドを送信する(ステップS2)。   Now, in order to detect the presence or absence of wear of the small gear 8 directly connected to the motor 3 and the large gear 9 meshing with the small gear 8, a personal computer 19 is connected to the interface 20 of the robot controller 12, and a wear measurement program is connected. Start up. Then, first, the personal computer 19 sets a numerical value n indicating the magnitude of the command signal to 1 (step S1 in FIG. 3), sets the magnitude of the commanded rotation angle to θ1, and instructs the CPU 13 of the control device 12 to A command is transmitted so as to output a forward rotation command signal with a command angle of + θ1 and a reverse rotation command signal with −θ1 (step S2).

ロボットの制御装置12のCPU13は、上記コマンドを受信すると、駆動回路14に指令角度+θ1の正回転指令信号と、指令角度−θ1の逆回転指令信号とを順に出力する(ステップS3、ステップS5)。これにより駆動回路14は、モータ3を、その回転軸5が停止位置(基準位置)から正方向にθ1だけ回転し、θ1回転したところで、逆方向に回転して元の基準位置に戻り且つこの基準位置から更に逆方向にθ1だけ回転するように駆動する。   When the CPU 13 of the robot control device 12 receives the above command, it outputs a forward rotation command signal of command angle + θ1 and a reverse rotation command signal of command angle −θ1 to the drive circuit 14 in order (step S3, step S5). . As a result, the drive circuit 14 rotates the motor 3 in the forward direction from the stop position (reference position) by θ1, and when it rotates θ1, the motor 3 rotates in the reverse direction and returns to the original reference position. It is driven to rotate further by θ1 in the opposite direction from the reference position.

このとき、ロータリエンコーダ21は、実際の回転軸5の回転角度を所定の短時間毎に検出してその検出信号を位置検出回路15に与え、位置検出回路15は、ロータリエンコーダ21による検出角度をCPU13に与える(ステップS4、ステップS6)。そして、CPU13は、正回転指令信号および逆回転指令信号の指令角度と、ロータリエンコーダ21による検出角度をRAM17に記憶し(指令値・検出値記憶手段)、且つそれら指令角度と検出角度をパソコン19に送信する。   At this time, the rotary encoder 21 detects the actual rotation angle of the rotating shaft 5 every predetermined short time and gives a detection signal to the position detection circuit 15. The position detection circuit 15 determines the detection angle by the rotary encoder 21. It gives to CPU13 (step S4, step S6). Then, the CPU 13 stores the command angle of the forward rotation command signal and the reverse rotation command signal and the detected angle by the rotary encoder 21 in the RAM 17 (command value / detected value storage means), and the command angle and detected angle are stored in the personal computer 19. Send to.

パソコン1は、制御装置12のCPU13から送信されてきた指令角度と検出角度により、それら指令角度の変化(指令角度波形)と検出角度の変化を示す波形(検出角度波形)を生成する(ステップS7:波形生成手段)。次いで、パソコン1は、指令値+θn(ここでは+θ1)になった時から一定時間経過t1するまでの間の検出角度波形と、指令値−θn(ここでは−θ1)になった時から所定時間t1経過するまでの間の検出角度波形が対称であるか否かを判断する(ステップS8:波形形状判定手段)。この場合の対称とは、完全に対称である外、両検出波形が互いに所定の誤差範囲内にある場合も含むものとする。したがって、このステップS8は、つきつめると、指令値が+θnになった時点から所定時間t1内で、および指令値が−θnになった時点から所定時間t1内で、+θ1および−θ1となった時から任意の時間経過した時点の検出角度の差が所定値内にあるか否かを判断することと等価となる。   The personal computer 1 generates a change in the command angle (command angle waveform) and a waveform indicating the change in the detection angle (detection angle waveform) based on the command angle and the detection angle transmitted from the CPU 13 of the control device 12 (step S7). : Waveform generating means). Next, the personal computer 1 detects the detected angle waveform from the time when the command value + θn (here, + θ1) is reached until the time t1 elapses, and the time when the command value −θn (here, −θ1) is reached. It is determined whether or not the detected angle waveform until t1 has elapsed (step S8: waveform shape determining means). The symmetry in this case includes not only complete symmetry but also a case where both detected waveforms are within a predetermined error range. Therefore, in step S8, when the command value becomes + θn within the predetermined time t1 from the time when the command value becomes + θn and within the predetermined time t1 from the time when the command value becomes −θn, This is equivalent to determining whether or not the difference in detection angle at the time when an arbitrary time has passed is within a predetermined value.

ところで、θ1の正回転指令信号と逆回転指令信号とがCPU13から出力されたとき、小歯車8と大歯車9との歯の噛み合い状態は様々である。理想的には、図4に示すように、小歯車8の1枚の歯8aが大歯車9の隣り合う2枚の歯9a,9bの間の中央に位置した状態(歯の偏りがない状態)、つまり1枚の歯8aの両側の隙間G1,G2が互いに等しい状態が現出され、この状態で、正回転指令信号および逆回転指令信号が出力されることが好ましい。   By the way, when the forward rotation command signal and the reverse rotation command signal of θ1 are outputted from the CPU 13, the meshing states of the teeth of the small gear 8 and the large gear 9 are various. Ideally, as shown in FIG. 4, one tooth 8a of the small gear 8 is located in the center between the two adjacent teeth 9a, 9b of the large gear 9 (the state where there is no tooth bias). That is, a state where the gaps G1, G2 on both sides of one tooth 8a are equal to each other appears, and in this state, it is preferable that the forward rotation command signal and the reverse rotation command signal are output.

この理想的な状態の典型的な例として、小歯車8と大歯車9の回転中心点を結ぶ直線Cが大歯車9の2枚の歯9a,9bの間(歯みぞ)の中央を通り、且つ、その歯みぞの中央に小歯車8の1枚の歯8aが位置している場合を、図5(a)に示した。なお、歯の摩耗が0の場合、図5(a)において、歯8aの両側の隙間G1,G2は、当初設定されたバックラッシュの1/2となる。
図4(a)の状態と図5(a)の状態とは、本発明の摩耗検出を適用する場合、条件として完全に同じではないが、ほぼ同等と考えられるので、以下では、小歯車8と大歯車9の回転中心を結ぶ直線Cが小歯車8の歯8aの中央を通っている状態にあるとして説明する。
As a typical example of this ideal state, a straight line C connecting the rotation center points of the small gear 8 and the large gear 9 passes through the center between the two teeth 9a and 9b (tooth groove) of the large gear 9, FIG. 5A shows the case where one tooth 8a of the small gear 8 is located at the center of the tooth groove. When the tooth wear is 0, in FIG. 5A, the gaps G1 and G2 on both sides of the tooth 8a are ½ of the initially set backlash.
The state of FIG. 4A and the state of FIG. 5A are not completely the same as the conditions when the wear detection of the present invention is applied, but are considered to be substantially equivalent. The straight line C connecting the rotation center of the large gear 9 and the large gear 9 will be described as passing through the center of the tooth 8a of the small gear 8.

さて、指令角度+θ1の正回転指令信号と、指令角度−θ1の逆回転指令信号とが順に出力された場合、小歯車8と大歯車9が上記理想的な状態にある場合、指令角度が+θ1のときも、−θ1のときも、角度0の位置(歯8aが存在する位置)から同じ角度(θ1−β)だけ回転したところで、歯8aが歯9a或いは歯9bに当たる。そして、その回転位置で小歯車8が大歯車9から回転抵抗を受けるので、回転軸5はそれ以上回転しなくなる。
このため、指令値+θ1になった時から所定時間t1が経過するまでの間のロータリエンコーダ21の検出角度の変化を示す波形(正側検出角度波形)と、指令値−θ1になった時から一定時間t1が経過するまでの間のロータリエンコーダ21の検出角度の変化を示す波形(逆側検出角度波形)とは、図5(b)に示すように対称となる。
When a forward rotation command signal having a command angle + θ1 and a reverse rotation command signal having a command angle −θ1 are sequentially output, when the small gear 8 and the large gear 9 are in the ideal state, the command angle is + θ1. At the time of -θ1, the tooth 8a hits the tooth 9a or the tooth 9b when it is rotated by the same angle (θ1-β) from the position of the angle 0 (position where the tooth 8a exists). And since the small gear 8 receives rotational resistance from the large gear 9 in the rotation position, the rotating shaft 5 does not rotate any more.
Therefore, a waveform (positive detection angle waveform) indicating a change in the detection angle of the rotary encoder 21 from when the command value + θ1 is reached until the predetermined time t1 elapses, and from when the command value −θ1 is reached. The waveform indicating the change in the detection angle of the rotary encoder 21 until the predetermined time t1 elapses (reverse detection angle waveform) is symmetric as shown in FIG.

一方、例えば図6(a)に示すように、大歯車9が小歯車8に対し上記理想的な状態からずれていた場合には、歯8aの両側の隙間G1、G2の大きさが異なるので、回転軸5が角度0の位置から正方向に回転する場合と逆方向に回転する場合とで、小歯車8の歯8aが大歯車9の一方の歯9aに当たるまでの回転角度と他方の歯9bに当たるまでの回転角度が異なることようになる。したがって、図6(b)に示すように、上記の正側検出角度波形と逆側検出角度波形とは対称にならない。   On the other hand, for example, as shown in FIG. 6A, when the large gear 9 deviates from the ideal state with respect to the small gear 8, the sizes of the gaps G1 and G2 on both sides of the tooth 8a are different. The rotation angle until the tooth 8a of the small gear 8 hits one tooth 9a of the large gear 9 and the other tooth depending on whether the rotating shaft 5 rotates in the forward direction from the position of the angle 0 The rotation angle until it hits 9b will be different. Therefore, as shown in FIG. 6B, the positive side detection angle waveform and the reverse side detection angle waveform are not symmetric.

このように正側検出角度波形と逆側検出角度波形とが非対称であった場合(ステップS8で「NO」)、パソコン19は、再び、指令角度+θ1の正回転指令信号と、指令角度−θ1の逆回転指令信号とを出力するように制御装置12のCPU13にコマンドを送信し、CPU13から送信されてくる指令角度と検出角度とから指令角度波形および検出角度波形を生成し、正側検出角度波形と逆側検出角度波形が対象であるか否かを判定する(以上、ステップS3〜8)。   When the positive side detection angle waveform and the reverse side detection angle waveform are asymmetric as described above ("NO" in step S8), the personal computer 19 again sends the forward rotation command signal of the command angle + θ1 and the command angle -θ1. Is transmitted to the CPU 13 of the control device 12 so as to output a reverse rotation command signal, and a command angle waveform and a detected angle waveform are generated from the command angle and the detected angle transmitted from the CPU 13, and the positive detection angle is detected. It is determined whether or not the waveform and the reverse detection angle waveform are targets (steps S3 to S8).

そして、パソコン19は、正側検出角度波形と逆側検出角度波形とが対称でなかった場合、その正側検出角度波形と逆側検出角度波形とが対象となるまで、ステップS3〜ステップS8を繰り返し実行する。このように、指令角度の大きさを一定にしたまま、正回転指令信号と、逆回転指令信号とを出力する動作を繰り返すことにより、小歯車8の歯8aが大歯車9の2枚の歯9a,9b間で往復移動(回動)する。これにより、隙間G1、G2のうち小なる隙間側の歯、図6の例では、歯9aの方が、大間隙側の歯9bよりも、小歯車8の歯8aから大きな当接力を受ける。
このため、図7(a)に示すように、大歯車9が隙間の大なる歯9bから隙間の小なる歯9aに向かう方向に僅かずつ回転し、最終的には、図5(a)に示すように、歯8aの両側の隙間G1、G2が同じ大きさになる。すると、正側検出角度波形と逆側検出角度波形が対称になる。
If the positive side detection angle waveform and the reverse side detection angle waveform are not symmetric, the personal computer 19 performs steps S3 to S8 until the positive side detection angle waveform and the reverse side detection angle waveform are targeted. Run repeatedly. In this way, by repeating the operation of outputting the forward rotation command signal and the reverse rotation command signal while keeping the command angle constant, the tooth 8a of the small gear 8 is changed to the two teeth of the large gear 9. It reciprocates (rotates) between 9a and 9b. As a result, the smaller gap side tooth of the gaps G1 and G2, that is, the tooth 9a in the example of FIG. 6, receives a larger abutting force from the tooth 8a of the small gear 8 than the large gap side tooth 9b.
For this reason, as shown in FIG. 7A, the large gear 9 rotates little by little in the direction from the tooth 9b having a large gap toward the tooth 9a having a small gap, and finally, as shown in FIG. As shown, the gaps G1 and G2 on both sides of the tooth 8a have the same size. Then, the positive side detection angle waveform and the reverse side detection angle waveform are symmetric.

以上のようにして、正側検出角度波形と逆側検出角度波形との対称性が検出されると(ステップS8で「YES」)、次に、パソコン19は、指令値が+θ1になった時点から所定時間t2、ロータリエンコーダ21の検出角度が同一角度である状態が継続するか否かを判断する(ステップS9)。なお、t2は、指令角度の大きさが角度βだけ変化する時間に相当する時間以内に定められている。   As described above, when the symmetry between the positive side detection angle waveform and the reverse side detection angle waveform is detected (“YES” in step S8), the personal computer 19 then determines when the command value becomes + θ1. From a predetermined time t2, it is determined whether or not the state in which the detected angle of the rotary encoder 21 is the same angle continues (step S9). Note that t2 is set within a time corresponding to a time when the magnitude of the command angle changes by the angle β.

このステップS9の意義は次の通りである。つまり、正側検出角度波形と逆側検出角度波形の対称性が確認されたことと、小歯車8の歯8aが大歯車9の2枚の歯9a,9bの双方に均等に当接したこととは必ずしも一致しない。例えば、図8(a)のように、歯の摩耗量が大きい場合、+θ1、−θ1の指令角では、歯8aが2枚の歯9a,9bに当たらず、歯みぞ内で往復移動しているだけかも知れない。この場合の検出角度波形は、図8(b)のようになり、正側検出角度波形と逆側検出角度波形は対称となる。しかし、これでは、磨耗量を検出することはできない。磨耗量を検出するためには、歯8aが2枚の歯9a,9bの双方に均等に当たらなければならない。   The significance of this step S9 is as follows. That is, the symmetry of the positive side detection angle waveform and the reverse side detection angle waveform was confirmed, and that the tooth 8a of the small gear 8 was in contact with both of the two teeth 9a and 9b of the large gear 9 equally. Does not necessarily match. For example, as shown in FIG. 8A, when the amount of wear of the teeth is large, at the command angles of + θ1 and −θ1, the teeth 8a do not hit the two teeth 9a and 9b and reciprocate in the tooth groove. It may be just there. The detected angle waveform in this case is as shown in FIG. 8B, and the positive side detected angle waveform and the reverse side detected angle waveform are symmetric. However, this cannot detect the wear amount. In order to detect the amount of wear, the tooth 8a must hit both the two teeth 9a and 9b evenly.

歯8aが2枚の歯9a,9bの双方に均等に当たれば、検出角度が一定の状態が現出される。ステップS9では、この検出角度が一定の状態があること、換言すれば、歯8aが2枚の歯9a,9bの双方に均等に当接したことを検出するものである。なお、歯8aが2枚の歯9a,9bの双方に当たると、大歯車9が若干回転するが、その回転角度は、極々小さなものであるから、検出角度としては概ね一定の状態となるのである。   If the tooth 8a hits both the two teeth 9a and 9b evenly, a state where the detection angle is constant appears. In step S9, it is detected that the detected angle is constant, in other words, that the tooth 8a is in contact with both the teeth 9a and 9b evenly. When the tooth 8a hits both of the two teeth 9a and 9b, the large gear 9 is slightly rotated. However, since the rotation angle is extremely small, the detection angle is substantially constant. .

さて、正側検出角度波形と逆側検出角度波形が対称であっても、指令値が+θ1になった時点から所定時間t2内のロータリエンコーダ21の検出角度が同一角度である状態がt2時間継続されない場合(ステップS9で「NO」)、パソコン19は、指令信号の大きさを示す数値nをインクリメントする(ステップS10)。ここでは、nは「1」であったので、ステップS10で「2」に変更されたこととなる。その後、パソコン19は、前述のステップS2に戻り、指令する角度の大きさをθ1より一段階大きいθ2にセットして制御装置12のCPU13に指令角度が+θ2、−θ2の正回転指令信号と逆回転指令信号を出力するようにコマンドを送信する。   Now, even if the positive side detection angle waveform and the reverse side detection angle waveform are symmetric, the state where the detection angle of the rotary encoder 21 within the predetermined time t2 is the same angle from the time when the command value becomes + θ1 continues for t2 time. If not (“NO” in step S9), the personal computer 19 increments a numerical value n indicating the magnitude of the command signal (step S10). Here, since n is “1”, it is changed to “2” in step S10. After that, the personal computer 19 returns to the above-described step S2, sets the commanded angle to θ2, which is one step larger than θ1, and reverses the forward rotation command signal with the command angles of + θ2 and −θ2 to the CPU 13 of the control device 12. A command is transmitted so as to output a rotation command signal.

すると、ロボットの制御装置12のCPU13が指令角度+θ2の正回転指令信号と、指令角度−θ2の逆回転指令信号とを順に出力し、ロータリエンコーダ21による検出角度をパソコン19に送信し、パソコン19は、正側検出角度波形と逆側検出角度波形の対称性が確認されたら、指令値+θ2から所定時間t2内で同一角度を維持する状態になるかを判断する。t2時間同一角度が維持されなければ、パソコン19は、指令の角度の大きさを示す数値を更に一段大きくし(ステップS10)、その指令角度の正回転指令信号と逆回転指令信号を出力するようにコマンドをロボットの制御装置12に送信し、制御装置12から送られてくる検出角度情報から正側検出角度波形と逆側検出角度波形が対称で、且つ、正回転指令信号の指令値のピーク後、所定時間t2だけ検出角度一定の状態が存在することが確認されるまで、指令角度を一段ずつ上げてモータ3を正逆方向に駆動し、回転軸5の実際の回転角度を検出するという動作を、繰り返す。   Then, the CPU 13 of the robot control device 12 sequentially outputs a forward rotation command signal with a command angle + θ2 and a reverse rotation command signal with a command angle −θ2, and transmits the detected angle by the rotary encoder 21 to the personal computer 19. When the symmetry between the positive detection angle waveform and the reverse detection angle waveform is confirmed, it is determined whether or not the same angle is maintained within a predetermined time t2 from the command value + θ2. If the same angle is not maintained for t2 time, the personal computer 19 further increases the numerical value indicating the magnitude of the command angle (step S10), and outputs a normal rotation command signal and a reverse rotation command signal for the command angle. Are transmitted to the control device 12 of the robot, the detection angle information sent from the control device 12 is symmetrical in the positive detection angle waveform and the reverse detection angle waveform, and the command value peak of the forward rotation command signal After that, until it is confirmed that a state where the detection angle is constant only for a predetermined time t2 is confirmed, the command angle is increased step by step, the motor 3 is driven in the forward and reverse directions, and the actual rotation angle of the rotary shaft 5 is detected. Repeat the operation.

正回転指令信号の指令値のピーク後、所定時間t2だけ検出角度一定の状態が存在することが確認されると(ステップS9で「YES」)、パソコン19は、その時の指令角度θnと予め定められた閾値角度θyとを比較し、指令角度θnが閾値角度θy(θ1−β)を超えているか否かを判断する(ステップS11:比較手段)。指令角度θnが閾値角度θyを超えていなければ、パソコン19は、摩耗なしと判定し(ステップS12:判定手段)、エンドとなる。なお、この場合の「摩耗なし」は、正しくは、ユーザが設定した摩耗の許容範囲内にあって問題となるような摩耗に至っていない状態にあることを言う。   If it is confirmed that a state where the detection angle is constant for a predetermined time t2 exists after the peak of the command value of the forward rotation command signal (“YES” in step S9), the personal computer 19 predetermines the command angle θn at that time. The commanded threshold angle θy is compared to determine whether the command angle θn exceeds the threshold angle θy (θ1-β) (step S11: comparison means). If the command angle θn does not exceed the threshold angle θy, the personal computer 19 determines that there is no wear (step S12: determination means) and ends. Note that “no wear” in this case means that the wear is not in a state that is within the allowable range of wear set by the user and causes a problem.

指令角度θnが閾値角度θyを超えていた場合、パソコン19は、摩耗ありと判断して検出角度の最大角度を摩耗角θxとし(ステップS13:判定手段、摩耗角検出手段)、次式に摩耗角θxを代入して摩耗量を求め(ステップS14:摩耗量演算手段)、エンドとなる。
摩耗量=歯車の基準ピッチ円直径×π×2θx÷360
なお、上式での歯車の基準ピッチ円直径は、回転軸5に直結した歯車、本実施形態では小歯車8の基準ピッチ円直径D0(図4参照)である。
If the command angle θn exceeds the threshold angle θy, the personal computer 19 determines that there is wear and sets the maximum detected angle as the wear angle θx (step S13: determination means, wear angle detection means). The wear amount is obtained by substituting the angle θx (step S14: wear amount calculation means), and the end.
Amount of wear = reference pitch circle diameter of gear × π × 2θx ÷ 360
The reference pitch circle diameter of the gear in the above equation is the reference pitch circle diameter D0 (see FIG. 4) of the gear directly connected to the rotating shaft 5, that is, the small gear 8 in this embodiment.

このように本実施形態によれば、歯車の摩耗の有無を、モータ3の制御系を利用して検出することができる。しかも、駆動側の小歯車8の歯8aが従動側の大歯車9の2枚の歯9a,9bに当たるときのモータ3の回転軸5の回転角度によって歯車の摩耗量を検出するので、より正確に摩耗を検出できる。   Thus, according to this embodiment, the presence or absence of gear wear can be detected using the control system of the motor 3. In addition, the amount of wear of the gear is detected based on the rotation angle of the rotating shaft 5 of the motor 3 when the tooth 8a of the small gear 8 on the driving side hits the two teeth 9a and 9b of the large gear 9 on the driven side. Wear can be detected.

なお、本発明は上記し且つ図面に示す実施形態に限られるものではなく、次のような変更或いは拡張が可能である。
ステップS8は、指令値が+θn、−θnのときの検出角度の差、または、指令値が+θn、−θnになった時点から所定時間後の検出角度の差が所定値内であるか否かを判断することに変えても良い。
摩耗の有無を検出する機能だけに止めても良い。
1枚の歯8aを2枚の歯9a,9b間の中央にセットした状態で回転指令信号を出力すれば、回転指令信号は、正または逆のうちの一方だけで摩耗の有無と摩耗量の検出を行うことができる。
パソコン19の機能は、制御装置12のCPU13が果たすようにしてパソコン19を用いずとも歯車の摩耗検出が行い得るようにしても良い。
ロボットのアーム駆動装置の歯車を対象とする場合に限られず、歯車の摩耗を検出する場合に広く適用できる。
The present invention is not limited to the embodiment described above and shown in the drawings, and the following modifications or expansions are possible.
Step S8 determines whether or not the difference between the detected angles when the command value is + θn or −θn, or the difference between the detected angles after a predetermined time from when the command value becomes + θn or −θn is within the predetermined value. It may be changed to judge.
You may stop only in the function which detects the presence or absence of wear.
If a rotation command signal is output in a state where one tooth 8a is set at the center between the two teeth 9a and 9b, the rotation command signal can be used to determine whether or not there is wear and the amount of wear only in one of the positive and reverse directions. Detection can be performed.
The function of the personal computer 19 may be performed by the CPU 13 of the control device 12 so that gear wear can be detected without using the personal computer 19.
The present invention is not limited to the case of gears of robot arm drive devices, and can be widely applied to the detection of gear wear.

本発明の一実施形態におけるモータの制御系の構成を示すブロック図The block diagram which shows the structure of the control system of the motor in one Embodiment of this invention. 歯車減速装置の概略を示す断面図Sectional drawing which shows the outline of a gear reduction device 摩耗検出のためのフローチャートFlow chart for wear detection 摩耗検査のための歯車の理想的な状態の一例を示す部分的な平面図Partial plan view showing an example of an ideal state of a gear for wear inspection (a)は摩耗検査のための歯車の理想的な状態の他の例を示す部分的な平面図、(b)は指令角度と検出角度の波形図(A) is a partial plan view showing another example of an ideal state of a gear for wear inspection, (b) is a waveform diagram of command angle and detection angle (a)は歯みぞ内に1枚の歯が偏って位置する例を示す平面図、(b)は指令角度と検出角度の波形図(A) is a plan view showing an example in which one tooth is biased in the tooth groove, (b) is a waveform diagram of command angle and detection angle (a)は歯みぞ内の1枚の歯の偏りが是正されてゆく途中を示す平面図、(b)は指令角度と検出角度の波形図(A) is a plan view showing the way in which the deviation of one tooth in the tooth groove is corrected, (b) is a waveform diagram of command angle and detection angle (a)は摩耗量が大きい場合の歯車の部分的な平面図、(b)は指令角度と検出角度の波形図(A) is a partial plan view of a gear when the amount of wear is large, and (b) is a waveform diagram of command angle and detection angle.

符号の説明Explanation of symbols

図面中、4は歯車減速装置、5は回転軸、6は中間軸、7は出力軸、8は小歯車、9は大歯車、12は制御装置、13はCPU(制御手段、比較手段、判定手段、摩耗量演算手段)、14は駆動回路、15は位置検出回路、19はパソコン、21はロータリーエンコーダ(回転センサ)を示す。   In the drawings, 4 is a gear reduction device, 5 is a rotation shaft, 6 is an intermediate shaft, 7 is an output shaft, 8 is a small gear, 9 is a large gear, 12 is a control device, and 13 is a CPU (control means, comparison means, determination) Means, wear amount calculating means), 14 a drive circuit, 15 a position detection circuit, 19 a personal computer, and 21 a rotary encoder (rotation sensor).

Claims (5)

互いに噛み合う一対の歯車の摩耗を検出する装置であって、
前記一対の歯車のうちの一方の歯車に直結されたモータと、
回転指令信号を出力し、前記モータの回転角度を検出する回転センサからの検出信号をフィードバック信号として前記モータが前記回転指令信号に応じた指令角度だけ回転するように当該モータを制御する制御手段と、
前記回転指令信号に応じた前記指令角度と前記回転センサの検出角度とを比較する比較手段と、
前記比較手段の比較により、前記指令角度が前記検出角度よりも大きく、且つ、前記検出角度が予め定められた閾値角度以下とされたとき、摩耗なしと判定し、前記指令角度が前記検出角度よりも大きく、且つ、前記検出角度が予め定められた前記閾値角度を超えているとされたとき、摩耗ありと判定する判定手段と、
を具備してなる歯車の摩耗検出装置。
A device for detecting wear of a pair of gears meshing with each other,
A motor directly connected to one of the pair of gears;
Control means for outputting a rotation command signal and controlling the motor so that the motor rotates by a command angle corresponding to the rotation command signal using a detection signal from a rotation sensor for detecting a rotation angle of the motor as a feedback signal; ,
A comparison means for comparing the command angle according to the rotation command signal with a detection angle of the rotation sensor;
When the command angle is larger than the detection angle and the detection angle is equal to or smaller than a predetermined threshold angle by comparison of the comparison means, it is determined that there is no wear, and the command angle is greater than the detection angle. And when the detected angle exceeds the predetermined threshold angle, a determination unit that determines that there is wear,
A gear wear detection device comprising:
前記制御手段は、前記回転指令信号として、前記モータを正方向および逆方向に同じ角度だけ回転させる正回転指令信号および逆回転指令信号を出力することを、前記正回転指令信号に対する前記回転センサの検出角度と前記逆回転指令信号に対する前記回転センサの検出角度との差が所定値内となるまで繰り返す
ようにしてなる請求項1記載の歯車の摩耗検出装置。
The control means outputs, as the rotation command signal, a normal rotation command signal and a reverse rotation command signal for rotating the motor by the same angle in the forward direction and the reverse direction. The gear wear detection device according to claim 1, wherein the gear wear detection device is repeated until a difference between a detection angle and a detection angle of the rotation sensor with respect to the reverse rotation command signal falls within a predetermined value.
前記制御手段は、前記正回転指令信号に対する前記回転センサの検出角度と前記逆回転指令信号に対する前記回転センサの検出角度との差が前記所定値内となったとき、前記正回転指令信号または前記逆回転指令信号に対して、前記回転センサが所定時間継続して同じ角度を検出するか否かを判断し、所定時間継続して同じ角度を検出しないときには、前記正回転指令信号および前記逆回転指令信号を、前回よりも大きい指令角度にして出力することを、前記正回転指令信号または前記逆回転指令信号に対して、前記回転センサが所定時間継続して同じ角度を検出するまで繰り返す
ようにしてなる請求項2記載の歯車の摩耗検出装置。
When the difference between the detected angle of the rotation sensor with respect to the forward rotation command signal and the detected angle of the rotation sensor with respect to the reverse rotation command signal is within the predetermined value, the control means In response to the reverse rotation command signal, the rotation sensor determines whether or not the same angle is detected continuously for a predetermined time. When the same angle is not detected continuously for a predetermined time, the forward rotation command signal and the reverse rotation are determined. The output of the command signal at a command angle larger than the previous command is repeated until the rotation sensor detects the same angle continuously for a predetermined time with respect to the forward rotation command signal or the reverse rotation command signal. The gear wear detecting device according to claim 2.
前記正回転指令信号または前記逆回転指令信号に対して、前記回転センサが所定時間継続して同じ角度を検出するとき、前記比較手段が前記正回転指令信号および前記逆回転指令信号に応じた前記指令角度と前記正回転指令信号および前記逆回転指令信号に対する前記回転センサの検出角度を比較する
ことを特徴とする請求項3記載の歯車の摩耗検出装置。
When the rotation sensor detects the same angle continuously for a predetermined time with respect to the normal rotation command signal or the reverse rotation command signal, the comparison unit responds to the normal rotation command signal and the reverse rotation command signal. 4. The gear wear detection device according to claim 3, wherein the rotation angle of the rotation sensor with respect to the command angle is compared with the normal rotation command signal and the reverse rotation command signal.
前記判定手段が摩耗ありと判定したとき、前記回転センサの前記検出角度から摩耗量を演算する摩耗量演算手段を
備えることを特徴とする請求項1ないし4のいずれか一項に記載の歯車の摩耗検出装置。
5. The gear according to claim 1, further comprising: a wear amount calculation unit that calculates a wear amount from the detection angle of the rotation sensor when the determination unit determines that there is wear. Wear detection device.
JP2008279785A 2008-10-30 2008-10-30 Gear wear detection device Active JP5195292B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2008279785A JP5195292B2 (en) 2008-10-30 2008-10-30 Gear wear detection device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2008279785A JP5195292B2 (en) 2008-10-30 2008-10-30 Gear wear detection device

Publications (2)

Publication Number Publication Date
JP2010107361A true JP2010107361A (en) 2010-05-13
JP5195292B2 JP5195292B2 (en) 2013-05-08

Family

ID=42296948

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2008279785A Active JP5195292B2 (en) 2008-10-30 2008-10-30 Gear wear detection device

Country Status (1)

Country Link
JP (1) JP5195292B2 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US11192761B2 (en) 2015-11-25 2021-12-07 Konecranes Global Corporation Brake condition monitoring

Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5882111A (en) * 1981-11-11 1983-05-17 Hitachi Ltd Device for detecting abrasion of reduction gear
JPS58143210A (en) * 1982-02-22 1983-08-25 Hitachi Ltd Abrasion detector for gear
JPH01289656A (en) * 1988-05-11 1989-11-21 Fujikoshi Kikai Kogyo Kk Polished amount sensing method and automatic regular size polishing machine
JPH02259442A (en) * 1989-03-31 1990-10-22 Suzuki Motor Co Ltd Gear inspection apparatus
JPH05223789A (en) * 1992-02-12 1993-08-31 Eagle Ind Co Ltd Actuator
JPH0695446A (en) * 1992-09-16 1994-04-08 Brother Ind Ltd Drum rotational speed detector
JPH07229814A (en) * 1994-02-21 1995-08-29 Kokusai Keisokki Kk Method for detecting nick on tooth surface in single tooth surface mating gear test
JPH09288042A (en) * 1996-04-22 1997-11-04 Yutaka Seimitsu Kogyo Kk Method for measuring mating gears
JPH10332539A (en) * 1997-05-28 1998-12-18 Nippon Steel Corp Method for diagnosing deterioration of gear
JP2000317710A (en) * 1999-05-07 2000-11-21 Toyoda Mach Works Ltd Tool abnormality detection tethod and device for machine tool
JP2001255240A (en) * 2000-03-14 2001-09-21 Marugo:Kk Performance test method for plastic gear and device for the method
JP2008213966A (en) * 2007-02-28 2008-09-18 Hitachi Industrial Equipment Systems Co Ltd Hoist crane device having abnormality diagnosis function

Patent Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5882111A (en) * 1981-11-11 1983-05-17 Hitachi Ltd Device for detecting abrasion of reduction gear
JPS58143210A (en) * 1982-02-22 1983-08-25 Hitachi Ltd Abrasion detector for gear
JPH01289656A (en) * 1988-05-11 1989-11-21 Fujikoshi Kikai Kogyo Kk Polished amount sensing method and automatic regular size polishing machine
JPH02259442A (en) * 1989-03-31 1990-10-22 Suzuki Motor Co Ltd Gear inspection apparatus
JPH05223789A (en) * 1992-02-12 1993-08-31 Eagle Ind Co Ltd Actuator
JPH0695446A (en) * 1992-09-16 1994-04-08 Brother Ind Ltd Drum rotational speed detector
JPH07229814A (en) * 1994-02-21 1995-08-29 Kokusai Keisokki Kk Method for detecting nick on tooth surface in single tooth surface mating gear test
JPH09288042A (en) * 1996-04-22 1997-11-04 Yutaka Seimitsu Kogyo Kk Method for measuring mating gears
JPH10332539A (en) * 1997-05-28 1998-12-18 Nippon Steel Corp Method for diagnosing deterioration of gear
JP2000317710A (en) * 1999-05-07 2000-11-21 Toyoda Mach Works Ltd Tool abnormality detection tethod and device for machine tool
JP2001255240A (en) * 2000-03-14 2001-09-21 Marugo:Kk Performance test method for plastic gear and device for the method
JP2008213966A (en) * 2007-02-28 2008-09-18 Hitachi Industrial Equipment Systems Co Ltd Hoist crane device having abnormality diagnosis function

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US11192761B2 (en) 2015-11-25 2021-12-07 Konecranes Global Corporation Brake condition monitoring

Also Published As

Publication number Publication date
JP5195292B2 (en) 2013-05-08

Similar Documents

Publication Publication Date Title
US10259121B2 (en) Robot apparatus, and measuring method of rotation driving apparatus
JP6164948B2 (en) Robot apparatus and component manufacturing method
JP5149416B2 (en) Robot system having robot abnormality detection function and control method thereof
US20160263747A1 (en) Robot controlling method, robot apparatus, program and recording medium
JP6915395B2 (en) Control device, robot system, table creation method and robot control method
KR102007536B1 (en) Method for detecting a torque and industrial robot
US8196673B2 (en) Method and apparatus for determining when a threaded fastener has been tightened to a predetermined tightness
JP2005118910A (en) Impact rotary tool
JP2011176913A5 (en) Rotation drive device and robot arm
JP2013193183A (en) Torque detecting method, and arm device
JP2012051042A (en) Robot system and robot control device
JP4440072B2 (en) Robot control method
JP2008148412A (en) Motor control device
JP2006263832A (en) Control device of robot
JP5195292B2 (en) Gear wear detection device
JPWO2018203492A1 (en) Robot system
US20200150094A1 (en) Machine tool and vibration diagnosis support method
US11370130B2 (en) Gripping system and gripping method
JP4293222B2 (en) Impact tools
JP5687539B2 (en) Impact tools
JP2017159428A (en) Control device, robot, and robot system
JP2008090692A (en) Method for suppressing position fluctuation of actuator
JP6632214B2 (en) Control method, robot hand, robot device, manufacturing method, robot hand control program, and recording medium
JP2020110877A (en) Robot diagnostic method, drobot diagnostic device, control program, recording medium, production system and manufacturing method of article
JP6696359B2 (en) Angular position detector

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20110822

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20121030

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20121205

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20130108

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20130121

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

Free format text: PAYMENT UNTIL: 20160215

Year of fee payment: 3

R150 Certificate of patent or registration of utility model

Ref document number: 5195292

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

Free format text: JAPANESE INTERMEDIATE CODE: R150

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

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250