Articulated robot, method for manufacturing the same, robot system, and method for producing articles

Abstract

To highly accurately control a tip of a robot without narrowing a workable region of an articulated robot even around a base.SOLUTION: A robot 10 comprises: a joint mechanism JEr3 that rotates a link LK2 with respect to a link LK1 with an axis Ax3 having an angle formed between the links LK1 and LK2 and a direction De1 in which the link LK1 extends larger than a prescribed angle as a first rotation axis; a joint mechanism JEp1 that moves the joint mechanism JEr3 with respect to the link LK1 in the direction De1; a joint mechanism JEp2 that moves the link LK2 with respect to the joint mechanism JEr3 in the extending direction of the link LK2; and a joint mechanism JEr2 that rotates the link LK1 with an axis Ax2 having an angle formed with a direction Dv1 perpendicular to a bottom surface BDPbt of a body BDP and larger than the prescribed angle as a third rotation axis. In a plan view from the direction De1, a direction Dax3 along the first rotation axis and a direction Dax2 along the third rotation axis intersect each other at a first angle equal to or larger than the prescribed angle.SELECTED DRAWING: Figure 1

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 Application Laid-Open No. 61-136782 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, limiting the area that the tip of the robot can reach, 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 are attached, which is located at the base side of the robot, and many areas are outside the workable area. That is, in the case of a robot with two arms, the angle between the two arms approaches 0°, so the arms interfere with each other. Even if the workable area is within the workable area, the tip is controlled via the two arms, so there is a limit to how much precision can be improved. For this reason, it is desirable to control the tip of the robot with high precision, 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 including: 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 greater than a predetermined angle; a first movement mechanism moving the first drive mechanism relative to the first link along the first direction; The device comprises a second moving mechanism which moves the base relative to the first driving mechanism, a second driving mechanism which rotates at least a part of the base around a second rotation axis whose angle with a direction perpendicular to the bottom surface of the base is less than or equal to the predetermined angle, and a third driving mechanism which connects the base and the first link and rotates the first link around a third rotation axis whose angle with a direction perpendicular to the bottom surface of the base is greater than the predetermined angle, and when viewed in a plan view from the first direction, the direction along the first rotation axis and the direction along the third rotation axis intersect at a first angle greater than the predetermined angle.

[0006] A method for controlling a multi-joint robot according to a preferred aspect of the present invention includes, in the multi-joint robot described above, further comprising: a first motor for driving the first drive mechanism, a second motor for driving the first moving mechanism, a third motor for driving the second moving mechanism, a fourth motor for driving the second drive mechanism, and a fifth motor for driving the third drive mechanism, wherein the first moving mechanism includes a first screw portion disposed inside the first link, extending in the first direction, and rotating around an axis along the first direction as the second motor rotates, and a first moving portion connected to the first drive mechanism, through which the first screw portion is inserted, and moving relatively to the first screw portion as the first screw portion rotates, and the second moving mechanism is disposed inside the second link, extending in the second direction, and A method for controlling a multi-joint robot comprising: a second screw portion that rotates about an axis along the second direction as a motor rotates; and a second moving portion that is connected to the first driving mechanism, through which the second screw portion is inserted, and that moves relative to the second screw portion as the second screw portion rotates, wherein the first driving mechanism moves relative to the first link as the first moving portion moves, and the second link moves relative to the first driving mechanism as the second moving portion moves, and the first angle is substantially 90 degrees, wherein a control device that controls the operation of the multi-joint robot controls the first motor, the second motor, and the third motor to control the operation of the multi-joint robot so that the tip of the multi-joint robot moves along a predetermined plane.

[0007] A robot system according to a preferred aspect of the present invention is the above-mentioned articulated robot, further comprising a first motor that drives the first drive mechanism, a second motor that drives the first moving mechanism, a third motor that drives the second moving mechanism, a fourth motor that drives the second drive mechanism, and a fifth motor that drives the third drive mechanism, wherein the first moving mechanism comprises a first screw portion that is disposed inside the first link, extends in the first direction, and rotates with a rotation of the second motor about an axis along the first direction as a rotation axis, and a first moving portion that is connected to the first drive mechanism, has the first screw portion inserted therethrough, and moves relatively to the first screw portion as the rotation of the first screw portion occurs, and the second moving mechanism is disposed inside the second link, extends in the second direction, and rotates with a rotation of the third motor about the a second screw portion that rotates around an axis along two directions as a rotation axis, and a second moving portion that is connected to the first driving mechanism, through which the second screw portion is inserted, and that moves relative to the second screw portion as the second screw portion rotates, wherein the first driving mechanism moves relative to the first link as the first moving portion moves, and the second link moves relative to the first driving mechanism as the second moving portion moves, and the first angle is substantially 90 degrees; an end effector attached to the tip; and a control device that controls the operation of the multi-joint robot and the end effector, wherein the control device controls the operation of the multi-joint robot by controlling the first motor, the second motor, the third motor, the fourth motor, and the fifth motor.

[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 controlled with high precision even around the base without narrowing the workable area of ​​the articulated robot. [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] 11 is an explanatory diagram for explaining an example of an operation of moving the tip of the robot horizontally relative to a ground surface. FIG. [Figure 4] 4 is an explanatory diagram for explaining a continuation of the operation of the robot shown in FIG. 3. FIG. [Diagram 5] FIG. 11 is an explanatory diagram for explaining an example of an operation realized by driving only two joint mechanisms corresponding to prismatic joints among a plurality of joint mechanisms. [Figure 6] 2 is a diagram illustrating an example of a hardware configuration of a robot controller illustrated in FIG. 1. [Figure 7] FIG. 11 is an explanatory view for explaining an example of a tip portion according to a first modified example. [Figure 8] 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. 6.

[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 MO (see FIG. 2) that drive the plurality of joint mechanisms JE. In FIG. 1, in order to make the drawing easier to see, the motors MO that drive the plurality of joint mechanisms JE, the reducers and encoders provided in each of the plurality of motors MO, 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 the axis Ax2, which is 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 direction Dax2 is the direction from the joint mechanism JEr2 to the link LK1, among the directions along the axis Ax2, which is the rotation axis of the joint mechanism JEr2. 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 around 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 around the axis Ax3. The direction Dax3 is a direction from the link LK1 to the link LK2 along the axis Ax3, which is the rotation axis of the joint mechanism JEr3. The axis Ax3 is an example of a "first rotation axis."

[0027] In this embodiment, the axis Ax3 is an axis perpendicular to the directions De1 and Dax2. In this case, in a plan view from the direction De1, a straight line along the axis Ax3 and a straight line along the axis Ax2 intersect at 90 degrees. That is, in a plan view from the direction De1, the direction Dax3 along the axis Ax3 and the direction Dax2 along the axis Ax2 intersect at 90 degrees. Note that a plan view is, for example, viewing an object from a specific direction. In addition, "intersecting at 90 degrees" does not only mean intersecting at 90 degrees strictly, but also includes intersecting at substantially 90 degrees (for example, an angle within an error range that can be regarded as 90 degrees). 90 degrees is an example of a "first angle."

[0028] Thus, in this embodiment, in a plan view from the direction De1, the direction Dax3 along the axis Ax3 and the direction Dax2 along the axis Ax2 intersect at 90 degrees, so the rotation plane of the link LK2 is perpendicular to the rotation plane of the link LK1. The rotation plane of the link LK2 is a plane that includes a trajectory of a predetermined position of the link LK2 when the link LK2 rotates about the axis Ax3 as the rotation axis. Similarly, the rotation plane of the link LK1 is a plane that includes a trajectory of a predetermined position of the link LK1 when the link LK1 rotates about the axis Ax2 as the rotation axis.

[0029] The joint mechanism JEp1 moves the joint mechanism JEr3 relative to the link LK1 along the direction De1. When the joint mechanism JEr3 moves along the direction De1, the link LK2 moves 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 movement area ARmv1 in which the joint mechanism JEr3 can move.

[0030] 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."

[0031] 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.

[0032] 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.

[0033] 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.

[0034] 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 relatively along the direction De2, the opening Hlk2 of the link LK2 corresponds to the movement area ARmv2 in which the joint mechanism JEr3 can move.

[0035] 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."

[0036] 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.

[0037] 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."

[0038] 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."

[0039] 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.

[0040] 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.

[0041] The state (posture) of the robot 10 shown in FIG. 1 is one of the states that represent the characteristics of the robot 10 in this embodiment. For example, in the posture shown in FIG. 1, the link LK1 is tilted by the joint mechanism JEr2 until it is horizontal with respect to the bottom surface BDPbt of the body part BDP, that is, horizontal with respect to the ground surface of the robot 10. In addition, the joint mechanism JEr3 is located in a position in the moving area ARmv1 closer to the end LK1ed2 of the link LK1 than the intermediate area ARmd1 (see FIG. 2) excluding both ends of the moving area ARmv1. The end LK1ed2 is the end LK1ed farthest from the body part BDP among the two ends LK1ed (LK1ed1 and LK1ed2) of the link LK1. In addition, the joint mechanism JEr3 is located in a position in the moving area ARmv2 closer to the end LK2ed1 of the link LK2 than the intermediate area ARmd2 (see FIG. 2) excluding both ends of the moving area ARmv2. Of the two ends LK1ed (LK2ed1 and LK2ed2) of the link LK2, the end LK2ed1 is the end LK2ed farthest from the tip end TP1.

[0042] In this embodiment, the joint mechanism JEr3 rotates (pivots) the link LK2 relative to the link LK1 from the posture shown in FIG. 1, thereby allowing the tip part TP1 to rotate in the horizontal direction relative to the ground surface. Also, in this embodiment, the joint mechanism JEp1 moves the joint mechanism JEr3 along the direction De1 from the posture shown in FIG. 1, thereby allowing the tip part TP1 to move along the direction De1. Also, in this embodiment, the joint mechanism JEp2 moves the joint mechanism JEr3 along the direction De2 from the posture shown in FIG. 1, thereby allowing the tip part TP1 to move along the direction De2. That is, in this embodiment, the tip part TP1 can be moved in the horizontal direction relative to the ground surface from the posture shown in FIG. 1. A specific example of the operation of moving the tip part TP1 in the horizontal direction relative to the ground surface will be described later with reference to FIG. 3 and FIG. 4.

[0043] 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°.

[0044] 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.

[0045] 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.

[0046] 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.

[0047] 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.

[0048] 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.

[0049] 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.

[0050] Furthermore, in this embodiment, the joint mechanism JEp1 provided in the link LK1 allows the link LK2 to move 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 allows the link LK2 to move relative to the link LK1 along the direction De2 in which the link LK2 extends. This makes it possible to widen the area that the tip part TP1 (more specifically, the end face TP1sf) can reach in this embodiment. As a result, it is possible to widen the area that the end effector 20 attached to the robot 10 can reach in this embodiment.

[0051] In this embodiment, the joint mechanisms JEp1 and JEp2 allow the tip part TP1 of the robot 10 to be easily moved to the periphery of the body part BDP. For example, the robot controller 30 controls the joint mechanisms JEp1 and JEp2 so that the axis Ax3 is located closer to the end part LK1ed1 than the end part LK1ed2 of the link LK1, and closer to the end part LK2ed2 than the end part LK2ed1 of the link LK2. In this case, the length from the end part 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 part 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.

[0052] Furthermore, when controlling the tip part TP1 around the body part BDP by driving the joint mechanisms JEr2 and JEr3, 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 accuracy of the control. In this embodiment, by shortening the substantial link length of the links LK1 and LK2, the tip part of the robot can be controlled with high accuracy even around the base part without narrowing the workable area of ​​the articulated robot.

[0053] 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. In addition, in a plan view from the direction De1, the angle at which the direction Dax3 along the axis Ax3 and the direction Dax2 along the axis Ax2 intersect is not limited to 90 degrees. For example, in a plan view from the direction De1, the direction Dax3 along the axis Ax3 and the direction Dax2 along the axis Ax2 may intersect at a first angle that is equal to or greater than a predetermined angle.

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

[0055] 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.

[0056] 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."

[0057] The joint mechanism JEp1 includes, for example, a screw portion JEp11 extending along a direction De1, a nut JEp12, a connection portion JEp13, and a rail JEp14. The screw portion JEp11 is an example of a "first screw portion," and the nut JEp12 is an example of a "first moving portion."

[0058] 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.

[0059] 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.

[0060] 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.

[0061] The rail JEp14 extends along the direction De1 and includes two rod-shaped members JEp14a and JEp14b 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 Dax3 along the axis Ax3 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 Dax3 along the axis Ax3 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.

[0062] 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 area ARmv1 (movement range) of the joint mechanism JEr3 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).

[0063] 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.

[0064] 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.

[0065] The joint mechanism JEp2 includes, for example, a screw portion JEp21 extending along the direction De2, a nut JEp22, a connection portion JEp23, and a rail JEp24. The screw portion JEp21 is an example of a "second screw portion," and the nut JEp22 is an example of a "second moving portion."

[0066] 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.

[0067] 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 the axis Ax3 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.

[0068] 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.

[0069] The rail JEp24 extends along the direction De2 and includes two rod-shaped members JEp24a and JEp24b 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 disposed, for example, between the opening Hlk2 and the screw portion JEp21 in the direction Dax3 along the axis Ax3 and is attached to the inside of the link LK2. Note that the rail JEp24 does not have to be disposed between the opening Hlk2 and the screw portion JEp21 in the direction Dax3 along the axis Ax3 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.

[0070] 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 area ARmv2 (movement range) of the joint mechanism JEr3 is movable from an area closer to the end LK2ed1 than the end LK2ed2 of the link LK2 to an area closer to the end LK2ed2 than the end LK2ed1. This makes it possible to set the substantial length (length under control) of the link LK2 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).

[0071] 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.

[0072] 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.

[0073] 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.

[0074] 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.

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

[0076] 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. The motor MOr1 is an example of a "fourth motor."

[0077] 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.

[0078] 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. The motor MOr2 is an example of a "fifth motor."

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

[0080] 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.

[0081] 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.

[0082] 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.

[0083] 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.

[0084] 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.

[0085] 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.

[0086] 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.

[0087] 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 relative to the housing JEr62. In this case, the surface of the rotating part JEr61 corresponds to the end surface 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.

[0088] 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.

[0089] 2 shows an example in which the joint mechanism JEr3 is located in the intermediate region ARmd1 excluding both ends of the movement region ARmv1, and is located in the intermediate region ARmd2 excluding both ends of the movement region ARmv2, but the position of the joint mechanism JEr3 is not particularly limited. For example, in the posture shown in FIG. 2, the position of the joint mechanism JEr3 may be 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. Alternatively, in the posture shown in FIG. 2, the position of the joint mechanism JEr3 may be 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.

[0090] Next, an example of the operation of moving the tip part TP1 in the horizontal direction relative to the ground surface will be described with reference to FIGS.

[0091] Fig. 3 is an explanatory diagram for explaining an example of an operation of moving the tip part TP1 of the robot 10 in a horizontal direction relative to the ground surface. Fig. 4 is an explanatory diagram for explaining an operation subsequent to the operation of the robot 10 shown in Fig. 3.

[0092] For ease of explanation, a three-axis Cartesian coordinate system having an X-axis, a Y-axis, and a Z-axis that are orthogonal to each other will be introduced below. In addition, in the following, the direction indicated by the X-axis arrow will be referred to as the +X direction, and the opposite direction of the +X direction will be referred to as the -X direction. In the following, the direction indicated by the Y-axis arrow will be referred to as the +Y direction, and the opposite direction of the +Y direction will be referred to as the -Y direction. In the following, the +Y direction and the -Y direction will be referred to as the Y direction without any particular distinction, and the +X direction and the -X direction will be referred to as the X direction without any particular distinction. In the following, the +Z direction and the -Z direction will be referred to as the Z direction without any particular distinction.

[0093] In this embodiment, it is assumed that the XY plane is parallel to the bottom surface BDPbt of the body part BDP, that is, parallel to the ground surface of the robot 10. In the example shown in Figures 3 and 4, the direction De1 is parallel to the Y direction, the direction Dax2 is parallel to the X direction, and the direction Dax3 is parallel to the Z direction.

[0094] The top view of the figure shows a schematic representation of the state of robot 10 as viewed from the +Z direction, the XZ side view of the figure shows a schematic representation of the state of robot 10 as viewed from the -Y direction, and the YZ side view of the figure shows a schematic representation of the state of robot 10 as viewed from the -X direction.

[0095] In the first posture shown in Fig. 3(a), the link LK1 is tilted by the joint mechanism JEr2 until it is horizontal with respect to the bottom surface BDPbt of the body part BDP, that is, horizontal with respect to the ground surface of the robot 10. In addition, the link LK2 is maintained by the joint mechanism JEr3 in a state in which the extension direction (direction De2) of the link LK2 is perpendicular to the extension direction (direction De1) of the link LK1 in a plan view from the +Z direction. In addition, the joint mechanism JEr3 is located closer to the end LK1ed1 than the end LK1ed2 of the link LK1, and is located near the middle between the ends LK2ed1 and LK2ed2 of the link LK2 (for example, the middle area ARmd2 shown in Fig. 2).

[0096] Then, as shown in Fig. 3(b), for example, the robot controller 30 controls the joint mechanism JEp2 to move the link LK2 in the -X direction relative to the joint mechanism JEr3. That is, the robot controller 30 controls the joint mechanism JEp2 to move the tip part TP1 in the -X direction while maintaining the end face TP1sf of the tip part TP1 horizontally relative to the ground surface. As a result, the posture of the robot 10 changes from the first posture shown in Fig. 3(a) to the second posture shown in Fig. 3(b).

[0097] Next, as shown in Fig. 4(c), for example, the robot controller 30 controls the joint mechanism JEp1 to move the joint mechanism JEr3 in the -Y direction along the extension direction (direction De1) of the link LK1. That is, the robot controller 30 controls the joint mechanism JEp1 to move the tip part TP1 in the -Y direction while maintaining the end face TP1sf of the tip part TP1 horizontally relative to the ground surface. As a result, the posture of the robot 10 changes from the second posture shown in Fig. 3(b) to the third posture shown in Fig. 4(c).

[0098] Then, as shown in Fig. 4(d), for example, the robot controller 30 controls the joint mechanism JEp2 to move the link LK2 in the +X direction relative to the joint mechanism JEr3. That is, the robot controller 30 controls the joint mechanism JEp2 to move the tip part TP1 in the +X direction while maintaining the end face TP1sf of the tip part TP1 horizontally relative to the ground surface. As a result, the posture of the robot 10 changes from the third posture shown in Fig. 4(c) to the fourth posture shown in Fig. 4(d).

[0099] Thus, in this embodiment, by changing the posture of the robot 10 from the first posture, to the second posture, to the third posture, and to the fourth posture in that order, the tip part TP1 can be moved so as to trace the three sides of a rectangle having a surface horizontal to the ground surface.

[0100] Here, for example, in a conventional six-axis articulated robot, when the tip part TP1 is moved so as to trace three sides of a rectangle having a surface horizontal to the ground surface, it is necessary to accurately control four or five joint mechanisms JEr. Therefore, in a conventional six-axis articulated robot, when the tip part TP1 is moved along each side of the rectangle, the number of joint mechanisms JEr to be driven increases, and the operation becomes complicated. For this reason, problems such as a decrease in operation speed or operation accuracy occur in the conventional six-axis articulated robot. Also, in the conventional six-axis articulated robot, the torque of each of the multiple joint mechanisms JEr driven to move the tip part TP1 along each side of the rectangle may be limited. In this case, it becomes difficult to move the tip part TP1 at high speed or to increase the weight capacity.

[0101] In contrast, in this embodiment, as described above, by driving only the joint mechanisms JEp1 and JEp2 corresponding to the linear joints among the multiple joint mechanisms JE, the tip part TP1 can be moved along each side of the rectangle. As a result, in this embodiment, it is possible to suppress a decrease in the operating speed or operating accuracy. That is, in this embodiment, the tip part TP1 of the robot 10 can be moved along each side of the rectangle with high accuracy and high speed. For example, in this embodiment, it is possible to cause the robot 10 to perform an operation such as welding along each side of a rectangle or applying adhesive along each side of a rectangle with high accuracy and high speed.

[0102] In addition, in this embodiment, the tip part TP1 can be moved on a predetermined plane without driving the joint mechanism JEr corresponding to the rotary joint, and therefore is not affected by torque limitations of the rotary joint, etc. Therefore, in this embodiment, when the tip part TP1 is moved on a predetermined plane, it is possible to move the tip part TP1 at high speed and increase the payload capacity.

[0103] In this embodiment, the movement of the tip part TP1 is not limited to the movement of the tip part TP1 along each side of the rectangle, but can be realized by driving only the joint mechanisms JEp1 and JEp2 of the multiple joint mechanisms JE as long as the tip part TP1 moves on a plane (XY plane) horizontal to the ground surface. For example, in this embodiment, it is also possible to make the robot 10 draw a figure by having the tip part TP1 of the robot 10 hold a writing implement. In a conventional six-axis articulated robot, even when the tip part TP1 is moved on a plane horizontal to the ground surface, there is a problem similar to that when the tip part TP1 is moved along each side of the rectangle. In this embodiment, even when the tip part TP1 is moved on a plane horizontal to the ground surface, the tip part TP1 can be moved with high accuracy and high speed by driving only the joint mechanisms JEp1 and JEp2 corresponding to the linear joints of the multiple joint mechanisms JE. In addition, in this embodiment, the payload can be increased even when the tip part TP1 is moved on a plane horizontal to the ground surface.

[0104] In this embodiment, for example, by driving the joint mechanism JEr3 so that the link LK2 rotates (turns) relative to the link LK1, the tip part TP1 can be rotated in the horizontal direction relative to the ground surface. In this case, too, the tip part TP1 can be moved with high precision and high speed, and the payload capacity can be increased.

[0105] In addition, in this embodiment, the same effects as those described above can be obtained not only in the operation of the tip part TP1 moving on a plane (XY plane) horizontal to the ground surface, but also in the operation realized by driving only the joint mechanisms JEp1 and JEp2 of the multiple joint mechanisms JE. For example, in this embodiment, as shown in FIG. 5(b), the operation of the tip part TP1 moving on a plane (XZ plane, YZ plane) perpendicular to the ground surface can be realized by driving only the joint mechanisms JEp1 and JEp2 of the multiple joint mechanisms JE. Alternatively, in this embodiment, as shown in FIG. 5(c), the operation of the tip part TP1 moving on a plane inclined to the ground surface can be realized by driving only the joint mechanisms JEp1 and JEp2 of the multiple joint mechanisms JE.

[0106] Fig. 5 is an explanatory diagram for explaining an example of an operation realized by driving only two joint mechanisms JEp1 and JEp2 corresponding to linear joints among the multiple joint mechanisms JE. Note that Fig. 5 shows a schematic state (posture) of the robot 10 as viewed from the -X direction.

[0107] Fig. 5(a) shows a schematic diagram of the state (posture) of the robot 10 when the tip TP1 moves on a plane SF1 (XY plane) horizontal to the ground surface. The posture of the robot 10 shown in Fig. 5(a) is the same as the first posture shown in Fig. 3(a) except that a writing implement is attached to the tip TP1 of the robot 10 as the end effector 20. For example, in this embodiment, by setting the posture of the robot 10 to the posture shown in Fig. 5(a), it is possible to easily cause the robot 10 to perform the task of drawing a figure or the like on the plane SF1 (e.g., a floor surface) horizontal to the ground surface.

[0108] Fig. 5(b) shows a schematic diagram of the state (posture) of the robot 10 when the tip part TP1 moves on a plane SF2 (XZ plane) perpendicular to the ground surface. The posture of the robot 10 transitions from the posture shown in Fig. 5(a) to the posture shown in Fig. 5(b), for example, by driving the joint mechanism JEr2 so that the link LK1 becomes perpendicular to the ground surface. For example, in this embodiment, by changing the posture of the robot 10 to the posture shown in Fig. 5(b), it is possible to easily cause the robot 10 to perform the task of drawing a figure or the like on the plane SF2 (for example, a wall surface) perpendicular to the ground surface.

[0109] FIG. 5(c) shows a schematic diagram of the state (posture) of the robot 10 when the tip part TP1 moves on a plane SF3 inclined with respect to the ground surface. The plane SF3 is inclined with respect to, for example, the plane SF1 shown in FIG. 5(a) and the plane SF2 shown in FIG. 5(b). The posture of the robot 10 transitions from the posture shown in FIG. 5(a) to the posture shown in FIG. 5(c) by driving the joint mechanism JEr2 so that the extension direction (direction De1) of the link LK1 becomes parallel to the plane SF3. For example, in this embodiment, by changing the posture of the robot 10 to the posture shown in FIG. 5(c), the robot 10 can be easily made to perform the task of drawing a figure or the like on the plane SF3 inclined with respect to the ground surface.

[0110] The plane SF1 horizontal to the ground surface, the plane SF2 perpendicular to the ground surface, and the plane SF3 inclined to the ground surface are examples of the "predetermined plane". Also, in the example shown in Fig. 5, the tip part TP1 can be rotated on a predetermined plane such as the plane SF1 by driving the joint mechanism JEr3 so that the link LK2 rotates (pivots) relative to the link LK1. In this case as well, the tip part TP1 can be moved with high precision and high speed, and the payload can be increased.

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

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

[0113] 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.

[0114] 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.

[0115] 6 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.

[0116] 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.

[0117] 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.

[0118] 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.

[0119] 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.

[0120] 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).

[0121] 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.

[0122] In this manner, the robot controller 30 controls the motors MOr1, MOr2, MOr3, MOr4, MOr5, MOr6, MOp1, and MOp2 to control the movement of the robot 10. For example, the robot controller 30 controls the movement of the robot 10 by controlling the motors MOr3, MOp1, and MOp2 so that the tip portion TP1 of the robot 10 moves along a predetermined plane.

[0123] As described above, in this embodiment, the robot 10 includes a body part BDP, a tip part TP1, and links LK1 and LK2, and includes a plurality of links LK that connect the body part BDP and the tip part TP1, a joint mechanism JEr3 that connects the link LK1 and the link LK2 and rotates the link LK2 relative to the link LK1 around an axis Ax3 that forms an angle with a direction De1 in which the link LK1 extends that is larger than a predetermined angle as a first rotation axis, a joint mechanism JEp1 that moves the joint mechanism JEr3 relative to the link LK1 along the direction De1, and a joint mechanism JEp2 that moves the joint mechanism JEr3 relative to the link LK1 along the direction De1. The joint mechanism JEr1 rotates at least a part of the body part BDP around an axis Ax1, which forms an angle with a direction Dv1 perpendicular to a bottom surface BDPbt of the body part BDP at a second rotation axis equal to or smaller than a predetermined angle, and the joint mechanism JEr2 connects the body part BDP and the link LK1 and rotates the link LK1 around an axis Ax2, which forms an angle with the direction Dv1 perpendicular to the bottom surface BDPbt of the body part BDP at a greater than a predetermined angle, as a third rotation axis. In a plan view from the direction De1, the direction Dax3 along the first rotation axis (axis Ax3) and the direction Dax2 along the third rotation axis (axis Ax2) intersect at a first angle equal to or larger than a predetermined angle.

[0124] 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 part TP1 of the robot 10 can be moved to the periphery of the body part BDP by simple control. Also, in this embodiment, by shortening the effective link lengths of the links LK1 and LK2, the tip part of the robot can be controlled with high precision even around the base without narrowing the workable area of ​​the articulated robot.

[0125] In addition, in this embodiment, in a plan view from the direction De1, the direction Dax3 along the first rotation axis (axis Ax3) and the direction Dax2 along the third rotation axis (axis Ax2) intersect at a first angle. Therefore, in this embodiment, the angle between the rotation plane of the link LK2 and the rotation plane of the link LK1 is the first angle. As a result, in this embodiment, the operation of the tip part TP1 moving on a plane where the angle between the rotation plane of the link LK1 and the link LK1 is the first angle can be realized by driving only the joint mechanisms JEp1 and JEp2 corresponding to the linear joints among the multiple joint mechanisms JE. As a result, in this embodiment, the tip part TP1 can be moved with high precision and high speed on a plane where the angle between the rotation plane of the link LK1 and the link LK1 is the first angle. Furthermore, in this embodiment, by driving only joint mechanisms JEp1 and JEp2 among the multiple joint mechanisms JE, the tip end TP1 can be moved on a plane whose angle with the rotation plane of link LK1 is a first angle, thereby increasing the carrying capacity of the tip end TP1.

[0126] Moreover, in this embodiment, the first angle is substantially 90 degrees. Therefore, in this embodiment, the tip part TP1 can be moved with high accuracy and speed on a plane SF1 horizontal to the ground surface of the robot 10, a plane SF2 perpendicular to the ground surface, or a plane SF3 inclined to the ground surface. Also, in this embodiment, the tip part TP1 can be moved on the above-mentioned plane SF1, plane SF2, or plane SF3 by driving only the joint mechanisms JEp1 and JEp2 out of the multiple joint mechanisms JE, so that the payload capacity of the tip part TP1 can be increased.

[0127] In this embodiment, the robot 10 further includes 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. The joint mechanism JEr4 rotates the tip part TP1 relative to the link LK2 around an axis Ax4 that forms an angle with the direction De2 larger than a predetermined angle as a 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 an axis Ax5 that forms an angle with a fourth rotation axis (axis Ax4) larger than a predetermined angle as a 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 around an axis Ax6 that forms an angle with the fifth rotation axis (axis Ax5) larger than a predetermined angle as a sixth rotation axis. In this way, the robot 10 may be realized by adding the joint mechanisms JEp1 and JEp2 to a six-axis articulated robot. For example, in this embodiment, since the tip part TP1 includes 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 or on a specified plane.

[0128] In this embodiment, the robot 10 further includes a motor MOr3 for driving the joint mechanism JEr3, a motor MOp1 for driving the joint mechanism JEp1, a motor MOp2 for driving the joint mechanism JEp2, a motor MOr1 for driving the joint mechanism JEr1, and a motor MOr2 for driving the joint mechanism JEr2. The joint mechanism JEp1 includes a screw portion JEp11 disposed inside the link LK1, extending in the direction De1, and rotating about an axis along the direction De1 as the motor MOp1 rotates, and a nut JEp12 connected to the joint mechanism JEr3, through which the screw portion JEp11 is inserted, and which moves relative to the screw portion JEp11 as the screw portion JEp11 rotates. The joint mechanism JEp2 has a screw portion JEp21 disposed inside the link LK2, extending in the direction De2, and rotating about an axis along the direction De2 as the motor MOp2 rotates, and a nut JEp22 connected to the joint mechanism JEr3, through which the screw portion JEp21 is inserted, and which moves relative to the screw portion JEp21 as the screw portion JEp21 rotates. The joint mechanism JEr3 moves relative to the link LK1 as the nut JEp12 moves, and the link LK2 moves relative to the joint mechanism JEr3 as the nut JEp22 moves. In this way, in this embodiment, the joint mechanisms JEp1 and JEp2 can be realized with a simple configuration.

[0129] In this embodiment, the robot controller 30 controls the motors MOr3, MOp1, and MOp2 to control the operation of the robot 10 so that the tip part TP1 of the robot 10 moves along a predetermined plane. In this manner, in this embodiment, the robot controller 30 can easily control the operation of the robot 10 so that the tip part TP1 of the robot 10 moves along a predetermined plane.

[0130] In the present embodiment, the robot system 1 includes the robot 10, the end effector 20 attached to the tip part TP1, and a robot controller 30 that controls the operation of the robot 10 and the end effector 20. The robot controller 30 controls the operation of the robot 10 by controlling the motors MOr3, MOp1, MOp2, MOr1, and MOr2. In this manner, in the present embodiment, the robot 10 that can move the tip part TP1 along a predetermined plane by simple control and move the tip part TP1 to the periphery of the body part BDP by simple control is used in the robot system 1. For this reason, in the present embodiment, the work performed on a predetermined plane can be efficiently performed. Alternatively, in the present embodiment, even in a narrow space around the body part BDP, complex work and simple work can be efficiently performed. For example, the robot system 1 may be used in a manufacturing method of an article that includes assembling or removing a part. In this case, the work of assembling or removing a part can be efficiently performed.

[0131] [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.

[0132] [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.

[0133] Fig. 7 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. 6 are given the same reference numerals, and detailed explanations will be omitted.

[0134] 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."

[0135] 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. 7 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.

[0136] 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.

[0137] 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. 1 indicates the rotation direction of the second part TP12A when rotating around the axis Ax5. The joint mechanism JEr5A is another example of the "fifth driving mechanism."

[0138] 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. 7, 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.

[0139] As described above, in this modified example, the joint mechanism JEr4A rotates the tip part TP1A relative 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 connecting the first part TP11A and the second part TP12A and rotating the second part TP12A relative 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, which rotates a part of the tip part TP1A to which the end effector 20 is attached, 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.

[0140] In this modified example, the same effects as those of the above-described embodiment can be obtained. For example, in this modified example, the tip part TP1A includes the joint mechanisms JEr5A and JEr6, so that the joint mechanisms JEr4A, JEr5A, JEr6, etc. can cause the robot 10 to perform various tasks around the body part BDP or on a predetermined plane.

[0141] [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.

[0142] [Third Modification] In the above-described embodiment and modified example, the robot 10 is exemplified as a 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.

[0143] 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.

[0144] [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.

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

[0146] FIG. 8 is an explanatory diagram for explaining an example of turning. In FIG. 8, the distinction between turning and other rotations will be explained using the connection of two links LKi and LKj whose longitudinal directions can be grasped as an example. The extension direction Dei in FIG. 8 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. 8 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.

[0147] In the example shown in FIG. 8, 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. 8 indicates a rotation other than a turn. In addition, the predetermined angle is not particularly limited, but in FIG. 8, 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).

[0148] 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.

[0149] 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.

[0150] 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.

[0151] 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.

[0152] 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.

[0153] 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.

[0154] 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.

[0155] 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.

[0156] 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. 8 correspond to turns, and the second, third, fourth, and seventh patterns correspond to rotation other than a turn.

[0157] 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. 8 correspond to turns, and the second, fourth and seventh patterns correspond to rotation other than a turn.

[0158] 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. 8 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.

[0159] 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]

[0160] 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, Ax1, Ax2, Ax3, Ax4, Ax4A, Ax5, Ax6, Axi...axis, BDP...body part, BDPbt...bottom surface, BDPba...base part, JEr1, JEr2, JEr3, JEr4, JEr4A, JEr5, JEr6, JEri, JEp1, JEp2...joint mechanism, JEp11, JEp21...screw part, JEp12, JEp22...na JEp13, JEp23...connection part, JEp13a, JEp23a...slider part, JEp13b, JEp23b...support part, JEp14, JEp24...rail, JEp14a, JEp14b, JEp24a, JEp24b...rod-shaped member, JEr11, JEr21, JEr41, JEr51, JEr61...rotating part, JEr12, JEr22, JEr42, JEr52, JEr62...housing, LK1, LK2, LK2A, LKi, LKj...link, MOr1, MOr2, MOr3, MOr4, MOr5, MOr6, MOp1, MOp2...motors.

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 greater 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; 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; Equipped with In a plan view from the first direction, a direction along the first rotation axis and a direction along the third rotation axis intersect at a first angle that is equal to or greater than the predetermined angle. A multi-joint robot characterized by

2. The first angle is substantially 90 degrees.

2. The articulated robot according to claim 1 .

3. a fourth drive mechanism that connects the second link and the tip portion and rotates the tip portion relative to the second link; 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, 3. The articulated robot according to claim 2.

4. a fourth drive mechanism that connects the second link and the tip portion and rotates the tip portion relative to the second link; 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, 3. The articulated robot according to claim 2.

5. a first motor that drives the first drive mechanism; a second motor that drives the first moving mechanism; a third motor that drives the second moving mechanism; a fourth motor that drives the second drive mechanism; a fifth motor that drives the third drive mechanism; and The first moving mechanism is a first screw portion that is disposed inside the first link, extends in the first direction, and rotates about an axis along the first direction as the second motor rotates; a first moving portion connected to the first driving mechanism, through which the first screw portion is inserted, and which moves relative to the first screw portion as the first screw portion rotates; having The second moving mechanism is a second screw portion that is disposed inside the second link, extends in the second direction, and rotates about an axis along the second direction as the third motor rotates; a second moving portion connected to the first driving mechanism, through which the second screw portion is inserted, and which moves relative to the second screw portion as the second screw portion rotates; having the first drive mechanism moves relative to the first link in accordance with the movement of the first moving part; the second link moves relative to the first drive mechanism in accordance with the movement of the second moving part; 3. The articulated robot according to claim 2.

6. A method for controlling an articulated robot according to claim 5, comprising the steps of: A control device for controlling the operation of the articulated robot includes: By controlling the first motor, the second motor, and the third motor, an operation of the articulated robot is controlled so that the tip end of the articulated robot moves along a predetermined plane. A method for controlling an articulated robot.

7. The articulated robot according to claim 5 , an end effector attached to the tip; A control device for controlling the operation of the articulated robot and the end effector; Equipped with The control device includes: controlling the first motor, the second motor, the third motor, the fourth motor, and the fifth motor to control an operation of the articulated robot; A robot system comprising:

8. The robot system according to claim 7 assembles or removes a part. A method for producing an article.

Images