[go: up one dir, main page]
More Web Proxy on the site http://driver.im/

JPS6254303A - Robot controller - Google Patents

Robot controller

Info

Publication number
JPS6254303A
JPS6254303A JP19323485A JP19323485A JPS6254303A JP S6254303 A JPS6254303 A JP S6254303A JP 19323485 A JP19323485 A JP 19323485A JP 19323485 A JP19323485 A JP 19323485A JP S6254303 A JPS6254303 A JP S6254303A
Authority
JP
Japan
Prior art keywords
control
force
reaction force
robot
motor
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
JP19323485A
Other languages
Japanese (ja)
Inventor
Kinichi Tamura
田村 欣一
Teruo Asae
浅枝 暉雄
Tatsuo Naito
内藤 辰男
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.)
Nissan Motor Co Ltd
Original Assignee
Nissan Motor Co Ltd
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 Nissan Motor Co Ltd filed Critical Nissan Motor Co Ltd
Priority to JP19323485A priority Critical patent/JPS6254303A/en
Publication of JPS6254303A publication Critical patent/JPS6254303A/en
Pending legal-status Critical Current

Links

Landscapes

  • Numerical Control (AREA)
  • Manipulator (AREA)

Abstract

PURPOSE:To omit teaching by detecting reaction force applied to a leading tool while executing force reduction control of robot moving parts, and controlling a motor to apply pressing force and thrust corresponding to the size and direction of the reaction force to the tool. CONSTITUTION:A control device of a robot is constituted of a central processing part 23 such as a microcomputer and a servocontrol part for an arm driving motor 6 which consists of a position resistor 24 or the like. In addition, a control switching circuit 30 for switching play back control operation and free operation, a force sensor 15, a reaction force detecting part 32, and a pressing force/thrust arithmetic part 33. The arithmetic part 33 calculates the pressing force and thrust required for copy control in accordance with the size of X and Y directional components detected by the detecting part 32 and inputs the calculated values to the central processing part 23. Consequently, the central processing part 23 outputs a current command values Sa, Sb to control the driving current of the motor 6.

Description

【発明の詳細な説明】 〔産業上の利用分野〕 この発明は、ロボットによって被加工物(ワーク)の外
形を倣いながら作業を行なわせる倣い制御が可能なロボ
ットの制御装置に関する。
DETAILED DESCRIPTION OF THE INVENTION [Field of Industrial Application] The present invention relates to a robot control device capable of performing tracing control in which the robot performs work while tracing the outer shape of a workpiece.

〔従来の技術〕[Conventional technology]

近年、各種の産業用ロボットが工場の製造ラインで使用
されるようになり、組立(アッセンブリ)ロボットも実
用化されつつある。
In recent years, various industrial robots have come to be used on factory production lines, and assembly robots are also being put into practical use.

ところで、このような従来の産業用ロボットを用いて、
例えばワークの外周を研摩するような作業を倣い制御に
よって実施する場合には、ワークの外形を予めティーチ
ングしておいて、プレイバック時に、ロボットに取付け
た工具がワークの外形を倣うようにしていた。
By the way, using such conventional industrial robots,
For example, when performing work such as polishing the outer circumference of a workpiece using copying control, the outline of the workpiece is taught in advance so that the tool attached to the robot will follow the outline of the workpiece during playback. .

〔発明が解決しようとする問題点〕[Problem that the invention seeks to solve]

しかしながら、このような従来のロボットによる倣い制
御にあっては、ワークの外形を予めティーチングする必
要があり、しかもワークの外形を忠実に倣うことが難し
く、ワークの位置ずれや変形に対応できないという問題
点があった。
However, in such conventional tracing control using robots, it is necessary to teach the outline of the workpiece in advance, and it is difficult to faithfully follow the outline of the workpiece, and there are problems in that it is not possible to respond to misalignment or deformation of the workpiece. There was a point.

さらに、ワークの形状が変更されると新たなティーチン
グが必要になるという問題点もあった。
Furthermore, there is also the problem that new teaching is required when the shape of the workpiece is changed.

この発明は、これらの問題点を解決して、ティーチング
をする必要がなく、しかもワークの外形を忠実に倣って
作業を行なわせることのできるロボットの制御装置を提
供することを目的とする。
SUMMARY OF THE INVENTION An object of the present invention is to solve these problems and provide a robot control device that does not require teaching and can perform work by faithfully following the outer shape of a workpiece.

c問題点を解決するための手段〕 そのためこの発明は、速度指令値とロボットの可動部の
速度検出系からの速度フィードバック値との偏差に基づ
く指令値に応じて上記ロボットの可動部を駆動するモー
タの駆動電流を制御するロボットの制御装置において。
Means for Solving Problem c] Therefore, the present invention drives the movable part of the robot according to a command value based on the deviation between the speed command value and the speed feedback value from the speed detection system of the movable part of the robot. In a robot control device that controls the drive current of a motor.

上記速度指令値と速度フィードバック値との偏差に基づ
く指令値を実際の値に係わらず零にして」二記可動部を
力抜き状態にする制御切換手段と。
2. Control switching means that sets the movable part to a relaxed state by setting the command value based on the deviation between the speed command value and the speed feedback value to zero regardless of the actual value.

ロボットの上記可動部に取付けた工具に加わる被加工物
からの反力を検出する反力検出手段と、その反力検出手
段によって検出される反力の大きさ及び方向に応じて必
要な押圧力と推力とを算出する演算手段とを設け、 上記制御切換手段によって上記偏差に基づく指令値を零
にした状態で、上記演算手段によって算出された抑圧力
と推力を上記工具に与えるように上記モータの駆動電流
を制御して、上°記工具によって被加工物の外形を倣い
ながら作業を行なわせるようにしたものである。
A reaction force detection means for detecting the reaction force from the workpiece applied to the tool attached to the movable part of the robot, and a necessary pressing force depending on the magnitude and direction of the reaction force detected by the reaction force detection means. and a calculation means for calculating a thrust and a thrust, and the motor is configured to apply the suppressing force and thrust calculated by the calculation means to the tool while the command value based on the deviation is set to zero by the control switching means. The drive current of the workpiece is controlled to allow the tool to work while tracing the outer shape of the workpiece.

〔作  用〕[For production]

制御切換手段によって、速度指令値と速度フィードバッ
ク値との偏差に基づく指令値を零にすることによって、
プレイバンク制御が行なわれなくなり、モータの駆動電
流は一旦ゼロになる6したがって、そのモータによって
駆動されるロボットの可動部(アーム等)はその時の姿
勢を保持し。
By setting the command value based on the deviation between the speed command value and the speed feedback value to zero by the control switching means,
Playbank control is no longer performed, and the motor drive current temporarily becomes zero6. Therefore, the movable parts (arms, etc.) of the robot driven by the motors maintain their current postures.

外力によって自由に動かせる力抜き状態になる。It becomes a relaxed state where it can be moved freely by external force.

そして、その可動部に取付けた工具が作業対象であるワ
ーク(被加工物)に当接すると、反力検出手段によって
、工具に加わるワークからの反力が検出され、その大き
さ及び方向に応じて必要な押圧力と推力とが演算手段に
よって算出される。
When the tool attached to the movable part contacts the workpiece (workpiece), the reaction force detection means detects the reaction force from the workpiece applied to the tool, and depending on the magnitude and direction of the reaction force, the reaction force is detected by the reaction force detection means. The necessary pressing force and thrust are calculated by the calculation means.

そして、その算出された押圧力と推力を工具に与えるよ
うに上記モータの駆動電流を制御することにより、工具
がワークの外形を忠実に倣いながら作業を行なう。
Then, by controlling the driving current of the motor so as to apply the calculated pressing force and thrust to the tool, the tool performs the work while faithfully following the outer shape of the workpiece.

〔実施例〕〔Example〕

以下、この発明の実施例を図面に基づいて説明する。 Embodiments of the present invention will be described below based on the drawings.

先ず第2図を参照して、この実施例に使用するロボット
の構成及びその作業について説明する。
First, with reference to FIG. 2, the configuration and operation of the robot used in this embodiment will be explained.

同図中、1は水平多関節形のロボットであり、台座2上
に鉛直方向であるZ方向に立設固定した基部3と、この
基部3に対してタコジェネレータ4及びパルスジェネレ
ータ5を出力軸に取り付けたDCサーボモータ(以下、
単に「モータ」と云う)6の駆動力によってX−Y・平
面上を矢示01方向に旋回する可動部である第1のアー
ム7と、この第1のアーム7に対してやはりタコジェネ
レータ8及びパルスジェネレータ日を出力軸に取り付け
たDCサーボモータ(以下、単に「モータ」と云う)1
0の駆動力によってX−Y平面上を矢示θ2方向に旋回
する可動部である第2のアーム11とを備えている。
In the figure, reference numeral 1 is a horizontally articulated robot, which includes a base 3 that is erected and fixed in the vertical Z direction on a pedestal 2, and a tacho generator 4 and a pulse generator 5 are connected to the output shafts of the base 3. DC servo motor (hereinafter referred to as
A first arm 7, which is a movable part that rotates in the direction of arrow 01 on the A DC servo motor (hereinafter simply referred to as "motor") 1 with a pulse generator and a pulse generator attached to its output shaft
The second arm 11 is a movable part that rotates in the direction of arrow θ2 on the XY plane by a driving force of 0.

そして、この第2のアーム11に先端部にエアシリンダ
12を装着し、そのピストンの下端部12aに力センサ
15を介してグラインダ16を取付けて、鉛直方向であ
る矢示ZItZ2方向に昇降(上下動)させると共に、
グラインダ16は内蔵のモータ(図示を省略)の駆動力
によって研摩円板16aを矢示θ3方向に回転する。
Then, an air cylinder 12 is attached to the tip of this second arm 11, and a grinder 16 is attached to the lower end 12a of the piston via a force sensor 15, and the air cylinder 12 is moved up and down (up and down) in the vertical direction, ie, the arrow ZItZ2 direction. (movement) and
The grinder 16 rotates the polishing disk 16a in the direction of arrow θ3 by the driving force of a built-in motor (not shown).

エアシリンダ12のピストンは、先端にドッグ13を固
着した上方突出部12bを備えており。
The piston of the air cylinder 12 has an upwardly protruding portion 12b having a dog 13 fixed to its tip.

ピストンの上昇によりドッグ13がガイドロッド14に
沿って昇降し1図示のように上昇限まで上昇している時
に上昇限りミツトスイッチ21をオンにし、下降限まで
下降した時に下降限りミツトスイッチ21をオンにする
As the piston rises, the dog 13 moves up and down along the guide rod 14. When the dog 13 rises to the upper limit as shown in Figure 1, the upper limit switch 21 is turned on, and when the dog 13 descends to the lower limit, the lower limit switch 21 is turned on. Make it.

なお、この両リミットスイッチ21.22は、第2のア
ーム11に取付けた図示しな゛いステーなどに固定され
ている。
Note that both limit switches 21 and 22 are fixed to a stay (not shown) attached to the second arm 11.

この水平多関節形のロボット1は、各アーム7゜11の
矢示Z1方向の自重を支えられる構造となっているため
、後述する制御切換手段によってモータ6.10をフリ
ー状態にして、第1.第2のアーム7及び11を外力に
よって自由に動かし得るようにしても、その姿勢が崩れ
ることはない。
This horizontally articulated robot 1 has a structure that can support the weight of each arm 7°11 in the direction of arrow Z1. .. Even if the second arms 7 and 11 can be freely moved by external force, their postures will not collapse.

この第1.第2のアーム7.11にモータ6゜10の駆
動力を伝達する減速機として、逆伝達効率の比較的高い
もの(例えばベベルギアによるもの)を使用することに
より、モータ6及び10をフリー状態にするだけで外力
によって自由に動かせるようになる。
This first. By using a speed reducer with relatively high reverse transmission efficiency (for example, a bevel gear) to transmit the driving force of the motors 6 and 10 to the second arm 7 and 11, the motors 6 and 10 can be brought into a free state. By simply doing this, you will be able to move it freely using external force.

一方、17はコンベアであり、ワーククランプ1日によ
って位置決め固定したワーク18を載せて、ロボット1
のワークエリア内を矢示Y方向(紙面に垂直な方向)に
所定の速度で搬送する。
On the other hand, 17 is a conveyor, on which the workpiece 18 that has been positioned and fixed by the workpiece clamp is placed, and the robot 1
The work area is conveyed at a predetermined speed in the direction of arrow Y (direction perpendicular to the plane of the paper).

20は所定の作業位置に固設したワーク検知器であり、
ロボット1が予め定めた待機位置で待機している時に、
ワーク18の到来を検知する。
20 is a workpiece detector fixed at a predetermined working position;
While the robot 1 is waiting at a predetermined standby position,
The arrival of the workpiece 18 is detected.

なお、このワーク検知器20としては、例えば反射型の
光電スイッチなどを用いることができる。
Note that as the workpiece detector 20, for example, a reflective photoelectric switch or the like can be used.

力センサ15は、例えば第3図に示すように。The force sensor 15 is, for example, as shown in FIG.

円板状の取付板151に小径のストッパ保持筒152を
介して大径のセンサ保持筒153が固設され、このセン
サ保持筒153に十字形のセンサ取付板154の各偏部
を固着し、その・センサ取付板154の中心部に検出軸
としてとしてグラインダ16の円筒状本体16bを垂直
に貫通させて固着している。
A large-diameter sensor holding cylinder 153 is fixed to a disk-shaped mounting plate 151 via a small-diameter stopper holding cylinder 152, and each eccentric part of a cross-shaped sensor mounting plate 154 is fixed to this sensor holding cylinder 153. The cylindrical main body 16b of the grinder 16 is vertically penetrated and fixed to the center of the sensor mounting plate 154 as a detection shaft.

センサ取付板154には4個のセンサ素子(例えば半導
体ストレインケージ等の歪センサ素子)151〜15d
を貼着しており、ストッパ保持筒152には一対のスト
ッパボルト155が螺入して、検出軸としてのグライン
ダ本体16bの傾斜角を規制している。
The sensor mounting plate 154 has four sensor elements (for example, strain sensor elements such as semiconductor strain cages) 151 to 15d.
A pair of stopper bolts 155 are screwed into the stopper holding cylinder 152 to regulate the angle of inclination of the grinder main body 16b as a detection shaft.

この力センサ15は、センサ保持筒153に対してグラ
インダ1日が外力によって傾斜されると、その傾斜方向
及び傾斜度合に応じてセンサ取付板154が歪むため、
その歪量に応じて各センサ素子15a〜ISdの抵抗値
がそれぞれ変化する。
In this force sensor 15, when the grinder is tilted by an external force with respect to the sensor holding cylinder 153, the sensor mounting plate 154 is distorted depending on the direction and degree of the tilt.
The resistance value of each sensor element 15a to ISd changes depending on the amount of strain.

したがって、この力センサ15の取付板151を第2図
のエアシリンダ12のピストンの下端に固着しておくこ
とにより、グラインダ16がワーク18の研摩作業を行
なう際に受ける反力の大きさ及び方向をを検出すること
ができる。
Therefore, by fixing the mounting plate 151 of the force sensor 15 to the lower end of the piston of the air cylinder 12 shown in FIG. can be detected.

次に、第1図を参照して第2図に示したロボット1の制
御装置の実施例を説明する。
Next, an embodiment of the control device for the robot 1 shown in FIG. 2 will be described with reference to FIG.

同図において、23はマイクロコンピュータ等による中
央処理部であり、ロボット1の全搬的な制御を司ってお
り5位置指令レジスタ242位置制御部25.速度制御
部26.及び電流制御部27等からなる第1のアーム7
を駆動するモータ6用のサーボ制御部と、図示は省略し
ているが。
In the figure, reference numeral 23 denotes a central processing unit such as a microcomputer, which is in charge of overall control of the robot 1, and includes 5 position command registers 242 position control units 25. Speed control section 26. A first arm 7 consisting of a current control section 27, etc.
Although not shown, a servo control unit for the motor 6 that drives the motor 6 is also included.

このサーボ制御部と全く同様に構成した第2のアーム1
1を駆動するモータ10用のサーボ制御部と、エアシリ
ンダ12用の電磁弁等の駆動回路を制御する他、グライ
ンダ16の駆動・停止の制御。
A second arm 1 configured in exactly the same way as this servo control section
In addition to controlling the servo control unit for the motor 10 that drives the grinder 1 and the drive circuit such as the solenoid valve for the air cylinder 12, it also controls the drive and stop of the grinder 16.

及び後述する倣い制御時の各モータの駆動電流の制御等
も行なう。
It also controls the drive current of each motor during tracing control, which will be described later.

次に、モータ6用のサーボ制御部において1通常のプレ
イバック制御中は、中央処理部23からの第1のアーム
7の目標位置指令値が位置レジスタ24に逐次更新しな
がら書き込まれる。
Next, during normal playback control in the servo control section for the motor 6, the target position command value of the first arm 7 from the central processing section 23 is written into the position register 24 while being updated one after another.

位置制御部25は、位置指令レジスタ24に書き込まれ
ている第1のアーム7の目標位置指令値と、モータ6の
出力軸に取り付けたパルスジェネレータ5からの位置フ
ィードバックパルスを現在値カウンタ2Sによってモー
タ6の回転方向に応じてアップ又はダウンカウントする
ことによって得られる第1のアー ム7の現在位置を示
すカウント値(現在値)とを入力して、その偏差に基づ
く速度指令値を出力すると共に、目標位置指令値と現在
値とが一致して位置決めが完了する毎にそれを中央処理
部23に知らせ、中央処理部23はそれによって次に目
標位置指令値を出力するタイミングを測っている。
The position control unit 25 uses the target position command value of the first arm 7 written in the position command register 24 and the position feedback pulse from the pulse generator 5 attached to the output shaft of the motor 6 to control the motor using the current value counter 2S. A count value (current value) indicating the current position of the first arm 7 obtained by counting up or down depending on the rotation direction of the arm 6 is input, and a speed command value based on the deviation is output. Each time the target position command value and the current value match and positioning is completed, this is notified to the central processing unit 23, and the central processing unit 23 uses this to measure the timing for outputting the next target position command value.

速度制御部2日は、後述する制御切換手段である制御切
換回路30を介して入力される位置制御部25からの速
度指令値と、モータ6の出力軸に取り付けた第1のアー
ム7の速度検出系としてのタコジェネレータ4からの速
度フィードバック値との偏差に基づく電流指令値を出力
する。
The speed control unit 2 receives a speed command value from the position control unit 25 that is input via a control switching circuit 30, which is a control switching means to be described later, and the speed of the first arm 7 attached to the output shaft of the motor 6. A current command value is output based on the deviation from the speed feedback value from the tacho generator 4 as a detection system.

電流制御部27は、速度制御部26からの電流指令値と
、モータ6に流れる駆動電流を検出する電流検出器28
からの電流フィードバック値との偏差に基づく駆動電流
を第1のアーム7を駆動するモータ6に流す。
The current controller 27 includes a current detector 28 that detects the current command value from the speed controller 26 and the drive current flowing through the motor 6.
A drive current based on the deviation from the current feedback value from the first arm 7 is applied to the motor 6 that drives the first arm 7.

したがって、位置指令レジスタ242位置制御部25.
速度制御部26.及び電流制御部27等からなる第1の
アーム7を駆動するモータ6用のサーボ制御部は、制御
切換回路30が位置制御部25からの速度指令値とタコ
ジェネレータ4からの速度フィードバック値とをそのま
ま速度制御部2日へ出力している限りにおいては、中央
処理部23からの目標位置指令値に基づいて第1のアー
ム7をプレイバック制御(位置決め制御)することがで
きる。
Therefore, the position command register 242 position control section 25.
Speed control section 26. In the servo control unit for the motor 6 that drives the first arm 7, which includes a current control unit 27 and the like, a control switching circuit 30 converts the speed command value from the position control unit 25 and the speed feedback value from the tacho generator 4. As long as the output is output to the speed control section 2 as is, playback control (positioning control) of the first arm 7 can be performed based on the target position command value from the central processing section 23.

第2のアーム7を駆動するモータ10用の図示しないサ
ーボ制御部も、モータ6用のサーボ制御部と全く同様に
構成され、やはり制御切換回路30が速度指令値と速度
フィードバック値(タコジェネレータ8からの値)とを
そのまま速度制御部に出力している限りにおいては、中
央処理部23からの目標位置指令値に基づいて第2のア
ーム11をプレイバック制御(位置決め制御)すること
ができる。  − エアシリンダ12用の駆動回路は、公知のシリンダ操作
回路からなり、その電磁式方向切換弁を中央処理部23
からの指令で切り換えることによって、第2図のグライ
ンダ15を矢示ZI、Z2方向に昇降させる。
The servo control unit (not shown) for the motor 10 that drives the second arm 7 is configured in exactly the same way as the servo control unit for the motor 6, and the control switching circuit 30 also controls the speed command value and the speed feedback value (tacho generator 8 As long as the value from the central processing unit 23 is output as is to the speed control unit, the second arm 11 can be playback controlled (positioning controlled) based on the target position command value from the central processing unit 23. - The drive circuit for the air cylinder 12 consists of a known cylinder operation circuit, and its electromagnetic directional control valve is connected to the central processing unit 23.
The grinder 15 shown in FIG. 2 is moved up and down in the directions of arrows ZI and Z2 by switching in accordance with a command from the operator.

制御切換回路30は、リレーコイルRyを励磁すること
によって4個の可動接片30a、30b。
The control switching circuit 30 switches four movable contact pieces 30a, 30b by exciting a relay coil Ry.

30c、30d (30c、30dの2個は図示してい
ない)が夫々固定接点a1 r a2 r a 3 r
 a 4から固定接点)11 pb2 +b3 rb4
  (a3 ra4 +b3.b4も図示していない)
に切り換わる4連式トランスファ切換接点を有する電磁
リレーからなり、モータ6用のサーボ制御部に用いる可
動接片30a、30b及び固定接点alzblとa2゜
b2は、可動接片30a、30bが夫々速度制御部26
の入力側に接続されると共に、固定接点al t 82
が夫々アースに、固定接点b1が位置制御部25の出力
側に、固定接点b2がタコジェネレータ4に夫々接続さ
れている。
30c and 30d (the two 30c and 30d are not shown) are fixed contacts a1 r a2 r a 3 r, respectively.
a 4 to fixed contact) 11 pb2 +b3 rb4
(a3 ra4 +b3.b4 are also not shown)
The movable contact pieces 30a, 30b and the fixed contacts alzbl and a2°b2 used in the servo control section for the motor 6 are composed of an electromagnetic relay having four transfer switching contacts that switch to the speed. Control unit 26
is connected to the input side of the fixed contact al t 82
are connected to ground, the fixed contact b1 is connected to the output side of the position control section 25, and the fixed contact b2 is connected to the tachogenerator 4.

また1図示しない残りの可動接片3oc、30dと固定
接点a3 、a4とb3.b4は、モータ10用のサー
ボ制御部における位置制御部及びタコジェネレータ8と
速度制御部との間に、可動接片:50a、30b及び固
定接点al +82とbl+b2と全く同様に接続され
ている。
In addition, the remaining movable contact pieces 3oc, 30d and fixed contacts a3, a4 and b3. b4 is connected between the position control unit and tachogenerator 8 in the servo control unit for the motor 10, and the speed control unit in exactly the same way as the movable contact pieces 50a, 30b and the fixed contacts al+82 and bl+b2.

なお、リレーコイルRyの′rt1端に接続したダイオ
ードDはフライホイールダイオードである。
Note that the diode D connected to the 'rt1 end of the relay coil Ry is a flywheel diode.

この制御切換回路30は、リレーコイルR′yに通電さ
れると、各可動接片30.〜30dを図示のように固定
接点b1〜b4側に切り換えて、実際の速度指令値と速
度フィードバック値とをそのまま通過させてモータ6.
10用の各サーボ制御部を夫々本来のプレイバック制御
動作させる。
When the relay coil R'y is energized, the control switching circuit 30 switches between each movable contact piece 30. 30d to the fixed contacts b1 to b4 as shown in the figure, and the actual speed command value and speed feedback value are passed through as they are to the motor 6.
Each servo control unit for 10 is operated for original playback control.

そして、リレーコイルRyへの通電が断たれると、各可
動接片30a〜30dを固定接点a1〜a4側に切り換
えて、速度指令値と速度フィードバック値を共にその切
り換え前のプレイバック制御に係る値からそれとは無関
係な零値(アース値)に切り換え、それによって第1の
アーム7を駆動するモータ6用のサーボ制御部における
速度制御部26及び同じく第2のアーム11を駆動する
モータ10用の図示しないサーボ制御部における速度制
御部から夫々出力される電流指令値をモータ6.10の
動きに一関係なく零にする。
Then, when the power to the relay coil Ry is cut off, each movable contact piece 30a to 30d is switched to the fixed contact point a1 to a4 side, and both the speed command value and the speed feedback value are related to the playback control before the switching. value to an independent zero value (ground value) and thereby the speed control 26 in the servo control for the motor 6 driving the first arm 7 and also for the motor 10 driving the second arm 11. The current command values output from the speed control sections in the servo control sections (not shown) are set to zero regardless of the movement of the motors 6 and 10.

このように、電流指令値を実際の速度指令値と速度フィ
ードバック値に係わらず零にすると、位置及び速度フィ
ードバック制御が効かなくなるため、モータ6.10は
フリーの状態になり、それによって第1.第2のアーム
7.11は外力によって自由にX−Y平面上で旋回させ
得るようになる。この状態をrカ抜き状態Jという。
In this way, if the current command value is set to zero regardless of the actual speed command value and speed feedback value, the position and speed feedback control becomes ineffective, and the motor 6.10 becomes free, thereby causing the first. The second arm 7.11 can be freely pivoted in the X-Y plane by external forces. This state is called r-cut state J.

なお、この制御切換回路30のリレーコイルRyは、第
2図の上昇限りミツトスイッチ21がオフになった時、
すなわち第2図のエアシリンダ12がグラインダ16を
下降させた時に通電される。
Note that the relay coil Ry of this control switching circuit 30 is activated when the upward limit switch 21 in FIG. 2 is turned off.
That is, the air cylinder 12 in FIG. 2 is energized when the grinder 16 is lowered.

また、上昇限りミツトスイッチ21と並列に接続した手
段のスイッチ′51をオンにしておくと。
Further, if the switch '51 of the means connected in parallel with the limit switch 21 is turned on as far as the rise is concerned.

リレーコイルRyを常に通電状態にして、プレイバック
制御によって研摩作業を行なわせることもできる。
It is also possible to keep the relay coil Ry energized and perform the polishing work by playback control.

32は反力検出部で、第2図のグラインダ16によって
ワーク18の外周の研摩を行なう際にグラインダ16に
加わるワーク18からの反力の大きさ及び方向を力セン
サ15の4個のセンサ素子(第3図)の抵抗値の変化に
よって検出する。
Reference numeral 32 denotes a reaction force detection unit, which detects the magnitude and direction of the reaction force from the work 18 that is applied to the grinder 16 when the outer periphery of the work 18 is polished by the grinder 16 shown in FIG. It is detected by the change in resistance value (Fig. 3).

33は押付力・推力演算部で、反力検出部32によって
検出される反力のX方向成分とY方向成分の大きさに応
じて、倣い制御を行うのに必要な押付力と推力(詳細は
後述する)を算出し、X方向出力及びY方向出力として
中央処理部23へ入力させる。
Reference numeral 33 denotes a pushing force/thrust force calculation unit, which calculates the pushing force and thrust (details will be described later) and inputted to the central processing unit 23 as an X-direction output and a Y-direction output.

それによって、中央処理部23は、押付力・推力演算部
33によって算出された押付力と推力(X方向及びY方
向)をグランダ16に与えるように、モータ6及び10
の駆動電流を制御する。
Thereby, the central processing unit 23 causes the motors 6 and 10 to apply the pressing force and thrust (X direction and Y direction) calculated by the pressing force/thrust force calculation unit 33 to the grander 16.
control the drive current.

すなおち、前述の力抜き状態において、所要の電流指令
値Sa、Sbを出力して、Saを加算器34を介して電
流制御部27へ入力しくこの時は、速度制御部2日から
の電流指令値は零である)、sbを図示しないモータ1
0用のサーボ制御回路の電流制御部へ、やはり加算器を
介して入力して、各モータ6及び10の駆動電流を制御
する。
In other words, in the above-mentioned relaxed state, the required current command values Sa and Sb are output and Sa is inputted to the current control section 27 via the adder 34. At this time, the current from the speed control section 2 (command value is zero), motor 1 (sb not shown)
The current is also input to the current control section of the servo control circuit for 0 via an adder to control the drive current of each motor 6 and 10.

次に、反力検出部32と押付力・推力演算部33の詳細
を第4図及び第5図によって説明する。
Next, details of the reaction force detection section 32 and the pressing force/thrust force calculation section 33 will be explained with reference to FIGS. 4 and 5.

第3図に示した力センサ15のセンサ取付板154に9
0’ずつ角度を置いて貼着されている4個のセンサ素子
15a〜15dのうち、15aと15bが第4図のX方
向力センサを構成し、15cと15dがY方向力センサ
を構成している。
9 on the sensor mounting plate 154 of the force sensor 15 shown in FIG.
Of the four sensor elements 15a to 15d attached at an angle of 0', 15a and 15b constitute the X-direction force sensor in FIG. 4, and 15c and 15d constitute the Y-direction force sensor. ing.

すなわち、十字形のセンサ取付板154が第2図の水平
面内で直交するX方向とY方向に向くように力センサ1
5を取付けてあり、グラインダ16がX方向に傾斜する
とセンサ素子15a。
That is, the force sensor 1 is mounted so that the cross-shaped sensor mounting plate 154 faces the X direction and the Y direction, which are perpendicular to each other in the horizontal plane in FIG.
5 is attached, and when the grinder 16 is tilted in the X direction, the sensor element 15a.

ISbの一方が伸び他方が縮むので、一方の抵抗値が増
加して他方の抵抗値が減少する。グラインダ16がY方
向に傾斜すると、同様にしてセンサ素子ISC,ISd
の一方の抵抗値が増加し、他方の抵抗値が減少する。通
常はこれらの組合せとして現われる。
Since one ISb expands and the other contracts, the resistance value of one increases and the resistance value of the other decreases. When the grinder 16 tilts in the Y direction, the sensor elements ISC, ISd
The resistance value of one side increases and the resistance value of the other side decreases. It usually appears as a combination of these.

第4図の反力検出部32は、X方向力センサとしてのセ
ンサ素子ISa、15bの抵抗値変化から反力のX方向
成分tQm気信号として検出する反力検出回路41と、
Y方向力センサとしてのセンサ素子15C,15dの抵
抗値変化から反力のY方向成分を電気信号として検出す
る反力回路42とによって構成されている。
The reaction force detection unit 32 in FIG. 4 includes a reaction force detection circuit 41 that detects the X direction component of the reaction force as a signal tQm from the resistance change of the sensor elements ISa and 15b as X direction force sensors;
It is constituted by a reaction force circuit 42 that detects the Y direction component of the reaction force as an electric signal from the resistance change of the sensor elements 15C and 15d as Y direction force sensors.

反力検出回路41は1例えば第5図に示すように、ブリ
ッジ回路41aと直流アンプ41bとローパスフィルタ
41Cによって構成されている。
For example, as shown in FIG. 5, the reaction force detection circuit 41 includes a bridge circuit 41a, a DC amplifier 41b, and a low-pass filter 41C.

ブリッジ回路41aは、力センサ15のX方向力センサ
としての一対のセンサ素子15a、15bを2辺とし、
抵抗Ra、Rhを他の2辺として、a −b間に電源E
によって電圧を印加されており、c−d間にセンサ素子
ISa、ISbの抵抗値変化に応じた電圧を出力する。
The bridge circuit 41a has two sides of a pair of sensor elements 15a and 15b as X-direction force sensors of the force sensor 15,
With resistors Ra and Rh as the other two sides, a power supply E is connected between a and b.
A voltage is applied between the sensor elements c and d, and a voltage corresponding to a change in the resistance value of the sensor elements ISa and ISb is output.

直流アンプ41bは、オペアンプOP1と入力抵抗Re
、Rd及び帰還ボリュームVRfがらなり、ブリッジ回
路41aが出力する電圧を直流増幅する。その増幅度は
ボリュームVRfによって調整される。
The DC amplifier 41b includes an operational amplifier OP1 and an input resistor Re.
, Rd, and a feedback volume VRf, and DC amplify the voltage output from the bridge circuit 41a. The degree of amplification is adjusted by the volume VRf.

ローパスフィルタ41cは、積分回路を構成する抵抗R
e及びコンデンサCaと、バッファアンプを構成するオ
ペアンプoP2とがらなり、直流アンプ41bによって
増幅された検出信号のノイズ成分を除去して、グ・ライ
ング16がワーク18から受ける反力のX方向成分に応
じた電圧信号vxを出力する。
The low-pass filter 41c is a resistor R constituting an integrating circuit.
e and capacitor Ca, and an operational amplifier oP2 constituting a buffer amplifier, remove the noise component of the detection signal amplified by the DC amplifier 41b, and respond to the X-direction component of the reaction force that the grinding 16 receives from the workpiece 18. outputs a voltage signal vx.

Y方向成分検出用の反力検出回路42も、ブリッジ回路
の2辺に力センサ15のY方向力センサとしての一対の
センサ素子15e、15dを接続するほかは上記反力検
出回路41と同様に構成され、グラインダ16がワーク
18から受ける反力のY方向成分に応じた電圧信号v!
!を出力する。
The reaction force detection circuit 42 for detecting the Y direction component is also similar to the reaction force detection circuit 41 described above, except that a pair of sensor elements 15e and 15d as Y direction force sensors of the force sensor 15 are connected to two sides of the bridge circuit. A voltage signal v! corresponding to the Y-direction component of the reaction force that the grinder 16 receives from the workpiece 18!
! Output.

第4図の上述した反力検出部32から先が、第1図の押
付力・推力演算部33を構成している。
The above-mentioned reaction force detection section 32 in FIG. 4 and beyond constitutes the pressing force/thrust force calculation section 33 in FIG. 1.

ここでは、まず反力検出回路41.42からそれぞれ出
力される電圧信号vc、v!Iの大小を絶対値比較器4
3によって比較判定し、その結果によって一組の双反転
切換スイッチ44.45 (実際にはアナログスイッチ
ング回路)を切換制御して1反力のX、Y方向の成分の
大きい方の方向に押付力を作用させ、小さい方の方向に
推力を作用させるように回路を切換える。
Here, first, voltage signals vc, v! are respectively output from the reaction force detection circuits 41 and 42. Absolute value comparator 4 for the magnitude of I
3, and based on the results, a pair of bi-inverting changeover switches 44 and 45 (actually analog switching circuits) are switched and controlled to apply a pressing force in the direction of the larger X and Y direction components of one reaction force. The circuit is switched so that the thrust is applied in the smaller direction.

さらに、比較器46によって電圧信号vxを、比較器4
7によって電圧信号v!!をそれぞれゼロ設定器48に
よるO値(0ボルト)と比較し1反力のX方向成分及び
Y方向成分の正負をそれぞれ判定し、第1図の中央処理
部23へ入力させる。
Further, the comparator 46 outputs the voltage signal vx to the comparator 4
By 7 the voltage signal v! ! are compared with the O value (0 volts) from the zero setter 48 to determine whether the X-direction component and Y-direction component of one reaction force are positive or negative, respectively, and input them to the central processing unit 23 in FIG.

押付力演算回路4日は、電圧信号vx、vgのうちの絶
対値の大きい方を入力して、その大きさに応じて工具で
あるグラインダ16をワーク18に押付けるために必要
な押付力を算出する。
The pressing force calculation circuit 4 inputs the voltage signal vx or vg, whichever has a larger absolute value, and calculates the pressing force necessary to press the grinder 16, which is a tool, against the workpiece 18 according to its magnitude. calculate.

推力演算回路50は、電圧信号Vz、V!fのうちの絶
対値の小さい方を入力して、その大きさに応じてグライ
ンダ1日をワーク18の外周に沿って移動させるために
必要な推力を算出する。
The thrust calculation circuit 50 outputs voltage signals Vz, V! The smaller absolute value of f is input, and the thrust required to move the grinder along the outer periphery of the workpiece 18 is calculated according to the magnitude.

押付力については、反力を常に検知するために下限値を
、グラインダ1日の研摩円盤16aとワーク18の滑り
をなくするために上限値をそれぞれ設定する必要がある
Regarding the pressing force, it is necessary to set a lower limit value in order to constantly detect the reaction force, and an upper limit value in order to prevent slippage between the polishing disk 16a and the workpiece 18 during one day using the grinder.

そのため、下限値設定器51と上限値設定器52及び比
較器53.54と切換回路55を設け−ており、押付力
演算回路4日によって算出された押圧力の値が、下限値
設定器51によって設定された下限値より小さい時には
、比較器53がそれを判別して切換回路55を切換えて
下限値を出力するようにし、上限値設定器52によって
設定された上限値より大きい時には、比較器54がそれ
を判別して切換回路55を切換えて上限値を出力するよ
うにする。
Therefore, a lower limit value setter 51, an upper limit value setter 52, a comparator 53, 54, and a switching circuit 55 are provided. When it is smaller than the lower limit set by the upper limit setter 52, the comparator 53 determines it and switches the switching circuit 55 to output the lower limit, and when it is larger than the upper limit set by the upper limit setter 52, the comparator 54 determines this and switches the switching circuit 55 to output the upper limit value.

また、推力については、押付は方向と推力方向が切換わ
った時点で動きが止まらないように下限値を設定する必
要がある。
Further, regarding the thrust force, it is necessary to set a lower limit value so that the movement does not stop when the pressing direction and the thrust direction are switched.

そのため、下限値設定器56と比較器57及び切換回路
58を設けており、推力演算回路50によって算出され
た推力の値が下限値設定器56によって設定された下限
値より小さい時には、比較器57がそれを判別して切換
回路58を切換えて下限値を出力するようにする。
Therefore, a lower limit value setter 56, a comparator 57, and a switching circuit 58 are provided, and when the thrust value calculated by the thrust calculation circuit 50 is smaller than the lower limit value set by the lower limit value setter 56, the comparator 57 determines this and switches the switching circuit 58 to output the lower limit value.

このようにして、切換回路55.56から出力される押
付力と推力の値を示す信号は、双反転切換スイッチ45
によって出力インタフェース59か60を選択されて、
これらを介してX方向出力及びY方向出力となり、第1
図の中央処理部23に入力される。
In this way, the signals indicating the pushing force and thrust values output from the switching circuits 55 and 56 are transmitted to the bi-inverting changeover switch 45.
Output interface 59 or 60 is selected by
Through these, it becomes the X direction output and the Y direction output, and the first
The data is input to the central processing unit 23 shown in the figure.

なお、この押付力・推力演算部33の機能を。Note that the function of this pressing force/thrust force calculating section 33 is as follows.

第1図の中央処理部23内のマイクロコンピュータによ
るソフト処理で行なわせることも可能である。
It is also possible to perform software processing by a microcomputer in the central processing unit 23 shown in FIG.

次に、この実施例の作用を第6図及び第7図も参照して
説明する。
Next, the operation of this embodiment will be explained with reference also to FIGS. 6 and 7.

このロボットの制御装置には、予め第6図に示すような
動作をティーチングして、第1図の中央処理部23内の
メモリに記憶させておく。
The control device of this robot is taught the operation shown in FIG. 6 in advance and stored in the memory in the central processing unit 23 shown in FIG.

ステップのでは、プレイバック制御により第2図のアー
ム7.11を駆動してグラインダ16を原位置(退避位
置)へ移動させる。
In the step, the arm 7.11 in FIG. 2 is driven by playback control to move the grinder 16 to its original position (retracted position).

ステップ■でエアシリンダ12を動作させ、グラインダ
16を下降させてアプローチ点へ移動させる。この時、
上昇限りミツトスイッチ21がオフになり、第1図のリ
レーコイルRyへの通電が断たれるので、制御切換回路
30が各可動接30a、3Qb、・・・・・;を全てア
ース側へ切換え、モータ6.10がフリーになりってア
ーム7.11は力抜き状態になる。
In step (2), the air cylinder 12 is operated to lower the grinder 16 and move it to the approach point. At this time,
The limit switch 21 is turned off as long as it rises, cutting off the power to the relay coil Ry shown in Fig. 1, so the control switching circuit 30 switches all the movable contacts 30a, 3Qb, . . . to the ground side. , the motor 6.10 becomes free and the arm 7.11 becomes relaxed.

ステップ■では、第2図のワーク検知器20からのワー
ク検知信号の入力により、第1図の電流指令値Sa、S
bを出力してグラインダ16を例えばX方向へ移動させ
てワーク18に接触させる。
In step (2), the current command values Sa and S shown in FIG. 1 are input by the workpiece detection signal from the workpiece detector 20 shown in FIG.
b is output to move the grinder 16, for example, in the X direction and bring it into contact with the workpiece 18.

その接触点を作業開始点として、ステップ■でグライン
ダ16を始動させ、押付力・推力演算部33から前述の
ようにして入力する押付力及び推力を示すX方向出力と
Y方向出力、及びグラインダ16がワーク18から受け
る反力のX方自分とY方向成分の正負を示す信号によっ
て、後述するような倣い制御を行ないながらグラインダ
1日による研摩作業を行なう。
Using the contact point as the work start point, the grinder 16 is started in step (3), and the X-direction output and Y-direction output indicating the pressing force and thrust input from the pressing force/thrust force calculation unit 33 as described above, and the grinder 16 The grinder performs a polishing operation using the grinder while performing tracing control as will be described later, based on signals indicating the positive and negative values of the X-direction component and the Y-direction component of the reaction force received from the workpiece 18.

ステップ■で研摩作業が完了すると、エアシリンダ12
を作動させてグラインダ16を上昇させ。
When the polishing work is completed in step ■, the air cylinder 12
to raise the grinder 16.

上限リミットスイッチ21のオンによりプレイバック制
御が可能になり、ステップ■に戻って原位置に復帰させ
る。
Playback control becomes possible by turning on the upper limit switch 21, and the process returns to step (2) to return to the original position.

このステップ■〜■の内、ステップ■〜■の間を力抜き
状態にし、ステップ■の研摩作業中は更に倣い制御を行
なう。
Among these steps (2) to (2), the force is relaxed between steps (2) and (2), and the tracing control is further performed during the polishing operation of step (2).

この二次元の倣い制御の例を、第7図によって説明する
An example of this two-dimensional tracing control will be explained with reference to FIG.

ロボット1の第2のアーム11に取付けたグラインダ1
6の先端をアプローチ点aから、対象となるワーク18
の外周上の作業開始点すへX方向から力抜き状態でアプ
ローチする。
Grinder 1 attached to second arm 11 of robot 1
6 from the approach point a to the target workpiece 18.
Approach the work starting point on the outer circumference from the X direction in a relaxed state.

そして、グラインダ1日の先端が作業開始点すに接触し
た時にワーク18からの反力Fを受ける。
Then, when the tip of the grinder 1 contacts the work starting point, it receives a reaction force F from the workpiece 18.

この反力FのX方向成分FZとY方向成分のF!Iを、
前述のように反力検出手段である力センサ15と反力検
出部32によって検出する。
The X-direction component FZ and the Y-direction component F! of this reaction force F! I,
As described above, it is detected by the force sensor 15 and the reaction force detection section 32, which are reaction force detection means.

そして、押付力・推力演算部33からのX方向出力及び
Y方向出力に応じて、第1図の中央処理部23が電流指
令−sa、Sbを出力上て、検出された反力の2つの方
向成分のうち、成分が大きい方の方向(第7図のb点で
はX方向成分F″Cの方向で向きは反対)に押付力Pu
を作用させ、小さい方の方向(同じくY方向成分F!l
の方向)に推力Prを作用させなから力抜き制御を行な
う。
Then, in response to the X-direction output and Y-direction output from the pressing force/thrust force calculation unit 33, the central processing unit 23 in FIG. Pressing force Pu is applied in the direction of the larger component among the direction components (at point b in Fig. 7, the direction is opposite to the direction of the X direction component F''C).
is applied in the smaller direction (also the Y direction component F!l
The thrust force Pr is not applied in the direction (direction of

押付力Puと推力Prの向きの切り換えは、押付は方向
の反力が0になった時点で行なう。これによって、グラ
インダ16の研摩円盤16.の外周が、ワーク18の外
周に倣って回るように制御することができる。
The direction of the pressing force Pu and thrust Pr is switched when the reaction force in the pressing direction becomes zero. This allows the grinding disk 16 of the grinder 16 to be removed. The outer periphery of the workpiece 18 can be controlled so as to follow the outer periphery of the workpiece 18.

第7図には、ワーク18の外周上の作業開始点すから進
行した2つの点c、dにおける反力FとそのX方向成分
及びY方向成分、並びに押付力Puと推力Prをそれぞ
れ矢印で示している。
In FIG. 7, the reaction force F, its X-direction component and Y-direction component, as well as the pushing force Pu and the thrust force Pr at two points c and d, which have progressed from the work start point on the outer circumference of the workpiece 18, are indicated by arrows. It shows.

以上、この発明による制御装置によって、力抜き状態に
しても可動部の姿勢がくずれない水平多関節形のロボッ
トを制御する場合の例について説明してきたが、垂直関
節軸を有するロボットでも、力抜き状態において、可動
部の自重による回動力に抗するトルクをその可動部を駆
動するモータに発生させるような重力バランス補償手段
を設けることにより、前述の例と同様に倣い制御を行な
わせることが可能である。
Above, we have described an example in which the control device according to the present invention controls a horizontally multi-jointed robot in which the posture of the movable parts does not collapse even when the robot is in a relaxed state. By providing a gravity balance compensation means that causes the motor driving the movable part to generate a torque that resists the rotational force due to the weight of the movable part, it is possible to perform tracing control in the same way as in the previous example. It is.

使用する工具もグラインダに限らず、ワークに接触しな
がら作業を行なう各種の工具を使用することができる。
The tool used is not limited to the grinder, but various tools that perform work while in contact with the work can be used.

〔発明の効果〕〔Effect of the invention〕

以上説明してきたように、この発明によれば。 As explained above, according to the present invention.

ロボットの可動部(アーム又はハンド)を力抜き制御し
ながら、その先端に取付けた工具に加わるワークからの
反力を検出して、その大きさ及び方向に応じた押圧力と
推力を工具に与えるように、上記可動部を駆動するモー
タの駆動電流を制御することによって倣い制御を行なう
ようにしたので、予めワークの外形をティーチングする
必要がなく。
While controlling the robot's movable part (arm or hand) to release force, it detects the reaction force from the workpiece that is applied to the tool attached to its tip, and applies pressing force and thrust to the tool according to the magnitude and direction of the reaction force. Since the tracing control is performed by controlling the drive current of the motor that drives the movable part, there is no need to teach the outer shape of the workpiece in advance.

しかも常にワークの形状に忠実に倣って作業を行なわせ
ることができ、ワークの位置ずれや変形、あるいは形状
変更等に対しても、何の変更も要さずに直ちに対処でき
る。
In addition, the work can always be carried out faithfully following the shape of the workpiece, and any misalignment, deformation, or change in shape of the workpiece can be immediately dealt with without the need for any changes.

【図面の簡単な説明】[Brief explanation of the drawing]

第1図はこの発明の一実施例を示すブロック構成図、 第2図はロボットの構成及びその作業の説明に供するロ
ボツートまわりの外観図。 第3図は同じくそのカセンサ及15びグラインダ1日の
詳細例を示す斜視図。 第4図は第1図における反力検出部32と押付力・推力
演算部33の例を示すブロック図、第5図は第3図にお
ける反力検出回路41の具体例を示す回路図、 第6図はこの実施例におけるティーチング内容を示すフ
ロー図 第7図はこの実施例による倣い制御の説明図である。 1・・・水平多関節形のロボット 4.8・・・タコジエネ°レータ 5.9・・・パルスジェネレータ 6.10・・・DCサーボモータ 7.11・・・第1.第2のアーム(可動部)12・・
・エアシリンダ    15・・・力センサ16・・・
グラインダ(工具)  17・・・コンベア18・・・
ワーク(被加工物)  20・・・ワーク検知器23・
・・中央処理部     30・・・制御切換回路32
・・・反力検出部  33・・・押付力・推力演算部第
3図 県6図 第7図
FIG. 1 is a block configuration diagram showing an embodiment of the present invention, and FIG. 2 is an external view of the robot tool and its surroundings to explain the structure of the robot and its work. FIG. 3 is a perspective view showing a detailed example of the capacitor 15 and the grinder. 4 is a block diagram showing an example of the reaction force detection section 32 and the pressing force/thrust force calculation section 33 in FIG. 1; FIG. 5 is a circuit diagram showing a specific example of the reaction force detection circuit 41 in FIG. 3; FIG. 6 is a flowchart showing the content of teaching in this embodiment, and FIG. 7 is an explanatory diagram of tracing control according to this embodiment. 1...Horizontal articulated robot 4.8...Tachometer generator 5.9...Pulse generator 6.10...DC servo motor 7.11...1st. Second arm (movable part) 12...
・Air cylinder 15...force sensor 16...
Grinder (tool) 17... Conveyor 18...
Workpiece (workpiece) 20... Workpiece detector 23.
...Central processing unit 30...Control switching circuit 32
...Reaction force detection section 33...Pushing force/thrust force calculation section Fig. 3 Prefecture 6 Fig. 7

Claims (1)

【特許請求の範囲】 1 速度指令値とロボットの可動部の速度検出系からの
速度フィードバック値との偏差に基づく指令値に応じて
前記ロボットの可動部を駆動するモータの駆動電流を制
御するロボットの制御装置において、 前記速度指令値と速度フィードバック値との偏差に基づ
く指令値を実際の値に係わらず零にして前記可動部を力
抜き状態にする制御切換手段と、ロボットの前記可動部
に取付けた工具に加わる被加工物からの反力を検出する
反力検出手段と、該反力検出手段によつて検出される反
力の大きさ及び方向に応じて必要な押圧力と推力とを算
出する演算手段とを設け、 前記制御切換手段によつて前記偏差に基づく指令値を零
にした状態で、前記演算手段によつて算出された押圧力
と推力を前記工具に与えるように前記モータの駆動電流
を制御して、前記工具によつて前記被加工物の外形を倣
いながら作業を行なわせるようにしたことを特徴とする
ロボットの制御装置。
[Scope of Claims] 1. A robot that controls a drive current of a motor that drives a movable part of the robot according to a command value based on a deviation between a speed command value and a speed feedback value from a speed detection system of a movable part of the robot. In the control device, the control switching means sets the command value based on the deviation between the speed command value and the speed feedback value to zero regardless of the actual value, and puts the movable part into a relaxed state; A reaction force detection means for detecting a reaction force from a workpiece applied to an attached tool, and a necessary pressing force and thrust according to the magnitude and direction of the reaction force detected by the reaction force detection means. and a calculation means for calculating, and the motor is configured to apply the pressing force and thrust calculated by the calculation means to the tool with the command value based on the deviation set to zero by the control switching means. 1. A control device for a robot, characterized in that the control device controls a drive current of a robot so that the tool performs work while tracing the outer shape of the workpiece.
JP19323485A 1985-09-03 1985-09-03 Robot controller Pending JPS6254303A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP19323485A JPS6254303A (en) 1985-09-03 1985-09-03 Robot controller

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP19323485A JPS6254303A (en) 1985-09-03 1985-09-03 Robot controller

Publications (1)

Publication Number Publication Date
JPS6254303A true JPS6254303A (en) 1987-03-10

Family

ID=16304556

Family Applications (1)

Application Number Title Priority Date Filing Date
JP19323485A Pending JPS6254303A (en) 1985-09-03 1985-09-03 Robot controller

Country Status (1)

Country Link
JP (1) JPS6254303A (en)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH04165508A (en) * 1990-10-30 1992-06-11 Toshiba Corp Control method for robot
JP2005193339A (en) * 2004-01-08 2005-07-21 Honda Motor Co Ltd Assist conveyance method and its device
WO2010004635A1 (en) * 2008-07-10 2010-01-14 川崎重工業株式会社 Robot and its teaching method
JP2012254524A (en) * 2012-08-30 2012-12-27 Kawasaki Heavy Ind Ltd Robot, and teaching method for the same
JP2014155986A (en) * 2013-02-15 2014-08-28 Ihi Corp Posture detection controller, polishing device, and posture detection control method

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH04165508A (en) * 1990-10-30 1992-06-11 Toshiba Corp Control method for robot
JP2005193339A (en) * 2004-01-08 2005-07-21 Honda Motor Co Ltd Assist conveyance method and its device
JP4578808B2 (en) * 2004-01-08 2010-11-10 本田技研工業株式会社 Assist transfer device
WO2010004635A1 (en) * 2008-07-10 2010-01-14 川崎重工業株式会社 Robot and its teaching method
JP5114804B2 (en) * 2008-07-10 2013-01-09 川崎重工業株式会社 Robot and teaching method thereof
US8788087B2 (en) 2008-07-10 2014-07-22 Kawasaki Jukogyo Kabushiki Kaisha Robot and instruction method thereof
JP2012254524A (en) * 2012-08-30 2012-12-27 Kawasaki Heavy Ind Ltd Robot, and teaching method for the same
JP2014155986A (en) * 2013-02-15 2014-08-28 Ihi Corp Posture detection controller, polishing device, and posture detection control method

Similar Documents

Publication Publication Date Title
US9533411B2 (en) System and method for controlling a teleoperated robotic agile lift system
KR940003204B1 (en) Control robot
US6222338B1 (en) Method and apparatus for the direct teaching of automatic machines
TW201718204A (en) Method for teaching robot and device for controlling robot arm
JP2021517520A (en) Rotation speed control in robot-assisted grinding
JPH10138187A (en) Automatic computing method of load weight and load center-of-gravity position of articulated robot
JPS6254303A (en) Robot controller
JP2786874B2 (en) Movable position control device
EP0353305A1 (en) Industrial robot capable of automatically changing operating conditions depending on its attitude of installation
JPS61243514A (en) Robot controller
JPS6254302A (en) Robot controller
JPH05329792A (en) Balancer device for robot arm
JP2635690B2 (en) Ground manipulator for space manipulator
JP2827097B2 (en) Teach position teaching method of robot welding gun
JPS6254301A (en) Robot controller
JP2911160B2 (en) Grinder robot
JPS61208513A (en) Controller of traveling object
JPH0411029Y2 (en)
JPH05192885A (en) Robot arm controller
JPS61221803A (en) Robot controller
JP2635776B2 (en) Master / slave type manipulator
JPH01164552A (en) Automatic copy-polishing device for curved surface
JPH0612111A (en) Position controlling method for robot arm and position controller
KR200172908Y1 (en) Apparatus for controlling industrial multi-joint robot
JP3779523B2 (en) Position teaching method