Multi-joint robot, control method of multi-joint robot, robot system, and article manufacturing method

The articulated robot's innovative link and drive mechanism design minimizes interference and enhances precision by allowing parallel movement directions and centralized placement, addressing workspace limitations and control accuracy issues.

JP2024165698APending Publication Date: 2024-11-28LAUREL BANK MACHINES CO LTD +2
View PDF 1 Cites 0 Cited by

Patent Information

Application Number
JP2023082099
Authority / Receiving Office
JP · JP
Patent Type
Applications
Current Assignee / Owner
Filing Date
2023-05-18
Publication Date
2024-11-28

AI Technical Summary

Technical Problem

Conventional articulated robots face limitations in workspace due to arm interference, particularly around the base, and have accuracy issues in controlling the tip position.

Method used

The articulated robot design includes a base, first and second links, and drive mechanisms with specific angular relationships between axes, allowing for parallel movement directions and centralized placement of drive mechanisms to minimize interference and enhance control precision.

Benefits of technology

This design enables precise movement of the robot tip without narrowing the workspace, reducing interference and improving control accuracy, especially around the base, while allowing for efficient assembly and disassembly of parts.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 2024165698000001_ABST
    Figure 2024165698000001_ABST
Patent Text Reader

Abstract

To move a tip part of a robot by simple control.SOLUTION: A robot 10 includes: a joint mechanism JEr3 that rotates a link LK2 with respect to a link LK1; a joint mechanism JEp1 that moves the joint mechanism JEr3 relatively with respect to the link LK1 along a direction De1 in which the link LK1 extends; and a joint mechanism JEp2 that moves the link LK2 relatively with respect to the joint mechanism JEp1 along a direction De2 in which the link LK2 extends. States of the link LK1 and the link LK2 can be transitioned to a first state in which the direction De1 and the direction De2 are parallel to each other. The link LK1 includes a movement region ARmv1 where the joint mechanism JEr3 moves, and the link LK2 includes a movement region ARmv2 where the joint mechanism JEr3 moves. The joint mechanism JEr3 is positioned at a central region ARmd1 excluding both end parts of the movement region ARmv1 and also is positioned at a central region ARmd2 excluding both end parts of the movement region ARmv2, in the first state.SELECTED DRAWING: Figure 2
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] The present invention relates to an articulated robot, a control method for the articulated robot, a robot system, and a method for manufacturing an article. [Background technology]

[0002] 2. Description of the Related Art Articulated robots are known as robots that perform the same movements as humans (see, for example, Patent Document 1). [Prior art documents] [Patent documents]

[0003] [Patent Document 1] Japanese Patent Publication No. 136782 / 1982 Summary of the Invention [Problem to be solved by the invention]

[0004] In the case of conventional articulated robots, the arms of the robot interfere with each other, so that the area that the tip of the robot can reach is limited, narrowing the workable area of ​​the articulated robot. In particular, the arms are likely to interfere with each other around the base where the arms located at the base side of the robot are attached, and there are many areas outside the workable area. That is, in the case of a robot having two arms, the angle between the two arms approaches 0°, so the arms interfere with each other. Even if it is within the workable area, the tip is controlled via the two arms, so there is a limit to improving the accuracy of the control of the tip. For this reason, it is desired to control the tip of the robot with high accuracy even around the base without narrowing the workable area of ​​the articulated robot. [Means for solving the problem]

[0005] According to a preferred aspect of the present invention, there is provided an articulated robot including a base, a tip, a first link, and a second link, the articulated robot comprising: a plurality of links connecting the base and the tip; a first drive mechanism connecting the first link and the second link and rotating the second link relative to the first link about an axis that forms an angle with a first direction in which the first link extends that is larger than a predetermined angle as a first rotation axis; a first movement mechanism moving the first drive mechanism relative to the first link along the first direction; and a second movement mechanism moving the second link relative to the first drive mechanism along a second direction in which the second link extends, The second link is capable of transitioning to a first state in which one direction and the second direction are parallel to each other, and one of the two ends of the second link that is farther from the tip is located closer to the one of the two ends of the first link that is closer to the base than the one of the two ends that is farther from the base, the first link has a first movement region in which the first driving mechanism moves along the first direction by the first movement mechanism, the second link has a second movement region in which the first driving mechanism moves along the second direction by the second movement mechanism, and in the first state, the first driving mechanism is located in a first central region excluding both ends of the first movement region, and is located in a second central region excluding both ends of the second movement region.

[0006] A method for controlling a multi-joint robot according to a preferred aspect of the present invention provides a method for controlling a multi-joint robot comprising: a base portion, a tip portion, a first link, and a second link, a plurality of links connecting the base portion and the tip portion; a first drive mechanism connecting the first link and the second link, and rotating the second link relative to the first link about an axis that forms an angle with a first direction in which the first link extends that is larger than a predetermined angle; a first movement mechanism moving the first drive mechanism relative to the first link along the first direction; and a second movement mechanism moving the second link relative to the first drive mechanism along a second direction in which the second link extends, The articulated robot is capable of transitioning to a first state in which one of the two ends of a link is located closer to the end closer to the base than the end farther from the base, the first link has a first movement region in which the first driving mechanism moves along the first direction by the first movement mechanism, the second link has a second movement region in which the first driving mechanism moves along the second direction by the second movement mechanism, and in the first state, the first driving mechanism is located in a first central region excluding both ends of the first movement region and is located in a second central region excluding both ends of the second movement region, and by controlling the first driving mechanism, the first movement mechanism, and the second movement mechanism, the articulated robot is caused to start operating from the first state or is caused to transition to the first state, thereby putting the first driving mechanism, the first movement mechanism, and the second movement mechanism into a standby state and then resuming operation from the first state.

[0007] A robot system according to a preferred aspect of the present invention includes a multi-joint robot, an end effector attached to the multi-joint robot, and a control device that controls operations of the multi-joint robot and the end effector, wherein the multi-joint robot includes a base, a tip including a portion to which the end effector is attached, a plurality of links including a first link and a second link connecting the base and the tip, a first drive mechanism that connects the first link and the second link and rotates the second link relative to the first link about an axis that forms an angle with a first direction in which the first link extends that is greater than a predetermined angle as a first rotation axis, a first movement mechanism that moves the first drive mechanism relative to the first link along the first direction, and a second movement mechanism that moves the second link relative to the first drive mechanism along a second direction in which the second link extends, The states of the first link and the second link are capable of transitioning to a first state in which the first direction and the second direction are parallel to each other, and an end of the two ends of the second link that is farther from the tip is located closer to an end of the two ends of the first link that is closer to the base than an end of the two ends of the first link that is farther from the base, the first link has a first movement region in which the first driving mechanism moves along the first direction by the first moving mechanism, the second link has a second movement region in which the first driving mechanism moves along the second direction by the second moving mechanism, and the first driving mechanism is located in a first central region excluding both ends of the first movement region and in a second central region excluding both ends of the second movement region in the first state, and the control device causes the articulated robot to wait in the first state by controlling the first driving mechanism, the first moving mechanism, and the second moving mechanism.

[0008] In a method for manufacturing an article according to a preferred embodiment of the present invention, a part is assembled or removed by the above-mentioned robot system. Effect of the Invention

[0009] According to the present invention, the tip of the robot can be moved with simple control. [Brief description of the drawings]

[0010] [Figure 1] FIG. 1 is an explanatory diagram for explaining an overview of a robot system according to an embodiment. [Diagram 2] FIG. 2 is an explanatory diagram for explaining an example of a joint mechanism. [Diagram 3] FIG. 2 is an explanatory diagram for explaining an example of a state of the robot shown in FIG. [Figure 4] 1. FIG. 4 is an explanatory diagram for explaining another example of the state of the robot shown in FIG. [Diagram 5] FIG. 2 is an explanatory diagram for explaining how the state of the robot transitions from a first state to a first work state. [Figure 6] FIG. 11 is an explanatory diagram for explaining how the state of the robot transitions from a first comparison state to a first working state. [Figure 7] FIG. 11 is an explanatory diagram for explaining how the state of the robot transitions from a second comparison state to a first work state. [Figure 8] FIG. 2 is an explanatory diagram for explaining how the robot state transitions from a first state to a second work state. [Figure 9] FIG. 11 is an explanatory diagram for explaining how the state of the robot transitions from a first comparison state to a second work state. [Figure 10] FIG. 11 is an explanatory diagram for explaining how the state of the robot transitions from a second comparison state to a second work state. [Figure 11] 2 is a diagram illustrating an example of a hardware configuration of a robot controller illustrated in FIG. 1. [Figure 12] FIG. 11 is an explanatory view for explaining an example of a tip portion according to a first modified example. [Figure 13] FIG. 11 is an explanatory diagram for explaining an example of turning. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0011] Hereinafter, the embodiments of the present invention will be described with reference to the drawings. In each drawing, the dimensions and scale of each part are appropriately different from the actual ones. In addition, the embodiments described below are preferred examples of the present invention, and therefore various technically preferable limitations are attached, but the scope of the present invention is not limited to these embodiments unless otherwise specified in the following description to the effect that the present invention is limited.

[0012] [1. Embodiment] First, an example of an overview of a robot system 1 according to an embodiment will be described with reference to FIG.

[0013] FIG. 1 is an explanatory diagram for explaining an overview of a robot system 1 according to an embodiment.

[0014] The robot system 1 includes, for example, a robot 10, an end effector 20 that is detachably attached to the robot 10, and a robot controller 30 that controls the operations of the robot 10 and the end effector 20. The robot 10 is an example of a "multi-joint robot," and the robot controller 30 is an example of a "control device."

[0015] The robot 10 and the robot controller 30 are connected to each other so as to be able to communicate with each other, for example, by a wired connection. The connection between the robot 10 and the robot controller 30 may be a wireless connection, or a connection using both wires and wireless connections. The robot controller 30 is capable of communicating with the end effector 20 attached to the robot 10. The robot controller 30 may be any information processing device capable of communicating with other devices. The configuration of the robot controller 30 will be described later with reference to FIG. 11.

[0016] The robot 10 is an articulated robot used for work in, for example, farms, factories, warehouses, etc. Specifically, the robot 10 is an eight-axis articulated robot in which two joint mechanisms JEp (JEp1 and JEp2) corresponding to linear joints are added to a six-axis articulated robot having six joint mechanisms JEr (JEr1, JEr2, JEr3, JEr4, JEr5, and JEr6) corresponding to rotary joints. For example, the robot 10 has six joint mechanisms JEr, two joint mechanisms JEp, a body part BDP, two links LK (LK1 and LK2), and a tip part TP1. In the example shown in FIG. 1, the joint mechanism JEr1 is included in the body part BDP, and the joint mechanisms JEr5 and JEr6 are included in the tip part TP1. The joint mechanism JEp1 is provided in the link LK1, and the joint mechanism JEp2 is provided in the link LK2. Hereinafter, the joint mechanisms JEr and JEp are also referred to as the joint mechanism JE without any particular distinction. For example, the robot 10 further includes a plurality of motors that drive the plurality of joint mechanisms JE. In Fig. 1, in order to make the drawing easier to understand, the motors that drive the plurality of joint mechanisms JE, the reducers and encoders provided in each of the plurality of motors, and the like are omitted.

[0017] The body part BDP is an example of a "base part." In addition, the link LK1 is an example of a "first link," and the link LK2 is an example of a "second link." Therefore, the links LK1 and LK2 correspond to "multiple links." For example, the links LK1 and LK2 connect the body part BDP and the tip part TP1.

[0018] Here, for example, the connection of members includes both cases where two members are directly connected and cases where two members are indirectly connected. Two members being directly connected includes a state where two members are in contact with each other, and a state that can be regarded as equivalent to a state where two members are in contact with each other. A state that can be regarded as equivalent to a state where two members are in contact with each other is, for example, a state where one of the two members is fixed to the other by an adhesive or the like. Also, two members being indirectly connected means that another member is disposed between the two members.

[0019] Joint mechanism JEr1 is an example of a "second driving mechanism," and joint mechanism JEr2 is an example of a "third driving mechanism." Joint mechanism JEr3 is an example of a "first driving mechanism," and joint mechanism JEr4 is an example of a "fourth driving mechanism." Joint mechanism JEr5 is an example of a "fifth driving mechanism," and joint mechanism JEr6 is an example of a "sixth driving mechanism." Joint mechanism JEp1 is an example of a "first moving mechanism," and joint mechanism JEp2 is an example of a "second moving mechanism."

[0020] The body part BDP includes, for example, a base part BDPba fixed to a predetermined location such as a floor, and a joint mechanism JEr1 connected to the joint mechanism JEr2. The joint mechanism JEr1 rotates a part of the body part BDP around an axis Ax1 perpendicular to the bottom surface BDPbt of the body part BDP as a rotation axis. For example, the joint mechanism JEr1 rotates an outer wall including a part of the joint mechanism JEr1 connected to the joint mechanism JEr2, relative to the base part BDPba, around the axis Ax1 as a rotation axis. That is, the joint mechanism JEr1 rotates the joint mechanism JEr2 relative to the body part BDP, around the axis Ax1 as a rotation axis. The axis Ax1 is an example of a "second rotation axis."

[0021] Here, "vertical" includes not only strict vertical but also substantial vertical (e.g., vertical within a margin of error). Similarly, "parallel" described below includes not only strict parallel but also substantial parallel (e.g., parallel within a margin of error). The rotation direction Dr1 in FIG. 1 indicates the rotation direction of a portion of the body part BDP when the portion of the body part BDP rotates around the axis Ax1 as a rotation axis.

[0022] The joint mechanism JEr2 connects the body part BDP and the link LK1, and rotates the link LK1 relative to the body part BDP around an axis Ax2 parallel to the bottom surface BDPbt of the body part BDP. The rotation direction Dr2 in FIG. 1 indicates the rotation direction of the link LK1 when the link LK1 rotates around the axis Ax2. The axis Ax2 is an example of a "third rotation axis."

[0023] The link LK1 is, for example, hollow and long. The link LK1 has an opening Hlk1 extending in a direction De1 along which the link LK1 extends. The direction De1 is an example of a "first direction."

[0024] The opening Hlk1 is formed, for example, in a surface of the link LK1 that includes a portion facing the link LK2. A part of the joint mechanism JEr3 and the joint mechanism JEp1 are provided inside the link LK1. For example, a part of the joint mechanism JEr3 is located inside the link LK1, and the other part of the joint mechanism JEr3 protrudes from the opening Hlk1 to the outside of the link LK1. Note that the part of the joint mechanism JEr3 protruding outside the link LK1 or a part of the part protruding outside the link LK1 passes through an opening Hlk2 of the link LK2 described later and is located inside the link LK2.

[0025] The link LK1 rotates relative to the body part BDP about an axis Ax1 as a rotation axis by the joint mechanism JEr1, and rotates relative to the body part BDP about an axis Ax2 as a rotation axis by the joint mechanism JEr2.

[0026] The joint mechanism JEr3 connects the link LK1 and the link LK2, and rotates the link LK2 relative to the link LK1 about an axis Ax3 perpendicular to the direction De1 in which the link LK1 extends. The rotation direction Dr3 in FIG. 1 indicates the rotation direction of the link LK2 when the link LK2 rotates about the axis Ax3. The axis Ax3 is an example of a "first rotation axis."

[0027] The joint mechanism JEp1 moves the joint mechanism JEr3 relative to the link LK1 along the direction De1. In the example shown in FIG. 1, when the joint mechanism JEp1 moves the joint mechanism JEr3 along the direction De1, the opening Hlk1 of the link LK1 corresponds to the movable area of ​​the joint mechanism JEr3. That is, the opening Hlk1 of the link LK1 corresponds to the movement area ARmv1 in which the joint mechanism JEr3 moves along the direction De1 by the joint mechanism JEp1. The movement area ARmv1 is an example of a "first movement area." Note that, as the joint mechanism JEr3 moves along the direction De1, the link LK2 moves relative to the link LK1 along the direction De1.

[0028] The link LK2 is, for example, hollow and long. The link LK2 has an opening Hlk2 extending in a direction De2 along which the link LK2 extends. The direction De2 is an example of a "second direction."

[0029] The opening Hlk2 is formed, for example, in a surface of the link LK2 that includes a portion facing the link LK1. A part of the joint mechanism JEr3 and the joint mechanism JEp2 are provided inside the link LK2. For example, a part of the joint mechanism JEr3 is located inside the link LK2, and the other part of the joint mechanism JEr3 protrudes from the opening Hlk2 to the outside of the link LK2.

[0030] The joint mechanism JEp2 moves the link LK2 relative to the joint mechanism JEr3 along the direction De2 in which the link LK2 extends. As a result, the link LK2 moves relative to the joint mechanism JEr3 along the direction De2. That is, the link LK2 moves relative to the link LK1 along the direction De2.

[0031] In this way, the link LK2 moves relative to the link LK1 along the direction De1 by the joint mechanism JEp1, and moves relative to the link LK1 along the direction De2 by the joint mechanism JEp2.

[0032] Here, the movement of the link LK2 relative to the joint mechanism JEr3 can be said to be the movement of the joint mechanism JEr3 relative to the link LK2. Therefore, the joint mechanism JEp2 can also be regarded as a joint mechanism JE that moves the joint mechanism JEr3 relative to the link LK2 along the direction De2. In the example shown in FIG. 1, when the joint mechanism JEp2 moves the joint mechanism JEr3 along the direction De2, the opening Hlk2 of the link LK2 corresponds to the movable area of ​​the joint mechanism JEr3. That is, the opening Hlk2 of the link LK2 corresponds to the movement area ARmv2 in which the joint mechanism JEr3 moves along the direction De2 by the joint mechanism JEp2. The movement area ARmv2 is an example of a "second movement area."

[0033] The joint mechanism JEr4 connects the link LK2 and the tip TP1, and rotates the tip TP1 relative to the link LK2 around an axis Ax4 perpendicular to the direction De2. The rotation direction Dr4 in FIG. 1 indicates the rotation direction of the tip TP1 when the tip TP1 rotates around the axis Ax4. The axis Ax4 is an example of a "fourth rotation axis."

[0034] For example, an end effector 20 that grips an article is attached to the tip part TP1. For example, the end effector 20 is attached to an end face TP1sf of the tip part TP1. The tip part TP1 includes a first part TP11 connected to the link LK2, a second part TP12 connected to the first part TP11, a joint mechanism JEr5, and a joint mechanism JEr6. The first part TP11 is connected to the link LK2 via, for example, a joint mechanism JEr4. Therefore, the first part TP11 rotates relative to the link LK2 around the axis Ax4 as a rotation axis.

[0035] The joint mechanism JEr5 connects the first part TP11 and the second part TP12, and rotates the second part TP12 relative to the first part TP11 around an axis Ax5 perpendicular to the axis Ax4. The rotation direction Dr5 in FIG. 1 indicates the rotation direction of the second part TP12 when the second part TP12 rotates around the axis Ax5. The axis Ax5 is an example of the "fifth rotation axis."

[0036] The joint mechanism JEr6 rotates at least a part of the tip part TP1 around an axis Ax6 perpendicular to the axis Ax5. In the example shown in FIG. 1, the joint mechanism JEr6 rotates the end face TP1sf of the tip part TP1 around the axis Ax6. That is, the joint mechanism JEr6 rotates a part (end face TP1sf) of the tip part TP1 to which the end effector 20 is attached around the axis Ax6. The rotation direction Dr6 in FIG. 1 indicates the rotation direction of the end face TP1sf when the end face TP1sf rotates around the axis Ax6. The axis Ax6 is an example of a "sixth rotation axis."

[0037] 1, the surface of the joint mechanism JEr6 corresponds to the end surface TP1sf. In a configuration in which the joint mechanism JEr6 is included in the second part TP12, the end surface of the second part TP12 may be the end surface TP1sf.

[0038] Furthermore, the work performed by the end effector 20 is not limited to gripping an object. As the end effector 20, an appropriate part (e.g., a robot hand, a robot finger, etc.) can be applied depending on the work purpose of the robot 10. That is, an end effector 20 suitable for various works is attached to the tip portion TP1.

[0039] In this embodiment, a rotation about an axis whose angle with a specific direction is greater than a predetermined angle is sometimes referred to as a "turn" to distinguish it from a rotation about an axis whose angle with a specific direction is equal to or smaller than the predetermined angle. The predetermined angle may be, for example, 45°. Note that the predetermined angle is not limited to 45°.

[0040] For example, in the rotation about each of the axes Ax1 and Ax2 as the rotation axis, the direction Dv1 perpendicular to the bottom surface BDPbt of the body part BDP corresponds to the specific direction. In this case, the axis Ax1 corresponds to an axis whose angle with the direction Dv1 perpendicular to the bottom surface BDPbt of the body part BDP is equal to or smaller than a predetermined angle, and the axis Ax2 corresponds to an axis whose angle with the direction Dv1 is greater than a predetermined angle. Therefore, the rotation of the link LK1 about the axis Ax2 as the rotation axis corresponds to a turn. Note that in this embodiment, since the body part BDP extends along the direction Dv1 perpendicular to the bottom surface BDPbt, the direction Deb in which the body part BDP extends may be the specific direction.

[0041] In addition, in the rotation about the axis Ax3, the direction De1 in which the link LK1 extends corresponds to a specific direction, and in the rotation about the axis Ax4, the direction De2 in which the link LK2 extends corresponds to a specific direction. In this case, the axis Ax3 corresponds to an axis that forms an angle with the direction De1 in which the link LK1 extends that is larger than a predetermined angle, and the axis Ax4 corresponds to an axis that forms an angle with the direction De2 in which the link LK2 extends that is larger than a predetermined angle. Therefore, the rotation of the link LK2 about the axis Ax3 and the rotation of the first part TP11 about the axis Ax4 correspond to turning.

[0042] In addition, in the rotation about the axis Ax5, the direction De11 corresponds to a specific direction, and in the rotation about the axis Ax6, the direction De12 corresponds to a specific direction. The direction De11 is a direction from an end of the first part TP11 opposite to a specific end to which the joint mechanism JEr5 is connected toward the specific end. The direction De11 may be regarded as a direction in which the first part TP11 extends. The direction De12 is a direction from an end of the second part TP12 opposite to a specific end (end including the end face TP1sf) to which the joint mechanism JEr6 is connected toward the specific end. The direction De12 may be regarded as a direction in which the second part TP12 extends.

[0043] When the direction De11 is a specific direction, the axis Ax5 corresponds to an axis whose angle with the direction De11 is equal to or smaller than a predetermined angle. When the direction De12 is a specific direction, the axis Ax6 corresponds to an axis whose angle with the direction De12 is equal to or smaller than a predetermined angle. In this embodiment, it is assumed that the direction De11 is perpendicular to the axis Ax4, and the direction De12 is perpendicular to the axis Ax5. In this case, the axis Ax5 whose angle with the direction De11 is equal to or smaller than a predetermined angle corresponds to an axis whose angle with the axis Ax4 is larger than a predetermined angle, and the axis Ax6 whose angle with the direction De12 is equal to or smaller than a predetermined angle corresponds to an axis whose angle with the axis Ax5 is larger than a predetermined angle.

[0044] In this manner, in this embodiment, each of the multiple parts of the robot 10 (such as the body part BDP, the link LK1, the link LK2, and the tip part TP1) can rotate about each of the axes Ax1, Ax2, Ax3, Ax4, Ax5, and Ax6 as a rotation axis, thereby enabling the robot 10 to perform the same movements as a human being.

[0045] For example, the link LK1 between the joint mechanism JEr2 and the joint mechanism JEr3 corresponds to the upper arm, and the link LK2 between the joint mechanism JEr3 and the joint mechanism JEr4 corresponds to the forearm. The robot 10 can perform an action simulating the twisting of a human waist by the joint mechanism JEr1, and can perform an action simulating the rotation of a shoulder by the joint mechanism JEr2. The robot 10 can perform an action simulating the rotation of an elbow by the joint mechanism JEr3, and can perform an action simulating the rotation of a wrist by the joint mechanism JEr4. The robot 10 can perform an action simulating the twisting of a wrist by the joint mechanism JEr5, and can perform an action simulating the twisting of a fingertip by the joint mechanism JEr6.

[0046] Furthermore, in this embodiment, the joint mechanism JEp1 provided in the link LK1 can move the link LK2 relative to the link LK1 along the direction De1 in which the link LK1 extends. Also, in this embodiment, the joint mechanism JEp2 provided in the link LK2 can move the link LK2 relative to the link LK1 along the direction De2 in which the link LK2 extends. Therefore, in this embodiment, the joint mechanisms JEp1 and JEp2 can easily move the tip part TP1 of the robot 10 to the periphery of the body part BDP. Also, in this embodiment, the joint mechanisms JEp1 and JEp2 can widen the area that the tip part TP1 (more specifically, the end face TP1sf) can reach, and therefore the area that the end effector 20 attached to the robot 10 can reach can be widened.

[0047] The configuration of the robot system 1 is not limited to the example shown in FIG. 1. For example, the robot controller 30 may be built into the robot 10. Although FIG. 1 assumes a case where the robot 10 is fixed to a predetermined location such as a floor, the robot 10 itself may be movable without being fixed to a predetermined location. The base part BDPba of the body part BDP may be fixed to a predetermined location such as a floor via a joint mechanism JEr1. In this case, the body part BDP may be defined without including the joint mechanism JEr1. In a configuration in which the base part BDPba is fixed to a predetermined location via the joint mechanism JEr1, the joint mechanism JEr1 may rotate the base part BDPba around the axis Ax1 as a rotation axis. In a configuration in which the base part BDPba is fixed to a predetermined location via the joint mechanism JEr1, the base part BDPba may be connected to the joint mechanism JEr2.

[0048] Next, an example of the joint mechanisms JEp1 and JEp2 will be described with reference to FIG.

[0049] FIG. 2 is an explanatory diagram for explaining an example of the joint mechanism JE. In FIG. 2, the joint mechanisms JEp1 and JEp2 and the joint mechanism JEr3 will be mainly described. In this embodiment, it is assumed that the motor MOr3 that drives the joint mechanism JEr3 moves integrally with the joint mechanism JEr3. For example, the motor MOr3 may be fixed to the joint mechanism JEr3. The motor MOr3 is an example of a "first motor." First, the joint mechanism JEp1 will be described.

[0050] The joint mechanism JEp1 and the motor MOp1 that drives the joint mechanism JEp1 are disposed inside the link LK1. For example, the motor MOp1 is attached inside the link LK1 at the end LK1ed1, which is closer to the body part BDP, of the two ends LK1ed (LK1ed1 and LK1ed2) of the link LK1. The motor MOp1 is an example of a "second motor." Note that, of the two ends LK1ed of the link LK1, the end LK1ed farther from the body part BDP.

[0051] The joint mechanism JEp1 includes, for example, a screw portion JEp11 extending along a direction De1, a nut JEp12, a connecting portion JEp13, and a rail JEp14.

[0052] One end of the threaded portion JEp11 is attached to the motor MOp1. For example, the threaded portion JEp11 is attached to the motor MOp1 so that the central axis of the threaded portion JEp11 (the central axis along the direction De1) coincides with the rotation axis of the motor MOp1, and is inserted into a nut JEp12. Then, the threaded portion JEp11 rotates around the central axis along the direction De1 as the rotation axis of the motor MOp1.

[0053] The connection part JEp13 includes, for example, a slider part JEp13a connected to the rail JEp14 so as to be movable along the direction De1, and a support part JEp13b supporting the nut JEp12 and the motor MOr3. For example, the nut JEp12 is fixed to the support part JEp13b so as not to rotate together with the screw part JEp11. In addition, the motor MOr3 is fixed to the support part JEp13b so as not to rotate itself.

[0054] It is not necessary to strictly distinguish between the slider portion JEp13a and the support portion JEp13b. For example, the motor MOr3 may be fixed to the slider portion JEp13a. The nut JEp12 may be fixed to the motor MOr3 without the support portion JEp13b. That is, the nut JEp12 only needs to be connected to the connection portion JEp13 or the like so that the relative position of the nut JEp12 with respect to the joint mechanism JEr3 does not change. In this way, the nut JEp12 is connected to the joint mechanism JEr3 via the connection portion JEp13 or the like.

[0055] The rail JEp14 includes two rod-shaped members JEp14a and JEp14b extending along the direction De1 and arranged parallel to each other. The shapes of the rod-shaped members JEp14a and JEp14b and the slider portion JEp13a are not particularly limited as long as the rod-shaped members JEp14a and JEp14b can support the slider portion JEp13a. The rail JEp14 is arranged, for example, between the opening Hlk1 and the screw portion JEp11 in the direction along the axis Ax2, and is attached to the inside of the link LK1. Note that the rail JEp14 does not have to be arranged between the opening Hlk1 and the screw portion JEp11 in the direction along the axis Ax2, as long as the joint mechanism JEr3 can move along the direction De1 with a part of the joint mechanism JEr3 protruding from the opening Hlk1.

[0056] The nut JEp12 is fixed to the connection part JEp13 so as not to rotate together with the threaded part JEp11, and therefore moves relative to the threaded part JEp11 along the direction De1 as the threaded part JEp11 rotates. As described above, the nut JEp12 is fixed to the connection part JEp13, etc. so that the relative position to the joint mechanism JEr3 does not change. That is, the joint mechanism JEr3 moves along the direction De1 together with the nut JEp12. For example, the joint mechanism JEr3 moves relative to the link LK1 as the nut JEp12 moves. In this way, the joint mechanism JEp1 movably supports the joint mechanism JEr3. It is preferable that the movement range of the joint mechanism JEr3, i.e., the movement area ARmv1, is movable from a region closer to the end LK1ed1 than the end LK1ed2 of the link LK1 to a region closer to the end LK1ed2 than the end LK1ed1. This allows the substantial length of the link LK1 (the length under control) to be set to half or less of the length of the link LK1 or more than half of the length of the link LK1. The substantial length of the link LK1 is, for example, the length along the direction De1 from the end LK1ed1 (for example, the intersection of the link LK1 and the axis Ax2) to the joint mechanism JEr3 (more precisely, the axis Ax3).

[0057] Here, the moving direction of the nut JEp12, i.e., the moving direction of the joint mechanism JEr3, is switched between the direction De1 and the opposite direction to the direction De1 by switching the rotation direction of the motor MOp1. For example, when the motor MOp1 rotates in a first rotation direction, the nut JEp12 moves in the direction De1, and when the motor MOp1 rotates in a second rotation direction that is the opposite rotation to the first rotation direction, the nut JEp12 moves in the opposite direction to the direction De1. Next, the joint mechanism JEp2 will be described.

[0058] The joint mechanism JEp2 and the motor MOp2 that drives the joint mechanism JEp2 are disposed inside the link LK2. For example, the motor MOp2 is attached inside the link LK2 at the end LK2ed1, which is the farthest from the tip end TP1, of the two ends LK2ed (LK2ed1 and LK2ed2) of the link LK2. The motor MOp2 is an example of a "third motor." Note that, of the two ends LK2ed of the link LK2, the end LK2ed2 is the end LK2ed closer to the tip end TP1.

[0059] The joint mechanism JEp2 includes, for example, a screw portion JEp21 extending along the direction De2, a nut JEp22, a connecting portion JEp23, and a rail JEp24.

[0060] One end of the threaded portion JEp21 is attached to the motor MOp2. For example, the threaded portion JEp21 is attached to the motor MOp2 so that the central axis of the threaded portion JEp21 (the central axis along the direction De2) coincides with the rotation axis of the motor MOp2, and is inserted into the nut JEp22. Then, the threaded portion JEp21 rotates around the central axis along the direction De2 as the rotation axis of the motor MOp2.

[0061] The connection part JEp23 includes, for example, a slider part JEp23a connected to the rail JEp24 so as to be relatively movable along the direction De2, and a support part JEp23b supporting the nut JEp22 and the joint mechanism JEr3. For example, the nut JEp22 is fixed to the support part JEp23b so as not to rotate together with the screw part JEp21. In addition, the support part JEp23b is connected to the joint mechanism JEr3 so as to rotate about an axis Ax3 (not shown in FIG. 2) as the rotation axis in accordance with the rotation of the motor MOr3. That is, the joint mechanism JEr3 rotates the support part JEp23b about the axis Ax3 as the rotation axis in accordance with the rotation of the motor MOr3.

[0062] It is not necessary to strictly distinguish between the slider portion JEp23a and the support portion JEp23b. For example, the joint mechanism JEr3 may be connected to the slider portion JEp23a. The nut JEp22 may be fixed to the slider portion JEp23a. That is, the nut JEp22 only needs to be connected to the connection portion JEp23 or the like so that the relative position of the nut JEp22 with respect to the joint mechanism JEr3 does not change. In this way, the nut JEp22 is connected to the joint mechanism JEr3 via the connection portion JEp23 or the like.

[0063] The rail JEp24 includes two rod-shaped members JEp24a and JEp24b that extend along the direction De2 and are arranged parallel to each other. The shapes of the rod-shaped members JEp24a and JEp24b and the slider portion JEp23a are not particularly limited as long as the rod-shaped members JEp24a and JEp24b can support the slider portion JEp23a. The rail JEp24 is, for example, arranged between the opening Hlk2 and the screw portion JEp21 in the direction along the axis Ax2, and is attached to the inside of the link LK2. Note that the rail JEp24 does not have to be arranged between the opening Hlk2 and the screw portion JEp21 in the direction along the axis Ax2, as long as the joint mechanism JEr3 can move along the direction De2 with a part of the joint mechanism JEr3 protruding from the opening Hlk2.

[0064] The nut JEp22 is fixed to the connection part JEp23 so as not to rotate together with the threaded part JEp21, and therefore moves relative to the threaded part JEp21 along the direction De2 as the threaded part JEp21 rotates. As described above, the nut JEp22 is fixed to the connection part JEp23 and the like so that the relative position to the joint mechanism JEr3 does not change. In addition, when the threaded part JEp11 is not rotating, that is, when the motor MOp1 is not rotating, the joint mechanism JEr3 is supported by the joint mechanism JEp1 so that the relative position of the joint mechanism JEr3 to the link LK1 does not change. Therefore, the link LK2 moves relative to the joint mechanism JEr3 along the direction De2 as the nut JEp22 moves relative to the threaded part JEp21. In this way, the joint mechanism JEp2 movably supports the link LK2. It is preferable that the movement range of the joint mechanism JEr3, i.e., the movement area ARmv2, is movable from a region closer to the end LK2ed1 than the end LK2ed2 of the link LK2 to a region closer to the end LK2ed2 than the end LK2ed1. This makes it possible to set the substantial length of the link LK2 (the length under control) to a length equal to or less than half the length of the link LK2 to a length equal to or more than half the length of the link LK2. The substantial length of the link LK2 is, for example, the length along the direction De2 from the joint mechanism JEr3 (more precisely, the axis Ax3) to the end LK2ed2 (for example, the intersection of the link LK2 and the axis Ax4).

[0065] When the screw portion JEp21 is not rotating, i.e., when the motor MOp2 is not rotating, the joint mechanism JEr3 is supported by the joint mechanism JEp2 so that the relative position with respect to the link LK2 does not change. The joint mechanism JEr3 can rotate the link LK2 with respect to the link LK1 regardless of the relative position with respect to the link LK1. The joint mechanism JEr3 can rotate the link LK2 with respect to the link LK1 regardless of the relative position with respect to the link LK2.

[0066] Here, the moving direction of the nut JEp22 relative to the threaded portion JEp21, i.e., the moving direction of the link LK2, is switched between the direction De2 and the direction opposite to the direction De2 by switching the rotation direction of the motor MOp2. For example, when the motor MOp2 rotates in a first rotation direction, the link LK2 moves in the direction opposite to the direction De2, and when the motor MOp2 rotates in a second rotation direction that is opposite to the first rotation direction, the link LK2 moves in the direction De2.

[0067] The configuration of the joint mechanism JEp is not limited to the example shown in Fig. 2. For example, a ball screw having multiple balls between a screw part JEp11 and a nut JEp12 may be used as an element of the joint mechanism JEp1. Similarly, a ball screw having multiple balls between a screw part JEp21 and a nut JEp22 may be used as an element of the joint mechanism JEp2.

[0068] Also, for example, a part of the motor MOr3 may be located inside the link LK1, another part of the motor MOr3 may be located outside the link LK1 from the opening Hlk1, and the entire joint mechanism JEr3 may be located inside the link LK2. Also, for example, the joint mechanism JEr3 may have a storage section that stores the motor MOr3. That is, the motor MOr3 may be provided inside the joint mechanism JEr3. Alternatively, the motor MOr3 may be regarded as one element of the joint mechanism JEr3. Similarly, the motor MOp1 may be regarded as one element of the joint mechanism JEp1, and the motor MOp2 may be regarded as one element of the joint mechanism JEp2.

[0069] Next, the joint mechanisms JEr1, JEr2, JEr4, JEr5 and JEr6 will be briefly described.

[0070] The joint mechanism JEr1 has, for example, a rotating part JEr11 and a housing JEr12 that houses the rotating part JEr11. The rotating part JEr11 rotates around the axis Ax1 as a rotation axis with the rotation of the motor MOr1 that drives the joint mechanism JEr1. For example, the rotating part JEr11 is attached to the motor MOr1 so as to be rotatable around the base part BDPba around the axis Ax1 as a rotation axis. In addition, the housing JEr12 rotates around the axis Ax1 as a rotation axis with the rotating part JEr11 as a rotation axis with the base part BDPba. For example, the housing JEr12 is connected to the base part BDPba so as to be rotatable around the axis Ax1 as a rotation axis with the base part BDPba. Furthermore, the housing JEr12 is connected to the joint mechanism JEr2. As a result, the joint mechanism JEr2 rotates around the axis Ax1 as a rotation axis with the rotation of the rotating part JEr11 as a rotation axis with the base part BDPba.

[0071] The motor MOr1 may be regarded as one element of the joint mechanism JEr1. The housing JEr12 may be fixed to the base BDPba, and the joint mechanism JEr2 may be attached to the rotating part JEr11 so as to be rotatable with respect to the housing JEr12 about the axis Ax1 as the rotation axis. In this case, the housing JEr12 may be regarded as one element of the base BDPba.

[0072] The joint mechanism JEr2 has, for example, a rotating part JEr21 and a housing JEr22 that houses a motor MOr2 that drives the joint mechanism JEr2. The rotating part JEr21 rotates around an axis Ax2 as a rotation axis with the rotation of the motor MOr2. For example, the rotating part JEr21 is attached to the motor MOr2 so as to be rotatable with respect to the housing JEr22 around the axis Ax2 as a rotation axis. Furthermore, the rotating part JEr21 is connected to a link LK1. Furthermore, the link LK1 is connected to the housing JEr22 so as to be rotatable with respect to the housing JEr22. As a result, the link LK1 rotates with respect to the housing JEr22 around the axis Ax2 as a rotation axis with the rotation of the rotating part JEr21. Furthermore, the motor MOr2 is attached inside the housing JEr22.

[0073] The motor MOr2 may be regarded as one element of the joint mechanism JEr2. In the example shown in Fig. 2, a part of the rotating part JEr21 is located inside the link LK1, and another part of the rotating part JEr21 is located inside the housing JEr22, but the entire rotating part JEr21 may be located inside the link LK1 or inside the housing JEr22.

[0074] The joint mechanism JEr4 has, for example, a rotating part JEr41 and a housing JEr42 that houses the rotating part JEr41. The rotating part JEr41 rotates around an axis Ax4 as a rotation axis in accordance with the rotation of a motor MOr4 that drives the joint mechanism JEr4. For example, the rotating part JEr41 is attached to the motor MOr4 so as to be rotatable with respect to the link LK2 around the axis Ax4 as a rotation axis. The motor MOr4 is attached inside the link LK2.

[0075] Furthermore, the housing JEr42 rotates with the rotating part JEr41 relative to the link LK2 around the axis Ax4 as a rotation axis. For example, the housing JEr42 is connected to the link LK2 so as to be rotatable with respect to the link LK2 around the axis Ax4 as a rotation axis. Furthermore, the housing JEr42 is connected to the first part TP11. As a result, the first part TP11 rotates with the housing JEr42 around the axis Ax4 as a rotation axis in accordance with the rotation of the rotating part JEr41.

[0076] The motor MOr4 may be regarded as one element of the joint mechanism JEr4. In the example shown in Fig. 2, the entire rotating part JEr41 is located inside the housing JEr42, but the entire rotating part JEr41 may be located inside the link LK2. Alternatively, a part of the rotating part JEr41 may be located inside the housing JEr42, and the other part of the rotating part JEr41 may be located inside the link LK2.

[0077] The joint mechanism JEr5 has, for example, a rotating part JEr51 and a housing JEr52 that houses a part of the rotating part JEr51. The rotating part JEr51 rotates around an axis Ax5 as a rotation axis in accordance with the rotation of a motor MOr5 that drives the joint mechanism JEr5. For example, the rotating part JEr51 is attached to the motor MOr5 so as to be rotatable with respect to the first part TP11 around the axis Ax5 as a rotation axis. The motor MOr5 is attached inside the housing JEr42 of the joint mechanism JEr4.

[0078] Furthermore, the housing JEr52 rotates with respect to the first part TP11 together with the rotating part JEr51, with the axis Ax5 as the rotation axis. For example, the housing JEr52 is connected to the first part TP11 so as to be rotatable with respect to the first part TP11 around the axis Ax5 as the rotation axis. Furthermore, the housing JEr52 is connected to the second part TP12. As a result, the second part TP12 rotates with the housing JEr52 together with the axis Ax5 as the rotation axis in accordance with the rotation of the rotating part JEr51.

[0079] The motor MOr5 may be regarded as one element of the joint mechanism JEr5. In the example shown in Fig. 2, a part of the rotating part JEr51 is located inside the housing JEr52, and another part of the rotating part JEr51 is located inside the first part TP11, but the entire rotating part JEr51 may be located inside the housing JEr52 or inside the first part TP11.

[0080] The joint mechanism JEr6 has, for example, a rotating part JEr61 and a housing JEr62 that houses a part of the rotating part JEr61. The rotating part JEr61 rotates around the axis Ax6 as a rotation axis with the rotation of the motor MOr6 that drives the joint mechanism JEr6. For example, the rotating part JEr61 is attached to the motor MOr6 so as to be rotatable with respect to the second part TP12 around the axis Ax6 as a rotation axis. In addition, the housing JEr62 rotates with respect to the second part TP12 around the axis Ax6 as a rotation axis together with the rotating part JEr61. For example, the housing JEr62 is connected to the second part TP12 so as to be rotatable with respect to the second part TP12 around the axis Ax6 as a rotation axis. In addition, the housing JEr62 includes an end face TP1sf. For example, the end face TP1sf rotates with respect to the second part TP12 around the axis Ax6 as a rotation axis with the rotation of the rotating part JEr61.

[0081] The motor MOr6 may be regarded as one element of the joint mechanism JEr6. The housing JEr62 may be fixed to the second part TP12, and the end effector 20 may be attached to the surface of the rotating part JEr61 so as to be rotatable with respect to the housing JEr62. In this case, the surface of the rotating part JEr61 corresponds to the end face TP1sf. When the housing JEr62 is fixed to the second part TP12, the housing JEr62 may be regarded as one element of the second part TP12. Hereinafter, the motors MOr1, MOr2, MOr3, MOr4, MOr5, MOr6, MOp1, and MOp2 may be collectively referred to as motors MO.

[0082] Furthermore, the multiple joint mechanisms JEr are not limited to the example shown in Fig. 2. For example, each of the multiple joint mechanisms JEr may have the same configuration as a mechanism corresponding to each joint of a known articulated robot.

[0083] Moreover, the state (posture) of the robot 10 shown in FIG. 2 is a standby posture of the robot 10, which is one of the states that represent the characteristics of the robot 10 in this embodiment. The standby posture is the initial posture when the robot 10 starts to operate, or the posture to which the robot 10 transitions when it waits for a while after performing a specific task. The robot 10 resumes operation after transitioning to the standby posture once. The standby posture is also called a standby state, an initial posture, or a home position. Hereinafter, the standby posture is also called a first state. The first state shown in FIG. 2 is one of the standing states in which the directions De1 and De2 are parallel to the axis Ax1.

[0084] For example, the first state is a state in which the directions De1 and De2 are parallel to the axis Ax1, and the end LK2ed1 of the link LK2 is located closer to the end LK1ed1 than the end LK1ed2 of the link LK1. In the first state, the joint mechanism JEr3 is preferably located in a central region ARmd1 excluding both ends of the movement region ARmv1, and is located in a central region ARmd2 excluding both ends of the movement region ARmv2. The central region ARmd1 is an example of a "first central region," and the central region ARmd2 is an example of a "second central region."

[0085] The central region ARmd1 is, for example, a region located substantially in the center of the movement region ARmv1. The substantially center of the movement region ARmv1 is, for example, in the direction De1, within a range of ± a first predetermined value with respect to the center C1 (see FIG. 5) of the movement region ARmv1. The first predetermined value is preferably about 1 / 6 of the length of the movement region ARmv1 along the direction De1. More preferably, the first predetermined value is about 1 / 8 of the length of the movement region ARmv1 along the direction De1.

[0086] Moreover, the central region ARmd2 is, for example, a region located substantially in the center of the movement region ARmv2. The substantially center of the movement region ARmv2 is, for example, in the direction De2, within a range of ± a second predetermined value with respect to the center C2 (see FIG. 5) of the movement region ARmv2. The second predetermined value is preferably about 1 / 6 of the length of the movement region ARmv2 along the direction De2. More preferably, the second predetermined value is about 1 / 8 of the length of the movement region ARmv2 along the direction De2.

[0087] In the first state, as described above, the orientation of the links LK1 and LK2 is maintained so that the links LK1 and LK2 extend along the axis Ax1. In this case, the inertial force when the robot 10 is rotated about the axis Ax1 can be made smaller than when the orientation of the links LK1 and LK2 is such that one or both of the links LK1 and LK2 extend along a direction intersecting the axis Ax1.

[0088] Therefore, in this embodiment, by setting the state of the links LK1 and LK2 to the first state, the inertial force caused by the physical length and weight of the robot arm (links LK1 and LK2) can be reduced. As a result, in this embodiment, the robot 10 can be precisely controlled. For example, in this embodiment, the influence of vibration (vibration damping) when the operation of the robot 10 is stopped can be reduced. Therefore, in this embodiment, it is possible to shorten the total operation time of the robot 10 when the robot 10 performs a predetermined task, improve the operation accuracy, and the like.

[0089] Furthermore, in this embodiment, by setting the links LK1 and LK2 to the first state, the robot 10 can be made compact, making it easier to carry the robot 10. Therefore, in this embodiment, it is possible to facilitate installation work when installing the robot 10 in a factory, or work to change the installation of the robot 10 due to equipment changes in the factory, etc.

[0090] Furthermore, although details will be described later in FIG. 5 etc., in this embodiment, by having the robot 10 wait in the first state, it is possible to prevent the time required for state transition, which transitions the state of the robot 10 from one state to another, from becoming long.

[0091] The state of the links LK1 and LK2 that reduces the inertial force when the robot 10 is rotated around the axis Ax1 is not limited to the first state as long as the links LK1 and LK2 are in a posture (standing state) in which they extend along the axis Ax1. For example, the state of the links LK1 and LK2 may be close to the first state. The state close to the first state may be, for example, a state in which the directions De1 and De2 are parallel to the axis Ax1 and the end LK2ed1 of the link LK2 is located closer to the end LK1ed2 than the end LK1ed1 of the link LK1. In this case, the links LK1 and LK2 extend along the axis Ax1, and the link LK2 is located so that the tip TP1 is away from the link LK1. That is, in this embodiment, by setting the state of the robot 10 to an upright state, the inertial force when the robot 10 is rotated around the axis Ax1 can be reduced. However, the robot 10 is more stable when the tip TP1 is closer to the link LK1 than when the tip TP1 is farther from the link LK1.

[0092] Next, other states (states other than the first state) that represent the characteristics of the robot 10 in this embodiment will be described with reference to Figures 3 and 4. The states of the links LK1 and LK2 in the robot 10 can transition to a number of unique states including the first state shown in Figure 2, the second state shown in Figure 3, and the third state shown in Figure 4. Note that the states (postures) that represent the characteristics of the robot 10 in this embodiment are not limited to the first state, the second state, and the third state.

[0093] First, the second state will be described with reference to FIG.

[0094] Fig. 3 is an explanatory diagram for explaining an example of a state of the robot 10 shown in Fig. 1. The state of the links LK1 and LK2 shown in Fig. 3 is the second state. In Fig. 3, the same members as in Figs. 1 and 2 are given the same reference numerals. In Fig. 3, in order to make the drawing easier to see, some of the elements (e.g., rail JEp14, etc.) that are not used in the description of the second state are omitted.

[0095] As shown in FIG. 3, in the second state, the direction De1 is parallel to the axis Ax1, and the axis Ax3 is located closer to the end LK1ed1 than the end LK1ed2 of the link LK1, and is located closer to the end LK2ed2 than the end LK2ed1 of the link LK2. As a result, the length from the end LK1ed1 to the axis Ax3, which is the substantial link length (arm length) of the link LK1, is less than half the length of the link LK1. Also, the length from the axis Ax3 to the end LK2ed2, which is the substantial link length (arm length) of the link LK2, is less than half the length of the link LK2. Therefore, the area where the link LK1 and the link LK2 interfere with each other is very small, and the tip part TP1 can be easily moved to the periphery of the body part BDP, making it possible to easily perform work around the body part BDP of the robot 10.

[0096] Furthermore, in the second state, the joint mechanisms JEr2, JEr3, and JEr4 do not approach each other in a straight line, so that the robot 10 can perform work around the body part BDP without worrying about singular points. A singular point is, for example, a posture of the robot 10 that makes it impossible to control the robot 10. As described above, in this embodiment, since there is no need to consider singular points, the robot 10 can be operated safely when performing work in which the tip part TP1 is located around the body part BDP.

[0097] Furthermore, when the control of the tip part TP1 around the body part BDP is performed by the joint mechanism JEr2 by the motor MOr2 and the joint mechanism JEr3 by the motor MOr3, the control accuracy depends on the substantial link length of the links LK1 and LK2. The shorter the substantial link length of the links LK1 and LK2, the higher the precision of the control becomes, and the vibration control performance when the tip part TP1 is stopped is improved. In the case of the second state of this embodiment, since the substantial link length of the links LK1 and LK2 is short, the positional accuracy and vibration control performance of the tip part TP1 can be improved.

[0098] In the second state, the direction De1 does not necessarily have to be parallel to the axis Ax1, and the link LK1 may be inclined with respect to the axis Ax1 as long as the tip part TP1 can be positioned around the body part BDP.

[0099] Next, a third state, which is another example of a state in which the robot 10 is made compact, will be described with reference to FIG.

[0100] Fig. 4 is an explanatory diagram for explaining another example of the state of the robot 10 shown in Fig. 1. The state of the links LK1 and LK2 shown in Fig. 4 is the third state.

[0101] The third state is a state in which the directions De1 and De2 are perpendicular to the axis Ax1, and the end LK2ed1 of the link LK2 is located closer to the end LK1ed1 than the end LK1ed2 of the link LK1. That is, in the third state, the orientations of the links LK1 and LK2 are maintained such that the links LK1 and LK2 extend along a direction perpendicular to the axis Ax1 (a direction parallel to the bottom surface BDPbt of the body part BDP).

[0102] In the third state, the robot 10 is compact, as in the first state. When the links LK1 and LK2 are in the third state, the robot 10 can be easily packed by using a cushioning member or the like having a recess corresponding to the portion protruding from the links LK1 and LK2 in the direction along the axis Ax1. The portion protruding from the links LK1 and LK2 in the direction along the axis Ax1 is, for example, a part of the tip portion TP1 and the body portion BDP.

[0103] In this manner, in this embodiment, by setting the links LK1 and LK2 in the third state, the robot 10 can be made compact, and the robot 10 can be easily carried.

[0104] In the third state, the position of the joint mechanism JEr3 (more precisely, the axis Ax3) is not particularly limited as long as the directions De1 and De2 are perpendicular to the axis Ax1 and the end LK2ed1 of the link LK2 is closer to the end LK1ed1 than the end LK1ed2 of the link LK1. For example, the position of the joint mechanism JEr3 in the third state may be closer to the end LK1ed1 than the end LK1ed2 of the link LK1 and closer to the end LK2ed1 than the end LK2ed2 of the link LK2, as shown in FIG. 4. Alternatively, the position of the joint mechanism JEr3 in the third state may be closer to the end LK1ed2 than the end LK1ed1 of the link LK1 and closer to the end LK2ed2 than the end LK2ed1 of the link LK2. Alternatively, the position of the joint mechanism JEr3 in the third state may be the central regions ARmd1 and ARmd2, as in the first state.

[0105] When the position of the joint mechanism JEr3 is in the central regions ARmd1 and ARmd2, it can be treated as the first state because it can be set as a standby state. Usually, when the bottom surface BDPbt of the body part BDP, which is the base, is placed on the floor, the space in which the robot 10 works is the upper area of ​​the bottom surface BDPbt, so the first state shown in FIG. 2 is set as the standby state. However, when the robot 10 is installed on the top of a platform with a certain height or when the height of the body part BDP is high, it is assumed that the space in which the robot 10 works will be the side area of ​​the robot 10 and may include the area below the joint mechanism JEr2. Therefore, in such a case, by setting the state in which the position of the joint mechanism JEr3 is in the central regions ARmd1 and ARmd2 as the first state, which is a standby posture, it is possible to achieve the same effect as the first state shown in FIG. 2.

[0106] The state in which the robot 10 is made compact may be a state in which the joint mechanism JEr3 (more precisely, the axis Ax3) is located outside the central regions ARmd1 and ARmd2 in the standing state. For example, the state in which the robot 10 is made compact may be a state in which the joint mechanism JEr3 is closer to the end LK1ed1 than the end LK1ed2 of the link LK1 and closer to the end LK1ed1 than the end LK1ed2 of the link LK2 in the standing state (for example, a first comparative state shown in FIG. 6, etc.). Alternatively, the state in which the robot 10 is made compact may be a state in which the joint mechanism JEr3 is closer to the end LK1ed2 than the end LK1ed1 of the link LK1 and closer to the end LK1ed2 than the end LK1ed1 of the link LK2 in the standing state (for example, a second comparative state shown in FIG. 7, etc.).

[0107] Next, an example of a state transition in which the state of the robot 10 transitions from an upright state such as the first state shown in FIG. 2 to a predetermined working state will be described with reference to FIGS.

[0108] In FIG. 5 to FIG. 10, the position of the joint mechanism JEr3 with respect to the link LK1 is shown with the center C1 of the direction De1 of the moving area ARmv1 as the origin, and the position of the joint mechanism JEr3 with respect to the link LK2 is shown with the center C2 of the direction De2 of the moving area ARmv2 as the origin. For example, the position of the joint mechanism JEr3 with respect to the link LK1 is shown with a positive value when the axis Ax3 is located in the direction De1 with respect to the center C1, and is shown with a negative value when the axis Ax3 is located in the opposite direction to the direction De1 with respect to the center C1. The absolute value of the value shown as the position of the joint mechanism JEr3 with respect to the link LK1 indicates, for example, the distance from the center C1 to the axis Ax3. Also, for example, the position of the joint mechanism JEr3 with respect to the link LK2 is shown with a positive value when the axis Ax3 is located in the direction De2 with respect to the center C2, and is shown with a negative value when the axis Ax3 is located in the opposite direction to the direction De1 with respect to the center C2. The absolute value of the value indicated as the position of the joint mechanism JEr3 with respect to the link LK2 indicates, for example, the distance from the center C2 to the axis Ax3. Note that in the figures other than Fig. 5, the center C1 of the movement area ARmv1 and the center C2 of the movement area ARmv2 are omitted from illustration in order to make the figures easier to see.

[0109] Moreover, the length Ld1 indicates the maximum movement amount when the joint mechanism JEr3 moves along the direction De1, and the length Ld2 indicates the maximum movement amount when the joint mechanism JEr3 moves along the direction De2. Hereinafter, α times the length Ld1 (α is an arbitrary value) may be referred to as α×Ld1, and α times the length Ld2 may be referred to as α×Ld2. In Figs. 5 to 10, it is assumed that the joint mechanism JEr3 can move within a range of ±0.5×Ld1 (1 / 2 of the length Ld1) from the center C1 along the direction De1, and can move within a range of ±0.5×Ld2 (1 / 2 of the length Ld2) from the center C2 along the direction De2.

[0110] 5 to 10, the time required to move the joint mechanism JEr3 by the length Ld1 is time Td1, the time required to move the joint mechanism JEr3 by the length Ld2 is time Td2, and the time required to rotate the link LK2 360° about the axis Ax3 is time Tx3.

[0111] 5 to 10, in order to facilitate understanding of state transitions of the robot 10, it is assumed that the moving speed of the joint mechanism JEr3 when the joint mechanism JEr3 moves along the direction De1 by the joint mechanism JEp1 is a constant speed represented by Ld1 / Td1. Similarly, in Fig. 5 to 10, it is assumed that the moving speed of the joint mechanism JEr3 when the joint mechanism JEr3 moves along the direction De2 by the joint mechanism JEp2 is a constant speed represented by Ld2 / Td2. It is assumed that the rotation speed of the link LK2 when the link LK2 rotates around the axis Ax3 by the joint mechanism JEr3 is a constant speed represented by 360° / Tx3.

[0112] 5 to 10, in order to facilitate understanding of the state transition of the robot 10, it is assumed that the times Td1, Td2, and Tx3 are the same as each other. Hereinafter, the times Td1, Td2, and Tx3 may be collectively referred to as time Tu. For example, in FIGS. 5 to 10, the elapsed time from the start of the state transition of the robot 10 is indicated using the time Tu. Hereinafter, α times the time Tu may be referred to as α×Tu.

[0113] First, a state transition in which the state of the robot 10 transitions from the first state to the first working state will be described with reference to FIG.

[0114] FIG. 5 is an explanatory diagram for explaining the state of the robot 10 transitioning from the first state to the first working state. FIG. 5 shows a schematic diagram of the transition process when the state of the robot 10 transitions from the first state to the first working state. For example, the states of the robot 10 at the start of the state transition, at the timing when 0.15×Tu time has elapsed since the start of the state transition, at the timing when 0.2×Tu time has elapsed since the start of the state transition, and at the end of the state transition (0.5×Tu) are shown. Also, for example, the dashed arrow shown in the state of the robot 10 at the end of the state transition (0.5×Tu) indicates the motion area of ​​the robot 10 accompanying the state transition of the robot 10 (mainly the movement area of ​​the tip part TP1 and the movement area of ​​the end part LK2ed1 of the link LK2).

[0115] The first state is a state in which the directions De1 and De2 are parallel to the axis Ax1, and the end LK2ed1 of the link LK2 is closer to the end LK1ed1 than the end LK1ed2 of the link LK1, as described in Fig. 2. In the first state shown in Fig. 5, the position of the joint mechanism JEr3 relative to the link LK1 and the position of the joint mechanism JEr3 relative to the link LK2 are 0, and the angle between the links LK1 and LK2 is 0°.

[0116] The first working state is, for example, a state in which the direction De1 is parallel to the axis Ax1 and the direction De2 is perpendicular to the axis Ax1, and the tip part TP1 is farthest from the body part BDP. That is, in the first working state, the position of the joint mechanism JEr3 relative to the link LK1 is 0.5×Ld1, the position of the joint mechanism JEr3 relative to the link LK2 is −0.5×Ld2, and the angle between the links LK1 and LK2 is 90°.

[0117] Therefore, in the transition from the first state to the first working state, the position of the joint mechanism JEr3 with respect to the link LK1 changes from 0 to 0.5×Ld1, and the position of the joint mechanism JEr3 with respect to the link LK2 changes from 0 to −0.5×Ld2. Also, the angle between the links LK1 and LK2 changes from 0° to 90°.

[0118] For example, the shortest time required for the position of the joint mechanism JEr3 relative to the link LK1 to move from 0 to 0.5×Ld1 is 0.5×Td1 (=0.5×Tu). The shortest time required for the position of the joint mechanism JEr3 relative to the link LK2 to move from 0 to -0.5×Ld2 is 0.5×Td2 (=0.5×Tu). The shortest time required for the angle formed by the links LK1 and LK2 to change from 0° to 90° (=0.25×360°) is 0.25×Tx3 (=0.25×Tu). Therefore, the time required for the state of the robot 10 to transition from the first state to the first working state is 0.5×Tu.

[0119] Next, a state transition in which the state of the robot 10 transitions from a first comparison state, which is compared with a first state, to a first working state will be described with reference to FIG.

[0120] FIG. 6 is an explanatory diagram for explaining the state of the robot 10 transitioning from the first comparison state to the first work state. FIG. 6 shows a schematic diagram of the transition process when the state of the robot 10 transitions from the first comparison state to the first work state. For example, the states of the robot 10 at the start of the state transition, at the timing when 0.15×Tu time has elapsed since the start of the state transition, at the timing when 0.2×Tu time has elapsed since the start of the state transition, and at the end of the state transition (1.0×Tu) are shown. Also, in FIG. 6, as in FIG. 5, the dashed arrows shown in the state of the robot 10 at the end of the state transition (1.0×Tu) indicate the operating area of ​​the robot 10 accompanying the state transition of the robot 10.

[0121] The first comparative state is one of the standing states. For example, the first comparative state is similar to the first state shown in FIG. 5 except that the position of the joint mechanism JEr3 is the closest to the end LK1ed1 in the movement region ARmv1 and the closest to the end LK2ed1 in the movement region ARmv2. That is, the first comparative state is similar to the first state shown in FIG. 5 except that the position of the joint mechanism JEr3 relative to the link LK1 is −0.5×Ld1, and the position of the joint mechanism JEr3 relative to the link LK2 is −0.5×Ld2.

[0122] Therefore, in the transition from the first comparison state to the first working state, the position of the joint mechanism JEr3 with respect to the link LK1 changes from -0.5×Ld1 to 0.5×Ld1, and the angle between the links LK1 and LK2 changes from 0° to 90°. Note that the position of the joint mechanism JEr3 with respect to the link LK2 is maintained at -0.5×Ld2 and does not change.

[0123] For example, the time required for the position of the joint mechanism JEr3 relative to the link LK1 to move from -0.5×Ld1 to 0.5×Ld1, i.e., the time required for the joint mechanism JEr3 to move by the length Ld1, is at least 1.0×Td1 (=1.0×Tu). The time required for the angle between the links LK1 and LK2 to change from 0° to 90° (=0.25×360°) is at least 0.25×Tx3 (=0.25×Tu). Therefore, the time required for the state of the robot 10 to transition from the first comparison state to the first working state is 1.0×Tu, which is twice the time required (0.5×Tu) to transition from the first state to the first working state.

[0124] When the time required for the state transition of the robot 10 is long, the load on the motor MO is greater than when the time required for the state transition of the robot 10 is short. Therefore, when the state of the robot 10 is transitioned from the first comparison state to the first work state, the load on the motor MO is greater than when the state of the robot 10 is transitioned from the first state to the first work state. In other words, when the state of the robot 10 is transitioned from the first state to the first work state, the load on the motor MO can be smaller than when the state of the robot 10 is transitioned from the first comparison state to the first work state.

[0125] Also, as can be seen from the dashed arrow indicating the state of the robot 10 at the end of the state transition (1.0×Tu), the operating area of ​​the robot 10 accompanying the state transition of the robot 10 is mainly the movement area of ​​the tip part TP1. However, the movement area of ​​the tip part TP1 accompanying the transition from the first comparison state to the first work state is larger than the movement area of ​​the tip part TP1 accompanying the transition from the first state to the first work state shown in FIG. 5. That is, when the state of the robot 10 is transitioned from the first comparison state to the first work state, a larger space needs to be secured around the robot 10 compared to when the state of the robot 10 is transitioned from the first state to the first work state. In other words, when the state of the robot 10 is transitioned from the first state to the first work state, the state of the robot 10 can be transitioned in a smaller space compared to when the state of the robot 10 is transitioned from the first comparison state to the first work state.

[0126] Next, a state transition in which the state of the robot 10 transitions from a second comparison state, which is compared with the first state, to a first working state will be described with reference to FIG.

[0127] FIG. 7 is an explanatory diagram for explaining the state of the robot 10 transitioning from the second comparison state to the first work state. FIG. 7 shows a schematic diagram of the transition process when the state of the robot 10 transitions from the second comparison state to the first work state. For example, the states of the robot 10 at the start of the state transition, at the timing when 0.15×Tu time has elapsed since the start of the state transition, at the timing when 0.2×Tu time has elapsed since the start of the state transition, and at the end of the state transition (1.0×Tu) are shown. Also, in FIG. 7, as in FIG. 5, the dashed arrows shown in the state of the robot 10 at the end of the state transition (1.0×Tu) indicate the operating area of ​​the robot 10 accompanying the state transition of the robot 10.

[0128] The second comparative state is one of the standing states. For example, the second comparative state is similar to the first state shown in FIG. 5 except that the position of the joint mechanism JEr3 is the farthest from the end LK1ed1 in the movement region ARmv1 and the farthest from the end LK2ed1 in the movement region ARmv2. That is, the second comparative state is similar to the first state shown in FIG. 5 except that the position of the joint mechanism JEr3 relative to the link LK1 is 0.5×Ld1, and the position of the joint mechanism JEr3 relative to the link LK2 is 0.5×Ld2.

[0129] Therefore, in the transition from the second comparison state to the first working state, the position of the joint mechanism JEr3 with respect to the link LK2 changes from 0.5×Ld2 to -0.5×Ld2, and the angle between the links LK1 and LK2 changes from 0° to 90°. Note that the position of the joint mechanism JEr3 with respect to the link LK1 is maintained at 0.5×Ld1 and does not change.

[0130] For example, the time required for the position of the joint mechanism JEr3 relative to the link LK2 to move from 0.5×Ld2 to -0.5×Ld2, i.e., the time required for the joint mechanism JEr3 to move by the length Ld2, is at least 1.0×Td2 (=1.0×Tu). The time required for the angle between the links LK1 and LK2 to change from 0° to 90° (=0.25×360°) is at least 0.25×Tx3 (=0.25×Tu). Therefore, the time required for the state of the robot 10 to transition from the second comparison state to the first working state is 1.0×Tu, which is twice the time required (0.5×Tu) to transition from the first state to the first working state.

[0131] Also, as can be seen from the dashed arrows showing the state of the robot 10 at the end of the state transition (1.0×Tu), the operating area of ​​the robot 10 accompanying the state transition of the robot 10 is mainly the moving area of ​​the end LK2ed1 of the link LK2 and the moving area of ​​the tip TP1. For example, the moving area of ​​the end LK2ed1 of the link LK2 accompanying the transition from the second comparison state to the first work state is larger than the moving area of ​​the end LK2ed1 of the link LK2 accompanying the transition from the first state to the first work state shown in FIG. 5. That is, when the state of the robot 10 is transitioned from the second comparison state to the first work state, it is necessary to secure a larger space around the robot 10 compared to the case where the state of the robot 10 is transitioned from the first state to the first work state. In other words, when the state of the robot 10 is transitioned from the first state to the first work state, the state of the robot 10 can be transitioned in a smaller space compared to the case where the state of the robot 10 is transitioned from the second comparison state to the first work state.

[0132] In this manner, in this embodiment, by having the robot 10 wait in the first state, the time required to transition the state of the robot 10 to the first work state can be shortened compared to the case where the robot 10 waits in the first comparison state or the second comparison state. As a result, in this embodiment, it is possible to suppress an increase in the load on the motor MO when the state of the robot 10 is transitioned to the first work state.

[0133] Next, a state transition in which the state of the robot 10 transitions from the first state to the second working state will be described with reference to FIG.

[0134] FIG. 8 is an explanatory diagram for explaining the state of the robot 10 transitioning from the first state to the second working state. FIG. 8 shows a schematic diagram of the transition process when the state of the robot 10 transitions from the first state to the second working state. For example, the states of the robot 10 at the start of the state transition, at the timing when 0.125×Tu time has elapsed since the start of the state transition, at the timing when 0.25×Tu time has elapsed since the start of the state transition, and at the end of the state transition (0.375×Tu) are shown. In FIG. 8, as in FIG. 5, the dashed arrows shown in the state of the robot 10 at the end of the state transition (0.375×Tu) indicate the operating area of ​​the robot 10 accompanying the state transition of the robot 10.

[0135] The second working state is, for example, a state close to the second state described in Fig. 3. For example, in the second working state, the direction De1 is parallel to the axis Ax1, the direction De2 intersects with the axis Ax1, and the axis Ax3 is located in the opposite direction to the direction De1 with respect to the center C1 (see Fig. 5) of the moving area ARmv1, and is located at the center C2 (see Fig. 5) of the moving area ARmv2. In the second working state shown in Fig. 8, the position of the joint mechanism JEr3 relative to the link LK1 is -0.125 x Ld1, the position of the joint mechanism JEr3 relative to the link LK2 is 0, and the angle between the links LK1 and LK2 is 135°.

[0136] Therefore, in the transition from the first state to the second working state, the position of the joint mechanism JEr3 with respect to the link LK1 changes from 0 to -0.125×Ld1, and the angle between the links LK1 and LK2 changes from 0° to 135°. Note that the position of the joint mechanism JEr3 with respect to the link LK2 is maintained at 0 and does not change.

[0137] For example, the shortest time required for the position of the joint mechanism JEr3 relative to the link LK1 to move from 0 to -0.125×Ld1 is 0.125×Td1 (=0.125×Tu). Also, the shortest time required for the angle between the links LK1 and LK2 to change from 0° to 135° (=0.375×360°) is 0.375×Tx3 (=0.375×Tu). Therefore, the time required for the state of the robot 10 to transition from the first state to the second working state is 0.375×Tu.

[0138] Next, a state transition in which the state of the robot 10 transitions from the first comparison state to the second working state will be described with reference to FIG.

[0139] FIG. 9 is an explanatory diagram for explaining the state of the robot 10 transitioning from the first comparison state to the second work state. FIG. 9 shows a schematic diagram of the transition process when the state of the robot 10 transitions from the first comparison state to the second work state. For example, the states of the robot 10 at the start of the state transition, at the timing when 0.125×Tu time has elapsed since the start of the state transition, at the timing when 0.25×Tu time has elapsed since the start of the state transition, and at the end of the state transition (0.5×Tu) are shown. Also, in FIG. 9, as in FIG. 5, the dashed arrows shown in the state of the robot 10 at the end of the state transition (0.5×Tu) indicate the operating area of ​​the robot 10 accompanying the state transition of the robot 10.

[0140] In the transition from the first comparison state to the second working state, the position of the joint mechanism JEr3 with respect to the link LK1 changes from -0.5×Ld1 to -0.125×Ld1, and the position of the joint mechanism JEr3 with respect to the link LK2 changes from -0.5×Ld2 to 0. Also, the angle between the links LK1 and LK2 changes from 0° to 135°.

[0141] For example, the time required for the position of the joint mechanism JEr3 relative to the link LK1 to move from -0.5 x Ld1 to -0.125 x Ld1, i.e., the time required for the joint mechanism JEr3 to move by 0.375 x Ld1, is 0.375 x Td1 (= 0.375 x Tu) at the shortest. Also, the time required for the position of the joint mechanism JEr3 relative to the link LK2 to move from -0.5 x Ld2 to 0 is 0.5 x Td2 (= 0.5 x Tu) at the shortest. And, the time required for the angle formed by the links LK1 and LK2 to change from 0° to 135° (= 0.375 x 360°) is 0.375 x Tx3 (= 0.375 x Tu) at the shortest. Therefore, the time required for the state of the robot 10 to transition from the first comparison state to the second work state is 0.5 x Tu, which is approximately 1.33 times the time required to transition from the first state to the second work state (0.375 x Tu).

[0142] Also, as can be seen from the dashed arrows showing the state of the robot 10 at the end of the state transition (0.5×Tu), the operating area of ​​the robot 10 accompanying the state transition of the robot 10 is mainly the moving area of ​​the end LK2ed1 of the link LK2 and the moving area of ​​the tip part TP1. For example, the moving area of ​​the end part LK2ed1 of the link LK2 accompanying the transition from the first comparison state to the second work state is smaller than the moving area of ​​the end part LK2ed1 of the link LK2 accompanying the transition from the first state to the second work state shown in FIG. 8. However, the moving area of ​​the tip part TP1 accompanying the transition from the first comparison state to the second work state tends to be larger than the moving area of ​​the tip part TP1 accompanying the transition from the first state to the second work state shown in FIG. 8. For this reason, when the state of the robot 10 is transitioned from the first comparison state to the second work state, it is necessary to secure a larger space around the robot 10 compared to when the state of the robot 10 is transitioned from the first state to the second work state. In other words, when the state of the robot 10 is transitioned from the first state to the second working state, the state of the robot 10 can be transitioned in a smaller space than when the state of the robot 10 is transitioned from the first comparison state to the second working state.

[0143] Next, a state transition in which the state of the robot 10 transitions from the second comparison state to the second working state will be described with reference to FIG.

[0144] FIG. 10 is an explanatory diagram for explaining the state of the robot 10 transitioning from the second comparison state to the second work state. FIG. 10 shows a schematic diagram of the transition process when the state of the robot 10 transitions from the second comparison state to the second work state. For example, the states of the robot 10 at the start of the state transition, at the timing when 0.125×Tu time has elapsed since the start of the state transition, at the timing when 0.25×Tu time has elapsed since the start of the state transition, and at the end of the state transition (0.625×Tu) are shown. Also, in FIG. 10, as in FIG. 5, the dashed arrows shown in the state of the robot 10 at the end of the state transition (0.625×Tu) indicate the operating area of ​​the robot 10 accompanying the state transition of the robot 10.

[0145] In the transition from the second comparison state to the second working state, the position of the joint mechanism JEr3 with respect to the link LK1 changes from 0.5×Ld1 to −0.125×Ld1, and the position of the joint mechanism JEr3 with respect to the link LK2 changes from 0.5×Ld2 to 0. Also, the angle between the links LK1 and LK2 changes from 0° to 135°.

[0146] For example, the time required for the position of the joint mechanism JEr3 relative to the link LK1 to move from 0.5×Ld1 to -0.125×Ld1, i.e., the time required for the joint mechanism JEr3 to move by 0.625×Ld1, is at least 0.625×Td1 (=0.625×Tu). Also, the time required for the position of the joint mechanism JEr3 relative to the link LK2 to move from 0.5×Ld2 to 0 is at least 0.5×Td2 (=0.5×Tu). And, the time required for the angle between the links LK1 and LK2 to change from 0° to 135° (=0.375×360°) is at least 0.375×Tx3 (=0.375×Tu). Therefore, the time required for the state of the robot 10 to transition from the second comparison state to the second working state is 0.625×Tu, which is approximately 1.66 times the time required to transition from the first state to the second working state (0.375×Tu).

[0147] Also, as can be seen from the dashed arrows showing the state of the robot 10 at the end of the state transition (1.0×Tu), the operating area of ​​the robot 10 accompanying the state transition of the robot 10 is mainly the moving area of ​​the end LK2ed1 of the link LK2 and the moving area of ​​the tip part TP1. For example, the moving area of ​​the end part LK2ed1 of the link LK2 accompanying the transition from the second comparison state to the second work state is larger than the moving area of ​​the end part LK2ed1 of the link LK2 accompanying the transition from the first state to the second work state shown in FIG. 8. Also, the moving area of ​​the tip part TP1 accompanying the transition from the second comparison state to the second work state tends to be larger than the moving area of ​​the tip part TP1 accompanying the transition from the first state to the second work state shown in FIG. 8. For this reason, when the state of the robot 10 is transitioned from the second comparison state to the second work state, it is necessary to secure a larger space around the robot 10 compared to when the state of the robot 10 is transitioned from the first state to the second work state. In other words, when the state of the robot 10 is transitioned from the first state to the second working state, the state of the robot 10 can be transitioned in a smaller space than when the state of the robot 10 is transitioned from the second comparison state to the second working state.

[0148] In this manner, in this embodiment, by having the robot 10 wait in the first state, the time required to transition the state of the robot 10 to the second work state can be shortened compared to the case where the robot 10 waits in the first comparison state or the second comparison state. As a result, in this embodiment, it is possible to suppress an increase in the load on the motor MO when the state of the robot 10 is transitioned to the second work state.

[0149] Note that the state transition to the first working state shown in Fig. 5 etc. and the state transition to the second working state shown in Fig. 8 etc. are two state transitions among many state transitions of the robot 10. Therefore, by having the robot 10 wait in the first state, the amount of movement of the position of the joint mechanism JEr3 relative to the link LK1 and the amount of movement of the position of the joint mechanism JEr3 relative to the link LK2 are not minimized for all state transitions. Also, the area occupied as the operating area is not minimized for all state transitions.

[0150] However, when the robot 10 is made to wait in the first state, the movement amount of the position of the joint mechanism JEr3 relative to the link LK1 is 0.5×Ld1 at maximum, and the movement amount of the position of the joint mechanism JEr3 relative to the link LK2 is 0.5×Ld2 at maximum. Also, as described above, when the robot 10 is made to wait in the first state, the area occupied as the operating area of ​​the robot 10 during state transition can be made smaller in many cases than in the first comparison state or the second comparison state. Therefore, when considering the transition from the standing state to various working states comprehensively, it is optimal to make the robot 10 wait in the first state, taking into consideration the time required for the state transition and the size of the area occupied as the operating area of ​​the robot 10 during state transition. Also, the first state is not limited to the standing state shown in FIG. 2, and the same effect can be obtained even if the position of the joint mechanism JEr3 is the central area ARmd1 and ARmd2 in the third state shown in FIG. 4.

[0151] Also, for example, when the robot 10 starts to move from the first state, the joint mechanism JEr3 can move in both directions De1 and the opposite direction to the direction De1 by the joint mechanism JEp1, and can move in both directions De2 and the opposite direction to the direction De2 by the joint mechanism JEp2. This increases the variation in the movement of the robot 10 from the first state.

[0152] Furthermore, as described above, when the robot 10 starts to move from the first state, the maximum movement amount of the joint mechanism JEr3 is approximately half of the movable range (movement areas ARmv1 and ARmv2) of the joint mechanism JEr3. Therefore, in this embodiment, it is possible to reduce the influence of vibration (vibration damping) when the movement of the joint mechanism JEr3 is stopped. As a result, in this embodiment, it is possible to improve the operation accuracy when operating the robot 10. Furthermore, when the robot 10 starts to move from the first state, the area occupied by the robot 10 as the operation area becomes smaller, so that the links LK1 and LK2 can move in a narrow space, and interference with obstacles in the vicinity of the links LK1 and LK2 can be suppressed as much as possible.

[0153] Furthermore, when the robot 10 is made to wait in the first state, the control of the joint mechanisms JEp1 and JEp2 can be made symmetrical in the positive and negative directions with respect to the centers C1 and C2 by using the first state as a reference, and well-balanced control can be achieved. Furthermore, when the robot 10 is made to wait in the first state, the control of the joint mechanism JEp1 is made symmetrical in the direction De1 and the opposite direction of the direction De1 with respect to the center C1, so that the calculation of the control of one of the direction De1 and the opposite direction of the direction De1 can be used to simplify the calculation of the control of the other. Similarly to the control of the joint mechanism JEp1, the control of the joint mechanism JEp2 is also made symmetrical in the direction De2 and the opposite direction of the direction De2 with respect to the center C2, so that the calculation of the control of the other of the direction De2 and the opposite direction of the direction De2 can be used to simplify the calculation of the control of the other. In this way, when the robot 10 is made to wait in the first state, the control of the joint mechanisms JEp1 and JEp2 can be simplified.

[0154] Furthermore, when the robot 10 is on standby in the first state, the joint mechanism JEr3 is located in the central area ARmd1 of the movement area ARmv1 and is located in the central area ARmd2 of the movement area ARmv2, so the rotation direction of the motor MOr3 is basically not limited. Therefore, when the robot 10 is on standby in the first state, the movement of the robot 10 from the first state becomes more varied.

[0155] Next, the hardware configuration of the robot controller 30 will be described with reference to FIG.

[0156] FIG. 11 is a diagram illustrating an example of a hardware configuration of the robot controller 30 illustrated in FIG.

[0157] The robot controller 30 has a processing device 32 that controls each part of the robot controller 30, a memory 33 that stores various information, a communication device 34, an operation device 35 that accepts operations by an operator, etc., a display device 36, and a driver circuit 37.

[0158] The memory 33 includes, for example, one or both of a volatile memory such as a random access memory (RAM) that functions as a working area for the processing device 32 and a non-volatile memory such as an electrically erasable programmable read-only memory (EEPROM) that stores various information such as the control program PGr. The memory 33 may be detachable from the robot controller 30. Specifically, the memory 33 may be a storage medium such as a memory card that is detachable from the robot controller 30. The memory 33 may also be, for example, a storage device (e.g., online storage) that is communicatively connected to the robot controller 30 via a network or the like.

[0159] 11 stores a control program PGr. In this embodiment, the control program PGr includes, for example, an application program that causes the robot controller 30 to control the operation of the robot 10. However, the control program PGr may also include, for example, an operating robot system program that causes the processing device 32 to control each part of the robot controller 30.

[0160] The processing device 32 is a processor that controls the entire robot controller 30, and is configured to include, for example, one or more CPUs (Central Processing Units). The processing device 32 executes, for example, a control program PGr stored in the memory 33, and operates in accordance with the control program PGr to control the operation of the robot 10. The control program PGr may be transmitted from another device via a network or the like.

[0161] Furthermore, for example, when the processing device 32 is configured to include multiple CPUs, some or all of the functions of the processing device 32 may be realized by the multiple CPUs operating in cooperation with each other according to a program such as the control program PGr. Furthermore, the processing device 32 may be configured to include hardware such as a GPU (Graphics Processing Unit), a DSP (Digital Signal Processor), or an FPGA (Field Programmable Gate Array) in addition to one or more CPUs, or instead of some or all of the one or more CPUs. In this case, some or all of the functions of the processing device 32 may be realized by hardware such as a DSP.

[0162] The communication device 34 is hardware for communicating with an external device that exists outside the robot controller 30. For example, the communication device 34 has a function of communicating with the external device by short-range wireless communication. The communication device 34 may further have a function of communicating with the external device via a mobile communication network or a network.

[0163] The operation device 35 is an input device (for example, a keyboard, a mouse, a switch, a button, a sensor, etc.) that accepts input from the outside. For example, the operation device 35 accepts an operation by an operator and outputs operation information corresponding to the operation to the processing device 32. Note that, for example, a touch panel that detects contact with the display surface of the display device 36 may be adopted as the operation device 35.

[0164] The display device 36 is an output device such as a display that outputs to the outside. For example, the display device 36 displays an image under the control of the processing device 32. Note that the operation device 35 and the display device 36 may be integrated into one (for example, a touch panel).

[0165] The driver circuit 37 is hardware that outputs signals to drive the robot 10 under the control of the processing device 32. For example, the driver circuit 37 outputs signals to drive motors MOr1, MOr2, MOr3, MOr4, MOr5, MOr6, MOp1, MOp2, etc. to the robot 10 under the control of the processing device 32. Note that the motors MOr1, MOr2, MOr3, MOr4, MOr5, and MOr6 are motors that drive the joint mechanisms JEr1, JEr2, JEr3, JEr4, JEr5, and JEr6, respectively. Also, the motors MOp1 and MOp2 are motors that drive the joint mechanisms JEp1 and JEp2, respectively.

[0166] In this manner, the robot controller 30 controls the movement of the robot 10 by controlling the motors MOr1, MOr2, MOr3, MOr4, MOr5, MOr6, MOp1, and MOp2.

[0167] As described above, in this embodiment, the robot 10 has a body part BDP, a tip part TP1, and a plurality of links LK including links LK1 and LK2, which connect the body part BDP and the tip part TP1, a joint mechanism JEr3 which connects link LK1 and link LK2 and rotates link LK2 relative to link LK1 around axis Ax3, which forms an angle with the direction De1 in which link LK1 extends that is greater than a predetermined angle, as a first rotation axis, a joint mechanism JEp1 which moves joint mechanism JEr3 relative to link LK1 along direction De1, and a joint mechanism JEp2 which moves link LK2 relative to joint mechanism JEr3 along direction De2 in which link LK2 extends. The states of the links LK1 and LK2 can transition to a first state in which the directions De1 and De2 are parallel to each other, and the end LK2ed1 of the two ends LK2ed of the link LK2, which is farther from the tip end TP1, is located closer to the end LK1ed1 closer to the body part BDP than the end LK1ed2 of the two ends LK1ed of the link LK1, which is farther from the body part BDP. The link LK1 includes a movement area ARmv1 in which the joint mechanism JEr3 moves along the direction De1 by the joint mechanism JEp1, and the link LK2 includes a movement area ARmv2 in which the joint mechanism JEr3 moves along the direction De2 by the joint mechanism JEp2. In the first state, the joint mechanism JEr3 is located in a central area ARmd1 excluding both ends of the movement area ARmv1, and is located in a central area ARmd2 excluding both ends of the movement area ARmv2.

[0168] Thus, in this embodiment, the joint mechanism JEp1 moves the joint mechanism JEr3 relative to the link LK1 along the direction De1, and the joint mechanism JEp2 moves the link LK2 relative to the joint mechanism JEr3 along the direction De2. As a result, in this embodiment, the tip end TP1 of the robot 10 can be moved with simple control.

[0169] Furthermore, in this embodiment, the states of the link LK1 and the link LK2 can be transitioned to a first state in which the direction De1 and the direction De2 are parallel to each other, and the end LK2ed1 of the link LK2 is located closer to the end LK1ed1 than the end LK1ed2 of the link LK1. In the first state, the joint mechanism JEr3 is located in the central area ARmd1 of the movement area ARmv1, and is located in the central area ARmd2 of the movement area ARmv2. As a result, in this embodiment, for example, by setting the state of the robot 10 to the first state, it is possible to suppress an increase in the time required for state transition to transition the state of the robot 10 from the first state to another state. As a result, in this embodiment, when the state of the robot 10 is transitioned from the first state to another state, it is possible to suppress an increase in the load of the motor MO that drives the joint mechanism JEp1 and the like. Also, in this embodiment, by transitioning the state of the robot 10 from the first state to another state, it is possible to suppress an increase in the area occupied as the operating area of ​​the robot 10 (the area around the robot 10).

[0170] In addition, in this embodiment, the central area ARmd1 is an area located substantially at the center of the movement area ARmv1 in the direction De1, and the central area ARmd2 is an area located substantially at the center of the movement area ARmv2 in the direction De2. Therefore, in this embodiment, when the robot 10 starts moving from the first state, the maximum movement amount of the joint mechanism JEr3 is approximately half of the movable range of the joint mechanism JEr3 (movement areas ARmv1 and ARmv2). Therefore, in this embodiment, it is possible to reduce the influence of vibration (vibration damping) when the movement of the joint mechanism JEr3 is stopped, and it is possible to improve the operation accuracy when operating the robot 10.

[0171] In this embodiment, the robot 10 further includes a joint mechanism JEr1 that rotates at least a part of the body part BDP around an axis Ax1 that forms an angle with a direction perpendicular to the bottom surface of the body part BDP equal to or smaller than a predetermined angle as a second rotation axis, a joint mechanism JEr2 that connects the body part BDP and the link LK1 and rotates the link LK1 around an axis Ax2 that forms an angle with a direction perpendicular to the bottom surface of the body part BDP greater than a predetermined angle as a third rotation axis, and a joint mechanism JEr4 that connects the link LK2 and the tip part TP1 and rotates the tip part TP1 relative to the link LK2. As a result, in this embodiment, the tip part TP1 connected to the link LK2 can be moved to the periphery of the body part BDP connected to the link LK1 by simple control.

[0172] In this embodiment, the joint mechanism JEr4 rotates the tip part TP1 relative to the link LK2 around the axis Ax4, which forms an angle with the direction De2 greater than a predetermined angle, as the fourth rotation axis. The tip part TP1 includes a first part TP11 connected to the link LK2, a second part TP12 connected to the first part TP11, a joint mechanism JEr5 that connects the first part TP11 and the second part TP12 and rotates the second part TP12 relative to the first part TP11 around the axis Ax5, which forms an angle with the fourth rotation axis (axis Ax4) greater than a predetermined angle, as the fifth rotation axis, and a joint mechanism JEr6 that rotates a part of the tip part TP1 to which the end effector 20 is attached (for example, the end face TP1sf) around the axis Ax6, which forms an angle with the fifth rotation axis (axis Ax5) greater than a predetermined angle, as the sixth rotation axis. In this way, this embodiment may be realized by adding the joint mechanisms JEp1 and JEp2 to a vertical six-axis articulated robot. For example, in this embodiment, since the tip part TP1 includes the joint mechanisms JEr5 and JEr6, the joint mechanisms JEr4, JEr5, JEr6, etc. can cause the robot 10 to perform various tasks around the body part BDP.

[0173] In this embodiment, the first state is a posture in which the joint mechanisms JEr3, JEp1, and JEp2 are in a standby state, and the links LK1 and LK2 start to move from the first state. When the links LK1 and LK2 start to move from the first state, the joint mechanism JEr3 can move in both directions, the direction De1 and the direction opposite to the direction De1, by the joint mechanism JEp1, and can move in both directions, the direction De2 and the direction opposite to the direction De2, by the joint mechanism JEp2. Therefore, when the links LK1 and LK2 start to move from the first state, it is possible to suppress limitations on the variation in the movements of the robot 10.

[0174] Furthermore, the control method for the robot 10 according to this embodiment controls the joint mechanisms JEr3, JEp1, and JEp2 to make the robot 10 wait in the first state. As a result, in this embodiment, it is possible to prevent the time required for the state transition of the robot 10 from becoming long, and to prevent the load on the motor MO that drives the joint mechanism JEp1 and the like from becoming large. Furthermore, in this embodiment, it is possible to prevent the variation in the operation of the robot 10 from being limited by making the robot 10 wait in the first state.

[0175] Moreover, in this embodiment, the robot system 1 includes a robot 10, an end effector 20 attached to the robot 10, and a robot controller 30 that controls the operations of the robot 10 and the end effector 20. Thus, in this embodiment, the robot 10 capable of obtaining the above-mentioned effects is used in the robot system 1. Therefore, in this embodiment, for example, even in a narrow space around the robot 10, complex tasks and simple tasks can be efficiently performed. For example, the robot system 1 may be used in a manufacturing method of an article including assembling or removing a part. In this case, the task of assembling or removing a part can be efficiently performed.

[0176] [2. Modifications] The present invention is not limited to the above-described embodiments. Specific modified embodiments are exemplified below. Two or more embodiments selected from the following examples may be combined.

[0177] [First Modification] In the above embodiment, the joint mechanism JEr4 rotates the tip part TP1 relative to the link LK2 around the axis Ax4 perpendicular to the direction De2 in which the link LK2 extends, but the present invention is not limited to this. For example, the joint mechanism JEr4 may rotate the tip part TP1 relative to the link LK2 around an axis that forms an angle with the direction De2 in which the link LK2 extends that is equal to or smaller than a predetermined angle.

[0178] Fig. 12 is an explanatory diagram for explaining an example of a tip portion TP1A according to the first modified example. Elements similar to those explained in Fig. 1 to Fig. 11 are given the same reference numerals, and detailed explanations will be omitted.

[0179] For example, the robot 10 according to this modification is similar to the robot 10 shown in Fig. 1, except that it has a link LK2A, a joint mechanism JEr4A, and a tip part TP1A instead of the link LK2, joint mechanism JEr4, and tip part TP1 shown in Fig. 1. The link LK2A is similar to the link LK2, except that a joint mechanism JEr4A is connected instead of the joint mechanism JEr4. The link LK2A is another example of a "second link," and the joint mechanism JEr4A is another example of a "fourth drive mechanism."

[0180] The joint mechanism JEr4A connects the link LK2A and the tip TP1A, and rotates the tip TP1A relative to the link LK2A around an axis Ax4A parallel to the direction De2. The rotation direction Dr4 in FIG. 12 shows the rotation direction of the tip TP1A when rotating around the axis Ax4A. The axis Ax4A is another example of the "fourth rotation axis" and corresponds to an axis that forms an angle with the direction De2 in which the link LK2A extends that is equal to or smaller than a predetermined angle.

[0181] In the tip part TP1A, the end effector 20 is attached to the end surface TP1sf in the same manner as in the tip part TP1 shown in FIG. 1. The tip part TP1A includes a first part TP11A connected to the link LK2A, a second part TP12A connected to the first part TP11A, a joint mechanism JEr5A, and a joint mechanism JEr6. The first part TP11A is connected to the link LK2A via, for example, a joint mechanism JEr4A. Therefore, the first part TP11A rotates with respect to the link LK2A about the axis Ax4A as the rotation axis.

[0182] The joint mechanism JEr5A connects the first part TP11A and the second part TP12A, and rotates the second part TP12A relative to the first part TP11A around an axis Ax5 perpendicular to the axis Ax4A. The rotation direction Dr5 in FIG. 12 shows the rotation direction of the second part TP12A when rotating around the axis Ax5.

[0183] The joint mechanism JEr6 is similar to the joint mechanism JEr6 shown in Fig. 1. For example, the joint mechanism JEr6 rotates at least a part (for example, end face TP1sf) of the tip part TP1A around an axis Ax6 perpendicular to the axis Ax5 as a rotation axis. In the example shown in Fig. 12, the surface of the joint mechanism JEr6 corresponds to the end face TP1sf, similar to the joint mechanism JEr6 shown in Fig. 1. Note that in a configuration in which the joint mechanism JEr6 is included in the second part TP12A, the end face of the second part TP12A may be the end face TP1sf.

[0184] As described above, in this modified example, the joint mechanism JEr4A rotates the tip part TP1A with respect to the link LK2A around the axis Ax4A, which forms an angle with the direction De2 at a predetermined angle or less, as the fourth rotation axis. The tip part TP1A includes a first part TP11A connected to the link LK2A, a second part TP12A connected to the first part TP11A, a joint mechanism JEr5A that connects the first part TP11A and the second part TP12A and rotates the second part TP12A with respect to the first part TP11A around the axis Ax5, which forms an angle with the fourth rotation axis (axis Ax4A) greater than a predetermined angle, as the fifth rotation axis, and a joint mechanism JEr6 that rotates a part of the tip part TP1A to which the end effector 20 is attached (for example, the end face TP1sf) around the axis Ax6, which forms an angle with the fifth rotation axis (axis Ax5) greater than a predetermined angle, as the sixth rotation axis.

[0185] In this modified example, the same effects as those of the above-described embodiment can be obtained. For example, in this modified example, since the tip part TP1 includes the joint mechanisms JEr5A and JEr6, the joint mechanisms JEr4A, JEr5A, JEr6, etc. can cause the robot 10 to perform various tasks in the vicinity of the robot 10.

[0186] [Second modified example] In the above-described embodiment and modified example, the motor MOr3 that drives the joint mechanism JEr3 moves integrally with the joint mechanism JEr3, but the present invention is not limited to such an embodiment. For example, the motor MOr3 may be fixed to a predetermined location of the link LK1 so as to be able to drive the joint mechanism JEr3 even if the relative position of the joint mechanism JEr3 with respect to the link LK1 changes. In this modified example, the same effects as those of the above-described embodiment and modified example can be obtained.

[0187] [Third Modification] In the above-described embodiment and modified example, the robot 10 is exemplified as a vertical six-axis articulated robot to which two joint mechanisms JEp1 and JEp2 are added, but the present invention is not limited to such an embodiment. For example, the robot 10 may be a seven-axis or more articulated robot to which two joint mechanisms JEp1 and JEp2 are added. Specifically, one or more links LK different from the links LK1 and LK2 may be disposed between the body part BDP and the joint mechanism JEr2. Alternatively, one or more links LK different from the links LK1 and LK2 may be disposed between the joint mechanism JEr4 and the tip part TP1. That is, the robot 10 may have three or more links LK connecting the body part BDP and the tip part TP1. In this case, the three or more links LK of the robot 10 correspond to a plurality of links LK including the links LK1 and LK2.

[0188] As described above, in this modified example as well, the same effects as those of the above-described embodiment and modified example can be obtained.

[0189] [3. Application Examples] The robot system 1 including the robot 10 described in the above-mentioned embodiment and modified examples may be used in a manufacturing method of an article including assembling or removing a part.

[0190] [4.Other] The distinction between the "turning" briefly explained in the above embodiment and other rotations will be described with some examples.

[0191] FIG. 13 is an explanatory diagram for explaining an example of turning. In FIG. 13, the connection of two links LKi and LKj whose longitudinal directions can be grasped is taken as an example to explain the distinction between turning and other rotations. The extension direction Dei in FIG. 13 indicates the direction in which the link LKi extends, and the extension direction Dej indicates the direction in which the link LKj extends. In addition, the joint mechanism JEri in FIG. 13 connects the link LKi and the link LKj, and rotates the link LKj relative to the link LKi around the axis Axi as the rotation axis.

[0192] In the example shown in FIG. 13, when the angle θ between the extension direction Dei (specific direction) of the link LKi and the axis Axi is greater than a predetermined angle, the rotation about the axis Axi corresponds to a "turn". In other words, when the angle θ between the extension direction Dei of the link LKi and the axis Axi is equal to or less than a predetermined angle, the rotation about the axis Axi corresponds to a rotation other than a turn (a rotation other than a turn that is distinguished from a turn). The "rotation" shown in FIG. 13 indicates a rotation other than a turn. In addition, the predetermined angle is not particularly limited, but in FIG. 13, the predetermined angle is assumed to be 45°. The angle θ between the extension direction Dei and the axis Axi is an angle between 0° and 90° among a plurality of angles that are understood as the angle of the axis Axi with respect to the extension direction Dei (for example, four angles for two straight lines that intersect with each other, or 0° and 180° for two parallel straight lines).

[0193] In the first pattern, the angle θ between the extension direction Dei of the link LKi and the axis Axi is 90°, which is greater than a predetermined angle (45°). Therefore, in the first pattern, the rotation of the link LKj around the axis Axi is a turn. Also, in the first pattern, the extension direction Dej of the link LKj is perpendicular to the axis Axi. Note that in the first pattern, when the link LKj rotates (turns) around the axis Axi as the rotation axis, the angle of the extension direction Dej of the link LKj with respect to the extension direction Dei of the link LKi changes.

[0194] In the second pattern, the angle θ between the extension direction Dei of the link LKi and the axis Axi is 0°, which is less than a predetermined angle (45°). Therefore, in the second pattern, the rotation of the link LKj around the axis Axi is a rotation other than a turning. Also, in the second pattern, the extension direction Dej of the link LKj is parallel to the extension direction Dei of the link LKi and the axis Axi. That is, the angle of the extension direction Dej of the link LKj with respect to the extension direction Dei of the link LKi is 0°. Note that in the second pattern, even if the link LKj rotates around the axis Axi as the rotation axis, the angle of the extension direction Dej of the link LKj with respect to the extension direction Dei of the link LKi is maintained at 0° and is always constant.

[0195] In the third pattern, the angle θ between the extension direction Dei of the link LKi and the axis Axi is 0°, which is less than a predetermined angle (45°). Therefore, in the third pattern, the rotation of the link LKj around the axis Axi is a rotation other than a turning. Also, in the third pattern, the extension direction Dej of the link LKj is perpendicular to the extension direction Dei of the link LKi and the axis Axi. That is, the angle of the extension direction Dej of the link LKj with respect to the extension direction Dei of the link LKi is 90°. Note that in the third pattern, even if the link LKj rotates around the axis Axi as the rotation axis, the angle of the extension direction Dej of the link LKj with respect to the extension direction Dei of the link LKi is maintained at 90° and is always constant.

[0196] In the fourth pattern, the angle θ between the extension direction Dei of the link LKi and the axis Axi is 10°, which is less than the predetermined angle (45°). Therefore, in the fourth pattern, the rotation of the link LKj around the axis Axi is a rotation other than a turning. Also, in the fourth pattern, the extension direction Dej of the link LKj is parallel to the axis Axi, and the angle of the extension direction Dej of the link LKj with respect to the extension direction Dei of the link LKi is 10°. Note that in the fourth pattern, even if the link LKj rotates around the axis Axi, the angle of the extension direction Dej of the link LKj with respect to the extension direction Dei of the link LKi is maintained at 10° and is always constant.

[0197] In the fifth pattern, the angle θ between the extension direction Dei of the link LKi and the axis Axi is 70°, which is greater than the predetermined angle (45°). Therefore, in the fifth pattern, the rotation of the link LKj around the axis Axi is a turn. Also, in the fifth pattern, the extension direction Dej of the link LKj is perpendicular to the axis Axi. Note that in the fifth pattern, when the link LKj rotates (turns) around the axis Axi, the angle of the extension direction Dej of the link LKj with respect to the extension direction Dei of the link LKi changes.

[0198] In the sixth pattern, the angle θ between the extension direction Dei of the link LKi and the axis Axi is 10°, which is less than the predetermined angle (45°). Therefore, in the sixth pattern, the rotation of the link LKj around the axis Axi is a rotation other than a turn. Also, in the sixth pattern, the extension direction Dej of the link LKj is perpendicular to the axis Axi. Note that in the sixth pattern, when the link LKj rotates around the axis Axi, the angle of the extension direction Dej of the link LKj with respect to the extension direction Dei of the link LKi changes.

[0199] In the seventh pattern, the angle θ between the extension direction Dei of the link LKi and the axis Axi is 70°, which is larger than the predetermined angle (45°). Therefore, in the seventh pattern, the rotation of the link LKj around the axis Axi is a turn. Also, in the seventh pattern, the extension direction Dej of the link LKj is parallel to the axis Axi, and the angle of the extension direction Dej of the link LKj with respect to the extension direction Dei of the link LKi is 70°. Note that in the seventh pattern, even if the link LKj rotates around the axis Axi, the angle of the extension direction Dej of the link LKj with respect to the extension direction Dei of the link LKi is maintained at 70° and is always constant.

[0200] In this way, in the above-described embodiment and modified example, among the rotations of the link LKj with respect to the link LKi, the rotation about the axis Axi, which forms an angle with the extension direction Dei of the link LKi larger than a predetermined angle, is also referred to as a turn. However, the definition of "turn" is not limited to the above example. For example, if the above definition that defines a turn as a rotation about the axis Axi, which forms an angle with the extension direction Dei of the link LKi larger than a predetermined angle, as the first definition, the following second or third definition may be adopted instead of the first definition.

[0201] In the second definition, when the angle of the extension direction Dej of the link LKj with respect to the extension direction Dei of the link LKi changes due to the rotation of the link LKj with respect to the link LKi, the rotation corresponds to a turn. Therefore, in the second definition, when the angle of the extension direction Dej of the link LKj with respect to the extension direction Dei of the link LKi is always constant even if the link LKj rotates, the rotation corresponds to a rotation other than a turn. For example, in the second definition, the first, fifth, and sixth patterns shown in FIG. 13 correspond to turns, and the second, third, fourth, and seventh patterns correspond to rotation other than a turn.

[0202] In the third definition, when the angle between the extension direction Dej of the rotating link LKj and the rotation axis (axis Axi) of the link LKj is greater than a predetermined angle, the rotation corresponds to a turn. Therefore, in the third definition, when the angle between the extension direction Dej of the link LKj and the rotation axis (axis Axi) of the link LKj is equal to or smaller than a predetermined angle, the rotation corresponds to a rotation other than a turn. For example, in the third definition, the first, third, fifth and sixth patterns shown in FIG. 13 correspond to turns, and the second, fourth and seventh patterns correspond to rotation other than a turn.

[0203] In addition to the above-mentioned first, second and third definitions, the relative relationship between the two rotations by the two joint mechanisms JEr may be defined by focusing on the relationship between the rotation axes of the two joint mechanisms JEr adjacent to each other. Specifically, when the angle between the two rotation axes is equal to or less than a predetermined angle (typically parallel), the two rotations may be regarded as the same type of rotation, and when the angle between the two rotation axes is greater than a predetermined angle (typically perpendicular), the two rotations may be regarded as different types of rotation. The same type of rotation means that both rotations are rotations or both rotations are other than rotations, and the different type of rotation means that one of the two rotations is rotation and the other is other than rotation. When the definition of the relative relationship between the two rotations is used, the rotation that is the starting point of the relative relationship may be determined based on, for example, any of the above-mentioned first, second and third definitions. The first pattern shown in Fig. 13 corresponds to a rotation in any of the first, second, and third definitions, and the second pattern corresponds to a rotation other than a rotation in any of the first, second, and third definitions. Therefore, it is preferable to set the first pattern or the second pattern as the rotation that is the starting point of the relative relationship.

[0204] Also, a definition that combines two or more of the above-mentioned first, second, and third definitions may be used. In this case, for example, only a rotation that corresponds to a rotation in all of the two or more definitions to be combined may be considered as a rotation, or a rotation that corresponds to a rotation in at least one of the two or more definitions to be combined may be considered as a rotation. [Explanation of symbols]

[0205] 1...robot system, 10...robot, 20...end effector, 30...robot controller, 32...processing device, 33...memory, 34...communication device, 35...operation device, 36...display device, 37...driver circuit, ARmd1, ARmd2...central area, ARmv1, ARmv2...movement area, Ax1, Ax2, Ax3, Ax3z, Ax4, Ax4A, Ax5, Ax6, Axi...axis, BDP...body part, BDPbt...bottom surface, BDPba...base part, GD...article, JEr1, JEr2, JEr3, JEr4, JEr4A, JEr5, JEr6, JEri, JEp1, JEp2...joint mechanism, JEp11, JEp2 1...Screw portion, JEp12, JEp22...Nut, JEp13, JEp23...Connection portion, JEp13a, JEp23a...Slider portion, JEp13b, JEp23b...Support portion, JEp14, JEp24...Rail, JEp14a, JEp14b, JEp24a, JEp24b...Rod-shaped member, JEr11, JEr21, JEr41, JEr51, JEr61...Rotating portion, JEr12, JEr22, JEr42, JEr52, JEr62...Housing, LK1, LK2, LK2A, LKi, LKj...Link, MOr1, MOr2, MOr3, MOr4, MOr5, MOr6, MOp1, MOp2...Motor, WB...Work table.

Claims

1. A base and A tip portion, A plurality of links including a first link and a second link connecting the base portion and the tip portion; a first drive mechanism that connects the first link and the second link and rotates the second link relative to the first link about a first rotation axis that forms an angle with a first direction in which the first link extends that is larger than a predetermined angle; a first moving mechanism that moves the first drive mechanism relative to the first link along the first direction; a second moving mechanism that moves the second link relative to the first driving mechanism along a second direction in which the second link extends; Equipped with The states of the first link and the second link are the first direction and the second direction are parallel to each other, and the second link is capable of transitioning to a first state in which an end of the second link that is farther from the tip end is closer to an end of the first link that is closer to the base end than an end of the first link that is farther from the base end; The first link is a first movement region in which the first drive mechanism is moved along the first direction by the first movement mechanism; The second link is a second movement region in which the first drive mechanism is moved along the second direction by the second movement mechanism; The first drive mechanism includes: In the first state, the movable member is located in a first central region excluding both ends of the first moving region, and is located in a second central region excluding both ends of the second moving region. A multi-joint robot characterized by

2. The first central region is a region located substantially at the center of the first moving region in the first direction, and the second central region is a region located substantially at the center of the second moving region in the second direction.

2. The articulated robot according to claim 1 .

3. a second drive mechanism that rotates at least a portion of the base about a second rotation axis that forms an angle with a direction perpendicular to a bottom surface of the base that is equal to or smaller than the predetermined angle; a third drive mechanism that connects the base and the first link and rotates the first link about a third rotation axis that forms an angle with a direction perpendicular to a bottom surface of the base that is greater than the predetermined angle; a fourth drive mechanism that connects the second link and the tip portion and rotates the tip portion relative to the second link; Further comprising:

2. The articulated robot according to claim 1 .

4. The fourth drive mechanism is The tip portion is rotated with respect to the second link about a fourth rotation axis, the fourth rotation axis being an axis that forms an angle with the second direction larger than the predetermined angle. The tip portion is a first portion connected to the second link; a second portion connected to the first portion; a fifth drive mechanism that connects the first portion and the second portion and rotates the second portion relative to the first portion about a fifth rotation axis that is an axis that forms an angle with the fourth rotation axis greater than the predetermined angle; a sixth drive mechanism that rotates a portion of the tip end to which an end effector is attached, about a sixth rotation axis that is an axis that forms an angle with the fifth rotation axis greater than the predetermined angle; Including, 4. The articulated robot according to claim 3.

5. The fourth drive mechanism is The tip portion is rotated with respect to the second link about a fourth rotation axis, the fourth rotation axis being an axis that forms an angle with the second direction equal to or smaller than the predetermined angle; The tip portion is a first portion connected to the second link; a second portion connected to the first portion; a fifth drive mechanism that connects the first portion and the second portion and rotates the second portion relative to the first portion about a fifth rotation axis that is an axis that forms an angle with the fourth rotation axis greater than the predetermined angle; a sixth drive mechanism that rotates a portion of the tip end to which an end effector is attached, about a sixth rotation axis that is an axis that forms an angle with the fifth rotation axis greater than the predetermined angle; Including, 4. The articulated robot according to claim 3.

6. the first state is a posture in which the first driving mechanism, the first moving mechanism, and the second moving mechanism are in a standby state; the first link and the second link start or resume operation from the first state; 6. The articulated robot according to claim 1, wherein the articulated robot is a robot having a plurality of joints.

7. a first drive mechanism that connects the first link and the second link and rotates the second link relative to the first link about an axis that forms an angle with a first direction in which the first link extends that is larger than a predetermined angle as a first rotation axis; a first movement mechanism that moves the first drive mechanism relative to the first link along the first direction; and a second movement mechanism that moves the second link relative to the first drive mechanism along a second direction in which the second link extends, a state of the first link and the second link can transition to a first state in which the first direction and the second direction are parallel to each other, and an end of the second link, which is farther from the tip portion, is located closer to an end of the first link, which is closer to the base portion, than an end of the first link, which is farther from the base portion; the first link has a first movement region in which the first drive mechanism moves along the first direction by the first movement mechanism; the second link has a second movement region in which the first drive mechanism is moved along the second direction by the second movement mechanism; the first driving mechanism is located in a first central region excluding both ends of the first movement region and is located in a second central region excluding both ends of the second movement region in the first state; by controlling the first driving mechanism, the first moving mechanism, and the second moving mechanism, the articulated robot is caused to start operating from the first state, or by transitioning to the first state, the first driving mechanism, the first moving mechanism, and the second moving mechanism are caused to enter a standby state, and then the operation is resumed from the first state. A method for controlling an articulated robot.

8. A multi-joint robot, an end effector attached to the multi-joint robot, and a control device that controls the operation of the multi-joint robot and the end effector, The articulated robot comprises: A base and a tip portion including a portion to which the end effector is attached; A plurality of links including a first link and a second link connecting the base portion and the tip portion; a first drive mechanism that connects the first link and the second link and rotates the second link relative to the first link about a first rotation axis that forms an angle with a first direction in which the first link extends that is larger than a predetermined angle; a first moving mechanism that moves the first drive mechanism relative to the first link along the first direction; a second moving mechanism that moves the second link relative to the first driving mechanism along a second direction in which the second link extends; Equipped with The states of the first link and the second link are the first direction and the second direction are parallel to each other, and the second link is capable of transitioning to a first state in which an end of the second link that is farther from the tip end is closer to an end of the first link that is closer to the base end than an end of the first link that is farther from the base end; The first link is a first movement region in which the first drive mechanism is moved along the first direction by the first movement mechanism; The second link is a second movement region in which the first drive mechanism is moved along the second direction by the second movement mechanism; The first drive mechanism includes: In the first state, the first moving region is located in a first central region excluding both ends thereof, and the second moving region is located in a second central region excluding both ends thereof, The control device includes: by controlling the first driving mechanism, the first moving mechanism, and the second moving mechanism, the articulated robot is caused to wait in the first state; A robot system comprising:

9. The robot system according to claim 8 , wherein a part is assembled or a part is removed. A method for producing an article.

Citation Information

Patent Citations

  • Composite multi-joint type robot

    JP1986136782A