WO2022091241A1 - オフセット値設定方法およびロボット制御装置 - Google Patents

オフセット値設定方法およびロボット制御装置 Download PDF

Info

Publication number
WO2022091241A1
WO2022091241A1 PCT/JP2020/040371 JP2020040371W WO2022091241A1 WO 2022091241 A1 WO2022091241 A1 WO 2022091241A1 JP 2020040371 W JP2020040371 W JP 2020040371W WO 2022091241 A1 WO2022091241 A1 WO 2022091241A1
Authority
WO
WIPO (PCT)
Prior art keywords
offset value
rotation
tool
coordinate
mark
Prior art date
Application number
PCT/JP2020/040371
Other languages
English (en)
French (fr)
Inventor
将吾 東
Original Assignee
株式会社Fuji
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 株式会社Fuji filed Critical 株式会社Fuji
Priority to JP2022558662A priority Critical patent/JPWO2022091241A1/ja
Priority to PCT/JP2020/040371 priority patent/WO2022091241A1/ja
Publication of WO2022091241A1 publication Critical patent/WO2022091241A1/ja

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00—Controls for manipulators
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/10—Programme-controlled manipulators characterised by positioning means for manipulator elements

Definitions

  • This specification discloses an offset value setting method and a robot control device.
  • Patent Document 1 uses a camera that captures a mark on a target fixed in the space of the robot coordinate system, and the shape of the mark captured by the camera when the robot is moved to a plurality of operating positions. Described are those in which a plurality of operation positions and robot postures whose features satisfy a predetermined condition are memorized and calibrated.
  • the main purpose of this disclosure is to set the offset value of the tool attached by offsetting the control point from the origin of the tip of the arm with higher accuracy.
  • the offset value setting method of the present disclosure is described. It is an offset value setting method of a tool attached to the tip of an arm of an articulated robot and the control point is offset in the XY direction from the origin of the tip. Image recognition of a plate having a position mark for alignment in the XY direction of the tool and a rotation orientation mark for alignment around the Z axis is performed, and the first coordinate indicating the position of the position mark in the XY direction is acquired. The first acquisition step to do and After operating the arm with the first coordinate as the target position of the control point of the tool using the offset value in the design of the tool, the actual position of the control point and the rotation direction of the tool are the position marks.
  • the second acquisition step of acquiring the second coordinate indicating the position of the control point in the XY direction after the adjustment and the rotation adjustment amount of the tip portion by the adjustment, and the second acquisition step.
  • the third acquisition step to acquire the third coordinate indicating the position where the coordinates are rotated, and A setting step of calculating the difference between the first coordinate and the third coordinate in the X direction and the Y direction, adding the difference to the offset value in the design, and setting the offset value of the tool.
  • the gist is to include.
  • the actual position of the control point and the rotation direction of the tool are the positions. Adjust the position and amount of rotation of the tip so that it matches the mark and the rotation direction mark.
  • the origin position of the adjusted tip is obtained using the second coordinate of the adjusted control point, the rotation adjustment amount of the tip, and the design offset value, and the direction is to return the rotation adjustment amount around the origin position.
  • the third coordinate obtained by rotating the second coordinate is acquired. 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.
  • the offset value can be set accurately by removing the influence of the tool processing error, mounting error, and rotation deviation.
  • the block diagram which shows the outline of the structure of the robot 20.
  • Explanatory drawing which shows an example of the offset value setting method.
  • Explanatory drawing which shows an example of offset value calculation after rotation deviation removal.
  • Explanatory drawing which shows an example of the state when setting an offset value.
  • Explanatory drawing which shows an example of the upper surface of a cross plate P.
  • An image diagram showing an example of how to set an offset value An image diagram showing an example of how to set an offset value.
  • An image diagram showing an example of how to set an offset value An image diagram showing an example of how to set an offset value.
  • An image diagram showing an example of how to set an offset value. An image diagram showing an example of how to set an offset value.
  • FIG. 1 is a configuration diagram showing an outline of the configuration of the robot 20.
  • FIG. 2 is an explanatory diagram showing an electrical connection relationship between the robot 20 and the robot control device 70.
  • the robot 20 is controlled by the robot control device 70 to perform a predetermined work on a work (work object) transported by the work transfer device 12 (see FIG. 2).
  • the predetermined work may include a pick-up work for picking up the work, a place work for placing the work at a predetermined position, an assembling work for assembling the work at a predetermined position, and the like.
  • the robot 20 includes, for example, a 5-axis vertical articulated arm (hereinafter referred to as an 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 rotatably or swivelly connect each link.
  • motors servo motors
  • encoders rotary encoders
  • the sixth link 36 is referred to as a tip link (tip portion) 36.
  • a work tool (hereinafter referred to as tool T) as an end effector can be attached to and detached from the tip link 36 of the arm 22.
  • the tool T include an electromagnetic chuck, a mechanical chuck, a suction nozzle, and the like, and are appropriately selected according to the shape and material of the work to be worked.
  • a camera 24 is attached to the fifth link 35 of the arm 22. The camera 24 images the work, for example, in order to recognize the position and orientation of the work.
  • the arm 22 of the present embodiment configured in this way has the X-axis in the front (front) and rear (back) directions when the robot 20 is viewed from the front, and the extension of the rotation axis of the first joint 41 in the vertical direction of the robot 20.
  • Direction) is the Z-axis
  • movement in the three-dimensional space is possible with the X-axis and the direction orthogonal to the Z-axis as the Y-axis.
  • the three-dimensional space defines a world coordinate system whose origin is a predetermined position of the workbench 11 (see FIG. 5) of the robot 20.
  • a mechanical interface coordinate system whose origin is the center position of the tool mounting surface of the tip link 36, that is, the mounting reference position of the tool T is defined.
  • the origin of this mechanical interface coordinate system is defined as the origin Mo.
  • the robot control device 70 is configured as a microprocessor centered on a CPU 71, and includes a ROM 72, an HDD 73, a RAM 74, an input / output interface (not shown), a communication interface (not shown), and the like, in addition to the CPU 71.
  • the HDD 73 stores the operation program of the robot 20 and the offset value 73a described later of the tool T. Detection signals from encoders 61 to 65, image signals from the camera 24, and operation signals from the display operation panel 28 are input to the robot control device 70.
  • the robot control device 70 outputs a control signal to the motors 51 to 55, the work transfer device 12, and the like, a drive signal to the camera 24, and a display signal to the display operation panel 28.
  • the display operation panel 28 is configured as a touch panel type liquid crystal display that can be touch-operated by an operator.
  • the display operation panel 28 displays various information such as the operating status of the robot 20, inputs operations such as various settings and instructions, and manually operates the arm 22 (position adjustment) by the operator.
  • the display device and the input device may be provided separately.
  • the robot control device 70 drives and controls the motors 51 to 55 of the robot 20 to move the tool T mounted on the arm 22 toward the work, and the tool T is used to perform a predetermined work on the work. I do.
  • the robot control device 70 processes the image captured by the camera 24 to acquire the target position of the control point which is the work center (control center) of the tool T and the target angle (attitude) of the tool T, and mechanically obtains the target angle (attitude) of the tool T. Convert to the target position and target angle of the interface coordinate system (origin Mo). Further, when the control point of the tool T is attached at an offset from the origin Mo, it is converted into a target position and a target angle by reflecting the offset value 73a.
  • the robot control device 70 sets the target position and the target angle of each joint of the arm 22 by using well-known parameters and the like for the converted target position and target angle. Then, the robot control device 70 drives and controls the corresponding motors 51 to 55 so that the position and angle of each joint match the target position and target angle, and the tool is used to perform work on the work. Drive control of T.
  • 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 is the content of S60 in FIG.
  • FIG. 5 is an explanatory diagram showing an example of a state when an offset value is set
  • FIG. 6 is an explanatory diagram showing an example of an upper surface of the cross plate P.
  • 7 to 11 are image views on an XY plane showing an example of a method of setting an offset value, and for convenience of explanation, offset deviation and rotation deviation are largely shown.
  • the offset value setting method of the present embodiment is performed by an operator or the like by installing a cross plate P at a predetermined position on the workbench 11 of the robot 20 as shown in FIG.
  • the cross plate P has a cross-shaped pattern, a position mark Mp for alignment of the tool T, and a rotation orientation mark Mr for rotation orientation alignment formed on the upper surface thereof.
  • the position mark Mp is a circular mark formed at the center of the cross, that is, the center of the plate.
  • the rotation direction mark Mr is a mark indicating the projected shape of the tool T. For example, the projected shapes of the pair of mechanical chucks are formed at symmetrical positions about the position mark Mp.
  • the operator causes the robot control device 70 to set an offset value while the cross plate P is installed on the workbench 11 and the display operation panel 28 is used to input necessary information or manually operate the arm 22.
  • the operator first registers the offset value in the design of the tool T (S10).
  • the design offset value (hereinafter referred to as the offset design value) is determined based on the design dimensions of the tool T as the distances 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 by the operator, for example, using the display operation panel 28.
  • 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 work is offset by Xoff0 in the X direction from the origin Mo. Not only the offset values in the X direction and the Y direction but also the offset values in the rotation direction around the Z axis may be registered, but if there is no offset design value in the rotation direction, the value 0 is registered.
  • the CPU 71 moves the camera 24 so that the center of the camera 24 is aligned with the center of the cross plate P (position mark Mp), and the first coordinates (X1, Y1) indicating the position (center position) of the position mark Mp at that time. And the rotation amount R1 around the Z axis of the rotation direction mark Mr (S20, FIG. 7).
  • the CPU 71 processes the image captured by the camera 24 to recognize the position mark Mp and the rotation direction mark Mr, and acquires the position and the rotation direction.
  • the rotation amount R1 of S20 indicates the rotation deviation amount around the Z axis of the cross plate P on the workbench 11, and if the cross plate P is correctly installed without the rotation deviation, the value becomes 0. In FIG.
  • the first coordinates (X1, Y1) acquired in S20 are referred to as “S20 (X1, Y1)”, and the same applies to FIGS. 8 to 11. Further, 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 as the origin Mo0.
  • the CPU 71 sets the target position and the target rotation amount (target angle) of the control point of the tool T as the first coordinates (X1, Y1) and the rotation amount R1, and operates the arm 22 so that the tool T moves.
  • Control S30, FIG. 7
  • the actual offset value may differ from the offset design value, and offset deviation in the X direction and Y direction or rotation deviation around the Z axis may occur.
  • the position of the actual control point of the tool T moved in S30 does not match the first coordinate (X1, Y1) or the rotation amount R1, and the position shift or the rotation shift occurs.
  • 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 the rotation direction mark Mr of the cross plate P. (S40, FIG. 8).
  • the operator visually adjusts the control point using the display operation panel 28 so that the position and the rotation direction of the control point of the tool T match the position mark Mp and the rotation direction mark Mr. Operate the robot 20.
  • the position where the rotation deviation is eliminated by the rotation adjustment is shown by a dotted line
  • the position where the offset deviation is eliminated by the position adjustment is shown by a solid line.
  • the position where the origin Mo of the mechanical interface coordinate system moves from the origin Mo0 as the position is adjusted in the XY direction is defined as the origin Mo1.
  • the CPU 71 acquires the second coordinates (X2, Y2) indicating the position of the control point after adjustment (after movement) and the rotation amount (rotation adjustment amount) R2 (S50, FIG. 8, FIG. 9).
  • the CPU 71 since the CPU 71 erroneously recognizes that the control point is in "S20 (X1, Y1)" in S30, it recognizes that the adjustment has been made for "S20 (X1, Y1)".
  • the position where the rotation is adjusted with respect to “S20 (X1, Y1)” (the same position as S40) is shown by a dotted line, and the position where the position is adjusted in the XY direction is shown by a solid line.
  • the position coordinates of "S50 (X2, Y2)" are acquired as the second coordinates (X2, Y2).
  • the solid line position of S50 is in the X direction.
  • the offset deviation in the Y direction also overlaps with the rotation deviation due to the difference in the center of rotation. Therefore, the differences ⁇ X, ⁇ Y, and ⁇ R are calculated based on the second coordinates (X2, Y2) and the rotation amount R2, and the first coordinates (X1, Y1) and the rotation amount R1 and reflected in the offset design value. Even so, the effect of the rotation shift remains and the correct offset value is not obtained.
  • the process of calculating the offset value after removing the rotation deviation shown in FIG. 4 is performed so as to calculate the offset value after removing the rotation deviation (S60).
  • the CPU 71 first derives the origin Mo1 after movement based on the offset design value, the second coordinates (X2, Y2), and the rotation amount R2 (S61).
  • the CPU 71 first calculates an offset value in the XY direction in a state of being rotated by the rotation amount R2, that is, an offset value reflecting the rotation deviation of the rotation amount R2, from the rotation amount R2 and the offset design value.
  • the CPU 71 derives a position separated from the second coordinates (X2, Y2) by the calculated offset value as the origin Mo1.
  • the derivation method is not limited to this method, and any method may be used as long as the origin Mo1 after movement is derived by using at least one of the design offset value, the second coordinates (X2, Y2), and the rotation amount R2.
  • the CPU 71 removes the rotation deviation of the tool T (S62).
  • the CPU 71 corrects the second coordinates (X2, Y2) by rotating the second coordinates (X2, Y2) by the rotation amount R2 in the direction opposite to the rotation amount R2 with the origin Mo1 calculated in S61 as the center.
  • the third coordinate (X3, Y3) is acquired (FIG. 10). As a result, the position of the control point from which the rotation deviation of the tool T is removed is acquired.
  • the CPU 71 removes the rotational deviation of the cross plate P (S63).
  • the CPU 71 rotates the first coordinate (X1, Y1) and the third coordinate (X3, Y3) by the rotation amount R1 in the direction opposite to the rotation amount R1 acquired in S20 with the origin Mo1 as the center.
  • the first coordinate (X1', Y1') corrected by the above and the third coordinate (X3', Y3') are acquired (FIG. 11). As a result, the position where the rotation deviation of the cross plate P is removed is acquired.
  • the CPU 71 stores the offset values (Xoff, Yoff) in the X and Y directions calculated in S60 (S65) in the HDD 73 as the offset values 73a in association with the identification information such as the type and model of the tool T. (S70).
  • the robot control device 70 can make the robot 20 perform the work using the tool T by removing the rotation deviation and using the correctly set offset value 73a, so that the work accuracy can be improved. ..
  • S20 of the offset value setting method of the present embodiment corresponds to the first acquisition step
  • S30 and S40 correspond to the operation step
  • S50 corresponds to the second acquisition step
  • S61 and S62 for calculating the offset value after removing the rotation deviation.
  • S64 and S65 correspond to the setting step.
  • S63 corresponds to the correction step.
  • the camera 24 corresponds to the camera.
  • the HDD 73 of the robot control device 70 corresponds to the storage unit
  • the CPU 71 corresponds to the control unit
  • the robot control device 70 corresponds to the robot control device.
  • the cross plate P is image-recognized and the first coordinates (X1, Y1) and the rotation amount R1 are acquired.
  • the first coordinates (X1, Y1) as the target position of the control point of the tool T
  • the position and rotation amount of the tip link 36 are adjusted after the arm 22 is operated, and the second coordinates (X2, Y1) of the control point are adjusted.
  • Y2) and the rotation amount (rotation adjustment amount) R2 are acquired.
  • the origin is rotated by rotating the second coordinate (X2, Y2) in the direction of returning the rotation amount R2 around the origin Mo1 obtained from the second coordinates (X2, Y2), the rotation amount R2, and the offset design value.
  • the third coordinates (X3, Y3) from which the rotation deviation due to the movement of Mo (rotation center) is removed are acquired. Further, by rotating the first coordinate (X1, Y1) and the third coordinate (X3, Y3) around the origin Mo1 in the direction opposite to the rotation amount R1, the first coordinate that eliminates the rotation deviation of the cross plate P is removed. It is corrected to (X1', Y1') and the third coordinate (X3', Y3').
  • the difference ⁇ X, ⁇ Y between the first coordinate (X1', Y1') and the third coordinate (X3', Y3') is added to the offset design value to set the offset value.
  • the rotation deviation of the tool T can be removed and the offset value can be set accurately.
  • the offset value can be set more accurately by removing the influence of the rotation deviation of the cross plate P.
  • the position mark Mp is formed at the center of the cross line and the projected shape of the outer shape of the tool T is formed as the rotation direction mark Mr, the position of the control point and the rotation direction of the tool T can be determined. The work of adjustment can be performed more appropriately.
  • the offset value can be set by using the camera 24 included in the robot 20, the offset value can be easily adjusted without preparing measuring tools or sensors other than the components of the robot 20.
  • the rotation deviation of the cross plate P is removed in S63 of the offset value calculation after removing the rotation deviation in FIG. 4, but the present invention is not limited to this, and S63 may be omitted.
  • S63 may be omitted.
  • S64 the difference ⁇ X, ⁇ Y between the first coordinate (X1, Y1) and the third coordinate (X3, Y3) may be calculated.
  • the camera 24 attached to the arm 22 of the robot 20 is used, but the present invention is not limited to this, and a camera provided in the robot system including the robot 20 may be used, for example, the camera is suspended above the robot 20 and installed. You may use a camera. Further, a camera different from the camera 24 attached to the robot 20 or the camera provided in the robot system may be used, or a dedicated camera installed when setting the offset value may be used.
  • a cross plate P in which a circular position mark Mp and a rotation direction mark Mr indicating the projection shape of the tool T are formed is used, but the present invention is not limited to this.
  • the position mark Mp may be any mark that can be aligned and is not limited to a circular shape.
  • the rotation direction mark Mr may be any mark as long as it can be rotated and oriented around the Z axis, and is not limited to the mark indicating the projected shape of the tool T.
  • the plate is not limited to the cross plate P on which the cross-shaped pattern is formed, and may be any plate on which the position mark Mp and the rotation direction mark Mr are formed.
  • the robot control device 70 plays a central role in performing the offset value setting method, but the present invention is not limited to this, and an image processing device for processing the image of the camera 24 is provided separately from the robot control device 70. If this is the case, the image processing device may take the lead in performing the offset value setting method. Alternatively, the offset value setting method may be performed mainly by a dedicated device for setting the offset value.
  • the offset value setting method and the robot control device of the present disclosure may be configured as follows.
  • the first acquisition step the plate arranged on the work table of the articulated robot is image-recognized, and the rotation deviation between the first coordinates and the rotation direction mark.
  • a correction step is included in which the amount is acquired, and after the third acquisition step, the first coordinate and the third coordinate are rotated and corrected in a direction for eliminating the rotation deviation amount around the origin position.
  • the difference between the corrected first coordinate and the third coordinate in the X direction and the Y direction may be calculated and the offset value of the tool may be set. By doing so, even if the plate arranged on the workbench has a rotation deviation, the influence of the rotation deviation can be removed and the offset value can be set more accurately.
  • the plate may have the position mark formed at the center of the crosshairs and the projected shape of the outer shape of the tool formed as the rotation direction mark. In this way, the adjustment work can be performed more appropriately when the actual position of the control point and the rotation direction of the tool are adjusted visually by the operator.
  • the robot may include a camera attached to the arm, and may recognize an image captured by the camera in the first acquisition step.
  • the offset value can be set by using the camera provided in the robot, so that the offset value can be easily adjusted without preparing measuring tools or sensors other than the components of the robot.
  • the robot control device of the present disclosure controls the operation of the storage unit that stores the offset value set by any of the offset value setting methods described above, and the arm to which the tool is attached based on the offset value.
  • the gist is to have a control unit. Since the robot control device of the present disclosure stores the offset value set by the offset value setting method, the offset value set with high accuracy can be used regardless of the processing error and the mounting error of the tool. Therefore, the robot control device can improve the work accuracy of the articulated robot in which the tool is attached to the arm.
  • This disclosure can be used in the robot manufacturing industry and the like.

Abstract

アームの先端部に取り付けられるツールのオフセット値設定方法は、位置マークと回転向きマークとを有するプレートを画像認識して位置マークの第１座標を取得するステップと、設計上のオフセット値を用いて第１座標をツールの制御点の目標位置としてアームを作動させてから、実際の制御点の位置および回転向きが位置マークおよび回転向きマークに合うように先端部の位置および回転量を調整するステップと、調整後の制御点の第２座標と先端部の回転調整量と設計上のオフセット値を用いて調整後の先端部の原点位置を求め、原点位置を中心に回転調整量だけ戻す方向に第２座標を回転させた第３座標を取得するステップと、第１座標と第３座標とのＸＹ方向の差分をそれぞれ算出し、差分を設計上のオフセット値に加えてツールのオフセット値を設定するステップと、を含む。

Description

オフセット値設定方法およびロボット制御装置
　本明細書は、オフセット値設定方法およびロボット制御装置を開示する。
　従来、アームの先端にツールが取り付けられる多関節型のロボットにおいて、アームの先端を所望の位置に精度よく位置決めするために、ロボットの各機構のキャリブレーションを行うものが知られている。例えば、特許文献１には、ロボット座標系の空間内に固定されたターゲット上のマークを撮像するカメラを用い、ロボットを複数の動作位置に移動させた際にカメラで撮像されたマークの形状の特徴が所定の条件を満たす動作位置およびロボット姿勢を複数記憶してキャリブレーションを行うものが記載されている。
特開２００８－１２６０４号公報
　ここで、上述したツールとして、アームの先端部の原点からオフセットした位置に、制御点を有するものがある。そのようなツールに加工誤差や取付誤差がある場合、その誤差に、先端部の原点を回転中心とする回転ずれによる誤差が重なるため、オフセット値を正しく求めて設定することが困難となり、ロボットの作業精度が低下するおそれがある。
　本開示は、アームの先端部の原点から制御点がオフセットして取り付けられるツールのオフセット値をより精度よく設定することを主目的とする。
　本開示は、上述の主目的を達成するために以下の手段を採った。
　本開示のオフセット値設定方法は、
　多関節ロボットのアームの先端部に取り付けられ、制御点が前記先端部の原点からＸＹ方向にオフセットされたツールのオフセット値設定方法であって、
　前記ツールのＸＹ方向の位置合わせ用の位置マークとＺ軸回りの回転向き合わせ用の回転向きマークとを有するプレートを画像認識して、前記位置マークのＸＹ方向の位置を示す第１座標を取得する第１取得ステップと、
　前記ツールの設計上のオフセット値を用いて前記第１座標を前記ツールの制御点の目標位置として前記アームを作動させてから、実際の前記制御点の位置および前記ツールの回転向きが前記位置マークおよび前記回転向きマークに合うように前記先端部の位置および回転量を調整する作動ステップと、
　該調整後の前記制御点のＸＹ方向の位置を示す第２座標と該調整による前記先端部の回転調整量とを取得する第２取得ステップと、
　前記第２座標と前記回転調整量と前記設計上のオフセット値とを用いて前記調整後の前記先端部の原点位置を求め、該原点位置を中心に前記回転調整量だけ戻す方向に前記第２座標を回転させた位置を示す第３座標を取得する第３取得ステップと、
　前記第１座標と前記第３座標とのＸ方向とＹ方向の差分をそれぞれ算出し、該差分を前記設計上のオフセット値に加えて前記ツールのオフセット値を設定する設定ステップと、
　を含むことを要旨とする。
　本開示のオフセット値設定方法では、プレートを画像認識して取得した位置マークの第１座標を制御点の目標位置としてアームを作動させてから、実際の制御点の位置およびツールの回転向きが位置マークおよび回転向きマークに合うように先端部の位置および回転量を調整する。また、調整後の制御点の第２座標と先端部の回転調整量と設計上のオフセット値とを用いて調整後の先端部の原点位置を求め、原点位置を中心に回転調整量だけ戻す方向に第２座標を回転させた第３座標を取得する。そして、第１座標と第３座標とのＸ方向とＹ方向の差分をそれぞれ算出し、その差分を設計上のオフセット値に加えてツールのオフセット値を設定する。これにより、ツールの制御点が先端部の原点からＸＹ方向にオフセットされるものでも、ツールの加工誤差や取付誤差、回転ずれの影響を除去してオフセット値を精度よく設定することができる。
ロボット２０の構成の概略を示す構成図。 ロボット２０とロボット制御装置７０の電気的な接続関係を示す説明図。 オフセット値設定方法の一例を示す説明図。 回転ずれ除去後オフセット値算出の一例を示す説明図。 オフセット値を設定する際の様子の一例を示す説明図。 十字プレートＰの上面の一例を示す説明図。 オフセット値の設定方法の一例を示すイメージ図。 オフセット値の設定方法の一例を示すイメージ図。 オフセット値の設定方法の一例を示すイメージ図。 オフセット値の設定方法の一例を示すイメージ図。 オフセット値の設定方法の一例を示すイメージ図。
　次に、本開示の実施の形態を図面を参照しながら説明する。図１は、ロボット２０の構成の概略を示す構成図である。図２は、ロボット２０とロボット制御装置７０の電気的な接続関係を示す説明図である。
　ロボット２０は、ロボット制御装置７０による制御を受けて、ワーク搬送装置１２（図２参照）により搬送されるワーク（作業対象物）に対して所定の作業を行うものである。なお、所定の作業としては、ワークをピックアップするピックアップ作業や、ワークを所定位置にプレースするプレース作業、ワークを所定位置に組み付ける組み付け作業などを挙げることができる。
　ロボット２０は、図１に示すように、例えば５軸の垂直多関節アーム（以下、アームという）２２を備える。アーム２２は、６つのリンク（第１～第６リンク３１～３６）と、各リンクを回転または旋回可能に連結する５つの関節（第１～第５関節４１～４５）とを有する。各関節（第１～第５関節４１～４５）には、対応する関節を駆動するモータ（サーボモータ）５１～５５と、対応するモータの回転位置を検出するエンコーダ（ロータリエンコーダ）６１～６５とが設けられている。なお、第６リンク３６を先端リンク（先端部）３６という。
　アーム２２の先端リンク３６には、エンドエフェクタとしての作業ツール（以下、ツールＴ）が着脱可能となっている。ツールＴとしては、電磁チャックやメカニカルチャック、吸着ノズルなどを挙げることができ、作業対象のワークの形状や素材に合わせて適宜選択される。また、アーム２２の第５リンク３５には、カメラ２４が取り付けられている。カメラ２４は、例えばワークの位置および姿勢を認識するために当該ワークを撮像する。
　こうして構成された本実施形態のアーム２２は、ロボット２０を正面から見て前（手前）後（奥）の方向をＸ軸とし、ロボット２０の上下方向（第１関節４１の回転軸の延在方向）をＺ軸とし、Ｘ軸およびＺ軸に直交する方向をＹ軸とする三次元空間内の移動が可能である。なお、三次元空間には、ロボット２０の作業台１１（図５参照）の所定位置などを原点とするワールド座標系が規定されている。また、先端リンク３６のツール取付面の中心位置即ちツールＴの取付基準位置を原点とするメカニカルインタフェース座標系が規定されている。このメカニカルインタフェース座標系の原点を、原点Ｍｏとする。
　ロボット制御装置７０は、図２に示すように、ＣＰＵ７１を中心としたマイクロプロセッサとして構成され、ＣＰＵ７１の他に、ＲＯＭ７２やＨＤＤ７３、ＲＡＭ７４、図示しない入出力インタフェース、図示しない通信インタフェースなどを備える。なお、ＨＤＤ７３は、ロボット２０の動作プログラムやツールＴの後述するオフセット値７３ａなどを記憶している。ロボット制御装置７０には、エンコーダ６１～６５などからの検知信号やカメラ２４からの画像信号、表示操作パネル２８からの操作信号が入力される。また、ロボット制御装置７０からは、モータ５１～５５やワーク搬送装置１２などへの制御信号やカメラ２４への駆動信号、表示操作パネル２８への表示信号が出力される。表示操作パネル２８は、作業者がタッチ操作可能なタッチパネル式の液晶ディスプレイとして構成されている。この表示操作パネル２８では、ロボット２０の作動状況などの各種情報を表示したり、各種設定や各種指示などの入力操作や作業者によるアーム２２の手動操作（位置調整）を受け付けたりする。なお、表示装置と入力装置とが別々に設けられていてもよい。
　このロボット制御装置７０は、ロボット２０の各モータ５１～５５を駆動制御することにより、アーム２２に装着されたツールＴをワークに向けて移動させ、ツールＴを用いてワークに対して所定の作業を行う。例えば、ロボット制御装置７０は、カメラ２４で撮像された画像を処理して、ツールＴの作業中心（制御中心）である制御点の目標位置およびツールＴの目標角度（姿勢）を取得し、メカニカルインタフェース座標系（原点Ｍｏ）の目標位置および目標角度に変換する。また、ツールＴの制御点が、原点Ｍｏからオフセットして取り付けられるものである場合、そのオフセット値７３ａを反映して目標位置および目標角度に変換する。次に、ロボット制御装置７０は、変換した目標位置および目標角度を周知のパラメータ等を用いてアーム２２の各関節の目標位置および目標角度をそれぞれ設定する。そして、ロボット制御装置７０は、各関節の位置および角度が、それぞれの目標位置および目標角度に一致するように、対応するモータ５１～５５を駆動制御すると共にワークに対して作業が行われるようツールＴを駆動制御する。
　次に、こうして構成されたロボット２０において、所定の十字プレート（治具プレート）Ｐを用いてツールＴのオフセット値を設定するオフセット値設定方法を説明する。図３は、オフセット値設定方法の一例を示す説明図である。図４は、回転ずれ除去後オフセット値算出の一例を示す説明図であり、図３のＳ６０の内容である。また、図５は、オフセット値を設定する際の様子の一例を示す説明図であり、図６は、十字プレートＰの上面の一例を示す説明図である。図７～図１１は、オフセット値の設定方法の一例を示すＸＹ平面上のイメージ図であり、説明の便宜上、オフセットずれや回転ずれを大きく図示した。
　本実施形態のオフセット値設定方法は、作業者などにより、図５に示すようにロボット２０の作業台１１上の所定位置に十字プレートＰを設置して行われる。十字プレートＰは、図６に示すように、十字状のパターンと、ツールＴの位置合わせ用の位置マークＭｐと、回転向き合わせ用の回転向きマークＭｒとが、上面に形成されている。位置マークＭｐは、十字の中心即ちプレート中心に形成された円形のマークである。回転向きマークＭｒは、ツールＴの投影形状を示すマークであり、例えば一対のメカニカルチャックの投影形状が位置マークＭｐを中心とする対称位置に形成されている。作業者は、十字プレートＰを作業台１１上に設置した状態で、表示操作パネル２８で必要な情報の入力操作やアーム２２の手動操作を行いながら、ロボット制御装置７０にオフセット値を設定させる。
　図３のオフセット値設定方法では、作業者は、まず、ツールＴの設計上のオフセット値を登録する（Ｓ１０）。設計上のオフセット値（以下、オフセット設計値）は、ツールＴの取付基準位置からツールＴの制御点までのＸ方向およびＹ方向の距離として、ツールＴの設計寸法に基づいて定められている。オフセット設計値は、例えば作業者により表示操作パネル２８を用いて登録される。例えば、図５には、ツールＴとしてのメカニカルチャックがワークをチャックする作業中心の位置（制御点）Ｔ０が、原点ＭｏからＸ方向にＸｏｆｆ０だけオフセットされた様子を示す。なお、Ｘ方向，Ｙ方向のオフセット値だけでなく、Ｚ軸回りの回転方向のオフセット値が登録されてもよいが、回転方向のオフセット設計値がなければ値０が登録される。
　次に、ＣＰＵ７１は、十字プレートＰの中心（位置マークＭｐ）にカメラ２４の中心が合うように移動させ、その際の位置マークＭｐの位置（中心位置）を示す第１座標（Ｘ１，Ｙ１）と回転向きマークＭｒのＺ軸回りの回転量Ｒ１とを取得する（Ｓ２０，図７）。Ｓ２０では、ＣＰＵ７１は、カメラ２４により撮像された画像を画像処理して位置マークＭｐや回転向きマークＭｒを認識し、その位置および回転向きを取得する。Ｓ２０の回転量Ｒ１は、作業台１１上の十字プレートＰのＺ軸回りの回転ずれ量を示し、十字プレートＰが回転ずれなく正しく設置されていれば、値０となる。図７では、Ｓ２０で取得された第１座標（Ｘ１，Ｙ１）を「Ｓ２０（Ｘ１，Ｙ１）」とし、図８～図１１も同様とする。また、Ｓ２０を行った際のメカニカルインタフェース座標系の原点Ｍｏ即ち先端リンク３６の原点Ｍｏを、原点Ｍｏ０とする。
　続いて、ＣＰＵ７１は、ツールＴの制御点の目標位置と目標回転量（目標角度）を、第１座標（Ｘ１，Ｙ１）と回転量Ｒ１として、ツールＴが移動するようにアーム２２の作動を制御する（Ｓ３０，図７）。ここで、ツールＴの加工誤差や取付誤差などにより、実際のオフセット値がオフセット設計値と異なり、Ｘ方向，Ｙ方向のオフセットずれやＺ軸回りの回転ずれが発生する場合がある。その場合、Ｓ３０で移動させたツールＴの実際の制御点の位置が、第１座標（Ｘ１，Ｙ１）や回転量Ｒ１と一致せず、位置ずれや回転ずれが生じる。図７では、回転ずれによる移動位置を点線で図示し、これにオフセットずれが加わった位置を実線で示す。ただし、ＣＰＵ７１は、第１座標（Ｘ１，Ｙ１）と回転量Ｒ１とを制御点の目標位置と目標回転量としてアーム２２を作動させるから、ツールＴの制御点が図７の「Ｓ２０（Ｘ１，Ｙ１）」に移動したと認識している。即ち、実際には、ツールＴの制御点がＳ３０の実線位置に移動しているものの、ＣＰＵ７１は、ツールＴの制御点が「Ｓ２０（Ｘ１，Ｙ１）」にあると誤認識していることになる。
　Ｓ３０に続いて、ツールＴの制御点の位置と回転向きとが、十字プレートＰの位置マークＭｐと回転向きマークＭｒとに一致するように、先端リンク３６の位置および回転量（角度）を調整する（Ｓ４０，図８）。Ｓ４０では、例えば作業者が表示操作パネル２８を用いて、目視による調整操作を行うことで、ツールＴの制御点の位置と回転向きとが位置マークＭｐと回転向きマークＭｒとに一致するようにロボット２０を作動させる。例えば図８では、回転調整によって回転ずれを解消した位置を点線で図示し、これに位置調整によってオフセットずれを解消した位置を実線で示す。また、ＸＹ方向の位置調整に伴って、メカニカルインタフェース座標系の原点Ｍｏが原点Ｍｏ０から移動した位置を原点Ｍｏ１とする。
　そして、ＣＰＵ７１は、調整後（移動後）の制御点の位置を示す第２座標（Ｘ２，Ｙ２）と回転量（回転調整量）Ｒ２とを取得する（Ｓ５０，図８，図９）。上述したように、ＣＰＵ７１は、Ｓ３０で制御点が「Ｓ２０（Ｘ１，Ｙ１）」にあると誤認識しているから、「Ｓ２０（Ｘ１，Ｙ１）」に対して調整がなされたと認識する。図９では、「Ｓ２０（Ｘ１，Ｙ１）」（Ｓ４０と同位置）に対して回転調整がされた位置を点線で示し、これにＸＹ方向の位置調整がされた位置を実線で示す。図示するように、第２座標（Ｘ２，Ｙ２）として「Ｓ５０（Ｘ２，Ｙ２）」の位置座標が取得される。
　ここで、図９（図８）に示すように、メカニカルインタフェース座標系の原点即ち先端リンク３６の回転中心が原点Ｍｏ０から原点Ｍｏ１に移動しているため、Ｓ５０の実線位置には、Ｘ方向，Ｙ方向のオフセットずれに、回転中心が異なることによる回転ずれも重なっている。このため、第２座標（Ｘ２，Ｙ２）および回転量Ｒ２と、第１座標（Ｘ１，Ｙ１）および回転量Ｒ１とに基づいて差分ΔＸ，ΔＹ，ΔＲを算出してオフセット設計値に反映させたとしても、回転ずれによる影響が残ったままとなり正しいオフセット値とならない。また、上述したように、十字プレートＰが回転ずれして配置されているために、その回転ずれによる影響が反映されている可能性もある。そこで、本実施形態では、回転ずれを除去した上でオフセット値を算出するように、図４に示す回転ずれ除去後オフセット値算出の処理を行う（Ｓ６０）。
　図４の処理では、ＣＰＵ７１は、まず、オフセット設計値と第２座標（Ｘ２，Ｙ２）と回転量Ｒ２とに基づいて、移動後の原点Ｍｏ１を導出する（Ｓ６１）。ここでは、ＣＰＵ７１は、まず、回転量Ｒ２とオフセット設計値とから、回転量Ｒ２で回転した状態のＸＹ方向のオフセット値即ち回転量Ｒ２の回転ずれを反映したオフセット値を算出する。次に、ＣＰＵ７１は、算出したオフセット値分だけ第２座標（Ｘ２，Ｙ２）から離れた位置を、原点Ｍｏ１として導出する。なお、この導出方法に限られず、設計上のオフセット値と第２座標（Ｘ２，Ｙ２）と回転量Ｒ２の少なくともいずれかを用いて、移動後の原点Ｍｏ１を導出するものであればよい。
　次に、ＣＰＵ７１は、ツールＴの回転ずれを除去する（Ｓ６２）。ここでは、ＣＰＵ７１は、Ｓ６１で算出した原点Ｍｏ１を中心として、回転量Ｒ２と反対方向に回転量Ｒ２分だけ第２座標（Ｘ２，Ｙ２）を回転させて第２座標（Ｘ２，Ｙ２）を修正した第３座標（Ｘ３，Ｙ３）を取得する（図１０）。これにより、ツールＴの回転ずれを除去した制御点の位置が取得される。
　続いて、ＣＰＵ７１は、十字プレートＰの回転ずれを除去する（Ｓ６３）。ここでは、ＣＰＵ７１は、原点Ｍｏ１を中心として、Ｓ２０で取得した回転量Ｒ１と反対方向に回転量Ｒ１分だけ第１座標（Ｘ１，Ｙ１）と第３座標（Ｘ３，Ｙ３）とをそれぞれ回転させて補正した第１座標（Ｘ１’，Ｙ１’）と第３座標（Ｘ３’，Ｙ３’）とを取得する（図１１）。これにより、十字プレートＰの回転ずれを除去した位置が取得される。
　こうして回転ずれを除去すると、ＣＰＵ７１は、補正後の第１座標（Ｘ１’，Ｙ１’）と第３座標（Ｘ３’，Ｙ３’）とに基づいて、Ｘ，Ｙ方向のそれぞれのオフセットの差分ΔＸ（＝Ｘ１’－Ｘ３’），ΔＹ（＝Ｙ１’－Ｙ３’）をオフセットずれとして算出する（Ｓ６４）。続いて、ＣＰＵ７１は、算出した差分ΔＸ，ΔＹを、オフセット設計値にそれぞれ加えて、Ｘ方向，Ｙ方向のオフセット値（Ｘｏｆｆ，Ｙｏｆｆ）をそれぞれ算出して（Ｓ６５）、本処理を終了する。
　そして、ＣＰＵ７１は、Ｓ６０（Ｓ６５）で算出したＸ方向，Ｙ方向のオフセット値（Ｘｏｆｆ，Ｙｏｆｆ）を、ツールＴの種類や型式などの識別情報に対応付けて、ＨＤＤ７３にオフセット値７３ａとして記憶する（Ｓ７０）。これにより、ロボット制御装置７０は、回転ずれを除去して正しく設定されたオフセット値７３ａを用いてロボット２０にツールＴを用いた作業を行わせることができるから、作業精度を向上させることができる。
　ここで、本実施形態の構成要素と本開示の構成要素との対応関係を明らかにする。本実施形態のオフセット値設定方法のＳ２０が第１取得ステップに相当し、Ｓ３０，Ｓ４０が作動ステップに相当し、Ｓ５０が第２取得ステップに相当し、回転ずれ除去後オフセット値算出のＳ６１，Ｓ６２が第３取得ステップに相当し、Ｓ６４，Ｓ６５が設定ステップに相当する。また、Ｓ６３が補正ステップに相当する。また、カメラ２４がカメラに相当する。ロボット制御装置７０のＨＤＤ７３が記憶部に相当し、ＣＰＵ７１が制御部に相当し、ロボット制御装置７０がロボット制御装置に相当する。
　以上説明したロボット２０のツールＴのオフセット値設定方法では、まず、十字プレートＰを画像認識して第１座標（Ｘ１，Ｙ１）と回転量Ｒ１とを取得する。次に、第１座標（Ｘ１，Ｙ１）をツールＴの制御点の目標位置として、アーム２２を作動させてから先端リンク３６の位置および回転量を調整し、制御点の第２座標（Ｘ２，Ｙ２）と回転量（回転調整量）Ｒ２とを取得する。続いて、第２座標（Ｘ２，Ｙ２）と回転量Ｒ２とオフセット設計値とから求めた原点Ｍｏ１を中心に回転量Ｒ２だけ戻す方向に第２座標（Ｘ２，Ｙ２）を回転させることで、原点Ｍｏ（回転中心）の移動による回転ずれを除去した第３座標（Ｘ３，Ｙ３）を取得する。さらに、原点Ｍｏ１を中心に第１座標（Ｘ１，Ｙ１）と第３座標（Ｘ３，Ｙ３）とを回転量Ｒ１と反対方向に回転させることで、十字プレートＰの回転ずれを除去した第１座標（Ｘ１’，Ｙ１’）と第３座標（Ｘ３’，Ｙ３’）とに補正する。そして、第１座標（Ｘ１’，Ｙ１’）と第３座標（Ｘ３’，Ｙ３’）との差分ΔＸ，ΔＹをオフセット設計値に加えてオフセット値を設定する。これにより、ツールＴの回転ずれを除去してオフセット値を精度よく設定することができる。また、十字プレートＰの回転ずれの影響を除去してオフセット値をより精度よく設定することができる。
　また、十字プレートＰは、十字線の中心に位置マークＭｐが形成されると共にツールＴの外形の投影形状が回転向きマークＭｒとして形成されているから、制御点の位置およびツールＴの回転向きを調整する作業をより適切に行うことができる。
　また、ロボット２０が備えるカメラ２４を用いてオフセット値を設定することができるから、ロボット２０の構成品以外の測定器具やセンサなどを準備することなくオフセット値の調整を容易に行うことができる。
　なお、本開示は上述した実施形態に何ら限定されることはなく、本開示の技術的範囲に属する限り種々の態様で実施し得ることはいうまでもない。
　例えば、上述した実施形態では、図４の回転ずれ除去後オフセット値算出のＳ６３で十字プレートＰの回転ずれを除去したが、これに限られず、Ｓ６３を省略してもよい。例えば、ガイド治具など用いて作業台１１に十字プレートＰが回転ずれがないように設置されるものでは、Ｓ６３を省略すればよい。その場合、Ｓ６４では、第１座標（Ｘ１，Ｙ１）と第３座標（Ｘ３，Ｙ３）との差分ΔＸ，ΔＹを算出すればよい。
　実施形態では、ロボット２０のアーム２２に取り付けられたカメラ２４を用いたが、これに限られず、ロボット２０を含むロボットシステムが備えるカメラを用いればよく、例えばロボット２０の上方に吊り下げて設置されるカメラを用いてもよい。また、ロボット２０に取り付けられたカメラ２４やロボットシステムが備えるカメラとは別のカメラを用いてもよく、オフセット値を設定する際に設置される専用のカメラを用いてもよい。
　実施形態では、円形の位置マークＭｐとツールＴの投影形状を示す回転向きマークＭｒとが形成された十字プレートＰを用いたが、これに限られるものではない。例えば、位置マークＭｐは、位置合わせが可能なマークであればよく、円形に限られない。回転向きマークＭｒは、Ｚ軸回りの回転向き合わせが可能なマークであればよく、ツールＴの投影形状を示すマークに限られない。また、十字状のパターンが形成された十字プレートＰに限られず、位置マークＭｐと回転向きマークＭｒとが形成されたプレートであればよい。
　実施形態では、ロボット制御装置７０が主体となってオフセット値設定方法を行うものとしたが、これに限られず、ロボット制御装置７０とは別にカメラ２４の画像を処理する画像処理装置が設けられている場合に、画像処理装置が主体となってオフセット値設定方法を行ってもよい。あるいは、オフセット値を設定する専用の装置が主体となってオフセット値設定方法を行ってもよい。
　ここで、本開示のオフセット値設定方法およびロボット制御装置は、以下のように構成してもよい。例えば、本開示のオフセット値設定方法において、前記第１取得ステップでは、前記多関節ロボットの作業台に配置された前記プレートを画像認識して、前記第１座標と、前記回転向きマークの回転ずれ量とを取得し、前記第３取得ステップの後に、前記原点位置を中心に前記回転ずれ量を解消する方向に前記第１座標と前記第３座標とをそれぞれ回転させて補正する補正ステップを含み、前記設定ステップでは、前記補正後の前記第１座標と前記第３座標とのＸ方向とＹ方向の差分をそれぞれ算出して、前記ツールのオフセット値を設定するものとしてもよい。こうすれば、作業台に配置されたプレートに回転ずれがあった場合でも、その回転ずれの影響を除去してオフセット値をより精度よく設定することができる。
　本開示のオフセット値設定方法において、前記プレートは、十字線の中心に前記位置マークが形成されると共に前記ツールの外形の投影形状が前記回転向きマークとして形成されているものとしてもよい。こうすれば、実際の制御点の位置およびツールの回転向きを、作業者の目視で合わせて調整する際に、調整作業をより適切に行うことができる。
　本開示のオフセット値設定方法において、前記ロボットは、前記アームに取り付けられたカメラを備え、前記第１取得ステップでは、前記カメラにより撮像された画像を画像認識するものとしてもよい。こうすれば、ロボットが備えるカメラを用いてオフセット値を設定することができるから、ロボットの構成品以外の測定器具やセンサなどを準備することなくオフセット値の調整を容易に行うことができる。
　本開示のロボット制御装置は、上述したいずれかのオフセット値設定方法により設定されたオフセット値を記憶する記憶部と、前記オフセット値に基づいて、前記ツールが取り付けられた前記アームの作動を制御する制御部と、を備えることを要旨とする。本開示のロボット制御装置は、オフセット値設定方法により設定されたオフセット値を記憶しているから、ツールの加工誤差や取付誤差などに拘わらず、精度よく設定されたオフセット値を用いることができる。このため、ロボット制御装置は、アームにツールが取り付けられた多関節ロボットの作業精度を向上させることができる。
　本開示は、ロボットの製造産業などに利用可能である。
　１１　作業台、１２　ワーク搬送装置、２０　ロボット、２２　アーム、２４　カメラ、２８　表示操作パネル、３１　第１リンク、３２　第２リンク、３３　第３リンク、３４　第４リンク、３５　第５リンク、３６　先端リンク（第６リンク）、４１　第１関節、４２　第２関節、４３　第３関節、４４　第４関節、４５　第５関節、５１～５５　モータ、６１～６５　エンコーダ、７０　ロボット制御装置、７１　ＣＰＵ、７２　ＲＯＭ、７３　ＨＤＤ、７３ａ　オフセット値、７４　ＲＡＭ、Ｍｐ　位置マーク、Ｍｒ　回転向きマーク、Ｐ　十字プレート、Ｔ　ツール。

Claims (5)

  1. 　多関節ロボットのアームの先端部に取り付けられ、制御点が前記先端部の原点からＸＹ方向にオフセットされたツールのオフセット値設定方法であって、
    　前記ツールのＸＹ方向の位置合わせ用の位置マークとＺ軸回りの回転向き合わせ用の回転向きマークとを有するプレートを画像認識して、前記位置マークのＸＹ方向の位置を示す第１座標を取得する第１取得ステップと、
    　前記ツールの設計上のオフセット値を用いて前記第１座標を前記ツールの制御点の目標位置として前記アームを作動させてから、実際の前記制御点の位置および前記ツールの回転向きが前記位置マークおよび前記回転向きマークに合うように前記先端部の位置および回転量を調整する作動ステップと、
    　該調整後の前記制御点のＸＹ方向の位置を示す第２座標と該調整による前記先端部の回転調整量とを取得する第２取得ステップと、
    　前記第２座標と前記回転調整量と前記設計上のオフセット値とを用いて前記調整後の前記先端部の原点位置を求め、該原点位置を中心に前記回転調整量だけ戻す方向に前記第２座標を回転させた位置を示す第３座標を取得する第３取得ステップと、
    　前記第１座標と前記第３座標とのＸ方向とＹ方向の差分をそれぞれ算出し、該差分を前記設計上のオフセット値に加えて前記ツールのオフセット値を設定する設定ステップと、
    　を含むオフセット値設定方法。
  2. 　請求項１に記載のオフセット値設定方法であって、
    　前記第１取得ステップでは、前記多関節ロボットの作業台に配置された前記プレートを画像認識して、前記第１座標と、前記回転向きマークの回転ずれ量とを取得し、
    　前記第３取得ステップの後に、前記原点位置を中心に前記回転ずれ量を解消する方向に前記第１座標と前記第３座標とをそれぞれ回転させて補正する補正ステップを含み、
    　前記設定ステップでは、前記補正後の前記第１座標と前記第３座標とのＸ方向とＹ方向の差分をそれぞれ算出して、前記ツールのオフセット値を設定する
    　オフセット値設定方法。
  3. 　請求項１または２に記載のオフセット値設定方法であって、
    　前記プレートは、十字線の中心に前記位置マークが形成されると共に前記ツールの外形の投影形状が前記回転向きマークとして形成されている
    　オフセット値設定方法。
  4. 　請求項１ないし３のいずれか１項に記載のオフセット値設定方法であって、
    　前記ロボットは、前記アームに取り付けられたカメラを備え、
    　前記第１取得ステップでは、前記カメラにより撮像された画像を画像認識する
    　オフセット値設定方法。
  5. 　請求項１ないし４のいずれか１項に記載のオフセット値設定方法により設定されたオフセット値を記憶する記憶部と、
    　前記オフセット値に基づいて、前記ツールが取り付けられた前記アームの作動を制御する制御部と、
    　を備えるロボット制御装置。
PCT/JP2020/040371 2020-10-28 2020-10-28 オフセット値設定方法およびロボット制御装置 WO2022091241A1 (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2022558662A JPWO2022091241A1 (ja) 2020-10-28 2020-10-28
PCT/JP2020/040371 WO2022091241A1 (ja) 2020-10-28 2020-10-28 オフセット値設定方法およびロボット制御装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2020/040371 WO2022091241A1 (ja) 2020-10-28 2020-10-28 オフセット値設定方法およびロボット制御装置

Publications (1)

Publication Number Publication Date
WO2022091241A1 true WO2022091241A1 (ja) 2022-05-05

Family

ID=81382188

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2020/040371 WO2022091241A1 (ja) 2020-10-28 2020-10-28 オフセット値設定方法およびロボット制御装置

Country Status (2)

Country Link
JP (1) JPWO2022091241A1 (ja)
WO (1) WO2022091241A1 (ja)

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07311610A (ja) * 1994-05-19 1995-11-28 Fanuc Ltd 視覚センサを用いた座標系設定方法
JP2019025632A (ja) * 2017-08-03 2019-02-21 ファナック株式会社 キャリブレーションシステムおよびキャリブレーション方法

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07311610A (ja) * 1994-05-19 1995-11-28 Fanuc Ltd 視覚センサを用いた座標系設定方法
JP2019025632A (ja) * 2017-08-03 2019-02-21 ファナック株式会社 キャリブレーションシステムおよびキャリブレーション方法

Also Published As

Publication number Publication date
JPWO2022091241A1 (ja) 2022-05-05

Similar Documents

Publication Publication Date Title
JP6228120B2 (ja) 多関節型ロボットを備えた作業機および電気部品装着機
JP7153085B2 (ja) ロボットキャリブレーションシステム及びロボットキャリブレーション方法
JP6661028B2 (ja) 作業位置補正方法
KR102091917B1 (ko) 기어 기구의 조립 장치 및 조립 방법
CN112720458B (zh) 一种在线实时校正机器人工具坐标系的系统及方法
JP2012101306A (ja) ロボットの校正装置および校正方法
JP2016187846A (ja) ロボット、ロボット制御装置およびロボットシステム
US11173608B2 (en) Work robot and work position correction method
EP1886771B1 (en) Rotation center point calculating method, rotation axis calculating method, program creating method, operation method, and robot apparatus
WO2022091241A1 (ja) オフセット値設定方法およびロボット制御装置
JP6912529B2 (ja) 視覚誘導ロボットアームの補正方法
JP2016203282A (ja) エンドエフェクタの姿勢変更機構を備えたロボット
JP7145332B2 (ja) ロボット制御システム及びロボット制御方法
JP7384653B2 (ja) ロボットの位置を制御するロボット装置の制御装置
CN114012719A (zh) 一种六轴机器人的零点标定方法及系统
JP7105223B2 (ja) ロボットシステム
WO2022254613A1 (ja) カメラの位置ずれ補正方法およびロボット装置
JPH06206186A (ja) 視覚センサ付き水平多関節型ロボットのハンドリング精度校正法
JP2022048096A (ja) 位置決め方法及び位置決め装置
JP2017074637A (ja) ツールセンターポイント推定方法、ツールセンターポイント推定装置
CN116803627A (zh) 具有校正功能的对象物的检测方法和检测装置
CN114571199A (zh) 一种锁螺丝机及螺丝定位方法
JPH04109311A (ja) 多関節ロボットの位置補正方法

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 20959759

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2022558662

Country of ref document: JP

Kind code of ref document: A

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 20959759

Country of ref document: EP

Kind code of ref document: A1