Collaborative robot system

The collaborative robot system accurately estimates external force positions and magnitudes using torque sensors and simultaneous equations, improving safety by identifying collision points and stopping the robot if necessary.

JP2024164671APending Publication Date: 2024-11-27NACHI FUJIKOSHI CORP
View PDF 1 Cites 0 Cited by

Patent Information

Application Number
JP2023080329
Authority / Receiving Office
JP · JP
Patent Type
Applications
Current Assignee / Owner
Filing Date
2023-05-15
Publication Date
2024-11-27

AI Technical Summary

Technical Problem

Existing collaborative robot systems struggle to accurately estimate the position and magnitude of external forces applied during collisions, as torque sensors alone cannot differentiate between forces near or far from the center of rotation, and force sensors have limited detection locations.

Method used

A collaborative robot system equipped with torque sensors on each axis, a position detection unit, and a robot controller that calculates link parameters and solves simultaneous equations to estimate the position and magnitude of external forces using a multi-axis robot configuration.

Benefits of technology

Enables precise estimation of external force positions and magnitudes, enhancing safety by determining collision points and potentially stopping the robot if forces exceed a reference value.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 2024164671000001_ABST
    Figure 2024164671000001_ABST
Patent Text Reader

Abstract

To provide a collaborative robot system capable of estimating position and strength of an external force a robot receives and improving safety.SOLUTION: A collaborative robot system 100 has: a robot 102 having a plurality of arms; a position detection part 120 and a torque sensor 118 provided on each axis of the robot; a link parameter storage part 122 storing a link parameter including length of each arm; each axis position calculation part 124 which uses an axis position and the link parameter to calculate a position of each shaft in order from an axis near an installation surface of a multi-axis robot; and an external force estimation part 126. The external force estimation part decomposes torque of each shaft detected by the torque sensor into a three-dimensional axis rotational component on the basis of a position of each axis calculated by the each axis position calculation part, builds up an equation with a position and size of the external force every axis as unknown numbers every axis rotational component, and solves it as a simultaneous equation to estimate a position and size of the external force received by the multi-axis robot.SELECTED DRAWING: Figure 2
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] The present invention relates to a collaborative robot system with safety features. [Background technology]

[0002] Safety measures are required for industrial robots that share a working area with humans, so-called collaborative robots. As a safety standard required for collaborative robots, the technical specification ISO / TS15066 referenced by ISO10218-1 stipulates the safe "force" when in contact (collision) with each part of the human body.

[0003] Collaborative robots generally use multi-axis robots with multiple arms, and each axis is provided with a torque sensor to detect torque, for example. Torque is a value obtained by multiplying the length from the center of rotation by the "force." For this reason, a collaborative robot equipped with a torque sensor cannot distinguish whether a strong force is received at a position close to the center of rotation or a weak force is received at a position far from the center of rotation, even if the torque is the same.

[0004] Patent Document 1 describes a robot system in which a torque sensor is provided at at least one of the joints (axes) of the robot to detect torque around a rotation axis. In this robot system, the torque sensor detects force components in the directions of the X-axis, Y-axis, and Z-axis, and torque components acting around the rotation axis, thereby detecting external forces acting on the robot. It also describes that a force sensor may be used instead of the torque sensor. [Prior art documents] [Patent documents]

[0005] [Patent Document 1] Patent Publication No. 2022-15850 Summary of the Invention [Problem to be solved by the invention]

[0006] However, the robot system of Patent Document 1 only detects the force and moment applied to the robot using a torque sensor or a force sensor. Therefore, when a torque sensor is used, there is a problem that it is not possible to estimate the position where the external force was applied (collision position) or the force. In addition, when a force sensor is used for detection, although it is possible to detect the force, there is a problem that the location where the force is applied is limited in the first place.

[0007] In view of the above problems, the present invention aims to provide a collaborative robot system that can estimate the position and magnitude of an external force applied to a robot, thereby improving safety. [Means for solving the problem]

[0008] In order to solve the above problems, a representative configuration of a collaborative robot system according to the present invention includes a multi-axis robot having a plurality of arms, a position detection unit provided on each axis of the multi-axis robot, a torque sensor provided on each axis of the multi-axis robot and detecting the torque of each axis, and a robot control device that controls the operation of the multi-axis robot, wherein the robot control device has a link parameter storage unit that stores link parameters including the length of each arm, an axis position calculation unit that calculates the position of each axis, starting from the axis closest to the installation surface of the multi-axis robot, using the axis position detected by the position detection unit and the link parameters read from the link parameter storage unit, and an external force estimation unit that estimates the position and magnitude of an external force received by the multi-axis robot, wherein the external force estimation unit resolves the torque of each axis detected by the torque sensor into three-dimensional axis rotation components based on the positions of each axis calculated by the axis position calculation unit, and formulates an equation for each axis rotation component in which the position and magnitude of the external force for each axis are unknowns, and estimates the position and magnitude of the external force by solving these as simultaneous equations.

[0009] The robot control device preferably includes a collision determination unit that transmits a stop command to the multi-axis robot when the external force exceeds a reference value. Effect of the Invention

[0010] According to the present invention, it is possible to provide a collaborative robot system capable of estimating the position and magnitude of an external force applied to a robot and thereby improving safety. [Brief description of the drawings]

[0011] [Figure 1] 1 is a diagram illustrating an overall configuration of a collaborative robot system according to an embodiment of the present invention. [Diagram 2] FIG. 2 is a functional block diagram of the collaborative robot system of FIG. 1. [Diagram 3] 2 is a flowchart showing the operation of the collaborative robot system of FIG. 1. [Figure 4] 2A to 2C are diagrams illustrating a method for estimating the position and magnitude of an external force by the collaborative robot system of FIG. 1. [Diagram 5] FIG. 2 is a diagram showing a specific example in which the collaborative robot system of FIG. 1 estimates the position and magnitude of an external force from the torque between axes in the same rotation direction. [Figure 6] FIG. 2 is a diagram showing a case where another robot is applied to the collaborative robot system in FIG. 1. [Figure 7] 4 is a flowchart showing exception processing in FIG. 3. [Figure 8] FIG. 11 is a functional block diagram of a collaborative robot system according to another embodiment of the present invention. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0012] A preferred embodiment of the present invention will be described in detail below with reference to the accompanying drawings. The dimensions, materials, and other specific values ​​shown in the embodiment are merely examples for facilitating understanding of the invention, and do not limit the present invention unless otherwise specified. In this specification and drawings, elements having substantially the same functions and configurations are given the same reference numerals to avoid repeated explanations, and elements not directly related to the present invention are not shown.

[0013] 1 is a diagram showing a schematic diagram of the overall configuration of a collaborative robot system 100 according to an embodiment of the present invention. The collaborative robot system 100 is an industrial robot system in which a worker H and a robot 102 share a working area, and includes the robot 102, a robot controller 104, and a teaching pendant 106. The teaching pendant 106 is a device connected to the robot controller 104, and is used to operate the robot 102 and display various information.

[0014] The robot 102 is a multi-axis robot whose operation is controlled by a robot control device 104, and includes, for example, a rotating frame 108, a first arm 110, a second arm 112, and an end effector 114. The end effector 114 is, for example, a hand or gripper that grasps an object to be grasped.

[0015] The first arm 110 of the robot 102 is rotatably connected to the rotating frame 108 via a J2 axis. The second arm 112 is rotatably connected to the first arm 110 via a J3 axis. The end effector 114 is rotatably connected to the second arm 112 via a J5 axis.

[0016] Each axis of the robot 102, i.e., the J2 axis, the J3 axis, and the J5 axis, is provided with a torque sensor 118 (see FIG. 2) that detects torque. Torque is a value obtained by multiplying the length from the center of rotation by the "force." For this reason, when the worker H comes into contact with the robot 102 (at the time of collision), even if the torque detected by the torque sensor 118 is the same as described above, it is not possible to determine whether the worker H received a strong force at a position close to the center of rotation or a weak force at a position far from the center of rotation.

[0017] Therefore, the collaborative robot system 100 according to the present embodiment employs a configuration that improves safety for the worker H by estimating the collision position and magnitude of the external force applied to the robot 102.

[0018] Fig. 2 is a functional block diagram of the collaborative robot system 100 in Fig. 1. The robot 102 has a torque sensor 118 and a position detection unit 120. The torque sensor 118 detects the torque of each axis. The position detection unit 120 is an encoder, and detects the current position using the rotation angle of each axis of the robot 102. The position detection unit 120 is provided on each axis of the robot 102.

[0019] The robot control device 104 has a link parameter storage unit (storage unit 122), an axis position calculation unit 124, and an external force estimation unit 126. The storage unit 122 stores link parameters that are design parameters for the length and positional relationship of each arm.

[0020] The axis position calculation unit 124 calculates the position of each axis. Specifically, the axis position calculation unit 124 calculates the position of each axis, starting from the axis closest to the installation surface of the multi-axis robot 102 (i.e., the axis closest to the rotating frame 108), using the axis position detected by the position detection unit 120 and the link parameters read from the storage unit 122. Note that the position of each axis calculated by the axis position calculation unit 124 also includes the attitude (direction) of each axis.

[0021] The external force estimation unit 126 acquires the torque of each axis detected by the torque sensor 118 and the position of each axis calculated by the axis position calculation unit 124, and estimates the position and magnitude of the external force received by the robot 102 when the worker H contacted the robot 102 based on these (described later). The teaching pendant 106 also has a display unit 120. The display unit 120 displays the position and magnitude of the external force estimated by the external force estimation unit 126.

[0022] Fig. 3 is a flowchart showing the operation of the collaborative robot system 100 in Fig. 1. Fig. 4 is a diagram for explaining a method for estimating the position and magnitude of an external force by the collaborative robot system 100 in Fig. 1.

[0023] In the collaborative robot system 100, first, the robot control device 104 sets the axis number to "0" (step S100), and determines whether processing of all axes has been completed based on whether the axis number is smaller than the total number of axes of the robot 102 (step S102). If processing has not been completed (if the axis number is smaller than the total number of axes of the robot 102) (No), processing of step S104 is performed.

[0024] In step S104, each axis position calculation unit 124 calculates the X-, Y-, and Z-axis spatial position (JnPosX, JnPosY, JnPosZ) of the axis and the X-, Y-, and Z-axis rotation components (JnRotX, JnRotY, JnRotZ) of the axis using the current position of the axis detected by position detection unit 120 and the link parameters read from memory unit 122. In this manner, each axis position calculation unit 124 calculates the position including the attitude (direction) of the axis.

[0025] Next, the external force estimation unit 126 acquires the torque (JnTrq) of the axis detected by the torque sensor 118 (step S108). Furthermore, the external force estimation unit 126 resolves the torque (JnTrq) of the axis into three-dimensional axis rotation components based on the XYZ spatial position (JnPosX, JnPosY, JnPosZ) that is the position of the axis calculated by each axis position calculation unit 124, as shown in Fig. 4, and calculates the torque components (JnTrqX, JnTrqY, JnTrqZ) along the X-axis, Y-axis, and Z-axis (step S110). The axis rotation includes the X-axis rotation (roll), the Y-axis rotation (pitch), and the Z-axis rotation (yaw).

[0026] After step S110, the robot control device 104 increments the axis number (step S112), returns to the processing of step S102, and determines whether or not the processing of all axes has been completed. If the processing is completed (Yes), the robot control device 104 performs the processing of step S114.

[0027] In step S114, the robot control device 104 determines whether or not the processing has been completed for all rotational components. If the processing has not been completed (No), the external force estimation unit 126 performs the subsequent processing.

[0028] First, the external force estimation unit 126 formulates an equation with the position and magnitude of the external force as unknowns for each three-dimensional axial rotation component (JnTrqX, JnTrqY, JnTrqZ) of the torque (JnTrq) of each axis of the robot calculated in step S108, and solves this as simultaneous equations (step S116).

[0029] Next, the external force estimation unit 126 determines whether the simultaneous equations have a solution (step S118), and if the solution is found (Yes), obtains the position (collision position) and magnitude of the external force for each rotation received by the robot 102 (step S120). On the other hand, if the solution is not found in step S118 (No), the external force estimation unit 126 executes exception processing (see FIG. 7) in step S122 (described later).

[0030] Here, the processing of steps S116 and S120 by the external force estimation unit 126 will be specifically described. Fig. 5 is a diagram showing a specific example in which the position and magnitude of an external force are estimated from the torque between axes in the same rotation direction by the collaborative robot system 100 of Fig. 1. In the figure, the distance x from the origin O to the collision position of the external force and the magnitude f of the external force are set as unknowns.

[0031] 5(a), the torques of the J2, J3, and J5 axes detected by the torque sensor 118 are 50 Nm, 80 Nm, and 10 Nm, respectively. The distances between the centers of the J2 and J3 axes, and the distances between the centers of the J2 and J5 axes are 0.3 m and 0.4 m, respectively. The distances between the centers of the axes can be calculated from the link parameters and the axis angles.

[0032] From these conditions, the following three equations can be formulated for each axis of the robot, with the position of the external force (the distance x from the origin O to the collision point of the external force) and its magnitude f as unknowns. J2:xf=50 J3:(x+0.3)f=80 J5:(x-0.4)f=10

[0033] By solving these three equations as simultaneous equations, we can obtain the values ​​f = 100 N and x = 0.5 m. Since x = 0.5 m, it can be seen that the robot 102 receives an external force of magnitude 100 N at the end effector 114, which is located 0.1 m ahead of the J5 axis, as shown in Figure 5(a).

[0034] In the robot 102 shown in Fig. 5(b), the torques of the J2 axis, J3 axis, and J5 axis detected by the torque sensor 118 are 50 Nm, 125 Nm, and 0 Nm, respectively. Since the torque of the J5 axis is 0 Nm, there is no load beyond the J5 axis. The distance between the axis centers of the J2 axis and the J3 axis, and the distance between the axis centers of the J2 axis and the J5 axis are 0.3 m and 0.4 m, respectively.

[0035] From these conditions, the following two equations can be formulated for each axis of the robot, with the position of the external force (the distance x from the origin O to the collision point of the external force) and its magnitude f as unknowns. J2:xf=50 J3:(x+0.3)f=125

[0036] By solving these two equations as simultaneous equations, we can obtain the values ​​f = 250 N and x = 0.2 m. Since x = 0.2 m, it can be seen that the robot 102 receives an external force of 250 N at the second arm 112, which is located 0.5 m ahead of the J3 axis, as shown in Figure 5(b).

[0037] In this way, the external force estimation unit 126 can estimate the position and magnitude of the external force received by the robot 102 through the processing of steps S116 and S120. After step S120, the robot control device 104 returns to the processing of step S114 again to determine whether or not the processing has been completed for all rotational components, and when the processing is completed (Yes), ends the operation.

[0038] FIG. 6 is a diagram showing a case where other robots 102A and 102B are applied to the collaborative robot system 100 of FIG.

[0039] 6(a) is a six-axis robot, with the J1 axis rotating about the Z axis (yaw) and the J2 and J3 axes rotating about the Y axis (pitch). Furthermore, in the robot 102A, whether the rotation of the J4, J5, and J6 axes is a yaw or pitch depends on the axis in front.

[0040] Therefore, when a six-axis robot (robot 102A) is applied to collaborative robot system 100, if the axial rotation of the J4, J5, and J6 axes of robot 102A is determined by the axes in front of the J4, J5, and J6 axes, the position and magnitude of the external force received by robot 102A can be estimated, except for the exception handling described below (see FIG. 7).

[0041] 6(b) is a 7-axis robot, with the J1 axis rotating around the Z axis (yaw) and the J2 axis rotating around the Y axis (pitch). Furthermore, in the robot 102A, whether the rotation of the J7, J3, J4, J5, and J6 axes is a yaw or pitch depends on the axis in front.

[0042] Therefore, when a 7-axis robot (robot 102B) is applied to collaborative robot system 100, if the axial rotation of the J7, J3, J4, J5 and J6 axes is determined by the axes before the J7, J3, J4, J5 and J6 axes of robot 102B, the position and magnitude of the external force received by robot 102B can be estimated, except for the exception handling described below (see FIG. 7).

[0043] Fig. 7 is a flowchart showing the exception processing in Fig. 3. The external force estimating unit 126 executes exception processing when the simultaneous equations have no solution in step S116 or when the simultaneous equations cannot be formulated.

[0044] In exception handling, the external force estimation unit 126 determines whether there is only one axis in front of the point of action (collision position) although there are rotational components on multiple axes as shown in Fig. 7 (step S124). In other words, when there is only one axis on which torque is generated, simultaneous equations cannot be formulated because only one equation can be formulated. If there is only one axis in front in step S124 (Yes), the external force estimation unit 126 identifies the "range" of the external force and the collision position (step S126).

[0045] As an example of step S126, if the torques detected on the J2 and J3 axes are J2>>0 Nm and J3≈0 Nm, it is found that the point of application exists on the first arm 110 between the J2 and J3 axes. In other words, the range of the point of application can be identified.

[0046] If there is more than one axis in the foreground in step S124 (No), the external force estimation unit 126 determines whether multiple axes have rotational components but the positions of the axes are the same (step S128).In other words, even if torque is generated on multiple axes, if the positions of the axes are the same, the torque values ​​will be different but the position values ​​will be the same, and the simultaneous equations will not have a solution.

[0047] Therefore, if the shaft positions are the same in step S128 (Yes), the external force estimation unit 126 identifies the "range" of the external force and the collision occurrence position (step S130). In step S130, it is found that the point of action is located on the tip side of the shaft that is the most distal of the shafts on which torque is generated (the shaft farthest from the J2 shaft).

[0048] On the other hand, if there are rotational components on multiple axes in step S128, but there is no force with a component in the same direction (No), only one equation can be established for each directional component. For example, this is the case when torque is detected only on the J1 axis that rotates the rotating frame 108. In this case, the point of action cannot be estimated (step S132). In this way, the external force estimation unit 126 ends the exception processing, and performs the processing of step S114 again as shown in FIG. 3, and ends the operation.

[0049] Therefore, the collaborative robot system 100 can estimate the position and magnitude of the external force applied to the robot 102, except in the case of exception handling, thereby improving safety. Even in the case of exception handling, the position and magnitude of the external force cannot be estimated, but the range of the point of action can be specified.

[0050] 8 is a functional block diagram of a collaborative robot system 100A according to another embodiment of the present invention. The collaborative robot system 100A includes a robot 102 and a robot control device 104A. The robot control device 104A differs from the robot control device 104 in that it includes a collision determination unit 130. The collision determination unit 130 receives information on the position and magnitude of an external force applied to the robot 102 from the external force estimation unit 126.

[0051] The collision determination unit 130 of the robot control device 104A compares the magnitude of the external force received by the robot 102 with a reference value, and if the magnitude of the external force exceeds the reference value, transmits a stop command to the robot 102. This can further improve safety.

[0052] Although the preferred embodiment of the present invention has been described above with reference to the accompanying drawings, it goes without saying that the present invention is not limited to such an example. It is clear that a person skilled in the art can think of various modified or altered examples within the scope of the claims, and it is understood that such examples also naturally belong to the technical scope of the present invention. [Industrial Applicability]

[0053] The present invention is applicable to collaborative robot systems with safety features. [Explanation of symbols]

[0054] 100, 100A... Collaborative robot system, 102, 102A, 102B... Robot, 104, 104A... Robot control device, 106... Teaching pendant, 108... Rotating frame, 110... First arm, 112... Second arm, 114... End effector, 118... Torque sensor, 120... Position detection unit, 122... Link parameter storage unit, 124... Each axis position calculation unit, 126... External force estimation unit, 128... Display unit, 130... Collision determination unit, H... Worker

Claims

1. A multi-axis robot having a plurality of arms; A position detection unit provided on each axis of the multi-axis robot; a torque sensor provided on each axis of the multi-axis robot and configured to detect torque of each axis; A robot control device for controlling the operation of the multi-axis robot, The robot control device includes: a link parameter storage unit that stores link parameters including the length of each arm; an axis position calculation unit that calculates the position of each axis, starting from the axis closest to an installation surface of the multi-axis robot, using the position of the axis detected by the position detection unit and the link parameters read out from the link parameter storage unit; An external force estimation unit that estimates a position and a magnitude of an external force received by the multi-axis robot, The external force estimation unit is The torque of each axis detected by the torque sensor is resolved into three-dimensional axial rotation components based on the position of each axis calculated by the axis position calculation unit; A collaborative robot system characterized in that, for each of the axial rotation components, an equation is formulated with the position and magnitude of the external force for each axis as unknowns, and the position and magnitude of the external force are estimated by solving this as a simultaneous equation.

2. 2. The collaborative robot system according to claim 1, wherein the robot control device includes a collision determination unit that transmits a stop command to the multi-axis robot when the external force exceeds a reference value.

Citation Information

Patent Citations

  • Operation method of robot system and robot

    JP2022015850A