ROBOT CONTROLLER AND ROBOT CONTROL METHOD

Abstract

A robot controller (2) configured to control a robot (1) including a plurality of joints (J.sub.1-J.sub.6) each rotatable around a rotation axis, the robot controller (2) including: an acquisition unit (21) configured to acquire a rotation angle of each of the plurality of joints (J.sub.1-J.sub.6); a determination unit (22) configured to determine whether or not the robot (1) has been in proximity to a singular configuration, based on the rotation angle of each of the plurality of joints (J.sub.1-J.sub.6); and a control unit (23) configured to control the plurality of joints (J.sub.1-J.sub.6) to be rotated not to rotate simultaneously, when the determination unit (22) determines that the robot (1) has been in proximity to the singular configuration.

Claims

1. A robot controller configured to control a robot including a plurality of joints each rotatable around a rotation axis, the robot controller comprising: an acquisition unit configured to acquire a rotation angle of each of the plurality of joints; a determination unit configured to determine whether or not the robot has been in proximity to a singular configuration, based on the rotation angle of each of the plurality of joints; and a control unit configured to control the plurality of joints to be rotated not to rotate simultaneously, when the determination unit determines that the robot has been in proximity to the singular configuration.

2. The robot controller according to claim 1, wherein the control unit is configured to be capable of rotation of the plurality of joints simultaneously, when the determination unit determines that the robot has not been in proximity to the singular configuration.

3. The robot controller according to claim 1, further comprising: an output unit configured to output an alarm, when the determination unit determines that the robot has been in proximity to the singular configuration and when the plurality of joints rotates simultaneously.

4. The robot controller according to claim 2, further comprising: an output unit configured to output an alarm, when the determination unit determines that the robot has been in proximity to the singular configuration and when the plurality of joints rotates simultaneously.

5. The robot controller according to claim 1, wherein the acquisition unit is configured to detect torque of each of the plurality of joints, and to acquire the rotation angle of each of the plurality of joints based on the torque.

6. The robot controller according to claim 1, wherein the control unit is configured to determine an order of rotating the plurality of joints in response to an instruction of a user.

7. The robot controller according to claim 1, wherein the control unit is configured to vary conditions for determining that the robot has been in proximity to the singular configuration, in response to the instruction of the user.

8. The robot controller according to claim 1, wherein the control unit is configured to stop control of rotating the plurality of joints on a one-by-one basis, in response to the instruction of the user.

9. The robot controller according to claim 1, wherein the control unit is configured to varies conditions for determining that the robot has been in proximity to the singular configuration, in response to a rotation speed of each of the plurality of joints.

10. A robot control method of controlling a robot having a plurality of joints each rotatable around a rotation axis, the robot control method comprising: acquiring a rotation angle of each of the plurality of joints; determining whether or not the robot has been in proximity to a singular configuration, based on the rotation angle of each of the plurality of joints; and controlling the plurality of joints to be rotated not to rotate simultaneously, when the determining determines that the robot has been in proximity to the singular configuration.

Description

BRIEF DESCRIPTION OF DRAWINGS

[0013] FIG. 1 is a view of an exemplary robot system according to an embodiment;

[0014] FIG. 2 is a diagram of an exemplary functional block of a robot controller according to the embodiment;

[0015] FIG. 3 is a view of an exemplary operation of a robot according to the embodiment;

[0016] FIG. 4 is a view of another exemplary operation of the robot according to the embodiment;

[0017] FIG. 5 is a flow chart of exemplary robot control method according to the embodiment; and

[0018] FIG. 6 is a view of an exemplary operation of a conventional robot.

DESCRIPTION OF THE EMBODIMENTS

[0019] One embodiment will be described below with reference to FIGS. 1 to 5. As illustrated in FIG. 1, a robot system 100 according to the present embodiment includes a robot 1 and a robot controller 2 configured to control the robot 1.

[0020] According to the present embodiment, the robot 1 includes an arm having a plurality of joints J.sub.1 to J.sub.6. The plurality of joints J.sub.1 to J.sub.6 is configured to be capable of rotating around rotation axes thereof (not illustrated).

[0021] Note that, according to the present embodiment, the robot 1 is premised on performing work in cooperation with a human so that the robot controller 2 controls power generated at tool center point P of the robot 1, to be a designated value (e.g., 150 N) or less, as described above. Here, according to the present embodiment, the tool center point P of the robot 1 is a representative point of a tool fitted to a leading end of the arm of the robot 1.

[0022] According to the present embodiment, as illustrated in FIG. 1, a multiaxial robot including the arm having the joints J.sub.1 to J.sub.6 is exemplified as the robot 1, but the number of the joints (namely, the rotation axes) is not limited to six. For example, the robot 1 may be a multiaxial robot including an arm having seven units or more of the joints (namely, the rotation axes), or a multiaxial robot including an arm having two to five units of the joints (namely, the rotation axes). According to the present embodiment, as illustrated in FIG. 1, a single-arm robot is exemplified as the robot 1, but the robot 1 may be a multi-arm robot having two or more arms.

[0023] In a case where the robot 1 has been in a singular configuration (namely, at a singularity of the robot 1), the robot controller 2 cannot calculate the power in operation direction Dx generated at the tool center point P of the robot 1.

[0024] Here, a state where the robot 1 has been in the singular configuration (at the singularity of the robot 1) means that the solution of inverse kinematics calculation is not acquired in the robot 1. The inverse kinematics calculation means that the position and the angle of each of the joints J.sub.1 to J.sub.6 are calculated based on an operation at the tool center point P of the robot 1.

[0025] The robot controller 2 is configured to control the robot 1, and includes an acquisition unit 21, a determination unit 22, a control unit 23, and an output unit 24 as illustrated in FIG. 2.

[0026] The acquisition unit 21 is configured to be capable of acquiring the rotation angle and the torque of each of the plurality of joints J.sub.1 to J.sub.6.

[0027] For example, the acquisition unit 21 may be configured to detect and acquire the rotation angle of each of the plurality of joints J.sub.1 to J.sub.6, using an encoder or a resolver, or may be configured to calculate and acquire the rotation angle of each of the plurality of joints J.sub.1 to J.sub.6 based on each rotation angle of actuators (not illustrated) that individually drive the plurality of joints J.sub.1 to J.sub.6, and the reduction ratio of a speed reducer (not illustrated).

[0028] Alternatively, the acquisition unit 21 may be configured to detect the torque at the rotation axis of each of the plurality of joints J.sub.1 to J.sub.6, so as to calculate and acquire the rotation angle of each of the plurality of joints J.sub.1 to J.sub.6 based on the torque.

[0029] The acquisition unit 21 may be configured to detect the torque at the rotation axis of each of the plurality of joints J.sub.1 to J.sub.6 based on torque sensors each provided to the plurality of joints J.sub.1 to J.sub.6.

[0030] Alternatively, the acquisition unit 21 may be configured to detect the torque at the rotation axis of each of the plurality of joints J.sub.1 to J.sub.6 based on the output torque or the current value of each of the actuators that individually drive the plurality of joints J.sub.1 to J.sub.6, and the reduction ratio of the speed reducer, or may be configured to detect the torque at the rotation axis of each of the plurality of joints J.sub.1 to J.sub.6 based on a different method.

[0031] The determination unit 22 is configured to determine whether the robot 1 has been in proximity to the singular configuration, based on the rotation angle of each of the plurality of joints J.sub.1 to J.sub.6, acquired by the acquisition unit 21.

[0032] The control unit 23 is configured to control a plurality of the joints J.sub.2 and J.sub.3 to be rotated, not to rotate simultaneously when the determination unit 22 determines that the robot 1 has been in proximity to the singular configuration.

[0033] That is, the control unit 23 is configured to control the plurality of the joints to be rotated, to rotate on a one-by-one basis when the determination unit 22 determines that the robot 1 has been in proximity to the singular configuration.

[0034] Here, the control unit 23 is configured to be capable of determine the joints to be rotated on the one-by-one basis when the determination unit 22 determines that the robot 1 has been in proximity to the singular configuration.

[0035] For example, when the determination unit 22 determines that the robot 1 has been in proximity to the singular configuration, the control unit 23 is configured to rotate the joint J.sub.2 in operation direction D1 as illustrated in FIG. 3, and then rotate the joint J.sub.3 in operation direction D2 as illustrated in FIG. 4.

[0036] According to the configuration, in a case where the robot 1 has been in proximity to the singular configuration, the plurality of the joints (the joints J.sub.2 and J.sub.3 in FIGS. 3 and 4) rotates on the one-by-one basis so that the power in the operation direction Dx that cannot be calculated, is not generated at the tool center point P of the robot 1. Therefore, the power generated at the tool center point P of the robot 1 can be calculated.

[0037] Meanwhile, the control unit 23 is configured to be capable of rotating the plurality of the joints J.sub.2 and J.sub.3 simultaneously when the determination unit 22 determines that the robot 1 has not been in proximity to the singular configuration.

[0038] According to the configuration, in a state where the robot 1 has not been in proximity to the singular configuration, the plurality of the joints J.sub.2 and J.sub.3 rotates simultaneously so that the work efficiency of the robot 1 can improve.

[0039] The control unit 23 may be configured to determine the order of rotating the plurality of the joints (the joints J.sub.2 and J.sub.3 in FIGS. 3 and 4) in response to the instruction of a user.

[0040] According to the configuration, the arm of the robot 1 can be manipulated along an orbit convenient for the user, in consideration of, for example, a jig arranged on the periphery of the robot 1.

[0041] The control unit 23 may previously sets the order of rotating the plurality of the joints (the joints J.sub.2 and J.sub.3 in FIGS. 3 and 4), and when the determination unit 22 determines that the robot 1 has been in proximity to the singular configuration, the control unit 23 may determine the order of rotating the plurality of the joints (the joints J.sub.2 and J.sub.3 in FIGS. 3 and 4) in accordance with the setting.

[0042] The control unit 23 may be configured to vary conditions for determining that the robot 1 has been in proximity to the singular configuration, in response to the instruction of the user.

[0043] The conditions may be prescribed with the position and the angle of each of the joints J.sub.1 to J.sub.6. For example, when the position and the angle of each of the joints J.sub.1 to J.sub.6 become a predetermined position and a predetermined angle, respectively, the determination unit 22 may determine that the robot 1 has been in proximity to the singular configuration.

[0044] According to the feature, the range of determining that the robot 1 has been in proximity to the singular configuration is varied in response to various states, so that further securely ensuring that the power generated at the tool center point P of the robot 1 is the designated value or less, can be made.

[0045] The control unit 23 may be configured to stop the control of rotating the plurality of the joints on the one-by-one basis, in response to the instruction of the user. That is, when stopping the control, the control unit 23 may be configured to control the plurality of the joints to be rotated, to rotate simultaneously even when the determination unit 22 determines that the robot 1 has been in proximity to the singular configuration.

[0046] According to the feature, in a case where the robot 1 has not been in cooperation with the human, the robot 1 can perform a normal operation so that the operation speed of the robot 1 can be accelerated.

[0047] Furthermore, the control unit 23 may be configured to vary the conditions for determining that the robot 1 has been in proximity to the singular configuration, in response to the rotation speed of each of the plurality of joints J.sub.1 to J.sub.6. The acquisition unit 21 may be configured to acquire the rotation speed of each of the plurality of joints J.sub.1 to J.sub.6.

[0048] According to the feature, when the rotation speed of each of the plurality of joints J.sub.1 to J.sub.6 is fast, the range of determining that the robot 1 has been in proximity to the singular configuration, is expanded so that further securely ensuring that the power generated at the tool center point P of the robot 1 is the designated value or less, can be made.

[0049] The output unit 24 is configured to output an alarm when the determination unit 22 determines that the robot 1 has been in proximity to the singular configuration, and additionally when the plurality of the joints J.sub.2 and J.sub.3 rotates simultaneously. The output unit 24 may be configured to output the alarm when unusual torque is generated at each of the plurality of joints J.sub.1 to J.sub.6.

[0050] The control unit 23 may be configured to control the operation of the robot 1 to stop when the output unit 24 outputs the alarm. In this case, the control unit 23 may be configured to restore the operation of the robot 1 based on the instruction of the user.

[0051] According to the configuration, when the determination unit 22 determines that the robot 1 has been in proximity to the singular configuration and additionally when the plurality of the joints J.sub.2 and J.sub.3 rotates simultaneously, the operation of the robot 1 is stopped so that the cooperation between the robot 1 and the human can be further securely achieved.

[0052] An exemplary operation of the robot controller 2 that controls the robot 1, according to the present embodiment will be described below with reference to FIG. 5.

[0053] As illustrated in FIG. 5, the robot controller 2 acquires the rotation angle of each of the plurality of joints J.sub.1 to J.sub.6 at step S101 and determines whether the robot 1 has been in proximity to the singular configuration, based on the rotation angle of each of the plurality of joints J.sub.1 to J.sub.6 at step S102.

[0054] When the determination unit 22 determines that the robot 1 has been in proximity to the singular configuration, the present operation proceeds to step S103. When the determination unit 22 determines that the robot 1 has not been in proximity to the singular configuration, the present operation proceeds to step S104.

[0055] The robot controller 2 controls the plurality of the joints to be rotated, to rotate on the one-by-one basis (namely, controls the plurality of the joints not to rotate simultaneously) at step S103, and controls the plurality of the joints to be rotated, to rotate simultaneously, namely, performs the normal control at step S104.

[0056] The robot system 100 according to the present embodiment, can ensure that the power in the operation direction Dx generated at the tool center point P of the robot 1 is the designated value or less, even in a case where the robot 1 has been in the singular configuration.

[0057] It should be understood by those skilled in the art that various modifications, combinations, sub-combinations and alterations may occur depending on design requirements and other factors insofar as they are within the scope of the appended claims or the equivalents thereof.