Multijoint robot, control method of the same, robot system, and article manufacturing method

The articulated robot's innovative cable support system maintains power supply to motors by using movable and fixed support mechanisms, addressing the challenge of posture changes in articulated robots.

JP2024168976AInactive Publication Date: 2024-12-05LAUREL BANK MACHINES CO LTD +2
View PDF 1 Cites 0 Cited by

Patent Information

Application Number
JP2023086117
Authority / Receiving Office
JP · JP
Patent Type
Applications
Current Assignee / Owner
Filing Date
2023-05-25
Publication Date
2024-12-05
Estimated Expiration
Not applicable · inactive patent

AI Technical Summary

Technical Problem

The challenge in articulated robots is reliably supplying power to motors as the robot's posture changes, necessitating a flexible and secure cable arrangement.

Method used

The articulated robot incorporates a system with movable and fixed support mechanisms for cables, allowing them to adjust with the robot's posture changes, ensuring continuous power supply to motors.

Benefits of technology

This arrangement ensures reliable power supply to motors even as the robot's posture changes, preventing cable loosening and damage.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 2024168976000001_ABST
    Figure 2024168976000001_ABST
Patent Text Reader

Abstract

To supply electric power to motors in a reliable manner even if an attitude of a robot changes.SOLUTION: A robot 10 includes: a joint mechanism JEp1 which moves a joint mechanism JEr3 along a direction De1; a joint mechanism JEp2 which moves a link LK2 relative to the joint mechanism JEr3 along a direction De2; a cable CBL for supplying electric power to motors MOr3, MOp1, and MOp2 which respectively drive the joint mechanisms JEr3, JEp1, and JEp2; fixed support parts Sf1 and Sf2 which are respectively fixed to links LK1 and LK2; and a movable support part Sm1 and a movable support part Sm2 which respectively move along the direction De1 and the direction De2 according to a change of a position of the motor MOr3. A portion between the motors MOp1 and MOr3 of the cable CBL is supported by the fixed support part Sf1 and the movable support part Sm1, and a portion between the motors MOr3 and MOp2 is supported by the fixed support part Sf2 and the movable support part Sm2.SELECTED DRAWING: Figure 4
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

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

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

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

[0004] Incidentally, the motors that drive each joint of an articulated robot are supplied with power from a power supply device, for example, using wired cables that run from the base of the robot to inside or along the housing of the robot. Since the posture of an articulated robot changes in many ways, it is necessary to arrange the cables so that power can be reliably supplied to the motors even if the posture of the robot changes. [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; a second movement mechanism moving the second link relative to the first drive mechanism along a second direction in which the second link extends; a first motor moving together with the first drive mechanism and driving the first drive mechanism; a second motor driving the first movement mechanism; a first fixed support part fixed to the first link and supporting the cable, a first moving support part moving along the first direction in response to a change in position of the first motor relative to the second motor and supporting the cable, a second fixed support part fixed to the second link and supporting the cable, and a second moving support part moving along the second direction in response to a change in position of the first motor relative to the third motor and supporting the cable, wherein a portion of the cable between the second motor and the first motor is supported by the first fixed support part and the first moving support part, and a portion of the cable between the first motor and the third motor is supported by the second fixed support part and the second moving support part.

[0006] A control method for a multi-joint robot according to a preferred embodiment of the present invention is a control method for the multi-joint robot described above, wherein a control device that controls the operation of the multi-joint robot controls the operation of the multi-joint robot by controlling the first motor, the second motor, and the third motor.

[0007] A robot system according to a preferred embodiment of the present invention comprises the above-mentioned articulated robot, an end effector attached to the tip, and a control device that controls the operation of the articulated robot and the end effector, wherein the control device supplies power to the first motor, the second motor, and the third motor via the cables, and controls the operation of the articulated robot by controlling the first motor, the second motor, and the third 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, power can be reliably supplied to the motor even if the posture of the robot changes. [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] 2 is a diagram illustrating an example of a hardware configuration of a robot controller illustrated in FIG. 1. [Figure 4] FIG. 2 is an explanatory diagram for explaining an outline of cable arrangement. [Diagram 5] FIG. 2 is an explanatory diagram for explaining the arrangement of cables in one of two links. [Figure 6] FIG. 13 is an explanatory diagram for explaining the arrangement of cables in the other of the two links. [Figure 7] FIG. 2 is an explanatory diagram for explaining the arrangement around a motor that drives a joint mechanism that is movable along the extension directions of two links. [Figure 8] FIG. 11 is an explanatory view for explaining an example of a tip portion according to a first modified example. [Figure 9] 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. 1. In Fig. 1, the configuration of a robot 10 is shown in schematic form.

[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 connection using a cable CBL. For example, power for driving the robot 10 and a control signal for controlling the robot 10 are supplied from the robot controller 30 to the robot 10 via the cable CBL. The connection between the robot 10 and the robot controller 30 may be both wired and wireless. For example, power may be supplied from the robot controller 30 to the robot 10 via the cable CBL, and a control signal may be supplied from the robot controller 30 to the robot 10 via wireless communication. In this embodiment, it is assumed that power and a control signal are supplied from the robot controller 30 to the robot 10 via the cable CBL. The robot controller 30 can communicate with the end effector 20 attached to the robot 10. As the robot controller 30, any information processing device capable of communicating with other devices can be adopted. The configuration of the robot controller 30 will be described later with reference to FIG. 3.

[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 an axis Ax2 parallel to the bottom surface BDPbt of the body part BDP. The rotation direction Dr2 in FIG. 1 indicates the rotation direction of the link LK1 when the link LK1 rotates around the axis Ax2. The axis Ax2 is an example of a "third rotation axis."

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

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

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

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

[0027] The joint mechanism JEp1 moves the joint mechanism JEr3 relative to the link LK1 along the direction De1. 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.

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

[0049] Fig. 2 is an explanatory diagram for explaining an example of the joint mechanism JE. In Fig. 2, the joint mechanisms JEp1 and JEp2 and the joint mechanism JEr3 will be mainly explained. Note that Fig. 2 shows the configurations of the joint mechanisms JEp1 and JEp2, etc. In addition, in Fig. 2, in order to make the drawing easier to see, the illustration of the cables CBL for supplying power to the motors MO (MOr1, MOr2, MOr3, MOr4, MOr5, MOr6, MOp1, and MOp2) is omitted.

[0050] In this embodiment, it is assumed that the motor MOr3 that drives the joint mechanism JEr3 moves integrally with the joint mechanism JEr3. That is, the motor MOr3 moves together 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 JEr3 will be described.

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

[0072] The motor MOr1 may be regarded as one element of the joint mechanism JEr1. The housing JEr12 may be fixed to the base part 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 around the axis Ax1 as the rotation axis. In this case, the housing JEr12 may be regarded as one element of the base part BDPba. The motor MOr1 is an example of a "fourth motor."

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

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

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

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

[0077] 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 another part of the rotating part JEr41 may be located inside the link LK2. The motor MOr4 is an example of a "sixth motor."

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

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

[0080] 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. The motor MOr5 is an example of a "seventh motor."

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

[0082] 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 face TP1sf. When the housing JEr62 is fixed to the second part TP12, the housing JEr62 may be regarded as one element of the second part TP12. The motor MOr6 is an example of an "eighth motor."

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

[0084] 2 is an initial posture of the robot 10, which is one of the states that represent the characteristics of the robot 10 in this embodiment. The initial posture is the initial posture when the robot 10 starts to operate, or the posture to which the robot 10 transitions when waiting once after performing a specific task. The initial posture is also called a standby state, standby posture, or home position. The standby state shown in FIG. 2 is one of the standing states in which the directions De1 and De2 are parallel to the axis Ax1.

[0085] For example, the standby state is a state in which the directions De1 and De2 are parallel to the axis Ax1, and the end LK2ed1 of the link LK2 is located closer to the end LK1ed1 than the end LK1ed2 of the link LK1. In the standby state, the joint mechanism JEr3 is preferably 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. For example, when the robot 10 is made to wait in the standby state shown in FIG. 2, the maximum movement amount of the position of the joint mechanism JEr3 relative to the link LK1 is about half the length along the direction De1 of the movement region ARmv1. Also, the maximum movement amount of the position of the joint mechanism JEr3 relative to the link LK2 is about half the length along the direction De2 of the movement region ARmv2. Therefore, in this embodiment, by making the robot 10 wait in the standby state shown in FIG. 2, it is possible to suppress the time required for the state transition of the robot 10 from the standby state to another state from becoming long.

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

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

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

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

[0090] Here, in this embodiment, as described above, since the motor MOr3 moves along with the joint mechanism JEr3, the distance from the motor MOp1 to the motor MOr3 and the distance from the motor MOp2 to the motor MOr3 change according to the posture of the robot 10. For this reason, in this embodiment, the cable CBL is arranged so that power can be reliably supplied to the motors even if the posture of the robot 10 changes (transitions). The arrangement of the cable CBL will be described in FIG. 4 and subsequent figures.

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

[0092] Fig. 3 is a diagram showing an example of a hardware configuration of the robot controller 30 shown in Fig. 1. In Fig. 3, for ease of understanding, a plurality of motors MO and an end effector 20 of the robot 10 are also shown.

[0093] The robot controller 30 includes a power supply device 31, 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 or the like, a display device 36, and a driver circuit 37. The robot controller 30 may be realized as a single device, or may be realized as a plurality of devices that are configured separately from each other. For example, the robot controller 30 may be a device separate from the power supply device 31 and the processing device 32.

[0094] The power supply device 31 receives power from a commercial power source (not shown) and generates a power supply voltage to be supplied to each of the multiple motors MO (MOr1, MOr2, MOr3, MOr4, MOr5, MOr6, MOp1, and MOp2) and a power supply voltage to be supplied to the end effector 20. In this embodiment, it is assumed that the multiple motors MO and the motors (not shown) included in the end effector 20 are DC (Direct Current) motors that operate with a direct current power source. In this case, the power supply device 31 generates the DC power to be supplied to the DC motors using AC power received from the commercial power source. Note that the multiple motors MO and the motors included in the end effector 20 are not limited to DC motors. For example, the multiple motors MO and some or all of the motors included in the end effector 20 may be AC ​​(Alternating Current) motors that operate with an alternating current power source. In this case, the power supply device 31 generates the AC power to be supplied to the AC motors using AC power received from the commercial power source.

[0095] Each motor MO receives a power supply voltage generated by the power supply device 31 via a wire Lpm. For example, each motor MO has a connector CT including a terminal P1 to which a power supply voltage is supplied, a terminal P2 to which a control signal is input, and a terminal P3 to which a control signal is output. The wire LPm is connected to the terminal P1 of each motor MO. The end effector 20 receives the power supply voltage generated by the power supply device 31 via a wire Lpe. In this embodiment, it is assumed that the wires Lpm and Lpe and wires Lcm and Lce described later are included in the cable CBL. That is, in this embodiment, power is supplied to each of the multiple motors MO via the cable CBL.

[0096] 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. Alternatively, the memory 33 may be included in the processing device 32.

[0097] 3 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.

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

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

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

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

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

[0103] The driver circuit 37 is hardware that outputs a control signal for driving the robot 10 to the robot 10 under the control of the processing device 32. For example, the driver circuit 37 supplies a control signal for driving each of the motors MO to each of the motors MO via the wiring Lcm under the control of the processing device 32. For example, the wiring Lcm includes wirings Lcm1, Lcm2, Lcm3, Lcm4, Lcm5, Lcm6, Lcm7, and Lcm8. The wiring Lcm1 connects the robot controller 30 to the terminal P2 of the motor MOr1. The wiring Lcm2 connects the terminal P3 of the motor MOr1 to the terminal P2 of the motor MOr2. The wiring Lcm3 connects the terminal P3 of the motor MOr2 to the terminal P2 of the motor MOp1. The wiring Lcm4 connects the terminal P3 of the motor MOp1 to the terminal P2 of the motor MOr3. The wire Lcm5 connects the terminal P3 of the motor MOr3 to the terminal P2 of the motor MOp2. The wire Lcm6 connects the terminal P3 of the motor MOp2 to the terminal P2 of the motor MOr4. The wire Lcm7 connects the terminal P3 of the motor MOr4 to the terminal P2 of the motor MOr5. The wire Lcm8 connects the terminal P3 of the motor MOr5 to the terminal P2 of the motor MOr6. In this way, the multiple motors MO are cascade-connected by the cable CBL in the order of motor MOr1, motor MOr2, motor MOp1, motor MOr3, motor MOp2, motor MOr4, motor MOr5, and motor MOr6. In addition, the driver circuit 37 supplies a control signal for driving the end effector 20 to the end effector 20 via the wire Lce under the control of the processing device 32.

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

[0105] The configuration of the robot controller 30 is not limited to the example shown in Fig. 3. For example, the operation device 35 and the display device 36 may be omitted from the robot controller 30.

[0106] Next, an outline of the arrangement of the cable CBL will be described with reference to FIG.

[0107] FIG. 4 is an explanatory diagram for explaining an outline of the arrangement of the cable CBL.

[0108] 3, the cable CBL connects the robot controller 30 to the multiple motors MO and the end effector 20. For example, the cable CBL is connected to the multiple motors MO in the following order: motor MOr1, motor MOr2, motor MOp1, motor MOr3, motor MOp2, motor MOr4, motor MOr5, and motor MOr6.

[0109] In this embodiment, it is assumed that each of the motors MOr1, MOr2, MOr3, MOr4, MOr5, and MOr6 has a hollow structure. For example, the cable CBL is arranged from the robot controller 30 through the insides (hollow parts) of the motors MOr1 and MOr2 to the motor MOp1, and from the motor MOp1 to the motor MOp2 through the insides (hollow parts) of the motors MOr3. Furthermore, the cable CBL is arranged from the motor MOp2 to the end effector 20 through the insides (hollow parts) of the motors MOr4, MOr5, and MOr6.

[0110] In the following, of the two openings in the hollow portion of each of the motors MOr1, MOr2, MOr3, MOr4, MOr5, and MOr6, the opening farther from the connector CT may be referred to as the outlet EX of the cable CBL.

[0111] In this embodiment, the robot 10 further includes a fixed support part Sf1, a moving support part Sm1, an elastic member EL1, a fixed support part Sf2, a moving support part Sm2, and an elastic member EL1. The fixed support part Sf1 is an example of a "first fixed support part," the moving support part Sm1 is an example of a "first moving support part," and the elastic member EL1 is an example of a "first elastic member." The fixed support part Sf2 is an example of a "second fixed support part," the moving support part Sm2 is an example of a "second moving support part," and the elastic member EL2 is an example of a "second elastic member."

[0112] The fixed support Sf1 is fixed to the link LK1. The moving support Sm1 is supported by an elastic member EL1 that expands and contracts along the direction De1 so as to be movable along the direction De1 in response to a change in the position of the motor MOr3 relative to the motor MOp1. One end of the elastic member EL1 is fixed to the link LK1, and the other end is connected to the moving support Sm1. The fixed support Sf1 and the moving support Sm1 support the cable CBLa, which is a portion of the cable CBL between the motor MOp1 and the motor MOr3. As a result, in this embodiment, even if the distance between the connector CT of the motor MOp1 and the connector CT of the motor MOr3 changes with a change in the position of the motor MOr3 relative to the motor MOp1, the cable CBLa can be prevented from loosening.

[0113] The fixed support part Sf2 is fixed to the link LK2. The movable support part Sm2 is supported by an elastic member EL2 that expands and contracts along the direction De2 so as to be movable along the direction De2 in response to a change in the position of the motor MOr3 relative to the motor MOp2. One end of the elastic member EL2 is fixed to the link LK2, and the other end is connected to the movable support part Sm2. The fixed support part Sf2 and the movable support part Sm2 support the cable CBLb, which is a portion of the cable CBL between the motor MOp2 and the motor MOr3. As a result, in this embodiment, even if the distance between the connector CT of the motor MOp2 and the outlet EX of the cable CBL at the motor MOr3 changes with a change in the position of the motor MOr3 relative to the motor MOp2, it is possible to prevent the cable CBLb from loosening.

[0114] The distance between the outlet EX of the cable CBL in the motor MOr1 and the connector CT of the motor MOr2, and the distance between the outlet EX of the cable CBL in the motor MOr2 and the connector CT of the motor MOp1 are maintained at a constant or approximately constant distance. However, the relative position of the connector CT of the motor MOr2 to the outlet EX of the cable CBL in the motor MOr1 changes with the rotation of the motor MOr1 because the joint mechanism JEr2 rotates with the rotation of the motor MOr1. Similarly, the relative position of the connector CT of the motor MOp1 to the outlet EX of the cable CBL in the motor MOr2 changes with the rotation of the motor MOr2 because the link LK1 turns with the rotation of the motor MOr2. For this reason, the motors MOr1 and MOr2 are connected by a cable CBL of a length that allows a slight margin with respect to the distance between the motors MOr1 and MOr2. The motors MOr2 and MOP1 are connected by a cable CBL of a length that allows a slight margin with respect to the distance between the motors MOr2 and MOP1.

[0115] Furthermore, the distance between the connector CT of motor MOp2 and the connector CT of motor MOr4 does not change. Therefore, motors MOp2 and MOr4 are connected by a cable CBL having a length corresponding to the distance between the connector CT of motor MOp2 and the connector CT of motor MOr4. Note that motors MOp2 and MOr4 may be connected by a cable CBL having a length that allows some leeway with respect to the distance between the connector CT of motor MOp2 and the connector CT of motor MOr4.

[0116] Further, the distance between the outlet EX of the cable CBL in the motor MOr4 and the connector CT of the motor MOr5, and the distance between the outlet EX of the cable CBL in the motor MOr5 and the connector CT of the motor MOr6 are maintained at a constant or approximately constant distance. However, the relative position of the connector CT of the motor MOr5 to the outlet EX of the cable CBL in the motor MOr4 changes with the rotation of the motor MOr4 because the first part TP11 of the tip part TP1 rotates with the rotation of the motor MOr4. Similarly, the relative position of the connector CT of the motor MOr6 to the outlet EX of the cable CBL in the motor MOr5 changes with the rotation of the motor MOr5 because the second part TP12 of the tip part TP1 rotates with the rotation of the motor MOr5. For this reason, the motors MOr4 and MOr5 are connected by a cable CBL having a length that allows a slight margin with respect to the distance between the motors MOr4 and MOr5. The motors MOr5 and MOr6 are connected by a cable CBL having a length that allows a slight margin with respect to the distance between the motors MOr5 and MOr6.

[0117] In this manner, in this embodiment, the motors MO are connected by the cable CBL in the order of the motors MO driving the joint mechanisms JE arranged in sequence from the body part BDP in the path inside the robot 10 from the body part BDP toward the tip part TP1. As a result, in this embodiment, it is possible to prevent the arrangement of the cable CBL from becoming complicated. For example, in a configuration in which the arrangement of the cable CBL is complicated, there is a risk that the changeable posture of the robot 10 is restricted by the cable CBL, or that excessive tension is generated in the cable CBL when the posture of the robot 10 changes. If excessive tension is generated in the cable CBL, there is a risk that the cable CBL will be damaged. In this embodiment, it is possible to prevent the arrangement of the cable CBL from becoming complicated, and therefore it is possible to prevent the changeable posture of the robot 10 from being restricted by the cable CBL and the occurrence of excessive tension in the cable CBL.

[0118] Next, the arrangement of the cable CBLa in the link LK1 will be described with reference to FIG.

[0119] Fig. 5 is an explanatory diagram for explaining the arrangement of the cable CBLa in the link LK1. Note that in Fig. 5, in order to make the arrangement of the cable CBLa easier to understand, the exterior of the link LK1 is omitted. Furthermore, in Fig. 5(b) and Fig. 5(c), in order to make the positional relationship between the movement support part Sm1 and the motor MOr3 easier to understand, the frame FM12, which will be described later, is omitted.

[0120] In FIG. 5(b), the motor MOr3 is located closer to the end LK1ed1 than the end LK1ed2 of the link LK1. For example, the motor MOr3 is located at a position where the distance from the motor MOp1 is the smallest in the movement range when the motor MOr3 moves along the direction De1. Also, in FIG. 5(c), the motor MOr3 is located closer to the end LK1ed2 than the end LK1ed1 of the link LK1. For example, the motor MOr3 is located at a position where the distance from the motor MOp1 is the largest in the movement range when the motor MOr3 moves along the direction De1. Also, the direction Dax3 in FIG. 5 is the direction from the link LK1 to the link LK2 among the directions along the axis Ax3, which is the rotation axis of the motor MOr3.

[0121] The link LK1 has, for example, frames FM10, FM11, and FM12 extending along a direction De1. For example, a motor MOr3 is attached to the frame FM10. In the example shown in Fig. 5, the frame FM10 is located between the frame FM11 and the motor MOr3 in the direction Dax3.

[0122] As shown in Fig. 5(b), the frame FM11 includes a surface facing the frame FM10, and includes a plate portion FM11a extending along the direction De1, and a plate portion FM11b protruding in the opposite direction to the direction Dax3 from one of two edges of the plate portion FM11a along the direction De1. For example, the frame FM11 is disposed in the direction Dax3 such that the plate portion FM11a is located between the frames FM12 and FM10. Note that in the example shown in Fig. 5, when the frames FM11 and FM12 are viewed in the direction Dax3, the plate portion FM11b of the frame FM11 is located outside the frame FM12, but may be located inside the frame FM12.

[0123] Hereinafter, among the ends of frames FM10, FM11, and FM12, the end corresponding to end LK1ed1 of link LK1 may be referred to as end LK1ed1, and the end corresponding to end LK1ed2 of link LK1 may be referred to as end LK1ed2. For example, among the ends of frame FM11, the end opposite to direction De1 may be referred to as end LK1ed1 of frame FM11, and the end in direction De1 may be referred to as end LK1ed2 of frame FM11.

[0124] The cable CBLa, the fixed support part Sf1, and the movable support part Sm1 are arranged, for example, in a region sandwiched between the plate part FM11a of the frame FM11 and the frame FM12.

[0125] In this embodiment, it is assumed that the fixed support part Sf1 is a pulley (so-called fixed pulley) fixed to the link LK1, and the movable support part Sm1 is a pulley (so-called movable pulley) suspended by an elastic member EL1 and movable along a direction De1. For example, the fixed support part Sf1 includes a disk Sf11 on which the cable CBLa is hung, and a disk support part Sf12 that rotatably supports the disk Sf11. The disk support part Sf12 is fixed to, for example, an end part LK1ed1 of a plate part FM11a of the frame FM11.

[0126] The moving support part Sm1 includes a disk Sm11 on which the cable CBLa is hung, and a disk support part Sm12 connected to the elastic member EL1 and rotatably supporting the disk Sm11. The elastic member EL1 is, for example, a spring member that expands and contracts along a direction De1. For example, one end of the elastic member EL1 is connected to an end LK1ed2 of the plate part FM11a of the frame FM11 by a screw SC1, and the other end of the elastic member EL1 is connected to the disk support part Sm12. Note that the method of connecting the elastic member EL1 and the plate part FM11a is not limited to the screw SC1. For example, the elastic member EL1 may be connected to the plate part FM11a by an adhesive or by welding.

[0127] 5(b) and 5(c), the cable CBLa between the motors MOp1 and MOr3 is connected from the motor MOp1 to the motor MOr3 via the moving support Sm1 and the fixed support Sf1. For example, the fixed support Sf1 is fixed to the end LK1ed1 of the plate FM11a of the frame FM11.

[0128] In addition, the moving support part Sm1 is movable along slits SL1a and SL1b provided in the frame FM11 and slits SL1c and SL1d provided in the frame FM12. The slits SL1a, SL1b, SL1c, and SL1d limit the moving direction of the moving support part Sm1 so that the moving support part Sm1 does not move in any direction other than the direction De1.

[0129] For example, the slit SL1a is an opening penetrating the plate portion FM11a of the frame FM11 and extends along the direction De1. The slit SL1b is an opening penetrating the plate portion FM11b of the frame FM11 and extends along the direction De1. The slit SL1c is an opening penetrating a portion of the frame FM12 facing the plate portion FM11a of the frame FM11 and extends along the direction De1. The slit SL1d is an opening penetrating a portion of the frame FM12 facing the plate portion FM11b of the frame FM11 and extends along the direction De1. For example, a portion of the disk support portion Sm12 of the moving support portion Sm1 that corresponds to the rotation axis of the disk Sm11 is inserted into the slits SL1a and SL1c. A part of the moving support portion Sm1 is inserted into the slits SL1b and SL1d.

[0130] As described above, the moving support part Sm1 is suspended from the end part LK1ed2 of the plate part FM11a of the frame FM11 by the elastic member EL1. Therefore, a force in the direction De1 due to the elastic force of the elastic member EL1 or the like is constantly applied to the moving support part Sm1. Therefore, when the position of the motor MOr3 relative to the motor MOp1 changes, the moving support part Sm1 moves to a position where the forces applied to the moving support part Sm1, such as the force in the opposite direction to the direction De1 due to the cable CBLa and the force in the direction De1 due to the elastic force of the elastic member EL1, are balanced.

[0131] For example, as shown in FIG. 5(b), when the motor MOr3 is located closer to the end LK1ed1 than the end LK1ed2 of the link LK1, the distance from the fixed support Sf1 to the motor MOr3 is shorter than when the motor MOr3 is located at the end LK1ed2 of the link LK1. In this case, the length of the portion of the cable CBLa from the fixed support Sf1 to the motor MOr3 is shorter, and the length of the portion from the motor MOp1 to the fixed support Sf1 is longer. Therefore, the forces applied to the moving support Sm1, such as the force in the opposite direction to the direction De1 by the cable CBLa and the force in the direction De1 by the elastic force of the elastic member EL1, are balanced at a position closer to the end LK1ed2 than the end LK1ed1 of the link LK1. Therefore, when the motor MOr3 is located closer to the end LK1ed1 than the end LK1ed2 of the link LK1, the moving support Sm1 is located closer to the end LK1ed2 than the end LK1ed1 of the link LK1. For example, the state shown in FIG. 5(b) is a state in which the stretch of the elastic member EL1 suspending the movement support member Sm1 is at a minimum.

[0132] Also, as shown in FIG. 5(c), when the motor MOr3 is located at the end LK1ed2 of the link LK1, the distance from the fixed support Sf1 to the motor MOr3 is longer than when the motor MOr3 is located closer to the end LK1ed1 than the end LK1ed2 of the link LK1. In this case, the length of the portion of the cable CBLa from the fixed support Sf1 to the motor MOr3 is longer, and the length of the portion from the motor MOp1 to the fixed support Sf1 is shorter. Therefore, the forces applied to the moving support Sm1, such as the force in the opposite direction to the direction De1 by the cable CBLa and the force in the direction De1 by the elastic force of the elastic member EL1, are balanced at a position closer to the end LK1ed1 than the end LK1ed2 of the link LK1. Therefore, when the motor MOr3 is located at the end LK1ed2 of the link LK1, the moving support Sm1 is located closer to the end LK1ed1 than the end LK1ed2 of the link LK1. For example, the state shown in Fig. 5(c) is a state in which the elastic member EL1 suspending the moving support unit Sm1 is stretched to the maximum. The length of the cable CBLa connecting the motors MOp1 and MOr3 is determined based on the state in which the distance from the fixed support unit Sf1 to the motor MOr3 is maximized. This makes it possible to prevent excessive tension from being generated in the cable CBLa in this embodiment.

[0133] In this manner, in this embodiment, the moving support part Sm1 moves along the direction De1 in response to a change in the position of the motor MOr3 relative to the motor MOp1, so that the cable CBLa can be prevented from loosening. Also, in this embodiment, the disk Sm11 of the moving support part Sm1 is located in the direction De1 (the direction of the force applied to the disk Sf11 by the elastic force of the elastic member EL1) further than the disk Sf11 of the fixed support part Sf1, regardless of the position of the motor MOr3. Therefore, in this embodiment, for example, even if the position of the motor MOr3 changes, it is possible to prevent the cable CBLa from coming off the disk Sm11 of the moving support part Sm1.

[0134] Furthermore, in this embodiment, regardless of the position of the motor MOr3, the cable CBLa passes through the frame FM10 at a position in the direction De1 relative to the disk Sf11 of the fixed support Sf1. Therefore, in this embodiment, the direction in which the cable CBLa bends at the portion where it passes through the frame FM10 is maintained in a constant direction regardless of the position of the motor MOr3. As a result, in this embodiment, damage to the cable CBLa can be suppressed compared to a case in which the direction in which the cable CBLa bends at the portion where it passes through the frame FM10 changes depending on the position of the motor MOr3.

[0135] 5, in this embodiment, a portion of the cable CBLa disposed in an area sandwiched between the plate portion FM11a of the frame FM11 and the frame FM12 is covered with a tube. This makes it possible to smoothly slide the cable CBLa hanging on the disks Sf11 and Sm11 while preventing damage to the cable CBLa hanging on the disks Sf11 of the fixed support member Sf1 and the disk Sm11 of the movable support member Sm1. Note that the cable CBLa does not have to be covered with a tube.

[0136] Next, the arrangement of the cable CBLb in the link LK2 will be described with reference to FIG.

[0137] FIG. 6 is an explanatory diagram for explaining the arrangement of the cable CBLb in the link LK2. In FIG. 6, the exterior of the link LK2 is omitted in order to make the arrangement of the cable CBLb easier to understand. Furthermore, in FIG. 6(b) and FIG. 6(c), the frame FM22, which will be described later, is omitted in order to make the positional relationship between the moving support part Sm2 and the motor MOr3 easier to understand. Furthermore, the direction Dc2 in FIG. 6 is, for example, a direction perpendicular to the direction De2 and the direction Dax3. However, the direction Dc2 is not limited to a direction perpendicular to the direction De2 and the direction Dax3. For example, the direction Dc2 may be any direction that intersects the direction De2 and the direction Dax3.

[0138] In FIG. 6(b), the motor MOr3 is located closer to the end LK2ed1 of the link LK2 than the end LK2ed2 of the link LK2. For example, the motor MOr3 is located at a position where the distance from the motor MOp2 is minimum in the movement range when the motor MOr3 moves along the direction De2. Also, in FIG. 6(c), the motor MOr3 is located closer to the end LK2ed2 of the link LK2 than the end LK2ed1 of the link LK2. For example, the motor MOr3 is located at a position where the distance from the motor MOp2 is maximum in the movement range when the motor MOr3 moves along the direction De2.

[0139] The link LK2 has, for example, frames FM20, FM21, and FM22 extending along the direction De2. For example, a motor MOr3 is attached to the frame FM20. That is, the motor MOr3 is attached to the frame FM20 and the frame FM10 shown in FIG. 5. In the example shown in FIG. 6, the frame FM20 is located between the frames FM21 and FM22 and the motor MOr3 in the direction Dax3. In addition, the frames FM21 and FM22 are connected to one of the two edges of the frame FM20 along the direction De2 (the edge in the direction Dc2 in the example shown in FIG. 6).

[0140] As shown in Fig. 6(b), the frame FM21 includes a surface parallel to the direction De2 and the direction Dax3, and includes a plate portion FM21a extending along the direction De2, and a plate portion FM21b protruding in the direction Dc2 from an edge portion in the direction Dax3 of two edges of the plate portion FM21a along the direction De2. For example, the frames FM21 and FM22 are arranged along the direction Dc2 so that a space for arranging the cable CBLb is secured between the plate portion FM21a and the frame FM22. In the example shown in Fig. 6, when the frames FM21 and FM22 are viewed from the direction Dc2, the plate portion FM21b of the frame FM21 is located outside the frame FM22, but may be located inside the frame FM22.

[0141] Hereinafter, among the ends of frames FM20, FM21, and FM22, the end corresponding to end LK2ed1 of link LK2 may be referred to as end LK2ed1, and the end corresponding to end LK2ed2 of link LK2 may be referred to as end LK2ed2. For example, among the ends of frame FM21, the end opposite to direction De2 may be referred to as end LK2ed1 of frame FM21, and the end in direction De2 may be referred to as end LK2ed2 of frame FM21.

[0142] The cable CBLb, the fixed support part Sf2, and the movable support part Sm2 are disposed, for example, in a region sandwiched between the plate part FM21a of the frame FM21 and the frame FM22.

[0143] In this embodiment, it is assumed that the fixed support part Sf2 is a pulley (so-called fixed pulley) fixed to the link LK2, and the movable support part Sm2 is a pulley (so-called movable pulley) suspended by an elastic member EL2 and movable along the direction De2. For example, the fixed support part Sf2 includes a disk Sf21 on which the cable CBLb is hung, and a disk support part Sf22 that rotatably supports the disk Sf21. The disk support part Sf22 is fixed to, for example, an end part LK2ed1 of the plate part FM21a of the frame FM21.

[0144] The moving support part Sm2 includes a disk Sm21 on which the cable CBLb is hung, and a disk support part Sm22 connected to the elastic member EL2 and rotatably supporting the disk Sm21. The elastic member EL2 is, for example, a spring member that expands and contracts along the direction De2. For example, one end of the elastic member EL2 is connected to an end LK2ed2 of the plate part FM21a of the frame FM21 by a screw SC2, and the other end of the elastic member EL2 is connected to the disk support part Sm22. Note that the method of connecting the elastic member EL2 and the plate part FM21a is not limited to the screw SC2. For example, the elastic member EL2 may be connected to the plate part FM21a by an adhesive or by welding.

[0145] As shown in Figures 6(b) and 6(c), the cable CBLb between the motors MOp2 and MOr3 is connected from the motor MOr3 to the motor MOp2 via the fixed support Sf2 and the movable support Sm2. For example, the fixed support Sf2 is fixed to the end LK2ed1 of the plate FM21a of the frame FM21.

[0146] In addition, the moving support part Sm2 is movable along slits SL2a and SL2b provided in the frame FM21 and slits SL2c and SL2d provided in the frame FM22. For example, the slits SL2a, SL2b, SL2c, and SL2d limit the moving direction of the moving support part Sm2 so that the moving support part Sm2 does not move in any direction other than the direction De2.

[0147] For example, the slit SL2a is an opening penetrating the plate portion FM21a of the frame FM21 and extends along the direction De2. The slit SL2b is an opening penetrating the plate portion FM21b of the frame FM21 and extends along the direction De2. The slit SL2c is an opening penetrating a portion of the frame FM22 facing the plate portion FM21a of the frame FM21 and extends along the direction De2. The slit SL2d is an opening penetrating a portion of the frame FM22 facing the plate portion FM21b of the frame FM21 and extends along the direction De2. For example, a portion of the disk support portion Sm22 of the moving support portion Sm2 that corresponds to the rotation axis of the disk Sm21 is inserted into the slits SL1a and SL1c. A portion of the moving support portion Sm2 is inserted into the slits SL2b and SL2d.

[0148] As described above, the moving support part Sm2 is suspended from the end part LK2ed2 of the plate part FM21a of the frame FM21 by the elastic member EL2. Therefore, a force in the direction De2 due to the elastic force of the elastic member EL2 or the like is constantly applied to the moving support part Sm2. Therefore, when the position of the motor MOr3 relative to the motor MOp2 changes, the moving support part Sm2 moves to a position where the forces applied to the moving support part Sm2, such as the force in the opposite direction to the direction De2 due to the cable CBLb and the force in the direction De2 due to the elastic force of the elastic member EL2, are balanced.

[0149] For example, as shown in FIG. 6(b), when the motor MOr3 is located at the end LK2ed1 of the link LK2, the distance from the motor MOr3 to the fixed support Sf2 is shorter than when the motor MOr3 is located closer to the end LK2ed2 than the end LK2ed1 of the link LK2. In this case, the length of the portion of the cable CBLb from the motor MOr3 to the fixed support Sf2 is shorter, and the length of the portion from the fixed support Sf2 to the motor MOp2 is longer. Therefore, the forces applied to the moving support Sm2, such as the force in the opposite direction to the direction De2 by the cable CBLb and the force in the direction De2 by the elastic force of the elastic member EL2, are balanced at a position closer to the end LK2ed2 than the end LK2ed1 of the link LK2. Therefore, when the motor MOr3 is located at the end LK2ed1 of the link LK2, the moving support Sm2 is located closer to the end LK2ed2 than the end LK2ed1 of the link LK2. For example, the state shown in FIG. 6(b) is a state in which the stretch of the elastic member EL2 that suspends the moving support member Sm2 is at a minimum.

[0150] Also, as shown in FIG. 6(c), when the motor MOr3 is located closer to the end LK2ed2 than the end LK2ed1 of the link LK2, the distance from the motor MOr3 to the fixed support Sf2 is longer than when the motor MOr3 is located at the end LK2ed1 of the link LK2. In this case, the length of the portion of the cable CBLb from the motor MOr3 to the fixed support Sf2 is longer, and the length of the portion from the fixed support Sf2 to the motor MOp2 is shorter. Therefore, the forces applied to the moving support Sm2, such as the force in the opposite direction to the direction De2 by the cable CBLb and the force in the direction De2 by the elastic force of the elastic member EL2, are balanced at a position closer to the end LK2ed1 than the end LK2ed2 of the link LK2. Therefore, when the motor MOr3 is located closer to the end LK2ed2 than the end LK2ed1 of the link LK2, the moving support Sm2 is located closer to the end LK2ed1 than the end LK2ed2 of the link LK2. For example, the state shown in Fig. 6(c) is the state in which the elastic member EL2 suspending the moving support member Sm2 is stretched to the maximum. The length of the cable CBLb connecting the motors MOp2 and MOr3 is determined based on the state in which the distance from the fixed support member Sf2 to the motor MOr3 is maximized. This makes it possible to prevent excessive tension from being generated in the cable CBLb in this embodiment.

[0151] In this manner, in this embodiment, the moving support part Sm2 moves along the direction De2 in response to a change in the position of the motor MOr3 relative to the motor MOp2, so that the cable CBLb can be prevented from loosening. Also, in this embodiment, the disk Sm21 of the moving support part Sm2 is located in the direction De2 (the direction of the force applied to the disk Sf21 by the elastic force of the elastic member EL2) further than the disk Sf21 of the fixed support part Sf2, regardless of the position of the motor MOr3. Therefore, in this embodiment, for example, even if the position of the motor MOr3 changes, it is possible to prevent the cable CBLb from coming off the disk Sm21 of the moving support part Sm2.

[0152] Furthermore, in this embodiment, regardless of the position of the motor MOr3, the cable CBLb passes through the frame FM20 at a position in the direction De2 higher than the disk Sf21 of the fixed support Sf2. Therefore, in this embodiment, the direction in which the cable CBLb bends at the portion where it passes through the frame FM20 is maintained in a constant direction regardless of the position of the motor MOr3. As a result, in this embodiment, damage to the cable CBLb can be suppressed compared to a case in which the direction in which the cable CBLb bends at the portion where it passes through the frame FM20 changes depending on the position of the motor MOr3.

[0153] 6, in this embodiment, the portion of the cable CBLb arranged in the area between the plate portion FM21a of the frame FM21 and the frame FM22 is covered with a tube. This makes it possible to smoothly slide the cable CBLb hanging on the disks Sf21 and Sm21 while preventing the cable CBLb hanging on the disks Sf21 of the fixed support member Sf2 and the disk Sm21 of the movable support member Sm2 from being damaged. Note that the cable CBLb does not have to be covered with a tube.

[0154] 5 and 6, in this embodiment, even if one or both of the position of the motor MOr3 relative to the motor MOp1 and the position of the motor MOr3 relative to the motor MOp2 change, it is possible to prevent the cable CBL from loosening. Therefore, in this embodiment, even if the posture of the robot 10 changes (transitions) and the distance from the body part BDP to each motor MO changes significantly, it is possible to reliably supply power and control signals to each motor MO.

[0155] Furthermore, the cable CBL is fixed to the motor MOr3, and the arrangement in the direction of the link LK1 and the arrangement in the direction of the link LK2 as viewed from the motor MOr3 are nearly symmetrical. In this case, the force applied to the motor MOr3 by the tension of the cable CBL is a force pulling the motor MOr3 in the direction of the link LK1 due to the tension of the cable CBLa, and a force pulling the motor MOr3 in the direction of the link LK2 due to the tension of the cable CBLb. Therefore, in this embodiment, the arrangement of the cable CBL is very well balanced with respect to the motor MOr3.

[0156] Next, with reference to FIG. 7, the arrangement of the cable CBLb in the link LK2, around the motor MOr3 that drives the joint mechanism JEr3, will be described.

[0157] FIG. 7 is an explanatory diagram for explaining the arrangement around the motor MOr3 that drives the joint mechanism JEr3.

[0158] The cable CBLb, which passes through the hollow part of the motor MOr3 and is connected to the motor MOp2 (not shown in FIG. 7), is guided to the space between the frame FM21 and the frame FM22 (not shown in FIG. 7) at a position in the direction De2 from the motor MOr3. In addition, the cable CBLc, which is a part of the cable CBL between the motor MOp2 and the motor MOr4, is arranged, for example, along the edge in the opposite direction of the direction Dc2 (the edge to which the frame FM21 is not connected) of the two edges of the frame FM20 along the direction De2. Note that the distance between the connector CT of the motor MOp2 and the connector CT of the motor MOr4 does not change, as described in FIG. 4. For this reason, the cable CBLc connecting the motor MOp2 and the motor MOr4 is fixed, for example, to the edge of the frame FM20 in the opposite direction of the direction Dc2. In this embodiment, it is possible to suppress the cable CBLc from loosening.

[0159] The arrangement of the cable CBL is not limited to the examples shown in Figures 5, 6, and 7. For example, the elastic members EL1 and EL2 are not limited to spring members as long as they can movably support the movable support members Sm1 and Sm2. For example, instead of the elastic members EL1 and EL2, the positions of the movable support members Sm1 and Sm2 may be moved by actuators.

[0160] In addition, in this embodiment, the cable CBLa is supported by one fixed support part Sf1 and one movable support part Sm1, but the number of each of the fixed support parts Sf1 and the movable support parts Sm1 is not limited to one. For example, if the cable CBLa can be prevented from slackening even when the position of the motor MOr3 relative to the motor MOp1 changes, one or both of the fixed support parts Sf1 and the movable support parts Sm1 may be two or more. Also, for example, the fixed support part Sf1 may be omitted. In a configuration in which the fixed support part Sf1 is omitted, it is preferable that a member such as a cover that prevents the cable CBLa from coming off the disk Sm11 of the movable support part Sm1 is provided on the disk Sm11.

[0161] As with the fixed support Sf1 and the movable support Sm1, one or both of the fixed support Sf2 and the movable support Sm2 may be two or more. Also, for example, the fixed support Sf2 may be omitted. In a configuration in which the fixed support Sf2 is omitted, it is preferable that a member such as a cover that prevents the cable CBLb from coming off the disk Sm21 of the movable support Sm2 is provided on the disk Sm21.

[0162] In addition, the movable support members Sm1 and Sm2 are not limited to pulleys as long as they can suspend the cable CBL while smoothly sliding it. Similarly, the fixed support members Sf1 and Sf2 are not limited to pulleys as long as they can smoothly slide the cable CBL.

[0163] 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 relatively to the link LK1 along the direction De1, a joint mechanism JEp2 that moves the link LK2 relatively to the joint mechanism JEr3 along the direction De2 in which the link LK2 extends, and a joint mechanism JEp3 that moves together with the joint mechanism JEr3 and The link LK1 includes a motor MOr3 for driving the joint mechanism JEp3, a motor MOp1 for driving the joint mechanism JEp1, a motor MOp2 for driving the joint mechanism JEp2, a cable CBL for supplying power to the motors MOr3, MOp1, and MOp2, a fixed support Sf1 fixed to the link LK1 and supporting the cable CBL, a moving support Sm1 moving along the direction De1 in response to a change in the position of the motor MOr3 relative to the motor MOp1 and supporting the cable CBL, a fixed support Sf2 fixed to the link LK2 and supporting the cable CBL, and a moving support Sm2 moving along the direction De2 in response to a change in the position of the motor MOr3 relative to the motor MOp2 and supporting the cable CBL. Of the cable CBL, a portion (cable CBLa) between the motor MOp1 and the motor MOr3 is supported by the fixed support Sf1 and the moving support Sm1. Of the cable CBL, a portion (cable CBLb) between the motor MOr3 and the motor MOp2 is supported by the fixed support part Sf2 and the movable support part Sm2.

[0164] In this manner, in this embodiment, the cable CBLa between the motors MOp1 and MOr3 is supported by the moving support Sm1 that moves along the direction De1 in response to a change in the position of the motor MOr3 relative to the motor MOp1. Also, in this embodiment, the cable CBLb between the motors MOr3 and MOp2 is supported by the moving support Sm2 that moves along the direction De2 in response to a change in the position of the motor MOr3 relative to the motor MOp2. As a result, in this embodiment, even if one or both of the position of the motor MOr3 relative to the motor MOp1 and the position of the motor MOr3 relative to the motor MOp2 change, it is possible to prevent the cable CBL from slackening. Therefore, in this embodiment, even if the posture of the robot 10 changes, it is possible to reliably supply power to the motors MO (MOr3, MOp1, and MOp2).

[0165] In addition, in this embodiment, the robot 10 further includes a joint mechanism JEr1 that rotates at least a part of the body part BDP around an axis Ax1 that forms an angle with a direction perpendicular to the bottom surface of the body part BDP less than a predetermined angle as a second rotation axis, a joint mechanism JEr2 that connects the body part BDP and the link LK1 and rotates the link LK1 around an axis Ax2 that forms an angle with a direction perpendicular to the bottom surface of the body part BDP greater than a predetermined angle as a third rotation axis, 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, a motor MOr1 that receives power via a cable CBL and drives the joint mechanism JEr1, a motor MOr2 that receives power via a cable CBL and drives the joint mechanism JEr2, and a motor MOr4 that receives power via a cable CBL and drives the joint mechanism JEr4. The cable CBL is connected to the motors MOr1, MOr2, MOP1, MOR3, MOP2, and MOR4 in the order of MOr1, MOR2, MOP1, MOR3, MOP2, and MOR4.

[0166] In this manner, in this embodiment, the multiple motors MO (MOr1, MOr2, MOp1, MOr3, MOp2, and MOr4) are connected by the cable CBL in the order of the motors MO that drive the multiple joint mechanisms JE that are arranged in sequence from the body part BDP on the path inside the robot 10 from the body part BDP toward the tip part TP1. This makes it possible to prevent the arrangement of the cable CBL from becoming complicated in this embodiment.

[0167] In this embodiment, the robot 10 further includes a motor MOr5 and a motor MOr6. 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 the 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 (for example, an end face TP1sf) 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. The motor MOr5 is supplied with power via a cable CBL to drive the joint mechanism JEr5. The motor MOr6 is supplied with power via a cable CBL to drive the joint mechanism JEr6. The cable CBL is connected to the motors MOr1, MOr2, MOp1, MOr3, MOp2, MOr4, MOr5, and MOr6 in the order of motor MOr1, motor MOr2, motor MOp1, motor MOr3, motor MOp2, motor MOr4, motor MOr5, and motor MOr6.

[0168] In this manner, in this embodiment, the multiple motors MO (MOr1, MOr2, MOp1, MOr3, MOp2, MOr4, MOr5, and MOr6) are connected by the cable CBL in the order of the motors MO that drive the multiple joint mechanisms JE that are arranged in sequence from the body part BDP on the path inside the robot 10 from the body part BDP toward the tip part TP1. This makes it possible to prevent the arrangement of the cable CBL from becoming complicated in this embodiment.

[0169] In this embodiment, the robot 10 further includes an elastic member EL1 fixed to the link LK1, supporting the moving support member Sm1, and expanding and contracting along the direction De1, and an elastic member EL2 fixed to the link LK2, supporting the moving support member Sm2, and expanding and contracting along the direction De2. The fixed support member Sf1 is a pulley fixed to the link LK1. The fixed support member Sf2 is a pulley fixed to the link LK2. The moving support member Sm1 is a pulley suspended by the elastic member EL1. The moving support member Sm2 is a pulley suspended by the elastic member EL2.

[0170] Thus, in this embodiment, the moving support member Sm1 is a pulley supported by the elastic member EL1 so as to be movable along the direction De1, and the moving support member Sm2 is a pulley supported by the elastic member EL2 so as to be movable along the direction De2. As a result, in this embodiment, when one or both of the position of the motor MOr3 relative to the motor MOp1 and the position of the motor MOr3 relative to the motor MOp2 change, the cable CBL can be smoothly slid. As a result, in this embodiment, even if the posture of the robot 10 changes, power can be reliably supplied to the motor MO.

[0171] In this embodiment, the fixed support Sf1 is fixed to the end LK1ed1 of the link LK1 that is closer to the body BDP. The moving support Sm1 is suspended by the elastic member EL1 from the end LK1ed2 of the link LK1 that is farther from the body BDP. The fixed support Sf2 is fixed to the end LK2ed1 of the link LK2 that is farther from the tip TP1. The moving support Sm2 is suspended by the elastic member EL2 from the end LK2ed1 of the link LK2 that is closer to the tip TP1.

[0172] Thus, in this embodiment, the moving support part Sm1 is disposed so that a force is applied in a direction away from the fixed support part Sf1 by the elastic force of the elastic member EL1. In this way, in this embodiment, the moving support part Sm1 can be easily moved along the direction De1 in response to a change in the position of the motor MOr3 relative to the motor MOp1. Also, in this embodiment, the moving support part Sm2 is disposed so that a force is applied in a direction away from the fixed support part Sf2 by the elastic force of the elastic member EL2. In this way, in this embodiment, the moving support part Sm2 can be easily moved along the direction De2 in response to a change in the position of the motor MOr3 relative to the motor MOp2.

[0173] In this embodiment, the robot controller 30 controls the motors MOr3, MOp1, and MOp2 to control the operation of the robot 10. In this manner, in this embodiment, the robot controller 30 can easily control the operation of the robot 10.

[0174] In this embodiment, the robot system 1 includes a robot 10, an end effector 20 attached to a tip portion TP1, and a robot controller 30 that controls the operation of the robot 10 and the end effector 20. The robot controller 30 supplies power to the motors MOr3, MOp1, and MOp2 via the cable CBL, and controls the motors MOr3, MOp1, and MOp2, thereby controlling the operation of the robot 10. In this manner, in this embodiment, the robot controller 30 can reliably supply power to the motors MO (MOr3, MOp1, and MOp2) via the cable CBL.

[0175] In the present embodiment, 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 task of assembling or removing a part can be efficiently performed.

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

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

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

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

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

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

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

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

[0184] Although not shown in FIG. 8, the motor MOr4 drives the joint mechanism JEr4A in place of the joint mechanism JEr4, and the motor MOr5 drives the joint mechanism JEr5A in place of the joint mechanism JEr5.

[0185] As described above, in this modified example, the joint mechanism JEr4A rotates the tip part TP1A with respect to the link LK2A around the axis Ax4A, which forms an angle with the direction De2 at a predetermined angle or less, as the fourth rotation axis. The tip part TP1A includes a first part TP11A connected to the link LK2A, a second part TP12A connected to the first part TP11A, a joint mechanism JEr5A that connects the first part TP11A and the second part TP12A and rotates the second part TP12A with respect to the first part TP11A around the axis Ax5, which forms an angle with the fourth rotation axis (axis Ax4A) greater than a predetermined angle, as the fifth rotation axis, and a joint mechanism JEr6 that rotates a part of the tip part TP1A to which the end effector 20 is attached (for example, the end face TP1sf) around the axis Ax6, which forms an angle with the fifth rotation axis (axis Ax5) greater than a predetermined angle, as the sixth rotation axis. The motor MOr5 is supplied with power via a cable CBL to drive the joint mechanism JEr5A. The motor MOr6 is supplied with power via a cable CBL to drive the joint mechanism JEr6. The cable CBL is connected to the motors MOr1, MOr2, MOp1, MOr3, MOp2, MOr4, MOr5, and MOr6 in the order of motor MOr1, motor MOr2, motor MOp1, motor MOr3, motor MOp2, motor MOr4, motor MOr5, and motor MOr6.

[0186] In this modified example, the same effect as in the above-described embodiment can be obtained. For example, in this modified example, the multiple motors MO (MOr1, MOr2, MOp1, MOr3, MOp2, MOr4, MOr5, and MOr6) are connected by the cable CBL in the order of the motors MO that drive the multiple joint mechanisms JE that are arranged in sequence from the body part BDP on the path in the robot 10 from the body part BDP toward the tip part TP1A. This makes it possible to prevent the arrangement of the cable CBL from becoming complicated in this embodiment.

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

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

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

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

[0191] FIG. 9 is an explanatory diagram for explaining an example of turning. In FIG. 9, the connection of two links LKi and LKj whose longitudinal directions can be grasped is taken as an example to explain the distinction between turning and other rotations. The extension direction Dei in FIG. 9 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. 9 connects the link LKi and the link LKj, and rotates the link LKj relative to the link LKi around the axis Axi as the rotation axis.

[0192] In the example shown in FIG. 9, 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. 9 indicates a rotation other than a turn. In addition, the predetermined angle is not particularly limited, but in FIG. 9, the predetermined angle is assumed to be 45°. The angle θ between the extension direction Dei and the axis Axi is an angle between 0° and 90° among a plurality of angles that are understood as the angle of the axis Axi with respect to the extension direction Dei (for example, four angles for two straight lines that intersect with each other, or 0° and 180° for two parallel straight lines).

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

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

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

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

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

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

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

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

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

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

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

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

[0205] 1...robot system, 10...robot, 20...end effector, 30...robot controller, 31...power supply device, 32...processing device, 33...memory, 34...communication device, 35...operation device, 36...display device, 37...driver circuit, ARmv1, ARmv2...movement area, Ax1, Ax2, Ax3, Ax4, Ax4A, Ax5, Ax6, Axi...axis, BDP...body part, BDPbt...bottom surface, BDPba...base part, CBL, CBLa, CBLb, CBLc... cable, EL1, EL2... elastic member, FM10, FM11, FM12, FM20, FM21, FM22... frame, JEr1, JEr2, JEr3, JEr4, JEr4A, JEr5, JEr6, JEri, JEp1, JEp2... joint mechanism, JEp11, JEp21... screw part, JEp12, JEp22... nut, JEp13, JEp23... connection part, JEp1 3a, JEp23a...slider portion, JEp13b, JEp23b...support portion, JEp14, JEp24...rail, JEp14a, JEp14b, JEp24a, JEp24b...rod-shaped member, JEr11, JEr21, JEr41, JEr51, JEr61...rotating portion, JEr12, JEr22, JEr42, JEr52, JEr62...housing, Lce, Lcm, Lcm1, Lcm2, Lcm3, Lcm4, Lcm 5, Lcm6, Lcm7, Lcm8, Lpe, Lpm... wiring, LK1, LK2, LK2A, LKi, LKj... links, MOr1, MOr2, MOr3, MOr4, MOr5, MOr6, MOp1, MOp2... motors, Sm1, Sm2... moving support part, Sm11, Sm21... disc, Sm12, Sm22... disc support part, Sf1, Sf2... fixed support part, Sf11, Sf21... disc, Sf12, Sf22... disc support part.

Claims

1. A base and A tip portion, A plurality of links including a first link and a second link connecting the base portion and the tip portion; a first drive mechanism that connects the first link and the second link and rotates the second link relative to the first link about a first rotation axis that forms an angle with a first direction in which the first link extends that is larger than a predetermined angle; a first moving mechanism that moves the first drive mechanism relative to the first link along the first direction; a second moving mechanism that moves the second link relative to the first driving mechanism along a second direction in which the second link extends; a first motor that moves together with the first drive mechanism and drives the first drive mechanism; a second motor that drives the first moving mechanism; a third motor that drives the second moving mechanism; a cable for supplying power to the first motor, the second motor, and the third motor; a first fixed support portion fixed to the first link and supporting the cable; a first moving support unit that moves along the first direction in response to a change in a position of the first motor relative to the second motor and supports the cable; a second fixed support portion fixed to the second link and supporting the cable; a second moving support unit that moves along the second direction in response to a change in a position of the first motor relative to the third motor and supports the cable; Equipped with a portion of the cable between the second motor and the first motor is supported by the first fixed support part and the first movable support part, a portion of the cable between the first motor and the third motor is supported by the second fixed support portion and the second movable support portion; A multi-joint robot characterized by

2. a second drive mechanism that rotates at least a portion of the base about a second rotation axis that forms an angle with a direction perpendicular to a bottom surface of the base that is equal to or smaller than the predetermined angle; a third drive mechanism that connects the base and the first link and rotates the first link about a third rotation axis that forms an angle with a direction perpendicular to a bottom surface of the base that is greater than the predetermined angle; a fourth drive mechanism that connects the second link and the tip portion and rotates the tip portion relative to the second link; a fourth motor that is supplied with power via the cable and drives the second drive mechanism; a fifth motor that is supplied with power via the cable and drives the third drive mechanism; a sixth motor that is supplied with power via the cable and drives the fourth drive mechanism; Further equipped with The cable includes: the fourth motor, the fifth motor, the second motor, the first motor, the third motor, and the sixth motor are connected in this order to the fourth motor, the fifth motor, the second motor, the first motor, the third motor, and the sixth motor; 2. The articulated robot according to claim 1 .

3. Further comprising a seventh motor and an eighth motor; 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, The seventh motor is Power is supplied via the cable to drive the fifth drive mechanism; The eighth motor is Power is supplied via the cable to drive the sixth drive mechanism; The cable includes: the fourth motor, the fifth motor, the second motor, the first motor, the third motor, the sixth motor, the seventh motor, and the eighth motor are connected in this order to the fourth motor, the fifth motor, the second motor, the first motor, the third motor, the sixth motor, the seventh motor, and the eighth motor; 3. The articulated robot according to claim 2.

4. Further comprising a seventh motor and an eighth motor; 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, The seventh motor is Power is supplied via the cable to drive the fifth drive mechanism; The eighth motor is Power is supplied via the cable to drive the sixth drive mechanism; The cable includes: the fourth motor, the fifth motor, the second motor, the first motor, the third motor, the sixth motor, the seventh motor, and the eighth motor are connected in this order to the fourth motor, the fifth motor, the second motor, the first motor, the third motor, the sixth motor, the seventh motor, and the eighth motor; 3. The articulated robot according to claim 2.

5. a first elastic member fixed to the first link, supporting the first movement support part, and expanding and contracting along the first direction; a second elastic member fixed to the second link, supporting the second movement support portion, and expanding and contracting along the second direction; Further equipped with The first fixed support portion is a pulley fixed to the first link; The second fixed support portion is a pulley fixed to the second link; The first moving support portion is a pulley suspended by the first elastic member; The second moving support portion is a pulley suspended by the second elastic member; 2. The articulated robot according to claim 1 .

6. The first fixed support portion is The first link is fixed to an end of the first link that is closer to the base portion, The first moving support portion is the first link is suspended from the end of the two ends farther from the base by the first elastic member; The second fixed support portion is The second link is fixed to the end of the second link that is farther from the tip end. The second moving support portion is The second link is suspended from the end of the two ends closer to the tip end by the second elastic member.

6. The articulated robot according to claim 5.

7. A method for controlling an articulated robot according to claim 1, 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. A method for controlling an articulated robot.

8. The articulated robot according to claim 1 , 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: supplying electric power to the first motor, the second motor, and the third motor via the cable, and controlling the first motor, the second motor, and the third motor to control an operation of the articulated robot; A robot system comprising:

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

Citation Information

Patent Citations

  • Composite multi-joint type robot

    JP1986136782A