Robot system

This application is based on Japanese Patent Application No. 2019-100293, the contents of which are incorporated herein by reference.

The present disclosure relates to robot systems.

A known technology involves detecting a torque acting on a robot and stopping the robot when the detected torque exceeds an upper limit value (e.g., see Japanese Patent No. 5927284).

An aspect of the present disclosure provides a robot system including a robot and a control device that controls the robot. The robot includes a first member, a second member that is rotationally driven around a predetermined first axis relative to the first member, and a first torque detector that detects a torque around the first axis, and the control device includes an external-force upper-limit-value estimator that estimates an external-force upper limit value serving as an assumable upper limit value for an external force acting on the second member based on the torque detected by the first torque detector, and controls the robot to avoid an increase in the external force when the estimated external-force upper limit value is larger than a predetermined threshold value.

FIG. 1 illustrates the overall configuration of a robot system according to an embodiment of the present disclosure.

FIG. 2 is a block diagram illustrating a control device included in the robot system in FIG. 1 .

FIG. 3 is a side view of a robot included in the robot system in FIG. 1 and illustrates an example of external-force upper limit values around a J 1 axis to a J 3 axis of the robot.

FIG. 4 is a plan view of the robot and explains an external-force upper limit value in a modification of the robot system in FIG. 1 .

FIG. 5 is a side view of the robot in the robot system in FIG. 4 .

FIG. 6 is a diagram explaining a method for calculating a combined external force from external-force upper limit values for shafts estimated in the robot system in FIGS. 4 and 5 .

FIG. 7 is a side view of the robot and explains an external-force upper limit value in another modification of the robot system in FIG. 1 .

FIG. 8 is a front view of a wrist unit of the robot in the robot system in FIG. 7 .

FIG. 9 is a diagram explaining a method for calculating a combined external force from external-force upper limit values for shafts estimated in the robot system in FIGS. 7 and 8 .

FIG. 10 is a side view of the robot and explains a method for estimating an external-force upper limit value in a modification of the robot system in FIG. 1 .

FIG. 11 is a side view of the robot and explains a method for estimating an external-force upper limit value in an orientation different from that in FIG. 4 .

FIG. 12 is a side view of the robot and explains a specific orientation of the robot in the robot system in FIG. 1 .

FIG. 13 is a side view of the robot and illustrates a modification of the robot in the robot system in FIG. 1 .

FIG. 14 is an expanded front view of the robot and illustrates another modification of the robot in the robot system in FIG. 1 .

A robot system 1 according to an embodiment of the present disclosure will be described below with reference to the drawings. As shown in FIG. 1 , the robot system 1 according to this embodiment includes a robot 2 and a control device 3 that controls the robot 2 .

The robot 2 includes a base (third member) 4 set on a floor surface G, and also includes a rotating body (first member) 5 supported by the base 4 in a rotatable manner around a vertical J 1 axis (second axis) A. The robot 2 includes a first arm (second member) 6 supported by the rotating body 5 in a rotatable manner around a horizontal J 2 axis (first axis) B, and also includes a second arm (fourth member) 7 supported by the first arm 6 in a rotatable manner around a J 3 axis (third axis) C extending parallel to the J 2 axis B.

The robot 2 includes a three-axis wrist unit 8 at the distal end of the second arm 7 . The wrist unit 8 includes a first wrist component 9 supported by the second arm 7 in a rotatable manner around a J 4 axis D extending in the longitudinal direction of the second arm 7 . The wrist unit 8 includes a second wrist component 10 supported by the first wrist component 9 in a rotatable manner around a J 5 axis E extending orthogonally to the J 4 axis D. The wrist unit 8 includes a third wrist component 11 supported by the second wrist component 10 in a rotatable manner around a J 6 axis F extending orthogonally to the J 5 axis E and through an intersection point between the J 4 axis D and the J 5 axis E.

The robot 2 according to this embodiment includes a torque sensor (second torque detector) 12 that is disposed between the floor surface G and the base 4 and that detects a torque around the J 1 axis A. The robot 2 includes a torque sensor (first torque detector) 13 that detects a torque around the J 2 axis B between the rotating body 5 and the first arm 6 . The robot 2 includes a torque sensor (third torque detector) that detects a torque around the J 3 axis C between the first arm 6 and the second arm 7 .

The control device 3 is constituted by a processor and a memory. As shown in FIG. 2 , the control device 3 includes a controller 15 that outputs a command signal to the robot 2 in accordance with a learned program. The control device 3 includes a torque calculator 16 that receives the position (orientation) of a tool tip of the robot 2 and the speed (movement) of each shaft from the controller 15 , and that successively calculates torque values acting around the J 1 axis A to the J 3 axis C in accordance with the orientation and the movement.

The control device 3 includes a differential torque calculator 17 that receives a torque value detected by each of the torque sensors 12 , 13 , and 14 and that calculates, for each shaft, an absolute value of a differential torque value indicating a difference between the received torque value and a torque value calculated by the torque calculator 16 in accordance with the orientation of the robot 2 and the speed and acceleration of each driver. Moreover, the control device includes an external-force upper-limit-value estimator 18 that estimates an external-force upper limit value Pa, as an assumable upper limit value for an external force P acting on the robot 2 , based on the calculated differential torque value.

The external-force upper-limit-value estimator 18 stores, for each shaft, a minimum radius from an axis at a physically contactable position, due to the structure of the robot 2 , on a surface disposed at each of the opposite ends, in the rotational direction, of any of two of the members 4 , 5 , 6 , and 7 relatively rotated around the axes A, B, and C.

For example, with regard to the rotating body 5 rotated around the J 1 axis A relative to the base 4 , the radius at a position closest to the J 1 axis A on a surface extending in the radial direction of the rotating body 5 , and having a possibility that an operator may physically come into contact therewith, and in the direction of the J 1 axis A is stored. For example, as shown in FIG. 3 , in a case where the rotating body 5 has a conical outer surface centered on the J 1 axis A, a radius R 1 from the J 1 axis A on a surface where the cross section is the smallest is stored.

For example, with regard to the first arm 6 rotated around the J 2 axis B relative to the rotating body 5 , the radius at a position closest to the J 2 axis B on a surface extending in the radial direction of the first arm 6 , and having a possibility that an operator may physically come into contact therewith, and in the direction of the J 2 axis B is stored. For example, as shown in FIG. 3 , in a case where the first arm 6 includes an end 6 a having a cylindrical outer surface centered on the J 2 axis B and an arm 6 b extending radially outward from the surface of the end 6 a , a radius R 2 from the J 2 axis B at the base of the arm 6 b , that is, a radius R 2 on the outer surface of the end 6 a , is stored.

For example, with regard to the second arm 7 rotated around the J 3 axis C relative to the first arm 6 , the radius at a position closest to the J 3 axis C on a surface extending in the radial direction of the second arm 7 , and having a possibility that an operator may physically come into contact therewith, is stored. For example, as shown in FIG. 3 , in a case where the second arm 7 includes an end 7 a having a cylindrical outer surface centered on the J 3 axis C and an arm 7 b extending radially outward from the surface of the end 7 a , a radius R 3 from the J 3 axis C at the base of the arm 7 b , that is, a radius R 3 on the outer surface of the end 7 a , is stored.

The external-force upper-limit-value estimator 18 divides the absolute value of the differential torque calculated by the differential torque calculator 17 by each stored minimum radius, so as to calculate the external-force upper limit value Pa. Specifically, if there is a differential torque calculated by the differential torque calculator 17 , it is clear that there is an external force P acting on some location on the surface of the robot 2 with respect to a shaft where the differential torque exists.

Since it is not possible to specify the location receiving the external force P, it is not possible to determine the magnitude of the actual external force P based on the magnitude of the differential torque alone. However, by dividing the differential torque by each of the minimum radii R 1 , R 2 , and R 3 at the physically contactable positions, each of maximum values P 1 , P 2 , and P 3 for an external force that may be generated as a result of the contact can be determined as an external-force upper limit value Pa.

Then, the controller 15 compares the external-force upper limit value Pa estimated by the external-force upper-limit-value estimator 18 with a predetermined threshold value. When the external-force upper limit value Pa is larger than the predetermined threshold value, the controller 15 controls the robot 2 to stop or retract. In ISO/TS 15066, a threshold value for a biodynamical load that an operator can withstand without being injured when the robot 2 and the operator come into contact with each other is set for each contactable part of the operator's body. The controller 15 stores the smallest value among these threshold values as a threshold value and determines whether or not the calculated external-force upper limit value Pa is larger than the threshold value.

The stopping operation or the retracting operation of the robot 2 performed by the controller 15 is for preventing the external-force upper limit value Pa from increasing. Specifically, the stopping operation involves stopping the robot 2 at that location, and the retracting operation involves moving the robot 2 in a direction for alleviating the external force, such as the direction opposite to that of the previous movement.

In the robot system 1 according to this embodiment having the above-described configuration, with respect to the external force that can generate the torque detected by each of the torque sensors 12 , 13 , and 14 , the external-force upper limit value Pa acting on the physically contactable position with the minimum radius is compared with the predetermined threshold value. Specifically, in a case where a significant torque is detected by the torque sensor 12 , 13 , or 14 , it is regarded that an external force P having the magnitude of the external-force upper limit value Pa is acting on the physically contactable position with the minimum radius.

Accordingly, for example, the actual load applied to the operator when the operator comes into contact with the robot 2 is reliably smaller than or equal to the external-force upper limit value Pa. Specifically, the robot system 1 according to this embodiment is advantageous in that the robot 2 can be reliably stopped or retracted before the operator receives a biodynamical load that the operator can withstand without being injured.

The external-force upper limit value Pa can be estimated more securely by storing an even smaller value as a minimum radius value. However, this is not preferable since the external-force upper limit value Pa is set too much toward the safe side to an extent that the robot 2 is stopped or retracted even when an extremely small external force P is applied to a position distant from the axis A, B, or C.

In this embodiment, the external-force upper limit values P 1 , P 2 , and P 3 are calculated for the respective shafts, and each are compared with the threshold value. Alternatively, for example, in a case where a torque around the J 1 axis A is detected by the torque sensor 12 and a torque around the J 2 axis B disposed in a plane extending orthogonally to the J 1 axis A is detected by the torque sensor 13 , the external-force upper limit value Pa may be estimated as follows.

Specifically, an external-force upper limit value (second external-force upper-limit value) P 1 is calculated in accordance with the above-described method based on the torque around the J 1 axis A, an external-force upper limit value (first external-force upper-limit value) P 2 is calculated in accordance with the above-described method based on the torque around the J 2 axis B, and the two calculated external-force upper-limit values are combined. Accordingly, the combined external-force upper limit value (combined external force) Pa may be calculated using the expression indicated below:

Pa =√( P 1 2 +P 2 2 )  (1)

where Pa denotes the combined external-force upper limit value, P 1 denotes the external-force upper limit value around the J 1 axis A, and P 2 denotes the external-force upper limit value around the J 2 axis B.

For example, as shown in FIGS. 4 and 5 , an orthogonal coordinate system with respect to the robot 2 is conceptualized. Then, it is assumed that an external force component F 1 in a horizontal plane, as shown in FIG. 4 , and an external force component F 2 in a vertical plane, as shown in FIG. 5 , are applied as an external force to the first arm 6 of the robot 2 .

In this case, as shown in FIG. 4 , the external-force upper limit value P 1 is estimated from the torque around the J 1 axis A detected by the torque sensor 12 . It is conceivable that the external-force upper limit value P 1 acts in an arbitrary direction in the Fx-Fy plane. As shown in FIG. 5 , the external-force upper limit value P 2 is estimated from the torque around the J 2 axis B detected by the torque sensor 13 . It is conceivable that the external-force upper limit value P 2 acts in an arbitrary direction in the Fx-Fz plane.

Therefore, in this case, the combined external-force upper limit value Pa can be calculated in accordance with the root sum square of the external-force upper limit values P 1 and P 2 indicated in Expression (1), as shown in FIG. 6 . Although the above description relates to an example where the torque around the J 1 axis A and the torque around the J 2 axis B are detected, the embodiment is not limited to this example.

For example, as shown in FIGS. 7 and 8 , the same applies to a case where a torque sensor (not shown) that detects a torque around the J 4 axis D and a torque sensor (not shown) that detects a torque around the J 5 axis E are provided. Specifically, an external-force upper limit value P 1 estimated from the torque around the J 4 axis D detected by the corresponding torque sensor acts in an arbitrary direction in the Fx-Fy plane, as shown in FIG. 8 .

An external-force upper limit value P 2 estimated from the torque around the J 5 axis E detected by the corresponding torque sensor acts in an arbitrary direction in the Fx-Fz plane, as shown in FIG. 7 . The J 4 axis D and the J 5 axis E extend along planes that are orthogonal to each other. Therefore, in this case, the combined external-force upper limit value Pa can be similarly calculated in accordance with the root sum square of the external-force upper limit values P 1 and P 2 indicated in Expression (1), as shown in FIG. 9 .

Although the above description relates to an example where the torques around the two adjacent axes B and C among the axes A, B, C, D, E, and F of the robot 2 are detected, the embodiment is not limited to this example. For example, torques around two non-adjacent axes among the axes A, B, C, D, E, and F, such as the J 1 axis A and the J 3 axis C or the J 2 axis B and the J 4 axis D, may be detected and combined.

In a case where a torque around the J 2 axis B and a torque around the J 3 axis C extending parallel to the J 2 axis B are detected, an external-force upper limit value P 2 is calculated in accordance with the above-described method based on the torque around the J 2 axis B, and an external-force upper limit value (third external-force upper limit value) P 3 is calculated in accordance with the above-described method based on the torque around the J 3 axis C. Then, for example, an external-force upper limit value Pa based on the J 1 axis A may be estimated from the calculated first external-force upper limit value P 2 and third external-force upper limit value P 3 .

In a case where a torque around the J 2 axis B and a torque around the J 3 axis C extending parallel to the J 2 axis B are detected, an external-force upper limit value P 2 is calculated in accordance with the above-described method based on the torque around the J 2 axis B, and an external-force upper limit value (third external-force upper limit value) P 3 is calculated in accordance with the above-described method based on the torque around the J 3 axis C. Then, the calculated first external-force upper limit value P 2 and third external-force upper limit value P 3 are compared with each other, and the smaller one of the values may be estimated as an external-force upper limit value Pa.

Specifically, as shown in FIGS. 10 and 11 , in a case where an external force acts on the distal end of the second arm 7 , torques acting in the same direction around the J 2 axis B and the J 3 axis C that are parallel to each other are detected. The two external-force upper limit values P 2 and P 3 calculated based on the two detected torques are both used for estimating the same external force and each are an assumable maximum value, so that the smaller one of the values serves as a value closer to the actual external force P.

Therefore, in the case of FIG. 10 , the external-force upper limit value P 2 calculated based on the torque around the J 2 axis B may be estimated as an external-force upper limit value Pa, and in the case of FIG. 11 , the external-force upper limit value P 3 calculated based on the torque around the J 3 axis C may be estimated as an external-force upper limit value Pa. Accordingly, the external force P can be estimated more accurately.

In this embodiment, the external-force upper limit value Pa is calculated by using a minimum radius at a physically contactable position due to the structure of the robot 2 . Alternatively, as in a case where the robot 2 is partially covered or surrounded by a safety fence, the embodiment may be applied to a case where a physically non-contactable position occurs due to the cover or the safety fence.

If there is a section not contactable from the outside by the operator due to the installation environment of the robot 2 , a minimum radius in a range where the robot 2 is contactable may be used. An example of a case where there is a non-contactable section due to the installation environment is a case where the operator is restricted from approaching a specific section of the robot 2 by, for example, a sensor.

As shown in FIG. 12 , in a case where the external force P acts in a direction extending along a line orthogonal to the J 2 axis B and the J 3 axis C in a plane including the J 1 axis A, the torques around the J 1 axis A to the J 3 axis C are all small. Specifically, such an orientation of the robot 2 is an orientation (specific orientation) where it is difficult for all the torque sensors 12 , 13 , and 14 to detect torques.

In this embodiment, since the estimation of an external-force upper limit value Pa is assumed based on the fact that a torque is detectable, the control device 3 may determine whether or not the robot 2 is in the specific orientation from the angle of each driver of the robot 2 , and may restrict the robot 2 from moving when the robot 2 is determined as being in the specific orientation. The robot 2 may be restricted from moving by reducing the operating speed to a predetermined speed or lower. Another alternative is to restrict the robot 2 from moving in the direction of an external force P that causes the torque detection by the torque sensors 12 , 13 , and 14 to be difficult.

As an alternative to this embodiment in which the robot 2 is of a vertical articulated type, a horizontal articulated robot may be employed. As an alternative to this embodiment in which the torque sensors 12 , 13 , and 14 are described as torque detectors that detect torques, the torques may each be estimated by detecting an electric current of a motor that drives each component. In a case where a secondary encoder is provided, the torques may each be estimated based on angle information detected by the secondary encoder.

As an alternative to the robot 2 of a six-axis articulated type, the embodiment may be applied to a seven-axis articulated robot 20 . In this case, as shown in FIG. 13 , torque sensors 12 , 13 , 14 , and 22 that detect torques around a J 1 axis A 1 to a J 4 axis D 1 may be disposed. Reference sign 21 denotes a third arm supported by the second arm 7 in a rotatable manner around the J 4 axis D 1 extending parallel to the J 3 axis C 1 .

In this case, the first wrist component 9 is supported by the third arm 21 in a rotatable manner around a J 5 axis E 1 extending in the longitudinal direction of the third arm 21 . The second wrist component 10 is supported by the first wrist component 9 in a rotatable manner around a J 6 axis F 1 extending orthogonally to the J 5 axis E 1 . The third wrist component 11 is supported by the second wrist component 10 in a rotatable manner around a J 7 axis H 1 extending orthogonally to the J 6 axis F 1 and through an intersection point between the J 5 axis E 1 and the J 6 axis F 1 .

Then, based on the lowest external-force upper limit value among three external-force upper limit values estimated based on torque values detected by the torque sensors 13 , 14 , and 22 and an external-force upper limit value estimated based on a torque value detected by the torque sensor 12 , the external-force upper-limit-value estimator 18 estimates an external-force upper limit value used for a comparison with the predetermined threshold value.

As an alternative to this embodiment in which the torque sensor 12 is provided in the base 4 , the torque sensor 13 is provided in the rotating body 5 , and the torque sensor 14 is provided in the first arm 6 , the torque sensor 12 may be provided in the floor surface G, the torque sensor 13 may be provided in the first arm 6 , and the torque sensor 14 may be provided in the second arm 7 . Specifically, by adjusting the torque calculation method in the torque calculator 16 , each torque sensor may be disposed in either one of two drivers that move relatively in accordance with rotation around each of the axes A, B, and C.

For example, in a case where the first arm 6 and the second arm 7 are used as two drivers, the torque sensor 14 , a motor 23 that drives the second arm 7 around the J 3 axis C, and a speed reducer 24 are disposed in the first arm 6 and the second arm 7 , as shown in FIG. 14 . In this case, the second arm 7 as a driver to be desirably made narrower is provided with the torque sensor 14 , so that the second arm 7 can be made narrower.