【０００１】[0001]
【産業上の利用分野】本発明は、ロボットの自動運転中
に自動運転モードと手動運転モードを相互に切り換える
ことができるロボット手動送り制御装置に関する。BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a robot manual feed controller capable of switching between an automatic operation mode and a manual operation mode during automatic operation of a robot.
【０００２】[0002]
【従来の技術】近年、ティーチングプレイバック式のロ
ボットが盛んに利用されている。このティーチングプレ
イバックとは、予めロボットが動作すべき軌跡の位置及
び姿勢を記憶装置等に記憶させておき、この記憶された
データに基づいて該ロボットを前記軌跡に沿って作動さ
せる方式であり、この記憶させる操作をティーチングと
称し、ティーチングプレイバックとは、前記ティーチン
グにより記憶させた操作を再現させる操作をいう。そし
て、多品種少量に対応した生産形態が増加するのに伴
い、作業対象となるワークの形状及び作業形態の変更が
煩雑に生じ、その度にロボットに記憶させるべきティー
チングのデータを修正せねばならず、このために生産性
が上がらなくなってきている。このようなティーチング
プレイバック方式を適用したロボットの操作方法に関連
して以下のような技術が知られている。例えば、特開昭
５９−１４４９１０号公報には、所定のティーチングポ
イント近くまでロボットを手動で移動した後は、自動で
制御点を移動させ、認識した制御点をティーチングポイ
ントとして記憶させるティーチングサポート方法が提案
されている。また、特開平２−１６０４８７号公報に
は、精度確保が必要な箇所では、ロボットの自動実行プ
ログラム中に外部割り込みの命令コードを置き、ロボッ
トの自動運転中に自動運転モードと手動運転モードを切
り換え、手動運転により基準とする位置を修正する位置
修正方式が提案されている。2. Description of the Related Art In recent years, teaching playback type robots have been widely used. This teaching playback is a system in which the position and orientation of the locus that the robot should move in advance is stored in a storage device or the like, and the robot is operated along the locus based on the stored data. This stored operation is called teaching, and teaching playback is an operation for reproducing the operation stored by the teaching. Then, as the number of production types corresponding to a wide variety of small quantities increases, the shape of the work to be worked and the work form are complicatedly changed, and the teaching data to be stored in the robot must be corrected each time. This, in turn, has reduced productivity. The following techniques are known in relation to a robot operating method to which such a teaching playback system is applied. For example, Japanese Laid-Open Patent Publication No. 59-144910 discloses a teaching support method in which a control point is automatically moved after the robot is manually moved to near a predetermined teaching point and the recognized control point is stored as a teaching point. Proposed. In Japanese Patent Laid-Open No. 2-160487, an instruction code of an external interrupt is placed in a robot automatic execution program at a place where accuracy is required to be secured, and an automatic operation mode and a manual operation mode are switched during automatic operation of the robot. A position correction method for correcting the reference position by manual operation has been proposed.
【０００３】[0003]
【発明が解決しようとする課題】しかしながら、前記特
開昭５９−１４４９１０号公報の提案では、制御点の認
識を機械的な接触検出手段により行っているために、高
速で移動接触を行うと、制御装置が接触を電気的に認識
したときには、ロボットが惰走して必要精度の位置認識
ができず、所定の精度の位置認識を行うには、低速移動
を行う必要があり、ティーチング作業の自動化は行われ
るものの生産性が上がらないという問題点があった。ま
た、前記特開平２−１６０４８７号公報の提案では、従
来から公知なロボット制御装置の入出力回路に遠隔操作
盤を設けて手動動作を行うようになっているが、ロボッ
ト制御装置の入出力回路が接点構成であるため、ロボッ
トを事前に設定した速度の組合わせの中で、接点を切り
換えて動作させることしかできない。従って、速度増減
動作を滑らかに行うことができず、手動運転時の操作性
が悪いために効率のよいティーチング作業が行えないと
いう問題点があった。本発明はこのような事情に鑑みて
なされたもので、機械の持つ正確な動作と、人間の持つ
高度な確認、判断能力とを有効に活用すると共に、手動
運転時の操作性を改善することにより簡便な方法で能率
よくロボットの位置及び姿勢制御を行えるロボット手動
送り制御装置を提供することを目的とする。However, in the proposal of the above-mentioned Japanese Patent Laid-Open No. 59-144910, since the control point is recognized by the mechanical contact detecting means, when the moving contact is performed at high speed, When the control device electrically recognizes the contact, the robot coasts and cannot recognize the position with the required accuracy.To perform the position recognition with the predetermined accuracy, it is necessary to move at low speed. However, there was a problem that productivity was not improved though it was done. Further, in the proposal of the above-mentioned Japanese Patent Laid-Open No. 2-160487, a remote operation panel is provided in the input / output circuit of a conventionally known robot control device to perform a manual operation. Since it has a contact structure, the robot can only be operated by switching the contact in a preset combination of speeds. Therefore, there is a problem in that the speed increasing / decreasing operation cannot be performed smoothly, and the operability during manual operation is poor, so that efficient teaching work cannot be performed. The present invention has been made in view of such circumstances, and it is possible to effectively utilize the accurate operation of a machine and the advanced confirmation and judgment ability of a human, and to improve the operability during manual operation. Therefore, it is an object of the present invention to provide a robot manual feed control device capable of efficiently controlling the position and orientation of a robot by a simple method.
【０００４】[0004]
【課題を解決するための手段】前記目的に沿う請求項１
記載のロボット手動送り制御装置は、ティーチングプレ
イバック制御による自動運転モードと手動運転モードと
によりロボットを動作させるロボット制御装置を有する
ロボット手動送り制御装置において、多方向の動作自由
度を持つロボットの位置及び姿勢修正用の操作桿と、前
記ロボット制御装置の自動運転モードと手動運転モード
との切り換えを指示する操作ボタンと、該ロボット制御
装置からの出力信号を表示する状態表示ランプとを設け
た遠隔操作ボックスを有すると共に、ティーチングデー
タの入力及び編集を行うティーチングボックスを備える
ように構成されている。請求項２記載のロボット手動送
り制御装置は、請求項１記載のロボット手動送り制御装
置において、前記操作桿は各自由度毎の操作量に同期し
て動作するアナログ素子を有し、該アナログ素子に生じ
るアナログ値を検出して、該アナログ値をアナログ／デ
ジタル変換する電気回路が前記操作桿あるいは前記ロボ
ット制御装置に設けられて構成されている。A method according to the above-mentioned object.
The robot manual feed control device described is a robot manual feed control device having a robot control device that operates the robot in an automatic operation mode and a manual operation mode by teaching playback control. And a remote controller provided with an operation stick for posture correction, an operation button for instructing switching between the automatic operation mode and the manual operation mode of the robot controller, and a status display lamp for displaying an output signal from the robot controller. In addition to having an operation box, the teaching box for inputting and editing teaching data is provided. The robot manual feed control device according to claim 2 is the robot manual feed control device according to claim 1, wherein the operating rod has an analog element that operates in synchronization with an operation amount for each degree of freedom. An electric circuit for detecting an analog value generated in the above and converting the analog value into an analog / digital value is provided in the operation rod or the robot control device.
【０００５】[0005]
【作用】請求項１及び２記載のロボット手動送り制御装
置においては、多方向の動作自由度を持つロボットの位
置及び姿勢修正用の操作桿と、前記ロボット制御装置の
自動運転モードと手動運転モードとの切り換えを指示す
る操作ボタンと、該ロボット制御装置からの出力信号を
表示する状態表示ランプとを設けた遠隔操作ボックスを
有すると共に、ティーチングデータの入力及び編集を行
うティーチングボックス備えるように構成されているの
で、オペレータが状態表示ランプ及びロボットの作動状
態を判断しながら、自動運転モードと手動運転モードを
切り換えることにより効率的なロボット運転操作を行う
ことができる。特に、請求項２記載のロボット手動送り
制御装置においては、前記操作桿は各自由度毎の操作角
度等の操作量に同期して動作するアナログ素子を有し、
該アナログ素子に生じるアナログ値を検出して、該アナ
ログ値をアナログ／デジタル変換する電気回路が前記操
作桿あるいは前記ロボット制御装置に設けられているの
で、前記操作量と該電気回路からの出力値との関係を調
整あるいは変更することができるため、手動運転モード
における操作桿の必要な動作特性を確保することができ
る。In the robot manual feed control device according to the present invention, the operating rod for correcting the position and orientation of the robot having multi-directional movement degrees of freedom, and the automatic operation mode and the manual operation mode of the robot control device. And a remote control box provided with a status display lamp for displaying an output signal from the robot controller, and a teaching box for inputting and editing teaching data. Therefore, the operator can perform an efficient robot operation operation by switching between the automatic operation mode and the manual operation mode while determining the status display lamp and the operating state of the robot. Particularly, in the robot manual feed control device according to claim 2, the operation rod has an analog element that operates in synchronization with an operation amount such as an operation angle for each degree of freedom,
Since an electric circuit that detects an analog value generated in the analog element and converts the analog value into an analog / digital value is provided in the operation rod or the robot control device, the operation amount and the output value from the electric circuit Since it is possible to adjust or change the relationship with, it is possible to secure the necessary operating characteristics of the operating rod in the manual operation mode.
【０００６】[0006]
【実施例】続いて、添付した図面を参照しつつ、本発明
を具体化した実施例につき説明し、本発明の理解に供す
る。ここに、図１は本発明の一実施例に係るロボット手
動送り制御装置の説明図、図２は同装置の動作を説明す
る斜視図、図３は同装置のロボット制御装置の説明図、
図４は同装置の動作を示すフロー図、図５（Ａ）、
（Ｂ）はそれぞれジョイスティックモード、及びマスタ
ーアームモードにおける操作桿の操作角度と発生電圧と
の関係を示し、（Ｃ）は修正量と発生電圧との関係を示
す図である。Embodiments of the present invention will now be described with reference to the accompanying drawings to provide an understanding of the present invention. 1 is an explanatory view of a robot manual feed control device according to an embodiment of the present invention, FIG. 2 is a perspective view for explaining the operation of the same device, FIG. 3 is an explanatory view of a robot control device of the same device,
FIG. 4 is a flow chart showing the operation of the device, FIG.
(B) shows the relationship between the operating angle of the operating rod and the generated voltage in the joystick mode and the master arm mode, and (C) shows the relationship between the correction amount and the generated voltage.
【０００７】図１に示すように本発明の一実施例に係る
ロボット手動送り制御装置１０は、ロボットの一例であ
るマニプレータ１２、ロボット制御装置１１、ティーチ
ングボックス１７及び遠隔操作ボックスの一例であるジ
ョイステックコントローラ１３とからなる。マニプレー
タ１２は、アーム１２ａの先端部に鋳造物等のワーク２
７を把持して多方向の自由度を持って移動させることの
できる把持部１２ｂを有しており、後述するロボット制
御装置１１からの信号に基づいて位置及び姿勢を所望の
状態に制御するように構成されている。ロボット制御装
置１１は、ジョイステックコントローラ１３、及びティ
ーチングボックス１７からの信号に基づいて必要な制御
信号をマニプレータ１２に送ることのできる装置であ
る。ジョイスティックコントローラ１３には、マニプレ
ータ１２の位置及び姿勢修正用の操作桿１４と、前記ロ
ボット制御装置１１の自動運転モードと手動運転モード
との切り換えを指示する操作ボタン１６と、該ロボット
制御装置１１からの出力信号を表示する状態表示ランプ
１５とが設けられており、オペレータが実際の操作状況
とロボット制御装置１１からの表示信号に基づいて的確
に状況を判断することができるようになっている。また
ジョイスティックコントローラ１３は、前記操作桿１４
の各自由度毎の操作量に同期して動作するアナログ素子
の一例である可変抵抗を有しており、また、ジョイステ
ィックコントローラ１３あるいは操作桿１４には、予め
設定されている電圧を固定抵抗と前記可変抵抗との間に
かけておき、該可変抵抗の両端に生じる電圧値を検出し
て該電圧値をアナログ／デジタル変換する電気回路が設
けられている。但し、このアナログ／デジタル変換する
電気回路自体はジョイスティックコントローラ１３の中
あるいは操作桿１４に配置されている必要はなく、ロボ
ット制御装置１１の中に配置しておくほうが、ジョイス
ティックコントローラ１３の軽量化の点で有効である。As shown in FIG. 1, a robot manual feed control device 10 according to an embodiment of the present invention includes a manipulator 12, which is an example of a robot, a robot control device 11, a teaching box 17, and a joystick, which is an example of a remote control box. It consists of the tech controller 13. The manipulator 12 includes a workpiece 2 such as a casting on the tip of the arm 12a.
It has a gripping part 12b capable of gripping 7 and moving in multiple directions with freedom, and controls the position and orientation to a desired state based on a signal from a robot controller 11 described later. Is configured. The robot control device 11 is a device that can send necessary control signals to the manipulator 12 based on signals from the joystick controller 13 and the teaching box 17. The joystick controller 13 includes an operation rod 14 for correcting the position and orientation of the manipulator 12, an operation button 16 for instructing switching between the automatic operation mode and the manual operation mode of the robot control device 11, and the robot control device 11 And a status display lamp 15 for displaying the output signal of the robot controller 11 are provided so that the operator can accurately judge the status based on the actual operation status and the display signal from the robot controller 11. In addition, the joystick controller 13 includes the operation rod 14
Has a variable resistor that is an example of an analog element that operates in synchronization with the operation amount for each degree of freedom, and the joystick controller 13 or the operating rod 14 has a preset voltage as a fixed resistor. An electric circuit is provided which is provided between the variable resistor and the voltage value generated at both ends of the variable resistor, and which converts the voltage value into an analog / digital value. However, the electric circuit itself for analog / digital conversion does not need to be arranged in the joystick controller 13 or the operation stick 14, and it is preferable to arrange the electric circuit in the robot control device 11 in order to reduce the weight of the joystick controller 13. It is effective in terms.
【０００８】ジョイスティックコントローラ１３上の操
作桿１４には手首位置操作用レバー１４ａ及び手首姿勢
操作用レバー１４ｂとがあり、３自由度を有する手首位
置操作用レバー１４ａを前後、左右に傾動することによ
ってマニプレータ１２のアーム１２ａの先部に取付けら
れている把持部１２ｂが前後、左右に移動し、更に手首
位置操作用レバー１４ａの側面に取付けられているスイ
ッチを昇降することにより把持部１２ｂを上下に移動す
るようになっている。同じく３自由度を有する手首姿勢
操作用レバー１４ｂを前後、左右に傾動することによっ
て、把持部１２ｂが前後、左右に傾動し、更に手首姿勢
操作用レバー１４ｂをレバー軸芯まわりに正逆転方向に
転動することにより把持部１２ｂが把持部軸芯まわりに
正逆転方向に転動する。また、ジョイスティックコント
ローラ１３には操作桿１４の操作角度の操作量に応じて
速度指令量を生成するジョイスティックモードと、操作
桿１４の操作量に応じて絶対位置指令量を発生するマス
ターアームモードとがあり、切り換えスイッチにより両
モードを任意に選択できるようになっている。図５
（Ａ）、（Ｂ）はそれぞれジョイスティックモード及び
マスターアームモード時における操作桿１４の操作角度
と操作桿１４の操作によって発生する発生電圧との関係
を示したものであり、ジョイスティックモード時におい
ては、操作桿１４の中立点（オフセット値）に不感帯域
を設けることが、実際の場合においては操作性を確保す
るために重要であるが、マスターアームモード時におい
ては絶対位置を正確に指定することが必要であるため、
このような不感帯域を前回入力電圧値の近傍に設けるこ
とが好ましい。The operating rod 14 on the joystick controller 13 has a wrist position operating lever 14a and a wrist posture operating lever 14b. By tilting the wrist position operating lever 14a having three degrees of freedom, back and forth and left and right. The grip 12b attached to the tip of the arm 12a of the manipulator 12 moves back and forth, left and right, and the switch attached to the side surface of the wrist position operating lever 14a is moved up and down to move the grip 12b up and down. It is designed to move. Similarly, by tilting the wrist posture operating lever 14b having three degrees of freedom back and forth and left and right, the grip portion 12b tilts forward and backward and left and right, and further, the wrist posture operating lever 14b is rotated in the forward and reverse directions around the lever axis. By rolling, the grip portion 12b rolls in the forward and reverse directions around the grip portion axis. In addition, the joystick controller 13 has a joystick mode that generates a speed command amount according to the operation amount of the operation angle of the operation rod 14 and a master arm mode that generates an absolute position command amount according to the operation amount of the operation rod 14. Yes, both modes can be arbitrarily selected by the changeover switch. Figure 5
(A) and (B) show the relationship between the operating angle of the operating rod 14 and the voltage generated by operating the operating rod 14 in the joystick mode and the master arm mode, respectively. In the joystick mode, It is important to provide a dead zone at the neutral point (offset value) of the operating rod 14 in order to ensure operability in the actual case, but it is necessary to accurately specify the absolute position in the master arm mode. Because it is necessary
It is preferable to provide such a dead band near the previous input voltage value.
【０００９】状態表示ランプ１５は操作時点での自動運
転あるいは手動運転モードの状態を表示し、さらに必要
に応じてマニプレータ１２の位置、姿勢等の情報をオペ
レータに明示することができるものである。そして、ジ
ョイスティックコントローラ１３上に配置された操作ボ
タン１６をオンオフさせることにより自動運転モードと
手動運転モードとの切り換えが行える。ティーチングボ
ックス１７は、ティーチング時におけるマニプレータ１
２の位置及び姿勢等のデータをロボット制御装置１１に
予め入力して、ロボットを動作させるプログラムの編集
等を行うための装置である。The status display lamp 15 displays the status of the automatic operation mode or the manual operation mode at the time of operation, and can further indicate information such as the position and orientation of the manipulator 12 to the operator as necessary. Then, the operation button 16 arranged on the joystick controller 13 is turned on / off to switch between the automatic operation mode and the manual operation mode. The teaching box 17 is used for the manipulator 1 during teaching.
This is a device for preliminarily inputting data such as position and orientation of No. 2 into the robot control device 11 to edit a program for operating the robot.
【００１０】続いて、図３に示す本発明の一実施例に係
るロボット手動送り制御装置１０のロボット制御装置１
１について更に詳細に説明する。図３に示されるように
ロボット制御装置１１はマニプレータ１２、ジョイステ
ィックコントローラ１３及びティーチングボックス１７
に連結されており、必要な信号の入出力が行えるように
なっている。そして、図３の点線内に示されるロボット
制御装置１１の内部には、中央処理装置（ＣＰＵ１８）
が配置され、外部のティーチングボックス１７と信号線
を介して最初に連結する操作パネルインターフェース１
９、モーションコントロール２０、各軸コントロール２
１、及び外部のマニプレータ１２に接続する各軸サーボ
回路２２とが配置されている。Subsequently, the robot controller 1 of the robot manual feed controller 10 according to the embodiment of the present invention shown in FIG.
1 will be described in more detail. As shown in FIG. 3, the robot controller 11 includes a manipulator 12, a joystick controller 13, and a teaching box 17.
It is connected to and can input and output the necessary signals. A central processing unit (CPU 18) is provided inside the robot controller 11 shown within the dotted line in FIG.
The operation panel interface 1 in which is arranged and is first connected to the external teaching box 17 via a signal line.
9, motion control 20, each axis control 2
1 and each axis servo circuit 22 connected to the external manipulator 12 are arranged.
【００１１】ここで、操作パネルインターフェース１９
にはティーチングボックス１７からの信号が入力され、
モーションコントロール２０はＣＰＵ１８を介して処理
される信号等により、各軸コントロール２１に対応した
信号を発生する機能を有する。各軸コントロール２１は
モーションコントロール２０の作動に応じて各軸（例え
ば６軸）の移動量を決定して、各軸サーボ回路２２に必
要な制御信号を発することができる。Here, the operation panel interface 19
The signal from the teaching box 17 is input to
The motion control 20 has a function of generating a signal corresponding to each axis control 21 by a signal processed through the CPU 18. Each axis control 21 can determine the amount of movement of each axis (for example, 6 axes) according to the operation of the motion control 20, and can issue a necessary control signal to each axis servo circuit 22.
【００１２】更に、ロボット制御装置１１は外部のジョ
イスティックコントローラ１３にそれぞれ信号線を介し
て連結するＩ／Ｏコントロール２４及び手動送りコント
ロール２５とがあり、ＣＰＵ１８が参照するプログラム
データ記憶部２３とを有している。Ｉ／Ｏコントロール
２４はＣＰＵ１８への外部割り込み等の入出力を受け付
ける制御部であり、これによりジョイスティックコント
ローラ１３からの信号が処理されて操作ボタン１６の入
力による自動運転モードから手動運転モードへの切り換
え、表示ランプ出力用の接点コントロール等が実行され
る。手動送りコントロール２５は操作桿１４の操作角度
等の操作量に対応して可変抵抗から出力されるアナログ
信号である発生電圧（６チャンネル）をアナログ／デジ
タル変換後、修正特性を付与して修正されたデジタルデ
ータを生成することができる。ここで、前記修正特性の
付与は例えば、図５（Ｃ）に示すようにアナログ／デジ
タル変換して得られる発生電圧（ｘ）を基にして、１次
増加特性（ｙ＝ａｘ）、２次増加特性（ｙ＝ａｘ2）あ
るいは１／２次増加特性（ｙ＝ａｘ1/2）等の関係式に
より修正された修正量（ｙ）を求めることができ、これ
をＣＰＵ１８上の簡単な演算操作により行うことができ
る（但しａは定数）。通常は発生電圧に対して比例した
修正量を生成させる１次増加特性によるものが一般的な
方法であるが、微小な位置決めと、大きな移動操作が混
在するような場合には２次増加特性により規定される修
正量を用いることにより位置決め操作を容易にすること
ができる。また、もっぱら高速で大きな移動操作のみを
行う場合には、１／２次増加特性による制御を行うこと
により操作桿１４の操作量を少なくできて操作性を向上
させることが可能となる。従って、その時の操作条件に
応じて前記の操作特性を適宜選択することにより、操作
桿１４の操作性を確保し適切なロボットの遠隔操作が可
能となる。Further, the robot controller 11 has an I / O control 24 and a manual feed control 25 which are connected to the external joystick controller 13 via signal lines, respectively, and has a program data storage section 23 referred to by the CPU 18. are doing. The I / O control 24 is a control unit that receives input / output such as an external interrupt to the CPU 18, and a signal from the joystick controller 13 is processed by the I / O control 24 to switch the automatic operation mode to the manual operation mode by inputting the operation button 16. , Contact control for output of the indicator lamp, etc. are executed. The manual feed control 25 corrects the generated voltage (6 channels), which is an analog signal output from the variable resistance, in accordance with the amount of operation such as the operation angle of the operating rod 14 after analog / digital conversion and then adds a correction characteristic to correct. Digital data can be generated. Here, the correction characteristic is given, for example, based on a generated voltage (x) obtained by analog / digital conversion as shown in FIG. 5C, a primary increase characteristic (y = ax), a secondary increase characteristic The correction amount (y) corrected by a relational expression such as the increasing characteristic (y = ax2 ) or the 1 / 2th-order increasing characteristic (y = ax1/2 ) can be obtained, and this can be calculated by the simple calculation on the CPU 18. It can be performed by operation (however, a is a constant). Normally, the primary increase characteristic that generates a correction amount proportional to the generated voltage is a general method, but when minute positioning and large movement operation are mixed, the secondary increase characteristic is used. The positioning operation can be facilitated by using the specified correction amount. Further, when only a large moving operation is performed at high speed, the operation amount of the operating rod 14 can be reduced and the operability can be improved by performing the control by the 1/2 order increase characteristic. Therefore, the operability of the operating rod 14 is secured and appropriate remote control of the robot becomes possible by appropriately selecting the above-mentioned operating characteristics according to the operating conditions at that time.
【００１３】プログラムデータ記憶部２３にはティーチ
ング操作により保持されたロボット本体の位置及び姿勢
等のデータ、自動運転モードにおける制御操作データ、
並びに手動運転モードにおけるジョイスティックコント
ローラ１３からの信号に基づいてマニプレータ１２を制
御するための制御データ等がある。ステップ番号毎に記
述されたＣＰＵ１８への命令が、対応する機械語等のプ
ログラム言語に置き換えられて入力されることになる。
そして、ロボット制御装置１１の前記各構成部分が信号
線（バス２６）を介して図３に示すようにＣＰＵ１８に
連結配置されている。The program data storage unit 23 stores data such as the position and orientation of the robot body held by the teaching operation, control operation data in the automatic operation mode,
In addition, there are control data and the like for controlling the manipulator 12 based on the signal from the joystick controller 13 in the manual operation mode. The instruction to the CPU 18 described for each step number is replaced with a corresponding programming language such as a machine language and input.
Then, each of the components of the robot controller 11 is connected to the CPU 18 via a signal line (bus 26) as shown in FIG.
【００１４】次ぎに、前述したロボット手動送り制御装
置１０を用いた操作手順を図２及び図４に基づいて説明
する。図２は本発明の一実施例に係るロボット手動送り
制御装置１０の動作を説明する斜視図である。同図にお
いて、図の右から左方向に向かってワーク２７搬送用の
コンベア２９が動いており、鋳造後に型ばらし機２８に
よる処理を終えたワーク２７がコンベア２９上をマニプ
レータ１２の方向に向かって搬送されるようになってい
る。そして、マニプレータ１２によりコンベア２９上を
搬送されるワーク２７を掴み取って、これをワーク積載
用パレット３０内に順序よく載置している。ここで、型
ばらし機２８を経て排出されるワーク２７はコンベア２
９上の載置位置及び方向がそれぞれランダムとなってい
るため、マニプレータ１２を正確に制御してワーク２７
を掴み取ることが必要となるが、従来のティーチングプ
レイバック式のロボットではこのようにランダムに配置
されたワーク２７を処理することはきわめて困難であっ
た。Next, an operation procedure using the above-described robot manual feed control device 10 will be described with reference to FIGS. 2 and 4. FIG. 2 is a perspective view for explaining the operation of the robot manual feed control device 10 according to the embodiment of the present invention. In the figure, a conveyor 29 for conveying the work 27 is moving from the right to the left in the figure, and the work 27, which has been processed by the demolding machine 28 after casting, moves on the conveyor 29 toward the manipulator 12. It is designed to be transported. Then, the work 27 conveyed on the conveyor 29 by the manipulator 12 is grasped and placed in the work loading pallet 30 in order. Here, the work 27 discharged through the unmolding machine 28 is the conveyor 2
Since the mounting position and the direction on 9 are random respectively, the manipulator 12 is accurately controlled and the work 27
However, it is extremely difficult for the conventional teaching playback type robot to process the workpieces 27 randomly arranged in this way.
【００１５】図４は本発明の一実施例に係るロボット手
動送り制御装置１０の動作を示すフロー図である。オペ
レータは掴み取るべきワーク２７がロボットの操作可能
な範囲に到達した時を判断して手元のジョイスティック
コントローラ１３上の操作ボタン１６を押すことによ
り、ロボット制御装置１１を自動運転モードから手動運
転モードに切り換える（Ｓ−１）。これによりジョイス
ティックコントローラ１３によるロボット制御装置１１
の制御が可能となり、オペレータは操作桿１４を操作す
ることにより、マニプレータ１２がワーク２７をつかむ
ことのできる基準位置に移動させる（Ｓ−２）。そし
て、オペレータは目視あるいジョイスティックコントロ
ーラ１３上に表示される状態表示ランプ１５の監視によ
り自動運転モードへの移行可能な状態を確認して、手動
運転モードの操作ボタン１６を押すことにより手動運転
モードを完了させる（Ｓ−３）。この操作により、ロボ
ット制御装置１１は手動運転モードから自動運転モード
に切り換わる（Ｓ−４）。Ｓ−５のステップにおいて
は、ロボット制御装置１１のプログラムデータ記憶部２
３に予め入力されている操作手順に従って、ロボットの
マニプレータ１２が制御されて、ワーク２７がマニプレ
ータ１２の把持部１２ｂにより把持され、ワーク積載用
パレット３０上に搬送される。Ｓ−６のステップにおい
ては、同じくプログラムデータ記憶部２３上にあるワー
ク積載パレット３０の現在番地データに従い、ワーク積
載用パレット３０上の所定の番地にワーク２７を積み込
む操作が行われる。さらに、Ｓ−７のステップではプロ
グラムデータ記憶部２３に記憶されているワーク積載用
パレット３０の番地を一つ繰り上げる操作が行われる。
最後のＳ−８のステップではワーク積載用パレット３０
が満杯か否かを判断して、満杯でない場合にはＳ−１の
ステップに戻り、満杯の場合にはこのワーク積載用パレ
ット３０における積み込み処理を終了させる。FIG. 4 is a flowchart showing the operation of the robot manual feed control device 10 according to the embodiment of the present invention. The operator judges when the work 27 to be grabbed has reached the operable range of the robot, and presses the operation button 16 on the joystick controller 13 at hand to change the robot controller 11 from the automatic operation mode to the manual operation mode. Switch (S-1). Thereby, the robot controller 11 by the joystick controller 13
Can be controlled, and the operator operates the operating rod 14 to move the manipulator 12 to a reference position where the workpiece 27 can be gripped (S-2). Then, the operator confirms the state in which it is possible to switch to the automatic operation mode by monitoring the status display lamp 15 displayed on the joystick controller 13 or visually, and presses the operation button 16 in the manual operation mode to press the manual operation mode. Is completed (S-3). By this operation, the robot controller 11 switches from the manual operation mode to the automatic operation mode (S-4). In step S-5, the program data storage unit 2 of the robot controller 11 is
The manipulator 12 of the robot is controlled according to the operation procedure input in advance in 3, and the work 27 is gripped by the grip portion 12b of the manipulator 12 and conveyed onto the work loading pallet 30. In step S-6, the work 27 is loaded at a predetermined address on the work loading pallet 30 according to the current address data of the work loading pallet 30 also stored in the program data storage unit 23. Further, in step S-7, the operation of moving up the address of the work loading pallet 30 stored in the program data storage unit 23 by one is performed.
In the last step S-8, the work loading pallet 30
Is full, and if it is not full, the process returns to step S-1. If it is full, the loading process on the work loading pallet 30 is terminated.
【００１６】前記したように、操作桿１４を用いた手動
運転モードにおいては、各操作桿１４の操作角度等の操
作量に比例して絶対位置指令を出す形式のマスターアー
ムモードと、操作量に応じて速度指令を出すジョイステ
ィックモードとがあるが、本実施例においては後者を採
用して必要に応じて前者を採用できるようになってい
る。また後者の速度指令には比例制御、多段比例制御、
２次関数比例制御等があり、これらは作業内容に応じて
選択して用いることができる。As described above, in the manual operation mode using the operating rods 14, the master arm mode in which the absolute position command is issued in proportion to the operating amount such as the operating angle of each operating rod 14 and the operating amount. There is a joystick mode in which a speed command is issued accordingly, but in the present embodiment, the latter is adopted and the former can be adopted if necessary. In the latter speed command, proportional control, multistage proportional control,
There are quadratic function proportional control and the like, which can be selected and used according to the work content.
【００１７】以上、本発明の実施例を説明したが、本発
明はこの実施例に限定されるものではなく、要旨を逸脱
しない条件の変更等は全て本発明の適用範囲である。例
えば、本実施例においては、ロボット手動送り制御装置
１０をワーク２７の積み換え作業に適用したが、マニプ
レータ１２に加工用の工具、センサ、あるいは監視用カ
メラ等を取付けて操作するような場合にも適用すること
ができる。Although the embodiment of the present invention has been described above, the present invention is not limited to this embodiment, and changes in conditions and the like without departing from the gist are all within the scope of the present invention. For example, in the present embodiment, the robot manual feed control device 10 is applied to the work of transposing the work 27, but in the case where the manipulator 12 is operated by attaching a machining tool, a sensor, a monitoring camera, or the like. Can also be applied.
【００１８】[0018]
【発明の効果】請求項１及び２記載のロボット手動送り
制御装置においては、ロボットの位置及び姿勢修正用の
操作桿と、自動運転モードと手動運転モードとの切り換
えを指示する操作ボタンと、状態表示ランプとを設けた
遠隔操作ボックスを有するので、オペレータが状態表示
ランプ及びロボットの作動状態を判断しながら、自動運
転モードと手動運転モードを切り換えることができるた
めに、人間が介在する高度な判断を必要とする手動運転
と、機械的に処理できる自動運転との過程を混在させて
両者の特質を活かして、効率的なロボット運転操作を行
うことができる。特に、請求項２記載のロボット手動送
り制御装置においては、前記操作桿は各自由度毎の操作
量に同期して動作するアナログ素子を有し、該アナログ
素子に生じる電圧等のアナログ値を検出して該アナログ
値をアナログ／デジタル変換する電気回路が設けられて
いるので、前記操作量と該電気回路からの出力値との関
係を調整することにより、手動運転モードにおける操作
桿の必要な動作特性を確保することができる。In the robot manual feed control device according to the first and second aspects of the invention, the operating rod for correcting the position and orientation of the robot, the operating button for instructing switching between the automatic operating mode and the manual operating mode, and the state Since it has a remote control box equipped with a display lamp, the operator can switch between the automatic operation mode and the manual operation mode while judging the status display lamp and the operating state of the robot. It is possible to carry out an efficient robot driving operation by mixing the processes of the manual driving that requires the above and the automatic driving that can be mechanically processed by utilizing the characteristics of both. Particularly, in the robot manual feed control device according to claim 2, the operating rod has an analog element that operates in synchronization with an operation amount for each degree of freedom, and detects an analog value such as a voltage generated in the analog element. Since an electric circuit for analog / digital converting the analog value is provided, a necessary operation of the operating rod in the manual operation mode is performed by adjusting the relationship between the operation amount and the output value from the electric circuit. The characteristics can be secured.
【図１】本発明の一実施例に係るロボット手動送り制御
装置の説明図である。FIG. 1 is an explanatory diagram of a robot manual feed control device according to an embodiment of the present invention.
【図２】同装置の動作を説明する斜視図である。FIG. 2 is a perspective view illustrating the operation of the device.
【図３】同装置のロボット制御装置の説明図である。FIG. 3 is an explanatory diagram of a robot controller of the apparatus.
【図４】同装置の動作を示すフロー図である。FIG. 4 is a flowchart showing an operation of the same device.
【図５】（Ａ）、（Ｂ）はそれぞれジョイスティックモ
ード、及びマスターアームモードにおける操作桿の操作
角度と発生電圧との関係を示し、（Ｃ）は修正量と発生
電圧との関係を示す図である。5A and 5B show a relationship between an operating angle of a control rod and a generated voltage in a joystick mode and a master arm mode, and FIG. 5C shows a relationship between a correction amount and a generated voltage. Is.
１０ ロボット手動送り制御装置 １１ ロボット制御装置 １２ マニプレータ １２ａ アーム １２ｂ 把持部 １３ ジョイスティックコントローラ（遠隔操作ボック
ス） １４ 操作桿 １４ａ 手首位置操作レバー １４ｂ 手首姿勢操作レバー １５ 状態表示ランプ １６ 操作ボタン １７ ティーチングボックス １８ ＣＰＵ １９ 操作パネルインターフェース ２０ モーションコントロール ２１ 各軸コントロール ２２ 各軸サーボ回路 ２３ プログラムデータ記憶部 ２４ Ｉ／Ｏコントロール ２５ 手動送りコントロール ２６ バス ２７ ワーク ２８ 型ばらし機 ２９ コンベア ３０ ワーク積載用パレット10 Robot Manual Feed Control Device 11 Robot Control Device 12 Manipulator 12a Arm 12b Gripping Part 13 Joystick Controller (Remote Control Box) 14 Control Rod 14a Wrist Position Control Lever 14b Wrist Posture Control Lever 15 Status Display Lamp 16 Control Button 17 Teaching Box 18 CPU 19 Operation Panel Interface 20 Motion Control 21 Each Axis Control 22 Each Axis Servo Circuit 23 Program Data Storage 24 I / O Control 25 Manual Feed Control 26 Bus 27 Work 28 Type Unloader 29 Conveyor 30 Work Pallet
───────────────────────────────────────────────────── フロントページの続き (72)発明者 佐々木 英二 福岡県北九州市戸畑区一枝２−５−10− 308 ─────────────────────────────────────────────────── ─── Continuation of the front page (72) Inventor Eiji Sasaki 2-5-10-308 Ichie, Tobata-ku, Kitakyushu, Fukuoka
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP9970995AJPH08267381A (en) | 1995-03-30 | 1995-03-30 | Robot manual feed controller |
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP9970995AJPH08267381A (en) | 1995-03-30 | 1995-03-30 | Robot manual feed controller |
| Publication Number | Publication Date |
|---|---|
| JPH08267381Atrue JPH08267381A (en) | 1996-10-15 |
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP9970995AWithdrawnJPH08267381A (en) | 1995-03-30 | 1995-03-30 | Robot manual feed controller |
| Country | Link |
|---|---|
| JP (1) | JPH08267381A (en) |
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2000141259A (en)* | 1999-01-01 | 2000-05-23 | Fanuc Ltd | Robot control device |
| US6472838B1 (en)* | 1998-08-21 | 2002-10-29 | Matsushita Electric Industrial Co., Ltd. | Robot controller and control method |
| US6522949B1 (en) | 1999-09-27 | 2003-02-18 | Matsushita Electric Industrial Co., Ltd. | Robot controller |
| JP2009285753A (en)* | 2008-05-28 | 2009-12-10 | Shibuya Kogyo Co Ltd | Robot control system |
| CN103862477A (en)* | 2014-03-31 | 2014-06-18 | 内蒙古科技大学 | Upper computer control method for automatic gripping mechanical arm |
| WO2015127694A1 (en)* | 2014-02-28 | 2015-09-03 | 福建一丁芯智能技术有限公司 | Automatic control apparatus |
| WO2017033350A1 (en)* | 2015-08-25 | 2017-03-02 | 川崎重工業株式会社 | Remote control robot system and operation method thereof |
| CN109228213A (en)* | 2018-09-25 | 2019-01-18 | 珠海格力电器股份有限公司 | Double-joystick operation injection molding manipulator demonstrator and control method thereof |
| WO2024009359A1 (en)* | 2022-07-04 | 2024-01-11 | ファナック株式会社 | Laser machining head and laser machining system |
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US6472838B1 (en)* | 1998-08-21 | 2002-10-29 | Matsushita Electric Industrial Co., Ltd. | Robot controller and control method |
| JP2000141259A (en)* | 1999-01-01 | 2000-05-23 | Fanuc Ltd | Robot control device |
| US6522949B1 (en) | 1999-09-27 | 2003-02-18 | Matsushita Electric Industrial Co., Ltd. | Robot controller |
| JP2009285753A (en)* | 2008-05-28 | 2009-12-10 | Shibuya Kogyo Co Ltd | Robot control system |
| WO2015127694A1 (en)* | 2014-02-28 | 2015-09-03 | 福建一丁芯智能技术有限公司 | Automatic control apparatus |
| CN103862477A (en)* | 2014-03-31 | 2014-06-18 | 内蒙古科技大学 | Upper computer control method for automatic gripping mechanical arm |
| TWI623398B (en)* | 2015-08-25 | 2018-05-11 | Kawasaki Heavy Ind Ltd | Robot system |
| JPWO2017033363A1 (en)* | 2015-08-25 | 2018-07-05 | 川崎重工業株式会社 | Robot system |
| CN107848112A (en)* | 2015-08-25 | 2018-03-27 | 川崎重工业株式会社 | Robot system |
| KR20180039132A (en) | 2015-08-25 | 2018-04-17 | 카와사키 주코교 카부시키 카이샤 | Robot system |
| CN107921640A (en)* | 2015-08-25 | 2018-04-17 | 川崎重工业株式会社 | Teleoperation robot system and method of operation thereof |
| KR20180042332A (en)* | 2015-08-25 | 2018-04-25 | 카와사키 주코교 카부시키 카이샤 | Remote-operated robot system and its operation method |
| WO2017033350A1 (en)* | 2015-08-25 | 2017-03-02 | 川崎重工業株式会社 | Remote control robot system and operation method thereof |
| JPWO2017033350A1 (en)* | 2015-08-25 | 2018-06-07 | 川崎重工業株式会社 | Remote operation robot system and operation method thereof |
| JPWO2017033377A1 (en)* | 2015-08-25 | 2018-07-05 | 川崎重工業株式会社 | Robot system |
| CN107848113A (en)* | 2015-08-25 | 2018-03-27 | 川崎重工业株式会社 | Robot system and its method of operation |
| JP2022119943A (en)* | 2015-08-25 | 2022-08-17 | 川崎重工業株式会社 | Industrial robot and operating method thereof |
| EP3342559A4 (en)* | 2015-08-25 | 2019-06-26 | Kawasaki Jukogyo Kabushiki Kaisha | ROBOT SYSTEM |
| EP3342560A4 (en)* | 2015-08-25 | 2019-07-03 | Kawasaki Jukogyo Kabushiki Kaisha | ROBOT SYSTEM AND METHOD OF OPERATION |
| CN107921640B (en)* | 2015-08-25 | 2021-08-06 | 川崎重工业株式会社 | Remote operation robot system and operation method thereof |
| US11116593B2 (en) | 2015-08-25 | 2021-09-14 | Kawasaki Jukogyo Kabushiki Kaisha | Robot system |
| US11147641B2 (en) | 2015-08-25 | 2021-10-19 | Kawasaki Jukogyo Kabushiki Kaisha | Robot system |
| CN109228213A (en)* | 2018-09-25 | 2019-01-18 | 珠海格力电器股份有限公司 | Double-joystick operation injection molding manipulator demonstrator and control method thereof |
| WO2024009359A1 (en)* | 2022-07-04 | 2024-01-11 | ファナック株式会社 | Laser machining head and laser machining system |
| Publication | Publication Date | Title |
|---|---|---|
| EP0780197B1 (en) | Apparatus for controlling movement of robot and method of controlling movement of robot | |
| US6124693A (en) | Robot controller | |
| JP2684359B2 (en) | Robot work Cartesian coordinate system setting device | |
| WO1990011166A1 (en) | Manual intervention method for industrial robot | |
| EP0400154B1 (en) | Robot operation method that can be manually corrected | |
| JPH08267381A (en) | Robot manual feed controller | |
| JPH08300280A (en) | Motion control system of robot | |
| US4831235A (en) | Automatic welding machine torch movement control system | |
| JP2015231659A (en) | Robot device | |
| KR100454472B1 (en) | Welding torch angle control method and device of arc welding robot in relation to angle correction of welding torch in welding circular arc | |
| JP3588956B2 (en) | Robot controller | |
| JP3023432B2 (en) | Robot controller | |
| JPH0146271B2 (en) | ||
| US20230286142A1 (en) | Robot teaching control method, robot teaching apparatus, and robot system | |
| JPH0632914B2 (en) | Industrial robots | |
| JPS6214845B2 (en) | ||
| JPS58191010A (en) | Control method for industrial robots | |
| JPH0413109B2 (en) | ||
| JPH0639066B2 (en) | Control method for industrial robot | |
| JP2025085435A (en) | Industrial robot and method for controlling industrial robot | |
| JP2025085434A (en) | Industrial Robots | |
| JPH0264714A (en) | Method for preparing nc data | |
| JPH09225536A (en) | Operation of press brake robot and controller therefor | |
| JPH0780787A (en) | Robot control method and robot control device | |
| JPS61193206A (en) | Teaching method for robot |
| Date | Code | Title | Description |
|---|---|---|---|
| A300 | Withdrawal of application because of no request for examination | Free format text:JAPANESE INTERMEDIATE CODE: A300 Effective date:20020604 |