Control method and robot system

The described control method and system address the issue of robot coordinate system changes by transforming control positions using actual reference points and transformation functions, ensuring accurate and precise robot operation despite mechanical parameter variations.

JP7947829B2Active Publication Date: 2026-11-11SEIKO EPSON CORP
View PDF 2 Cites 0 Cited by

Patent Information

Application Number
JP2022137619
Authority / Receiving Office
JP · JP
Patent Type
Patents
Current Assignee / Owner
Filing Date
2022-08-31
Publication Date
2026-11-11
Estimated Expiration
2042-08-31

AI Technical Summary

Technical Problem

Existing robot control methods face accuracy issues when the robot control coordinate system changes due to mechanical parameter variations, especially when the control position is determined directly in the robot control coordinate system without a corresponding target position in the actual coordinate system, leading to potential operational inaccuracies.

Method used

A control method and system that involves acquiring actual reference positions in an ideal coordinate system, determining a first transformation function to convert control positions in the robot control coordinate system to the ideal coordinate system, and adjusting the control position based on this transformation, allowing for accurate determination of new control positions even when the robot control coordinate system changes.

Benefits of technology

This approach effectively reduces position control errors and maintains high operational accuracy by ensuring that control positions are accurately transformed and adjusted to match changes in the robot control coordinate system, thereby enhancing the precision of robot operations.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 0007947829000008
    Figure 0007947829000008
  • Figure 0007947829000009
    Figure 0007947829000009
  • Figure 0007947829000010
    Figure 0007947829000010
Patent Text Reader

Abstract

To provide a control method and a robot system having high positional accuracy.SOLUTION: A control method determines a control position with respect to a target position of a robot. The control method comprises: a real reference position acquisition step of acquiring three or more real reference positions in an ideal coordinate system; a first control reference position acquisition step of acquiring a first control reference position in a first robot control coordinate system when a control point of the robot is located at each of the real reference positions; a first conversion function acquisition step of acquiring a first conversion function for converting the control position in the first robot control coordinate system into the target position in the ideal coordinate system on the basis of the real reference positions and the first control reference position; a control position determination step of converting the control position in the first robot control coordinate system to the target position in the ideal coordinate system using the first conversion function, and determining a new control position on the basis of the target position.SELECTED DRAWING: Figure 6
Need to check novelty before this filing date? Find Prior Art

Description

TECHNICAL FIELD

[0001] The present invention relates to a control method and a robot system.

BACKGROUND ART

[0002] For example, the robot system described in Patent Document 1 is configured to improve the motion accuracy of a robot by setting a plurality of work origins in a real coordinate system, acquiring a measured position for each of the plurality of work origins based on a captured image from a camera, and correcting the position information of each work origin based on the measured positions.

PRIOR ART DOCUMENTS

PATENT DOCUMENTS

[0003]

PATENT DOCUMENT 1

SUMMARY OF THE INVENTION

PROBLEMS TO BE SOLVED BY THE INVENTION

[0004] As methods for determining a control position, in addition to the method of determining a control position by converting a target position in a real coordinate system to a robot control coordinate system as in Patent Document 1, there is a method of directly specifying the control position in the robot control coordinate system, such as direct teaching. Hereinafter, for convenience of explanation, the former method is also referred to as the first determination method, and the latter method is also referred to as the second determination method.

[0005] Here, after the control position in the first robot control coordinate system is determined, if the robot control coordinate system changes due to a change in mechanical parameters caused by maintenance or the like, the already determined control position must be corrected to a value corresponding to the new robot control coordinate system. When the control position is determined by the first determination method, the new control position can be determined by converting the target position in the real coordinate system to the second robot control coordinate system.

[0006] In contrast, if the control position is determined by the second determination method, there is no target position in the actual coordinate system corresponding to the control position. Therefore, it is not possible to convert to the second robot control coordinate system using the same method as the first determination method. As a result, there is a risk that the accuracy of the operation cannot be improved. [Means for solving the problem]

[0007] The control method of the present invention is a control method for determining a control position relative to the target position of a robot, A step to acquire actual reference positions in an ideal coordinate system of three or more points, A first control reference position acquisition step, which involves acquiring a first control reference position in the first robot control coordinate system when the control points of the robot are located at each of the actual reference positions, A first transformation function acquisition step, in which a first transformation function representing the correspondence between the control position in the first robot control coordinate system and the target position in the ideal coordinate system is obtained based on the actual reference position and the first control reference position, The method includes a control position determination step of transforming the control position in the first robot control coordinate system into the target position in the ideal coordinate system using the first transformation function, and determining a new control position based on the target position.

[0008] The present invention relates to a robot system comprising a robot and a control device for controlling the driving of the robot, wherein the control device determines the control position of the robot relative to a target position. The control device acquires the actual reference position in three or more ideal coordinate systems, The first control reference position in the first robot control coordinate system is obtained when the control points of the robot are located at each of the actual reference positions. Based on the actual reference position and the first control reference position, a first transformation function is obtained that represents the correspondence between the control position in the first robot control coordinate system and the target position in the ideal coordinate system. The control position in the first robot control coordinate system is transformed into the target position in the ideal coordinate system using the first transformation function, and a new control position is determined based on the target position. [Brief explanation of the drawing]

[0009] [Figure 1] This is a diagram illustrating the configuration of a robot system according to a preferred embodiment. [Figure 2] This diagram shows how to use the mounting frame. [Figure 3] This is a diagram showing a modified example of a stand. [Figure 4] This is a block diagram of the control device. [Figure 5] This figure shows the error in the robot's position control. [Figure 6] This is a flowchart showing the control method. [Figure 7] This figure shows an example of robot movement. [Figure 8] This diagram shows the shape used for determining the control position. [Figure 9] This diagram shows the shape used for determining the control position. [Figure 10] This diagram shows the shape used for determining the control position. [Modes for carrying out the invention]

[0010] The control method and robot system of the present invention will be described in detail below based on embodiments shown in the accompanying drawings.

[0011] Figure 1 is a diagram of the configuration of a robot system according to a preferred embodiment. Figure 2 is a diagram showing how to use the stand. Figure 3 is a diagram showing a modified example of the stand. Figure 4 is a block diagram of the control device. Figure 5 is a diagram showing the error in robot position control. Figure 6 is a flowchart of the control method. Figure 7 is a diagram showing an example of robot operation. Figures 8 to 10 are diagrams showing shapes for determining the control position, respectively.

[0012] The robot system 1 shown in Figure 1 includes a robot 2, a control device 3 that controls driving of the robot 2, and a mount 5. Note that Figure 1 illustrates three axes that define an orthogonal coordinate system in a three-dimensional space, namely the X-axis, Y-axis, and Z-axis. The X-axis and Y-axis are horizontal axes, and the Z-axis is a vertical axis. Hereinafter, this three-dimensional space (real space) is also referred to as the "ideal coordinate system".

[0013] As shown in Figure 1, the robot 2 is a 6-axis vertical articulated robot having six drive axes. The robot 2 includes a base 21, a robot arm 22 rotatably connected to the base 21, and an end effector 23 attached to the distal end of the robot arm 22. Further, the robot arm 22 is a robotic arm formed by rotatably connecting a plurality of arms 221, 222, 223, 224, 225, 226, and includes six joints J1, J2, J3, J4, J5, J6. Among these six joints J1 to J6, joints J2, J3, and J5 are bending joints, and joints J1, J4, and J6 are torsional joints, respectively.

[0014] A motor and an encoder (not shown) are installed at each of the joints J1, J2, J3, J4, J5, and J6. During operation of the robot system 1, the control device 3 executes servo control (feedback control) for each of the joints J1 to J6 to make the rotation angle of the joint indicated by the output of the encoder match the control position. Thereby, the robot 2 can be set to a desired posture.

[0015] The end effector 23 can be appropriately selected according to the task to be performed by the robot 2. Further, a control point TCP of the robot 2 is set at the distal end portion of the end effector 23. The position of the control point TCP can be set arbitrarily, but in order to determine the position of the control point TCP using a positioning jig 51 described later, it is preferable to set the control point TCP at the distal end portion of the end effector 23 as in the present embodiment.

[0016] The robot 2 has been described above, but the configuration of the robot 2 is not particularly limited. For example, it may be a SCARA robot (horizontal articulated robot), a dual-arm robot provided with two of the aforementioned robot arms 22, or the like. It may also be a self-propelled robot to which the base 21 is not fixed.

[0017] The gantry 5 is used when acquiring the first conversion function and the second conversion function for reducing positional deviation of the robot 2, and is not used during robot operation.

[0018] To briefly describe the positional deviation of the robot 2, in the robot system 1, the control device 3 controls driving of the robot 2 based on a target position received from a host computer (not shown) or the like. Specifically, the control device 3 calculates the position of the control point TCP based on design mechanism parameters such as the length of each of the arms 221 to 226, the rotation axis origin of each of the joints J1 to J6, and the parallelism and orthogonality of each of the joints J1 to J6, and controls driving of the robot 2 so that the control point TCP coincides with the target position.

[0019] However, actual mechanism parameters may deviate from the design mechanism parameters due to component variations, assembly variations, and the like. When a deviation occurs in the actual mechanism parameters in this manner, the calculated position of the control point TCP deviates from the actual position of the control point TCP, and thus even if the control point TCP is made to coincide with the target position in terms of control, the control point TCP actually deviates from the target position. Hereinafter, this deviation is also referred to as "position control error".

[0020] Accordingly, the robot system 1 is configured to indicate the correspondence relationship between the ideal coordinate system and the robot control coordinate system, and acquire a conversion function for reducing position control error. The gantry 5 is a tool used for acquiring this conversion function. As shown in Figure 1, the gantry 5 has four positioning jigs 51. Each positioning jig 51 is a jig used when positioning the control point TCP. The number of the positioning jigs 51 is not particularly limited as long as it is 3 or more.

[0021] Furthermore, a real reference position RP is set at the tip of the positioning jig 51. The three-dimensional positional relationship between the real reference positions RP of each positioning jig 51 in the ideal coordinate system has been measured in advance. As shown in Figure 2, by bringing the control point TCP of the robot 2 into contact with the real reference position RP, the control position in the robot control coordinate system at that time can be obtained as the control reference position corresponding to the real reference position RP.

[0022] The positioning jig is not particularly limited, and for example, a positioning jig 53 as shown in Figure 3 may be used. The positioning jig 53 has a flat substrate 531 and an L-shaped wall portion 532 installed on the substrate 531. The wall portion 532 is bent at a right angle, and the actual reference position RP is set at the point where the bent portion of the wall portion 532 and the surface of the substrate 531 come into contact. On the other hand, a positioning aid 54 is connected to the tip of the robot arm 22. This positioning aid 54 has a rectangular parallelepiped shape, and a control point TCP is set at the vertex of its bottom surface.

[0023] By bringing the control point TCP into contact with the actual reference position RP of the positioning jig 53, the control position of the robot control coordinate system at that time can be obtained as the control reference position corresponding to the actual reference position RP. Furthermore, when the positioning jig 53 and the positioning aid 54 are in contact with each other on three surfaces, the orientation of the control point TCP of the robot 2 is uniquely determined, so the control orientation of the robot control coordinate system at that time can be obtained as the control reference orientation corresponding to the actual orientation at the actual reference position RP.

[0024] Alternatively, instead of using the positioning jigs 51 and 53 described above, the actual reference position and control reference position of the robot control coordinate system may be obtained using a three-dimensional measuring instrument. In this case, first, the control point TCP of the robot 2 is positioned using the control reference position of the robot control coordinate system, and then the three-dimensional position of the control point TCP in the ideal coordinate system is measured with a three-dimensional position measuring instrument to obtain the actual reference position RP.

[0025] The control device 3 controls the driving of the robot 2. As shown in Figure 4, the control device 3 is composed of, for example, a computer and includes a processor 31, a memory 32, an interface circuit 33, an input device 34 connected to the interface circuit 33, and a display unit 35.

[0026] The processor 31 functions as a control position determination unit 310 that determines the control position of the robot 2. The function of the control position determination unit 310 is realized by the processor 31 executing a computer program stored in memory 32. However, some or all of the functions of the control position determination unit 310 may be realized by hardware circuits.

[0027] Memory 32 stores the control position correction data CD and the operation program MP. The control position correction data CD also includes the figure G and the first and second transformation functions A11, A12, and A2, which will be described later. The operation program MP consists of multiple operation commands that operate the robot 2.

[0028] Next, we will explain the error in the position control of robot 2 based on Figure 5. The left side of Figure 5 shows the control position in the robot control coordinate system, and the right side shows the error in position control in the ideal coordinate system. The "robot control coordinate system" is a coordinate system that represents the position and orientation of robot 2 used in the motion commands for controlling robot 2.

[0029] In the example shown in Figure 5, it is assumed that control positions are set at 30 mm intervals in the X and Y directions in the robot control coordinate system. The arrows drawn in the ideal coordinate system represent the position control error. That is, the starting point of the arrow is the target position, and the tip of the arrow is the control point TCP containing the error. However, for illustrative purposes, the amount of error is multiplied by 200 to represent the length of the arrow.

[0030] To reduce such position control errors, a conventional method has been used in which the target position in the ideal coordinate system is converted to a control position in the robot control coordinate system using conversion coefficients, and the drive of the robot 2 is controlled based on this control position.

[0031] However, this method presents the following problems. As mentioned above, the actual mechanism parameters, such as the length of each arm 221-226, the rotation axis origin of each joint J1-J6, and the parallelism and orthogonality of each joint J1-J6, deviate from the design mechanism parameters, resulting in a discrepancy between the robot control coordinate system and the ideal coordinate system. Furthermore, the mechanism parameters may change if the joints J1-J6 or arms 221-226 are replaced, if the installation location of robot 2 is changed, if the end effector 23 is changed, or due to ambient temperature, etc. Thus, when the mechanism parameters change, the robot control coordinate system also changes accordingly. For the sake of explanation, the robot control coordinate system before the change will be referred to as the first robot control coordinate system, and the robot control coordinate system after the change will be referred to as the second robot control coordinate system.

[0032] Here, in addition to the method of converting the target position in the ideal coordinate system to the control position in the robot control coordinate system, there is also a method of directly setting the control position in the robot control coordinate system, such as direct teaching. For the sake of explanation, the former method will be referred to as the first determination method, and the latter method as the second determination method.

[0033] After determining the control position in the first robot control coordinate system using this method, if the robot control coordinate system changes from the first robot control coordinate system to the second robot control coordinate system due to the various factors mentioned above, controlling the drive of robot 2 based on the same control position, i.e., the control position in the first robot control coordinate system, will result in a position control error. Therefore, the control position in the first robot control coordinate system must be corrected to the control position in the second robot control coordinate system.

[0034] When the control position is determined by the first determination method, that control position has a target position in the ideal coordinate system. Therefore, by converting that target position to the control position in the second robot control coordinate system, a new control position in the second robot control coordinate system can be determined. In contrast, when the control position is determined by the second determination method, that control position does not have a target position in the ideal coordinate system. Therefore, it is not possible to convert it to the second robot control coordinate system using the same method as the first determination method. Thus, the robot system 1 is configured so that even when the control position is determined by the second determination method, a new control position in the second robot control coordinate system can be determined using the same method as the first determination method. This effectively reduces errors in position control. The control method of the robot 2 by the control device 3 will be described below.

[0035] As shown in Figure 6, the control method for robot 2 includes the following steps: acquiring the actual reference position S1, acquiring the first control reference position S2, acquiring the first transformation function S3, acquiring the target position etc. S4, determining the first control position S5, confirming the robot control coordinate system S6, acquiring the second control reference position S7, acquiring the second transformation function S8, determining the second control position S9, and controlling the robot S10. Each of these steps S1 to S10 will be explained in order below.

[0036] [Actual reference position acquisition step S1] In the actual reference position acquisition step S1, the control position determination unit 310 acquires actual reference positions RP in three or more ideal coordinate systems. As mentioned above, in this embodiment, the frame 5 has four positioning jigs 51, and the actual reference positions RP are set at the tips of these jigs. Therefore, in this embodiment, as shown in Figure 7, the control position determination unit 310 acquires four actual reference positions RP1, RP2, RP3, and RP4.

[0037] [First control reference position acquisition step S2] In the first control reference position acquisition step S2, the control position determination unit 310 acquires the first control reference position CP1 in the first robot control coordinate system when the control point TCP is located at the actual reference position RP. Specifically, first, the control position determination unit 310 positions the control point TCP at the actual reference position RP1. Next, the control position determination unit 310 acquires the first control reference position CP11, which is the position of the control point TCP in the first robot control coordinate system when the control point TCP is located at the actual reference position RP1. The control position determination unit 310 performs the same operation for the other actual reference positions RP2, RP3, and RP4 to acquire the first control reference positions CP12, CP13, and CP14. As a result, the control position determination unit 310 acquires four first control reference positions CP11, CP12, CP13, and CP14.

[0038] [Step S3: Obtaining the first transformation function] In the first transformation function acquisition step S3, the control position determination unit 310 first sets up a triangular figure G with three actual reference positions RP as its vertices in the ideal coordinate system, as shown in Figure 8. As mentioned above, since four actual reference positions RP1 to RP4 are acquired in the actual reference position acquisition step S1, in this embodiment, the region enclosed by the four actual reference positions RP1 to RP4 is divided into two triangular figures G1 and G2. Any division method, such as Delaunay triangulation, can be used for this division.

[0039] Next, the control position determination unit 310 determines a first transformation function that represents the correspondence between the target position and the control position within each figure G1 and G2, as shown in Figure 9. The control position determination unit 310 determines two first transformation functions: a first transformation function A11 that converts the target position in the ideal coordinate system to the control position in the robot control coordinate system, and a first transformation function A12 that converts the control position in the robot control coordinate system to the target position in the ideal coordinate system. The first transformation function A12 is the inverse transformation function of the first transformation function A11.

[0040] The first transformation function A11 for figure G1 is determined based on the difference between the actual reference positions RP1, RP2, and RP3, which are the vertices of figure G1, and their corresponding first control reference positions CP11, CP12, and CP13. Similarly, the first transformation function A11 for figure G2 is determined based on the difference between the actual reference positions RP2, RP3, and RP4, which are the vertices of figure G2, and their corresponding first control reference positions CP12, CP13, and CP14. Furthermore, the first transformation function A12 can be derived from the first transformation function A11. The first transformation functions A11 and A12 can be expressed by the following formulas, respectively.

[0041]

number

[0042]

number

[0043] In the formula, Pctrl is the control position in the first robot control coordinate system, and Preal is the target position in the ideal coordinate system. Xctrl is the X-coordinate of the control position in the first robot control coordinate system, and Yctrl is the Y-coordinate of the control position in the first robot control coordinate system. Xreal is the X-coordinate of the target position in the ideal coordinate system, and Yreal is the Y-coordinate of the target position in the ideal coordinate system. A11 and A12 are the first transformation functions, which are transformation formulas representing affine transformations. a11, a12, a21, a22, b1, and b2 are coefficients, which differ for each of the first transformation functions A11 and A12, and for each of the shapes G1 and G2. By using this first transformation function A11, the target position Preal can be easily and accurately converted to the control position Pctrl. Similarly, by using the first transformation function A12, the control position Pctrl can be easily and accurately converted to the target position Preal.

[0044] Transformations using these first transformation functions A11 and A12 represent coordinate transformation operations other than translation and rotation.

[0045] Note that the shape of figure G does not have to be a triangle, and the first transformation function does not have to be an affine transformation. For example, figure G may be a quadrilateral, and the first transformation function may be a projection transformation. Alternatively, the figure may be divided into a state with multiple types of polygons mixed together, and the first transformation function may be different for each figure G. Figure G may also be a three-dimensional figure. The first transformation function may be constructed as a transformation formula, or in other forms such as a lookup table.

[0046] [Target position acquisition step S4] In step S4, the target position acquisition step, the control position determination unit 310 accepts input of the target position or control position of the control point TCP. The target position can be input, for example, by the operator using the input device 34 as a position in the ideal coordinate system. The control position can be input, for example, by the operator directly using direct teaching, as a position in the robot control coordinate system. If the operator creates an operation program MP and the operation commands within it describe the target position or control position of the control point TCP, the control position determination unit 310 may perform this step by acquiring the target position or control position included in the operation commands of the operation program MP.

[0047] In the following explanation, we will use the example shown in Table 1 below, where the robot receives target positions Q1 and Q2 and control position P3, and one cycle is defined as a robot movement that completes a full rotation in the order of target position Q1, target position Q2, and control position P3, and this cycle is repeated a predetermined number of times.

[0048] [Table 1]

[0049] [First control position determination step S5] In the first control position determination step S5, the control position determination unit 310 performs the following processing on target positions Q1 and Q2. First, the control position determination unit 310 selects a target shape containing target position Q1 from shapes G1 and G2. Next, the control position determination unit 310 calculates the control position in the first robot control coordinate system for target position Q1 using the first transformation function A11 corresponding to the selected target shape. If target position Q1 is located within shape G1, the control position in the first robot control coordinate system for target position Q1 is calculated using the first transformation function A11 corresponding to shape G1. If target position Q1 is located within shape G2, the control position in the first robot control coordinate system for target position Q1 is calculated using the first transformation function A11 corresponding to shape G2. In this case, for example, by using the above-described equation (1) and inputting the coordinate values ​​of target position Q1 into Preal, Pctrl can be calculated as the control position for target position Q1.

[0050] Similarly, the control position determination unit 310 first selects a target shape containing the target position Q2 from shapes G1 and G2. Next, the control position determination unit 310 calculates the control position in the first robot control coordinate system for the target position Q2 using the first transformation function A11 corresponding to the selected target shape. If the target position Q2 is located within shape G1, the control position in the first robot control coordinate system for the target position Q2 is calculated using the first transformation function A11 corresponding to shape G1. If the target position Q2 is located within shape G2, the control position in the first robot control coordinate system for the target position Q2 is calculated using the first transformation function A11 corresponding to shape G2. In this case, for example, by using the above-described equation (1) and inputting the coordinate values ​​of the target position Q2 into Preal, Pctrl can be calculated as the control position for the target position Q2.

[0051] Based on the above, the control positions P1 and P2 in the first robot control coordinate system for target positions Q1 and Q2 are obtained, as shown in Table 2 below.

[0052] [Table 2]

[0053] Next, the control position determination unit 310 creates an operation command using the control positions P1 and P2 in the first robot control coordinate system of the target positions Q1 and Q2 calculated by the method described above, and the control position P3 acquired in the target position acquisition step S4. If an operation program MP including the operation command has been created in advance, this process can be executed by replacing the target positions included in the operation command with the control positions determined as described above.

[0054] [Robot control coordinate system confirmation step S6] In the robot control coordinate system confirmation step S6, the control position determination unit 310 confirms whether the robot control coordinate system remains the first robot control coordinate system. If it remains the first robot control coordinate system, the control position determination unit 310 proceeds to the robot control step S10. On the other hand, if the robot control coordinate system changes from the first robot control coordinate system to the second robot control coordinate system, the control position determination unit 310 proceeds to the second control reference position acquisition step S7.

[0055] [Second control reference position acquisition step S7] In the second control reference position acquisition step S7, the control position determination unit 310 acquires the second control reference position CP2 in the second robot control coordinate system when the control point TCP is located at the actual reference position RP. Specifically, first, the control position determination unit 310 positions the control point TCP at the actual reference position RP1. Next, as shown in Figure 10, the control position determination unit 310 acquires the second control reference position CP21, which is the position of the control point TCP in the second robot control coordinate system when the control point TCP is located at the actual reference position RP1. The control position determination unit 310 performs the same operation for the other actual reference positions RP2, RP3, and RP4, and acquires the second control reference positions CP22, CP23, and CP24. As a result, the control position determination unit 310 acquires four second control reference positions CP21, CP22, CP23, and CP24.

[0056] [Second transformation function acquisition step S8] In the second transformation function acquisition step S8, the control position determination unit 310 determines a second transformation function A2 that represents the correspondence between the target position and the control position within each figure G1 and G2, as shown in Figure 10. The second transformation function A2 in figure G1 is determined based on the difference between the actual reference positions RP1, RP2, and RP3, which are the vertices of figure G1, and the corresponding second control reference positions CP21, CP22, and CP23. Similarly, the second transformation function A2 in figure G2 is determined based on the difference between the actual reference positions RP2, RP3, and RP4, which are the vertices of figure G2, and the corresponding second control reference positions CP22, CP23, and CP24. The second transformation function A2 can be expressed by the following formula.

[0057]

number

[0058] In the formula, Pctrl is the control position in the second robot control coordinate system, and Preal is the target position in the ideal coordinate system. Xctrl is the X-coordinate of the control position in the second robot control coordinate system, and Yctrl is the Y-coordinate of the control position in the second robot control coordinate system. Xreal is the X-coordinate of the target position in the ideal coordinate system, and Yreal is the Y-coordinate of the target position in the ideal coordinate system. A2 is the second transformation function, which is a transformation formula representing the affine transformation. a11, a12, a21, a22, b1, and b2 are coefficients, which differ for each figure G1 and G2. These coefficients may differ from those used in the first transformation function A11. By using this second transformation function A2, the target position Preal can be easily and accurately converted to the control position Pctrl.

[0059] [Second control position determination step S9] In the second control position determination step S9, the control position in the second robot control coordinate system is determined for the target positions Q1, Q2 and control position P3 received in the target position acquisition step S4.

[0060] For target positions Q1 and Q2, the control position determination unit 310 performs the following processing: Similar to the first control position determination step S5 described above, the control position determination unit 310 calculates the control position P10 in the second robot control coordinate system for target position Q1 using the second transformation function A2 corresponding to figure G1. Similarly, it calculates the control position P20 in the second robot control coordinate system for target position Q2 using the second transformation function A2 corresponding to figure G2. The results are shown in Table 3 below.

[0061] [Table 3]

[0062] Furthermore, the control position determination unit 310 performs the following processing with respect to the control position P3. As mentioned above, since the control position P3 is set directly in the first robot control coordinate system, it does not have a target position in the ideal coordinate system. Therefore, the control position determination unit 310 first uses the first transformation function A12 to determine the target position Q3 of the control position P3 in the ideal coordinate system. In this case, for example, by using equation (5) described above and inputting the coordinate values ​​of the control position P3 into Pctrl, Preal can be calculated as the target position Q3 in the ideal coordinate system.

[0063] Next, the control position determination unit 310 selects a target shape containing the target position Q3 from shapes G1 and G2. Then, the control position determination unit 310 calculates the control position P30 in the second robot control coordinate system relative to the target position Q3 using the second transformation function A2 corresponding to the selected target shape. In this case, by using the above-mentioned equation (9) and inputting the coordinate values ​​of the target position Q3 into Preal, Pctrl can be calculated as the control position P30. This allows for accurate calculation of the control position P30 in the second robot control coordinate system. The results are shown in Table 4 below.

[0064] [Table 4]

[0065] Next, the control position determination unit 310 creates an operation command using the control positions P10, P20, and P30 in the second robot control coordinate system calculated by the method described above. If an operation program MP including the operation command has been created in advance, this process can be executed by replacing the target position and control position included in the operation command with the control positions determined as described above. In this way, the target positions Q1, Q2 and control position P3 are replaced with the new control positions P10, P20, and P30 in the second robot control coordinate system.

[0066] As mentioned above, in addition to the case where the control position P3 in the first robot control coordinate system is directly converted to the new control position P30 in the second robot control coordinate system, it is also conceivable that the control position P3 in the first robot control coordinate system is relatively moved and then converted to the new control position P30 in the second robot control coordinate system. Relative movement here refers to, for example, translation in the X-axis direction or Y-axis direction, or rotational movement around the Z-axis. In such cases, the control position determination unit 310 first uses the first conversion function A12 to determine the target position Q3 in the ideal coordinate system of the control position P3. Next, it adds the relative movement amount to the target position Q3 to determine the target position Q3'. Here, the relative movement amount is the amount of movement from a predetermined position, and adding the relative movement amount to the target position Q3 to determine the target position Q3' means adding the movement amount to the coordinates (x3, y3, z3) of the target position Q3 to determine the coordinates of the target position Q3'. Then, the target position Q3' is converted to the control position P30 in the second robot control coordinate system using the second transformation function A2. In this way, by adding the relative movement amount to the target position Q3 instead of the control position P3, the control position P30 in the second robot control coordinate system can be calculated with high accuracy.

[0067] [Robot control step S10] In robot control step S10, the control position determination unit 310 controls the drive of robot 2 using the latest motion program MP, which includes the created motion commands. When one cycle of robot motion is completed, the control position determination unit 310 determines whether the robot motion has reached a predetermined number of times. If it has, it stops the drive of robot 2; otherwise, it returns to robot control coordinate system confirmation step S6. Each time it returns to robot control coordinate system confirmation step S6, the current robot control coordinate system becomes the first robot control coordinate system, and the changed robot control coordinates become the second robot control coordinate system.

[0068] According to the control method described above, the target position Q3 in the ideal coordinate system is calculated for the control position P3 directly set in the first robot control coordinate system. Therefore, the control position P3 in the new robot control coordinate system can be determined in the same way as the target positions Q1 and Q2. As a result, the error in position accuracy can be effectively reduced in a simple manner, resulting in a robot system 1 that can exhibit excellent operational accuracy.

[0069] Furthermore, even when the control position P3 in the first robot control coordinate system is moved relative to the new control position P30 in the second robot control coordinate system without conversion, the target position in the ideal coordinate system is also determined. Q It is desirable to add the relative displacement to 3. This is because if the relative displacement is added in the first robot control coordinate system, there will be a difference from the amount in the ideal coordinate system, preventing the intended relative displacement from being achieved. Specifically, the first transformation function A12 is used to find the target position Q3 in the ideal coordinate system of the control position P3. Next, the relative displacement is added to the target position Q3 to find the target position Q3'. Then, the target position Q3' is converted to the control position P3' in the first robot control coordinate system using the first transformation function A11. In this way, by adding the relative displacement to the target position Q3 rather than the control position P3, the relative displacement can be added with high accuracy.

[0070] The robot system 1 has been described above. As previously stated, the control method for such a robot system 1 is a control method for determining the control position of the robot 2 with respect to the target position, and includes: an actual reference position acquisition step S1 for acquiring actual reference positions RP in three or more ideal coordinate systems; a first control reference position acquisition step S2 for acquiring a first control reference position CP1 in a first robot control coordinate system when the control points TCP of the robot 2 are located at each actual reference position RP; a first transformation function acquisition step S3 for acquiring a first transformation function A12 that represents the correspondence between the control position in the first robot control coordinate system and the target position in the ideal coordinate system, based on the actual reference position RP and the first control reference position CP1; and a second control position determination step S9 as a control position determination step in which the control position P3 in the first robot control coordinate system is transformed into a target position Q3 in the ideal coordinate system using the first transformation function A12, and a new control position P30 is determined based on the target position Q3. With this control method, the control position P30 in the new robot control coordinate system can be determined in the same way as the target positions Q1 and Q2 set in the ideal coordinate system, even for the control position P3 directly set in the first robot control coordinate system. Therefore, the robot system 1 can effectively reduce position accuracy errors in a simple manner and exhibit excellent operational accuracy.

[0071] Furthermore, as mentioned above, the control position P3 in the first robot control coordinate system is directly set in the first robot control coordinate system. In this way, even for a control position P3 that does not have a target position in the ideal coordinate system, the control position P30 in the new robot control coordinate system can be determined in the same way as for target positions Q1 and Q2. Therefore, the calculation of the control position becomes easier.

[0072] Furthermore, as mentioned above, if the robot control coordinate system for setting the control position is changed from the first robot control coordinate system to the second robot control coordinate system, the second control reference position acquisition step S7 is performed prior to the second control position determination step S9 to acquire the second control reference position CP2 in the second robot control coordinate system when the control point TCP is located at the actual reference position RP, and the second transformation function acquisition step S8 is performed to acquire a second transformation function A2 that transforms the target position in the ideal coordinate system into a control position in the second robot control coordinate system based on the actual reference position RP and the second control reference position CP2. In the second control position determination step S9, the control position P3 in the first robot control coordinate system is transformed into the target position Q3 in the ideal coordinate system using the first transformation function A12, and then transformed into a new control position P30 in the second robot control coordinate system using the second transformation function A2. This makes it possible to calculate the control position P30 in the second robot control coordinate system with high accuracy.

[0073] Furthermore, as mentioned above, in the first control position determination step S5 or the second control position determination step S9, the control position P3 in the first robot control coordinate system is transformed into the target position Q3 in the ideal coordinate system using the first transformation function A12, the relative movement is added to the target position Q3, and then it is transformed into the control position P3' in the first robot control coordinate system using the first transformation function A11 or into the new control position P30 in the second robot control coordinate system using the second transformation function A2. This allows the relative movement to be added with high accuracy.

[0074] Furthermore, as mentioned above, in the first transformation function acquisition step S3, at least one figure G with three or more actual reference positions RP as vertices is set in the ideal space, and the first transformation functions A11 and A12, which represent the correspondence between the target position and the control position within figure G, are obtained. This makes it possible to calculate the control position in the first robot control coordinate system with high accuracy.

[0075] As mentioned above, the robot system 1 comprises a robot 2 and a control device 3 that controls the driving of the robot 2. The control device 3 determines the control position of the robot 2 relative to the target position. The control device 3 obtains the actual reference position RP in the ideal coordinate system, obtains the first control reference position CP1 in the first robot control coordinate system when the control point TCP of the robot 2 is located at the actual reference position RP, obtains a first transformation function A12 that represents the correspondence between the control position in the first robot control coordinate system and the target position in the ideal coordinate system based on the actual reference position RP and the first control reference position CP1, converts the control position P3 in the first robot control coordinate system to the target position Q3 in the ideal coordinate system using the first transformation function A12, and determines a new control position P30 based on the target position Q3. With this configuration, even for a control position P3 directly set in the first robot control coordinate system, the control position P30 in the new robot control coordinate system can be determined in the same way as the target positions Q1 and Q2 set in the ideal coordinate system. Therefore, the robot system 1 can effectively reduce position accuracy errors in a simple manner and exhibit excellent operational accuracy.

[0076] The control method and robot system of the present invention have been described above based on the illustrated embodiments, but the present invention is not limited thereto. The configuration of each part can be replaced with any configuration having a similar function. In addition, any other configuration may be added to the present invention. [Explanation of symbols]

[0077] 1...Robot system, 2...Robot, 21...Base, 22...Robot arm, 221...Arm, 222...Arm, 223...Arm, 224...Arm, 225...Arm, 226...Arm, 23...End effector, 3...Control device, 31...Processor, 310...Control position determination unit, 32...Memory, 33...Interface circuit, 34...Input device, 35...Display unit, 5...Stand, 51...Positioning jig, 53...Positioning jig, 531...Substrate, 532...Wall section, 54...Positioning aid, CD...Control position correction data, CP1...First control reference position, CP11...First control reference position, CP12...First control reference position, CP13...First control reference position, CP14...First control reference position, CP2...Second control reference position, CP21...Second control reference position, C P22...Second control reference position, CP23...Second control reference position, CP24...Second control reference position, G...Shape, G1...Shape, G2...Shape, J1...Joint, J2...Joint, J3...Joint, J4...Joint, J5...Joint, J6...Joint, MP...Motion program, RP...Actual reference position, RP1...Actual reference position, RP2...Actual reference position, RP3...Actual reference position, RP4...Actual reference position, S1...Actual reference position acquisition step, S2...First control reference position acquisition step, S3...First transformation function acquisition step, S4...Target position etc. acquisition step, S5...First control position determination step, S6...Robot control coordinate system confirmation step, S7...Second control reference position acquisition step, S8...Second transformation function acquisition step, S9...Second control position determination step, S10...Robot control step, TCP...Control point

Claims

1. A control method for determining the control position of a robot relative to its target position, A step to acquire actual reference positions in an ideal coordinate system of three or more points, A first control reference position acquisition step, which involves acquiring a first control reference position in a first robot control coordinate system when the control points of the robot are located at each of the actual reference positions, Based on the actual reference position and the first control reference position, the first robot control coordinate system A first transformation function acquisition step involves obtaining a first transformation function that represents the correspondence between the control position and the target position in the ideal coordinate system, A control method characterized by including a control position determination step of converting the control position in the first robot control coordinate system to the target position in the ideal coordinate system using the first transformation function, and determining a new control position in the new robot control coordinate system based on the target position.

2. The control method according to claim 1, wherein the control position in the first robot control coordinate system is directly set in the first robot control coordinate system.

3. When the robot control coordinate system used to set the control position is changed from the first robot control coordinate system to the second robot control coordinate system, Prior to the control position determination step, A second control reference position acquisition step for acquiring the second control reference position in the second robot control coordinate system when the control point is located at the actual reference position, The step includes obtaining a second transformation function, which obtains a second transformation function that transforms the target position in the ideal coordinate system into the control position in the second robot control coordinate system, based on the actual reference position and the second control reference position. The control method according to claim 1, wherein in the control position determination step, the control position in the first robot control coordinate system is converted to the target position in the ideal coordinate system using the first transformation function, and then converted to the new control position in the second robot control coordinate system using the second transformation function.

4. The control method according to claim 1, in the control position determination step, the relative movement amount, which is the amount of movement from a predetermined position, is added to the target position converted in the control position determination step to determine a new control position.

5. The control method according to claim 1, wherein in the first transformation function acquisition step, at least one figure having three or more of the actual reference positions as vertices is set in the ideal coordinate system, and the first transformation function representing the correspondence between the target position and the control position within the figure is obtained.

6. A robot system comprising a robot and a control device that controls the driving of the robot, wherein the control device determines the control position of the robot relative to a target position, The control device acquires the actual reference position in three or more ideal coordinate systems, The first control reference position in the first robot control coordinate system is obtained when the control points of the robot are located at each of the actual reference positions. Based on the actual reference position and the first control reference position, a first transformation function is obtained that represents the correspondence between the control position in the first robot control coordinate system and the target position in the ideal coordinate system. A robot system characterized by converting the control position in the first robot control coordinate system to the target position in the ideal coordinate system using the first transformation function, and determining a new control position in the new robot control coordinate system based on the target position.

Citation Information

Patent Citations

  • Robot system, robot control device, and robot control method

    JP2018134695A

  • Method of determining control position of robot, and robot system

    JP2022100627A