[go: up one dir, main page]

JP7510514B2 - Offset value setting method and robot control device - Google Patents

Offset value setting method and robot control device Download PDF

Info

Publication number
JP7510514B2
JP7510514B2 JP2022558662A JP2022558662A JP7510514B2 JP 7510514 B2 JP7510514 B2 JP 7510514B2 JP 2022558662 A JP2022558662 A JP 2022558662A JP 2022558662 A JP2022558662 A JP 2022558662A JP 7510514 B2 JP7510514 B2 JP 7510514B2
Authority
JP
Japan
Prior art keywords
offset value
tool
coordinate
rotation
robot
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.)
Active
Application number
JP2022558662A
Other languages
Japanese (ja)
Other versions
JPWO2022091241A1 (en
Inventor
将吾 東
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Individual
Original Assignee
Individual
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 Individual filed Critical Individual
Publication of JPWO2022091241A1 publication Critical patent/JPWO2022091241A1/ja
Application granted granted Critical
Publication of JP7510514B2 publication Critical patent/JP7510514B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/10Programme-controlled manipulators characterised by positioning means for manipulator elements

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)
  • Numerical Control (AREA)

Description

本明細書は、オフセット値設定方法およびロボット制御装置を開示する。 This specification discloses a method for setting offset values and a robot control device.

従来、アームの先端にツールが取り付けられる多関節型のロボットにおいて、アームの先端を所望の位置に精度よく位置決めするために、ロボットの各機構のキャリブレーションを行うものが知られている。例えば、特許文献1には、ロボット座標系の空間内に固定されたターゲット上のマークを撮像するカメラを用い、ロボットを複数の動作位置に移動させた際にカメラで撮像されたマークの形状の特徴が所定の条件を満たす動作位置およびロボット姿勢を複数記憶してキャリブレーションを行うものが記載されている。Conventionally, in a multi-joint robot in which a tool is attached to the end of an arm, calibration of each mechanism of the robot is known in order to accurately position the end of the arm at a desired position. For example, Patent Document 1 describes a calibration method that uses a camera that captures an image of a mark on a target fixed in the space of a robot coordinate system, and stores multiple operating positions and robot postures in which the shape characteristics of the mark captured by the camera satisfy predetermined conditions when the robot is moved to multiple operating positions.

特開2008-12604号公報JP 2008-12604 A

ここで、上述したツールとして、アームの先端部の原点からオフセットした位置に、制御点を有するものがある。そのようなツールに加工誤差や取付誤差がある場合、その誤差に、先端部の原点を回転中心とする回転ずれによる誤差が重なるため、オフセット値を正しく求めて設定することが困難となり、ロボットの作業精度が低下するおそれがある。 The above-mentioned tool includes one that has a control point at a position offset from the origin at the tip of the arm. If such a tool has machining or installation errors, these errors will be combined with errors due to rotational deviation around the origin at the tip, making it difficult to correctly determine and set the offset value, which could reduce the operational accuracy of the robot.

本開示は、アームの先端部の原点から制御点がオフセットして取り付けられるツールのオフセット値をより精度よく設定することを主目的とする。 The primary objective of this disclosure is to more accurately set the offset value of a tool whose control point is offset from the origin at the tip of the arm.

本開示は、上述の主目的を達成するために以下の手段を採った。 This disclosure takes the following measures to achieve the above-mentioned primary objective.

本開示のオフセット値設定方法は、
多関節ロボットのアームの先端部に取り付けられ、制御点が前記先端部の原点からXY方向にオフセットされたツールのオフセット値設定方法であって、
前記ツールのXY方向の位置合わせ用の位置マークとZ軸回りの回転向き合わせ用の回転向きマークとを有するプレートを画像認識して、前記位置マークのXY方向の位置を示す第1座標を取得する第1取得ステップと、
前記ツールの設計上のオフセット値を用いて前記第1座標を前記ツールの制御点の目標位置として前記アームを作動させてから、実際の前記制御点の位置および前記ツールの回転向きが前記位置マークおよび前記回転向きマークに合うように前記先端部の位置および回転量を調整する作動ステップと、
該調整後の前記制御点のXY方向の位置を示す第2座標と該調整による前記先端部の回転調整量とを取得する第2取得ステップと、
前記第2座標と前記回転調整量と前記設計上のオフセット値とを用いて前記調整後の前記先端部の原点位置を求め、該原点位置を中心に前記回転調整量だけ戻す方向に前記第2座標を回転させた位置を示す第3座標を取得する第3取得ステップと、
前記第1座標と前記第3座標とのX方向とY方向の差分をそれぞれ算出し、該差分を前記設計上のオフセット値に加えて前記ツールのオフセット値を設定する設定ステップと、
を含むことを要旨とする。
The offset value setting method of the present disclosure includes:
1. A method for setting offset values for a tool attached to a tip of an arm of an articulated robot, the control point of the tool being offset in X and Y directions from an origin of the tip, the method comprising the steps of:
a first acquisition step of acquiring first coordinates indicating the positions of the position marks in the XY directions by performing image recognition on a plate having position marks for aligning the tool in the XY directions and rotation orientation marks for aligning the tool around the Z axis;
an operating step of operating the arm by setting the first coordinates as a target position of a control point of the tool using an offset value in design of the tool, and then adjusting the position and rotation amount of the tip portion so that an actual position of the control point and a rotational orientation of the tool match the position mark and the rotational orientation mark;
a second acquisition step of acquiring second coordinates indicating the position of the control point in the XY direction after the adjustment and an amount of rotation adjustment of the tip portion due to the adjustment;
a third acquisition step of determining an origin position of the tip portion after the adjustment using the second coordinate, the rotation adjustment amount, and the design offset value, and acquiring a third coordinate indicating a position obtained by rotating the second coordinate in a direction returning the tip portion by the rotation adjustment amount around the origin position;
a setting step of calculating differences in an X direction and a Y direction between the first coordinate and the third coordinate, respectively, and adding the differences to the designed offset value to set an offset value of the tool;
The gist of the invention is that it includes the following:

本開示のオフセット値設定方法では、プレートを画像認識して取得した位置マークの第1座標を制御点の目標位置としてアームを作動させてから、実際の制御点の位置およびツールの回転向きが位置マークおよび回転向きマークに合うように先端部の位置および回転量を調整する。また、調整後の制御点の第2座標と先端部の回転調整量と設計上のオフセット値とを用いて調整後の先端部の原点位置を求め、原点位置を中心に回転調整量だけ戻す方向に第2座標を回転させた第3座標を取得する。そして、第1座標と第3座標とのX方向とY方向の差分をそれぞれ算出し、その差分を設計上のオフセット値に加えてツールのオフセット値を設定する。これにより、ツールの制御点が先端部の原点からXY方向にオフセットされるものでも、ツールの加工誤差や取付誤差、回転ずれの影響を除去してオフセット値を精度よく設定することができる。In the offset value setting method disclosed herein, the arm is operated with the first coordinate of the position mark obtained by image recognition of the plate as the target position of the control point, and then the position and rotation amount of the tip are adjusted so that the actual position of the control point and the rotation direction of the tool match the position mark and the rotation direction mark. In addition, the second coordinate of the adjusted control point, the rotation adjustment amount of the tip, and the design offset value are used to determine the origin position of the adjusted tip, and the third coordinate is obtained by rotating the second coordinate in a direction returning the rotation adjustment amount around the origin position. Then, the difference between the first coordinate and the third coordinate in the X direction and the Y direction is calculated, and the difference is added to the design offset value to set the offset value of the tool. As a result, even if the control point of the tool is offset in the XY direction from the origin of the tip, the offset value can be set with high precision by eliminating the effects of machining error, installation error, and rotation deviation of the tool.

ロボット20の構成の概略を示す構成図。FIG. 2 is a diagram showing an outline of the configuration of a robot 20. ロボット20とロボット制御装置70の電気的な接続関係を示す説明図。FIG. 2 is an explanatory diagram showing an electrical connection relationship between the robot 20 and a robot control device 70. オフセット値設定方法の一例を示す説明図。FIG. 11 is an explanatory diagram showing an example of a method for setting an offset value. 回転ずれ除去後オフセット値算出の一例を示す説明図。FIG. 11 is an explanatory diagram showing an example of calculation of an offset value after removing a rotational deviation. オフセット値を設定する際の様子の一例を示す説明図。FIG. 11 is an explanatory diagram showing an example of a state when an offset value is set. 十字プレートPの上面の一例を示す説明図。FIG. 4 is an explanatory diagram showing an example of the upper surface of the cross plate P. オフセット値の設定方法の一例を示すイメージ図。FIG. 11 is an image diagram showing an example of a method for setting an offset value. オフセット値の設定方法の一例を示すイメージ図。FIG. 11 is an image diagram showing an example of a method for setting an offset value. オフセット値の設定方法の一例を示すイメージ図。FIG. 11 is an image diagram showing an example of a method for setting an offset value. オフセット値の設定方法の一例を示すイメージ図。FIG. 11 is an image diagram showing an example of a method for setting an offset value. オフセット値の設定方法の一例を示すイメージ図。FIG. 11 is an image diagram showing an example of a method for setting an offset value.

次に、本開示の実施の形態を図面を参照しながら説明する。図1は、ロボット20の構成の概略を示す構成図である。図2は、ロボット20とロボット制御装置70の電気的な接続関係を示す説明図である。Next, an embodiment of the present disclosure will be described with reference to the drawings. Fig. 1 is a schematic diagram showing the configuration of the robot 20. Fig. 2 is an explanatory diagram showing the electrical connection between the robot 20 and the robot control device 70.

ロボット20は、ロボット制御装置70による制御を受けて、ワーク搬送装置12(図2参照)により搬送されるワーク(作業対象物)に対して所定の作業を行うものである。なお、所定の作業としては、ワークをピックアップするピックアップ作業や、ワークを所定位置にプレースするプレース作業、ワークを所定位置に組み付ける組み付け作業などを挙げることができる。The robot 20 is controlled by the robot control device 70 and performs a predetermined operation on a workpiece (work object) transported by the work transport device 12 (see FIG. 2). Examples of the predetermined operation include a pick-up operation for picking up a workpiece, a placing operation for placing a workpiece in a predetermined position, and an assembly operation for assembling a workpiece in a predetermined position.

ロボット20は、図1に示すように、例えば5軸の垂直多関節アーム(以下、アームという)22を備える。アーム22は、6つのリンク(第1~第6リンク31~36)と、各リンクを回転または旋回可能に連結する5つの関節(第1~第5関節41~45)とを有する。各関節(第1~第5関節41~45)には、対応する関節を駆動するモータ(サーボモータ)51~55と、対応するモータの回転位置を検出するエンコーダ(ロータリエンコーダ)61~65とが設けられている。なお、第6リンク36を先端リンク(先端部)36という。 As shown in Figure 1, the robot 20 has, for example, a five-axis vertical multi-joint arm (hereinafter referred to as arm) 22. The arm 22 has six links (first to sixth links 31 to 36) and five joints (first to fifth joints 41 to 45) that connect the links so that they can rotate or swivel. Each joint (first to fifth joints 41 to 45) is provided with a motor (servo motor) 51 to 55 that drives the corresponding joint, and an encoder (rotary encoder) 61 to 65 that detects the rotational position of the corresponding motor. The sixth link 36 is referred to as the tip link (tip) 36.

アーム22の先端リンク36には、エンドエフェクタとしての作業ツール(以下、ツールT)が着脱可能となっている。ツールTとしては、電磁チャックやメカニカルチャック、吸着ノズルなどを挙げることができ、作業対象のワークの形状や素材に合わせて適宜選択される。また、アーム22の第5リンク35には、カメラ24が取り付けられている。カメラ24は、例えばワークの位置および姿勢を認識するために当該ワークを撮像する。A work tool (hereinafter, tool T) serving as an end effector can be attached and detached to the tip link 36 of the arm 22. Examples of tool T include an electromagnetic chuck, a mechanical chuck, and a suction nozzle, and are selected appropriately according to the shape and material of the workpiece to be worked on. In addition, a camera 24 is attached to the fifth link 35 of the arm 22. The camera 24 captures an image of the workpiece to recognize, for example, the position and orientation of the workpiece.

こうして構成された本実施形態のアーム22は、ロボット20を正面から見て前(手前)後(奥)の方向をX軸とし、ロボット20の上下方向(第1関節41の回転軸の延在方向)をZ軸とし、X軸およびZ軸に直交する方向をY軸とする三次元空間内の移動が可能である。なお、三次元空間には、ロボット20の作業台11(図5参照)の所定位置などを原点とするワールド座標系が規定されている。また、先端リンク36のツール取付面の中心位置即ちツールTの取付基準位置を原点とするメカニカルインタフェース座標系が規定されている。このメカニカルインタフェース座標系の原点を、原点Moとする。The arm 22 of this embodiment thus configured can move in a three-dimensional space with the front (near) and rear (far) directions when the robot 20 is viewed from the front as the X-axis, the vertical direction of the robot 20 (extension direction of the rotation axis of the first joint 41) as the Z-axis, and the direction perpendicular to the X-axis and Z-axis as the Y-axis. In the three-dimensional space, a world coordinate system is defined with an origin at a predetermined position of the worktable 11 (see FIG. 5) of the robot 20. In addition, a mechanical interface coordinate system is defined with an origin at the center position of the tool mounting surface of the tip link 36, i.e., the mounting reference position of the tool T. The origin of this mechanical interface coordinate system is defined as the origin Mo.

ロボット制御装置70は、図2に示すように、CPU71を中心としたマイクロプロセッサとして構成され、CPU71の他に、ROM72やHDD73、RAM74、図示しない入出力インタフェース、図示しない通信インタフェースなどを備える。なお、HDD73は、ロボット20の動作プログラムやツールTの後述するオフセット値73aなどを記憶している。ロボット制御装置70には、エンコーダ61~65などからの検知信号やカメラ24からの画像信号、表示操作パネル28からの操作信号が入力される。また、ロボット制御装置70からは、モータ51~55やワーク搬送装置12などへの制御信号やカメラ24への駆動信号、表示操作パネル28への表示信号が出力される。表示操作パネル28は、作業者がタッチ操作可能なタッチパネル式の液晶ディスプレイとして構成されている。この表示操作パネル28では、ロボット20の作動状況などの各種情報を表示したり、各種設定や各種指示などの入力操作や作業者によるアーム22の手動操作(位置調整)を受け付けたりする。なお、表示装置と入力装置とが別々に設けられていてもよい。2, the robot control device 70 is configured as a microprocessor centered on the CPU 71, and in addition to the CPU 71, includes a ROM 72, a HDD 73, a RAM 74, an input/output interface (not shown), and a communication interface (not shown). The HDD 73 stores the operation program of the robot 20 and an offset value 73a (described later) of the tool T. The robot control device 70 receives detection signals from the encoders 61-65, image signals from the camera 24, and operation signals from the display operation panel 28. The robot control device 70 also outputs control signals to the motors 51-55 and the work transport device 12, drive signals to the camera 24, and display signals to the display operation panel 28. The display operation panel 28 is configured as a touch panel type liquid crystal display that can be operated by the operator. The display operation panel 28 displays various information such as the operating status of the robot 20, and accepts input operations such as various settings and various instructions, as well as manual operation (position adjustment) of the arm 22 by the operator. The display device and the input device may be provided separately.

このロボット制御装置70は、ロボット20の各モータ51~55を駆動制御することにより、アーム22に装着されたツールTをワークに向けて移動させ、ツールTを用いてワークに対して所定の作業を行う。例えば、ロボット制御装置70は、カメラ24で撮像された画像を処理して、ツールTの作業中心(制御中心)である制御点の目標位置およびツールTの目標角度(姿勢)を取得し、メカニカルインタフェース座標系(原点Mo)の目標位置および目標角度に変換する。また、ツールTの制御点が、原点Moからオフセットして取り付けられるものである場合、そのオフセット値73aを反映して目標位置および目標角度に変換する。次に、ロボット制御装置70は、変換した目標位置および目標角度を周知のパラメータ等を用いてアーム22の各関節の目標位置および目標角度をそれぞれ設定する。そして、ロボット制御装置70は、各関節の位置および角度が、それぞれの目標位置および目標角度に一致するように、対応するモータ51~55を駆動制御すると共にワークに対して作業が行われるようツールTを駆動制御する。 The robot control device 70 drives and controls each of the motors 51 to 55 of the robot 20 to move the tool T attached to the arm 22 toward the workpiece, and uses the tool T to perform a predetermined task on the workpiece. For example, the robot control device 70 processes an image captured by the camera 24 to obtain the target position of the control point that is the work center (control center) of the tool T and the target angle (posture) of the tool T, and converts them into the target position and target angle of the mechanical interface coordinate system (origin Mo). In addition, if the control point of the tool T is attached offset from the origin Mo, the offset value 73a is reflected and converted into the target position and target angle. Next, the robot control device 70 sets the target position and target angle of each joint of the arm 22 using the converted target position and target angle using well-known parameters, etc. Then, the robot control device 70 drives and controls the corresponding motors 51 to 55 so that the position and angle of each joint coincide with the respective target position and target angle, and drives and controls the tool T so that the task is performed on the workpiece.

次に、こうして構成されたロボット20において、所定の十字プレート(治具プレート)Pを用いてツールTのオフセット値を設定するオフセット値設定方法を説明する。図3は、オフセット値設定方法の一例を示す説明図である。図4は、回転ずれ除去後オフセット値算出の一例を示す説明図であり、図3のS60の内容である。また、図5は、オフセット値を設定する際の様子の一例を示す説明図であり、図6は、十字プレートPの上面の一例を示す説明図である。図7~図11は、オフセット値の設定方法の一例を示すXY平面上のイメージ図であり、説明の便宜上、オフセットずれや回転ずれを大きく図示した。Next, an offset value setting method for setting the offset value of the tool T using a specified cross plate (jig plate) P in the robot 20 configured in this manner will be described. FIG. 3 is an explanatory diagram showing an example of an offset value setting method. FIG. 4 is an explanatory diagram showing an example of offset value calculation after removal of rotational deviation, and shows the contents of S60 in FIG. 3. FIG. 5 is an explanatory diagram showing an example of a state when setting an offset value, and FIG. 6 is an explanatory diagram showing an example of the top surface of the cross plate P. FIGS. 7 to 11 are conceptual diagrams on the XY plane showing an example of a method for setting an offset value, with offset deviation and rotational deviation shown enlarged for ease of explanation.

本実施形態のオフセット値設定方法は、作業者などにより、図5に示すようにロボット20の作業台11上の所定位置に十字プレートPを設置して行われる。十字プレートPは、図6に示すように、十字状のパターンと、ツールTの位置合わせ用の位置マークMpと、回転向き合わせ用の回転向きマークMrとが、上面に形成されている。位置マークMpは、十字の中心即ちプレート中心に形成された円形のマークである。回転向きマークMrは、ツールTの投影形状を示すマークであり、例えば一対のメカニカルチャックの投影形状が位置マークMpを中心とする対称位置に形成されている。作業者は、十字プレートPを作業台11上に設置した状態で、表示操作パネル28で必要な情報の入力操作やアーム22の手動操作を行いながら、ロボット制御装置70にオフセット値を設定させる。 The offset value setting method of this embodiment is performed by an operator or the like by placing a cross plate P at a predetermined position on the work table 11 of the robot 20 as shown in FIG. 5. As shown in FIG. 6, the cross plate P has a cross-shaped pattern, a position mark Mp for aligning the tool T, and a rotation direction mark Mr for aligning the rotation direction formed on the upper surface. The position mark Mp is a circular mark formed at the center of the cross, i.e., the center of the plate. The rotation direction mark Mr is a mark that indicates the projected shape of the tool T, and for example, the projected shapes of a pair of mechanical chucks are formed in symmetrical positions with the position mark Mp as the center. With the cross plate P placed on the work table 11, the operator inputs necessary information on the display operation panel 28 and manually operates the arm 22 while causing the robot control device 70 to set the offset value.

図3のオフセット値設定方法では、作業者は、まず、ツールTの設計上のオフセット値を登録する(S10)。設計上のオフセット値(以下、オフセット設計値)は、ツールTの取付基準位置からツールTの制御点までのX方向およびY方向の距離として、ツールTの設計寸法に基づいて定められている。オフセット設計値は、例えば作業者により表示操作パネル28を用いて登録される。例えば、図5には、ツールTとしてのメカニカルチャックがワークをチャックする作業中心の位置(制御点)T0が、原点MoからX方向にXoff0だけオフセットされた様子を示す。なお、X方向,Y方向のオフセット値だけでなく、Z軸回りの回転方向のオフセット値が登録されてもよいが、回転方向のオフセット設計値がなければ値0が登録される。 In the offset value setting method of FIG. 3, the worker first registers the design offset value of the tool T (S10). The design offset value (hereinafter, the offset design value) is determined based on the design dimensions of the tool T as the distance in the X and Y directions from the mounting reference position of the tool T to the control point of the tool T. The offset design value is registered, for example, by the worker using the display operation panel 28. For example, FIG. 5 shows a state in which the position (control point) T0 of the work center where the mechanical chuck as the tool T chucks the workpiece is offset from the origin Mo by Xoff0 in the X direction. Note that not only the offset values in the X and Y directions but also the offset value in the rotation direction around the Z axis may be registered, but if there is no offset design value in the rotation direction, a value of 0 is registered.

次に、CPU71は、十字プレートPの中心(位置マークMp)にカメラ24の中心が合うように移動させ、その際の位置マークMpの位置(中心位置)を示す第1座標(X1,Y1)と回転向きマークMrのZ軸回りの回転量R1とを取得する(S20,図7)。S20では、CPU71は、カメラ24により撮像された画像を画像処理して位置マークMpや回転向きマークMrを認識し、その位置および回転向きを取得する。S20の回転量R1は、作業台11上の十字プレートPのZ軸回りの回転ずれ量を示し、十字プレートPが回転ずれなく正しく設置されていれば、値0となる。図7では、S20で取得された第1座標(X1,Y1)を「S20(X1,Y1)」とし、図8~図11も同様とする。また、S20を行った際のメカニカルインタフェース座標系の原点Mo即ち先端リンク36の原点Moを、原点Mo0とする。Next, the CPU 71 moves the camera 24 so that the center of the cross plate P (position mark Mp) is aligned with the center of the camera 24, and acquires the first coordinates (X1, Y1) indicating the position (center position) of the position mark Mp at that time and the rotation amount R1 of the rotation direction mark Mr around the Z axis (S20, FIG. 7). In S20, the CPU 71 performs image processing on the image captured by the camera 24 to recognize the position mark Mp and the rotation direction mark Mr, and acquires their positions and rotation directions. The rotation amount R1 in S20 indicates the amount of rotational deviation of the cross plate P around the Z axis on the workbench 11, and if the cross plate P is correctly installed without any rotational deviation, the value is 0. In FIG. 7, the first coordinates (X1, Y1) acquired in S20 are "S20 (X1, Y1)", and the same applies to FIGS. 8 to 11. In addition, the origin Mo of the mechanical interface coordinate system when S20 is performed, that is, the origin Mo of the tip link 36, is set to the origin Mo0.

続いて、CPU71は、ツールTの制御点の目標位置と目標回転量(目標角度)を、第1座標(X1,Y1)と回転量R1として、ツールTが移動するようにアーム22の作動を制御する(S30,図7)。ここで、ツールTの加工誤差や取付誤差などにより、実際のオフセット値がオフセット設計値と異なり、X方向,Y方向のオフセットずれやZ軸回りの回転ずれが発生する場合がある。その場合、S30で移動させたツールTの実際の制御点の位置が、第1座標(X1,Y1)や回転量R1と一致せず、位置ずれや回転ずれが生じる。図7では、回転ずれによる移動位置を点線で図示し、これにオフセットずれが加わった位置を実線で示す。ただし、CPU71は、第1座標(X1,Y1)と回転量R1とを制御点の目標位置と目標回転量としてアーム22を作動させるから、ツールTの制御点が図7の「S20(X1,Y1)」に移動したと認識している。即ち、実際には、ツールTの制御点がS30の実線位置に移動しているものの、CPU71は、ツールTの制御点が「S20(X1,Y1)」にあると誤認識していることになる。 Next, the CPU 71 controls the operation of the arm 22 so that the tool T moves, with the target position and target rotation amount (target angle) of the control point of the tool T set as the first coordinates (X1, Y1) and the rotation amount R1 (S30, FIG. 7). Here, due to machining errors and installation errors of the tool T, the actual offset value may differ from the offset design value, and offset deviations in the X and Y directions and rotation deviations around the Z axis may occur. In that case, the position of the actual control point of the tool T moved in S30 does not match the first coordinates (X1, Y1) and the rotation amount R1, and position deviations and rotation deviations occur. In FIG. 7, the moving position due to the rotation deviation is shown by a dotted line, and the position with the offset deviation added thereto is shown by a solid line. However, since the CPU 71 operates the arm 22 with the first coordinates (X1, Y1) and the rotation amount R1 as the target position and target rotation amount of the control point, it recognizes that the control point of the tool T has moved to "S20 (X1, Y1)" in FIG. 7. That is, although the control point of tool T has actually moved to the solid line position of S30, the CPU 71 erroneously recognizes that the control point of tool T is at "S20 (X1, Y1)."

S30に続いて、ツールTの制御点の位置と回転向きとが、十字プレートPの位置マークMpと回転向きマークMrとに一致するように、先端リンク36の位置および回転量(角度)を調整する(S40,図8)。S40では、例えば作業者が表示操作パネル28を用いて、目視による調整操作を行うことで、ツールTの制御点の位置と回転向きとが位置マークMpと回転向きマークMrとに一致するようにロボット20を作動させる。例えば図8では、回転調整によって回転ずれを解消した位置を点線で図示し、これに位置調整によってオフセットずれを解消した位置を実線で示す。また、XY方向の位置調整に伴って、メカニカルインタフェース座標系の原点Moが原点Mo0から移動した位置を原点Mo1とする。 Following S30, the position and rotation amount (angle) of the tip link 36 are adjusted so that the position and rotation direction of the control point of the tool T coincide with the position mark Mp and rotation direction mark Mr of the cross plate P (S40, FIG. 8). In S40, for example, an operator uses the display operation panel 28 to perform visual adjustment operations to operate the robot 20 so that the position and rotation direction of the control point of the tool T coincide with the position mark Mp and rotation direction mark Mr. For example, in FIG. 8, the position where the rotational deviation is eliminated by the rotation adjustment is shown by a dotted line, and the position where the offset deviation is eliminated by the position adjustment is shown by a solid line. In addition, the position where the origin Mo of the mechanical interface coordinate system moves from the origin Mo0 due to the position adjustment in the XY direction is set to the origin Mo1.

そして、CPU71は、調整後(移動後)の制御点の位置を示す第2座標(X2,Y2)と回転量(回転調整量)R2とを取得する(S50,図8,図9)。上述したように、CPU71は、S30で制御点が「S20(X1,Y1)」にあると誤認識しているから、「S20(X1,Y1)」に対して調整がなされたと認識する。図9では、「S20(X1,Y1)」(S40と同位置)に対して回転調整がされた位置を点線で示し、これにXY方向の位置調整がされた位置を実線で示す。図示するように、第2座標(X2,Y2)として「S50(X2,Y2)」の位置座標が取得される。Then, the CPU 71 acquires the second coordinates (X2, Y2) and the rotation amount (rotation adjustment amount) R2 indicating the position of the control point after adjustment (movement) (S50, Figs. 8 and 9). As described above, the CPU 71 erroneously recognizes in S30 that the control point is at "S20 (X1, Y1)," and therefore recognizes that adjustment has been made to "S20 (X1, Y1)." In Fig. 9, the position after rotation adjustment to "S20 (X1, Y1)" (the same position as S40) is shown by dotted lines, and the position after position adjustment in the XY directions is shown by solid lines. As shown in the figure, the position coordinates of "S50 (X2, Y2)" are acquired as the second coordinates (X2, Y2).

ここで、図9(図8)に示すように、メカニカルインタフェース座標系の原点即ち先端リンク36の回転中心が原点Mo0から原点Mo1に移動しているため、S50の実線位置には、X方向,Y方向のオフセットずれに、回転中心が異なることによる回転ずれも重なっている。このため、第2座標(X2,Y2)および回転量R2と、第1座標(X1,Y1)および回転量R1とに基づいて差分ΔX,ΔY,ΔRを算出してオフセット設計値に反映させたとしても、回転ずれによる影響が残ったままとなり正しいオフセット値とならない。また、上述したように、十字プレートPが回転ずれして配置されているために、その回転ずれによる影響が反映されている可能性もある。そこで、本実施形態では、回転ずれを除去した上でオフセット値を算出するように、図4に示す回転ずれ除去後オフセット値算出の処理を行う(S60)。 Here, as shown in FIG. 9 (FIG. 8), since the origin of the mechanical interface coordinate system, that is, the center of rotation of the tip link 36, has moved from the origin Mo0 to the origin Mo1, the solid line position in S50 has the offset deviation in the X and Y directions superimposed on the rotation deviation due to the different center of rotation. Therefore, even if the differences ΔX, ΔY, and ΔR are calculated based on the second coordinate (X2, Y2) and the rotation amount R2 and the first coordinate (X1, Y1) and the rotation amount R1 and reflected in the offset design value, the influence of the rotation deviation remains and the offset value is not correct. Also, as described above, since the cross plate P is arranged with a rotation deviation, the influence of the rotation deviation may be reflected. Therefore, in this embodiment, the process of calculating the offset value after removing the rotation deviation shown in FIG. 4 is performed (S60) so that the offset value is calculated after removing the rotation deviation.

図4の処理では、CPU71は、まず、オフセット設計値と第2座標(X2,Y2)と回転量R2とに基づいて、移動後の原点Mo1を導出する(S61)。ここでは、CPU71は、まず、回転量R2とオフセット設計値とから、回転量R2で回転した状態のXY方向のオフセット値即ち回転量R2の回転ずれを反映したオフセット値を算出する。次に、CPU71は、算出したオフセット値分だけ第2座標(X2,Y2)から離れた位置を、原点Mo1として導出する。なお、この導出方法に限られず、設計上のオフセット値と第2座標(X2,Y2)と回転量R2の少なくともいずれかを用いて、移動後の原点Mo1を導出するものであればよい。In the process of FIG. 4, the CPU 71 first derives the origin Mo1 after movement based on the offset design value, the second coordinate (X2, Y2), and the rotation amount R2 (S61). Here, the CPU 71 first calculates the offset value in the XY direction in the state rotated by the rotation amount R2, that is, the offset value reflecting the rotational deviation of the rotation amount R2, from the rotation amount R2 and the offset design value. Next, the CPU 71 derives a position away from the second coordinate (X2, Y2) by the calculated offset value as the origin Mo1. Note that this derivation method is not limited to this, and any method may be used as long as the origin Mo1 after movement is derived using at least one of the designed offset value, the second coordinate (X2, Y2), and the rotation amount R2.

次に、CPU71は、ツールTの回転ずれを除去する(S62)。ここでは、CPU71は、S61で算出した原点Mo1を中心として、回転量R2と反対方向に回転量R2分だけ第2座標(X2,Y2)を回転させて第2座標(X2,Y2)を修正した第3座標(X3,Y3)を取得する(図10)。これにより、ツールTの回転ずれを除去した制御点の位置が取得される。Next, the CPU 71 removes the rotational deviation of the tool T (S62). Here, the CPU 71 obtains the third coordinate (X3, Y3) by correcting the second coordinate (X2, Y2) by the amount of rotation R2, by rotating the second coordinate (X2, Y2) around the origin Mo1 calculated in S61 by the amount of rotation R2 (FIG. 10). This obtains the position of the control point with the rotational deviation of the tool T removed.

続いて、CPU71は、十字プレートPの回転ずれを除去する(S63)。ここでは、CPU71は、原点Mo1を中心として、S20で取得した回転量R1と反対方向に回転量R1分だけ第1座標(X1,Y1)と第3座標(X3,Y3)とをそれぞれ回転させて補正した第1座標(X1’,Y1’)と第3座標(X3’,Y3’)とを取得する(図11)。これにより、十字プレートPの回転ずれを除去した位置が取得される。Next, the CPU 71 removes the rotational deviation of the cross plate P (S63). Here, the CPU 71 acquires the first coordinate (X1', Y1') and the third coordinate (X3', Y3') corrected by rotating the first coordinate (X1, Y1) and the third coordinate (X3, Y3) by the amount of rotation R1 in the direction opposite to the amount of rotation R1 acquired in S20 around the origin Mo1 (FIG. 11). This acquires the position of the cross plate P with the rotational deviation removed.

こうして回転ずれを除去すると、CPU71は、補正後の第1座標(X1’,Y1’)と第3座標(X3’,Y3’)とに基づいて、X,Y方向のそれぞれのオフセットの差分ΔX(=X1’-X3’),ΔY(=Y1’-Y3’)をオフセットずれとして算出する(S64)。続いて、CPU71は、算出した差分ΔX,ΔYを、オフセット設計値にそれぞれ加えて、X方向,Y方向のオフセット値(Xoff,Yoff)をそれぞれ算出して(S65)、本処理を終了する。After removing the rotational deviation in this way, the CPU 71 calculates the offset deviations ΔX (=X1'-X3') and ΔY (=Y1'-Y3') in the X and Y directions based on the corrected first coordinate (X1', Y1') and third coordinate (X3', Y3') (S64). Next, the CPU 71 adds the calculated differences ΔX and ΔY to the offset design values, respectively, to calculate the offset values (Xoff, Yoff) in the X and Y directions (S65), and ends this process.

そして、CPU71は、S60(S65)で算出したX方向,Y方向のオフセット値(Xoff,Yoff)を、ツールTの種類や型式などの識別情報に対応付けて、HDD73にオフセット値73aとして記憶する(S70)。これにより、ロボット制御装置70は、回転ずれを除去して正しく設定されたオフセット値73aを用いてロボット20にツールTを用いた作業を行わせることができるから、作業精度を向上させることができる。Then, the CPU 71 associates the X-direction and Y-direction offset values (Xoff, Yoff) calculated in S60 (S65) with identification information such as the type and model of the tool T, and stores them in the HDD 73 as offset values 73a (S70). This allows the robot control device 70 to cause the robot 20 to perform work using the tool T using the offset values 73a that have been correctly set by removing the rotational deviation, thereby improving work accuracy.

ここで、本実施形態の構成要素と本開示の構成要素との対応関係を明らかにする。本実施形態のオフセット値設定方法のS20が第1取得ステップに相当し、S30,S40が作動ステップに相当し、S50が第2取得ステップに相当し、回転ずれ除去後オフセット値算出のS61,S62が第3取得ステップに相当し、S64,S65が設定ステップに相当する。また、S63が補正ステップに相当する。また、カメラ24がカメラに相当する。ロボット制御装置70のHDD73が記憶部に相当し、CPU71が制御部に相当し、ロボット制御装置70がロボット制御装置に相当する。Here, the correspondence between the components of this embodiment and the components of this disclosure will be clarified. S20 of the offset value setting method of this embodiment corresponds to the first acquisition step, S30 and S40 correspond to the operation steps, S50 corresponds to the second acquisition step, S61 and S62 of the calculation of the offset value after removing the rotational deviation correspond to the third acquisition step, and S64 and S65 correspond to the setting step. S63 corresponds to the correction step. Furthermore, the camera 24 corresponds to the camera. The HDD 73 of the robot control device 70 corresponds to the memory unit, the CPU 71 corresponds to the control unit, and the robot control device 70 corresponds to the robot control device.

以上説明したロボット20のツールTのオフセット値設定方法では、まず、十字プレートPを画像認識して第1座標(X1,Y1)と回転量R1とを取得する。次に、第1座標(X1,Y1)をツールTの制御点の目標位置として、アーム22を作動させてから先端リンク36の位置および回転量を調整し、制御点の第2座標(X2,Y2)と回転量(回転調整量)R2とを取得する。続いて、第2座標(X2,Y2)と回転量R2とオフセット設計値とから求めた原点Mo1を中心に回転量R2だけ戻す方向に第2座標(X2,Y2)を回転させることで、原点Mo(回転中心)の移動による回転ずれを除去した第3座標(X3,Y3)を取得する。さらに、原点Mo1を中心に第1座標(X1,Y1)と第3座標(X3,Y3)とを回転量R1と反対方向に回転させることで、十字プレートPの回転ずれを除去した第1座標(X1’,Y1’)と第3座標(X3’,Y3’)とに補正する。そして、第1座標(X1’,Y1’)と第3座標(X3’,Y3’)との差分ΔX,ΔYをオフセット設計値に加えてオフセット値を設定する。これにより、ツールTの回転ずれを除去してオフセット値を精度よく設定することができる。また、十字プレートPの回転ずれの影響を除去してオフセット値をより精度よく設定することができる。In the method for setting the offset value of the tool T of the robot 20 described above, first, the cross plate P is image-recognized to obtain the first coordinate (X1, Y1) and the rotation amount R1. Next, the first coordinate (X1, Y1) is set as the target position of the control point of the tool T, and the arm 22 is operated to adjust the position and rotation amount of the tip link 36, and the second coordinate (X2, Y2) and rotation amount (rotation adjustment amount) R2 of the control point are obtained. Next, the second coordinate (X2, Y2) is rotated in the direction of returning by the rotation amount R2 around the origin Mo1 obtained from the second coordinate (X2, Y2), the rotation amount R2, and the offset design value, to obtain the third coordinate (X3, Y3) from which the rotation deviation due to the movement of the origin Mo (center of rotation) is removed. Furthermore, the first coordinates (X1, Y1) and the third coordinates (X3, Y3) are rotated around the origin Mo1 in the direction opposite to the rotation amount R1 to correct the first coordinates (X1', Y1') and the third coordinates (X3', Y3') from which the rotational deviation of the cross plate P has been removed. Then, the offset value is set by adding the differences ΔX and ΔY between the first coordinates (X1', Y1') and the third coordinates (X3', Y3') to the offset design value. This makes it possible to remove the rotational deviation of the tool T and set the offset value with high precision. Also, it is possible to remove the influence of the rotational deviation of the cross plate P and set the offset value with high precision.

また、十字プレートPは、十字線の中心に位置マークMpが形成されると共にツールTの外形の投影形状が回転向きマークMrとして形成されているから、制御点の位置およびツールTの回転向きを調整する作業をより適切に行うことができる。 In addition, the cross plate P has a position mark Mp formed at the center of the cross lines and the projection shape of the outer shape of the tool T formed as a rotation direction mark Mr, so that the position of the control point and the rotation direction of the tool T can be adjusted more appropriately.

また、ロボット20が備えるカメラ24を用いてオフセット値を設定することができるから、ロボット20の構成品以外の測定器具やセンサなどを準備することなくオフセット値の調整を容易に行うことができる。 In addition, since the offset value can be set using the camera 24 equipped on the robot 20, the offset value can be easily adjusted without preparing measuring instruments, sensors, etc. other than the components of the robot 20.

なお、本開示は上述した実施形態に何ら限定されることはなく、本開示の技術的範囲に属する限り種々の態様で実施し得ることはいうまでもない。It goes without saying that the present disclosure is in no way limited to the above-described embodiments, and may be implemented in various forms as long as they fall within the technical scope of the present disclosure.

例えば、上述した実施形態では、図4の回転ずれ除去後オフセット値算出のS63で十字プレートPの回転ずれを除去したが、これに限られず、S63を省略してもよい。例えば、ガイド治具など用いて作業台11に十字プレートPが回転ずれがないように設置されるものでは、S63を省略すればよい。その場合、S64では、第1座標(X1,Y1)と第3座標(X3,Y3)との差分ΔX,ΔYを算出すればよい。For example, in the above-described embodiment, the rotational deviation of the cross plate P is removed in S63 of the calculation of the offset value after removing the rotational deviation in FIG. 4, but this is not limited to the above, and S63 may be omitted. For example, in the case where the cross plate P is installed on the work table 11 using a guide jig or the like so as not to cause a rotational deviation, S63 may be omitted. In that case, in S64, the differences ΔX, ΔY between the first coordinate (X1, Y1) and the third coordinate (X3, Y3) may be calculated.

実施形態では、ロボット20のアーム22に取り付けられたカメラ24を用いたが、これに限られず、ロボット20を含むロボットシステムが備えるカメラを用いればよく、例えばロボット20の上方に吊り下げて設置されるカメラを用いてもよい。また、ロボット20に取り付けられたカメラ24やロボットシステムが備えるカメラとは別のカメラを用いてもよく、オフセット値を設定する際に設置される専用のカメラを用いてもよい。In the embodiment, the camera 24 attached to the arm 22 of the robot 20 is used, but the present invention is not limited to this, and any camera provided in a robot system including the robot 20 may be used, for example, a camera suspended above the robot 20 may be used. Also, a camera other than the camera 24 attached to the robot 20 or the camera provided in the robot system may be used, and a dedicated camera installed when setting the offset value may be used.

実施形態では、円形の位置マークMpとツールTの投影形状を示す回転向きマークMrとが形成された十字プレートPを用いたが、これに限られるものではない。例えば、位置マークMpは、位置合わせが可能なマークであればよく、円形に限られない。回転向きマークMrは、Z軸回りの回転向き合わせが可能なマークであればよく、ツールTの投影形状を示すマークに限られない。また、十字状のパターンが形成された十字プレートPに限られず、位置マークMpと回転向きマークMrとが形成されたプレートであればよい。In the embodiment, a cross plate P is used on which a circular position mark Mp and a rotation direction mark Mr indicating the projected shape of the tool T are formed, but this is not limited to this. For example, the position mark Mp may be any mark that allows for alignment, and is not limited to being circular. The rotation direction mark Mr may be any mark that allows for rotation direction alignment around the Z axis, and is not limited to being a mark indicating the projected shape of the tool T. In addition, the cross plate P is not limited to being formed with a cross-shaped pattern, and may be any plate on which a position mark Mp and a rotation direction mark Mr are formed.

実施形態では、ロボット制御装置70が主体となってオフセット値設定方法を行うものとしたが、これに限られず、ロボット制御装置70とは別にカメラ24の画像を処理する画像処理装置が設けられている場合に、画像処理装置が主体となってオフセット値設定方法を行ってもよい。あるいは、オフセット値を設定する専用の装置が主体となってオフセット値設定方法を行ってもよい。In the embodiment, the offset value setting method is performed mainly by the robot control device 70, but this is not limited thereto. If an image processing device that processes images from the camera 24 is provided separately from the robot control device 70, the image processing device may be the main device that performs the offset value setting method. Alternatively, the offset value setting method may be performed mainly by a device dedicated to setting offset values.

ここで、本開示のオフセット値設定方法およびロボット制御装置は、以下のように構成してもよい。例えば、本開示のオフセット値設定方法において、前記第1取得ステップでは、前記多関節ロボットの作業台に配置された前記プレートを画像認識して、前記第1座標と、前記回転向きマークの回転ずれ量とを取得し、前記第3取得ステップの後に、前記原点位置を中心に前記回転ずれ量を解消する方向に前記第1座標と前記第3座標とをそれぞれ回転させて補正する補正ステップを含み、前記設定ステップでは、前記補正後の前記第1座標と前記第3座標とのX方向とY方向の差分をそれぞれ算出して、前記ツールのオフセット値を設定するものとしてもよい。こうすれば、作業台に配置されたプレートに回転ずれがあった場合でも、その回転ずれの影響を除去してオフセット値をより精度よく設定することができる。Here, the offset value setting method and robot control device of the present disclosure may be configured as follows. For example, in the offset value setting method of the present disclosure, the first acquisition step includes image recognition of the plate placed on the work table of the articulated robot to acquire the first coordinates and the rotational deviation amount of the rotation direction mark, and after the third acquisition step, a correction step is included in which the first coordinates and the third coordinates are rotated around the origin position in a direction that eliminates the rotational deviation amount, and the setting step may include calculating the differences in the X direction and the Y direction between the first coordinates and the third coordinates after the correction, and setting the offset value of the tool. In this way, even if there is a rotational deviation in the plate placed on the work table, the effect of the rotational deviation can be removed and the offset value can be set with higher accuracy.

本開示のオフセット値設定方法において、前記プレートは、十字線の中心に前記位置マークが形成されると共に前記ツールの外形の投影形状が前記回転向きマークとして形成されているものとしてもよい。こうすれば、実際の制御点の位置およびツールの回転向きを、作業者の目視で合わせて調整する際に、調整作業をより適切に行うことができる。In the offset value setting method disclosed herein, the plate may be configured so that the position mark is formed at the center of the crosshairs and the projection shape of the outer shape of the tool is formed as the rotation direction mark. In this way, the adjustment work can be more appropriately performed when the operator visually adjusts the actual control point position and the rotation direction of the tool.

本開示のオフセット値設定方法において、前記ロボットは、前記アームに取り付けられたカメラを備え、前記第1取得ステップでは、前記カメラにより撮像された画像を画像認識するものとしてもよい。こうすれば、ロボットが備えるカメラを用いてオフセット値を設定することができるから、ロボットの構成品以外の測定器具やセンサなどを準備することなくオフセット値の調整を容易に行うことができる。In the offset value setting method disclosed herein, the robot may include a camera attached to the arm, and the first acquisition step may involve image recognition of an image captured by the camera. In this way, the offset value can be set using the camera provided in the robot, and the offset value can be easily adjusted without preparing measuring instruments, sensors, or the like other than the components of the robot.

本開示のロボット制御装置は、上述したいずれかのオフセット値設定方法により設定されたオフセット値を記憶する記憶部と、前記オフセット値に基づいて、前記ツールが取り付けられた前記アームの作動を制御する制御部と、を備えることを要旨とする。本開示のロボット制御装置は、オフセット値設定方法により設定されたオフセット値を記憶しているから、ツールの加工誤差や取付誤差などに拘わらず、精度よく設定されたオフセット値を用いることができる。このため、ロボット制御装置は、アームにツールが取り付けられた多関節ロボットの作業精度を向上させることができる。The robot control device of the present disclosure includes a storage unit that stores an offset value set by any of the offset value setting methods described above, and a control unit that controls the operation of the arm to which the tool is attached based on the offset value. Since the robot control device of the present disclosure stores the offset value set by the offset value setting method, it can use an offset value that is set with high precision regardless of machining errors or installation errors of the tool. Therefore, the robot control device can improve the working precision of an articulated robot having a tool attached to its arm.

本開示は、ロボットの製造産業などに利用可能である。 This disclosure can be used in the robot manufacturing industry, etc.

11 作業台、12 ワーク搬送装置、20 ロボット、22 アーム、24 カメラ、28 表示操作パネル、31 第1リンク、32 第2リンク、33 第3リンク、34 第4リンク、35 第5リンク、36 先端リンク(第6リンク)、41 第1関節、42 第2関節、43 第3関節、44 第4関節、45 第5関節、51~55 モータ、61~65 エンコーダ、70 ロボット制御装置、71 CPU、72 ROM、73 HDD、73a オフセット値、74 RAM、Mp 位置マーク、Mr 回転向きマーク、P 十字プレート、T ツール。 11 work table, 12 work transport device, 20 robot, 22 arm, 24 camera, 28 display operation panel, 31 first link, 32 second link, 33 third link, 34 fourth link, 35 fifth link, 36 tip link (sixth link), 41 first joint, 42 second joint, 43 third joint, 44 fourth joint, 45 fifth joint, 51 to 55 motors, 61 to 65 encoders, 70 robot control device, 71 CPU, 72 ROM, 73 HDD, 73a offset value, 74 RAM, Mp position mark, Mr rotation direction mark, P cross plate, T tool.

Claims (5)

多関節ロボットのアームの先端部に取り付けられ、制御点が前記先端部の原点からXY方向にオフセットされたツールのオフセット値設定方法であって、
前記ツールのXY方向の位置合わせ用の位置マークとZ軸回りの回転向き合わせ用の回転向きマークとを有するプレートを画像認識して、前記位置マークのXY方向の位置を示す第1座標を取得する第1取得ステップと、
前記ツールの設計上のオフセット値を用いて前記第1座標を前記ツールの制御点の目標位置として前記アームを作動させてから、実際の前記制御点の位置および前記ツールの回転向きが前記位置マークおよび前記回転向きマークに合うように前記先端部の位置および回転量を調整する作動ステップと、
該調整後の前記制御点のXY方向の位置を示す第2座標と該調整による前記先端部の回転調整量とを取得する第2取得ステップと、
前記第2座標と前記回転調整量と前記設計上のオフセット値とを用いて前記調整後の前記先端部の原点位置を求め、該原点位置を中心に前記回転調整量だけ戻す方向に前記第2座標を回転させた位置を示す第3座標を取得する第3取得ステップと、
前記第1座標と前記第3座標とのX方向とY方向の差分をそれぞれ算出し、該差分を前記設計上のオフセット値に加えて前記ツールのオフセット値を設定する設定ステップと、
を含むオフセット値設定方法。
1. A method for setting offset values for a tool attached to a tip of an arm of an articulated robot, the control point of the tool being offset in X and Y directions from an origin of the tip, the method comprising the steps of:
a first acquisition step of acquiring first coordinates indicating the positions of the position marks in the XY directions by performing image recognition on a plate having position marks for aligning the tool in the XY directions and rotation orientation marks for aligning the tool around the Z axis;
an operating step of operating the arm by setting the first coordinates as a target position of a control point of the tool using an offset value in design of the tool, and then adjusting the position and rotation amount of the tip portion so that an actual position of the control point and a rotational orientation of the tool match the position mark and the rotational orientation mark;
a second acquisition step of acquiring second coordinates indicating the position of the control point in the XY direction after the adjustment and an amount of rotation adjustment of the tip portion due to the adjustment;
a third acquisition step of determining an origin position of the tip portion after the adjustment using the second coordinate, the rotation adjustment amount, and the design offset value, and acquiring a third coordinate indicating a position obtained by rotating the second coordinate in a direction returning the tip portion by the rotation adjustment amount around the origin position;
a setting step of calculating differences in an X direction and a Y direction between the first coordinate and the third coordinate, respectively, and adding the differences to the designed offset value to set an offset value of the tool;
A method for setting an offset value, including:
請求項1に記載のオフセット値設定方法であって、
前記第1取得ステップでは、前記多関節ロボットの作業台に配置された前記プレートを画像認識して、前記第1座標と、前記回転向きマークの回転ずれ量とを取得し、
前記第3取得ステップの後に、前記原点位置を中心に前記回転ずれ量を解消する方向に前記第1座標と前記第3座標とをそれぞれ回転させて補正する補正ステップを含み、
前記設定ステップでは、前記補正後の前記第1座標と前記第3座標とのX方向とY方向の差分をそれぞれ算出して、前記ツールのオフセット値を設定する
オフセット値設定方法。
2. The offset value setting method according to claim 1,
In the first acquisition step, the plate placed on a workbench of the articulated robot is image-recognized to acquire the first coordinates and a rotational deviation amount of the rotation direction mark;
a correction step of correcting the first coordinates and the third coordinates by rotating them around the origin position in a direction that eliminates the amount of rotational deviation, after the third acquisition step;
In the setting step, differences in an X direction and a Y direction between the first coordinate and the third coordinate after the correction are calculated, and an offset value of the tool is set.
請求項1または2に記載のオフセット値設定方法であって、
前記プレートは、十字線の中心に前記位置マークが形成されると共に前記ツールの外形の投影形状が前記回転向きマークとして形成されている
オフセット値設定方法。
3. The offset value setting method according to claim 1, further comprising the steps of:
The plate has the position mark formed at the center of the crosshairs and a projection shape of the outer shape of the tool formed as the rotation direction mark.
請求項1ないし3のいずれか1項に記載のオフセット値設定方法であって、
前記ロボットは、前記アームに取り付けられたカメラを備え、
前記第1取得ステップでは、前記カメラにより撮像された画像を画像認識する
オフセット値設定方法。
4. The offset value setting method according to claim 1, further comprising the steps of:
the robot includes a camera attached to the arm;
In the first acquisition step, an image captured by the camera is recognized.
請求項1ないし4のいずれか1項に記載のオフセット値設定方法により設定されたオフセット値を記憶する記憶部と、
前記オフセット値に基づいて、前記ツールが取り付けられた前記アームの作動を制御する制御部と、
を備えるロボット制御装置。
A storage unit that stores the offset value set by the offset value setting method according to any one of claims 1 to 4;
a control unit that controls the operation of the arm to which the tool is attached based on the offset value;
A robot control device comprising:
JP2022558662A 2020-10-28 2020-10-28 Offset value setting method and robot control device Active JP7510514B2 (en)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2020/040371 WO2022091241A1 (en) 2020-10-28 2020-10-28 Offset value setting method and robot control device

Publications (2)

Publication Number Publication Date
JPWO2022091241A1 JPWO2022091241A1 (en) 2022-05-05
JP7510514B2 true JP7510514B2 (en) 2024-07-03

Family

ID=81382188

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2022558662A Active JP7510514B2 (en) 2020-10-28 2020-10-28 Offset value setting method and robot control device

Country Status (2)

Country Link
JP (1) JP7510514B2 (en)
WO (1) WO2022091241A1 (en)

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2021210054A1 (en) 2020-04-14 2021-10-21 株式会社Fuji Cable clamp and cable assembly method

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3394322B2 (en) * 1994-05-19 2003-04-07 ファナック株式会社 Coordinate system setting method using visual sensor
JP6564428B2 (en) * 2017-08-03 2019-08-21 ファナック株式会社 Calibration system and calibration method

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2021210054A1 (en) 2020-04-14 2021-10-21 株式会社Fuji Cable clamp and cable assembly method

Also Published As

Publication number Publication date
JPWO2022091241A1 (en) 2022-05-05
WO2022091241A1 (en) 2022-05-05

Similar Documents

Publication Publication Date Title
JP7153085B2 (en) ROBOT CALIBRATION SYSTEM AND ROBOT CALIBRATION METHOD
EP2613912B1 (en) System and method for tool testing and alignment
JP4271232B2 (en) Apparatus, method, program, and recording medium for executing offline programming of robot
JP5321532B2 (en) Robot calibration apparatus and calibration method
JP4829359B2 (en) Calculation method of probe mounting position of on-machine measuring device
EP3542969B1 (en) Working-position correcting method and working robot
CN112720458B (en) System and method for online real-time correction of robot tool coordinate system
US11173608B2 (en) Work robot and work position correction method
KR102091917B1 (en) Gear mechanism assembly and assembly method
JP2012101306A (en) Apparatus and method for calibration of robot
EP1886771B1 (en) Rotation center point calculating method, rotation axis calculating method, program creating method, operation method, and robot apparatus
JP7510514B2 (en) Offset value setting method and robot control device
JP7145332B2 (en) Robot control system and robot control method
JP7105223B2 (en) robot system
CN114571199A (en) Screw locking machine and screw positioning method
JP7684651B2 (en) Positioning method and positioning device
CN116803627A (en) Method and device for detecting object with correction function
JP2017074637A (en) Tool center point estimation method and tool center point estimation device
JP2024102425A (en) Correction method, correction system and program
JPH06206186A (en) Calibration of handling precision of horizontal articulated type robot equipped with visual sensor
JP2023142080A (en) Method and device for detecting target
CN115996821A (en) arm robot
JP2006334683A (en) Polar coordinate machining system

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20230907

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20240604

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20240621

R150 Certificate of patent or registration of utility model

Ref document number: 7510514

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150