JP2016040067A - Robot device, method for controlling robot, program and recording medium - Google Patents

Robot device, method for controlling robot, program and recording medium Download PDF

Info

Publication number
JP2016040067A
JP2016040067A JP2014164818A JP2014164818A JP2016040067A JP 2016040067 A JP2016040067 A JP 2016040067A JP 2014164818 A JP2014164818 A JP 2014164818A JP 2014164818 A JP2014164818 A JP 2014164818A JP 2016040067 A JP2016040067 A JP 2016040067A
Authority
JP
Japan
Prior art keywords
robot
teaching point
teaching
point
corrected
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
JP2014164818A
Other languages
Japanese (ja)
Inventor
陽介 村井
Yosuke Murai
陽介 村井
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 JP2014164818A priority Critical patent/JP2016040067A/en
Publication of JP2016040067A publication Critical patent/JP2016040067A/en
Pending legal-status Critical Current

Links

Images

Landscapes

  • Manipulator (AREA)

Abstract

PROBLEM TO BE SOLVED: To reduce a deviation of a position and a posture of a robot from a position and a posture in operating the robot up to a teaching point for a correction object in order of process operations when correcting the teaching point for the correction object.SOLUTION: CPU201 sets a through point different from a teaching point for a movement source so that an operation direction of each joint of a robot in operating the robot to the teaching point for the correction object in a correction mode to control the robot to operate to the teaching point for the correction object is the same as an operation direction of each joint of the robot in operating the robot to the teaching point for the correction object from one previous teaching point of the movement source with respect to the teaching point of the correction object during a process operation mode. In the correction mode, CPU201 operates the robot to the teaching point of the correction object via the through point from the current position and posture.SELECTED DRAWING: Figure 3

Description

本発明は、ロボット装置、ロボット制御方法、プログラム及び記録媒体に関し、特に、複数の教示点のうち、ある教示点を修正する際のロボットの動作の制御に関する。   The present invention relates to a robot apparatus, a robot control method, a program, and a recording medium, and more particularly to control of a robot operation when correcting a certain teaching point among a plurality of teaching points.

従来、ロボットの教示点のパラメータ値を決定する作業(教示作業)を行う際には、例えばオフライン(コンピュータシミュレーション)で教示作業を行ったり、実際にロボットを動作させて教示作業を行ったりしていた。   Conventionally, when performing an operation (teaching operation) for determining a parameter value of a teaching point of a robot, for example, the teaching operation is performed offline (computer simulation) or the robot is actually operated to perform the teaching operation. It was.

このような教示作業後であっても、複数の教示点のうち、ある教示点についてパラメータ値を修正する場合が生じており、このような場合には、実際にロボットを動作させて修正する必要があった。   Even after such teaching work, there is a case where the parameter value is corrected for a certain teaching point among a plurality of teaching points. In such a case, it is necessary to actually correct the parameter by operating the robot. was there.

特許文献1には、ロボットの現在位置から修正が必要なロボットの教示点へ移動するためのパスを作成し、そのパスを辿って修正対象の教示点にロボットを移動させることが提案されている。   Patent Document 1 proposes that a path for moving from the current position of the robot to a teaching point of the robot that needs to be corrected is created, and the robot is moved to the correction target teaching point by following the path. .

特開2008−254172号公報JP 2008-254172 A

しかしながら、特許文献1に開示された技術では、修正対象の教示点にロボットを移動させる際に、実際の工程動作時と同じ方向から進入するとは限らない。修正対象の教示点へ動作させるロボットの進入方向が工程動作時と異なると、修正時に教示点にロボットを移動させたときのロボットの位置又は姿勢に対して、工程動作時に教示点にロボットを移動させたときのロボットの位置又は姿勢がずれることがあった。   However, in the technique disclosed in Patent Document 1, when the robot is moved to the teaching point to be corrected, the robot does not always enter from the same direction as in the actual process operation. If the approach direction of the robot to be moved to the teaching point to be corrected differs from that during the process operation, the robot moves to the teaching point during the process operation with respect to the robot position or posture when the robot is moved to the teaching point during the correction. In some cases, the position or posture of the robot was shifted.

このずれを発生させないために、実際の工程動作の順番に教示点を移動させて修正対象の教示点に移動させるか、又は現在位置から修正対象の教示点に移動させた後、一旦工程動作時の移動元の教示点に戻って再度修正対象の教示点に移動させる必要があった。しかし、このような教示点の修正の作業は、多大な時間を要し、作業者にとって大きな負担となっていた。   In order not to cause this deviation, the teaching point is moved to the correction target teaching point in the actual process operation order or moved from the current position to the correction target teaching point, and then once in the process operation. It is necessary to return to the teaching point of the movement source and move again to the teaching point to be corrected. However, the work for correcting the teaching point as described above requires a great amount of time, which is a heavy burden on the operator.

そこで、本発明は、修正対象の教示点の修正時に、工程動作の順番通りに修正対象の教示点までロボットを動作させたときの位置及び姿勢に対してロボットの位置及び姿勢がずれるのを低減することを目的とする。   Therefore, the present invention reduces the deviation of the position and posture of the robot from the position and posture when the robot is operated up to the teaching point to be corrected in the order of the process operation when the teaching point to be corrected is corrected. The purpose is to do.

本発明のロボット装置は、多関節のロボットと、複数の教示点を順番に動作するよう前記ロボットを制御する工程動作モード、及び前記複数の教示点の中から修正対象の教示点の指定を受けたときに、前記修正対象の教示点のパラメータ値の修正に先立って、前記修正対象の教示点に動作するよう前記ロボットを制御する修正モードを有する制御部と、を備え、前記制御部は、前記修正モードにおいて前記ロボットを前記修正対象の教示点に動作させる際の前記ロボットの各関節の動作方向が、前記工程動作モードのときに前記修正対象の教示点に対し1つ前の移動元の教示点から前記修正対象の教示点に前記ロボットを動作させる際の前記ロボットの各関節の動作方向と同じとなるよう、前記移動元の教示点とは異なる経由点を設定し、前記ロボットを、現在の位置及び姿勢から前記経由点を経由して前記修正対象の教示点に動作させることを特徴とする。   The robot apparatus of the present invention receives an articulated robot, a process operation mode for controlling the robot to operate a plurality of teaching points in sequence, and designation of a teaching point to be corrected from the plurality of teaching points. A control unit having a correction mode for controlling the robot so as to operate on the correction target teaching point prior to correction of the parameter value of the correction target teaching point. The movement direction of each joint of the robot when the robot is moved to the correction target teaching point in the correction mode is the movement source one previous to the correction target teaching point in the process operation mode. A route point different from the teaching point of the movement source is set so that the movement direction of each joint of the robot when moving the robot from the teaching point to the teaching point to be corrected is the same as the previous movement point. The robot, characterized in that to operate the current position and orientation to the teaching point of the correction object via said waypoint.

本発明によれば、修正対象の教示点の修正時に、工程動作の順番通りに修正対象の教示点までロボットを動作させたときの位置及び姿勢に対してロボットの位置及び姿勢がずれるのを低減することができる。   According to the present invention, when correcting the teaching point to be corrected, the position and posture of the robot is reduced from the position and posture when the robot is operated to the teaching point to be corrected in the order of the process operation. can do.

本発明の実施形態に係るロボット装置を示す斜視図である。1 is a perspective view showing a robot apparatus according to an embodiment of the present invention. ロボットの第2関節を示す部分断面図である。It is a fragmentary sectional view showing the 2nd joint of a robot. ロボット装置の制御装置の構成を示すブロック図である。It is a block diagram which shows the structure of the control apparatus of a robot apparatus. 教示点情報を示す説明図である。It is explanatory drawing which shows teaching point information. ロボット種別毎のずれ解消用距離情報を示す説明図である。It is explanatory drawing which shows the distance information for deviation | shift cancellation for every robot classification. 教示点情報をティーチングペンダントの液晶ディスプレイ上に表示した状態を示す説明図である。It is explanatory drawing which shows the state which displayed teaching point information on the liquid crystal display of a teaching pendant. 修正モードが選択された際のロボット制御方法の各工程を示すフローチャートである。It is a flowchart which shows each process of the robot control method when correction mode is selected. 経由点の算出方法を示すフローチャートである。It is a flowchart which shows the calculation method of a waypoint. 工程動作モードにおいてロボットが動作する動作経路と、修正モードにおいてロボットが動作する動作経路を示す図である。It is a figure which shows the operation path | route which a robot operate | moves in process operation mode, and the operation path | route which a robot operate | moves in correction mode.

以下、本発明を実施するための形態を、図面を参照しながら詳細に説明する。図1は、本発明の実施形態に係るロボット装置を示す斜視図である。図1に示すロボット装置500は、把持したワークWを別のワークに組付ける組立作業を行うロボット100と、ロボット100を制御する制御装置200と、教示装置であるティーチングペンダント300と、を備えている。   Hereinafter, embodiments for carrying out the present invention will be described in detail with reference to the drawings. FIG. 1 is a perspective view showing a robot apparatus according to an embodiment of the present invention. A robot apparatus 500 shown in FIG. 1 includes a robot 100 that performs an assembly operation for assembling a gripped work W to another work, a control device 200 that controls the robot 100, and a teaching pendant 300 that is a teaching device. Yes.

ロボット100は、多関節のロボットである。ロボット100は、垂直多関節型のロボットアーム101と、ロボットアーム101の先端に接続されたエンドエフェクタであるロボットハンド102と、を備えている。   The robot 100 is an articulated robot. The robot 100 includes a vertical articulated robot arm 101 and a robot hand 102 that is an end effector connected to the tip of the robot arm 101.

ロボットアーム101は、作業台に固定されるベース部(基端リンク)103と、変位や力を伝達する複数のリンク121〜126と、を有している。ベース部103及び複数のリンク121〜126は、複数の関節J1〜J6で旋回又は回転可能に互いに連結されている。また、ロボットアーム101は、各関節J1〜J6に設けられた、関節を駆動する関節駆動装置110を備えている。各関節J1〜J6に配置された関節駆動装置110は、必要なトルクの大きさに合わせて適切な出力のものが用いられる。   The robot arm 101 includes a base portion (base end link) 103 that is fixed to a work table, and a plurality of links 121 to 126 that transmit displacement and force. The base portion 103 and the plurality of links 121 to 126 are connected to each other so as to be able to turn or rotate at a plurality of joints J1 to J6. In addition, the robot arm 101 includes a joint driving device 110 that is provided at each of the joints J1 to J6 and drives the joint. As the joint driving device 110 disposed in each of the joints J1 to J6, one having an appropriate output is used in accordance with the required torque.

ロボットハンド102は、ワークWを把持する複数の把持爪(フィンガ)104と、複数の把持爪104を駆動する不図示の駆動部と、駆動部の回転角度を検出する不図示のエンコーダと、回転を把持動作に変換する不図示の機構とを有している。この不図示の機構は、カム機構やリンク機構などで必要な把持動作に合わせて設計される。なお、ロボットハンド102に用いる駆動部に必要なトルクは、ロボットアーム101の関節用と異なるが、基本構成は同じである。また、ロボットハンド102は、把持爪104等に作用する反力を検出可能な不図示の力覚センサを有している。   The robot hand 102 includes a plurality of gripping claws (finger) 104 that grips the workpiece W, a driving unit (not shown) that drives the plurality of gripping claws 104, an encoder (not shown) that detects a rotation angle of the driving unit, and a rotation And a mechanism (not shown) for converting the signal into a gripping action. This mechanism (not shown) is designed in accordance with a gripping operation required by a cam mechanism or a link mechanism. The torque required for the drive unit used for the robot hand 102 is different from that for the joint of the robot arm 101, but the basic configuration is the same. The robot hand 102 includes a force sensor (not shown) that can detect a reaction force acting on the gripping claws 104 and the like.

ロボット100の先端部(ロボットハンド102の先端部)には、ツールセンターポイント(TCP)が設定されており、教示点がタスク空間で規定される場合、その教示点は、TCPの位置及び姿勢を示す6つのパラメータで表現される。具体的には、教示点は、タスク空間で表すと、3つの位置パラメータ(X,Y,Z)と、3つの姿勢パラメータ(tX,tY,tZ)とからなる6つのパラメータで表現される。教示点がコンフィグレーション空間(関節空間)で規定される場合、その教示点は、ロボット100の各関節J1〜J6の関節位置(関節角度)を示すパラメータ(θ1,θ2,θ3,θ4,θ5,θ6)で表現される。   A tool center point (TCP) is set at the tip of the robot 100 (tip of the robot hand 102). When the teaching point is defined in the task space, the teaching point indicates the position and orientation of the TCP. It is expressed by the six parameters shown. Specifically, the teaching point is expressed by six parameters including three position parameters (X, Y, Z) and three posture parameters (tX, tY, tZ) when expressed in the task space. When the teaching point is defined in the configuration space (joint space), the teaching point is a parameter (θ1, θ2, θ3, θ4, θ5) indicating the joint position (joint angle) of each joint J1 to J6 of the robot 100. θ6).

なお、コンフィグレーション空間で規定された教示点は、順運動学計算により、タスク空間に変換することができ、タスク空間で規定された教示点は、逆運動学計算により、コンフィグレーション空間に変換することができる。本実施形態では、教示点は、タスク空間の6つのパラメータ(X,Y,Z,tX,tY,tZ)で作業者により設定される。各関節J1〜J6の駆動の際には、制御装置200によりコンフィグレーション空間のパラメータ(θ1,θ2,θ3,θ4,θ5,θ6)に変換される。   The teaching points specified in the configuration space can be converted to task space by forward kinematics calculation, and the teaching points specified in task space are converted to configuration space by inverse kinematics calculation. be able to. In the present embodiment, the teaching point is set by the operator with six parameters (X, Y, Z, tX, tY, tZ) in the task space. When the joints J1 to J6 are driven, the control device 200 converts them into configuration space parameters (θ1, θ2, θ3, θ4, θ5, θ6).

ティーチングペンダント300は、制御装置200に接続可能に構成され、制御装置200に接続された際に、ロボットアーム101やロボットハンド102を駆動制御する指令を制御装置200に送信可能に構成されている。   The teaching pendant 300 is configured to be connectable to the control device 200, and is configured to be able to transmit an instruction to drive and control the robot arm 101 and the robot hand 102 to the control device 200 when connected to the control device 200.

以下、関節J2における関節駆動装置110を例に代表して説明し、他の関節J1,J3〜J6の関節駆動装置110については、サイズや性能が異なる場合もあるが、同様の構成であるため、説明を省略する。   Hereinafter, the joint driving device 110 in the joint J2 will be described as an example, and the joint driving devices 110 of the other joints J1, J3 to J6 may have different sizes and performances, but have the same configuration. The description is omitted.

図2は、ロボット100のロボットアーム101の第2関節である関節J2を示す部分断面図である。関節駆動装置110は、電動モータであるサーボモータ(以下、「モータ」という)1と、モータ1の回転軸2の回転を減速して出力する減速機11と、を有している。   FIG. 2 is a partial cross-sectional view showing a joint J <b> 2 that is the second joint of the robot arm 101 of the robot 100. The joint drive device 110 includes a servo motor (hereinafter referred to as “motor”) 1 that is an electric motor, and a speed reducer 11 that decelerates and outputs the rotation of the rotating shaft 2 of the motor 1.

また、関節駆動装置110は、モータ1の回転軸2の回転角度(出力角度)を検出するモータ側角度検出器である入力側エンコーダ10を有している。また、関節駆動装置110は、減速機11の出力軸の回転角度(出力角度)を検出する減速機側角度検出器である出力側エンコーダ16を有している。   Further, the joint driving device 110 includes an input side encoder 10 that is a motor side angle detector that detects a rotation angle (output angle) of the rotating shaft 2 of the motor 1. Further, the joint drive device 110 includes an output side encoder 16 that is a speed reducer side angle detector that detects a rotation angle (output angle) of the output shaft of the speed reducer 11.

モータ1は、例えばブラシレスDCサーボモータやACサーボモータである。モータ1は、回転軸2とロータマグネット3とで構成された回転部4と、モータハウジング5と、回転軸2を回転自在に支持する軸受6,7と、回転部4を回転させるステータコイル8と、を備えている。軸受6,7はモータハウジング5に設けられ、ステータコイル8はモータハウジング5に取り付けられている。また、サーボモータ1はモータカバー9で囲われている。   The motor 1 is, for example, a brushless DC servo motor or an AC servo motor. The motor 1 includes a rotating portion 4 composed of a rotating shaft 2 and a rotor magnet 3, a motor housing 5, bearings 6 and 7 that rotatably support the rotating shaft 2, and a stator coil 8 that rotates the rotating portion 4. And. The bearings 6 and 7 are provided in the motor housing 5, and the stator coil 8 is attached to the motor housing 5. The servo motor 1 is surrounded by a motor cover 9.

入力側エンコーダ10は、光学式或いは磁気式のロータリエンコーダであり、モータ1の回転軸2の一端側に設けられ、モータ1の回転軸2の回転に伴ってパルス信号を生成し、制御装置200に生成したパルス信号を出力する。なお、入力側エンコーダ10は、回転軸2に取り付けられているが、減速機11の入力軸に取り付けてもよい。   The input-side encoder 10 is an optical or magnetic rotary encoder, is provided on one end side of the rotating shaft 2 of the motor 1, generates a pulse signal along with the rotation of the rotating shaft 2 of the motor 1, and controls the control device 200. The generated pulse signal is output. The input encoder 10 is attached to the rotary shaft 2, but may be attached to the input shaft of the speed reducer 11.

出力側エンコーダ16は、光学式或いは磁気式のロータリエンコーダであり、減速機11の出力角度、本実施形態では、ベース部103とリンク121、或いは隣り合う2つのリンク間の相対角度を検出する。関節J2においては、出力側エンコーダ16は、リンク121とリンク122との間の相対角度を検出する。具体的には、出力側エンコーダ16は、関節J2の駆動(リンク121とリンク122との相対移動)に伴ってパルス信号を生成し、制御装置200に生成したパルス信号を出力する。   The output side encoder 16 is an optical or magnetic rotary encoder, and detects the output angle of the speed reducer 11, in this embodiment, the relative angle between the base portion 103 and the link 121, or two adjacent links. In the joint J2, the output side encoder 16 detects the relative angle between the link 121 and the link 122. Specifically, the output side encoder 16 generates a pulse signal as the joint J2 is driven (relative movement between the link 121 and the link 122), and outputs the generated pulse signal to the control device 200.

リンク121とリンク122とは、クロスローラベアリング15を介して回転自在に結合されている。モータ1と入力側エンコーダ10との間には、必要に応じて、電源オフ時にロボットアーム101の姿勢を保持するためのブレーキユニットを設けてもよい。   The link 121 and the link 122 are rotatably coupled via the cross roller bearing 15. A brake unit for holding the posture of the robot arm 101 when the power is turned off may be provided between the motor 1 and the input encoder 10 as necessary.

減速機11は、本実施形態では、小型軽量で減速比の大きい波動歯車減速機である。減速機11は、モータ1の回転軸2に結合された、入力軸を有するウェブジェネレータ12と、リンク122に固定された、出力軸を有するサーキュラスプライン13と、を備えている。なお、サーキュラスプライン13は、リンク122に直結されているが、リンク122に一体に形成されていてもよい。   In this embodiment, the speed reducer 11 is a wave gear speed reducer that is small and light and has a large speed reduction ratio. The speed reducer 11 includes a web generator 12 having an input shaft, which is coupled to the rotary shaft 2 of the motor 1, and a circular spline 13 having an output shaft, which is fixed to a link 122. The circular spline 13 is directly connected to the link 122, but may be formed integrally with the link 122.

また、減速機11は、ウェブジェネレータ12とサーキュラスプライン13との間に配置され、リンク121に固定されたフレクスプライン14を備えている。フレクスプライン14は、ウェブジェネレータ12の回転に対して減速比Nで減速され、サーキュラスプライン13に対して相対的に回転する。従って、モータ1の回転軸2の回転数が減速機11で1/Nに減速され、フレクスプライン14が固定されたリンク121に対してサーキュラスプライン13が固定されたリンク122を相対的に回転運動させ、関節J2を屈曲(回転)させる。このときの減速機11の出力側の回転角度が、実出力角度、即ち関節J2の角度(関節角度)となる。   The speed reducer 11 includes a flex spline 14 that is disposed between the web generator 12 and the circular spline 13 and fixed to the link 121. The flex spline 14 is decelerated at a reduction ratio N with respect to the rotation of the web generator 12, and rotates relative to the circular spline 13. Accordingly, the rotational speed of the rotating shaft 2 of the motor 1 is reduced to 1 / N by the speed reducer 11 and the link 122 to which the circular spline 13 is fixed is rotated relative to the link 121 to which the flexspline 14 is fixed. The joint J2 is bent (rotated). The rotation angle on the output side of the speed reducer 11 at this time is the actual output angle, that is, the angle of the joint J2 (joint angle).

図3は、ロボット装置500の制御装置200の構成を示すブロック図である。制御装置200は、制御部(演算部)としてのCPU(Central Processing Unit)201を備えている。また、制御装置200は、記憶部として、ROM(Read Only Memory)202、RAM(Random Access Memory)203、HDD(Hard Disk Drive)204を備えている。また、制御装置200は、記録ディスクドライブ205及び各種のインタフェース211〜217を備えている。   FIG. 3 is a block diagram illustrating a configuration of the control device 200 of the robot apparatus 500. The control device 200 includes a CPU (Central Processing Unit) 201 as a control unit (calculation unit). The control device 200 includes a ROM (Read Only Memory) 202, a RAM (Random Access Memory) 203, and an HDD (Hard Disk Drive) 204 as storage units. The control device 200 also includes a recording disk drive 205 and various interfaces 211 to 217.

CPU201には、ROM202、RAM203、HDD204、記録ディスクドライブ205及び各種のインタフェース211〜217が、バス220を介して接続されている。ROM202には、BIOS等の基本プログラムが格納されている。RAM203は、CPU201の演算処理結果等、各種データを一時的に記憶する記憶部である。   A ROM 202, a RAM 203, an HDD 204, a recording disk drive 205, and various interfaces 211 to 217 are connected to the CPU 201 via a bus 220. The ROM 202 stores basic programs such as BIOS. The RAM 203 is a storage unit that temporarily stores various data such as the calculation processing result of the CPU 201.

HDD204は、CPU201の演算処理結果や外部から取得した各種データ等を記憶する記憶部であると共に、CPU201に、後述する各種演算処理を実行させるためのプログラム240を記録するものである。CPU201は、HDD204に記録(格納)されたプログラム240に基づいてロボット制御方法の各工程を実行する。   The HDD 204 is a storage unit that stores calculation processing results of the CPU 201 and various data acquired from the outside, and records a program 240 for causing the CPU 201 to execute various calculation processing described later. The CPU 201 executes each process of the robot control method based on the program 240 recorded (stored) in the HDD 204.

記録ディスクドライブ205は、記録ディスク241に記録された各種データやプログラム等を読み出すことができる。   The recording disk drive 205 can read out various data and programs recorded on the recording disk 241.

インタフェース211には、ユーザが操作可能なティーチングペンダント300が接続されている。ティーチングペンダント300は、ロボット100を操作する際に使用する携帯型の端末である。ティーチングペンダント300はタッチパネルである液晶ディスプレイを有しており、液晶ディスプレイ上に、HDD204に格納されたロボットプログラム情報や教示点情報等を表示することができる。   The interface 211 is connected to a teaching pendant 300 that can be operated by the user. The teaching pendant 300 is a portable terminal used when operating the robot 100. The teaching pendant 300 has a liquid crystal display as a touch panel, and can display robot program information, teaching point information, and the like stored in the HDD 204 on the liquid crystal display.

また、ロボット100を目的の教示点の位置座標に移動させる機能やジョグ動作させる機能を持つ。ジョグ動作とは、機械の位置合わせなどのために、モータ1を断続的に微動させる動作を指す。さらに、ロボット100の位置及び姿勢を教示点情報に登録する教示作業や教示点のパラメータ値を修正する再教示作業を行うことができる。   Further, it has a function of moving the robot 100 to the position coordinates of the target teaching point and a function of jogging. The jog operation refers to an operation of intermittently finely moving the motor 1 for machine positioning or the like. Furthermore, a teaching operation for registering the position and orientation of the robot 100 in the teaching point information and a re-teaching operation for correcting the parameter value of the teaching point can be performed.

インタフェース212には、キーボードやマウス等の入力装置310が接続されている。インタフェース213には、各種画像が表示されるモニタ等の出力装置311が接続されている。インタフェース214には、書き換え可能な不揮発性メモリや外付けHDD等の外部記憶装置312が接続されている。   An input device 310 such as a keyboard or a mouse is connected to the interface 212. An output device 311 such as a monitor for displaying various images is connected to the interface 213. An external storage device 312 such as a rewritable nonvolatile memory or an external HDD is connected to the interface 214.

インタフェース215,216には、入力側エンコーダ10及び出力側エンコーダ16がそれぞれ接続されている。入力側エンコーダ10及び出力側エンコーダ16は、前述したパルス信号をインタフェース215,216及びバス220を介してCPU201に出力する。   The input side encoder 10 and the output side encoder 16 are connected to the interfaces 215 and 216, respectively. The input side encoder 10 and the output side encoder 16 output the above-described pulse signal to the CPU 201 via the interfaces 215 and 216 and the bus 220.

インタフェース217には、サーボ制御装置230が接続されている。サーボ制御装置230は、ロボットアーム101に内蔵されている。   A servo controller 230 is connected to the interface 217. The servo control device 230 is built in the robot arm 101.

CPU201は、工程動作モードと修正モードとのいずれか一方に設定可能となっている。ティーチングペンダント300や入力装置310により工程動作モードが選択された場合、CPU201は、工程動作モードに移行し、ティーチングペンダント300や入力装置310により修正モードが選択された場合、修正モードに移行する。   The CPU 201 can be set to either the process operation mode or the correction mode. When the process operation mode is selected by the teaching pendant 300 or the input device 310, the CPU 201 shifts to the process operation mode, and when the correction mode is selected by the teaching pendant 300 or the input device 310, the CPU 201 shifts to the correction mode.

CPU201は、工程動作モードに移行した場合には、複数の教示点を順番に動作するようロボット100を制御する。即ち、CPU201は、HDD204に格納された教示点情報252から複数の教示点を取得し、ロボットプログラム情報251に記述された補間方法(例えば直線補間や円弧補間等)で教示点間を補間する多数の補間教示点を求める。そして、CPU201は、教示点間を繋ぐ軌道(多数の補間教示点を繋ぐ軌道)を生成して、サーボモータ1の回転軸2の回転角度の制御量を示す駆動指令を生成する。CPU201は、駆動指令を所定の時間間隔でサーボ制御装置230に出力する。   When the CPU 201 shifts to the process operation mode, the CPU 201 controls the robot 100 so as to operate a plurality of teaching points in order. That is, the CPU 201 acquires a plurality of teaching points from the teaching point information 252 stored in the HDD 204, and interpolates between teaching points by an interpolation method (for example, linear interpolation or circular interpolation) described in the robot program information 251. Find the interpolation teaching point. Then, the CPU 201 generates a trajectory connecting the teaching points (trajectory connecting a large number of interpolation teaching points), and generates a drive command indicating a control amount of the rotation angle of the rotating shaft 2 of the servo motor 1. The CPU 201 outputs drive commands to the servo control device 230 at predetermined time intervals.

サーボ制御装置230は、CPU201から入力を受けた駆動指令に基づき、フィードバック制御によるサーボモータ1への電流の出力量を演算し、サーボモータ1へ電流を供給して、ロボットアーム101の関節J1〜J6の関節角度制御を行う。即ち、CPU201は、サーボ制御装置230を介して、関節J1〜J6の関節角度(関節位置)が教示した目標角度(目標位置)となるように、サーボモータ1による関節J1〜J6の駆動を制御する。   The servo control device 230 calculates an output amount of current to the servo motor 1 by feedback control based on a drive command received from the CPU 201, supplies current to the servo motor 1, and supplies joints J1 to J1 of the robot arm 101. J6 joint angle control is performed. That is, the CPU 201 controls the driving of the joints J1 to J6 by the servo motor 1 so that the joint angles (joint positions) of the joints J1 to J6 become the taught target angles (target positions) via the servo control device 230. To do.

HDD204には、工程動作モード時に、ロボット100に所定の作業、例えば把持、運搬等の一連の動作を実行させるためのロボットプログラム情報251が記憶されている。また、HDD204には、ロボット100の教示点情報(複数の教示点を含む)252と、ロボットの種別毎のずれ解消用距離情報253とが記憶されている。CPU201は、ロボットプログラム情報251に従ってロボット100に所定の作業を行わせる。ロボットプログラム情報251や教示点情報252は予めオフラインで作成しておく。   The HDD 204 stores robot program information 251 for causing the robot 100 to execute a series of operations such as gripping and transporting in the process operation mode. Also, the HDD 204 stores teaching point information (including a plurality of teaching points) 252 of the robot 100 and deviation elimination distance information 253 for each type of robot. The CPU 201 causes the robot 100 to perform a predetermined operation according to the robot program information 251. The robot program information 251 and the teaching point information 252 are previously created offline.

CPU201は、修正モードに移行した場合には、複数の教示点の中から修正対象の教示点(以下、対象教示点という)の指定を受けたときに、対象教示点のパラメータ値の修正に先立って、対象教示点に動作するようロボット100を制御する。つまり、CPU201は、HDD204に格納されたロボットプログラム情報251、教示点情報252、及びロボット種別毎のずれ解消用距離情報253、並びに周囲環境モデルの情報に基づいて動作経路を生成する。ここで、ロボット100の教示点とは、各プログラム指令実行開始時のロボット100の教示点をいう。ロボット100の動作を制御することで、ロボット100を教示点に移動させ、その教示点の情報を捕え、予めオフラインで作成したロボットプログラム情報251上の教示点の情報を、捕えた情報に置換して修正することができる。   When the CPU 201 shifts to the correction mode, when receiving a designation of a teaching point to be corrected (hereinafter referred to as a target teaching point) from among a plurality of teaching points, the CPU 201 prior to correcting the parameter value of the target teaching point. Then, the robot 100 is controlled to operate on the target teaching point. That is, the CPU 201 generates an operation path based on the robot program information 251, the teaching point information 252, the deviation elimination distance information 253 for each robot type, and the information on the surrounding environment model stored in the HDD 204. Here, the teaching point of the robot 100 refers to the teaching point of the robot 100 at the start of execution of each program command. By controlling the operation of the robot 100, the robot 100 is moved to the teaching point, the teaching point information is captured, and the teaching point information on the robot program information 251 created offline in advance is replaced with the captured information. Can be corrected.

次に、図4及び図5を用いて、記憶部であるHDD204に格納される情報252,253について説明する。   Next, information 252 and 253 stored in the HDD 204 as a storage unit will be described with reference to FIGS. 4 and 5.

図4は、HDD204に格納された教示点情報252を示す説明図である。図4(a)は、教示点情報252を示し、図4(b)は、各関節J1〜J6の動作方向を2進数で示す図である。図4(a)に示すように、本実施形態では、教示点情報252として、直交座標系におけるロボット100の教示点の座標データがX,Y,Z,tX,tY,tZのパラメータ値によって格納される。さらに、教示点の識別ID、教示点の名称、教示点を使用するプログラム名、その教示点への移動元教示点の識別ID、移動先教示点の識別ID、各関節の動作方向が格納される。   FIG. 4 is an explanatory diagram showing the teaching point information 252 stored in the HDD 204. 4A shows the teaching point information 252 and FIG. 4B is a diagram showing the operation directions of the joints J1 to J6 in binary numbers. As shown in FIG. 4A, in this embodiment, the coordinate data of the teaching point of the robot 100 in the orthogonal coordinate system is stored as the teaching point information 252 by the parameter values of X, Y, Z, tX, tY, tZ. Is done. Furthermore, the teaching point identification ID, the teaching point name, the name of the program that uses the teaching point, the identification ID of the source teaching point to the teaching point, the identification ID of the destination teaching point, and the movement direction of each joint are stored. The

教示点情報252、特に教示点のパラメータ値は、オフライン教示により作業者が予めHDD204に記憶させておくものである。HDD204に格納される教示点情報252における教示点は、CPU201が教示点間をロボットプログラム情報251にて指定した補間方法(例えば直線補間や円弧補間等)により計算して得られる補間教示点とは異なるものである。   The teaching point information 252, especially the parameter value of the teaching point, is previously stored in the HDD 204 by the operator by offline teaching. The teaching point in the teaching point information 252 stored in the HDD 204 is an interpolation teaching point obtained by the CPU 201 calculating by an interpolation method (for example, linear interpolation or circular interpolation) designated between the teaching points by the robot program information 251. Is different.

図4(b)に示すように、各関節J1〜J6の動作方向を2進数、即ち1(正方向:第1の回転方向)または0(負方向:第1の回転方向とは反対の第2の回転方向)によって表している。図4(a)における各関節の動作方向の値は、図4(b)の2進数の情報を10進数で表したものである。例えば図4(b)の「101001」は、図4(a)の識別ID「P_0001」の教示点において識別ID「P_0002」の移動先の教示点に動作する各関節の動作方向「41」を意味する。   As shown in FIG. 4B, the movement directions of the joints J1 to J6 are binary numbers, that is, 1 (positive direction: first rotation direction) or 0 (negative direction: first rotation direction opposite to the first rotation direction). 2 rotation direction). The value of the motion direction of each joint in FIG. 4A represents the binary number information in FIG. 4B in decimal numbers. For example, “101001” in FIG. 4B indicates the motion direction “41” of each joint that operates at the teaching point of the movement destination of the identification ID “P_0002” at the teaching point of the identification ID “P_0001” in FIG. means.

つまり、HDD204は、各教示点に対して次の(1つ後の)移動先の教示点にロボット100が動作する際のロボット100の各関節J1〜J6の動作方向を示す動作方向データを記憶する動作記憶部である。例えば、教示点P2から移動先の教示点P3に動作する際の各関節の動作方向データは、図4(a)中の各関節の動作方向において上から2行目の「43」となる。   That is, the HDD 204 stores movement direction data indicating the movement directions of the joints J1 to J6 of the robot 100 when the robot 100 moves to the next (next one) destination teaching point with respect to each teaching point. It is an operation | movement memory | storage part to perform. For example, the movement direction data of each joint when moving from the teaching point P2 to the movement destination teaching point P3 is “43” in the second row from the top in the movement direction of each joint in FIG.

図5は、HDD204に格納された、ロボット種別毎のずれ解消用距離情報253を示す説明図である。HDD204には、図5に示すように、ロボット種別毎に、ずれ解消に必要な所定距離の情報(ずれ解消用距離情報)253が格納されている。つまり、HDD204は、ロボット種別毎に所定距離を記憶する距離情報記憶部である。CPU201は、この情報253に加えて、図4の情報252を使って移動の際に経由する経由点を算出し、対象教示点へアプローチする。この所定距離は、シミュレーションや実験を行い、各関節J1〜J6のバックラッシュを考慮して設定されている。   FIG. 5 is an explanatory diagram showing the deviation elimination distance information 253 stored for each robot type stored in the HDD 204. As shown in FIG. 5, the HDD 204 stores information on a predetermined distance (displacement elimination distance information) 253 necessary for eliminating the deviation for each robot type. That is, the HDD 204 is a distance information storage unit that stores a predetermined distance for each robot type. In addition to the information 253, the CPU 201 uses the information 252 in FIG. 4 to calculate a waypoint through which the movement is made and approaches the target teaching point. This predetermined distance is set in consideration of backlash of each joint J1 to J6 through simulations and experiments.

次に、ティーチングペンダント300から対象教示点を選択(指定)する方法を説明する。図6は、HDD204に格納された教示点情報252をティーチングペンダント300の液晶ディスプレイ上に表示した状態を示す説明図である。   Next, a method for selecting (designating) the target teaching point from the teaching pendant 300 will be described. FIG. 6 is an explanatory view showing a state in which the teaching point information 252 stored in the HDD 204 is displayed on the liquid crystal display of the teaching pendant 300.

図6に示すように、「アーム1」というロボットプログラムで使用する教示点の識別ID「P_0001」〜「P_0020」が、一覧として画面に表示される。そして、例えば、作業者によって識別ID「P_0005」が選択され、選択された識別ID「P_0005」の教示点情報252が一覧の下方に表示される。また、図6に示すように、「移動」ボタン、「教示」ボタン、「次候補」ボタン、及び「閉じる」ボタンが表示される。   As shown in FIG. 6, teaching point identification IDs “P_0001” to “P_0020” used in the robot program “arm 1” are displayed as a list on the screen. Then, for example, the identification ID “P_0005” is selected by the operator, and the teaching point information 252 of the selected identification ID “P_0005” is displayed below the list. Further, as shown in FIG. 6, a “move” button, a “teach” button, a “next candidate” button, and a “close” button are displayed.

作業者が画面下部の「移動」ボタンを押下すると、「移動」ボタンを押下している間、CPU201は、ロボット100のロボットハンド102の先端部(つまり、TCP)を、識別ID「P_0005」の教示点の位置座標へ向かって移動させる。位置が確定し作業者が「教示」ボタンを押下すると、CPU201は、ロボット100のロボットハンド102の先端部の位置座標を「P_0005」へ登録する。つまり、現在のロボット100の位置及び姿勢を、識別ID「P_0005」のパラメータ値(X,Y,Z,tX,tY,tZ)としてHDD204に格納する。登録が終わり、作業者が画面下部の「次候補」ボタンを押下すると、現在選択されている「P_0005」から教示点一覧中に表示された次の教示点の識別ID「P_0006」に選択が移る。   When the operator presses the “move” button at the bottom of the screen, while the “move” button is pressed, the CPU 201 moves the tip of the robot hand 102 (ie, TCP) of the robot 100 to the identification ID “P_0005”. Move to the position coordinates of the teaching point. When the position is confirmed and the operator presses the “Teach” button, the CPU 201 registers the position coordinate of the tip of the robot hand 102 of the robot 100 in “P_0005”. That is, the current position and orientation of the robot 100 are stored in the HDD 204 as parameter values (X, Y, Z, tX, tY, tZ) of the identification ID “P_0005”. When registration is completed and the operator presses the “next candidate” button at the bottom of the screen, the selection moves from the currently selected “P_0005” to the identification ID “P_0006” of the next teaching point displayed in the teaching point list. .

ここで、教示点一覧の表示方法について説明する。画面上部にある教示点表示方法選択部301を作業者が押下すると、教示点一覧の表示方法を「名前順」、「最短経路順」から選択することができる。「名前順」とは、教示点一覧を、図4中の「名称」列の値のアスキーコードの昇順に並べたものである。「最短経路順」とは、最短経路探索アルゴリズムであるダイクストラ法などを用いてロボット100の現在の位置座標を起点とし、そこからプログラム「アーム1」で使用する全教示点間を結ぶ最短経路を導き出し、その経路の順番に教示点を並べたものである。「次候補」ボタン押下時の次の教示点はこの表示方法による表示順に従う。   Here, a method for displaying the teaching point list will be described. When the operator presses the teaching point display method selection unit 301 at the top of the screen, the teaching point list display method can be selected from “name order” and “shortest path order”. “Name order” is a list of teaching points arranged in ascending order of ASCII codes of values in the “name” column in FIG. 4. “Shortest path order” refers to a shortest path connecting all teaching points used in the program “arm 1” from the current position coordinates of the robot 100 using the Dijkstra method, which is a shortest path search algorithm. The teaching points are arranged in the order of the route. The next teaching point when the “next candidate” button is pressed follows the display order according to this display method.

次に、図7及び図8に示されたフローチャートを用いて、再教示作業を行う際の教示点へのアプローチの方法について説明する。図7は、修正モードが選択された際のロボット制御方法の各工程を示すフローチャートである。   Next, a method of approaching the teaching point when performing the re-teaching work will be described using the flowcharts shown in FIGS. FIG. 7 is a flowchart showing each step of the robot control method when the correction mode is selected.

まず、CPU201は、作業者によって修正モードが選択された場合、修正モードの処理動作に移行する。   First, when the correction mode is selected by the operator, the CPU 201 shifts to the processing operation in the correction mode.

CPU201は、ティーチングペンダント300から対象教示点への移動指示を受けると、HDD204より、対象教示点の教示点情報252とロボット種別毎のずれ解消用距離情報253を取得する(S1)。   When the CPU 201 receives an instruction to move to the target teaching point from the teaching pendant 300, the CPU 201 acquires the teaching point information 252 of the target teaching point and the distance information 253 for deviation cancellation for each robot type from the HDD 204 (S1).

次に、CPU201は、経由点を算出する(S2)。工程動作モードのときの対象教示点に対する1つ前の移動元の教示点を、以下、移動元教示点という。CPU201は、ロボット100を対象教示点に動作させる際のロボット100の各関節J1〜J6の動作方向が移動元教示点から対象教示点にロボット100を動作させる際のロボット100の各関節J1〜J6の動作方向と同じとなるよう経由点を設定する。この経由点は、移動元教示点とは異なる点である。   Next, the CPU 201 calculates a waypoint (S2). Hereinafter, the previous teaching point of the movement source with respect to the target teaching point in the process operation mode is referred to as a movement source teaching point. The CPU 201 moves the joints J1 to J6 of the robot 100 from the movement source teaching point to the target teaching point when the robot 100 moves the robot 100 from the movement teaching point to the target teaching point. Set the waypoint to be the same as the direction of movement. This waypoint is different from the movement source teaching point.

ここで、CPU201は、経由点から対象教示点までのロボット100の動作経路が、移動元教示点から対象教示点までのロボット100の動作経路よりも短くなるように経由点を設定するのが好ましい。これにより、ロボット100が経由点から対象教示点に動作する時間を短縮することができる。   Here, the CPU 201 preferably sets the via point so that the operation path of the robot 100 from the via point to the target teaching point is shorter than the operating path of the robot 100 from the source teaching point to the target teaching point. . Thereby, the time for the robot 100 to operate from the waypoint to the target teaching point can be shortened.

例えば、図4中、教示点P4が対象教示点であった場合、移動元の教示点P3から対象教示点P4にロボット100が動作するときの動作方向が「43」となる。したがって、ロボット100が経由点から教示点P4に動作するときの動作方向が「43」となるよう、教示点P3以外の点に経由点が設定される。その際、教示点P3から教示点P4までの経路よりも経由点から教示点P4までの経路が短くなるように経由点が設定される。   For example, in FIG. 4, when the teaching point P4 is the target teaching point, the movement direction when the robot 100 moves from the moving teaching point P3 to the target teaching point P4 is “43”. Therefore, the via points are set at points other than the teaching point P3 so that the movement direction when the robot 100 moves from the via point to the teaching point P4 is “43”. At that time, the via point is set so that the path from the via point to the teaching point P4 is shorter than the path from the teaching point P3 to the teaching point P4.

CPU201は、経由点の算出が終わると、現在の位置及び姿勢から経由点を経由して対象教示点へロボット100が動作する動作経路を生成する(S3)。その際、少なくとも現在の位置及び姿勢から経由点までの動作経路は、周囲環境モデルの情報に基づいて、ロボット100が他の物体に干渉しないように生成する。   When the calculation of the waypoints is completed, the CPU 201 generates an operation path for the robot 100 to move from the current position and posture to the target teaching point via the waypoints (S3). At this time, at least the motion path from the current position and orientation to the waypoint is generated based on the information of the surrounding environment model so that the robot 100 does not interfere with other objects.

次に、CPU201は、作成された動作経路を辿って、対象教示点へロボット100をアプローチさせる(S4)。つまり、CPU201は、現在の位置及び姿勢から経由点を経由して対象教示点にロボット100を動作させる。その後は、上述したように、作業者がティーチングペンダント300を操作して、対象教示点の修正(再教示)を行うことができる。   Next, the CPU 201 follows the created operation path and causes the robot 100 to approach the target teaching point (S4). That is, the CPU 201 operates the robot 100 from the current position and posture to the target teaching point via the waypoint. Thereafter, as described above, the operator can operate the teaching pendant 300 to correct (re-teach) the target teaching point.

以上、CPU201は、修正モードに移行した場合には、経由点を経由して対象教示点へロボット100を動作させる。これにより、経由点から対象教示点へ動作するロボット100の各関節の動作方向が、工程動作モードにおいて移動元の教示点から対象教示点へ動作するロボット100の各関節の動作方向と一致する。従って、修正時に対象教示点へロボット100を動作させる際に、工程動作の順番通りにロボット100を動作させなくても、対象教示点に到達したときのロボット100の位置及び姿勢が工程動作時に対してずれるのを低減することができる。これにより作業者にとって作業しやすい順序や対象教示点を結ぶ最短経路となる順序で、対象教示点の修正が可能であり、また修正が不要な教示点への移動を省くことも可能である。これらによって対象教示点の修正作業の時間が短縮され、作業者の作業負担が低減し、作業効率が向上する。   As described above, when the CPU 201 shifts to the correction mode, the CPU 100 operates the robot 100 to the target teaching point via the waypoint. As a result, the movement direction of each joint of the robot 100 that moves from the via point to the target teaching point coincides with the movement direction of each joint of the robot 100 that moves from the movement source teaching point to the target teaching point in the process operation mode. Therefore, when the robot 100 is moved to the target teaching point at the time of correction, the position and posture of the robot 100 when reaching the target teaching point are compared with those at the time of the process operation without operating the robot 100 in the order of the process operation. It is possible to reduce slippage. As a result, the target teaching points can be corrected in the order that is easy for the operator to work and the shortest path connecting the target teaching points, and the movement to the teaching points that do not require correction can be omitted. As a result, the time for correcting the target teaching point is shortened, the work burden on the operator is reduced, and the work efficiency is improved.

特に、ロボット100の各関節J1〜J6には、減速機11が設けられているので、対象教示点に向かう動作方向が異なると、減速機11のバックラッシュにより、工程動作時のロボットの位置及び姿勢に対してずれることがあった。これに対して、本実施形態では、例えば減速機11にバックラッシュがあって、関節にガタが生じる場合であっても、対象教示点に到達したときのロボット100の位置及び姿勢が工程動作時に対してずれるのを低減することができる。   In particular, since each of the joints J1 to J6 of the robot 100 is provided with the speed reducer 11, if the operation direction toward the target teaching point is different, the position of the robot during the process operation and the backlash of the speed reducer 11 are reduced. There was a deviation from the posture. On the other hand, in the present embodiment, for example, even when the speed reducer 11 has a backlash and rattling occurs in the joint, the position and posture of the robot 100 when the target teaching point is reached is determined during the process operation. It is possible to reduce the shift.

次に、図7におけるステップS2の経由点の算出方法について詳細に説明する。図8は、経由点の算出方法を示すフローチャートである。   Next, the waypoint calculation method in step S2 in FIG. 7 will be described in detail. FIG. 8 is a flowchart showing a waypoint calculation method.

まず、CPU201は、教示点情報252から、対象教示点に対する移動元の教示点の識別IDを取得し、識別IDから移動元教示点の位置及び姿勢のパラメータ値及び各関節の動作方向のデータを取得する(S5)。   First, the CPU 201 acquires, from the teaching point information 252, the identification ID of the movement source teaching point with respect to the target teaching point, and obtains the position and orientation parameter values of the movement source teaching point and the motion direction data of each joint from the identification ID. Obtain (S5).

次に、CPU201は、図5のロボット種別毎のずれ解消用距離情報253の中から、該当するロボット100の情報を取得する(S6)。図5中の「装着中」列の値が”○”のものが現在装着中のロボット種別を意味し、そのときの所定距離は15mmである。つまり、CPU201は、ロボット100に対応する所定距離のデータをHDD204に格納されたずれ解消用距離情報253から取得する。なお、例えばロボットアーム101の先端に取り付けられているロボットハンド102を別のエンドエフェクタに交換して別のロボットを構成した際には、当該ロボットに対応する別の所定距離のデータが読み出されることとなる。このように、ロボットの種別に応じて所定距離のデータが異なるので、該当する所定距離のデータを読み出している。   Next, the CPU 201 acquires information of the corresponding robot 100 from the distance information 253 for deviation cancellation for each robot type in FIG. 5 (S6). A value “◯” in the “attached” column in FIG. 5 indicates the type of robot currently attached, and the predetermined distance at that time is 15 mm. That is, the CPU 201 acquires data of a predetermined distance corresponding to the robot 100 from the deviation elimination distance information 253 stored in the HDD 204. For example, when another robot is configured by replacing the robot hand 102 attached to the tip of the robot arm 101 with another end effector, data of another predetermined distance corresponding to the robot is read. It becomes. As described above, since the data of the predetermined distance varies depending on the type of the robot, the corresponding data of the predetermined distance is read out.

次に、CPU201は、ステップS5、ステップS6で取得した情報を基に、対象教示点への進入方向を計算する(S7)。ここでいう進入方向とは、対象教示点に対してどのような角度でTCPが進入するかを指す。次に、CPU201は、対象教示点からステップS7で決定した進入方向に対して、ステップS6で取得した所定距離(15mm)の分戻った点を経由点に設定する(S8)。なお、ステップS7,S8では、既に移動元教示点と対象教示点との間の動作経路が計算済みの場合は、該動作経路上、所定距離の分対象教示点から移動元教示点に戻った点を経由点に設定する。   Next, the CPU 201 calculates the approach direction to the target teaching point based on the information acquired in steps S5 and S6 (S7). The entry direction here refers to what angle the TCP enters with respect to the target teaching point. Next, the CPU 201 sets a point returned from the target teaching point by the predetermined distance (15 mm) acquired in step S6 with respect to the approach direction determined in step S7 as a via point (S8). In steps S7 and S8, if the motion path between the movement source teaching point and the target teaching point has already been calculated, the movement returns to the movement source teaching point from the target teaching point by a predetermined distance on the movement path. Set a point as a via point.

つまり、CPU201は、ステップS5〜S8において、工程動作モードにてロボット100が移動元教示点から対象教示点に動作する動作経路上(移動元教示点及び対象教示点を除く)に、経由点を設定する。これにより、経由点から対象教示点にロボット100を動作させたときには、工程動作時と同じ進入方向から対象教示点に進入することとなる。したがって、対象教示点に到達したときのロボット100の位置及び姿勢が工程動作時に対してずれるのをより効果的に低減することができる。   That is, in steps S5 to S8, the CPU 201 sets a via point on an operation path (excluding the movement source teaching point and the target teaching point) on which the robot 100 operates from the movement source teaching point to the target teaching point in the process operation mode. Set. Thus, when the robot 100 is moved from the via point to the target teaching point, the robot enters the target teaching point from the same approach direction as in the process operation. Therefore, it is possible to more effectively reduce the position and posture of the robot 100 when the target teaching point is reached with respect to the process operation.

そして、本実施形態では、対象教示点から所定距離以上(本実施形態では所定距離)離れたところに経由点が設定される。これにより、関節J1〜J6(例えば減速機11)のバックラッシュの影響により対象教示点に到達したときのロボット100の位置及び姿勢が工程動作時に対してずれるのをより効果的に低減することができる。   In the present embodiment, a via point is set at a distance from the target teaching point by a predetermined distance or more (a predetermined distance in the present embodiment). Thereby, it is possible to more effectively reduce the position and posture of the robot 100 when the target teaching point is reached due to the backlash of the joints J1 to J6 (for example, the speed reducer 11) with respect to the process operation. it can.

図9は、工程動作モードにおいてロボット100が動作する工程動作時の動作経路と、修正モードにおいて再教示の際に作業者が任意に選んだ教示点間の動作経路を示す図である。P1〜P8は教示点を示しており、P4’,P6’,P8’はそれぞれ教示点P4,P6,P8に対する経由点を示している。図9中の破線は、工程動作時の動作経路を示しており、実線は再教示の際に作業者がP1→P4→P6→P8の順にロボット100を動作させる動作経路を示している。   FIG. 9 is a diagram showing an operation path during a process operation in which the robot 100 operates in the process operation mode, and an operation path between teaching points arbitrarily selected by the operator during re-teaching in the correction mode. P1 to P8 indicate teaching points, and P4 ', P6' and P8 'indicate via points for the teaching points P4, P6 and P8, respectively. A broken line in FIG. 9 indicates an operation path at the time of the process operation, and a solid line indicates an operation path by which the operator operates the robot 100 in the order of P1 → P4 → P6 → P8 at the time of re-teaching.

例えば、教示点P1から教示点P4へ移動する場合は、教示点P3から教示点P4への動作経路上に経由点P4’を設定する。そして、ロボット100は、実線で示すように、教示点P1から経由点P4’へ動作し、また経由点P4’から教示点P4へ動作する。   For example, when moving from the teaching point P1 to the teaching point P4, a via point P4 'is set on the operation path from the teaching point P3 to the teaching point P4. Then, as shown by the solid line, the robot 100 moves from the teaching point P1 to the via point P4 'and also operates from the via point P4' to the teaching point P4.

教示点間の移動は、図6中の「移動」ボタンを作業者が押下し続けている間に行われ、経由点P4’で停止するか、教示点P4まで移動するか等は操作によって決定される。また、作業者が操作ボタンを押下し続けた場合に経由点P4’で自動的に一旦停止するかはティーチングペンダント300から設定により決めることができる。作業者は実線で示す動作経路に沿って教示点P4へロボット100を移動させた後に、ジョグ機能などを使って微細な位置修正を行う。   The movement between the teaching points is performed while the operator continues to press the “move” button in FIG. 6, and whether to stop at the via point P4 ′ or to move to the teaching point P4 is determined by the operation. Is done. In addition, when the operator continues to press the operation button, whether to automatically stop at the via point P4 'can be determined by setting from the teaching pendant 300. The operator moves the robot 100 to the teaching point P4 along the operation path indicated by the solid line, and then performs fine position correction using a jog function or the like.

ジョグ機能を使った位置修正の際、作業者は、ロボット100における図4に示した各関節の動作方向の値が登録された情報と変わらない範囲内においてジョグ操作を行うことにより、ずれを発生させることなく位置修正が可能である。例えば、図6中に表示された教示点P5に対するジョグ操作の場合は、図4中の識別IDが「P_0005」の行の各関節の動作方向の値と変わらない範囲であればずれは生じない。   When correcting the position using the jog function, the operator performs a jog operation within a range in which the value of the motion direction of each joint shown in FIG. The position can be corrected without making it. For example, in the case of a jog operation on the teaching point P5 displayed in FIG. 6, there is no deviation as long as the identification ID in FIG. 4 is in a range that does not differ from the value of the motion direction of each joint in the row “P_0005”. .

もし、位置修正中に各関節の動作方向の値と登録された情報との間に差異が生じた場合は、ティーチングペンダント(報知部)300からブザーを鳴動させ、また図9中の「各関節の動作方向」を点滅表示させることにより、作業者に警告する。   If there is a difference between the value of the motion direction of each joint and the registered information during position correction, a buzzer is sounded from the teaching pendant (notification unit) 300, and “each joint in FIG. The operator is warned by blinking the “operation direction”.

ここで、移動元教示点から修正後の対象教示点にロボット100を動作させるときのロボット100の関節J1〜J6の動作方向を、修正後動作方向とする。また、移動元教示点から修正前の対象教示点にロボット100を動作させるときのロボット100の関節J1〜J6の動作方向を、修正前動作方向とする。つまり、CPU201は、修正後動作方向が、修正前動作方向と異なる場合には、ティーチングペンダント(報知部)300において、作業者にブザー音や画像表示により報知させる。このように作業者に注意喚起することにより、動作方向が変更されるような教示点のパラメータ値の修正が行われることを防止することができ、関節J1〜J6のガタによる修正した教示点のずれを防止することができる。   Here, the operation direction of the joints J1 to J6 of the robot 100 when the robot 100 is operated from the movement source teaching point to the corrected target teaching point is defined as the corrected operation direction. Further, the operation direction of the joints J1 to J6 of the robot 100 when the robot 100 is operated from the movement source teaching point to the target teaching point before correction is defined as the pre-correction operation direction. That is, when the corrected operation direction is different from the pre-correction operation direction, the CPU 201 causes the teaching pendant (notification unit) 300 to notify the operator by a buzzer sound or an image display. By alerting the operator in this way, it is possible to prevent the parameter value of the teaching point from being changed so that the movement direction is changed, and the teaching point corrected by the play of the joints J1 to J6 can be prevented. Deviation can be prevented.

なお、本発明は、以上説明した実施形態に限定されるものではなく、本発明の技術的思想内で多くの変形が可能である。   The present invention is not limited to the embodiment described above, and many modifications are possible within the technical idea of the present invention.

上記実施形態においては、再教示を行う場合について説明したが、進入方向を合わせる機能を教示点の位置確認、進入方向の確認等に適用できることは明らかである。   In the above embodiment, the case where re-teaching is performed has been described. However, it is obvious that the function of matching the approach direction can be applied to the confirmation of the position of the teaching point, the confirmation of the approach direction, and the like.

また、上記実施形態においては、制御装置200が1つのコンピュータにより構成される場合について説明したが、複数のコンピュータにより構成される場合についても本発明は適用可能である。この場合、複数のCPUで本発明の制御部が構成されていてもよい。   Moreover, although the case where the control apparatus 200 was comprised by one computer was demonstrated in the said embodiment, this invention is applicable also when comprised by a some computer. In this case, the control unit of the present invention may be configured by a plurality of CPUs.

上記実施形態の各処理動作は具体的にはCPU301により実行されるものである。従って上述した機能を実現するプログラムを記録した記録媒体を制御装置200に供給し、制御装置200を構成するコンピュータ(CPUやMPU)が記録媒体に格納されたプログラムを読み出し実行することによって達成されるようにしてもよい。この場合、記録媒体から読み出されたプログラム自体が上述した実施形態の機能を実現することになり、プログラム自体及びそのプログラムを記録した記録媒体は本発明を構成することになる。   Each processing operation of the above embodiment is specifically executed by the CPU 301. Therefore, this is achieved by supplying a recording medium that records a program for realizing the above-described functions to the control device 200, and a computer (CPU or MPU) constituting the control device 200 reads and executes the program stored in the recording medium. You may do it. In this case, the program itself read from the recording medium realizes the functions of the above-described embodiments, and the program itself and the recording medium recording the program constitute the present invention.

また、上記実施形態では、コンピュータ読み取り可能な記録媒体がHDD204であり、HDD204にプログラム240が格納される場合について説明したが、これに限定するものではない。プログラム240は、コンピュータ読み取り可能な記録媒体であれば、いかなる記録媒体に記録されていてもよい。例えば、プログラムを供給するための記録媒体としては、図3に示すROM202や外部記憶装置312、記録ディスク241等を用いてもよい。具体例を挙げて説明すると、記録媒体として、フレキシブルディスク、ハードディスク、光ディスク、光磁気ディスク、CD−ROM、CD−R、磁気テープ、不揮発性のメモリカード、ROM等を用いることができる。また、上記実施形態におけるプログラムを、ネットワークを介してダウンロードしてコンピュータにより実行するようにしてもよい。   In the above embodiment, the computer-readable recording medium is the HDD 204, and the program 240 is stored in the HDD 204. However, the present invention is not limited to this. The program 240 may be recorded on any recording medium as long as it is a computer-readable recording medium. For example, as a recording medium for supplying the program, the ROM 202, the external storage device 312 and the recording disk 241 shown in FIG. 3 may be used. As a specific example, a flexible disk, hard disk, optical disk, magneto-optical disk, CD-ROM, CD-R, magnetic tape, nonvolatile memory card, ROM, or the like can be used as a recording medium. Further, the program in the above embodiment may be downloaded via a network and executed by a computer.

また、コンピュータが読み出したプログラムコードを実行することにより、上記実施形態の機能が実現されるだけに限定するものではない。そのプログラムコードの指示に基づき、コンピュータ上で稼働しているOS(オペレーティングシステム)等が実際の処理の一部または全部を行い、その処理によって前述した実施形態の機能が実現される場合も含まれる。   Further, the present invention is not limited to the implementation of the functions of the above-described embodiment by executing the program code read by the computer. This includes a case where an OS (operating system) or the like running on the computer performs part or all of the actual processing based on the instruction of the program code, and the functions of the above-described embodiments are realized by the processing. .

さらに、記録媒体から読み出されたプログラムコードが、コンピュータに挿入された機能拡張ボードやコンピュータに接続された機能拡張ユニットに備わるメモリに書き込まれてもよい。そのプログラムコードの指示に基づき、その機能拡張ボードや機能拡張ユニットに備わるCPU等が実際の処理の一部または全部を行い、その処理によって上記実施形態の機能が実現される場合も含まれる。   Furthermore, the program code read from the recording medium may be written in a memory provided in a function expansion board inserted into the computer or a function expansion unit connected to the computer. This includes a case where the CPU of the function expansion board or function expansion unit performs part or all of the actual processing based on the instruction of the program code, and the functions of the above embodiments are realized by the processing.

また、上記実施形態では、コンピュータが記録媒体や記憶装置に記録されたプログラムを実行することにより、処理を行う場合について説明したが、これに限定するものではない。プログラムに基づいて動作する制御部の一部又は全部の機能をASICやFPGA等の専用LSIで構成してもよい。なお、ASICはApplication Specific Integrated Circuit、FPGAはField-Programmable Gate Arrayの頭字語である。   Moreover, although the said embodiment demonstrated the case where a computer performed a process recorded on the recording medium or the memory | storage device, it demonstrated, but it does not limit to this. A part or all of the functions of the control unit that operates based on the program may be configured by a dedicated LSI such as an ASIC or FPGA. Note that ASIC is an acronym for Application Specific Integrated Circuit, and FPGA is an acronym for Field-Programmable Gate Array.

100…ロボット、101…ロボットアーム、102…ロボットハンド、200…制御装置、201…CPU(制御部)、300…ティーチングペンダント(報知部)、500…ロボット装置 DESCRIPTION OF SYMBOLS 100 ... Robot, 101 ... Robot arm, 102 ... Robot hand, 200 ... Control apparatus, 201 ... CPU (control part), 300 ... Teaching pendant (notification part), 500 ... Robot apparatus

Claims (10)

多関節のロボットと、
複数の教示点を順番に動作するよう前記ロボットを制御する工程動作モード、及び前記複数の教示点の中から修正対象の教示点の指定を受けたときに、前記修正対象の教示点のパラメータ値の修正に先立って、前記修正対象の教示点に動作するよう前記ロボットを制御する修正モードを有する制御部と、を備え、
前記制御部は、前記修正モードにおいて前記ロボットを前記修正対象の教示点に動作させる際の前記ロボットの各関節の動作方向が、前記工程動作モードのときに前記修正対象の教示点に対し1つ前の移動元の教示点から前記修正対象の教示点に前記ロボットを動作させる際の前記ロボットの各関節の動作方向と同じとなるよう、前記移動元の教示点とは異なる経由点を設定し、
前記ロボットを、現在の位置及び姿勢から前記経由点を経由して前記修正対象の教示点に動作させることを特徴とするロボット装置。
With articulated robots,
A process operation mode for controlling the robot to operate a plurality of teaching points in sequence, and a parameter value of the teaching point to be corrected when receiving a teaching point to be corrected from the plurality of teaching points A control unit having a correction mode for controlling the robot to operate at the teaching point to be corrected prior to the correction,
In the correction mode, the control unit has one operation direction of each joint of the robot when operating the robot to the correction target teaching point in the correction operation mode with respect to the correction target teaching point in the process operation mode. A via point different from the teaching point of the movement source is set so that the movement direction of each joint of the robot when the robot is moved from the previous teaching point of the movement source to the teaching point to be corrected ,
A robot apparatus, wherein the robot is operated from a current position and posture to the teaching point to be corrected via the waypoint.
前記制御部は、前記経由点から前記修正対象の教示点までの前記ロボットの動作経路が、前記移動元の教示点から前記修正対象の教示点までの前記ロボットの動作経路よりも短くなるように前記経由点を設定することを特徴とする請求項1に記載のロボット装置。   The control unit is configured so that an operation path of the robot from the via point to the correction target teaching point is shorter than an operation path of the robot from the movement source teaching point to the correction target teaching point. The robot apparatus according to claim 1, wherein the waypoint is set. 前記制御部は、前記工程動作モードにて前記ロボットが前記移動元の教示点から前記修正対象の教示点に動作する動作経路上に、前記経由点を設定することを特徴とする請求項1又は2に記載のロボット装置。   2. The control unit according to claim 1, wherein the control unit sets the waypoint on an operation path in which the robot moves from the movement source teaching point to the correction target teaching point in the process operation mode. The robot apparatus according to 2. 前記制御部は、前記修正対象の教示点に動作したとする前記ロボットの先端の位置と、前記経由点に動作したとする前記ロボットの先端の位置との距離が、予め設定された所定距離以上となるように前記経由点を設定することを特徴とする請求項1乃至3のいずれか1項に記載のロボット装置。   The control unit is configured such that a distance between the position of the tip of the robot that has been operated to the teaching point to be corrected and the position of the tip of the robot that has been operated to the via point is a predetermined distance or more. The robot apparatus according to any one of claims 1 to 3, wherein the via point is set so as to satisfy ロボット種別毎に前記所定距離を記憶する距離情報記憶部を備え、
前記制御部は、前記ロボットに対応する前記所定距離を前記距離情報記憶部から取得して、前記経由点を設定することを特徴とする請求項4に記載のロボット装置。
A distance information storage unit for storing the predetermined distance for each robot type;
The robot apparatus according to claim 4, wherein the control unit acquires the predetermined distance corresponding to the robot from the distance information storage unit and sets the waypoint.
前記各教示点に対して移動先の教示点に前記ロボットが動作する際の前記ロボットの各関節の動作方向を示す動作方向データを記憶する動作記憶部を備え、
前記制御部は、前記修正モードにて前記経由点を設定する際に、前記動作記憶部に記憶された前記動作方向データを用いることを特徴とする請求項1乃至5のいずれか1項に記載のロボット装置。
An operation storage unit that stores operation direction data indicating an operation direction of each joint of the robot when the robot operates at a teaching point of a movement destination with respect to each teaching point;
The said control part uses the said operation | movement direction data memorize | stored in the said action | operation memory | storage part, when setting the said via point in the said correction mode, The any one of Claim 1 thru | or 5 characterized by the above-mentioned. Robotic device.
作業者に報知する報知部を備え、
前記制御部は、前記移動元の教示点から修正後の前記修正対象の教示点に前記ロボットを動作させるときの前記ロボットの関節の動作方向が、前記移動元の教示点から修正前の前記修正対象の教示点に前記ロボットを動作させるときの前記ロボットの関節の動作方向と異なる場合には、前記報知部に報知させることを特徴とする請求項1乃至6のいずれか1項に記載のロボット装置。
An informing unit for informing the worker is provided,
The control unit is configured to change the movement direction of the robot joint when the robot is operated from the movement source teaching point to the corrected teaching point after correction from the movement source teaching point. The robot according to any one of claims 1 to 6, wherein when the robot moves to a target teaching point, the notification unit is notified when the direction of movement of the joint of the robot is different. apparatus.
複数の教示点を順番に動作するよう多関節のロボットを制御する工程動作モード、及び前記複数の教示点の中から修正対象の教示点の指定を受けたときに、前記修正対象の教示点のパラメータ値の修正に先立って、前記修正対象の教示点に動作するよう前記ロボットを制御する修正モードを有する制御部によるロボット制御方法であって、
前記制御部が、前記修正モードにおいて前記ロボットを前記修正対象の教示点に動作させる際の前記ロボットの各関節の動作方向が、前記工程動作モードのときに前記修正対象の教示点に対し1つ前の移動元の教示点から前記修正対象の教示点に前記ロボットを動作させる際の前記ロボットの各関節の動作方向と同じとなるよう、前記移動元の教示点とは異なる経由点を設定する工程と、
前記制御部が、前記ロボットを、現在の位置及び姿勢から前記経由点を経由して前記修正対象の教示点に動作させる工程と、を備えたことを特徴とするロボット制御方法。
A process operation mode for controlling an articulated robot to operate a plurality of teaching points in order, and when a teaching point to be corrected is designated from among the plurality of teaching points, Prior to the correction of the parameter value, a robot control method by a control unit having a correction mode for controlling the robot to operate at the teaching point to be corrected,
When the control unit moves the robot to the teaching point to be corrected in the correction mode, the operation direction of each joint of the robot is one for the teaching point to be corrected in the process operation mode. A via point different from the teaching point of the movement source is set so as to be the same as the movement direction of each joint of the robot when operating the robot from the previous teaching point of the movement source to the teaching point to be corrected Process,
And a step of causing the control unit to operate the robot from the current position and posture to the teaching point to be corrected via the waypoint.
コンピュータに、請求項8に記載のロボット装置の制御方法の各工程を実行させるためのプログラム。   The program for making a computer perform each process of the control method of the robot apparatus of Claim 8. 請求項9に記載のプログラムを記録したコンピュータ読み取り可能な記録媒体。   A computer-readable recording medium on which the program according to claim 9 is recorded.
JP2014164818A 2014-08-13 2014-08-13 Robot device, method for controlling robot, program and recording medium Pending JP2016040067A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2014164818A JP2016040067A (en) 2014-08-13 2014-08-13 Robot device, method for controlling robot, program and recording medium

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2014164818A JP2016040067A (en) 2014-08-13 2014-08-13 Robot device, method for controlling robot, program and recording medium

Publications (1)

Publication Number Publication Date
JP2016040067A true JP2016040067A (en) 2016-03-24

Family

ID=55540646

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2014164818A Pending JP2016040067A (en) 2014-08-13 2014-08-13 Robot device, method for controlling robot, program and recording medium

Country Status (1)

Country Link
JP (1) JP2016040067A (en)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2018171691A (en) * 2017-03-31 2018-11-08 株式会社ダイヘン Robot control device and control program
JP2020082218A (en) * 2018-11-16 2020-06-04 ファナック株式会社 Operation program creation device
WO2022137917A1 (en) * 2020-12-25 2022-06-30 川崎重工業株式会社 Control device for substrate conveyance robot and method for controlling joint motor
JP7531760B1 (en) 2024-01-23 2024-08-09 三菱電機株式会社 Support device, support system, support method and program

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2018171691A (en) * 2017-03-31 2018-11-08 株式会社ダイヘン Robot control device and control program
JP2020082218A (en) * 2018-11-16 2020-06-04 ファナック株式会社 Operation program creation device
WO2022137917A1 (en) * 2020-12-25 2022-06-30 川崎重工業株式会社 Control device for substrate conveyance robot and method for controlling joint motor
JP7531760B1 (en) 2024-01-23 2024-08-09 三菱電機株式会社 Support device, support system, support method and program

Similar Documents

Publication Publication Date Title
US10751874B2 (en) Method of teaching robot and robotic arm control device
JP6706489B2 (en) Robot direct teaching method
JP6648913B2 (en) Control method, robot apparatus, program, recording medium, article manufacturing method, and driving apparatus
JP6584102B2 (en) Robot apparatus, robot control method, program, recording medium, and article manufacturing method
JPWO2017033353A1 (en) Remote control robot system
JP5701055B2 (en) 7-axis articulated robot control method, control program, and robot controller
JP5458769B2 (en) Robot control device
JP2013193131A (en) Robot control method, robot control device, and robot control system
US20200283242A1 (en) Robot, method of controlling robot, method of manufacturing product, and recording medium
JP2014217913A (en) Operation teaching method of parallel link robot and parallel link robot
JP2016040067A (en) Robot device, method for controlling robot, program and recording medium
JP2007319970A (en) Method of controlling location/position of tool of industrial robot, and control system
JP2007168053A (en) Teaching method of vertical articulated type robot and industrial robot device
JP6348141B2 (en) Robot control device displaying operation program including additional axis status
JP2018012185A (en) Operation method of robot, computer program, and robot system
JPWO2019171516A1 (en) Inertia parameter identification system and inertial parameter identification method for vertical articulated robots, and control device and control method for vertical articulated robots
JP2020015124A (en) Robot control method, article manufacturing method, robot control device, robot, program and recording medium
JP2012051043A (en) Robot system or robot control device
JP2013223895A (en) Robot control method and robot control device
US20230035296A1 (en) Method of suppressing vibrations of a robot arm with external objects
JP5633268B2 (en) Robot control device
JP7424097B2 (en) Robot control device and robot control method
JP6439375B2 (en) Robot and control device
JPH0957671A (en) Control device of articulated moving body and its control method
JP2015000438A (en) Robot, positional attitude correction device, and positional attitude correction method