JP3147254B2 - Robot movable part positioning method and device - Google Patents

Robot movable part positioning method and device

Info

Publication number
JP3147254B2
JP3147254B2 JP26490792A JP26490792A JP3147254B2 JP 3147254 B2 JP3147254 B2 JP 3147254B2 JP 26490792 A JP26490792 A JP 26490792A JP 26490792 A JP26490792 A JP 26490792A JP 3147254 B2 JP3147254 B2 JP 3147254B2
Authority
JP
Japan
Prior art keywords
positioning
current
command
robot
gripping force
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.)
Expired - Fee Related
Application number
JP26490792A
Other languages
Japanese (ja)
Other versions
JPH06114763A (en
Inventor
岳人 山口
勝己 石原
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.)
Canon Inc
Original Assignee
Canon Inc
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Canon Inc filed Critical Canon Inc
Priority to JP26490792A priority Critical patent/JP3147254B2/en
Publication of JPH06114763A publication Critical patent/JPH06114763A/en
Application granted granted Critical
Publication of JP3147254B2 publication Critical patent/JP3147254B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Description

【発明の詳細な説明】DETAILED DESCRIPTION OF THE INVENTION

【0001】[0001]

【産業上の利用分野】本発明は、ロボットの例えばハン
ド,フィンガやアームなどの可動部の位置決め方法及び
その装置に関するものである。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a method and an apparatus for positioning a movable portion of a robot such as a hand, a finger or an arm.

【0002】[0002]

【従来の技術】従来、産業用ロボットによる組立作業
は、動作手順及び動作位置を予め教示しておき、その教
示手順及び教示位置に従った動作をロボットに行なわせ
ることにより達成されていた。従来のロボット装置の位
置決め制御のブロック図を図1に示す。同図に示すよう
に、フィンがの現在位置をエンコーダ(E)から得てそ
の現在位置と指令位置との差から移動速度を演算するよ
うにしている。
2. Description of the Related Art Conventionally, an assembling operation by an industrial robot has been achieved by teaching an operation procedure and an operation position in advance and causing the robot to perform an operation according to the teaching procedure and the instruction position. FIG. 1 shows a block diagram of positioning control of a conventional robot device. As shown in the figure, the current position of the fin is obtained from the encoder (E), and the moving speed is calculated from the difference between the current position and the command position.

【0003】このような従来技術のうち、特開平1−2
46087は、ハンド装置がワークを把持する場合、フ
ィンガ部をある指定された位置(実際のワークサイズ>
フィンガ部間隔)になるように教示し、その位置でワー
クを把持させるようにしている。また、ワークをトルク
によって制御する方法として、特開平1−183386
は、歪ゲージ等を用いたトルク検出手段で、フィンガ部
にかかるトルクを検出してこれを電動器にフィードバッ
クしている。
Among such prior arts, Japanese Patent Laid-Open No. 1-2
When the hand device grips a workpiece, the finger part is placed at a specified position (actual workpiece size> 46087).
(Finger interval), and the workpiece is held at that position. Japanese Patent Laid-Open No. 1-183386 discloses a method for controlling a work by torque.
Is a torque detecting means using a strain gauge or the like, detects the torque applied to the finger portion, and feeds it back to the electric motor.

【0004】さらにワークを力によって制御する単純な
方法として、実開昭58−55884のように電動器を
電流制御のみで行わせる方法や装置が提案されている。
Further, as a simple method of controlling a work by force, there has been proposed a method or an apparatus in which an electric motor is controlled only by current control as disclosed in Japanese Utility Model Application Laid-Open No. 58558/1983.

【0005】[0005]

【発明が解決しようとする課題】ところで、はじ対象の
ワークは重量と大きさを持つ。従って、剛体としてのフ
ィンガがそのワークを把持するためには、教示点に単に
移動したのでは把持できず、また、ワークの大きさも誤
差があったり、ワーク間で大きさが異なっているという
ことがある。従って、以下のような問題が従来にはあっ
た。
The work to be rejected has a weight and a size. Therefore, in order for the finger as a rigid body to grasp the work, it cannot be grasped simply by moving to the teaching point, and there is an error in the size of the work or the size differs between works. There is. Therefore, there have been the following problems conventionally.

【0006】上記従来例での図1に示されている位置決
め制御ブロック図に従って、ワークを担持するために
は、フィンガの目標位置を数値データとして予め直接入
力したり、あるいはフィンガを実際に動作させ、ワーク
を把持させて、その位置をティーチングするなどといっ
た方法が取られているが、この入力、ティーチング作業
に大変な時間がかかる。また、ワークのサイズに鑑みて
どのくらいのオーバーパルスをフィンガ駆動系に与えて
やれば、目標とする把持力でそのワークを把持するのか
といったことはあまり考慮されておらず、実際には、オ
ペレータがワークをフィンガに実際に把持させ、オペレ
ータは勘に頼ってオーバーパルス数を決定していたの
で、オペレータによりその値はまちまちになってしま
い、不安定であり、また熟練も必要とされていた。
According to the positioning control block diagram shown in FIG. 1 in the above-mentioned conventional example, in order to carry a work, a target position of a finger is directly input as numerical data in advance, or the finger is actually operated. In this method, the work is grasped and the position of the work is taught, but this input and teaching work takes a very long time. In addition, considering how much overpulse is given to the finger drive system in consideration of the size of the work, it is not considered much whether the work is to be gripped with the target gripping force. Since the finger is actually held by the finger and the operator determines the number of overpulses by relying on intuition, the value varies depending on the operator, is unstable, and requires skill.

【0007】また、上記の方法では、一度目標となる位
置を設定してしまうと、そのワークに関しては常に一定
の位置にフィンガ部が位置決めされるので、ワークの寸
法誤差といったものを考慮した時、実際に把持するワー
クが多少小さい場合には、設定しておいた位置へフィン
ガ部が位置決めされても、実際には目標となる把持力が
発生しておらず、ワークがずれてしまったり、最悪の場
合には、まったく把持力が発生しないまま、つまりフィ
ンガがワークを把持をしないまま次の動作へ移行してし
まったりする。また、逆に予め設定しておいたワークサ
イズよりも実際に把持するワークの方が多少、大きい場
合には、目標の把持力よりも、その指令位置へフィンガ
部を位置決めすることにより、目標の把持力よりも大き
な把持力が発生してしまい、ワークを曲げたり、あるい
は壊したりしてしまうことが考えられる。また、剛性が
高いものを把持した場合には、駆動源としてのDCサー
ボモータに考えていた以上の電流が流れてしまい、最悪
の場合には容量の小さなDCサーボモータでは過電流と
なってしまい、DCサーボモータ自体が壊れてしまう様
な状態が出てきてしまい、問題となる。
Further, in the above method, once a target position is set, the finger portion is always positioned at a fixed position with respect to the work. If the workpiece to be actually gripped is slightly smaller, the target gripping force is not actually generated even if the finger is positioned at the set position, and the workpiece may shift or become worst. In the case of (1), the operation may shift to the next operation without generating any gripping force, that is, without the finger gripping the work. On the other hand, if the work to be actually gripped is slightly larger than the work size set in advance, the finger is positioned at the command position rather than the target gripping force, so that the target It is conceivable that a gripping force larger than the gripping force is generated, and the work is bent or broken. In addition, if a gripper with high rigidity is gripped, more current than expected for the DC servomotor as a drive source will flow, and in the worst case, an overcurrent will occur for a DC servomotor with a small capacity. In such a case, a state in which the DC servo motor itself is broken appears, which is a problem.

【0008】一方、ワークに加わる把持力を検出して制
御する場合には、フィンガメカ機構部に歪ゲージを取り
付け、この歪ゲージの出力信号を増幅するアンプといっ
たものが必要となるが、このようなゲージの取付けによ
り装置が構成的に複雑なものになってしまい、また、同
時に高価なものになってしまうので、実用性が低くな
る。また、歪ゲージそのものも、信頼性の高いものが無
いといった問題点がある。
On the other hand, when detecting and controlling the gripping force applied to the workpiece, a strain gauge is attached to the finger mechanism and an amplifier for amplifying the output signal of the strain gauge is required. The installation of the gauge complicates the construction of the device, and at the same time makes the device expensive, so that the practicality is reduced. Also, there is a problem that there is no highly reliable strain gauge.

【0009】また、単純な電動器の電流制御のみでは、
位置制御が出来ないのは当然のことで、かつ機構部の摩
擦や剛性の影響で押付力(把持力)に大きな誤差を生じ
てしまう問題がある。そこで、本発明が解決しようとす
る課題は、このような従来の問題点を解決するために提
案されたものでその目的は、目標位置を粗く定義するこ
とが可能であり、それでも確実に対象の可動部を目標位
置に移動することが可能なロボットの可動部の位置決め
方法及びその装置を提案することにある。
[0009] In addition, with only a simple motor current control,
It is natural that position control cannot be performed, and there is a problem that a large error occurs in the pressing force (gripping force) due to the influence of the friction and rigidity of the mechanism. Therefore, the problem to be solved by the present invention has been proposed in order to solve such a conventional problem, and its purpose is to be able to roughly define the target position, and still ensure that the target It is an object of the present invention to propose a method and an apparatus for positioning a movable part of a robot capable of moving the movable part to a target position.

【0010】[0010]

【課題を解決するための手段】上記課題を達成するため
の本発明は、ロボットの可動部を移動させるための電動
モータ手段を備え、この電動モータ手段の移動位置,移
動速度,駆動電流を制御することによりロボットの可動
部の位置決めを行なう方法において、目標位置について
の粗い位置情報を与え、前記粗い位置情報に基づいて前
記目標位置に可動部を位置決めし、上記粗い位置情報に
基づいた位置決め動作の終了後に、前記可動部の移動の
みが可能な第1の電流値を与え、前記可動部が押付対象
物と接触したことを検出し、前記第1の電流値よりも大
きな第2の電流値を前記電動モータ手段に与えることを
特徴とする。
SUMMARY OF THE INVENTION In order to achieve the above object, the present invention comprises an electric motor means for moving a movable part of a robot, and controls a moving position, a moving speed and a driving current of the electric motor means. In the method of positioning the movable portion of the robot by performing the above, coarse position information about a target position is given, the movable portion is positioned at the target position based on the coarse position information, and a positioning operation based on the coarse position information is performed. After the end of the above, a first current value that allows only the movement of the movable portion is given, it is detected that the movable portion has come into contact with the object to be pressed, and a second current value larger than the first current value is detected. Is given to the electric motor means.

【0011】また、上記課題を達成するための本発明に
係る位置決め装置は、ロボットの可動部を移動させるた
めの電動モータ手段を備え、この電動モータ手段の移動
位置,移動速度,駆動電流を制御することによりロボッ
トの可動部の位置決めを行う位置決め装置において、目
標位置についての粗い位置情報を外部から入力する手段
と、前記電動モータ手段を駆動するための電流値データ
を外部から入力する手段と、前記粗い位置情報に基づい
て前記目標位置に可動部を位置決めするために、速度誤
差検出回路と位置誤差検出回路とを含む位置決め制御回
路と、前記可動部の移動状態を検出する検出手段と、前
記電流値データに基づいて電流量制御を行なう電流制御
回路と、前記検出手段が前記位置決め制御回路による前
記可動部の移動が略ゼロと検出したときに、前記モータ
手段への駆動パスを前記位置決め制御回路から電流制御
回路に切り替える切り替え手段とを具備することを特徴
とする。
According to another aspect of the present invention, there is provided a positioning apparatus including electric motor means for moving a movable portion of a robot, and controlling a moving position, a moving speed, and a driving current of the electric motor means. In a positioning device that positions the movable portion of the robot by doing, means for externally inputting coarse position information about a target position, and means for externally inputting current value data for driving the electric motor means, A positioning control circuit including a speed error detection circuit and a position error detection circuit for positioning the movable portion at the target position based on the coarse position information, a detection unit for detecting a moving state of the movable portion, A current control circuit that performs current amount control based on current value data, and wherein the detection unit moves the movable unit by the positioning control circuit. Upon detecting the zero, characterized by comprising a switching means for switching a driving path to the motor means to the current control circuit from said positioning control circuit.

【0012】本発明によれば、可動部をまず粗く位置決
めし、その後は電流制御にだけにより可動部を目標位置
にまで正確に位置決めさせる。
According to the present invention, the movable portion is first roughly positioned, and thereafter the movable portion is accurately positioned to the target position only by controlling the current.

【0013】[0013]

【実施例】以下添付図面を参照して、本発明の好適な実
施例を説明する。 〈構成〉図2は本発明の実施したロボットハンド機構を
示す図である。図2において、101はサーボモータ、
102はサーボモータ101に連結された位置検出用の
パルスエンコーダ、103はサーボモータの回転出力軸
に取り付けられたタイミングプーリ、104はタイミン
グベルト、105はプーリ103の反対側に位置するタ
イミングプーリ、106は左右両ネジの切られているボ
ールネジである。107と108は直線ガイドであり、
109,110は不図示のボールネジ106のためのナ
ット(不図示)が取り付けられた可動部であるところの
フィンガ部、111,112はフィンガ部と固定フレー
ム113に別々につけられたフィンガ用のストッパーで
ある。115はフィンガ部の原点位置出しする為の原点
センサである。114はロボットハンド機構部全体を産
業用ロボット先端に取り付ける為の取付フランジであ
る。
Preferred embodiments of the present invention will be described below with reference to the accompanying drawings. <Structure> FIG. 2 is a view showing a robot hand mechanism according to the present invention. In FIG. 2, 101 is a servo motor,
Reference numeral 102 denotes a pulse encoder for position detection connected to the servomotor 101; 103, a timing pulley attached to a rotary output shaft of the servomotor; 104, a timing belt; 105, a timing pulley located on the opposite side of the pulley 103; Is a ball screw with both left and right screws cut. 107 and 108 are linear guides,
Reference numerals 109 and 110 denote finger portions, which are movable portions to which nuts (not shown) for the ball screw 106 (not shown) are attached. Reference numerals 111 and 112 denote finger stoppers separately attached to the finger portion and the fixed frame 113. is there. Reference numeral 115 denotes an origin sensor for determining the origin position of the finger portion. Reference numeral 114 denotes a mounting flange for mounting the entire robot hand mechanism to the tip of the industrial robot.

【0014】このロボットハンド機構の動作は、サーボ
モータ101の回転出力を、タイミングプーリ103と
タイミングベルト104とタイミングプーリ105に伝
達し、ボールネジ106を回転させる。これにより、フ
ィンガ部109,110は離れる方向や近づく方向に直
線移動することが出来、この2つのフィンガによりワー
クを把持出来るものである。また、サーボモータ101
に取付けられたパルスエンコーダ102によって、フィ
ンガ部109,110の位置は検出できるようになって
いる。また、フィンガ部109,110の位置原点は、
原点センサ115を規準にして設定できるようになって
いる。フィンガ部109と110は離れる方向に移動し
たとき、フィンガ109がフレーム113に接触する前
に、フィンガ110のストッパー112とフレーム11
3のストッパー111が接触するようになっている。
The operation of the robot hand mechanism transmits the rotation output of the servo motor 101 to the timing pulley 103, the timing belt 104, and the timing pulley 105, and rotates the ball screw 106. As a result, the finger portions 109 and 110 can linearly move in a direction away from or approaching the finger portion, and the workpiece can be gripped by these two fingers. Also, the servo motor 101
The positions of the finger portions 109 and 110 can be detected by the pulse encoder 102 attached to the oscilloscope. In addition, the position origin of the finger parts 109 and 110 is
The origin sensor 115 can be set as a reference. When the finger portions 109 and 110 move away from each other, before the finger 109 contacts the frame 113, the stopper 112 of the finger 110 and the frame 11
The third stopper 111 comes into contact with the stopper.

【0015】図3は本方法を実現する制御装置のハード
構成図を示している。201は制御を実現する中央処理
装置(CPU)であり、202はCPU201とバス結
合され、一連の制御処理アルゴリズムのプログラム及び
マンマシンインターフェースプログラムを含む不揮発性
のメモリ(ROM)であり、203は教示データを記憶
可能な電源バックアップされたメモリ(RAM)であ
る。また、204はサーボモータ101と連結されたパ
ルスエンコーダ102に接続され、サーボモータの現在
位置を計数可能にする現在値カウンタである。208は
前記サーボモータとトルクアンプ209を通して接続さ
れているD/Aコンバータであり、CPU201の指示
でアナログ電流指示をトルクアンプ209へ出力出来る
ようになっている。206は原点センサ115の情報を
CPU201へ取り込むためのI/Oのインターフェー
スである。また、211は外部の教示装置212とCP
Uを結ぶ通信用インターフェースである。前記202,
203,204,206,208,211はすべてバス
213によってCPU201と接続されている。 〈第1実施例〉図4は本発明の第1実施例を示し、ロボ
ットハンド機構の把持力制御方法に関する制御ブロック
図である。図4は、位置決め制御ループ(図中実線の枠
で示す)と把持力制御ループ(図中破線の枠で示す)と
いう2つのループからなる。位置決め制御ループは「準
備位置」にフィンガを位置決めするループで、把持力制
御ループは準備位置にフィンガが置かれた後にフィンガ
が発生する把持力を制御するループである。準備位置への位置決め まず、位置決め制御ループについて説明する。
FIG. 3 shows a hardware configuration diagram of a control device for realizing the present method. Reference numeral 201 denotes a central processing unit (CPU) for realizing control; 202, a non-volatile memory (ROM) which is connected to the CPU 201 via a bus and includes a series of control processing algorithm programs and a man-machine interface program; It is a power-backed-up memory (RAM) capable of storing data. Reference numeral 204 denotes a current value counter connected to the pulse encoder 102 connected to the servo motor 101 and capable of counting the current position of the servo motor. Reference numeral 208 denotes a D / A converter connected to the servo motor through a torque amplifier 209, which can output an analog current instruction to the torque amplifier 209 according to an instruction from the CPU 201. Reference numeral 206 denotes an I / O interface for taking information of the origin sensor 115 into the CPU 201. Reference numeral 211 denotes an external teaching device 212 and a CP.
It is a communication interface connecting U. 202,
203, 204, 206, 208, 211 are all connected to the CPU 201 by a bus 213. <First Embodiment> FIG. 4 shows a first embodiment of the present invention and is a control block diagram relating to a gripping force control method of a robot hand mechanism. FIG. 4 is composed of two loops: a positioning control loop (shown by a solid frame in the figure) and a gripping force control loop (shown by a broken frame in the figure). The positioning control loop is a loop for positioning the finger at the “preparation position”, and the gripping force control loop is a loop for controlling the gripping force generated by the finger after the finger is placed at the preparation position. Positioning to the standby position is explained first positioning control loop.

【0016】図における、指令位置レジスタ1は、対象
ワークを把持するための目標指令位置を記憶するレジス
タで、この指令位置は、対象ワークの寸法に対して多少
余裕がある位置、即ち、そこに位置決めされた時に対象
ワークとフィンガ部との間にある程度の間隔が有るよう
な位置へフィンガ部の駆動源であるサーボモータを動作
させるような位置であり、実際のワークの把持動作へ移
行する前の準備段階での目標指令位置である。この目標
指令位置1は加算器2へ出力される。加算器2は、目標
指令位置1と、フィンガ部の現在位置との位置偏差を求
めて、位置ループゲイン乗算器3へ出力する。位置ルー
プゲイン乗算器3は、位置偏差に所定の制御ゲインを乗
じて目標移動速度を演算し加算器4へ出力する。加算器
4は、入力されてきた目標移動速度と、フィンガ部の現
在移動速度14との速度偏差を求めて、速度ループゲイ
ン乗算器5へ出力する。速度ループゲイン乗算器5は、
入力されてきた速度偏差に所定の制御ゲインを乗じて、
目標指令電流を加算器7へ出力する。加算器7は、入力
されてきた目標指令電流と、現在サーボモータ9に出力
されている現在指令電流との電流偏差を求めて、これを
トルクアンプ8へ出力する。トルクアンプ8は、入力さ
れてきた電流偏差を増幅し、指令電流とし、サーボモー
タ9へ出力する。サーボモータ9は、入力されてきた指
令電流により駆動され、トルクを発生してフィンガメカ
機構109,110を開閉させ位置決めを行なう。エン
コーダ102はフィンガ部の現在位置を検出する為に、
サーボモータ10の回転に対応した信号を現在位置カウ
ンタ204へ出力し、その現在位置カウンタ204はエ
ンコーダ102からの信号により現在位置を算出して、
現在位置とする。また、現在位置カウンタ12の出力を
微分器13を通して現在速度としている。これらは従来
通りの位置決め制御ループである。
In the figure, a command position register 1 is a register for storing a target command position for gripping a target work. This command position is a position where there is some margin for the size of the target work, that is, a position there. This is a position where the servomotor, which is the driving source of the finger, is operated to a position where there is a certain distance between the target work and the finger when positioned, before shifting to the actual work gripping operation. This is the target command position in the preparation stage of. The target command position 1 is output to the adder 2. The adder 2 obtains a position deviation between the target command position 1 and the current position of the finger unit, and outputs the position deviation to the position loop gain multiplier 3. The position loop gain multiplier 3 calculates a target moving speed by multiplying the position deviation by a predetermined control gain, and outputs the target moving speed to the adder 4. The adder 4 calculates a speed deviation between the input target moving speed and the current moving speed 14 of the finger unit, and outputs the result to the speed loop gain multiplier 5. The speed loop gain multiplier 5
Multiply the input speed deviation by a predetermined control gain,
The target command current is output to the adder 7. The adder 7 obtains a current deviation between the input target command current and the current command current currently being output to the servomotor 9, and outputs this to the torque amplifier 8. The torque amplifier 8 amplifies the input current deviation, outputs the amplified current deviation to the servo motor 9 as a command current. The servo motor 9 is driven by the input command current, generates torque, and opens and closes the finger mechanical mechanisms 109 and 110 to perform positioning. The encoder 102 detects the current position of the finger part,
A signal corresponding to the rotation of the servo motor 10 is output to the current position counter 204, and the current position counter 204 calculates a current position based on a signal from the encoder 102,
The current position. The output of the current position counter 12 is set to the current speed through the differentiator 13. These are conventional positioning control loops.

【0017】この位置決め制御ループによって、フィン
ガ部を、対象ワークを把持する為の準備動作としての準
備位置に位置決めをする。フィンガが準備位置に位置決
めされたとき、フィンガ部と把持する対象ワークとの間
には、ある程度間隔がある。よって、今までのような正
確な位置決めの為のティーチングなどが不要で教示作業
が簡単となる。把持力制御 次に、フィンガ部が実際に対象ワークを把持するための
動作が以下のように行なわれる。
With this positioning control loop, the finger portion is positioned at a preparation position as a preparation operation for gripping the target work. When the finger is positioned at the preparation position, there is a certain distance between the finger portion and the target work to be gripped. Therefore, teaching work for accurate positioning as in the past is not required, and the teaching operation is simplified. Gripping force control Next, the operation for fingers actually grip the object work is performed as follows.

【0018】フィンガを上記の準備位置に位置決めした
後、ループ切換スイッチ6を位置決め制御ループ側(図
中、b位置)から把持力制御ループ(a位置)へ切換え
る。この時、指令把持力切換スイッチ19は、初め第1
指令把持力側(c位置)に接続されている。そして、第
1指令把持力がセットされ、把持力/トルク演算部18
へ出力される。
After the fingers are positioned at the preparatory positions, the loop changeover switch 6 is switched from the positioning control loop side (position b in the figure) to the gripping force control loop (position a). At this time, the command gripping force switch 19 is initially set to the first
It is connected to the command gripping force side (position c). Then, the first command gripping force is set, and the gripping force / torque calculating unit 18 is set.
Output to

【0019】把持力/トルク演算部18には、指令把持
力に対するトルク(電流)値への変換器が有り、指令把
持力を入力すると、それに必要なトルク(電流)値を演
算して、指令トルク(電流)値として出力する。一般
に、サーボモータは指令電流値に対して、比例的にトル
クが発生し、当然トルクとそれによって発生する力は比
例的な関係上にあるから、指令電流値に対して発生して
くる力というものは、常に比例的な関係にある。よって
簡単な変換関数がその把持力/トルク演算部18には用
意されている。
The gripping force / torque calculating unit 18 has a converter for converting a commanded gripping force into a torque (current) value. When a commanded gripping force is input, a torque (current) value required for the commanded gripping force is calculated. Output as torque (current) value. Generally, a servomotor generates torque proportionally to a command current value, and naturally, the torque and the force generated by the torque are in a proportional relationship. Things are always in a proportional relationship. Therefore, a simple conversion function is prepared in the gripping force / torque calculation unit 18.

【0020】第1指令把持力が把持力トルク演算部18
へ入力されると、前記変換関数によりトルク(電流)値
に変換されて、指令値としてループ切換スイッチ6を通
して加算器7へ出力される。そして、電流制御ループ
(トルクアンプ8から加算器7へ戻るループ)によって
電流定値制御を行って、サーボモータ9に一定のトルク
を発生させ、ハンドメカ機構を動作させ、フィンガ部を
対象ワークに接触させる。
The first command gripping force is determined by a gripping force torque calculator 18.
When it is input to the adder 7, it is converted into a torque (current) value by the conversion function and output to the adder 7 through the loop changeover switch 6 as a command value. Then, constant current value control is performed by a current control loop (a loop returning from the torque amplifier 8 to the adder 7) to generate a constant torque in the servo motor 9, operate the hand mechanical mechanism, and bring the finger into contact with the target work. .

【0021】ここで、第1の指令把持力について言及す
る。把持力/トルク演算部18以後においては、指令電
流値というものは、ハンドメカ機構11の固有の摺動抵
抗などにより、指令電流値が小さい時にはフィンガ部が
動作しないような領域が存在するので、この摺動抵抗に
打ち勝って、実際にフィンガ部が動作できるような電流
値以上の値を指令電流値とする。この値を逆変換して、
第1指令把持力という形で設定しておく。
Here, the first command gripping force will be described. After the gripping force / torque calculation unit 18, the command current value has an area where the finger unit does not operate when the command current value is small due to the inherent sliding resistance of the hand mechanism mechanism 11. A value equal to or more than a current value that overcomes the sliding resistance and allows the finger to actually operate is set as a command current value. Invert this value,
It is set in the form of a first command gripping force.

【0022】第1の指令把持力に応じてハンドメカ機構
のフィンガ部が、対象ワークに対して把持する方向に動
作し、実際にフィンガ部が対象ワークに接触したら、指
令把持力切換スイッチ19を第2指令把持力(d位置)
側に切換える。このスイッチ19をc位置からd位置に
切換えるタイミングは、ループ切換スイッチ6を位置決
め制御ループから把持力制御側に切換えた後に、モータ
の回転速度がゼロになった時点である。この速度監視は
速度監視器20により行なわれ、現在速度が速度=0と
なった時をフィンガ部が対象ワークに接触したと判断し
て、第2指令把持力側に指令把持力切換スイッチ19を
切換えるというものである。
The finger portion of the hand mechanism operates in the direction of gripping the target work in response to the first commanded gripping force, and when the finger portion actually contacts the target work, the command gripping force switch 19 is turned on. 2 command gripping force (d position)
Switch to side. The timing of switching the switch 19 from the position c to the position d is the time when the rotation speed of the motor becomes zero after the loop switching switch 6 is switched from the positioning control loop to the gripping force control side. This speed monitoring is performed by the speed monitor 20, and when the current speed becomes speed = 0, it is determined that the finger portion has contacted the target work, and the command gripping force switch 19 is set to the second command gripping force side. It is to switch.

【0023】そして、第2指令把持力17側にスイッチ
が切替わると、第2指令把持力が把持に/トルク演算部
18へ出力され、変換関数により第2指令把持力に対応
した指令トルク(電流)値に変換されて、指令値として
ループ切換スイッチ6を通して加算器7へ出力される。
そして、電流制御ループによって、電流定値制御を行っ
て、サーボモータ101に一定のトルクを発生させ、ハ
ンドメカ機構を動作させ、フィンガ部が対象ワークに対
して目標とする把持力を達成できる。
Then, when the switch is switched to the second command gripping force 17 side, the second command gripping force is output to the gripping / torque calculating section 18 and the command torque (corresponding to the second command gripping force) is converted by a conversion function. The current value is converted to a current value and output to the adder 7 through the loop changeover switch 6 as a command value.
Then, the constant current value control is performed by the current control loop, a constant torque is generated in the servo motor 101, the hand mechanical mechanism is operated, and the finger portion can achieve the target gripping force on the target work.

【0024】尚、この第1実施例では把持力指示という
形式にしたが、電流定値制御であるから、初めから目標
となる把持力に対する指令電流値を直接、電流制御ルー
プに入力する方法や、あるいはトルクという形で指示す
る方法などがある。ここで、フィンガ部で対象ワークを
目標把持力で把持する為に、第1指令把持力、第2指令
把持力というように2段階で制御する理由は、目標把持
力に対応するであろう指令値を一度に与えると、対象ワ
ークとフィンガ部との間に間隔があるように上述の準備
位置において位置決めされているので、その間隔によっ
ては実際に対象ワークを把持した時に実際にワークにか
かる発生把持力が大きく変化してしまうこともあるし、
衝突するかも知れないことを考えると、瞬時に対象ワー
クに加わる把持力が、目標把持力に対して非常に大きな
把持力となってしまい、対象ワークに対して悪い影響、
つまり変形させたり、壊したり、把持できず飛ばした
り、発生する把持力がバラツキがあるものになってしま
う。そこで、第1指令把持力16によってフィンガ部を
安定かつ確実に動作させ、対象ワークとの間隔を考慮せ
ずに、衝突のときの把持力の大きな変化がない(一定値
におちついている)ような指令値、かつ、接触(衝突)
させた時に発生する把持力にバラツキが有るときでも、
それらの値が目標把持力以上にならないような指令値と
しておき、これによってフィンガ部を対象ワークに接触
させる。フィンガ部と対象ワークが接触している状態か
らは、指令電流値に対して発生してくる把持力が比例的
に増加するので、目標把持力に対応した指令電流値を与
えるこによって安定した目標把持力が得られる。
In the first embodiment, the form of gripping force instruction is used. However, since it is a constant current value control, a method of directly inputting a command current value corresponding to a target gripping force from the beginning to the current control loop, Alternatively, there is a method of giving an instruction in the form of torque. Here, in order to hold the target workpiece with the target gripping force by the finger portion, the reason for controlling in two stages, such as the first commanded gripping force and the second commanded gripping force, is that the command that will correspond to the target gripping force is used. When the value is given at a time, since the positioning is performed at the above-described preparation position so that there is a gap between the target work and the finger portion, depending on the distance, the actual work may be applied to the work when the target work is actually gripped. The gripping force may change greatly,
Considering that a collision may occur, the gripping force instantly applied to the target work becomes a very large gripping force with respect to the target gripping force, which has a bad effect on the target work,
In other words, it is deformed, broken, flies without being able to be gripped, and the generated gripping force varies. Therefore, the finger portion is operated stably and reliably by the first command gripping force 16 so that the gripping force at the time of collision does not significantly change (settles down to a constant value) without considering the interval with the target work. Command value and contact (collision)
Even when there is variation in the gripping force generated when
Command values are set so that those values do not exceed the target gripping force, and thereby the finger portion is brought into contact with the target work. From the state where the finger and the target workpiece are in contact with each other, the gripping force generated with respect to the command current value increases in proportion to the command current value. A grip force is obtained.

【0025】図5に一度に目標把持力に対応する指令値
を与えた場合の一例を示し、図6に本発明による指令値
(電流)と発生把持力の一例を示す。図6に示すよう
に、本実施例による手法の法が、接触時の発生把持力は
小さく、また変動幅も小さいことが分かる。次に、図7
〜図11を参照して第1実施例の把持プロセスを説明す
る。
FIG. 5 shows an example in which a command value corresponding to the target gripping force is given at one time, and FIG. 6 shows an example of the command value (current) and the generated gripping force according to the present invention. As shown in FIG. 6, it can be seen that the method of the present embodiment produces a small gripping force at the time of contact and a small fluctuation range. Next, FIG.
The gripping process of the first embodiment will be described with reference to FIGS.

【0026】図7は、不図示のロボットアームによって
ロボットハンド機構を移動し、ワークを搬送する全体動
作を表すフローチャートである。ステップS1におい
て、ロボットアームによって、ロボットハンド機構が把
持するための対象ワークに対して実際に把持できる位置
へ移動し位置決めされる。次に、ステップS2において
ロボットハンドのフィンガ部が対象ワークを把持する動
作に移行し、ステップS3で、把持動作が終了するとロ
ボットアームによりロボットハンドは対象ワークの組付
け位置へ移動、位置決めされる。次に、ステップS4
で、ロボットハンドは対象ワークを組付ける為のワーク
・リリース動作を行なう。そして、動作が継続している
場合には、最初の動作に戻り、ない場合には終了する
(ステップS5)。
FIG. 7 is a flowchart showing the overall operation of moving a robot hand mechanism by a robot arm (not shown) and transporting a work. In step S1, the robot arm moves and positions the target work to be gripped by the robot hand mechanism to a position where it can be actually gripped. Next, in step S2, the operation shifts to an operation in which the finger portion of the robot hand grips the target work. In step S3, when the gripping operation is completed, the robot arm is moved and positioned by the robot arm to the mounting position of the target work. Next, step S4
Then, the robot hand performs a work release operation for assembling the target work. Then, if the operation is continued, the operation returns to the first operation, and if not, the operation ends (step S5).

【0027】図8は図7のステップS2におけるフィン
ガ把持動作の実行部のプロセスを示した図であり、図9
はそのフローチャートである。図8のSTEP1は、図
9のステップS11からステップS13に対応してい
る。まず、フィンガ部が対象ワークに対して多少余裕の
有る位置へ移動する為に、目標位置と目標速度がセット
され(ステップS11,ステップS12)、フィンガ部
が目標位置へ移動、位置決めされる(ステップS1
3)。
FIG. 8 is a diagram showing the process of the execution unit of the finger gripping operation in step S2 of FIG.
FIG. STEP1 in FIG. 8 corresponds to steps S11 to S13 in FIG. First, a target position and a target speed are set in order for the finger to move to a position where the target work has some margin (steps S11 and S12), and the finger is moved and positioned to the target position (step S11). S1
3).

【0028】図8のSTEP1で、フィンガ部がワーク
近傍に位置決めされると、次にSTEP2においてフィ
ンガ部がワーク近傍から対象ワークを実際に把持する動
作に移行する。まず、フィンガ部を駆動させる為に、サ
ーボモータに指令値を与える。これは図9のステップS
14における第1指令把持力セットである。この第1指
令把持力の決定の仕方は、フィンガ部が安定かつ確実に
移動できる指令値(電流値or把持力etc)とする。
When the finger portion is positioned near the work in STEP 1 of FIG. 8, the operation then proceeds to STEP 2 in which the finger portion actually grips the target work from the vicinity of the work. First, a command value is given to the servomotor to drive the finger unit. This corresponds to step S in FIG.
14 is a first command gripping force set. The method of determining the first command gripping force is a command value (current value or gripping force etc) at which the finger portion can move stably and reliably.

【0029】一例として、指令電流値に対するフィンガ
部の変位の関係を図10に示す。この図10図11から
は、ここで使用したメカに関しては指令電流値150m
Aぐらいを境に、フィンガ部が安定かつ確実に変位して
いることがわかるので、第1の指令値として150mA
をセットする。図9のステップS15で、位置決め制御
ループから把持力制御ループへスイッチを切換えて、ス
テップS16でサーボモータに第1の指令値が与えら
れ、フィンガ部が安定かつ確実にワーク把持方向に移動
する。ステップS17においては、フィンガ部が対象ワ
ークに接触したか、しないかを現在速度を監視し、現在
速度=0であるか、ないかを判断して、現在速度が
“0”以外で、まだフィンガ部が移動途中ならば、ひき
つづき第1の指令値を与えつづけ、もし現在速度が
“0”となれば、フィンガ部が対象ワークに接触したこ
ととして、図8のSTEP3及び図6のステップS18
へと進む。
As an example, FIG. 10 shows the relationship between the command current value and the displacement of the finger portion. From FIG. 10 and FIG. 11, the command current value is 150 m for the mechanism used here.
Since it is understood that the finger portion is stably and reliably displaced from about A, the first command value is 150 mA.
Is set. In step S15 of FIG. 9, the switch is switched from the positioning control loop to the gripping force control loop. In step S16, the first command value is given to the servomotor, and the finger moves in the workpiece gripping direction stably and reliably. In step S17, the current speed is monitored to determine whether or not the finger portion has contacted the target work, and whether or not the current speed is 0 is determined. If the section is moving, the first command value continues to be given. If the current speed becomes "0", it is determined that the finger section has contacted the target work, and STEP 3 in FIG. 8 and step S18 in FIG.
Proceed to.

【0030】図8のSTEP3は具体的には、図9のス
テップS18〜ステップS21に相当しており、STE
P3では対象ワークを把持する目標把持力の指令電流値
を与える。まず、ステップS18においては、第2指令
把持力(目標把持力)が対象ワークに与えられる。指令
電流値をセットする。この第2指令把持力の決定の仕方
は、予めフィンガ部とワークが接触した状態を想定して
創り出し、指令電流値に対してどの程度の把持力が発生
するかを確認しておく。図11はこのためのものであ
り、フィンガ部がワークに接触している状態から徐々
に、指令電流値を増加させた時に発生する把持力がどの
ように変化するかをプロットしたものの一例である。こ
れによって、第2の指令把持力セットにおいて、実際に
与える指令電流値との関係がわかる。
Step 3 in FIG. 8 specifically corresponds to steps S18 to S21 in FIG.
At P3, a command current value of a target gripping force for gripping the target work is given. First, in step S18, a second command gripping force (target gripping force) is applied to the target work. Set the command current value. The method of determining the second command gripping force is created in advance by assuming a state in which the finger portion and the workpiece are in contact with each other, and it is confirmed how much gripping force is generated with respect to the command current value. FIG. 11 is an example of plotting how the gripping force generated when the command current value is gradually increased from the state where the finger portion is in contact with the workpiece is changed for this purpose. . Thereby, in the second command gripping force set, the relationship with the command current value actually given can be understood.

【0031】次に、ステップS19においては、第1の
指令把持力から第2の指令把持力にスイッチ19を切換
える。するとステップS20でフィンガ部が対象ワーク
に接触している状態からサーボモータに第2の指令値が
与えられ、第2の指令把持力動作により、目標とする把
持力で対象ワークを確実に把持する方向にフィンガ部を
移動させる。
Next, in step S19, the switch 19 is switched from the first commanded gripping force to the second commanded gripping force. Then, in step S20, the second command value is given to the servomotor from the state where the finger portion is in contact with the target work, and the target work is reliably gripped with the target gripping force by the second instruction gripping force operation. Move the finger in the direction.

【0032】ステップS21においては、確実に把持が
完了したかを確認して、そして、その把持力を維持した
まま、図9のフローチャートをぬける。そして、図7の
ステップS3へと移行していく。そして、把持した対象
ワークを組み付ける位置へロボットアームによってロボ
ットハンドを移動させ、図8のSTEP4において、ワ
ークをリリースする動作へ移る。
In step S21, it is confirmed whether gripping has been completed, and the flowchart of FIG. 9 is skipped while maintaining the gripping force. Then, the process proceeds to step S3 in FIG. Then, the robot hand is moved by the robot arm to a position where the grasped target work is to be assembled, and the operation proceeds to the operation of releasing the work in STEP 4 of FIG.

【0033】図7のステップS2でロボットハンドが把
持動作を行なっているとき、特に図9のSTEP2及び
STEP3においては、図4の指令位置レジスタ1に
は、カウンタ204からの現在位置の値が常に代入され
ており、図7図8のSTEP4で位置指令によるフィン
ガ部の移動命令によって現在位置の指令位置への代入動
作を抽出し、両値の一致している状態でスイッチ6を切
換え、位置決め制御系に変更し、通常の位置制御を行な
い、ワークをリリースできる位置にフィンガ部を移動す
る。 〈第2実施例〉第1実施例の図9の把持動作フローチャ
ートにおいて、ステップS16の第1把持動作は、一定
の電流値のみで、フィンガ部を移動させるように制御す
る例である。この第1把持動作をさらに信頼性を増すよ
うにする第2実施例を、図12のフローチャートでに示
す。図12は、図9のフローチャートのステップS16
の部分の詳細フローチャートとして書かれている。
When the robot hand is performing a gripping operation in step S2 in FIG. 7, especially in STEP2 and STEP3 in FIG. 9, the command position register 1 in FIG. In step 4 in FIGS. 7 and 8, the operation of substituting the current position into the commanded position is extracted by the finger movement command based on the position command, and the switch 6 is switched in a state where the two values match, and the positioning control is performed. Change to the system, perform normal position control, and move the finger to a position where the work can be released. <Second Embodiment> In the gripping operation flowchart of FIG. 9 of the first embodiment, the first gripping operation in step S16 is an example in which the finger is controlled to move with a constant current value only. A second embodiment for further increasing the reliability of the first gripping operation is shown in the flowchart of FIG. FIG. 12 is a flowchart showing step S16 in the flowchart of FIG.
Is written as a detailed flowchart of the section.

【0034】ステップS31で、まず初期値として、あ
らかじめ設定されている指令下限値を設定して、ステッ
プS32でトルクアンプを介してサーボモータ101へ
電流を流す。ステップS33でサーボモータ101がフ
ィンガ部の移動ガイドやボールネジの摩擦等で移動しな
かったか否か(即ち、速度0であったか否か)をチェッ
クし、移動しているときはステップS36で同じ指令値
でサーボモータに電流を流し続ける。ステップS33で
移動しなかったときは、ステップS34で現在の指令値
があらかじめ設定されている指令上限値を越えていない
かをチェックし、越えている場合は終了し、図9のステ
ップS17へ進む。ステップS34で上限値を越えてい
ない場合はステップS35へ進み、現指令値にあらかじ
め設定された増加値を加算し、ステップS36へ戻って
再度先の説明した内容を実行する。 〈応用〉上述した一定力の押付方法を原点出し動作に応
用した場合について説明する。
In step S31, first, a preset command lower limit value is set as an initial value, and in step S32, a current is supplied to the servomotor 101 via a torque amplifier. In step S33, it is checked whether the servo motor 101 has not moved due to the friction of the movement guide of the finger portion or the ball screw (that is, whether or not the speed is 0). To continue to supply current to the servo motor. If it has not moved in step S33, it is checked in step S34 whether or not the current command value has exceeded a preset command upper limit value. If it has, the process ends, and the process proceeds to step S17 in FIG. . If the value does not exceed the upper limit in step S34, the process proceeds to step S35, where a preset increase value is added to the current command value, and the process returns to step S36 to execute the above-described contents again. <Application> A case where the above-described pressing method with a constant force is applied to an origin search operation will be described.

【0035】図13は、この原点出し動作のフローチャ
ートを示している。このフローチャトで、STEPAは
実施例1,2の把持動作時のSTEP2に、STEPB
は同STEP3に対応しており、一定力押付方法として
は、まったく同じ動作になっている。図13のフローチ
ャートに従って、ロボットハンド機構図(図2)と、制
御ブロック図(図4)を用いて説明する。
FIG. 13 shows a flowchart of the origin finding operation. In this flowchart, STEPA is replaced with STEPB at the time of the gripping operation of the first and second embodiments.
Corresponds to STEP3, and has exactly the same operation as the constant force pressing method. According to the flowchart of FIG. 13, a description will be given using a robot hand mechanism diagram (FIG. 2) and a control block diagram (FIG. 4).

【0036】まず、原点出し動作を行なう前に、図12
の制御ブロックにおいて、切換スイッチ6はb位置に接
続されて位置決め制御系に接続されていることになって
いる。図13で、原点出し動作をスタートさせると、ス
テップS31で図12の把持力制御ループに第1指令力
をセットし、ステップS32でスイッチ19をc位置
に、スイッチ6をa位置に接続し、把持力制御系に切換
える。
First, before performing the home search operation, FIG.
In this control block, the changeover switch 6 is connected to the position b and connected to the positioning control system. In FIG. 13, when the origin search operation is started, the first command force is set in the gripping force control loop of FIG. 12 in step S31, the switch 19 is connected to the position c, and the switch 6 is connected to the position a in step S32. Switch to gripping force control system.

【0037】ステップS33,ステップS34で、この
指令力を出力制御しつつ、速度監視器20で速度が零に
なるまで続けて出力する。このステップS33,ステッ
プS34の動作で、ロボットハンド機構(図2)では、
フィンガ部109,110は互いに離れる方向に移動
し、フィンガ110に取付けられたストッパー112と
固定フレーム113に取付けられたストッパー111が
接触した状態となる(STEPA)。
At steps S33 and S34, the command force is continuously output until the speed becomes zero by the speed monitor 20 while controlling the output. In the operations of steps S33 and S34, the robot hand mechanism (FIG. 2)
The finger portions 109 and 110 move away from each other, and the stopper 112 attached to the finger 110 and the stopper 111 attached to the fixed frame 113 come into contact with each other (STEPA).

【0038】次に、ステップS35で、第2の指令力を
セットし、ステップS36でスイッチ19を切換えて、
ステップS37,ステップS38で第1指令力より大き
い第2指令力をサーボモータに出力制御し、ハンド機構
部にサーボモータのトルクが完全に伝達されたタイミン
グで次STEPに進む。ステップS37,ステップS3
8の状態で、ロボットハンド機構(図2)は、ストッパ
ー111とストッパ112は、バラツキなく一定力で付
き当たった状態になっている(STEPB)。
Next, in step S35, the second command force is set, and in step S36, the switch 19 is switched.
In steps S37 and S38, the second command force larger than the first command force is output-controlled to the servomotor, and the process proceeds to the next step at the timing when the torque of the servomotor is completely transmitted to the hand mechanism. Step S37, Step S3
In the state of No. 8, the robot hand mechanism (FIG. 2) is in a state where the stopper 111 and the stopper 112 abut with a constant force without variation (STEPB).

【0039】さらに、ステップS39で、図4のSTE
P6をb位置に接続し、位置決め制御系に切換える。こ
のとき、指令位置レジスタには、カウンタ204からの
現在位置の値を代入する。ステップS40では、指令位
置レジスタ1に微小移動量を加算しつづけ、先の移動方
法と逆になるようサーボモータを回転させる。ステップ
S41では、この回転しているサーボモータと接続して
いるパルスエンコーダのZ相信号(サーボモータ1回転
当り、1パルスの信号)が検知するまで、ステップS4
0のサーボモータの移動を行い、Z相信号が検知される
と即座にステップS42で図4の現在値カウンタ12を
クリアして、サーボモータの移動を止めて、原点出し動
作を終了する(STEPC)。
Further, in step S39, the STE of FIG.
Connect P6 to position b and switch to positioning control system. At this time, the value of the current position from the counter 204 is substituted into the command position register. In step S40, the small movement amount is continuously added to the command position register 1, and the servo motor is rotated so as to be the reverse of the previous movement method. In step S41, steps S4 and S4 are performed until the Z-phase signal of the pulse encoder connected to the rotating servomotor (one pulse signal per one rotation of the servomotor) is detected.
When the Z-phase signal is detected, the current value counter 12 shown in FIG. 4 is cleared in step S42, the servo motor is stopped, and the origin search operation is completed (STEPC). ).

【0040】この一定力押付方法を、ロボットハンド又
はロボットアームの原点出し動作に適用した場合、正確
な力で可動部を押付けられ、伝達部の変形量の再現性が
高くなり、原点センサを廃止し、コストダウンが計れる
効果がある。 〈その他の変形〉本発明は上記3つの実施例に限定され
ることはなく、種々の変形が可能である。
When this constant force pressing method is applied to the origin search operation of the robot hand or the robot arm, the movable part is pressed with an accurate force, the reproducibility of the deformation of the transmission part is increased, and the origin sensor is eliminated. This has the effect of reducing costs. <Other Modifications> The present invention is not limited to the above three embodiments, and various modifications are possible.

【0041】例えば、上記第3実施例の原点出し動作の
例において、第2実施例での図12に示した指令値を徐
々に増加させる手法を、図13のステップS33の動作
として行なうと、原点出し動作の信頼性をより高めるこ
とができる。また上記実施例は、ロボットハンドを例に
取って説明してきたが、ロボットアーム等、目標位置と
いう概念の有るものであればいかなるものにも適用可能
である。
For example, in the example of the origin finding operation of the third embodiment, the method of gradually increasing the command value shown in FIG. 12 in the second embodiment is performed as the operation of step S33 in FIG. The reliability of the home search operation can be further improved. Further, the above embodiment has been described by taking the robot hand as an example, but the present invention can be applied to any robot having a concept of a target position, such as a robot arm.

【0042】[0042]

【発明の効果】以上説明したように本発明のロボットの
可動部の位置決め方法及びその装置によれば、粗い位置
決めが可能な制御系による粗い位置決めの後に、電流制
御によるトルク制御を行なって最終の目標位置に正確に
移動することができる。更に、トルク制御系において
は、第1の指令値を与えて、可動部の移動がゼロになっ
た後にさらに第1の指令値よりも大きな第2の指令値を
モータ手段に与えることで、より正確な力で目標位置に
接近することができ、例えば、押付対象物を正確に押付
けることが出来る効果がある。
As described above, according to the method and the apparatus for positioning the movable part of the robot according to the present invention, after the coarse positioning by the control system capable of performing the coarse positioning, the torque control by the current control is performed to perform the final control. It can move to the target position accurately. Further, in the torque control system, the first command value is given, and after the movement of the movable portion becomes zero, a second command value larger than the first command value is further given to the motor means. It is possible to approach the target position with an accurate force, and for example, there is an effect that the pressing target can be pressed accurately.

【0043】また、第1の指令値を、移動を確認しなが
ら、ステップ状に増加させることで、より確実に押付を
実現できる効果がある。
Further, by increasing the first command value in a stepwise manner while confirming the movement, there is an effect that the pressing can be realized more reliably.

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

【図1】従来の位置決め回路の制御ブロック図である。FIG. 1 is a control block diagram of a conventional positioning circuit.

【図2】本発明の位置決め方法の適用対象となるロボッ
トハンド機構を示す図である。
FIG. 2 is a diagram showing a robot hand mechanism to which the positioning method of the present invention is applied.

【図3】実施例の制御装置のハード構成図である。FIG. 3 is a hardware configuration diagram of a control device according to the embodiment.

【図4】実施例の制御装置のブロック構成図。FIG. 4 is a block diagram of a control device according to the embodiment.

【図5】従来技術における指令値と発生把持力の時間変
化を示す図である。
FIG. 5 is a diagram showing a temporal change of a command value and a generated gripping force in the related art.

【図6】本実施例における指令値と発生把持力の時間変
化を示す図である。
FIG. 6 is a diagram showing a change over time of a command value and a generated gripping force in the present embodiment.

【図7】実施例の全体動作のフローチャートである。FIG. 7 is a flowchart of the overall operation of the embodiment.

【図8】フィンガ把持プロセスを示す図である。FIG. 8 illustrates a finger gripping process.

【図9】フィンガ把持動作のフローチャートである。FIG. 9 is a flowchart of a finger gripping operation.

【図10】指令電流に対するフィンガ部変位を示す図で
ある。
FIG. 10 is a diagram illustrating finger portion displacement with respect to a command current.

【図11】押付部接触状態からの指令電流と把持力を示
す図である。
FIG. 11 is a diagram showing a command current and a gripping force from a pressing portion contact state.

【図12】第2実施例における把持動作のフローチャー
トである。
FIG. 12 is a flowchart of a gripping operation in the second embodiment.

【図13】本発明を原点出し動作に応用したときのフロ
ーチャートである。
FIG. 13 is a flowchart when the present invention is applied to an origin finding operation.

フロントページの続き (58)調査した分野(Int.Cl.7,DB名) B25J 3/00 - 3/10 B25J 9/10 - 9/22 B25J 13/00 - 13/08 B25J 19/02 - 19/06 Continued on the front page (58) Fields surveyed (Int. Cl. 7 , DB name) B25J 3/00-3/10 B25J 9/10-9/22 B25J 13/00-13/08 B25J 19/02-19 / 06

Claims (4)

(57)【特許請求の範囲】(57) [Claims] 【請求項1】 ロボットの可動部を移動させるための電
動モータ手段を備え、この電動モータ手段の移動位置,
移動速度,駆動電流を制御することによりロボットの可
動部の位置決めを行なう方法において、 目標位置についての粗い位置情報を与え、 前記粗い位置情報に基づいて前記目標位置に可動部を位
置決めし、 上記粗い位置情報に基づいた位置決め動作の終了後に、
前記可動部の移動のみが可能な第1の電流値を与え、 前記可動部が押付対象物と接触したことを検出し、 前記第1の電流値よりも大きな第2の電流値を前記電動
モータ手段に与えること を特徴とするロボットの可動部
の位置決め方法。
1. An electric motor means for moving a movable part of a robot, wherein a moving position of the electric motor means,
The robot speed can be controlled by controlling the moving speed and drive current.
In the method for positioning a moving part , coarse position information about a target position is given, and the movable part is positioned at the target position based on the coarse position information. After the positioning operation based on the coarse position information is completed,
A first current value that allows only the movement of the movable portion is provided, and it is detected that the movable portion has come into contact with an object to be pressed, and a second current value larger than the first current value is supplied to the electric motor.
A method for positioning a movable part of a robot, which is provided to a motor means .
【請求項2】 前記可動部の移動が認められないとき
前記第1の電流値を徐々に増加させることを特徴とする
請求項1に記載のロボットの可動部の位置決め方法。
2. When the movement of the movable part is not recognized ,
2. The method according to claim 1, wherein the first current value is gradually increased.
【請求項3】 前記第1の電流値を徐々に増加させる場
合に、上限値に達した時点で増加を停止させることを特
徴とする請求項2に記載のロボットの可動部の位置決め
方法。
3. A method for gradually increasing the first current value.
The case, the method of positioning the movable portion of the robot according to claim 2, characterized in that stopping the increase up to the limit value.
【請求項4】 ロボットの可動部を移動させるための電
動モータ手段を備え、この電動モータ手段の移動位置,
移動速度,駆動電流を制御することによりロボットの可
動部の位置決めを行う位置決め装置において、 目標位置についての粗い位置情報を外部から入力する手
段と、 前記電動モータ手段を駆動するための電流値データを外
部から入力する手段と、 前記粗い位置情報に基づいて前記目標位置に可動部を位
置決めするために、速度誤差検出回路と位置誤差検出回
路とを含む位置決め制御回路と、 前記可動部の移動状態を検出する検出手段と、 前記電流値データに基づいて電流量制御を行なう電流制
御回路と、 前記検出手段が前記位置決め制御回路による前記可動部
の移動が略ゼロと検出したときに、前記モータ手段への
駆動パスを前記位置決め制御回路から電流制御回路に切
り替える切り替え手段とを具備することを特徴とするロ
ボットの可動部の位置決め装置。
4. An electric motor means for moving a movable portion of the robot, wherein a moving position of the electric motor means,
The robot speed can be controlled by controlling the moving speed and drive current.
In a positioning device for positioning a moving part, a means for externally inputting coarse position information about a target position; a means for externally inputting current value data for driving the electric motor means; A positioning control circuit including a speed error detection circuit and a position error detection circuit for positioning the movable section at the target position based on the current value data; A current control circuit for controlling the amount of current through the positioning control circuit, and when the detection means detects that the movement of the movable section by the positioning control circuit is substantially zero, a driving path from the positioning control circuit to the current control circuit A positioning unit for a movable part of a robot, comprising:
JP26490792A 1992-10-02 1992-10-02 Robot movable part positioning method and device Expired - Fee Related JP3147254B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP26490792A JP3147254B2 (en) 1992-10-02 1992-10-02 Robot movable part positioning method and device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP26490792A JP3147254B2 (en) 1992-10-02 1992-10-02 Robot movable part positioning method and device

Publications (2)

Publication Number Publication Date
JPH06114763A JPH06114763A (en) 1994-04-26
JP3147254B2 true JP3147254B2 (en) 2001-03-19

Family

ID=17409874

Family Applications (1)

Application Number Title Priority Date Filing Date
JP26490792A Expired - Fee Related JP3147254B2 (en) 1992-10-02 1992-10-02 Robot movable part positioning method and device

Country Status (1)

Country Link
JP (1) JP3147254B2 (en)

Families Citing this family (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH09290381A (en) * 1996-04-24 1997-11-11 Fanuc Ltd Robot with servo tool equipped at hand tip part
EP2132008B1 (en) * 2007-03-08 2010-10-06 Smv S.R.L. A method and a device for recognising, collecting and repositioning objects
JP5268096B2 (en) * 2008-08-07 2013-08-21 Ckd株式会社 Electric actuator
JP5924107B2 (en) * 2012-05-09 2016-05-25 セイコーエプソン株式会社 Robot hand and robot
JP2013047150A (en) * 2012-12-04 2013-03-07 Ihi Corp Article transfer device
JP7182952B2 (en) * 2018-08-27 2022-12-05 キヤノン株式会社 CONTROL METHOD, CONTROL PROGRAM, RECORDING MEDIUM, CONTROL DEVICE, ROBOT SYSTEM, AND PRODUCT MANUFACTURING METHOD

Also Published As

Publication number Publication date
JPH06114763A (en) 1994-04-26

Similar Documents

Publication Publication Date Title
US8321054B2 (en) Industrial robot and a method for adjusting a robot program
KR960005985B1 (en) Method of detecting a collision of machine operating parts driven by servo motors
EP2014426A2 (en) Machining robot control apparatus
EP1245324B1 (en) Method of and device for setting reference position for servo spot welding gun
JPH10264080A (en) Robot controller
JP3147254B2 (en) Robot movable part positioning method and device
JPH10207519A (en) Robot control system
US4580085A (en) Feed control system with a safety device
WO1998034753A1 (en) Method of detecting abrasion quantity of welding gun electrode and welding method
WO1994024621A1 (en) Method of force control by disturbance load estimation
JPS60252911A (en) Robot containing operation key at its mobile part
JP2786874B2 (en) Movable position control device
JP3268705B2 (en) Robot home search method
JP3202456B2 (en) Control device for hand mechanism
JPH077305B2 (en) Robot direct teaching apparatus and direct teaching method
JPH03130808A (en) Method and device for control of robot
JPH0639760A (en) Control device for robot
JP2922763B2 (en) Mounting device
JP4032263B2 (en) Robot direct teach device
JP2691591B2 (en) Control system of force control robot
JP3243009B2 (en) Control method and control device for movable part of robot
JPH03134714A (en) Positioning controller and position teaching method
JPH05250029A (en) Industrial robot
JPH1142577A (en) Control method and device for robot
JP2000084878A (en) Control device for robot

Legal Events

Date Code Title Description
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20001124

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

Free format text: PAYMENT UNTIL: 20090112

Year of fee payment: 8

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

Free format text: PAYMENT UNTIL: 20090112

Year of fee payment: 8

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

Free format text: PAYMENT UNTIL: 20100112

Year of fee payment: 9

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

Free format text: PAYMENT UNTIL: 20110112

Year of fee payment: 10

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

Free format text: PAYMENT UNTIL: 20120112

Year of fee payment: 11

LAPS Cancellation because of no payment of annual fees