JPH0871970A - Control device for robot - Google Patents

Control device for robot

Info

Publication number
JPH0871970A
JPH0871970A JP23031194A JP23031194A JPH0871970A JP H0871970 A JPH0871970 A JP H0871970A JP 23031194 A JP23031194 A JP 23031194A JP 23031194 A JP23031194 A JP 23031194A JP H0871970 A JPH0871970 A JP H0871970A
Authority
JP
Japan
Prior art keywords
unit
hand
motor
holding
stationary
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
JP23031194A
Other languages
Japanese (ja)
Inventor
Atsuhiro Ogiya
厚宏 扇谷
Toru Tanaka
徹 田中
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.)
Shibaura Mechatronics Corp
Original Assignee
Shibaura Engineering Works 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 Shibaura Engineering Works Co Ltd filed Critical Shibaura Engineering Works Co Ltd
Priority to JP23031194A priority Critical patent/JPH0871970A/en
Publication of JPH0871970A publication Critical patent/JPH0871970A/en
Pending legal-status Critical Current

Links

Abstract

PURPOSE: To prevent a servomotor from vibrating when a robot retains a stop position where the robot comes to a stop. CONSTITUTION: A control device for a robot is composed of a hand part moving and resting means for moving a hand part to an arbitrary position and resting the same at this position, a hand part resting position retaining means 4 for holding the hand part at the resting position when the hand part moving and resting means confirm the resting of the hand part, a motor shaft fixing means 5 for fixing the shaft of a servo motor when the hand part resting position retaining means 4 confirms the holding of the hand part at the resting position, and a motor power cut-off means 6 for cutting off power fed to the servo motor when the motor shaft fixing means 5 confirms the fixing of the shaft of the servo motor.

Description

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

【0001】[0001]

【産業上の利用分野】ハンド部と連結し、このハンド部
を駆動するたサーボモータと、このサーボモータの軸を
固定または開放可能にする、例えばブレーキとを備えた
ロボットの制御装置に関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a robot controller provided with a servo motor which is connected to a hand unit and drives the hand unit, and a brake which enables the axis of the servo motor to be fixed or released.

【0002】[0002]

【従来の技術】従来におけるロボットのシステムの構成
および動作の説明を図8〜図13を用いて行う。図8
は、従来におけるハンド部を任意の位置に静止させ、そ
の位置でハンド部を保持させるための基本ブロック図で
ある。図9は、図8で静止させ、保持させたハンド部を
再移動させるための基本ブロック図である。図10は、
非常停止の際の基本ブロック図である。図11は、従来
におけるロボットおよび制御装置を示すブロック図であ
る。図12は、従来におけるハンド部を静止させ、保持
させるためのフローチャート図である。図13は、図1
2で静止させ、保持させたハンド部を再移動させるめの
ためのフローチャート図である。
2. Description of the Related Art The structure and operation of a conventional robot system will be described with reference to FIGS. FIG.
FIG. 6 is a basic block diagram for holding the hand unit in an arbitrary position and holding the hand unit in that position in the related art. FIG. 9 is a basic block diagram for re-moving the hand unit held and held in FIG. Figure 10
It is a basic block diagram at the time of emergency stop. FIG. 11 is a block diagram showing a conventional robot and control device. FIG. 12 is a flow chart for holding and holding the conventional hand unit. 13 is the same as FIG.
It is a flowchart figure for moving the hand part which was made to stand still by 2 and was made to hold | maintain again.

【0003】図8において、ハンド部静止位置保持指令
手段1よりハンド部を任意の位置に静止させ、その位置
でハンド部を保持させるハンド部静止位置保持指令の信
号を制御手段40に入力する。そして、制御手段40よ
り、ハンド部を移動させ、任意の位置に静止させるため
の信号をハンド部移動静止手段3に出力する。次に、制
御手段40より、ハンド部が静止している位置を保持す
るための信号をハンド部静止位置保持手段4に出力す
る。
In FIG. 8, the hand unit still position holding command means 1 causes the hand unit to stand still at an arbitrary position, and a signal of a hand unit still position holding command for holding the hand unit at that position is input to the control unit 40. Then, the control unit 40 outputs a signal for moving the hand unit and stopping it at an arbitrary position to the hand unit moving / stationary unit 3. Next, the control unit 40 outputs a signal for holding the position where the hand unit is stationary to the hand unit stationary position holding unit 4.

【0004】図9において、ハンド部移動開始指令手段
7より静止させ、保持させたハンド部を再移動させるハ
ンド部移動指令の信号を制御手段41に入力する。そし
て、制御手段41より、ハンド部が静止している位置保
持を解除し、ハンド部を再移動させて、任意の動作をさ
せるための信号を軸移動開始手段11に出力する。
In FIG. 9, a signal of a hand part movement command for moving the held hand part again by the hand part movement start command means 7 is input to the control means 41. Then, the control means 41 releases the holding of the position where the hand portion is stationary, moves the hand portion again, and outputs a signal for performing an arbitrary operation to the axis movement starting means 11.

【0005】図10において、非常静止指令手段42か
ら出力された非常停止指令を制御手段43に入力する。
そして、制御手段43より、サーボモータの軸を固定す
るための信号をモータ軸固定手段5に出力する。次に、
制御手段43より、サーボモータへの電力の供給を遮断
するための信号をモータ電力遮断手段6に出力する。
In FIG. 10, the emergency stop command output from the emergency stop command means 42 is input to the control means 43.
Then, the control means 43 outputs a signal for fixing the axis of the servo motor to the motor shaft fixing means 5. next,
The control means 43 outputs a signal for cutting off the power supply to the servomotor to the motor power cutoff means 6.

【0006】図11において、ロボット12は、移動可
能なスライダー等で構成されたハンド部13と、このハ
ンド部13を移動させるためにハンド部13と連結され
たサーボモータ14と、サーボモータ14の軸を固定ま
たは開放するためのブレーキ15と、回転数、およびハ
ンド部13の位置を検出する回転・位置検出装置16と
を備えている。制御装置17は、サーボモータ14を駆
動するモータ駆動部18と、ブレーキ15に電力を供給
するか、遮断するかを制御するブレーキ駆動部19と、
ハンド部13の動作パターン等をROMまたはRAM等
に記憶させた記憶部20と、この記憶部20、回転・位
置検出装置16および外部装置22等から入力された信
号により、モータ駆動部18、ブレーキ駆動部19を制
御する制御部21とを備えている。電源部45は、ブレ
ーキ駆動部19、モータ駆動部18、制御部21、回転
・位置検出装置16等に、それぞれの任意の電圧に変圧
して電力を供給している。
In FIG. 11, a robot 12 includes a hand portion 13 composed of a movable slider, a servo motor 14 connected to the hand portion 13 for moving the hand portion 13, and a servo motor 14. A brake 15 for fixing or releasing the shaft and a rotation / position detecting device 16 for detecting the number of rotations and the position of the hand portion 13 are provided. The control device 17 includes a motor drive unit 18 that drives the servomotor 14, a brake drive unit 19 that controls whether to supply or cut off electric power to the brake 15.
A storage unit 20 in which an operation pattern or the like of the hand unit 13 is stored in a ROM or a RAM, and a signal input from the storage unit 20, the rotation / position detection device 16, the external device 22, and the like, the motor drive unit 18, the brake. The control unit 21 for controlling the drive unit 19 is provided. The power supply unit 45 supplies electric power to the brake drive unit 19, the motor drive unit 18, the control unit 21, the rotation / position detection device 16, etc. by converting them into arbitrary voltages.

【0007】ブレーキ15に電力が供給されている場
合、ブレーキ15は、サーボモータ14の軸を開放して
いる。また、電力が遮断された場合、ブレーキ15は、
サーボモータ14の軸を固定する。よって、ハンド部1
3を固定することでハンド部13の落下、移動を防止し
ている。
When electric power is supplied to the brake 15, the brake 15 opens the axis of the servo motor 14. When the power is cut off, the brake 15
The axis of the servo motor 14 is fixed. Therefore, the hand unit 1
By fixing 3 the hand part 13 is prevented from falling and moving.

【0008】ハンド部13に任意の動作を行わせる場
合、制御部21は、記憶部20から記憶部20に記憶さ
れた動作パターンを入力し、モータ制御信号21bとし
て、モータ駆動部18に出力する。そして、モータ駆動
部18は、入力されたモータ制御信号21bに基づいて
サーボモータ14を駆動し、ハンド部13に任意の動作
を行わせる。
When the hand unit 13 is to perform an arbitrary operation, the control unit 21 inputs the operation pattern stored in the storage unit 20 from the storage unit 20 and outputs it as a motor control signal 21b to the motor drive unit 18. . Then, the motor drive unit 18 drives the servo motor 14 based on the input motor control signal 21b, and causes the hand unit 13 to perform an arbitrary operation.

【0009】電源がOFFされた場合、電源部45に供
給される電力が遮断される。つまり、モータ駆動部1
8、ブレーキ駆動部19への電力の供給が遮断され、サ
ーボモータ14の巻線は励磁されなくなり、また、ブレ
ーキ15はサーボモータ14の軸を固定して、ハンド部
13の落下、移動を防止する。
When the power supply is turned off, the power supplied to the power supply unit 45 is cut off. That is, the motor drive unit 1
8. The power supply to the brake drive unit 19 is cut off, the winding of the servo motor 14 is not excited, and the brake 15 fixes the axis of the servo motor 14 to prevent the hand unit 13 from falling and moving. To do.

【0010】図8、図11、図12で、ハンド部13を
任意の位置で静止させ、その位置を保持させる場合につ
いて説明する。
A case in which the hand portion 13 is stopped at an arbitrary position and held at that position will be described with reference to FIGS. 8, 11, and 12.

【0011】ハンド部静止位置保持指令手段1として、
ティーチングペンダント等の外部装置22からハンド部
静止位置保持信号21eつまりハンド部静止位置保持指
令を制御部21に出力する。または、記憶部20内のプ
ログラムよりハンド部静止位置保持指令を制御部21に
出力する。そして、制御手段40として、制御部21か
らモータ駆動部18に以下のようなモータ制御信号21
bを出力する。
As the hand unit stationary position holding command means 1,
An external device 22 such as a teaching pendant outputs a hand part rest position holding signal 21e, that is, a hand part rest position holding command to the control part 21. Alternatively, a program in the storage unit 20 outputs a hand unit stationary position holding command to the control unit 21. Then, as the control means 40, the following motor control signal 21 is sent from the control unit 21 to the motor drive unit 18.
Output b.

【0012】制御部21からモータ駆動部18にモータ
制御信号21bが出力されると、まず、ハンド部移動静
止手段3として、モータ駆動部18は、ステップc1〜
ステップc3の動作を行う。つまり、ステップc1で
は、サーボモータ14を減速させながら、ハンド部13
を静止位置まで移動させる。そして、ステップc2、ス
テップc3では、回転・位置検出装置16から出力され
る回転・位置座標信号21aにより位置補正を行いなが
ら、位置決めを完了させる。次に、ハンド部静止位置保
持手段4として、モータ駆動部18は、ステップc4の
動作を行う。つまり、ステップc4では、位置決めが完
了するとサーボモータ14をサーボロックさせて、ハン
ド部13を任意の静止位置に保持させる。
When the motor control signal 21b is output from the control section 21 to the motor drive section 18, first, the motor drive section 18 as the hand section moving / stationary means 3 starts from step c1.
The operation of step c3 is performed. That is, in step c1, while decelerating the servo motor 14, the hand unit 13
Move to a rest position. Then, in steps c2 and c3, the positioning is completed while the position is corrected by the rotation / position coordinate signal 21a output from the rotation / position detection device 16. Next, as the hand portion stationary position holding means 4, the motor drive portion 18 performs the operation of step c4. That is, in step c4, when the positioning is completed, the servo motor 14 is servo-locked, and the hand unit 13 is held at an arbitrary stationary position.

【0013】また、保持後もサーボモータ14は、その
静止位置を保持するために常時、位置補正を行ってい
る。以上のステップを行うことにより、ハンド部13を
任意の位置で静止させ、その位置を保持させている。
Further, even after the holding, the servo motor 14 constantly performs the position correction in order to hold the stationary position. By performing the above steps, the hand unit 13 is stopped at an arbitrary position and held at that position.

【0014】図9、図11、図13で、ハンド部13を
静止・保持位置より再び移動させる場合について説明す
る。
A case in which the hand portion 13 is moved again from the stationary / holding position will be described with reference to FIGS. 9, 11, and 13.

【0015】ハンド部移動開始指令手段7として、ティ
ーチングペンダント等の外部装置22からハンド部移動
信号21fつまりハンド部移動指令を制御部21に出力
する。または、記憶部20内のプログラムよりハンド部
移動指令を制御部21に出力する。そして、制御手段4
1として、制御部21からモータ駆動部18に以下のよ
うなモータ制御信号21bを出力する。
As the hand part movement start command means 7, an external device 22 such as a teaching pendant outputs a hand part movement signal 21f, that is, a hand part movement command to the control part 21. Alternatively, a hand movement command is output to the control unit 21 from a program in the storage unit 20. And the control means 4
1, the following motor control signal 21b is output from the control unit 21 to the motor drive unit 18.

【0016】制御部21からモータ駆動部18にモータ
制御信号21bが出力されると、軸移動開始手段11と
して、モータ駆動部18は、ステップc6の動作を行
う。つまり、ステップc6では、サーボロックを解除
し、サーボモータ14を再移動させ、ハンド部13に任
意の動作をさせる。
When the motor control signal 21b is output from the control section 21 to the motor drive section 18, the motor drive section 18 as the axis movement starting means 11 performs the operation of step c6. That is, in step c6, the servo lock is released, the servo motor 14 is moved again, and the hand unit 13 is caused to perform an arbitrary operation.

【0017】図10、図11で、非常停止が行われた場
合の動作説明をする。
The operation when an emergency stop is performed will be described with reference to FIGS.

【0018】非常停止指令手段42として、非常ボタン
等の非常停止装置44から非常停止信号21cつまり非
常停止指令を制御部21に出力する。そして、制御手段
41として、制御部21からモータ駆動部18にモータ
制御信号21bが出力され、また、制御部21からブレ
ーキ駆動部19にブレーキ制御信号21dが出力され
る。
As the emergency stop command means 42, an emergency stop device 21 such as an emergency button outputs an emergency stop signal 21c, that is, an emergency stop command to the control section 21. Then, as the control means 41, the control unit 21 outputs a motor control signal 21b to the motor drive unit 18, and the control unit 21 outputs a brake control signal 21d to the brake drive unit 19.

【0019】制御部21からモータ駆動部18にモータ
制御信号21bが出力されると、モータ電力遮断手段6
として、モータ駆動部18は、サーボモータ14に供給
される電力を遮断させる。さらに、制御部21からブレ
ーキ駆動部19にブレーキ制御信号21dが出力される
と、モータ軸固定手段5として、ブレーキ駆動部19
は、ブレーキ15によりサーボモータ14の軸を固定さ
せる。
When the motor control signal 21b is output from the control unit 21 to the motor drive unit 18, the motor power cutoff means 6
As a result, the motor driving unit 18 shuts off the electric power supplied to the servo motor 14. Further, when the brake control signal 21d is output from the control unit 21 to the brake drive unit 19, the brake drive unit 19 serves as the motor shaft fixing means 5.
Fixes the shaft of the servomotor 14 with the brake 15.

【0020】[0020]

【発明が解決しようとする課題】上述したように、従来
の制御装置においては、ハンド部の静止位置を保持する
ためにサーボロックを行っている。しかしながら、この
位置を維持するためには、常時、位置補正を行わなけれ
ばならない。このとき、負荷により、または外部からの
作用等により、ハンド部の位置が常に変化していると、
位置補正が繰り返し行われ、そのため、サーボモータは
振動を発生する。
As described above, in the conventional control device, the servo lock is performed to hold the stationary position of the hand portion. However, in order to maintain this position, position correction must always be performed. At this time, if the position of the hand part is constantly changing due to load, external action, etc.,
The position correction is repeated, which causes the servomotor to vibrate.

【0021】[0021]

【課題を解決するための手段】そこで、本発明は、ハン
ド部を移動させ、任意の位置に静止させるハンド部移動
静止手段と、このハンド部移動静止手段によりハンド部
の静止を確認すると、この静止位置にハンド部を保持さ
せるハンド部静止位置保持手段と、このハンド部静止位
置保持手段によりハンド部の静止位置の保持を確認する
と、サーボモータの軸を固定させるモータ軸固定手段
と、このモータ軸固定手段によりサーボモータの軸の固
定を確認すると、サーボモータに供給する電力を遮断す
るモータ電力遮断手段とを備えたことを特徴とするロボ
ットの制御装置。
SUMMARY OF THE INVENTION Therefore, according to the present invention, when the hand unit moving / stationary means for moving the hand unit to stop the hand unit at an arbitrary position and the hand unit's stationary state are confirmed by the hand unit moving / stationary means, When the hand portion stationary position holding means for holding the hand portion in the stationary position and the holding of the hand portion stationary position by the hand portion stationary position holding means are confirmed, the motor shaft fixing means for fixing the shaft of the servo motor, and the motor A controller for a robot, comprising: a motor power cutoff means for cutting off the power supplied to the servomotor when the fixation of the axis of the servomotor is confirmed by the axis fixing means.

【0022】または、前記ハンド部静止位置保持手段に
よりハンド部の静止位置保持を確認すると、ハンド部の
静止時間をカウントするカウント手段と、任意の時間を
設定する時間設定手段と、この時間設定手段により設定
された時間と前記カウント手段でカウントされた時間と
の差を比較する比較手段と、この比較手段により、前記
カウント手段でカウントされた時間が、時間設定手段に
より設定された時間より長くなると、サーボモータの軸
を固定させる前記モータ軸固定手段と、このモータ軸固
定手段によりサーボモータの軸の固定を確認すると、サ
ーボモータに供給する電力を遮断する前記モータ電力遮
断手段とを備えたことを特徴とする制御装置を提供す
る。
Alternatively, when the holding of the stationary position of the hand unit is confirmed by the holding unit for the stationary position of the hand unit, the counting unit for counting the stationary time of the hand unit, the time setting unit for setting an arbitrary time, and the time setting unit. When the time counted by the counting means is longer than the time set by the time setting means, the comparing means compares the difference between the time set by and the time counted by the counting means. A motor shaft fixing means for fixing the axis of the servo motor, and the motor power cutoff means for cutting off the power supplied to the servo motor when the fixation of the servo motor axis is confirmed by the motor shaft fixing means. A control device is provided.

【0023】[0023]

【作用】請求項1において、ハンド部静止位置保持指令
が制御部に入力されると、サーボモータは、減速して静
止位置に移動を開始し、回転・位置検出装置から出力さ
れる回転・位置座標信号により、位置補正を行いながら
ハンド部を静止位置に静止させる。そして、このハンド
部の静止が確認されると、制御部からブレーキへの電力
の供給を遮断するためのブレーキ制御信号をブレーキ駆
動部へ出力して、ブレーキは、サーボモータの軸を固定
する。次に、制御部からサーボモータの巻線への電力の
供給を遮断するためのモータ制御信号をモータ駆動部へ
出力して、サーボモータの巻線は励磁されなくなる。
According to the first aspect of the present invention, when the command to hold the hand rest position is input to the control unit, the servo motor decelerates and starts moving to the rest position, and the rotation / position output from the rotation / position detection device is output. The hand unit is stopped at the stationary position while the position is corrected by the coordinate signal. Then, when it is confirmed that the hand unit is stationary, the control unit outputs a brake control signal for cutting off the supply of electric power to the brake to the brake drive unit, and the brake fixes the axis of the servo motor. Next, a motor control signal for cutting off the supply of electric power from the control unit to the winding of the servo motor is output to the motor driving unit, and the winding of the servo motor is no longer excited.

【0024】請求項2において、ハンド部静止位置保持
指令が制御部に入力されると、サーボモータは、減速し
て静止位置に移動を開始し、回転・位置検出装置から出
力される回転・位置座標信号により、位置補正を行いな
がらハンド部を静止位置に静止させる。そして、この静
止が確認されると、カウント部により時間のカウントを
開始する。そして、制御部により、あらかじめ時間設定
部に設定された任意の時間とカウント部でカウントされ
ている時間との差を比較し、カウント部の時間が、時間
設定部に設定された時間より長くなると、制御部からブ
レーキへの電力の供給を遮断するためのブレーキ制御信
号をブレーキ駆動部へ出力して、ブレーキは、サーボモ
ータの軸を固定する。次に、制御部からサーボモータの
巻線への電力の供給を遮断するためのモータ制御信号を
モータ駆動部へ出力して、サーボモータの巻線は励磁さ
れなくなる。
In the second aspect, when the hand unit stationary position holding command is input to the control unit, the servo motor decelerates and starts moving to the stationary position, and the rotation / position output from the rotation / position detection device. The hand unit is stopped at the stationary position while the position is corrected by the coordinate signal. When the stationary state is confirmed, the counting unit starts counting time. Then, the control unit compares the difference between the arbitrary time preset in the time setting unit and the time counted in the counting unit, and when the time of the counting unit becomes longer than the time set in the time setting unit. A brake control signal for cutting off the supply of electric power from the control unit to the brake is output to the brake drive unit, and the brake fixes the axis of the servo motor. Next, a motor control signal for cutting off the supply of electric power from the control unit to the winding of the servo motor is output to the motor driving unit, and the winding of the servo motor is no longer excited.

【0025】[0025]

【実施例】本発明における第一の実施例を図1〜図4お
よび図11を用いて説明する。図1は、本発明の第一の
実施例におけるハンド部を任意の位置に静止させ、その
位置でハンド部を保持させるための基本ブロック図であ
る。図2は、図1で静止させ、保持させたハンド部を再
移動させるめのための基本ブロック図である。図3は、
本発明の第一の実施例におけるハンド部を静止させ、保
持させるためのフローチャート図である。図4は、図3
で静止させ、保持させたハンド部を再移動させるめのた
めのフローチャート図である。
DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS A first embodiment of the present invention will be described with reference to FIGS. FIG. 1 is a basic block diagram for holding the hand unit at an arbitrary position and holding the hand unit in the first embodiment of the present invention. FIG. 2 is a basic block diagram for re-moving the hand unit held and held in FIG. FIG.
It is a flow chart figure for making a hand part stand still and to hold in a 1st example of the present invention. FIG. 4 shows FIG.
It is a flowchart figure for moving the hand part which was made to stand still and was hold | maintained again.

【0026】図1において、ハンド部静止位置保持指令
手段1よりハンド部を任意の位置に静止させ、その位置
でハンド部を保持させるハンド部静止位置保持指令の信
号を制御手段2に入力する。そして、制御手段2より、
ハンド部を移動させ、任意の位置に静止させるための信
号をハンド部移動静止手段3に出力する。次に、制御手
段2より、ハンド部が静止している位置を保持するため
の信号をハンド部静止位置保持手段4に出力する。次
に、制御手段2より、サーボモータの軸を固定せせるた
めの信号をモータ軸固定手段5に出力する。次に、制御
手段2より、サーボモータに供給される電力を遮断する
信号をモータ電力遮断手段6に出力する。
In FIG. 1, the hand portion stationary position holding command means 1 causes the hand portion to stand still at an arbitrary position, and a signal of a hand portion stationary position holding command for holding the hand portion at that position is input to the control means 2. Then, from the control means 2,
A signal for moving the hand unit and stopping it at an arbitrary position is output to the hand unit moving / stationary unit 3. Next, the control unit 2 outputs a signal for holding the position where the hand unit is stationary to the hand unit stationary position holding unit 4. Next, the control means 2 outputs a signal for fixing the axis of the servo motor to the motor shaft fixing means 5. Next, the control means 2 outputs a signal for shutting off the power supplied to the servomotor to the motor power shutoff means 6.

【0027】図2において、ハンド部移動開始指令手段
7より静止させ、保持させたハンド部を再移動させるハ
ンド部移動指令の信号を制御手段8に入力する。そし
て、制御手段8より、サーボモータに電力を供給して、
ハンド部が固定されている位置をサーボロックを行って
保持する信号をモータ電力供給手段9に出力する。次
に、制御手段8より、サーボモータの軸を開放せせるた
めの信号をモータ軸開放手段10に出力する。次に、制
御手段8より、ハンド部を再移動させて、任意の動作を
させるための信号をハンド部移動開始手段11に出力す
る。
In FIG. 2, a signal of a hand part movement command for moving the held hand part again by the hand part movement start command means 7 is input to the control means 8. Then, the control means 8 supplies power to the servo motor,
A signal for servo-locking the position where the hand portion is fixed and holding the position is output to the motor power supply means 9. Next, the control means 8 outputs a signal for opening the shaft of the servo motor to the motor shaft opening means 10. Next, the control unit 8 outputs the signal for moving the hand unit again and performing an arbitrary operation to the hand unit movement starting unit 11.

【0028】また、本発明の第一の実施例におけるロボ
ットおよび制御装置の構成は、従来における図11と同
様に、ロボット12は、移動可能なスライダー等で構成
されたハンド部13と、このハンド部13を移動させる
ためにハンド部13と連結されたサーボモータ14と、
サーボモータ14の軸を固定または開放するためのブレ
ーキ15と、回転数、およびハンド部13の位置を検出
する回転・位置検出装置16とを備えている。制御装置
17は、サーボモータ14を駆動するモータ駆動部18
と、ブレーキ15に電力を供給するか、遮断するかを判
断、制御するブレーキ駆動部19と、ハンド部13の動
作パターン等をROMまたはRAM等に記憶させた記憶
部20と、この記憶部20、回転・位置検出装置16お
よび外部装置22等から入力された信号により、モータ
駆動部18、ブレーキ駆動部19を制御する制御部21
の構成となっている。
The robot and the control device according to the first embodiment of the present invention have the same structure as in FIG. 11 in the prior art. The robot 12 includes a hand portion 13 composed of a movable slider and the like. A servo motor 14 connected to the hand portion 13 to move the portion 13;
A brake 15 for fixing or releasing the axis of the servo motor 14 and a rotation / position detecting device 16 for detecting the number of rotations and the position of the hand portion 13 are provided. The control device 17 includes a motor drive unit 18 that drives the servo motor 14.
And a brake driving unit 19 that determines and controls whether to supply or cut off electric power to the brake 15, a storage unit 20 that stores an operation pattern of the hand unit 13 in a ROM or a RAM, and the storage unit 20. A control unit 21 for controlling the motor drive unit 18 and the brake drive unit 19 based on signals input from the rotation / position detection device 16 and the external device 22.
It has a structure of.

【0029】図1、図3、図11で、ハンド部13を任
意の位置で静止させ、その位置を保持させる場合につい
て説明する。
A case where the hand unit 13 is stopped at an arbitrary position and held at that position will be described with reference to FIGS. 1, 3, and 11.

【0030】ハンド部静止位置保持指令手段1として、
ティーチングペンダント等の外部装置22からハンド部
静止位置保持信号21eつまりハンド部静止位置保持指
令を制御部21に出力する。または、記憶部20内のプ
ログラムよりハンド部静止位置保持指令を制御部21に
出力する。そして、制御手段2として、制御部21から
モータ駆動部18に以下のようなモータ制御信号21b
を出力し、また、制御部21からブレーキ駆動部19に
以下のようなブレーキ制御信号21dを出力する。
As the hand portion stationary position holding command means 1,
An external device 22 such as a teaching pendant outputs a hand part rest position holding signal 21e, that is, a hand part rest position holding command to the control part 21. Alternatively, a program in the storage unit 20 outputs a hand unit stationary position holding command to the control unit 21. Then, as the control means 2, the following motor control signal 21b is sent from the control unit 21 to the motor drive unit 18.
In addition, the control unit 21 outputs the following brake control signal 21d to the brake drive unit 19.

【0031】制御部21からモータ駆動部18にモータ
制御信号21bが出力されると、まず、ハンド部移動静
止手段3として、モータ駆動部18は、ステップa1〜
ステップa3の動作を行う。つまり、ステップa1で
は、サーボモータ14を減速させながら、ハンド部13
を静止位置まで移動させる。そして、ステップa2、ス
テップa3では、回転・位置検出装置16から出力され
る回転・位置座標信号21aにより位置補正を行いなが
ら、位置決めを完了させる。次に、ハンド部静止位置保
持手段4として、モータ駆動部18は、ステップa4の
動作を行う。つまり、ステップa4はで、位置決めが完
了するとサーボモータ14をサーボロックさせて、ハン
ド部13を任意の静止位置に保持させる。
When the motor control signal 21b is output from the control section 21 to the motor drive section 18, first, the motor drive section 18 as the hand section moving / stationary means 3 starts from step a1.
The operation of step a3 is performed. That is, in step a1, the hand unit 13 is decelerated while decelerating the servo motor 14.
Move to a rest position. Then, in steps a2 and a3, the positioning is completed while the position is corrected by the rotation / position coordinate signal 21a output from the rotation / position detection device 16. Next, as the hand portion stationary position holding means 4, the motor drive portion 18 performs the operation of step a4. That is, in step a4, when the positioning is completed, the servo motor 14 is servo-locked to hold the hand unit 13 at an arbitrary stationary position.

【0032】次に、制御部21からブレーキ駆動部19
へブレーキ制御信号21dが出力され、モータ軸固定手
段5として、ブレーキ駆動部19は、ステップa5の動
作を行う。つまり、ステップa5では、ブレーキ15を
作動させてサーボモータ14の軸を固定する。
Next, the control unit 21 to the brake drive unit 19
The brake control signal 21d is output to the brake drive unit 19 as the motor shaft fixing means 5 to perform the operation of step a5. That is, in step a5, the brake 15 is operated to fix the shaft of the servo motor 14.

【0033】次に、制御部21からモータ駆動部18に
モータ制御信号21bが出力され、モータ電力遮断手段
6として、モータ駆動部18は、ステップa5の動作を
行う。つまり、ステップa6では、サーボモータ14に
供給される電力を遮断する。また、電力を遮断すること
でサーボロックを解除する。以上のステップを行うこと
により、ハンド部13を任意の位置で静止させ、その位
置を保持させている。
Next, the motor control signal 21b is output from the control unit 21 to the motor drive unit 18, and the motor drive unit 18 as the motor power cutoff means 6 performs the operation of step a5. That is, in step a6, the electric power supplied to the servomotor 14 is cut off. Also, the servo lock is released by cutting off the power. By performing the above steps, the hand unit 13 is stopped at an arbitrary position and held at that position.

【0034】図2、図4、図11で、ハンド部13を静
止・保持位置より再び移動させる場合について説明す
る。
A case where the hand unit 13 is moved again from the stationary / holding position will be described with reference to FIGS. 2, 4, and 11.

【0035】ハンド部移動開始指令手段7として、ティ
ーチングペンダント等の外部装置22からハンド部移動
信号21fつまりハンド部移動指令を制御部21に出力
する。または、記憶部20内のプログラムよりハンド部
移動指令を制御部21に出力する。そして、制御手段8
として、制御部21からモータ駆動部18に以下のよう
なモータ制御信号21bを出力し、また、制御部21か
らブレーキ駆動部19に以下のようなブレーキ制御信号
21dを出力する。
As the hand part movement start command means 7, an external device 22 such as a teaching pendant outputs a hand part movement signal 21f, that is, a hand part movement command to the control part 21. Alternatively, a hand movement command is output to the control unit 21 from a program in the storage unit 20. And control means 8
As a result, the control unit 21 outputs the following motor control signal 21b to the motor drive unit 18, and the control unit 21 outputs the following brake control signal 21d to the brake drive unit 19.

【0036】制御部21からモータ駆動部18へモータ
制御信号21bが出力されると、まず、モータ電力供給
手段9として、モータ駆動部18は、ステップa7の動
作を行う。つまり、ステップa7では、サーボモータ1
4に電力を供給して、サーボモータ14をサーボロック
させる。
When the motor control signal 21b is output from the control section 21 to the motor drive section 18, first, the motor drive section 18 as the motor power supply means 9 performs the operation of step a7. That is, in step a7, the servo motor 1
4 is supplied with electric power to servo-lock the servo motor 14.

【0037】次に、制御部21からブレーキ駆動部19
へブレーキ制御信号21dが出力されると、モータ軸開
放手段10として、ブレーキ駆動部19は、ステップa
8の動作を行う。つまり、ステップa8では、サーボモ
ータ14の軸をブレーキ15より開放する。
Next, from the control unit 21 to the brake drive unit 19
When the brake control signal 21d is output to the motor shaft opening means 10, the brake drive unit 19 operates as the motor shaft opening means 10.
8 operation is performed. That is, in step a8, the axis of the servo motor 14 is released from the brake 15.

【0038】次に、制御部21からモータ駆動部18へ
モータ制御信号21bが出力されると、軸移動開始手段
11として、モータ駆動部18は、ステップa9の動作
を行う。つまり、ステップa9では、サーボロックを解
除し、サーボモータ14を再移動させ、ハンド部13に
任意の動作をさせる。
Next, when the motor control signal 21b is output from the control unit 21 to the motor drive unit 18, the motor drive unit 18 as the axis movement starting means 11 performs the operation of step a9. That is, in step a9, the servo lock is released, the servo motor 14 is moved again, and the hand unit 13 is caused to perform an arbitrary operation.

【0039】本発明における第二の実施例を図5〜図7
および図4を用いて説明する。図5は、本発明の第二の
実施例におけるハンド部を任意の位置に静止させ、その
位置でハンド部を保持させるための基本ブロック図であ
る。図6は、本発明の第二の実施例におけるロボットお
よび制御装置を示すブロック図である。図7は、本発明
の第二の実施例におけるハンド部を静止、保持させるた
めのフローチャート図である。
The second embodiment of the present invention is shown in FIGS.
And it demonstrates using FIG. FIG. 5 is a basic block diagram for holding the hand unit at an arbitrary position and holding the hand unit in the second embodiment of the present invention. FIG. 6 is a block diagram showing a robot and a controller in the second embodiment of the present invention. FIG. 7 is a flow chart for holding and holding the hand unit in the second embodiment of the present invention.

【0040】図5において、ハンド部静止位置保持指令
手段1から出力されたハンド部静止位置保持指令を制御
手段26に入力する。そして、制御手段26より、ハン
ド部を任意の位置に静止させるための信号をハンド部移
動静止手段3に出力する。次に、制御手段26より、ハ
ンド部が静止している位置を保持するための信号をハン
ド部静止位置保持手段4に出力する。次に、カウント手
段27より、時間をカウントして、この時間の信号を比
較手段28に出力し、時間設定手段29により、任意の
時間を設定して、この時間の信号を比較手段28に出力
する。次に、時間設定手段29で設定された時間よりも
カウント手段27でカウントされた時間が長くなると、
比較手段28より、制御手段26に信号が出力される。
次に、制御手段26より、サーボモータの軸を固定せせ
るための信号をモータ軸固定手段5に出力する。次に、
制御手段26より、サーボモータに供給される電力を遮
断する信号をモータ電力遮断手段6に出力する。
In FIG. 5, the hand unit still position holding command output from the hand unit still position holding command unit 1 is input to the control unit 26. Then, the control unit 26 outputs a signal for stopping the hand unit to an arbitrary position to the hand unit moving / stationary unit 3. Next, the control means 26 outputs a signal for holding the position where the hand portion is stationary to the hand portion stationary position holding means 4. Next, the counting means 27 counts time, outputs the signal of this time to the comparing means 28, the time setting means 29 sets an arbitrary time, and outputs the signal of this time to the comparing means 28. To do. Next, when the time counted by the counting means 27 becomes longer than the time set by the time setting means 29,
A signal is output from the comparison means 28 to the control means 26.
Next, the control means 26 outputs a signal for fixing the axis of the servo motor to the motor shaft fixing means 5. next,
The control means 26 outputs a signal for shutting off the power supplied to the servomotor to the motor power shutoff means 6.

【0041】また、カウント手段27でカウントされた
時間が時間設定手段29で設定された時間よりも長くな
る以前に、図9における従来例のようにハンド部移動開
始指令手段7によるハンド部移動指令が制御手段26に
入力されると、制御手段26より、ハンド部が静止して
いる位置保持を解除し、ハンド部を再移動させて、任意
の動作をさせるための信号を軸移動開始手段11に出力
する。
Before the time counted by the counting means 27 becomes longer than the time set by the time setting means 29, the hand movement command is issued by the hand movement start command means 7 as in the conventional example in FIG. Is input to the control means 26, the control means 26 releases the holding of the position where the hand portion is stationary, re-moves the hand portion, and sends a signal for performing an arbitrary operation to the axis movement starting means 11. Output to.

【0042】図6において、従来例と同様に、ロボット
12は、ハンド部13と、サーボモータ14と、ブレー
キ15と、回転・位置検出装置16とを備えている。制
御装置30は、従来例と同様に、モータ駆動部18と、
ブレーキ駆動部19と、記憶部20とを備え、さらに、
任意の時間を設定する時間設定部31と、サーボモータ
保持後、時間のカウントを開始するカウント部32と、
モータ駆動部18、ブレーキ駆動部19を制御し、さら
に、時間設定部31で設定された時間と、カウント部3
2でカウントされた時間を比較する制御部33とを備え
ている。
In FIG. 6, the robot 12 is provided with a hand unit 13, a servomotor 14, a brake 15, and a rotation / position detecting device 16, as in the conventional example. The control device 30 includes a motor drive unit 18 and
A brake drive unit 19 and a storage unit 20 are provided, and further,
A time setting unit 31 that sets an arbitrary time, a counting unit 32 that starts counting time after holding the servo motor,
The motor drive unit 18 and the brake drive unit 19 are controlled, and the time set by the time setting unit 31 and the counting unit 3 are controlled.
The control unit 33 compares the times counted in 2.

【0043】図5、図6、図7で、ハンド部を任意の位
置で静止させ、その位置を保持させる場合について説明
する。
A case in which the hand portion is stopped at an arbitrary position and held at that position will be described with reference to FIGS. 5, 6, and 7.

【0044】ハンド部静止位置保持指令手段1として、
ティーチングペンダント等の外部装置22からハンド部
静止位置保持信号33eつまりハンド部静止位置保持指
令を制御部33に出力する。または、記憶部20内のプ
ログラムよりハンド部静止位置保持指令を制御部33に
出力する。そして、制御手段26として、制御部33か
らモータ駆動部18に以下のようなモータ制御信号33
bを出力し、また、制御部33からブレーキ駆動部19
に以下のようなブレーキ制御信号33dを出力する。
As the hand portion stationary position holding command means 1,
An external device 22 such as a teaching pendant outputs a hand unit stationary position holding signal 33e, that is, a hand unit stationary position holding command to the control unit 33. Alternatively, a program in the storage unit 20 outputs a hand unit stationary position holding command to the control unit 33. Then, as the control means 26, the following motor control signal 33 is sent from the control unit 33 to the motor drive unit 18.
b is output, and the brake drive unit 19 is output from the control unit 33.
Then, the following brake control signal 33d is output.

【0045】制御部33からモータ駆動部18にモータ
制御信号33bが出力されると、まず、ハンド部移動静
止手段3として、モータ駆動部18は、ステップb1〜
ステップb3の動作を行う。つまり、ステップb1で
は、サーボモータ14を減速させながら、ハンド部13
を静止位置まで移動させる。そして、ステップb2、ス
テップb3では、回転・位置検出装置16から出力され
る回転・位置座標信号33aにより位置補正を行いなが
ら、位置決めを完了させる。次に、ハンド部静止位置保
持手段4として、モータ駆動部18は、ステップb4の
動作を行う。つまり、ステップb4では、位置決めが完
了するとサーボモータ14をサーボロックさせて、ハン
ド部13を任意の静止位置に固定させる。
When the motor control signal 33b is output from the control section 33 to the motor drive section 18, first, the motor drive section 18 as the hand section moving / stationary means 3 starts from step b1.
The operation of step b3 is performed. That is, in step b1, the hand unit 13 is decelerated while decelerating the servo motor 14.
Move to a rest position. Then, in steps b2 and b3, the positioning is completed while the position is corrected by the rotation / position coordinate signal 33a output from the rotation / position detection device 16. Next, as the hand unit stationary position holding unit 4, the motor drive unit 18 performs the operation of step b4. That is, in step b4, when the positioning is completed, the servo motor 14 is servo-locked and the hand unit 13 is fixed at an arbitrary stationary position.

【0046】次に、カウント手段27、時間設定手段2
9および比較手段28により、ステップb5の動作を行
う。つまり、カウント手段27として、カウント部32
は、ハンド部の静止を確認すると時間のカウントを開始
する。そして、時間設定手段29として、時間設定部3
1には、任意の時間を設定してある。また、比較手段2
8として、制御部33は、カウント部32でカウントし
た時間と時間設定部31で設定した時間を比較する。
Next, the counting means 27 and the time setting means 2
9 and the comparison means 28 perform the operation of step b5. That is, the counting unit 27 serves as the counting unit 32.
Starts counting the time when it confirms that the hand unit is stationary. Then, as the time setting means 29, the time setting unit 3
In 1, an arbitrary time is set. Also, the comparison means 2
As 8, the control unit 33 compares the time counted by the counting unit 32 with the time set by the time setting unit 31.

【0047】そして、カウント部32でカウントした時
間が時間設定部31で設定した時間より長くなると、制
御部33からブレーキ駆動部19にブレーキ制御信号3
3dが出力され、モータ軸固定手段5として、ブレーキ
駆動部19は、ステップb6の動作を行う。つまり、ス
テップb6では、ブレーキ15を作動させてサーボモー
タ14の軸を固定する。
When the time counted by the counting unit 32 becomes longer than the time set by the time setting unit 31, the brake control signal 3 is sent from the control unit 33 to the brake drive unit 19.
3d is output, and the brake drive unit 19 as the motor shaft fixing means 5 performs the operation of step b6. That is, in step b6, the brake 15 is operated to fix the shaft of the servo motor 14.

【0048】次に、制御部33からモータ駆動部18に
モータ制御信号33bが出力され、モータ電力遮断手段
6として、モータ駆動部18は、ステップb7の動作を
行う。つまり、ステップb7では、サーボモータ14に
供給されている電力を遮断する。また、電力を遮断する
ことでサーボロックを解除する。以上のステップを行う
ことにより、ハンド部13を任意の位置で静止させ、そ
の位置を保持させている。
Next, the motor control signal 33b is output from the control unit 33 to the motor drive unit 18, and the motor drive unit 18 as the motor power cutoff means 6 performs the operation of step b7. That is, in step b7, the electric power supplied to the servo motor 14 is cut off. Also, the servo lock is released by cutting off the power. By performing the above steps, the hand unit 13 is stopped at an arbitrary position and held at that position.

【0049】また、カウント部32でカウントしている
時間が時間設定部31で設定した時間内にハンド部移動
指令が制御部33に出力されると、従来例と同様に、軸
移動開始手段11として、モータ駆動部18は、ステッ
プb9の動作を行う。つまり、ステップb9では、サー
ボロックを解除し、サーボモータ14を再移動させ、ハ
ンド部13に任意の動作をさせる。
When a hand movement command is output to the control unit 33 within the time set by the time setting unit 31, the time counted by the counting unit 32 is output to the axis movement starting means 11 as in the conventional example. As a result, the motor drive unit 18 performs the operation of step b9. That is, in step b9, the servo lock is released, the servo motor 14 is moved again, and the hand unit 13 is caused to perform an arbitrary operation.

【0050】また、ハンド部13を任意の位置で静止さ
せ、ブレーキ15を作動させ、サーボモータ14の電力
を遮断させてから、再び移動させる場合は、第一の実施
例における図4と同様の動作をさせる。
When the hand portion 13 is stopped at an arbitrary position, the brake 15 is operated, the electric power of the servo motor 14 is cut off, and the hand portion 13 is moved again, the same operation as in FIG. 4 in the first embodiment is performed. Make it work.

【0051】第一および第二の実施例において、非常停
止などの電源OFF指令が制御装置に入力され、または
電源がOFFされた場合は、従来例と同様に、ブレーキ
15がサーボモータ14の軸を固定し、ハンド部13の
落下、移動の防止を行う。
In the first and second embodiments, when a power-off command such as an emergency stop is input to the control device or the power is turned off, the brake 15 causes the axis of the servomotor 14 to rotate, as in the conventional example. Is fixed to prevent the hand portion 13 from dropping and moving.

【0052】第一の実施例は、ロボット12に静止指令
が入力され、サーボモータ14が静止すると同時に、ブ
レーキ15によりサーボモータ14の軸を固定する。つ
まり、一担サーボモータ14が静止すると長時間にわた
り静止する可能性がある場合に用いられ、第二の実施例
は、ロボット12に静止指令が入力され、サーボモータ
14が静止すると、あらかじめ設定された任意に時間だ
け、サーボロックを行い、設定時間をすぎるとブレーキ
15によりサーボモータ14の軸を固定する。つまり、
移動静止が繰り返し行われる場合に用いられる。
In the first embodiment, a stationary command is input to the robot 12 and the servomotor 14 stops, and at the same time, the brake 15 fixes the axis of the servomotor 14. That is, it is used when there is a possibility that the supporting servomotor 14 will remain stationary for a long time if the servomotor 14 is stationary. In the second embodiment, when the stationary command is input to the robot 12 and the servomotor 14 is stationary, it is set in advance. The servo is locked for an arbitrary time, and when the set time is exceeded, the axis of the servo motor 14 is fixed by the brake 15. That is,
It is used when moving and stationary are repeated.

【0053】以上のように、ハンド部を静止・保持させ
る場合に、本発明においては、サーボロック後、ブレー
キを用いて、サーボモータの軸を固定し、サーボモータ
への電力を遮断するため、従来のような振動を防止する
ことができる。
As described above, in the present invention, when the hand portion is stationary and held, in the present invention, after the servo lock, the brake is used to fix the axis of the servo motor and shut off the power to the servo motor. It is possible to prevent the conventional vibration.

【0054】[0054]

【発明の効果】本発明によれば、ハンド部を任意の位置
に静止・保持する際のサーボロックによる振動が発生し
ない。さらに、サーボモータに電力が供給されていない
ため、省エネルギーとなる。
According to the present invention, the vibration due to the servo lock does not occur when the hand portion is stopped and held at an arbitrary position. Further, since power is not supplied to the servo motor, energy is saved.

【0055】[0055]

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

【図1】本発明の第一の実施例におけるハンド部を任意
の位置に静止させ、その位置でハンド部を保持させるた
めの基本ブロック図。
FIG. 1 is a basic block diagram for holding a hand unit at an arbitrary position and holding the hand unit in the first embodiment of the present invention.

【図2】図1で静止させ、保持させたハンド部を再移動
させるめのための基本ブロック図。
FIG. 2 is a basic block diagram for re-moving the hand unit that is stationary and held in FIG.

【図3】本発明の第一の実施例におけるハンド部を静止
させ、保持させるためのフローチャート図。
FIG. 3 is a flowchart for holding and holding the hand unit in the first embodiment of the present invention.

【図4】図3で静止させ、保持させたハンド部を再移動
させるめのためのフローチャート図。
FIG. 4 is a flow chart diagram for re-moving the hand unit held and held in FIG.

【図5】本発明の第二の実施例におけるハンド部を任意
の位置に静止させ、その位置でハンド部を保持させるた
めの基本ブロック図。
FIG. 5 is a basic block diagram for holding the hand unit at an arbitrary position and holding the hand unit in the second embodiment of the present invention.

【図6】本発明の第二の実施例におけるロボットおよび
制御装置を示すブロック図。
FIG. 6 is a block diagram showing a robot and a control device according to a second embodiment of the present invention.

【図7】本発明の第二の実施例におけるハンド部を静止
させ、保持させるためのフローチャート図。
FIG. 7 is a flow chart for holding and holding the hand unit in the second embodiment of the present invention.

【図8】従来におけるハンド部を任意の位置に静止さ
せ、その位置でハンド部を保持させるための基本ブロッ
ク図。
FIG. 8 is a basic block diagram for holding a hand unit at an arbitrary position and holding the hand unit at the position in the related art.

【図9】図8で静止させ、保持させたハンド部を再移動
させるための基本ブロック図。
9 is a basic block diagram for re-moving the hand unit that is held still in FIG. 8 and held.

【図10】非常停止の際の基本ブロック図。FIG. 10 is a basic block diagram at the time of emergency stop.

【図11】従来におけるロボットおよび制御装置を示す
ブロック図。
FIG. 11 is a block diagram showing a conventional robot and control device.

【図12】従来におけるハンド部を静止、保持させるた
めのフローチャート図。
FIG. 12 is a flow chart for holding and holding a conventional hand unit.

【図13】図12で静止させ、保持させたハンド部を再
移動させるめのためのフローチャート図。
FIG. 13 is a flow chart for moving the hand unit that is stationary and held in FIG. 12 again.

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

1…ハンド部静止位置保持指令手段 2、8、26、40、41、43…制御手段 3…ハンド部移動静止手段 4…ハンド部静止位置保持手段 5…モータ軸固定手段 6…モータ電力遮断手段 7…ハンド部移動開始指令手段 9…モータ電力供給手段 10…モータ
軸開放手段 11…軸移動開始手段 12…ロボッ
ト 13…ハンド部 14…サーボ
モータ 15…ブレーキ 16…回転・
位置検出装置 17、30…制御装置 18…モータ
駆動部 19…ブレーキ駆動部 20…記憶部 21、33…制御部 22…外部装
置 27…カウント手段 28…比較手
段 29…時間設定手段 31…時間設
定部 32…カウント部 42…非常停
止指令手段 44…非常停止装置 45…電源部
DESCRIPTION OF SYMBOLS 1 ... Hand part stationary position holding command means 2, 8, 26, 40, 41, 43 ... Control means 3 ... Hand part moving / stationary means 4 ... Hand part stationary position holding means 5 ... Motor shaft fixing means 6 ... Motor power interruption means 7 ... Hand part movement start command means 9 ... Motor power supply means 10 ... Motor shaft opening means 11 ... Axis movement start means 12 ... Robot 13 ... Hand part 14 ... Servo motor 15 ... Brake 16 ... Rotation /
Position detection device 17, 30 ... Control device 18 ... Motor drive unit 19 ... Brake drive unit 20 ... Storage unit 21, 33 ... Control unit 22 ... External device 27 ... Counting means 28 ... Comparison means 29 ... Time setting means 31 ... Time setting Part 32 ... Counting part 42 ... Emergency stop command means 44 ... Emergency stop device 45 ... Power supply part

Claims (2)

【特許請求の範囲】[Claims] 【請求項1】ハンド部と連結し、このハンド部を駆動す
るたサーボモータを備えたロボットの制御装置におい
て、 ハンド部を移動させ、任意の位置に静止させるハンド部
移動静止手段と、 このハンド部移動静止手段によりハンド部の静止を確認
すると、この静止位置にハンド部を保持させるハンド部
静止位置保持手段と、 このハンド部静止位置保持手段によりハンド部の静止位
置の保持を確認すると、サーボモータの軸を固定させる
モータ軸固定手段と、 このモータ軸固定手段によりサーボモータの軸の固定を
確認すると、サーボモータに供給する電力を遮断するモ
ータ電力遮断手段とを備えたことを特徴とするロボット
の制御装置。
1. A robot controller having a servo motor for driving a hand unit, which is connected to the hand unit, and a hand unit moving and stopping means for moving the hand unit and stopping the hand unit at an arbitrary position. When the stationary portion of the hand portion is confirmed by the unit moving and stationary means, the hand portion stationary position holding means for holding the hand portion at this stationary position and the holding of the stationary position of the hand portion by this hand portion stationary position holding means A motor shaft fixing means for fixing the motor shaft; and a motor power cutoff means for cutting off the power supplied to the servomotor when the fixing of the servomotor shaft is confirmed by the motor shaft fixing means. Robot controller.
【請求項2】前記ハンド部静止位置保持手段によりハン
ド部の静止位置保持を確認すると、ハンド部の静止時間
をカウントするカウント手段と、 任意の時間を設定する時間設定手段と、 この時間設定手段により設定された時間と前記カウント
手段でカウントされた時間との差を比較する比較手段
と、 この比較手段により、前記カウント手段でカウントされ
た時間が、時間設定手段により設定された時間より長く
なると、サーボモータの軸を固定させる前記モータ軸固
定手段と、 このモータ軸固定手段によりサーボモータの軸の固定を
確認すると、サーボモータに供給する電力を遮断する前
記モータ電力遮断手段とを備えたことを特徴とする請求
項1記載のロボットの制御装置。
2. When the holding of the stationary position of the hand unit is confirmed by the hand unit stationary position holding unit, the counting unit for counting the stationary time of the hand unit, the time setting unit for setting an arbitrary time, and the time setting unit. Comparing means for comparing the difference between the time set by the above-mentioned time and the time counted by the counting means, and when the time counted by the counting means becomes longer than the time set by the time setting means by the comparing means. A motor shaft fixing means for fixing the axis of the servo motor, and the motor power cut-off means for cutting off the power supplied to the servo motor when the fixation of the servo motor axis is confirmed by the motor shaft fixing means. The control device for a robot according to claim 1, wherein:
JP23031194A 1994-08-30 1994-08-30 Control device for robot Pending JPH0871970A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP23031194A JPH0871970A (en) 1994-08-30 1994-08-30 Control device for robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP23031194A JPH0871970A (en) 1994-08-30 1994-08-30 Control device for robot

Publications (1)

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

Family

ID=16905851

Family Applications (1)

Application Number Title Priority Date Filing Date
JP23031194A Pending JPH0871970A (en) 1994-08-30 1994-08-30 Control device for robot

Country Status (1)

Country Link
JP (1) JPH0871970A (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002192434A (en) * 2000-12-26 2002-07-10 Mori Seiki Co Ltd Automatic tool changer
JP2005209061A (en) * 2004-01-26 2005-08-04 Yaskawa Electric Corp Automatic machine control unit
JP2017524546A (en) * 2014-07-22 2017-08-31 グーグル インコーポレイテッド Hybrid fluid pressure and electrically operated mobile robot

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002192434A (en) * 2000-12-26 2002-07-10 Mori Seiki Co Ltd Automatic tool changer
JP2005209061A (en) * 2004-01-26 2005-08-04 Yaskawa Electric Corp Automatic machine control unit
JP2017524546A (en) * 2014-07-22 2017-08-31 グーグル インコーポレイテッド Hybrid fluid pressure and electrically operated mobile robot

Similar Documents

Publication Publication Date Title
JP4075803B2 (en) Motor control device
JP2009053801A (en) Numerical controller with program restart function
EP0150216A1 (en) Method of controlling positional loop gain
JP4362095B2 (en) Numerical controller
JP2006004275A (en) Numerical control device
JPH0871970A (en) Control device for robot
JPH1027013A (en) Method for controlling superimposition by numerical controller
JPH11143519A (en) Acceleration-deceleration control method for numerical control, and numerical controller
WO1995023046A1 (en) Laser processing apparatus
JP4116640B2 (en) Numerical control device with multi-system control function
JPS61203883A (en) Servo motor control system
JP6649336B2 (en) Control device and control method for controlling work moving device and robot to operate in cooperation
JPH02110707A (en) Reference point return system
WO1994019731A1 (en) Numeric controller
JP2831700B2 (en) Manual operation control device for pulse motor
JPH11179691A (en) Control device for robot
JPH04298490A (en) Method of forming speed reference signal in motor for crane
JP2006293791A (en) Numerical controller and driving shaft starting/stopping method thereof
JPH08132369A (en) Robot controller
JP3235719B2 (en) Dimensional cutting control device for steel sheet
JP3348423B2 (en) How to determine the load direction of the robot arm
JP2741220B2 (en) Vertical positioning device
JP2005219138A (en) Robot control method, robot control device, robot control program, and recording medium
JPH0215953A (en) Positioning control device
JPH05309583A (en) Control device for industrial robot