Dual-arm robot system
The dual-arm robot system addresses interference issues by using coaxial arm rotation and three-dimensional modeling with a common control unit, ensuring efficient operation and compact design.
Patent Information
- Application Number
- JP2021004006
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2021-01-14
- Publication Date
- 2024-12-09
- Estimated Expiration
- 2041-01-14
AI Technical Summary
Conventional dual-arm robot systems face interference issues between the hand portion and other parts, despite the absence of interference in other components, leading to operational challenges.
A dual-arm robot system with coaxially rotating robot arms, incorporating a control unit that determines interference based on three-dimensional models of the hand, horizontal, and torso parts, using a common control unit to suppress interference and reduce system size.
The system effectively suppresses interference between the hand and other parts, allows for downsizing, reduces control complexity, and enhances operational efficiency by accurately determining potential collisions.
Smart Images

Figure 0007596159000001 
Figure 0007596159000002 
Figure 0007596159000003
Abstract
Description
[Technical field]
[0001] The present invention relates to a dual-arm robot system. [Background technology]
[0002] 2. Description of the Related Art Conventionally, a dual-arm robot system is known that determines whether or not link portions interfere with each other (see, for example, Patent Document 1).
[0003] The above-mentioned Patent Document 1 discloses a dual-arm robot system including a dual-arm robot and an interference determination unit that determines interference between the dual-arm robot. In the above-mentioned Patent Document 1, the dual-arm robot includes a pair of horizontal multi-joint arms attached to a support base. Each of the pair of horizontal multi-joint arms includes a first link unit and a second link unit. One end of the first link unit is attached to the support base. One end of the second link unit is attached to the other end of the first link unit. In addition, the pair of horizontal multi-joint arms are attached to the support base in a state separated from each other. In other words, the rotation axes (rotation axes relative to the support base) of one ends of the first link units of the pair of horizontal multi-joint arms are separated from each other.
[0004] The interference determination unit in the above Patent Document 1 determines whether or not the respective parts of the dual-arm robot interfere with each other when the dual-arm robot operates. Specifically, the interference determination unit determines whether or not the first link unit and the second link unit interfere with each other in three dimensions. [Prior art documents] [Patent documents]
[0005] [Patent Document 1] JP 2013-136109 A Summary of the Invention [Problem to be solved by the invention]
[0006] However, in a conventional dual-arm robot such as that described in Patent Document 1, a hand unit is attached to the tip of a horizontal articulated arm. Even if parts of the horizontal articulated arm other than the hand unit do not interfere with each other, there is a problem in that the hand unit may interfere with other parts.
[0007] The present invention has been made to solve the above-mentioned problems, and one object of the present invention is to provide a dual-arm robot system that is capable of suppressing interference between the hand portion and other parts. [Means for solving the problem]
[0008] In order to achieve the above object, a dual-arm robot system according to a first aspect of the present invention comprises a first robot arm section and a second robot arm section, each of which includes a horizontal link section to which a hand section is attached and which rotates along a horizontal plane; a body section that supports the first robot arm section and the second robot arm section so that the first robot arm section and the second robot arm section rotate coaxially; and a control unit that determines whether or not the interference determination target sections interfere with each other based on whether or not three-dimensional models generated using a plurality of parts of the hand section, the horizontal link section, and the body section, including at least the hand section, as interference determination target sections overlap with each other. the control unit determines whether interference determination target parts including the vertical link part interfere with each other, the vertical link part includes a plate-like member provided at the tip of each of the first robot arm part and the second robot arm part, and a hand attachment member provided on the plate-like member and to which the hand part is attached, the vertical link part raises and lowers the hand attachment member by rotating the plate-like member about a predetermined axis, and a storage unit in which three-dimensional models of the hand part, the horizontal link part, the plate-like member, the hand attachment member, and the body part are stored in advance. .
[0009] In the dual-arm robot system according to the first aspect of the present invention, as described above, the control unit determines whether or not the interference detection target parts interfere with each other based on whether or not the 3D models generated with a plurality of parts including at least the hand parts among the hand parts, horizontal link parts, and torso parts as interference detection target parts overlap with each other. This determines the interference between the interference detection target parts including at least the hand parts, so that it is possible to prevent the hand parts from interfering with other parts. As a result, it is possible to prevent the hand parts from interfering with other parts.
[0010] Also, in the dual-arm robot system according to the first aspect, as described above, the torso section supports the first robot arm section and the second robot arm section so that the first robot arm section and the second robot arm section rotate about the same axis. Here, when the first robot arm section and the second robot arm section rotate about different axes, the first robot arm section and the second robot arm section need to be disposed apart from each other. This results in an increase in size of the dual-arm robot system. On the other hand, in the dual-arm robot system according to the first aspect, the first robot arm section and the second robot arm section rotate about the same axis, so that the first robot arm section and the second robot arm section can be disposed with a small distance between them. This results in a reduction in size of the dual-arm robot system.
[0011] A dual-arm robot system according to a second aspect of the present invention includes a first robot arm section and a second robot arm section, each of which includes a horizontal link section to which a hand section is attached and which rotates along a horizontal plane; a body section that supports the first robot arm section and the second robot arm section so that the first robot arm section and the second robot arm section rotate; and a control section that determines whether or not the interference determination target sections interfere with each other based on whether or not three-dimensional models generated using a plurality of parts of the hand section, the horizontal link section, and the body section, including at least the hand section, as interference determination target sections overlap with each other, and the control section is provided in common to the first robot arm section and the second robot arm section. The robot arm further includes a vertical link section which moves the hand section in the vertical direction by rotating the plate-like member about a predetermined axis to raise and lower the hand attachment member and move the hand section in the vertical direction, and a storage section in which three-dimensional models of the hand section, the horizontal link section, the plate-like member, the hand attachment member and the body section are stored in advance, and the control section determines whether or not interference determination target sections including the vertical link section interfere with each other. .
[0012] In the dual-arm robot system according to the second aspect of the present invention, as described above, the control unit determines whether or not the parts subject to interference determination interfere with each other based on whether or not the 3D models generated with a plurality of parts, including at least the hand parts, among the hand parts, horizontal link parts, and torso part as parts subject to interference determination overlap with each other. This determines the interference between the parts subject to interference determination, including at least the hand parts, and thus makes it possible to prevent the hand parts from interfering with other parts. As a result, it is possible to prevent the hand parts from interfering with other parts.
[0013] In the dual-arm robot system according to the second aspect, as described above, the control unit is provided in common to the first robot arm unit and the second robot arm unit. This allows the configuration of the dual-arm robot system to be simplified (reduced in size) compared to a case where a control unit is provided individually for each of the first robot arm unit and the second robot arm unit. In addition, since the control unit is provided in common to the first robot arm unit and the second robot arm unit, the dual-arm robot system can be made more compact, less expensive, and easier to operate. In addition, unlike a case where interference is determined by control units provided separately for the first robot arm unit and the second robot arm unit while communicating with each other, accurate interference determination can be performed while suppressing delays in determination. In addition, by configuring the control unit to control the operations of the first robot arm unit and the second robot arm unit in addition to determining interference, delays in the operation for avoiding interference can be suppressed, unlike a case where the operations of the first robot arm unit and the second robot arm unit are controlled by separate control units. Effect of the Invention
[0014] According to the present invention, as described above, interference between the hand portion and other portions can be suppressed. [Brief description of the drawings]
[0015] [Figure 1] FIG. 1 is a side view of a dual-arm robot system according to a first embodiment. [Diagram 2] FIG. 2 is a top view of the dual-arm robot system according to the first embodiment. [Diagram 3] FIG. 2 is a diagram showing a three-dimensional model of the dual-arm robot system according to the first embodiment. [Figure 4] 3 is a diagram for explaining a target part for interference determination in the dual-arm robot system according to the first embodiment. FIG. [Diagram 5] FIG. 1 is a diagram for explaining interference determination in the dual-arm robot system according to the first embodiment. [Figure 6]FIG. 2 is a diagram for explaining interference determination in the dual-arm robot system according to the first embodiment. [Figure 7] FIG. 2 is a control flow diagram of the dual-arm robot system according to the first embodiment. [Figure 8] FIG. 11 is a side view of a dual-arm robot system according to a second embodiment. [Figure 9] FIG. 11 is a top view of a dual-arm robot system according to a second embodiment. [Figure 10] FIG. 1 shows a three-dimensional model of a dual-arm robot system according to a second embodiment. [Figure 11] FIG. 2 shows a three-dimensional model of the dual-arm robot system according to the second embodiment. [Figure 12] FIG. 3 shows a three-dimensional model of the dual-arm robot system according to the second embodiment. [Figure 13] 13 is a diagram for explaining a part subject to interference determination in the dual-arm robot system according to the second embodiment. FIG. [Figure 14] FIG. 11 is a diagram for explaining interference determination in the dual-arm robot system according to the second embodiment. [Figure 15] FIG. 11 is a diagram (2) for explaining interference determination in the dual-arm robot system according to the second embodiment. [Figure 16] FIG. 11 is a diagram (3) for explaining interference determination in the dual-arm robot system according to the second embodiment. [Figure 17] FIG. 11 is a diagram (4) for explaining interference determination in the dual-arm robot system according to the second embodiment. [Figure 18] FIG. 11 is a side view of a dual-arm robot system according to a third embodiment. [Figure 19] FIG. 11 is a side view of a dual-arm robot system according to a first modified example. [Figure 20] FIG. 11 is a side view of a dual-arm robot system according to a second modified example. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0016] DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS An embodiment of the present invention will now be described with reference to the drawings.
[0017] [First embodiment] The configuration of a dual-arm robot system 100 according to the first embodiment will be described with reference to FIGS.
[0018] The dual-arm robot system 100 includes a first robot arm unit 10. The first robot arm unit 10 includes a horizontal link unit that rotates along a horizontal plane. The horizontal link unit includes a first horizontal link unit 11 that is rotatably connected to the body unit 30, and a second horizontal link unit 12 that is rotatably connected to the first horizontal link unit 11. Specifically, one end of the first horizontal link unit 11 is attached to the upper part of the body unit 30 so as to be rotatable relative to the body unit 30. The other end of the first horizontal link unit 11 is attached to one end of the second horizontal link unit 12. The other end of the second horizontal link unit 12 is attached to a vertical link unit 13. The first horizontal link unit 11 and the second horizontal link unit 12 are examples of the "horizontal link unit" in the claims.
[0019] The first robot arm unit 10 also includes a vertical link unit 13. The vertical link unit 13 is provided on the tip side of the first robot arm unit 10. The vertical link unit 13 moves along the vertical direction. The vertical link unit 13 is an example of a "first vertical link unit" in the claims.
[0020] Further, a hand unit 14 is attached to the first robot arm unit 10. The hand unit 14 is attached to the lower end of the vertical link unit 13. The hand unit 14 is composed of, for example, a chuck that grips a workpiece.
[0021] The dual-arm robot system 100 also includes a second robot arm unit 20. The configuration of the second robot arm unit 20 is similar to that of the first robot arm unit 10. That is, the second robot arm unit 20 includes a first horizontal link unit 21, a second horizontal link unit 22, and a vertical link unit 23. A hand unit 24 is attached to the second robot arm unit 20. The first horizontal link unit 21 and the second horizontal link unit 22 are examples of the "horizontal link unit" in the claims. The vertical link unit 23 is an example of the "first vertical link unit" in the claims.
[0022] The dual-arm robot system 100 also includes a body section 30. The first robot arm section 10 and the second robot arm section 20 are supported by the body section 30 so as to rotate coaxially. Specifically, one end of the first horizontal link section 11 and one end of the first horizontal link section 21 rotate coaxially. One end of the first horizontal link section 21 is disposed above the first horizontal link section 11. One end of the first horizontal link section 21 is attached to the body section 30 via the first horizontal link section 11 so as to be rotatable relative to the body section 30.
[0023] In the dual-arm robot system 100, a first robot arm unit 10, a second robot arm unit 20, and a body unit 30 constitute a dual-arm robot 100a.
[0024] In the dual-arm robot 100a, one end of the first horizontal link unit 11 rotates around the A1 axis. The other end of the first horizontal link unit 11 (one end of the second horizontal link unit 12) rotates around the A2 axis. The hand unit 14 rotates around the A3 axis.
[0025] In the dual-arm robot 100a, one end of the first horizontal link unit 21 rotates around the A1 axis. The other end of the first horizontal link unit 21 (one end of the second horizontal link unit 22) rotates around the A4 axis. The hand unit 24 rotates around the A5 axis. The A1 to A5 axes are vertical and arranged parallel to one another.
[0026] The dual-arm robot system 100 also includes a housing 40. The body 30 is placed on the housing 40. Inside the housing 40, a control unit 50, which will be described later, is also disposed.
[0027] Also, a first cable 71 is provided that connects the control unit 50 arranged inside the housing 40 with the first robot arm unit 10 and the second robot arm unit 20 and is provided inside the housing 40 and the body unit 30. Also, a second cable 72 is provided outside the housing 40 and the body unit 30. The first cable 71 is a signal line for controlling the drive units of the first robot arm unit 10 and the second robot arm unit 20, etc. Also, the second cable 72 is a power supply cable for supplying power to the dual-arm robot system 100, an external communication cable for communication between the dual-arm robot system 100 and the outside, etc.
[0028] In this embodiment, the drive unit is realized by, for example, a servo motor. Each servo motor is provided with a position sensor such as an encoder that detects the rotation angle position of the servo motor (not shown). Here, the rotation angle position refers to the angle position of each joint in the joint coordinate system of each servo motor. The control unit 50 is configured to control the first robot arm unit 10 and the second robot arm unit 20 to any posture by controlling the position of the servo motor.
[0029] Moreover, around the first robot arm unit 10 and the second robot arm unit 20, an object 60 (obstacle) is placed.
[0030] Here, in the first embodiment, as shown in FIG. 2 and FIG. 3, the dual-arm robot system 100 includes a control unit 50. The control unit 50 determines whether or not the interference determination target parts interfere with each other based on whether or not the three-dimensional models M generated with a plurality of parts including at least the hand parts (14, 24) among the hand parts (14, 24), the horizontal link parts (11, 12, 21, 22), and the body part 30 overlap with each other as the interference determination target parts. Specifically, in the first embodiment, the control unit 50 determines the hand part 14, the first horizontal link part 11, the second horizontal link part 12, and the vertical link part 13 of the first robot arm part 10 as the interference determination target parts. The control unit 50 also determines the hand part 24, the first horizontal link part 21, the second horizontal link part 22, and the vertical link part 23 of the second robot arm part 20 as the interference determination target parts. The control unit 50 also determines the body part 30 and the housing 40 as the interference determination target parts. Moreover, the three-dimensional model M is generated (set) individually for each of the above-mentioned collision detection target parts.
[0031] In the first embodiment, the three-dimensional model M of the horizontal link sections (first horizontal link section 11, second horizontal link section 12, first horizontal link section 21, and second horizontal link section 22) is set based on the coordinate system of the torso section 30. The three-dimensional model M3 of the torso section 30 is set based on the coordinate system of the torso section 30. The three-dimensional model M4 of the housing 40 is set based on the coordinate system of the torso section 30. On the other hand, the three-dimensional model M of the hand sections (hand sections 14 and 24) is set based on the tip coordinates of the hand sections (14, 24).
[0032] For example, the three-dimensional model M1a of the first horizontal link unit 11 of the first robot arm unit 10 has, for example, a substantially elliptical shape when viewed from above so as to conform to the shape of the first horizontal link unit 11. The length in the Z direction of the three-dimensional model M1a of the first horizontal link unit 11 corresponds to the length in the Z direction of the first horizontal link unit 11. The same applies to the three-dimensional model M1b of the second horizontal link unit 12 of the first robot arm unit 10. The same applies to the three-dimensional model M2a of the first horizontal link unit 21 of the second robot arm unit 20 and the three-dimensional model M2b of the second horizontal link unit 22.
[0033] Moreover, the three-dimensional model M1c of the vertical link part 13 of the first robot arm part 10 has, for example, a substantially elliptical shape when viewed from above so as to follow the shape of the vertical link part 13. Moreover, the length in the Z direction of the three-dimensional model M1c of the vertical link part 13 has a length corresponding to the length in the Z direction of the vertical link part 13. Moreover, the same is true for the three-dimensional model M2c of the vertical link part 23 of the second robot arm part 20.
[0034] Moreover, the three-dimensional model M1d of the hand unit 14 of the first robot arm unit 10 has, for example, a substantially rectangular shape when viewed from above, so as to conform to the shape of the hand unit 14. Moreover, the length in the Z direction of the three-dimensional model M1d of the hand unit 14 corresponds to the length in the Z direction of the hand unit 14. The same is true for the three-dimensional model M2d of the hand unit 24 of the second robot arm unit 20.
[0035] Moreover, the three-dimensional model M3 of the torso 30 has, for example, a substantially circular shape when viewed from above so as to match the shape of the torso 30. Moreover, the length in the Z direction of the three-dimensional model M3 of the torso 30 corresponds to the length of the torso 30 in the Z direction.
[0036] Moreover, when viewed from above, the three-dimensional model M4 of the housing 40 has, for example, a substantially rectangular shape that conforms to the shape of the housing 40. Moreover, the length in the Z direction of the three-dimensional model M4 of the housing 40 corresponds to the length of the housing 40 in the Z direction.
[0037] Furthermore, the three-dimensional model M5 of the object 60 disposed around the first robot arm unit 10 and the second robot arm unit 20 has a shape that follows the shape of the object 60 when viewed from above. Moreover, the length in the Z direction of the three-dimensional model M5 of the object 60 corresponds to the length of the object 60 in the Z direction.
[0038] In the first embodiment, as shown in FIG. 1, the dual-arm robot system 100 includes a storage unit 51. The storage unit 51 is arranged, for example, inside the housing 40. The above-mentioned three-dimensional models M (M1a to M1d, M2a to M2d, M3, M4, and M5) are stored in advance in the storage unit 51. The shape (length, etc.) of the three-dimensional model M is fixed. The housing 40 (control unit 50) is moved together with the dual-arm robot 100a. As a result, unlike the case where the housing 40 (control unit 50) and the dual-arm robot 100a are arranged separately, the relative positions of the housing 40 (control unit 50) and the dual-arm robot 100a do not change, so that it is easy to determine whether or not there is interference with the housing 40.
[0039] In the first embodiment, the control unit 50 determines whether or not the interference determination target parts interfere with each other based on the three-dimensional model M stored in advance in the storage unit 51. Specifically, the control unit 50 determines whether or not the interference determination target parts including the hand units (14, 24) interfere with each other, other than the interference between the first horizontal link unit 11 of the first robot arm unit 10 and the first horizontal link unit 21 of the second robot arm unit 20. In the first embodiment, the control unit 50 determines whether or not the interference determination target parts including the housing 40 interfere with each other. Furthermore, the control unit 50 determines whether or not the interference determination target parts including the object 60 arranged around the first robot arm unit 10 and the second robot arm unit 20 interfere with each other.
[0040] (Subject to collision detection) Next, parts that are subject to collision detection will be described with reference to Fig. 4. In Fig. 4, parts that are subject to collision detection are represented by "o", and parts that are not subject to collision detection are represented by "x".
[0041] 4, the targets of interference determination for the first horizontal link unit 11 of the first robot arm unit 10 are the hand unit 14 of the first robot arm unit 10 itself, the second horizontal link unit 22, the vertical link unit 23 and the hand unit 24 of the second robot arm unit 20 on the opposing side, and an object 60 disposed in the vicinity. In other words, it is not determined whether the first horizontal link unit 11 of the first robot arm unit 10 and the first horizontal link unit 21 of the second robot arm unit 20 interfere with each other.
[0042] The targets of interference determination with the second horizontal link section 12 of the first robot arm section 10 are the hand section 14 of the first robot arm section 10 itself, the first horizontal link section 21, the second horizontal link section 22, the vertical link section 23 and the hand section 24 of the opposing second robot arm section 20, and objects 60 placed in the vicinity.
[0043] The targets of interference determination with respect to the vertical link section 13 of the first robot arm section 10 are the hand section 14 of the first robot arm section 10 itself, the first horizontal link section 21, the second horizontal link section 22, the vertical link section 23 and the hand section 24 of the opposing second robot arm section 20, and objects 60 placed in the vicinity.
[0044] The targets of interference determination for the hand unit 14 of the first robot arm unit 10 are the first horizontal link unit 21, the second horizontal link unit 22, the vertical link unit 23, and the hand unit 24 of the opposing second robot arm unit 20. Furthermore, in the first embodiment, in the first robot arm unit 10, it is determined whether the hand unit 14, the body unit 30, the housing 40, and the object 60 arranged in the periphery interfere with each other.
[0045] The objects of interference determination for the first horizontal link unit 21, the second horizontal link unit 22, the vertical link unit 23, and the hand unit 24 of the second robot arm unit 20 are the same as those of the first robot arm unit 10.
[0046] In the first embodiment, as shown in FIG. 1, the control unit 50 is provided in common to the first robot arm unit 10 and the second robot arm unit 20. The control unit 50 determines whether or not the three-dimensional models M generated for the first robot arm unit 10 and the second robot arm unit 20 overlap on three-dimensional coordinates. If the three-dimensional models M overlap, it is determined that the interference determination target parts interfere with each other. The control unit 50 controls the operation of the first robot arm unit 10 and the second robot arm unit 20 in addition to determining whether or not the interference determination target parts interfere with each other.
[0047] (Example of collision detection) 5 and 6, when viewed from above, hand portion 14 and hand portion 24 overlap, but are at different height positions, if a two-dimensional model is set for hand portion 14 and hand portion 24, they will overlap in two dimensions, and it will be erroneously determined that hand portion 14 and hand portion 24 interfere with each other. Therefore, by setting three-dimensional models M1d and M2d for hand portion 14 and hand portion 24, respectively, as in the first embodiment, it is possible to suppress erroneous determination.
[0048] Next, the operation of the control unit 50 will be described with reference to FIG.
[0049] In step S1, the control unit 50 determines whether or not an interference determination function provided in advance in the dual-arm robot system 100 is enabled. If the result in step S1 is yes, the process proceeds to step S2.
[0050] In step S2, the control unit 50 determines whether the first robot arm unit 10 and the second robot arm unit 20 are in cooperative operation. A cooperative operation is an operation in which one of the first robot arm unit 10 and the second robot arm unit 20 is the master and the other is the slave. In a cooperative operation, the slave follows the movement of the master. An example of a cooperative operation is an operation in which a workpiece is moved while being grasped by the hand unit 14 of the first robot arm unit 10 and the hand unit 24 of the second robot arm unit 20. If the answer is no in step S2, proceed to step S3.
[0051] In step S3, the control unit 50 calculates a command value (command value for the servo motor) for the dual-arm robot 100a several cycles ahead based on the deceleration time, which is the time it takes for the dual-arm robot 100a to decelerate and stop, which is obtained based on the current motion plan of the dual-arm robot 100a.
[0052] In step S4, the control unit 50 determines whether the parts subject to interference determination interfere with each other based on the calculated command value. That is, it calculates the position where the double-arm robot 100a moves until it decelerates and stops, and determines whether the three-dimensional models M of the parts subject to interference determination overlap with each other at the calculated position. Then, it proceeds to step S5.
[0053] If the answer is yes (the three-dimensional models M overlap) in step S5, the control unit 50 causes the double-arm robot 100a to abnormally stop in step S6.
[0054] If the answer is no in step S5, the control unit 50 calculates a command value for the servo motor of the dual-arm robot 100a (a command value for the next processing cycle) in step S7. If the answer is no in step S1 and if the answer is yes in step S2, the control unit 50 calculates a command value for the servo motor of the dual-arm robot 100a in step S7.
[0055] The operations of steps S1 to S7 described above are constantly performed while the double-arm robot 100a is in operation.
[0056] [Effects of the first embodiment] In the first embodiment, the following effects can be obtained.
[0057] In the first embodiment, as described above, the control unit 50 determines whether or not the interference determination target parts interfere with each other based on whether or not the three-dimensional models M generated with a plurality of parts including at least the hand parts (14, 24) among the hand parts (14, 24), the horizontal link parts (11, 12, 21, 22), and the torso part 30 overlap with each other as interference determination target parts. This determines the interference between the interference determination target parts including at least the hand parts (14, 24), and therefore makes it possible to prevent the hand parts (14, 24) from interfering with other parts. As a result, it is possible to prevent the hand parts (14, 24) from interfering with other parts.
[0058] In the first embodiment, as described above, the torso section 30 supports the first robot arm section 10 and the second robot arm section 20 so that the first robot arm section 10 and the second robot arm section 20 rotate about the same axis. Here, when the first robot arm section 10 and the second robot arm section 20 rotate about different axes, the first robot arm section 10 and the second robot arm section 20 need to be arranged apart from each other. This makes the dual-arm robot system 100 larger. On the other hand, in the dual-arm robot system 100 according to the first embodiment, the first robot arm section 10 and the second robot arm section 20 rotate about the same axis, so that the first robot arm section 10 and the second robot arm section 20 can be arranged with the distance between them reduced. This makes it possible to reduce the size of the dual-arm robot system 100.
[0059] In the first embodiment, as described above, the horizontal link parts (11, 12, 21, 22) of the first robot arm section 10 and the second robot arm section 20 each include a first horizontal link part (11, 21) rotatably connected to the body section 30, and a second horizontal link part (12, 22) rotatably connected to the first horizontal link part (11, 21). The control section 50 then determines whether or not the interference determination target parts including the hand parts (14, 24) interfere with each other, other than the interference between the first horizontal link part 11 of the first robot arm section 10 and the first horizontal link part 21 of the second robot arm section 20. Here, since the first horizontal link part 11 of the first robot arm section 10 and the first horizontal link part 21 of the second robot arm section 20 rotate on the same axis, the first horizontal link part 11 of the first robot arm section 10 and the first horizontal link part 21 of the second robot arm section 20 do not interfere with each other. Therefore, as described above, the control unit 50 determines whether or not interference between the interference determination target parts, including the hand parts (14, 24), other than interference between the first horizontal link part 11 of the first robot arm part 10 and the first horizontal link part 21 of the second robot arm part 20 will interfere with each other.Since no determination is made as to whether or not interference will occur between the first horizontal link part 11 of the first robot arm part 10 and the first horizontal link part 21 of the second robot arm part 20, the control burden on the control unit 50 can be reduced.
[0060] Furthermore, in the first embodiment, as described above, it is determined whether or not the hand sections (14, 24) and the body section 30 of each of the first robot arm section 10 and the second robot arm section 20 will interfere with each other. This makes it possible to easily prevent the hand sections (14, 24) and the body section 30 from interfering with each other as the hand sections (14, 24) move.
[0061] Furthermore, in the first embodiment, as described above, the control unit 50 determines whether or not the interference determination target parts interfere with each other based on the three-dimensional model M stored in advance in the storage unit 51. This makes it possible to easily perform interference determination based on the three-dimensional model M stored in advance in the storage unit 51.
[0062] In the first embodiment, as described above, the three-dimensional model M of the horizontal link unit (11, 12, 21, 22) and the torso unit 30 is set based on the coordinate system of the torso unit 30, and the three-dimensional model M of the hand unit (14, 24) is set based on the tip coordinates of the hand unit (14, 24). As a result, the shape and size of the horizontal link unit (11, 12, 21, 22) and the torso unit 30 do not change, so the three-dimensional model M of the horizontal link unit (11, 12, 21, 22) and the torso unit 30 can be easily set based on the coordinate system of the torso unit 30. Also, the shape and size of the hand unit (14, 24) may change depending on the movement of the hand unit (14, 24), so the three-dimensional model M of the hand unit (14, 24) can be appropriately set based on the tip coordinates of the hand unit (14, 24).
[0063] Furthermore, in the first embodiment, as described above, the control unit 50 determines whether or not the interference determination target parts, including the housing 40, interfere with each other. This makes it possible to prevent at least the hand units (14, 24) from interfering with the housing 40 when the body unit 30 is placed on the housing 40.
[0064] In the first embodiment, as described above, the first cable 71 is provided to connect the control unit 50, which is disposed inside the housing 40, to the first robot arm unit 10 and the second robot arm unit 20, and is provided inside the housing 40 and the body unit 30. This makes it possible to prevent the first cable 71 from interfering with surrounding objects 60, etc., unlike when the first cable 71 is provided outside the housing 40 and the body unit 30.
[0065] Furthermore, in the first embodiment, as described above, the control unit 50 determines whether or not interference determination target units, including the object 60 arranged around the first robot arm unit 10 and the second robot arm unit 20, interfere with each other. This makes it possible to prevent interference between at least the hand units (14, 24) and the object 60 arranged around the first robot arm unit 10 and the second robot arm unit 20 when an object 60 is arranged around them.
[0066] In the first embodiment, as described above, the control unit 50 is provided in common to the first robot arm unit 10 and the second robot arm unit 20. This allows the configuration of the dual-arm robot system 100 to be simplified (reduced in size) compared to a case where the first robot arm unit 10 and the second robot arm unit 20 are each provided with a separate control unit 50. In addition, since the control unit 50 is provided in common to the first robot arm unit 10 and the second robot arm unit 20, the dual-arm robot system 100 can be made more compact, less expensive, and easier to operate. In addition, unlike a case where the control units 50 provided separately to the first robot arm unit 10 and the second robot arm unit 20 perform interference determination while communicating with each other, accurate interference determination can be performed while suppressing delays in determination.
[0067] Furthermore, in the first embodiment, as described above, the control unit 50 determines whether or not the interference determination target units interfere with each other, and also controls the operations of the first robot arm unit 10 and the second robot arm unit 20. This makes it possible to suppress delays in operations to avoid interference, unlike when the operations of the first robot arm unit 10 and the second robot arm unit 20 are controlled by separate control units 50.
[0068] [Second embodiment] The configuration of a dual-arm robot system 200 according to the second embodiment will be described with reference to FIGS.
[0069] In the second embodiment, in the dual-arm robot system 200, the first robot arm unit 10 is provided with a vertical link unit 113. The vertical link unit 113 includes plate-like members 113a and 113b provided at the tip of the first robot arm unit 10. The plate-like members 113a and 113b are provided with a hand attachment member 113c to which the hand unit 14 is attached. The vertical link unit 113 rotates the plate-like members 113a and 113b around a predetermined axis to raise and lower the hand attachment member 113c, thereby moving the hand unit 14 in the vertical direction. Specifically, the plate-like member 113a rotates around the axis A11 relative to the second horizontal link unit 12. The plate-like member 113b rotates around the axis A12 relative to the plate-like member 113a. The plate-like members 113a and 113b have a substantially elliptical shape.
[0070] Further, the second robot arm unit 20 is provided with a vertical link unit 123. The configuration of the vertical link unit 123 is similar to the configuration of the vertical link unit 113. That is, the vertical link unit 123 includes a plate-like member 123a, a plate-like member 123b, and a hand attachment member 123c.
[0071] In the dual-arm robot 200a, one end of the first horizontal link unit 11 rotates around the A1 axis. The other end of the first horizontal link unit 11 (one end of the second horizontal link unit 12) rotates around the A2 axis. One end of the plate-shaped member 113a rotates around the A11 axis. The other end of the plate-shaped member 113a (one end of the plate-shaped member 113b) rotates around the A12 axis. The other end of the plate-shaped member 113b (hand attachment member 113c) rotates around the A13 axis. The hand unit 14 rotates around the A3 axis. The A11 axis, the A12 axis, and the A13 axis are axes along the horizontal direction and are arranged parallel to one another.
[0072] Moreover, in the dual-arm robot 200a, one end of the first horizontal link unit 21 rotates around the A1 axis. The other end of the first horizontal link unit 21 (one end of the second horizontal link unit 22) rotates around the A4 axis. One end of the plate-shaped member 123a rotates around the A21 axis. The other end of the plate-shaped member 123a (one end of the plate-shaped member 123b) rotates around the A22 axis. The other end of the plate-shaped member 123b (hand attachment member 123c) rotates around the A23 axis. The hand unit 24 rotates around the A5 axis. The A21 axis, the A22 axis, and the A23 axis are axes along the horizontal direction and are arranged parallel to one another.
[0073] The storage unit 151 also stores in advance three-dimensional models M of the hand unit 14, the hand unit 24, the first horizontal link unit 11, the second horizontal link unit 12, the first horizontal link unit 21, the second horizontal link unit 22, and the body unit 30. The storage unit 151 also stores in advance a three-dimensional model M of the housing 40. The storage unit 151 also stores in advance three-dimensional models M of the vertical link unit 113 (plate-shaped member 113a, plate-shaped member 113b, hand attachment member 113c) and the vertical link unit 123 (plate-shaped member 123a, plate-shaped member 123b, hand attachment member 123c).
[0074] In the second embodiment, as shown in Figs. 9 to 12, the three-dimensional model M of the vertical link section 113 is set based on a radius r1 (r2) about a predetermined axis A11 (A12) around which the plate-shaped member 113a (113b) rotates, a length L1 (L2) of the plate-shaped member 113a (113b), and a thickness t1 (t2) of the plate-shaped member 113a (113b). Specifically, for the plate-shaped member 113a, a shape on a circular arc of the plate-shaped member 113a having a substantially elliptical shape is defined based on a radius r1 about the axis A11. Then, a three-dimensional model M10a of the plate-shaped member 113a is generated based on the radius r1, the length L1, and the thickness t1. Similarly, a three-dimensional model M10b of the plate-shaped member 113b is generated based on the radius r2, the length L2, and the thickness t2. Moreover, the three-dimensional model M10c of the hand attachment member 123c has, for example, a substantially elliptical shape (see FIG. 9) when viewed from above so as to match the shape of the hand attachment member 123c. Moreover, the length in the Z direction of the three-dimensional model M10c of the hand attachment member 113c corresponds to the length in the Z direction of the hand attachment member 113c.
[0075] The three-dimensional model M11a of the plate-like member 123a of the vertical link section 123 of the second robot arm section 20, the three-dimensional model M11b of the plate-like member 123b, and the three-dimensional model M11c of the hand attachment member 123c are set in the same manner.
[0076] In the second embodiment, as shown in FIG. 9, a cover portion 161b is provided to cover a drive portion 161a that rotates the plate-like members 113a and 113b of the first robot arm portion 10. The cover portion 161b is attached to the vertical link portion 113. The three-dimensional model M12a of the cover portion 161b is set separately from the three-dimensional model M of the vertical link portion 113. The three-dimensional model M12a of the cover portion 161b has vertical and horizontal lengths set based on the rotation axis (A2) of the second horizontal link portion 12. The three-dimensional model M12a of the cover portion 161b has, for example, a substantially rectangular shape, as viewed from above, so as to follow the shape of the cover portion 161b. The length in the Z direction of the three-dimensional model M12a of the cover portion 161b corresponds to the length in the Z direction of the cover portion 161b.
[0077] The three-dimensional model M12b of the cover part 162b that covers the drive part 162a that rotates the plate-like members 123a and 123b of the second robot arm part 20 is also set in the same manner.
[0078] (Subject to collision detection) 13, the targets of interference determination by the control unit 150 (see FIG. 8) with respect to the first horizontal link unit 11 of the first robot arm unit 10 are the hand unit 14 of its own first robot arm unit 10, the second horizontal link unit 22, hand attachment member 123c, hand unit 24, cover unit 162b, plate-shaped member 123a, plate-shaped member 123b, and surrounding object 60, all of which are of the opposing second robot arm unit 20. In FIG. 13, plate-shaped member 123a is referred to as plate-shaped member A, and plate-shaped member 123b is referred to as plate-shaped member B.
[0079] The targets of interference determination with the second horizontal link section 12 of the first robot arm section 10 are the hand section 14 of the first robot arm section 10 itself, the first horizontal link section 21, the second horizontal link section 22, the hand mounting member 123c, the hand section 24, the cover section 162b, the plate-shaped member 123a, the plate-shaped member 123b, and objects 60 placed in the vicinity, of the opposing second robot arm section 20.
[0080] The targets of interference determination with respect to the hand mounting member 113c of the first robot arm section 10 are the hand section 14 of the first robot arm section 10 itself, the first horizontal link section 21, the second horizontal link section 22, the hand mounting member 123c, the hand section 24, the cover section 162b, the plate-shaped member 123a, the plate-shaped member 123b, and the objects 60 placed in the vicinity, of the opposing second robot arm section 20.
[0081] The targets of interference determination with respect to the cover portion 161b of the first robot arm portion 10 are the hand portion 14 of the first robot arm portion 10 itself, the first horizontal link portion 21, the second horizontal link portion 22, the hand mounting member 123c, the hand portion 24, the cover portion 162b, the plate-shaped members 123a and 123b of the opposing second robot arm portion 20, and objects 60 placed in the vicinity.
[0082] The objects of interference determination with respect to the plate member 113a of the first robot arm unit 10 are the hand unit 14 of the first robot arm unit 10 itself, the first horizontal link unit 21, the second horizontal link unit 22, the hand attachment member 123c, the hand unit 24, the cover unit 162b, the plate member 123a, the plate member 123b, and the surrounding object 60 of the second robot arm unit 20 of the opponent. Note that in Fig. 13, the plate member 113a is referred to as plate member A.
[0083] The objects for interference determination with respect to the plate member 113b of the first robot arm unit 10 are the hand unit 14 of the first robot arm unit 10 itself, the first horizontal link unit 21, the second horizontal link unit 22, the hand attachment member 123c, the hand unit 24, the cover unit 162b, the plate member 123a, the plate member 123b, and the surrounding object 60 of the second robot arm unit 20 of the opponent. Note that in FIG. 13, the plate member 113b is referred to as the plate member B.
[0084] The objects to be judged for interference with the hand portion 14 of the first robot arm portion 10 are the first horizontal link portion 21, the second horizontal link portion 22, the hand mounting member 123c, the hand portion 24, the cover portion 162b, the plate-shaped member 123a, the plate-shaped member 123b, the body portion 30, the housing 40, and objects 60 placed around it, all of the opposing second robot arm portion 20.
[0085] The targets of interference determination for the first horizontal link portion 21, the second horizontal link portion 22, the hand mounting member 123c, the cover portion 162b, the plate-shaped member 123a, the plate-shaped member 123b, and the hand portion 24 of the second robot arm portion 20 are the same as those of the first robot arm portion 10.
[0086] (Example of collision detection) As shown in FIG. 14, whether or not the hand portion 14 interferes with the vertical link portion 113 (plate-shaped member 113a, plate-shaped member 113b, hand mounting member 113c) is determined, so that interference between the hand portion 14 and the vertical link portion 113 can be suppressed.
[0087] In addition, as shown in FIG. 15, by appropriately setting the size of the three-dimensional model M12a of the cover portion 161b, it is possible to prevent the erroneous determination that the cover portion 161b and the first horizontal link portion 21 interfere with each other.
[0088] In addition, as shown in FIG. 16, whether or not the plate-like member 113a of the first robot arm section 10 and the first horizontal link section 21 of the second robot arm section 20 interfere with each other is determined, so that interference between the plate-like member 113a of the first robot arm section 10 and the first horizontal link section 21 of the second robot arm section 20 can be suppressed.
[0089] Furthermore, as shown in FIG. 17, by setting a three-dimensional model M3 of the body portion 30, interference between the body portion 30 and the hand portions 14 and 24 can be suppressed.
[0090] [Effects of the second embodiment] In the second embodiment, the following effects can be obtained.
[0091] In the second embodiment, as described above, the control unit 150 determines whether or not the interference determination target parts including the vertical link parts (113, 123) interfere with each other. This makes it possible to easily determine whether or not there is interference based on the three-dimensional model M stored in advance in the storage unit 151.
[0092] In the second embodiment, as described above, the plate-like members (113a, 113b, 123a, 123b) have a substantially elliptical shape, and the three-dimensional model M of the vertical link section (113, 123) is set based on the radius (r1, r2) centered on a predetermined axis (A11, A12, A22, A23), the length (L1, L2) of the plate-like member, and the thickness (t1, t2) of the plate-like member. This allows the three-dimensional model M of the plate-like member to be appropriately set based on the radius (the arc-shaped shape of the substantially elliptical plate-like member) centered on the predetermined axis, the length of the plate-like member, and the thickness of the plate-like member.
[0093] In the second embodiment, as described above, the control unit 50 determines whether or not the parts subject to interference determination including the cover parts (161b, 162b) interfere with each other. This makes it possible to appropriately determine whether the parts subject to interference determination interfere with each other even when the cover parts (161b, 162b) that cover the drive parts (161a, 162a) are provided.
[0094] In the second embodiment, as described above, the cover parts (161b, 162b) are attached to the vertical link parts (113, 123), the three-dimensional model M of the cover parts (161b, 162b) is set separately from the three-dimensional model M of the vertical link parts (113, 123), and the vertical and horizontal lengths are set based on the rotation axes (A2, A4) of the horizontal link parts (12, 22). This makes it possible to appropriately determine whether the cover parts (161b, 162b) interfere with other parts, unlike the case where the cover parts (161b, 162b) and the vertical link parts (113, 123) to which the cover parts (161b, 162b) are attached are represented by a single relatively large three-dimensional model M.
[0095] [Third embodiment] The configuration of a dual-arm robot system 300 according to the third embodiment will be described with reference to FIG.
[0096] The dual-arm robot system 300 includes a first dual-arm robot 300a and a second dual-arm robot 300b, each of which includes a first robot arm unit 10 and a second robot arm unit 20. The configurations of the first dual-arm robot 300a and the second dual-arm robot 300b are similar to the dual-arm robot 100a of the first embodiment (or the dual-arm robot 200a of the second embodiment).
[0097] Also provided are a control unit 250a for controlling the first dual-arm robot 300a and a control unit 250b for controlling the second dual-arm robot 300b. Various information (a three-dimensional model of the hand unit, a command value for the next processing cycle, a command value for several cycles ahead, etc.) is communicated (via Ethernet, etc.) between the control units 250a and 250b to perform control for avoiding interference. Note that the control units 250a and 250b may be configured as a single control unit.
[0098] Then, the control unit 250a determines whether or not the parts subject to interference determination in the first double-arm robot 300a will interfere with each other (for example, see FIG. 4 of the first embodiment). Also, the control unit 250b determines whether or not the parts subject to interference determination in the second double-arm robot 300b will interfere with each other (for example, see FIG. 4 of the first embodiment). Furthermore, the control units 250a and 250b determine whether or not the parts subject to interference determination in the first double-arm robot 300a and the parts subject to interference determination in the second double-arm robot 300b will interfere with each other.
[0099] [Effects of the third embodiment] In the third embodiment, the following effects can be obtained.
[0100] In the third embodiment, as described above, the control unit 250a determines whether or not the parts subject to interference determination in the first double-arm robot 300a interfere with each other, the control unit 250b determines whether or not the parts subject to interference determination in the second double-arm robot 300b interfere with each other, and the control units 250a and 250b determine whether or not the parts subject to interference determination in the first double-arm robot 300a and the parts subject to interference determination in the second double-arm robot 300b interfere with each other. This makes it possible to suppress not only interference within the first double-arm robot 300a itself (the second double-arm robot 300b itself) but also interference with other double-arm robots, even when two double-arm robots, the first double-arm robot 300a and the second double-arm robot 300b, are provided.
[0101] [Variations] The embodiments disclosed herein should be considered to be illustrative and not restrictive in all respects. The scope of the present invention is indicated by the claims, not by the description of the embodiments above, and further includes all modifications (variations) within the meaning and scope of the claims.
[0102] For example, in the above first to third embodiments, an example was shown in which the hand portion (14, 24), horizontal link portion (11, 12, 21, 22), vertical link portion (13, 23), (or vertical link portion (113, 123)), body portion 30, housing 40, surrounding object 60, and cover portion (161b, 162b) (only in the second embodiment) are all applied as parts subject to interference determination, but the present invention is not limited to this. For example, in the present invention, all of the above do not have to be parts subject to interference determination.
[0103] In the above first to third embodiments, an example has been shown in which one end of the first horizontal link portion 11 of the first robot arm portion 10 and one end of the first horizontal link portion 21 of the second robot arm portion 20 rotate on the same axis, but the present invention is not limited to this. For example, one end of the first horizontal link portion 11 of the first robot arm portion 10 and one end of the first horizontal link portion 21 of the second robot arm portion 20 may rotate on different axes. In this case, interference between the first horizontal link portion 11 of the first robot arm portion 10 and the first horizontal link portion 21 of the second robot arm portion 20 is also determined.
[0104] In the above first to third embodiments, the first robot arm unit 10 and the second robot arm unit 20 are provided with the vertical link unit (13, 23) or the vertical link unit (113, 123), but the present invention is not limited to this. For example, the first robot arm unit 10 and the second robot arm unit 20 do not have to be provided with a vertical link unit.
[0105] In the above first to third embodiments, an example has been shown in which the control unit 50 (control unit 150, control unit 250) is provided in common to the first robot arm unit 10 and the second robot arm unit 20, but the present invention is not limited to this. For example, the control unit 50 (control unit 150, control unit 250) may be provided individually to the first robot arm unit 10 and the second robot arm unit 20.
[0106] In the above first to third embodiments, the body 30 and the housing 40 are provided separately, but the present invention is not limited to this. For example, as shown in Fig. 19, the body and the housing may be integrally configured (body 330) (i.e., the control unit 50 may be provided in the body 330).
[0107] In the above first to third embodiments, an example has been shown in which the control unit 50 controls the operations of the first robot arm unit 10 and the second robot arm unit 20 in addition to determining whether or not there is interference, but the present invention is not limited to this. For example, as shown in Fig. 20, a control unit 350 that determines whether or not there is interference and an operation control unit 351 that controls the operations of the first robot arm unit 10 and the second robot arm unit 20 may be provided separately. [Explanation of symbols]
[0108] 10 First Robot Arm Section 11, 21 First horizontal link part (horizontal link part) 12, 22 Second horizontal link part (horizontal link part) 13, 23 Vertical link part (first vertical link part) 14, 24 Hand section 20 Second Robot Arm Section 30,330 Body 40 Case 50, 150, 250, 250a, 250b, 350 Control unit 51, 151 Storage section 60 Object 71 First Cable 72 Second Cable 100, 200, 300 Dual-arm robot system 113, 123 Vertical link part (second vertical link part) 113a, 123a Plate-shaped member 113b, 123b Plate-shaped member 113c, 123c Hand attachment parts 161a, 162a Drive unit 161b, 162b Cover part 300a 1st Dual Arm Robot 300b 2nd Dual Arm Robot 351 Operation control section L1, L2 length M, M1a, M1b, M1c, M1d, M2a, M2b, M2c, M2d, M3, M4, M5, M10a, M10b, M10c, M11a, M11b, M11c, M12a, M12b 3D models r1, r2 radius t1, t2 thickness
Claims
1. a first robot arm unit and a second robot arm unit each including a horizontal link unit to which a hand unit is attached and which rotates along a horizontal plane; a body portion supporting the first robot arm portion and the second robot arm portion such that the first robot arm portion and the second robot arm portion rotate coaxially; a control unit that determines whether or not the interference detection target parts interfere with each other based on whether or not three-dimensional models generated using a plurality of parts of the hand unit, the horizontal link unit, and the body unit, including at least the hand unit, as interference detection target parts, overlap with each other, a vertical link unit including: a plate-like member provided at a tip of each of the first robot arm unit and the second robot arm unit; and a hand attachment member provided on the plate-like member and to which the hand unit is attached, the vertical link unit rotating the plate-like member about a predetermined axis to raise and lower the hand attachment member and move the hand unit in a vertical direction; a storage unit in which the three-dimensional models of the hand unit, the horizontal link unit, the plate-like member, the hand attachment member, and the body unit are stored in advance, The control unit determines whether the interference determination target parts, including the vertical link part, interfere with each other.
2. the horizontal link portion of the first robot arm portion and the horizontal link portion of the second robot arm portion each include a first horizontal link portion rotatably connected to the body portion and a second horizontal link portion rotatably connected to the first horizontal link portion; 2. The dual-arm robot system according to claim 1, wherein the control unit determines whether or not the interference determination target parts including the hand part interfere with each other, other than interference between the first horizontal link part of the first robot arm part and the first horizontal link part of the second robot arm part.
3. The dual-arm robot system according to claim 1 , wherein in each of the first robot arm unit and the second robot arm unit, it is determined whether or not the hand unit and the body unit interfere with each other.
4. The plate-like member has a generally oval shape, The dual-arm robot system according to any one of claims 1 to 3, wherein the three-dimensional model of the vertical link section is set based on a radius centered on the specified axis, a length of the plate-like member, and a thickness of the plate-like member.
5. A cover portion for covering a drive portion that rotates the plate-like member is further provided. The dual-arm robot system according to claim 1 , wherein the control unit determines whether or not the interference determination target parts including the cover part interfere with each other.
6. The cover portion is attached to the vertical link portion, 6. The dual-arm robot system of claim 5, wherein the three-dimensional model of the cover portion is set separately from the three-dimensional model of the vertical link portion, and vertical and horizontal lengths are set based on the rotation axis of the horizontal link portion.
7. the three-dimensional models of the horizontal link section and the trunk section are set based on a coordinate system of the trunk section; 7. The dual-arm robot system according to claim 1, wherein the three-dimensional model of the hand unit is set based on coordinates of a tip end of the hand unit.
8. The device further includes a housing on which the body portion is placed and in which the control portion is disposed, The dual-arm robot system according to claim 1 , wherein the control unit determines whether or not the interference determination target parts including the housings interfere with each other.
9. a first cable that connects the control unit disposed inside the housing to the first robot arm unit and the second robot arm unit and is provided inside the housing and the body unit; The dual-arm robot system according to claim 8 , further comprising: a second cable provided outside the housing and the torso.
10. The dual-arm robot system according to any one of claims 1 to 9, wherein the control unit determines whether or not the interference determination target parts, which include objects arranged around the first robot arm part and the second robot arm part, interfere with each other.
11. The dual-arm robot system according to any one of claims 1 to 10, wherein the control unit is provided in common to the first robot arm unit and the second robot arm unit.
12. The dual-arm robot system according to any one of claims 1 to 11, wherein the control unit controls the operation of the first robot arm unit and the second robot arm unit in addition to determining whether the parts subject to interference determination will interfere with each other, or further includes an operation control unit that controls the operation of the first robot arm unit and the second robot arm unit separately from the control unit for determining whether the parts subject to interference determination will interfere with each other.
13. a first dual-arm robot and a second dual-arm robot including the first robot arm unit and the second robot arm unit, respectively; The control unit is determining whether or not the interference determination target portions in the first dual-arm robot interfere with each other; determining whether or not the interference determination target portions in the second dual-arm robot interfere with each other; The dual-arm robot system according to any one of claims 1 to 12, further comprising a controller that determines whether the interference determination target portion of the first dual-arm robot and the interference determination target portion of the second dual-arm robot interfere with each other.
14. a first robot arm unit and a second robot arm unit each including a horizontal link unit to which a hand unit is attached and which rotates along a horizontal plane; a body portion supporting the first robot arm portion and the second robot arm portion such that the first robot arm portion and the second robot arm portion rotate; a control unit that determines whether or not the interference detection target parts interfere with each other based on whether or not three-dimensional models generated using a plurality of parts of the hand unit, the horizontal link unit, and the body unit, including at least the hand unit, as interference detection target parts, overlap with each other, the control unit is provided in common to the first robot arm unit and the second robot arm unit, a vertical link unit including: a plate-like member provided at a tip of each of the first robot arm unit and the second robot arm unit; and a hand attachment member provided on the plate-like member and to which the hand unit is attached, the vertical link unit rotating the plate-like member about a predetermined axis to raise and lower the hand attachment member and move the hand unit in a vertical direction; a storage unit in which the three-dimensional models of the hand unit, the horizontal link unit, the plate-like member, the hand attachment member, and the body unit are stored in advance, The control unit determines whether the interference determination target parts, including the vertical link part, interfere with each other.
Citation Information
Patent Citations
Method for checking interference of robot arm in real time
JP2001315087A
Interference determination device and interference determination method
JP2013136109A
Robot control system
JP2020001103A
