[go: up one dir, main page]

JPH0871966A - Robot control device - Google Patents

Robot control device

Info

Publication number
JPH0871966A
JPH0871966A JP24220894A JP24220894A JPH0871966A JP H0871966 A JPH0871966 A JP H0871966A JP 24220894 A JP24220894 A JP 24220894A JP 24220894 A JP24220894 A JP 24220894A JP H0871966 A JPH0871966 A JP H0871966A
Authority
JP
Japan
Prior art keywords
reference device
robot
displacement detector
movement amount
wall surfaces
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.)
Pending
Application number
JP24220894A
Other languages
Japanese (ja)
Inventor
Osamu Toyama
修 外山
Akira Shimogoe
昭 下越
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.)
Toyoda Koki KK
Original Assignee
Toyoda Koki KK
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 Toyoda Koki KK filed Critical Toyoda Koki KK
Priority to JP24220894A priority Critical patent/JPH0871966A/en
Publication of JPH0871966A publication Critical patent/JPH0871966A/en
Pending legal-status Critical Current

Links

Landscapes

  • Numerical Control (AREA)
  • Manipulator (AREA)

Abstract

PURPOSE: To compensate for backlash of a driving system gear in a multiaxial control type robot. CONSTITUTION: A 6-axial multi-joint robot 10 clamps a cylindrical reference unit B by means of a hand 18. A displacement detector S1 is clamped on a displacement detector holder 50. The distal end part of the displacement detector S1 is located in the reference unit B in a noncontact condition. When a control shaft is normally and reversely rotated, the displacement detector S1 makes contact with the reference unit B. At that time, a CPU takes up angular data concerning the control shaft from an encoder and stores in memory, and then, computes a degree of backlash of a control shaft driving system gear, from data in memory. The CPU delivers an alarm signal to an alarm when the degree of backlash exceeds a specific value so that the alarm is energized.

Description

【発明の詳細な説明】Detailed Description of the Invention

【0001】[0001]

【産業上の利用分野】本発明は、制御軸駆動系におい
て、経年変化に起因するバックラッシュの増加によって
生ずる位置及び軌跡のズレに対し、警報及び位置補償を
行う多軸制御のロボット制御装置に関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a multi-axis robot controller for a control axis drive system, which warns and compensates for position and trajectory deviations caused by an increase in backlash due to aging. .

【0002】[0002]

【従来の技術】従来、多関節ロボットの長期使用による
経年変化のため各制御軸駆動用のギアに劣化が起こり、
ギアのバックラッシュ増加によって位置及び軌跡の精度
の低下が見られた。その対策としては、ロボット自身に
ギアのバックラッシュ増加の状況を把握する手段を有し
ていなかったため、製品の品質管理の結果を受けて、ロ
ボットの位置及び軌跡のズレを発見し、ロボットの位置
及び軌跡のズレを修正していた。
2. Description of the Related Art Conventionally, deterioration of gears for driving each control axis occurs due to secular change due to long-term use of an articulated robot,
As the backlash of the gears increased, the accuracy of the position and the trajectory decreased. As a countermeasure, the robot itself did not have a means to grasp the situation of the increase of gear backlash, so the position of the robot was found and the position of the robot was detected after the quality control of the product. And the deviation of the trajectory was corrected.

【0003】[0003]

【発明が解決しようとする課題】しかしながら、品質管
理の結果を受けた後に原因の究明を行うために、安定し
た品質を確保することができないという問題があり、ま
た、事後処理的手法のために非生産的であり、場合によ
っては、ロボットの制御軸駆動系の摩耗や損傷を発生し
かねないという問題がある。
However, there is a problem that stable quality cannot be secured because the cause is investigated after receiving the result of quality control, and because of the post-processing method. There is a problem that it is unproductive, and in some cases, the control axis drive system of the robot may be worn or damaged.

【0004】従って本発明の目的は、品質管理の結果を
受ける前に、定期的にバックラッシュの変位量を検出す
ることによって、経年変化によるロボットの位置及び軌
跡のズレを把握し、警報を発することによって、ロボッ
トの使用停止及び位置補償することにより、製品の品質
の安定化を図るとともに生産性の向上を提供し、加え
て、ロボットの制御軸駆動系の摩耗や損傷の発生を防止
することである。
Therefore, an object of the present invention is to detect the displacement amount of backlash on a regular basis before receiving the result of quality control, thereby grasping the deviation of the position and trajectory of the robot due to aging, and issuing an alarm. By stabilizing the robot and compensating the position, the product quality is stabilized and productivity is improved, and in addition, the control axis drive system of the robot is prevented from being worn or damaged. Is.

【0005】[0005]

【課題を解決するための手段】本発明は、上述した目的
を達成する手段として、請求項1に記載された手段は、
減速機構を介して可動部を駆動するモータと、その減速
機構に対してモータ側に配置され、可動部の位置を検出
する位置検出手段とを備えたロボットを制御するロボッ
ト制御装置において、少なくとも相対する2つの内壁面
を有する基準器と、この基準器の内壁面間に挿入可能な
接触子を有する変位検出器との一方をロボットの可動部
に設け、他方を固定部に固定し、変位検出器と基準器と
を正方向及び逆方向に相対移動させる移動手段と、この
移動手段による正方向及び逆方向の相対移動によって変
位検出器の接触子が基準器の相対する2つの内壁面に接
触したことを検出し、この時の変位検出器と基準器との
相対移動量を位置検出手段より検出する移動量検出手段
と、この移動量検出手段によって検出された相対移動量
に基づいた、ロボットのバックラッシュ量を確認する出
力値を出力する出力手段とを備えたものである。
According to the present invention, as a means for achieving the above-mentioned object, the means described in claim 1 is
In a robot control device for controlling a robot including a motor that drives a movable part via a speed reduction mechanism, and a position detection unit that is disposed on the motor side with respect to the speed reduction mechanism and that detects the position of the movable part, at least One of a reference device having two inner wall surfaces and a displacement detector having a contact that can be inserted between the inner wall surfaces of the reference device is provided in a movable part of the robot, and the other is fixed to a fixed part to detect displacement. Means for relatively moving the measuring device and the reference device in the forward and reverse directions, and the contact of the displacement detector contacts two inner wall surfaces of the reference device facing each other by the relative movement in the forward and reverse directions by the moving device. The movement amount detecting means for detecting the relative movement amount of the displacement detector and the reference device at this time by the position detecting means, and the robot based on the relative movement amount detected by the movement amount detecting means. It is obtained and output means for outputting an output value to verify the amount of backlash of bets.

【0006】また、請求項2に記載された手段は、減速
機構を介して可動部を駆動するモータと、その減速機構
に対してモータ側に配置され、可動部の位置を検出する
位置検出手段とを備えたロボットを制御するロボット制
御装置において、少なくとも相対する2つの内壁面を有
する基準器と、この基準器の内壁面間に挿入可能な接触
子を有する変位検出器との一方をロボットの可動部に設
け、他方を固定部に固定し、変位検出器と基準器とを正
方向及び逆方向に相対移動させる移動手段と、この移動
手段による正方向及び逆方向の相対移動によって変位検
出器の接触子が基準器の相対する2つの内壁面に接触し
たことを検出し、この時の変位検出器と基準器との相対
移動量を位置検出手段より検出する移動量検出手段と、
この移動量検出手段によって検出された相対移動量とあ
らかじめ定められた基準値に基づいて、ロボットの使用
の継続に関する可否の判定を行う判定手段と、この判定
手段による判定結果を出力する出力手段とを備えたもの
である。
The means described in claim 2 is a motor for driving a movable part through a speed reducing mechanism, and a position detecting means arranged on the motor side with respect to the speed reducing mechanism for detecting the position of the movable part. In a robot control device for controlling a robot including: a reference device having at least two inner wall surfaces facing each other, and a displacement detector having a contact insertable between the inner wall surfaces of the reference device. A moving means provided on the movable part and the other fixed to the fixed part, for moving the displacement detector and the reference device relative to each other in the forward and reverse directions, and the displacement detector by the relative movement in the forward and reverse directions by the moving means. Movement amount detecting means for detecting that the contact of the contactor has come into contact with two inner wall surfaces of the reference device facing each other, and the relative movement amount between the displacement detector and the reference device at this time is detected by the position detecting means,
Based on the relative movement amount detected by the movement amount detection means and a predetermined reference value, a determination means for determining whether or not the robot continues to be used, and an output means for outputting the determination result by the determination means. It is equipped with.

【0007】請求項3に記載された手段は、減速機構を
介して可動部を駆動するモータと、その減速機構に対し
てモータ側に配置され、可動部の位置を検出する位置検
出手段とを備えたロボットを制御するロボット制御装置
において、少なくとも相対する2つの内壁面を有する基
準器と、この基準器の内壁面間に挿入可能な接触子を有
する変位検出器との一方をロボットの可動部に設け、他
方を固定部に固定し、変位検出器と基準器とを正方向及
び逆方向に相対移動させる移動手段と、この移動手段に
よる正方向及び逆方向の相対移動によって変位検出器の
接触子が基準器の相対する2つの内壁面に接触したこと
を検出し、この時の変位検出器と基準器との相対移動量
を位置検出手段より検出する移動量検出手段と、この移
動量検出手段によって検出された相対移動量に基づい
て、ロボットを制御する指令値を補正する補正手段とを
備えたものである。
According to a third aspect of the present invention, there is provided a motor for driving a movable portion via a speed reducing mechanism, and position detecting means arranged on the motor side of the speed reducing mechanism for detecting the position of the movable portion. In a robot controller for controlling a robot equipped with the robot, one of a reference device having at least two inner wall surfaces facing each other and a displacement detector having a contact insertable between the inner wall surfaces of the reference device is provided as a movable part of the robot. And the other is fixed to the fixed part, the displacement detector and the reference device are moved relative to each other in the forward and reverse directions, and the displacement detector is brought into contact by the relative movement in the forward and reverse directions by the moving means. A moving amount detecting means for detecting the relative movement amount of the displacement detector and the reference device at this time by the position detecting means by detecting that the child has contacted two inner wall surfaces of the reference device, and this moving amount detection. By means Based on the detected relative movement amount Te, in which a correction means for correcting the command value for controlling the robot.

【0008】請求項4に記載された手段は、出力手段に
おける出力値は、基準器の相対する2つの内壁面の中心
値または基準器の相対する2つの内壁面間の距離である
ことを特徴とするものである。
According to a fourth aspect of the present invention, the output value of the output means is a center value of two inner wall surfaces of the reference device which face each other or a distance between two inner wall surfaces of the reference device which face each other. It is what

【0009】請求項5に記載された手段は、判定手段
は、ロボットの出荷時のデータと、移動量検出手段によ
って検出された相対移動量とを比較することによって、
ロボットの使用の継続に関する可否の判定を行うことを
特徴とするものである。
According to a fifth aspect of the present invention, the determining means compares the shipping data of the robot with the relative movement amount detected by the movement amount detecting means.
It is characterized by determining whether or not to continue using the robot.

【0010】[0010]

【作用】請求項1に記載された手段は、移動手段によっ
て変位検出器と基準器とを正方向及び逆方向に相対移動
させる。そして、移動量検出手段によって、変位検出器
の接触子が基準器の相対する2つの内壁面に接触したこ
とを検出し、この時の変位検出器と基準器との相対移動
量を位置検出手段により検出する。この出力値に基づい
て出力手段は、ロボットのバックラッシュ量を確認する
出力値を出力する。
The means described in claim 1 moves the displacement detector and the reference device relative to each other in the forward and reverse directions by the moving means. Then, the movement amount detecting means detects that the contacts of the displacement detector contact two inner wall surfaces of the reference device facing each other, and the relative movement amount between the displacement detector and the reference device at this time is detected by the position detecting means. To detect. Based on this output value, the output means outputs an output value for confirming the backlash amount of the robot.

【0011】請求項2に記載された手段は、移動手段に
よって変位検出器と基準器とを正方向及び逆方向に相対
移動させる。そして、移動量検出手段によって、変位検
出器の接触子が基準器の相対する2つの内壁面に接触し
たことを検出し、この時の変位検出器と基準器との相対
移動量を位置検出手段により検出する。この出力値に基
づいて判定手段は、ロボットの使用の継続に関する可否
の判定を行い、この判定結果を出力手段が出力する。
According to a second aspect of the present invention, the displacement detector relatively moves the displacement detector and the reference device in the forward and reverse directions by the moving means. Then, the movement amount detecting means detects that the contacts of the displacement detector contact two inner wall surfaces of the reference device facing each other, and the relative movement amount between the displacement detector and the reference device at this time is detected by the position detecting means. To detect. Based on this output value, the determination means determines whether or not to continue using the robot, and the output means outputs this determination result.

【0012】請求項3に記載された手段は、移動手段に
よって変位検出器と基準器とを正方向及び逆方向に相対
移動させる。そして、移動量検出手段によって、変位検
出器の接触子が基準器の相対する2つの内壁面に接触し
たことを検出し、この時の変位検出器と基準器との相対
移動量を位置検出手段により検出する。この出力値に基
づいて補正手段は、ロボットを制御する指令値を補正す
る。
According to a third aspect of the present invention, the displacement detector relatively moves the displacement detector and the reference device in the forward and reverse directions by the moving means. Then, the movement amount detecting means detects that the contacts of the displacement detector contact two inner wall surfaces of the reference device facing each other, and the relative movement amount between the displacement detector and the reference device at this time is detected by the position detecting means. To detect. The correction means corrects the command value for controlling the robot based on this output value.

【0013】請求項4に記載された手段は、出力手段
は、ロボットのバックラッシュ量を確認する出力値とし
て、基準器の相対する2つの内壁面の中心値または基準
器の相対する2つの内壁面間の距離を出力する。
According to a fourth aspect of the present invention, the output means uses, as an output value for confirming the backlash amount of the robot, the center value of two inner wall surfaces of the reference device or two of the two inner wall surfaces of the reference device which are opposed to each other. Output the distance between the walls.

【0014】請求項5に記載された手段は、判定手段
は、ロボットの出荷時のデータと移動量検出手段によっ
て検出された相対移動量とを比較することによって、ロ
ボットの使用の継続に関する可否の判定を行い、この判
定結果を出力手段が出力する。
According to a fifth aspect of the present invention, the determining means compares the data at the time of shipment of the robot with the relative movement amount detected by the movement amount detecting means to determine whether or not the robot continues to be used. A determination is made, and the result of this determination is output by the output means.

【0015】[0015]

【発明の効果】上述したように、本発明は、ロボットに
よって基準器と変位検出器とを相対移動させることによ
って、自動的にバックラッシュ量を知ることができる。
即ち、請求項1では、変位検出器と基準器との相対移動
量に基づいた値を出力することによって、作業者はロボ
ットのバックラッシュ量を知ることができる。請求項2
では、変位検出器と基準器との相対移動量と、あらかじ
め記憶された基準値との比較によってロボットの使用の
継続に関する可否の判定を行うため、バックラッシュ量
の増加によって、保守、点検が必要かどうかを知ること
ができる。このため、作業者による保守、点検作業は、
これらの結果から必要なときだけ行えば良いため、作業
が容易化される。また、このように確実に保守、点検が
必要な時期を知ることができるため、製品の品質の安定
化が図れるとともに、制御軸駆動系のギアの磨耗や、破
損から誘発される事故や災害の予防保全が図れる。さら
に、請求項3では、位置の補正が行われるため、一層、
作業が容易化するとともに、ロボットの精度を向上させ
ることができる。
As described above, according to the present invention, the amount of backlash can be automatically known by the relative movement of the reference device and the displacement detector by the robot.
That is, in claim 1, the worker can know the backlash amount of the robot by outputting the value based on the relative movement amount of the displacement detector and the reference device. Claim 2
In order to determine whether or not to continue using the robot by comparing the amount of relative movement between the displacement detector and the reference device with a previously stored reference value, maintenance and inspection are required due to an increase in the amount of backlash. You can know if Therefore, maintenance and inspection work by workers is
From these results, the work can be facilitated because it can be performed only when necessary. In addition, since it is possible to know when maintenance and inspection are required, it is possible to stabilize product quality and prevent accidents or disasters caused by wear or damage of the control axis drive system gear. Preventive maintenance can be achieved. Further, in claim 3, since the position is corrected, further
The work can be facilitated and the accuracy of the robot can be improved.

【0016】[0016]

【実施例】以下、本発明を具体的な実施例に基づいて説
明する。図1は、位置補償付ロボット制御装置の機構を
示した機構図である。6軸多関節ロボットの本体10
は、ベース12を配設して床に固定され、このベース1
2上に以下に示すロボットの可動部が取り付けられてい
る。即ち、ベース12上にはコラム13が固設されてボ
ディ14を制御軸aの回りに回転自在に配設している。
ボディ14はアッパーアーム15を制御軸bの回りに回
転自在に軸支しており、アッパーアーム15はフォアア
ーム16を制御軸cの回りに回転自在に軸支している。
フォアアーム16の先端部には、リスト17が制御軸d
の回りに回転自在に軸支され、リスト17にはハンド1
8が制御軸e及び制御軸fの回りに回転自在に軸支され
ている。また、ハンド18は筒状の基準器Bを把持して
いる。
EXAMPLES The present invention will be described below based on specific examples. FIG. 1 is a mechanism diagram showing a mechanism of a robot controller with position compensation. 6-axis articulated robot body 10
Is fixed to the floor by arranging the base 12, and the base 1
The movable part of the robot shown below is attached to the upper part of the robot 2. That is, the column 13 is fixedly mounted on the base 12 and the body 14 is rotatably arranged around the control axis a.
The body 14 rotatably supports an upper arm 15 about a control axis b, and the upper arm 15 rotatably supports a forearm 16 about a control axis c.
At the tip of the forearm 16, the wrist 17 has a control axis d.
It is rotatably supported around the
8 is rotatably supported around the control shaft e and the control shaft f. Further, the hand 18 holds the tubular reference device B.

【0017】なお、ロボットの手首フランジ部、或いは
ツールの一部に変位検出器S1に対応した孔を設けて基
準器Bとしてもよい。さらに、基準器Bは、必ずしも筒
状である必要はなく、相対する2つの内壁面を有する部
材であればよい。変位検出器S1は変位検出器保持台5
0に挟持され、変位検出器S1の先端部の接触子は基準
器Bの内壁に接触することなく、内部に位置できるよう
な大きさに設定されている。そして、この変位検出器S
1は、接触子が基準器Bの内壁が接触したことを検出で
きる接触センサとなっている。また、後述する変位検出
器S2は、変位検出器S1と方向が異なるのみで、同一
の構成となっている。この実施例では、ロボットに基準
器Bを設け、変位検出器S1を固定した構成であるが、
逆に変位検出器S1をロボットに設けてもよい。
It should be noted that a hole corresponding to the displacement detector S1 may be provided in the wrist flange portion of the robot or a part of the tool as the reference device B. Further, the reference device B does not necessarily have to be cylindrical and may be a member having two inner wall surfaces facing each other. The displacement detector S1 is a displacement detector holder 5
The contactor at the tip of the displacement detector S1 sandwiched between 0 is set to a size such that it can be positioned inside without contacting the inner wall of the reference device B. And this displacement detector S
Reference numeral 1 is a contact sensor capable of detecting that the contactor has contacted the inner wall of the reference device B. The displacement detector S2, which will be described later, has the same configuration as the displacement detector S1 except that the direction is different. In this embodiment, the robot is provided with the reference device B and the displacement detector S1 is fixed.
Conversely, the displacement detector S1 may be provided in the robot.

【0018】図2は、位置補償付ロボット制御装置の電
気的構成を示したブロックダイヤグラムである。CPU
20は、マイクロコンピュータ等からなる中央処理装置
であり、CPU20には、サーボモータを駆動するサー
ボCPU22a〜22f、警報装置23、変位検出器S
1からの検出信号を入力する入出力インタフェース2
4、メモリ25、ジョグ運転の指令等を行う操作盤26
が接続されている。
FIG. 2 is a block diagram showing the electrical configuration of the robot controller with position compensation. CPU
Reference numeral 20 denotes a central processing unit including a microcomputer, and the CPU 20 includes servo CPUs 22a to 22f for driving servo motors, an alarm device 23, and a displacement detector S.
Input / output interface 2 for inputting the detection signal from 1
4, memory 25, operation panel 26 for instructing jog operation, etc.
Is connected.

【0019】入出力インタフェース24には、変位検出
器S1及び変位検出器S2が接続されている。サーボC
PU22a〜22fでは、CPU20からの出力角度デ
ータθ1〜θ6と、各サーボモータと連結した位置検出
器としてのエンコーダE1〜E6(アブソリュートエン
コーダ)からの出力値との偏差を演算し、偏差の値の分
だけをサーボモータM1〜M6に出力する。サーボモー
タM1〜M6は、それぞれサーボCPU22a〜22f
からの指令により駆動され、各制御軸a〜fの回転角
は、それぞれエンコーダE1〜E6によって検出され
る。メモリ25は、基準器Bの検出データ並びに出荷時
の基準器Bの位置データが記憶される。
A displacement detector S1 and a displacement detector S2 are connected to the input / output interface 24. Servo C
In the PUs 22a to 22f, the deviations between the output angle data θ1 to θ6 from the CPU 20 and the output values from the encoders E1 to E6 (absolute encoders) as position detectors connected to the respective servo motors are calculated, and the deviation values are calculated. Only the minute is output to the servo motors M1 to M6. The servo motors M1 to M6 are servo CPUs 22a to 22f, respectively.
The rotation angles of the control axes a to f are detected by the encoders E1 to E6, respectively. The memory 25 stores the detection data of the reference device B and the position data of the reference device B at the time of shipment.

【0020】図3、上記に示した構成をモデル化したも
のである。ロボットの先端に設けられた基準器Bと各制
御軸a〜f回りの回転駆動を行うサーボモータM(M1
〜M6)との間には、バックラッシュの発生源となる減
速機構10aが存在している。また、この減速機構10
aに対して、サーボモータM側にエンコーダ(E1〜E
6)が取り付けられている。このため、後述するように
バックラッシュ量が増大するにつれて、基準器Bの内径
を計測するエンコーダEの値も増大することになる。
FIG. 3 is a model of the configuration shown above. A reference motor B provided at the tip of the robot and a servomotor M (M1 for rotating around each control axis af).
To M6), there is a speed reduction mechanism 10a which is a source of backlash. In addition, this reduction mechanism 10
Encoders (E1 to E
6) is attached. Therefore, as will be described later, as the amount of backlash increases, the value of the encoder E that measures the inner diameter of the reference device B also increases.

【0021】図4は、変位検出器S1及びS2とワール
ド座標系との位置関係を示す。水平面領域での位置補償
には変位検出器S1を用い、垂直面領域での位置補償に
は変位検出器S2を用いる。変位検出器S1とワールド
座標系との位置関係から、変位検出器S1によって検出
可能な制御軸はa軸とf軸の2つの制御軸であり、変位
検出器S2においてはb軸からe軸までの4つの制御軸
が検出可能である。なお、変位検出器S2を用いる場合
には、基準器Bの穴の方向は水平方向を向いている必要
がある。
FIG. 4 shows the positional relationship between the displacement detectors S1 and S2 and the world coordinate system. The displacement detector S1 is used for position compensation in the horizontal plane region, and the displacement detector S2 is used for position compensation in the vertical plane region. From the positional relationship between the displacement detector S1 and the world coordinate system, the control axes that can be detected by the displacement detector S1 are two control axes, the a axis and the f axis, and in the displacement detector S2, the b axis to the e axis. 4 control axes can be detected. When the displacement detector S2 is used, the hole of the reference device B needs to be horizontal.

【0022】図5及び図6は、それぞれ当実施例装置に
おける水平面及び垂直面での6軸多関節ロボットの動作
領域を示している(ただし、図4、図5における6軸多
関節ロボットは平行リンクタイプのものである。)。そ
して、この動作領域における斜線部分は、特によく使用
される領域である水平面及び垂直面常用領域である。本
実施例においては通常作業の妨げとならず、しかも、検
出の対象となる制御軸において使用頻度の多い領域を、
変位検出の対象となる領域とした。このため、変位検出
器S1は水平面常用領域における非垂直面常用領域に設
置することが望ましく、変位検出器S2は垂直面常用領
域における非水平面常用領域に設置することが望まし
い。
FIGS. 5 and 6 show the operation areas of the 6-axis articulated robot in the horizontal plane and the vertical plane in the apparatus of this embodiment (however, the 6-axis articulated robot in FIGS. 4 and 5 are parallel to each other). Link type.) The shaded areas in this operation area are the horizontal plane and the vertical plane normal use area, which are particularly frequently used areas. In the present embodiment, the normal work is not hindered, and moreover, the frequently used area in the control axis to be detected is
It was set as the area for displacement detection. Therefore, it is desirable that the displacement detector S1 is installed in the non-vertical plane regular area in the horizontal plane regular area, and the displacement detector S2 is desirably installed in the non-horizontal plane regular area in the vertical plane regular area.

【0023】次に、作用について説明する。図7は、当
実施例装置において使用されているCPU20の変位検
出に関する処理手順を示したフローチャートである。便
宜上、ここでは制御軸としてa軸を変位検出器としてS
1を用いて説明する。まず、変位検出に際して、ロボッ
トを作動させ、基準器B内に変位検出器S1の先端が位
置するように位置決めする。この状態からステップ10
0においてa軸を低速で逆転駆動させ、ハンド18によ
り挟持されている基準器Bをマイナス方向に移動させ
る。変位検出器S1は空間固定されているため、a軸が
ステップ100により逆転駆動されると基準器Bの内壁
と変位検出器S1の先端部との距離が狭まり、接触に到
る。このとき、この接触状態をステップ110において
電気の導通信号として検出し、ステップ120において
a軸の逆転駆動を停止させ、ステップ130においてこ
の時点のエンコーダ値を取り込み、このエンコーダ値を
ステップ140においてメモリ25に記憶させる。これ
によって、基準器Bの内径の一端のデータが取得され
る。
Next, the operation will be described. FIG. 7 is a flowchart showing a processing procedure relating to displacement detection of the CPU 20 used in the apparatus of this embodiment. For convenience, here, the a axis is used as the control axis and the
This will be described using 1. First, at the time of displacement detection, the robot is operated and positioned so that the tip of the displacement detector S1 is positioned inside the reference device B. From this state, step 10
At 0, the a-axis is reversely driven at low speed to move the reference device B held by the hand 18 in the minus direction. Since the displacement detector S1 is fixed in space, when the a-axis is reversely driven in step 100, the distance between the inner wall of the reference device B and the tip of the displacement detector S1 is narrowed, and the contact is reached. At this time, this contact state is detected as an electrical conduction signal in step 110, the reverse rotation drive of the a-axis is stopped in step 120, the encoder value at this point is fetched in step 130, and this encoder value is stored in the memory 25 in step 140. To memorize. Thereby, the data of one end of the inner diameter of the reference device B is acquired.

【0024】同様に、ステップ150においてa軸を低
速で正転駆動させ、ハンド18により挟持されている基
準器Bをプラス方向に移動させる。変位検出器S1は空
間固定されているため、a軸がステップ150により正
転駆動されると基準器Bの内壁の他端と変位検出器S1
の先端部との距離が狭まり、接触に到る。このとき、こ
の接触状態をステップ160において電気の導通信号と
して検出し、ステップ170においてa軸の正転駆動を
停止させ、ステップ180においてこの時点のエンコー
ダ値を取り込み、このエンコーダ値をステップ190に
おいてメモリ25に記憶させる。これによって、基準器
Bの内径の他端のデータも取得される。ステップ200
において、メモリ25から記憶されたデータを取り出
し、そのデータを用いてステップ210において演算を
行う。ステップ210における演算は基準器Bの基準位
置算出を行うもので式1に示される演算式を用いる。こ
こで、基準位置は基準器Bの内径の中心とした。
Similarly, in step 150, the a-axis is driven at a low speed in the forward direction to move the reference device B held by the hand 18 in the plus direction. Since the displacement detector S1 is fixed in space, when the a-axis is normally driven in step 150, the other end of the inner wall of the reference device B and the displacement detector S1 are driven.
The distance from the tip of the will decrease, and it will come into contact. At this time, this contact state is detected as an electrical conduction signal in step 160, the forward rotation drive of the a-axis is stopped in step 170, the encoder value at this point is fetched in step 180, and this encoder value is stored in step 190. 25. Thereby, the data of the other end of the inner diameter of the reference device B is also acquired. Step 200
At, the stored data is taken out from the memory 25, and an operation is performed in step 210 using the data. The calculation in step 210 is to calculate the reference position of the reference device B, and the calculation formula shown in Formula 1 is used. Here, the reference position was the center of the inner diameter of the reference device B.

【0025】[0025]

【数 1】 θiNmean =( θiNmax + θiNmin )÷2 ─(1) ここで、θiNmax は制御軸aを正転駆動させたときの基
準器Bの内径の一端の位置データ、θiNmin は制御軸a
を逆転駆動させたときの基準器Bの内径の他端の位置デ
ータ、θiNmeanは基準位置、即ち、内径の中心の値であ
る。添え字のiは i番目の軸という意味であり、N はN
番目のデータという意味である。このように、本実施例
の変位検出は定期的に行われ、検出されたデータの順に
番号Nを付与する。
[Equation 1] θiNmean = (θiNmax + θiNmin) ÷ 2 ─ (1) where θiNmax is the position data of one end of the inner diameter of the reference device B when the control axis a is driven in the forward direction, and θiNmin is the control axis a.
The position data of the other end of the inner diameter of the reference device B when θ is driven in the reverse direction, θiNmean is the reference position, that is, the center value of the inner diameter. The subscript i means i-th axis and N is N
It means the second data. In this way, the displacement detection of this embodiment is performed periodically, and the number N is given to the detected data in the order.

【0026】図8は、式1における演算結果をもとに、
縦軸に基準位置θiNmeanを、横軸にN をとり、グラフ化
したものである。図8は右肩上がりのグラフとなるが、
これはロボットの使用時間の増加とともに制御軸駆動系
のギアのバックラッシュ量が増加するために、基準位置
θiNmeanが増加するためである。図中のθc は製品の品
質を確保できる範囲内でロボットの使用が可能であるた
めの基準位置の上限値であり、ステップ220において
θc とθiNmeanとの比較を行う。ここでθiNmeanがθc
を超えた場合には、ステップ230において警報装置2
3にアラーム信号を出力する。また、警報装置23への
アラーム信号の出力とともに、操作盤26にモニター表
示或いは、ロボットの自動停止等を行ってもよい。警報
装置23では、アラーム信号の入力を受けて、アラーム
音の発生あるいはアラームランプの点灯等を行ってもよ
い。
FIG. 8 is based on the calculation result of the equation (1).
The vertical axis represents the reference position θiNmean and the horizontal axis represents N, which is a graph. Although the graph in Fig. 8 rises to the right,
This is because the reference position θiNmean increases because the amount of backlash of the gear of the control axis drive system increases as the usage time of the robot increases. Θc in the figure is the upper limit value of the reference position for allowing the robot to be used within the range where the quality of the product can be secured, and in step 220, θc and θiNmean are compared. Where θiNmean is θc
If it exceeds the limit, in step 230, the alarm device 2
Output an alarm signal to 3. In addition to the output of the alarm signal to the alarm device 23, a monitor may be displayed on the operation panel 26, or the robot may be automatically stopped. The alarm device 23 may generate an alarm sound or light an alarm lamp upon receiving an alarm signal.

【0027】図7のフローチャートにおいて、ステップ
100からステップ120まで及びステップ150から
ステップ170までが移動手段に相当する部分であり、
ステップ130からステップ140まで、ステップ18
0からステップ210までが移動量検出手段に相当する
部分であり、ステップ220が判断手段に相当する部分
である。
In the flowchart of FIG. 7, steps 100 to 120 and steps 150 to 170 correspond to the moving means,
Steps 130 to 140, Step 18
Steps 0 to 210 correspond to the movement amount detecting means, and step 220 corresponds to the determining means.

【0028】ステップ230において、製品の品質低下
の前に事前にアラーム信号を出力することにより、安定
した品質の確保を図ることができ、事後処理ではないた
めに生産性も向上することができる。また、アラームの
発生によって、バックラッシュが増加したままでのロボ
ットの使用を回避することができ、制御軸駆動系のギア
の磨耗や破損に誘発される事故や災害等の予防保全が可
能となる。尚、この基準位置θiNmeanの検出頻度は月1
回程度である。
In step 230, by outputting an alarm signal in advance before the quality of the product is deteriorated, stable quality can be ensured, and productivity can be improved because it is not post-processing. In addition, it is possible to avoid using the robot with increased backlash due to the occurrence of an alarm, and preventive maintenance such as accidents and disasters caused by wear and damage of the gears of the control axis drive system becomes possible. . The detection frequency of this reference position θiNmean is 1
It is about once.

【0029】次に、第二実施例として、アラーム発生の
処理手段において基準器Bの内径のデータを用いる場合
について説明する。第二実施例の装置全体の機構図、ブ
ロックダイヤグラム及びフローチャート等は第一実施例
と同じであるが、図7に示されるフローチャートのステ
ップ210「演算」の処理内容において、基準位置とし
て基準器Bの内径を用いることが特徴である。ステップ
210において用いられる演算式を式2に示す。
Next, as a second embodiment, a case of using data of the inside diameter of the reference device B in the alarm generation processing means will be described. The mechanism diagram, block diagram, flow chart, etc. of the entire apparatus of the second embodiment are the same as those of the first embodiment, but in the processing contents of step 210 "calculation" of the flow chart shown in FIG. The feature is that the inner diameter of is used. The arithmetic expression used in step 210 is shown in Expression 2.

【0030】[0030]

【数 2】 ΔiN = θiNmax − θiNmin ─(2) ここで、θiNmax は制御軸aを正転駆動させたときの基
準器Bの内径のデータ、θiNmin は制御軸aを逆転駆動
させたときの基準器Bの内径のデータであり、ΔiNは基
準器Bの内径のデータの値である。添え字のi は i番目
の軸という意味であり、N はN 番目のデータという意味
である。
[Formula 2] ΔiN = θiNmax − θiNmin ─ (2) where θiNmax is the data of the inner diameter of the reference device B when the control axis a is driven in the forward direction, and θiNmin is the reference when the control axis a is driven in the reverse direction. This is data of the inner diameter of the container B, and ΔiN is a value of the data of the inner diameter of the reference device B. The subscript i means the i-th axis and N means the N-th data.

【0031】図9は、式2における演算結果をもとに、
縦軸に基準器Bの内径のデータΔiNを、横軸にN をと
り、グラフ化したものである。図9も右肩上がりのグラ
フとなり、それはロボットの使用時間の増加とともに制
御軸駆動系のバックラッシュ量が増加するために、基準
器Bの内径のデータΔiNが増加するためである。図中の
Δc は製品の品質を確保できる範囲内でロボットの使用
が可能であるための基準器Bの内径のデータの上限値で
あり、ステップ220においてΔc とΔiNとの比較を行
う。ΔiNがΔc を超えた場合には、ステップ230にお
いて警報装置23にアラーム信号を出力する。
FIG. 9 is based on the calculation result of the equation (2).
The vertical axis represents the data ΔiN of the inner diameter of the reference device B, and the horizontal axis represents N, which is a graph. FIG. 9 also shows an upward-sloping graph because the backlash amount of the control axis drive system increases with the increase of the operating time of the robot, and the data ΔiN of the inner diameter of the reference device B increases. Δc in the figure is the upper limit value of the data of the inner diameter of the standard B for enabling the robot to be used within the range where the quality of the product can be secured, and in step 220, Δc and ΔiN are compared. If ΔiN exceeds Δc, an alarm signal is output to the alarm device 23 in step 230.

【0032】上述したように第一実施例及び第二実施例
では、変位検出器S1が基準器Bに接触した時の一端と
他端の位置データを記憶している。しかし、例えばパル
スジェネレータのように、基準器Bの移動をパルス数で
計測することによって、基準器Bの内径を測定する方法
としてもよい。この場合、このパルス数の1/2のパル
スの位置が内径の中心となる。また、上述の第一実施例
及び第二実施例では、ステップ220、ステップ230
においてθcとθiNとの比較結果に基づいてアラームを
出力しているが、場合によっては、θiNを直接表示した
り、比較結果を表示するようにしてもよい。
As described above, in the first and second embodiments, the position data of one end and the other end when the displacement detector S1 contacts the reference device B are stored. However, a method of measuring the inner diameter of the reference device B by measuring the movement of the reference device B by the number of pulses like a pulse generator may be used. In this case, the position of half the pulse number is the center of the inner diameter. Moreover, in the above-described first and second embodiments, step 220 and step 230.
In, the alarm is output based on the comparison result of θc and θiN. However, depending on the case, θiN may be directly displayed or the comparison result may be displayed.

【0033】さらに、第三実施例について説明する。第
三実施例における装置全体の機構図及びブロックダイヤ
グラム、フローチャート等については第一実施例並びに
第二実施例と同様である。図7のフローチャートにおい
て、第三実施例と第一実施例及び第二実施例との違い
は、ステップ210「演算」における演算式の内容であ
る。第三実施例の場合、出荷時の基準器Bの基準位置デ
ータを用いていることが特徴である。ステップ210に
おいて用いられる演算式を式3に示す。
Further, a third embodiment will be described. The mechanical diagram, block diagram, flow chart, etc. of the entire apparatus in the third embodiment are the same as those in the first and second embodiments. In the flowchart of FIG. 7, the difference between the third embodiment and the first and second embodiments is the content of the arithmetic expression in step 210 “calculation”. The third embodiment is characterized in that the reference position data of the reference device B at the time of shipment is used. The arithmetic expression used in step 210 is shown in Expression 3.

【0034】[0034]

【数 3】 εiN = θi0 − θiNmean ─(3) ここで、θi0は出荷時における基準器Bの基準位置デー
タ、θiNmeanはデータ取得時における基準器Bの基準位
置データであり、εiNはその時の誤差量の値である。添
え字のi は i番目の軸という意味であり、N はN 番目の
データという意味である。
[Equation 3] εiN = θi0 − θiNmean ─ (3) where θi0 is the reference position data of the reference device B at the time of shipment, θiNmean is the reference position data of the reference device B at the time of data acquisition, and εiN is the error at that time. The value of the quantity. The subscript i means the i-th axis and N means the N-th data.

【0035】図10は、式3における演算結果をもと
に、縦軸に誤差量εiNを、横軸にN をとり、グラフ化し
たものである。図10も右肩上がりのグラフとなり、そ
れはロボットの使用時間の増加とともに制御軸駆動系の
バックラッシュ量が増加するために、誤差量εiNが増加
するためである。図中のεc は製品の品質を確保できる
範囲内でロボットの使用が可能であるための誤差量の上
限値であり、ステップ220においてεc とεiNとの比
較を行う。εiNがεc を超えた場合には、ステップ23
0において警報装置23にアラーム信号を出力する。
FIG. 10 is a graph based on the calculation result of the equation 3 with the error amount εiN on the vertical axis and N on the horizontal axis. FIG. 10 also shows an upward-sloping graph because the error amount εiN increases because the backlash amount of the control axis drive system increases as the usage time of the robot increases. In the figure, εc is the upper limit of the error amount for allowing the robot to be used within the range where the quality of the product can be secured, and in step 220, εc and εiN are compared. If εiN exceeds εc, step 23
At 0, an alarm signal is output to the alarm device 23.

【0036】最後に、第四実施例について説明する。第
四実施例については、第三実施例と同様に出荷時のデー
タを用いるが、第三実施例との違いはバックラッシュの
補償機能を有することである。第四実施例における装置
全体の機構図及びブロックダイヤグラムは、第一実施
例、第二実施例及び第三実施例と同様である。
Finally, the fourth embodiment will be described. For the fourth embodiment, the data at the time of shipping is used as in the third embodiment, but the difference from the third embodiment is that it has a backlash compensation function. The mechanical diagram and the block diagram of the entire apparatus in the fourth embodiment are the same as those in the first embodiment, the second embodiment and the third embodiment.

【0037】第四実施例におけるフローチャートを図1
1に示す。図7におけるフローチャートとの違いは、ま
ず、ステップ90及びステップ145において制御軸を
移動させる前に、変位検出器S1の先端部を基準器Bの
内径の中心にセットするということであり、また、ステ
ップ240においてバックラッシュの補償を行うという
ことである。本実施例において検出されるデータは、正
転駆動時において得られる基準器Bの内径中心から内壁
の一端までのデータと、逆転駆動時において検出される
基準器Bの内径中心から内壁他端までのデータである。
ステップ210において用いられる演算式を式4及び式
5に示す。
FIG. 1 is a flowchart of the fourth embodiment.
It is shown in FIG. The difference from the flowchart in FIG. 7 is that the tip of the displacement detector S1 is set at the center of the inner diameter of the reference device B before the control axis is moved in step 90 and step 145. In step 240, backlash compensation is performed. The data detected in this embodiment includes data from the center of the inner diameter of the reference device B to one end of the inner wall obtained at the time of forward rotation, and data from the center of the inner diameter of the reference device B detected at the time of reverse rotation to the other end of the inner wall. Data.
The arithmetic expressions used in step 210 are shown in Expression 4 and Expression 5.

【0038】[0038]

【数 4】 εiNmax = θi0max − θiNmax ─(4)[Equation 4] εiNmax = θi0max − θiNmax ─ (4)

【0039】[0039]

【数 5】 εiNmin = θi0min − θiNmin ─(5) ここで、θi0max は出荷時における正転駆動時の基準器
Bのデータ、θiNmaxはデータ取得時における正転駆動
時の基準器Bのデータであり、εiNmax は正転駆動時の
誤差量の値である。同様に、θi0min は出荷時における
逆転駆動時の基準器Bのデータ、θiNminはデータ取得
時における逆転駆動時の基準器Bのデータであり、εiN
min は逆転駆動時の誤差量の値である。添え字のi は i
番目の軸という意味であり、N はN 番目のデータという
意味である。
[Equation 5] εiNmin = θi0min − θiNmin ─ (5) where θi0max is the data of the reference device B at the time of forward drive at the time of shipment and θiNmax is the data of the reference device B at the time of forward drive at the time of data acquisition. , ΕiNmax is a value of an error amount at the time of normal rotation driving. Similarly, θi0min is the data of the reference device B at the time of reverse driving at the time of shipping, θiNmin is the data of the reference device B at the time of reverse driving at the time of data acquisition, and εiN
min is the value of the error amount during reverse rotation drive. The subscript i is i
It means the nth axis and N means the Nth data.

【0040】図12は、式4及び式5における演算結果
をもとに、縦軸に誤差量εiNmax 及びεiNmin を、横軸
にN をとり、グラフ化したものである。図12も右肩上
がりのグラフとなり、それはロボットの使用時間の増加
とともに制御軸駆動系のギアのバックラッシュ量が増加
するために、誤差量εiNmax 及びεiNmin が増加するた
めである。図中のεc は製品の品質を確保できる範囲内
でロボットの使用が可能であるための誤差量の上限値で
あり、ステップ220においてεc とεiNmax 及びεc
とεiNmin との比較を行う。εiNmax 及びεiNmin がε
c を超えた場合には、ステップ230において警報装置
23にアラーム信号を出力する。
FIG. 12 is a graph in which the ordinates represent the error amounts εiNmax and εiNmin and the abscissa represents N, based on the calculation results in the equations 4 and 5. FIG. 12 also shows an upward-sloping graph because the backlash amount of the gears of the control axis drive system increases with the increase in the operating time of the robot, and the error amounts εiNmax and εiNmin increase. In the figure, εc is the upper limit of the error amount for enabling the robot to be used within the range where the quality of the product can be secured. In step 220, εc and εiNmax and εc
And εiNmin are compared. εiNmax and εiNmin are ε
If it exceeds c, an alarm signal is output to the alarm device 23 in step 230.

【0041】εiNmax 及びεiNmin がεc を超えない場
合には、ステップ240においてバックラッシュの補償
を行う。即ち、正転駆動時においてはεiNmax をCPU
20からサーボCPUへの指令に付加することによっ
て、逆転駆動時においてはεiNmin をCPU20からサ
ーボCPUへの指令に付加することによって、バックラ
ッシュの補償が可能となる。バックラッシュの補償につ
いては、自動的に補償を行ってもよい。また、ユーザー
コマンドにより補償を行ってもよいが、操作盤26にモ
ニター表示するだけでもよい。
If εiNmax and εiNmin do not exceed εc, backlash compensation is performed in step 240. That is, in normal rotation driving, εiNmax is
By adding the command from 20 to the servo CPU, by adding εiNmin to the command from the CPU 20 to the servo CPU at the time of reverse driving, backlash can be compensated. The backlash compensation may be automatically performed. Further, although compensation may be performed by a user command, it may be only displayed on the operation panel 26 as a monitor.

【図面の簡単な説明】[Brief description of drawings]

【図1】本実施例装置における6軸多関節ロボット及び
変位検出器等の位置関係を示した機構図。
FIG. 1 is a mechanism diagram showing a positional relationship between a 6-axis articulated robot, a displacement detector, and the like in the apparatus of this embodiment.

【図2】本実施例装置における位置補償付ロボット制御
装置の電気的構成を示したブロックダイヤグラム。
FIG. 2 is a block diagram showing an electrical configuration of a robot controller with position compensation in the apparatus of this embodiment.

【図3】本実施例装置の構成を示した模式図。FIG. 3 is a schematic diagram showing the configuration of the device of this embodiment.

【図4】本実施例装置におけるワールド座標系と変位検
出器との位置関係を示した説明図。
FIG. 4 is an explanatory diagram showing a positional relationship between a world coordinate system and a displacement detector in the device of this embodiment.

【図5】本実施例装置における水平面領域において用い
られる領域を示した説明図。
FIG. 5 is an explanatory view showing a region used in a horizontal plane region in the apparatus of this embodiment.

【図6】本実施例装置における垂直面領域において用い
られる領域を示した説明図。
FIG. 6 is an explanatory diagram showing a region used in a vertical plane region in the apparatus of this embodiment.

【図7】本実施例装置のうち、第一実施例、第二実施例
及び第三実施例において用いられる処理手順を示すフロ
ーチャート。
FIG. 7 is a flowchart showing a processing procedure used in the first embodiment, the second embodiment, and the third embodiment of the apparatus of this embodiment.

【図8】第一実施例において検出されるデータの変化を
示す説明図。
FIG. 8 is an explanatory diagram showing changes in data detected in the first embodiment.

【図9】第二実施例において検出されるデータの変化を
示す説明図。
FIG. 9 is an explanatory diagram showing changes in data detected in the second embodiment.

【図10】第三実施例において検出されるデータの変化
を示す説明図。
FIG. 10 is an explanatory diagram showing changes in data detected in the third embodiment.

【図11】本実施例装置のうち、第四実施例において用
いられる処理手順を示すフローチャート。
FIG. 11 is a flowchart showing a processing procedure used in a fourth embodiment of the apparatus of this embodiment.

【図12】第四実施例において検出されるデータの変化
を示す説明図。
FIG. 12 is an explanatory diagram showing changes in data detected in the fourth embodiment.

【符号の説明】[Explanation of symbols]

10 ロボット本体 18 ハンド 50 変位検出器保持台 O、X、Y、Z ワールド座標系 a〜f 制御軸 M1〜M6 サーボモータ E1〜E6 エンコーダ B 基準器 S1 a軸及びf軸対応の変位検出器(水平面領域) S2 b軸及びe軸対応の変位検出器(垂直面領域) 10 Robot main body 18 Hand 50 Displacement detector holder O, X, Y, Z World coordinate system a to f Control axis M1 to M6 Servo motor E1 to E6 Encoder B Reference device S1 Displacement detector for a-axis and f-axis ( Horizontal plane area) S2 Displacement detector for b-axis and e-axis (vertical plane area)

Claims (5)

【特許請求の範囲】[Claims] 【請求項1】減速機構を介して可動部を駆動するモータ
と、前記減速機構に対して前記モータ側に配置され、前
記可動部の位置を検出する位置検出手段とを備えたロボ
ットを制御するロボット制御装置において、 少なくとも相対する2つの内壁面を有する基準器と、こ
の基準器の前記内壁面間に挿入可能な接触子を有する変
位検出器との一方を前記ロボットの前記可動部に設け、
他方を固定部に固定し、 前記変位検出器と前記基準器とを正方向及び逆方向に相
対移動させる移動手段と、 この移動手段による正方向及び逆方向の相対移動によっ
て前記変位検出器の前記接触子が前記基準器の相対する
2つの内壁面に接触したことを検出し、この時の前記変
位検出器と前記基準器との相対移動量を前記位置検出手
段より検出する移動量検出手段と、 この移動量検出手段によって検出された相対移動量に基
づいた、前記ロボットのバックラッシュ量を確認する出
力値を出力する出力手段とを備えたことを特徴とするロ
ボット制御装置。
1. A robot having a motor for driving a movable part via a speed reduction mechanism, and position detecting means arranged on the motor side of the speed reduction mechanism for detecting the position of the movable part. In the robot controller, one of a reference device having at least two inner wall surfaces facing each other and a displacement detector having a contact insertable between the inner wall surfaces of the reference device is provided in the movable part of the robot,
The other of the displacement detector is fixed to the fixed portion, and the displacement detector and the reference device are relatively moved in the forward and reverse directions, and the displacement detector is moved by the relative movement in the forward and reverse directions. A movement amount detecting means for detecting that the contactor has contacted two inner wall surfaces of the reference device which face each other, and for detecting the relative movement amount of the displacement detector and the reference device at this time by the position detecting means. A robot controller, comprising: output means for outputting an output value for confirming the backlash amount of the robot based on the relative movement amount detected by the movement amount detection means.
【請求項2】減速機構を介して可動部を駆動するモータ
と、前記減速機構に対して前記モータ側に配置され、前
記可動部の位置を検出する位置検出手段とを備えたロボ
ットを制御するロボット制御装置において、 少なくとも相対する2つの内壁面を有する基準器と、こ
の基準器の前記内壁面間に挿入可能な接触子を有する変
位検出器との一方を前記ロボットの前記可動部に設け、
他方を固定部に固定し、 前記変位検出器と前記基準器とを正方向及び逆方向に相
対移動させる移動手段と、 この移動手段による正方向及び逆方向の相対移動によっ
て前記変位検出器の前記接触子が前記基準器の相対する
2つの内壁面に接触したことを検出し、この時の前記変
位検出器と前記基準器との相対移動量を前記位置検出手
段より検出する移動量検出手段と、 この移動量検出手段によって検出された相対移動量とあ
らかじめ定められた基準値に基づいて、前記ロボットの
使用の継続に関する可否の判定を行う判定手段と、 この判定手段による判定結果を出力する出力手段とを備
えたことを特徴とするロボット制御装置。
2. A robot provided with a motor for driving a movable part via a speed reduction mechanism, and a position detection means arranged on the motor side with respect to the speed reduction mechanism for detecting the position of the movable part. In the robot controller, one of a reference device having at least two inner wall surfaces facing each other and a displacement detector having a contact insertable between the inner wall surfaces of the reference device is provided in the movable part of the robot,
The other of the displacement detector is fixed to the fixed portion, and the displacement detector and the reference device are relatively moved in the forward and reverse directions, and the displacement detector is moved by the relative movement in the forward and reverse directions. A movement amount detecting means for detecting that the contactor has contacted two inner wall surfaces of the reference device which face each other, and for detecting the relative movement amount of the displacement detector and the reference device at this time by the position detecting means. A determination means for determining whether or not the robot continues to be used based on the relative movement amount detected by the movement amount detection means and a predetermined reference value; and an output for outputting the determination result by the determination means. And a robot controller.
【請求項3】減速機構を介して可動部を駆動するモータ
と、前記減速機構に対して前記モータ側に配置され、前
記可動部の位置を検出する位置検出手段とを備えたロボ
ットを制御するロボット制御装置において、 少なくとも相対する2つの内壁面を有する基準器と、こ
の基準器の前記内壁面間に挿入可能な接触子を有する変
位検出器との一方を前記ロボットの前記可動部に設け、
他方を固定部に固定し、 前記変位検出器と前記基準器とを正方向及び逆方向に相
対移動させる移動手段と、 この移動手段による正方向及び逆方向の相対移動によっ
て前記変位検出器の前記接触子が前記基準器の相対する
2つの内壁面に接触したことを検出し、この時の前記変
位検出器と前記基準器との相対移動量を前記位置検出手
段より検出する移動量検出手段と、 この移動量検出手段によって検出された相対移動量に基
づいて、前記ロボットを制御する指令値を補正する補正
手段とを備えたことを特徴とするロボット制御装置。
3. A robot having a motor for driving a movable part via a speed reduction mechanism, and position detection means arranged on the motor side of the speed reduction mechanism for detecting the position of the movable part. In the robot controller, one of a reference device having at least two inner wall surfaces facing each other and a displacement detector having a contact insertable between the inner wall surfaces of the reference device is provided in the movable part of the robot,
The other of the displacement detector is fixed to the fixed portion, and the displacement detector and the reference device are relatively moved in the forward and reverse directions, and the displacement detector is moved by the relative movement in the forward and reverse directions. A movement amount detecting means for detecting that the contactor has contacted two inner wall surfaces of the reference device which face each other, and for detecting the relative movement amount of the displacement detector and the reference device at this time by the position detecting means. A robot control apparatus comprising: a correction unit that corrects a command value that controls the robot based on the relative movement amount detected by the movement amount detection unit.
【請求項4】前記出力手段における出力値は、前記基準
器の相対する2つの内壁面の中心値または前記基準器の
相対する2つの内壁面間の距離であることを特徴とする
請求項1に記載のロボット制御装置。
4. The output value of the output means is a center value of two inner wall surfaces facing each other of the reference device or a distance between two inner wall surfaces facing each other of the reference device. The robot controller according to 1.
【請求項5】前記判定手段は、前記ロボットの出荷時の
データと、前記移動量検出手段によって検出された相対
移動量とを比較することによって、前記ロボットの使用
の継続に関する可否の判定を行うことを特徴とする請求
項2に記載のロボット制御装置。
5. The determination means determines whether or not to continue using the robot by comparing the shipping data of the robot with the relative movement amount detected by the movement amount detection means. The robot controller according to claim 2, wherein
JP24220894A 1994-09-08 1994-09-08 Robot control device Pending JPH0871966A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP24220894A JPH0871966A (en) 1994-09-08 1994-09-08 Robot control device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP24220894A JPH0871966A (en) 1994-09-08 1994-09-08 Robot control device

Publications (1)

Publication Number Publication Date
JPH0871966A true JPH0871966A (en) 1996-03-19

Family

ID=17085864

Family Applications (1)

Application Number Title Priority Date Filing Date
JP24220894A Pending JPH0871966A (en) 1994-09-08 1994-09-08 Robot control device

Country Status (1)

Country Link
JP (1) JPH0871966A (en)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2004103649A1 (en) * 2003-05-20 2004-12-02 Fujitsu Limited Method for controlling backlash compensation, backlash compensation controller and program for controlling backlash compensation
JP2014235587A (en) * 2013-06-03 2014-12-15 東芝機械株式会社 Machine tool and control method of the same
JP2017077602A (en) * 2015-10-20 2017-04-27 川崎重工業株式会社 Backlash measuring device and method
JP2017521266A (en) * 2014-05-20 2017-08-03 フラウンホッファ−ゲゼルシャフト・ツア・フェルダリュング・デア・アンゲヴァンテン・フォルシュング・エーファウ Joint configuration with at least one driven shaft
CN114750145A (en) * 2021-01-12 2022-07-15 曰轮法寺 Control method, device, system, storage medium and device for manipulator system

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2004103649A1 (en) * 2003-05-20 2004-12-02 Fujitsu Limited Method for controlling backlash compensation, backlash compensation controller and program for controlling backlash compensation
US7363109B2 (en) 2003-05-20 2008-04-22 Fujitsu Limited Backlash compensation control method, backlash compensation controller and backlash compensation control program
JP2014235587A (en) * 2013-06-03 2014-12-15 東芝機械株式会社 Machine tool and control method of the same
JP2017521266A (en) * 2014-05-20 2017-08-03 フラウンホッファ−ゲゼルシャフト・ツア・フェルダリュング・デア・アンゲヴァンテン・フォルシュング・エーファウ Joint configuration with at least one driven shaft
JP2017077602A (en) * 2015-10-20 2017-04-27 川崎重工業株式会社 Backlash measuring device and method
CN114750145A (en) * 2021-01-12 2022-07-15 曰轮法寺 Control method, device, system, storage medium and device for manipulator system

Similar Documents

Publication Publication Date Title
US5015821A (en) Computer controlled welding robot
JPH11502776A (en) Apparatus and method for calibration of multi-axis industrial robot
US11141855B2 (en) Robot system, method of controlling robot arm, recording medium, and method of manufacturing an article
US5189351A (en) Corrective positioning method in a robot
KR100222940B1 (en) Calibration method utilizing a sensor and its system
JP4618616B2 (en) Numerical controller
JPH0871966A (en) Robot control device
JPH03217907A (en) Numerical control method having circular arc interpolation locus display function and its device
JP2000055664A (en) Articulated robot system with function of measuring attitude, method and system for certifying measuring precision of gyro by use of turntable for calibration reference, and device and method for calibrating turntable formed of n-axes
JP7267688B2 (en) Robot system, robot arm control method, article manufacturing method, driving device, and driving device control method
JP2577713B2 (en) Control device for robot
JPS60118478A (en) Position control device for articulated robots
JP2649283B2 (en) Robot machining control method
JP2627006B2 (en) Method for controlling mutual distance between robot and workpiece and calibration data creation device therefor
JPH04322988A (en) robot joint mechanism
JPH04148307A (en) Detecting method for working force for force control robot
JPH0639066B2 (en) Control method for industrial robot
JPH05169351A (en) Machine tool thermal displacement compensation method
JPH01121904A (en) Correcting method for positioning data
US20240383142A1 (en) Robot system with stored position information of sensor
KR100224862B1 (en) Calibration device and method of robot arm
JP3855629B2 (en) Robot interference detection device
JPS6249513A (en) Automatic control method for robot machine constant
JPH01210643A (en) Control device for planetary differential type reducer
JPH0675004U (en) Numerical control device with double check function of machine origin