Robot system and control method

By combining the first and second cable holding methods of the robot system with the contact detection of the force detection unit, the problem of time-consuming and inaccurate connector holding in the prior art is solved, and fast and accurate connector holding is achieved.

CN111618844BActive Publication Date: 2024-11-19SEIKO EPSON CORP
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202010125274.9
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Priority Date
2019-02-28
Filing Date
2020-02-27
Publication Date
2024-11-19
Estimated Expiration
2040-02-27

AI Technical Summary

Technical Problem

In existing technologies, when photographing the connector and holding it based on the photographed results, it is time-consuming and difficult to hold the connector accurately, resulting in errors.

Method used

A robotic system is used to perform the first and second gripping of the cable through the robotic arm, and the force detection unit detects the contact and adjusts the movement based on the detection results to accurately hold the connector.

Benefits of technology

It enables fast and accurate connector handling, simplifies the processing flow, avoids complex image processing steps, and improves operational stability and accuracy.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN111618844B_ABST
    Figure CN111618844B_ABST
Patent Text Reader

Abstract

The present invention provides a robot system and a control method that can easily and accurately hold a connector. The robot system is characterized in that it comprises: a robot having an arm; a control unit that controls the operation of the robot; a gripping unit connected to the arm and gripping a cable having a connector at one end; and a detection unit that detects contact between the gripping unit and the connector, wherein the control unit performs the following processing: causing the gripping unit to perform a first grip of the cable in a manner that restricts movement of the cable in a thickness direction of the cable; causing the gripping unit to move toward the connector while performing the first grip; stopping the movement of the gripping unit based on the detection result of the detection unit; and causing the gripping unit to perform a second grip of the connector.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to a robot system and a control method. Background Art

[0002] For example, Patent Document 1 discloses a robot system including a multi-joint robot and a controller for controlling the multi-joint robot. The multi-joint robot described in Patent Document 1 is equipped with an end effector for holding a connector mounted on one end of a cable. In Patent Document 1, when the end effector holds the connector, an image of the connector is captured in advance by a camera, and the end effector is moved based on the captured image to hold the connector.

[0003] Patent Document 1: Japanese Patent Application Publication No. 2014-231110 Summary of the invention

[0004] However, in the above method, it takes time to capture images and identify the connector based on the captured images. In addition, depending on the image capturing accuracy and image quality of the image capturing unit, the end effector may not be able to accurately grasp the connector.

[0005] The present invention is made to solve at least a part of the above-mentioned technical problems, and can be achieved as follows.

[0006] The robot system of this application example is characterized by comprising:

[0007] A robot having an arm;

[0008] A control unit, for controlling the operation of the robot;

[0009] a holding portion connected to the arm portion, holding a cable having a connector at one end; and

[0010] a detection unit for detecting contact between the holding unit and the connector,

[0011] The control unit performs a first grip of the cable so as to restrict movement of the cable in a thickness direction of the cable with respect to the grip unit.

[0012] The control unit moves the gripping unit toward the connector in the first gripping state.

[0013] The control unit stops the movement of the gripping unit based on the detection result of the detection unit,

[0014] The control unit performs a second gripping operation in which the gripping unit grips the connector.

[0015] The control method of this application example is characterized in that:

[0016] is the control method of the robot system,

[0017] The robot system comprises: a robot having an arm;

[0018] a holding portion connected to the arm portion, holding a cable having a connector at one end; and

[0019] a detection unit for detecting contact between the holding unit and the connector,

[0020] The control method has:

[0021] In the holding portion, a first holding step of holding the cable in a manner that restricts movement of the cable in a thickness direction of the cable;

[0022] In the state where the first grip is performed, a step of moving the gripping portion toward the connector;

[0023] Based on the detection result of the detection unit, the step of stopping the movement of the holding unit; and

[0024] A second holding step of holding the connector by the holding portion is performed. BRIEF DESCRIPTION OF THE DRAWINGS

[0025] Figure 1 It is a diagram showing a robot system according to the first embodiment.

[0026] Figure 2 yes Figure 1 A schematic diagram of the robot shown.

[0027] Figure 3 is a block diagram representing a robot system.

[0028] Figure 4 This is a flowchart showing a method for controlling a robot using a control device.

[0029] Figure 5 yes Figure 4 Detailed flowchart of the posture adjustment steps shown.

[0030] Figure 6 It means assembled on Figure 1 FIG. 4 is a top view of a hand (first gripping portion) of a robot (first robot) shown.

[0031] Figure 7 It means assembled on Figure 1 FIG. 4 is a top view of a hand (first gripping portion) of a robot (first robot) shown.

[0032] Figure 8 It means assembled on Figure 1A side view of a hand (first gripping portion) of a robot (first robot) is shown.

[0033] Fig. 9 It means assembled on Figure 1 A side view of a hand (first gripping portion) of a robot (first robot) is shown.

[0034] Fig.10 It means assembled on Figure 1 A perspective view of the hand (second gripping portion) of the robot (second robot) shown.

[0035] Fig.11 It means assembled on Figure 1 A perspective view of the hand (second gripping portion) of the robot (second robot) shown.

[0036] Fig.12 It is used to illustrate Figure 1 A side view of the working state of the robot system is shown.

[0037] Fig.13 It is used to illustrate Figure 1 The top view of the working state of the robot system is shown.

[0038] Fig.14 It is used to illustrate Figure 1 A side view of the working state of the robot system is shown.

[0039] Fig.15 It is used to illustrate Figure 1 The top view of the working state of the robot system is shown.

[0040] Fig.16 It is a state explanation diagram showing the posture adjustment steps.

[0041] Fig.17 It is a state explanation diagram showing the posture adjustment steps.

[0042] Fig.18 This is a state explanation diagram showing the posture adjustment steps.

[0043] Fig.19 It is a state explanation diagram showing the posture adjustment steps.

[0044] Fig. 20 It is a state explanation diagram showing the posture adjustment steps.

[0045] Fig.21 This is a state explanation diagram showing the posture adjustment steps.

[0046] Fig. 22 It is used to illustrate Figure 1 A side view of the working state of the robot system is shown.

[0047] Fig.23 It is used to illustrate Figure 1 The top view of the working state of the robot system is shown.

[0048] Fig.24 It is used to illustrate Figure 1 A side view of the working state of the robot system is shown.

[0049] Fig.25 It is used to illustrate Figure 1 The top view of the working state of the robot system is shown.

[0050] Fig.26 It is used to illustrate Figure 1 A side view of the working state of the robot system is shown.

[0051] Fig. 27 It is used to illustrate Figure 1 The top view of the working state of the robot system is shown.

[0052] Fig.28 It is a diagram showing a gripping portion of a robot included in the robot system according to the second embodiment.

[0053] Fig.29 This is a block diagram used to explain the robot system with a hardware focus.

[0054] Fig.30 This is a block diagram showing Modification 1 focusing on the hardware of the robot system.

[0055] Fig.31 This is a block diagram showing a second modification centered on the hardware of the robot system.

[0056] Description of Reference Numerals

[0057] 100…Robot system; 100A…Robot system; 100B…Robot system; 100C…Robot system; 1A…Robot; 1B…Robot; 10…Robot arm; 110…Base; 120…Force detection unit; 130…Drive unit; 140…Position sensor; 11…Arm; 12…Arm; 13…Arm; 14…Arm; 15…Arm; 16…Arm; 17…Hand; 171…Gripping piece; 172…Posture adjustment unit; 173…Incision; 174…Divided space; 175…Restriction Surface; 176…guide piece; 18…hand; 181…clamping piece; 19…shooting unit; 191…light source; 5…control device; 51…control unit; 52…storage unit; 53…external input / output unit; 61…controller; 62…computer; 63…computer; 64…cloud; 65…network; 66…computer; 91…substrate; 911…insertion hole; 912…fixing unit; 913…fixing unit; 92…cable; 93…connector; 401…display device; 402…input device; O6…axis. DETAILED DESCRIPTION

[0058] Hereinafter, the robot system and control method of the present invention will be described in detail based on the preferred embodiments shown in the accompanying drawings.

[0059] In addition, Figure 1 In the figure, three mutually orthogonal axes (X-axis, Y-axis and Z-axis) are shown. In addition, the direction parallel to the X-axis will be referred to as the "X-axis direction", the direction parallel to the Y-axis will be referred to as the "Y-axis direction", and the direction parallel to the Z-axis will be referred to as the "Z-axis direction". In addition, the top side of each arrow shown in the figure will be referred to as "+(positive)", and the base side will be referred to as "-(negative)". In addition, the Z-axis direction is consistent with the "vertical direction", and the direction parallel to the XY plane is consistent with the "horizontal direction". In addition, the +(positive) side of the Z-axis is referred to as the "upper side", and the -(negative) side of the Z-axis is referred to as the "lower side". In addition, in Figure 2 In the figure, the force detection unit 120 is omitted.

[0060] First embodiment

[0061] For robotic systems

[0062] Figure 1 as well as Figure 2 The robot system 100 shown is used, for example, to insert a connector 93 into an insertion hole 911 formed in a substrate 91 , and includes a robot 1A as a first robot, a robot 1B as a second robot, and a control device 5 for controlling the driving of the robot 1A and the robot 1B.

[0063] In addition, if Figure 3As shown, in the robot system 100, in addition to the above, a display device 401 having a monitor and an input device 402 as an operating device constituted by, for example, a mouse, a keyboard, etc. are connected to each other so as to be able to communicate.

[0064] like Figure 1 As shown, the substrate 91 is rectangular and is placed on a workbench not shown in the figure. In addition, a flexible cable 92 is provided on the upper surface of the substrate 91, that is, the surface on the +Z axis side. A connector 93 is mounted on one end of the cable 92, and the other end becomes a fixed end fixed to the substrate 91. The fixed portion is biased toward the corner side of the -X axis side and the -Y axis side. On the other hand, one end of the cable 92, that is, the end on the connector 93 side, becomes a free end. The cable 92 is, for example, a long and flexible FPC (Flexible Printed Circuits: flexible printed circuit substrate) or FFC (Flexible Flat Cable: flexible flat cable).

[0065] The connector 93 is a polyhedron, and a hexahedron is shown as an example. The connector 93 is inserted into the insertion hole 911 provided on the side surface of the +Y axis side of the substrate 91 by the robot 1A. Then, in this inserted state, the cable 92 and the circuit (not shown) of the substrate 91 are electrically connected through the terminal (not shown) in the insertion hole 911. In addition, the position where the insertion hole 911 is formed is not limited to the above content, and for example, it can also be the side surface of the +Z axis side of the substrate 91.

[0066] For Robot 1A and Robot 1B

[0067] First, the robot 1A and the robot 1B will be described. Since the robot 1A and the robot 1B have substantially the same structure except for the installation position and the structure of the tip portion, the robot 1A will be used to representatively describe these common points, and the differences will be described later.

[0068] like Figure 1 as well as Figure 2 As shown, the robot 1A and the robot 1B are so-called 6-axis vertical multi-joint robots, and have a base 110 and a robot arm 10 connected to the base 110. In addition, the robot 1A and the robot 1B are single-arm multi-joint robots, but are not limited to this. For example, one or both of them may be a SCARA robot, and the robot 1A and the robot 1B may also be an integrated so-called dual-arm multi-joint robot.

[0069] The base 110 is a part for installing the robot 1A at any installation location. In the present embodiment, the base 110 is installed on a floor, etc. In addition, the installation location of the base 110 is not limited to the floor, etc., and may be, for example, a wall, a ceiling, a movable trolley, etc.

[0070] like Figure 1 as well as Figure 2 As shown in FIG. 1 , the robot arm 10 includes an arm 11, an arm 12, an arm 13, an arm 14, an arm 15, and an arm 16. These arms 11 to 16 are connected in sequence from the base end side to the tip end side. The arms 11 to 16 are formed to be rotatable relative to the adjacent arms or the base 110. Figure 1 As shown, the arm 16 is disc-shaped and can rotate around the axis O6 relative to the arm 15. Figure 2 As described above, in the present embodiment, the center of the distal end surface of the arm 16 is referred to as a predetermined point.

[0071] Furthermore, the robot arm 10 of the robot 1A constitutes a first arm, and the robot arm 10 of the robot 1B constitutes a second arm.

[0072] In addition, if Figure 1 As shown, the gripping portion or the first gripping portion, i.e., the hand 17, which is a gripping portion for gripping the cable 92 or the connector 93, can be mounted on the robot 10. For example, the robot 10 has a mounting portion, not shown in the figure, which has: a structure having an internal thread or an external thread for assembling the hand 17 by thread fixing, bolt fixing, etc., or a clamping portion such as a hook or an L-shaped groove. In this way, the hand 17 can be easily mounted at an appropriate position. The structure of the hand 17 will be described in detail later.

[0073] In addition, if Figure 1 As shown, between the arm 16 and the hand 17, a force detection unit 120 is detachably provided relative to them. The force detection unit 120 detects the force applied to the hand 17. In addition, the force also includes torque. The force detection unit 120 is composed of, for example, a 6-axis force sensor, a 3-axis force sensor, etc. In addition, the force detection unit 120 outputs the detected force detection information to the control device 5. The force detection unit 120 functions as a detection unit for detecting the contact between the hand 17 and the connector 93 as described later. The force detection unit 120 as the detection unit is a force sensor, thereby, as described later, it is possible to quickly and accurately detect the second grip of the hand 17. As a result, it is possible to prevent or suppress excessive tension from being applied to the cable 92. In addition, as a detection unit, it is not limited to the force detection unit 120, for example, it can also be a structure that uses a pressure-sensitive sensor or a proximity sensor to detect the contact between the connector 93 and the hand 17.

[0074] like Figure 3As shown, the robot 1A has a driving unit 130, and the driving unit 130 includes a motor and a reducer for rotating one arm relative to another arm or the base 110. As the motor, for example, a servo motor such as an AC servo motor and a DC servo motor can be used. As the reducer, for example, a planetary gear type reducer, a wave gear device, etc. can be used. In addition, the robot 1A has a position sensor 140 as an angle sensor for detecting the rotation angle of the rotating shaft of the motor or the reducer. For example, a rotary encoder can be used for the position sensor 140. In addition, the driving unit 130 and the position sensor 140 are respectively provided on the arms 11 to 16, for example. In the present embodiment, the robot 1A has 6 driving units 130 and 6 position sensors 140. In addition, each driving unit 130 is electrically connected to the control device 5, for example, through a motor driver built into the robot 1A. In addition, each position sensor 140 is also electrically connected to the control device 5.

[0075] For hand 17

[0076] like Figure 1 As shown, a hand 17 is mounted on the tip of the robot arm 10 of the robot 1A. The hand 17 has a function of holding a cable 92 having a connector 93 at one end. The hand 17 can rotate around an axis O6 by the rotation of the arm 16.

[0077] like Figure 6 as well as Figure 7 As shown, the hand 17 has a pair of clamping pieces 171 configured to be able to contact and separate from each other and a posture adjustment unit 172 for adjusting the posture of the connector 93 when in contact with the connector 93. Each clamping piece 171 is connected to a driving unit (not shown), which is electrically connected to the control device 5 and its operation is controlled.

[0078] Each clamping piece 171 is a claw portion, and a cutout 173 is formed at each opposing portion. Figure 6 As shown in FIG. 1 , when the clamping pieces 171 are in contact, the cutouts 173 are aligned, thereby forming a divided space 174 divided by the clamping pieces 171. Figure 7 As shown, when each clamping piece 171 is separated, the release Figure 6 The divided space 174 is shown. In the released state, that is, the state in which the clamping pieces 171 are separated, the cable 92 can move relatively between the clamping pieces 171 along their length directions.

[0079] Then, when the cable 92 reaches the position of the cutout 173, as shown in FIG. Figure 6As shown, the clamping pieces 171 are brought close to each other and contact each other, thereby accommodating the cable 92 in the partitioned space 174. In this state, the cable 92 is inserted through the partitioned space 174 and is restricted from moving outside the partitioned space 174, that is, the radial movement of the cable 92 is restricted.

[0080] In addition, the cable 92 can move radially in the partition space 174, but because it is restricted from moving outside the partition space 174, in this specification, the situation where the cable 92 is located in the partition space 174 is referred to as a state where the radial movement of the cable 92 is restricted. In other words, this state can be referred to as a state where the cable 92 is gripped by the clamping piece 171. In addition, this grip is referred to as "first grip" below. In other words, Figure 6 , Figure 8 The state shown is a state where the hand 17 performs the first gripping of the cable 92. In the first gripping state, the cable 92 can move relative to the hand 17 in the longitudinal direction of the cable 92.

[0081] In this way, the hand 17 as the gripping portion has two clamping pieces 171 as the first claw and the second claw that are in contact or separated from each other, and when the clamping pieces 171 are in contact, each clamping piece 171 forms a partitioned space 174 as a hole for inserting the cable 92. Thus, the first grip can be performed, and the action of moving along the cable 92 as described later can be performed. In addition, in the state of performing the first grip, it is prevented or suppressed to apply a clamping force exceeding the requirement to the cable 92, and damage to the cable 92 can be prevented or suppressed.

[0082] In addition, if Figure 6 As shown, the cross-sectional area of ​​the divided space 174 as the hole portion is larger than the cross-sectional area of ​​the cable 92, and smaller than the cross-sectional area of ​​the connector 93 or the area of ​​the end surface of the connector 93 on the cable 92 side. In addition, when viewed from a direction perpendicular to the thickness direction of the cable 92, at least one of the two clamping pieces 171 as the first claw and the second claw overlaps with the connector 93. Thus, even if an action such as moving along the cable 92 in the first gripping state as described later is quickly performed, damage to the cable 92 can be more effectively prevented or suppressed.

[0083] like Figure 8 and Fig. 9 As shown in FIG. 1 , the posture adjustment unit 172 is in a block shape: it is formed by protruding from one side of each clamping piece 171. In addition, the posture adjustment unit 172 is located above the partition space 174, that is, at the position of the robot arm 10. In addition, as shown in FIG. Figure 6 As shown, when the clamping pieces 171 are in contact, the blocks are also in contact and form a block. Figure 6 to Figure 9The lower end surface in the middle, that is, the end surface on the side opposite to the robot arm 10, is a plane. Fig. 9 As shown, the plane functions as a restriction surface 175 that restricts the movement or rotation of the connector 93 by contacting the connector 93 .

[0084] In addition, each clamping piece 171 and the posture adjusting part 172 may be formed as one body or as separate bodies. In the case where each clamping piece 171 and the posture adjusting part 172 are formed as separate bodies, the posture adjusting part 172 may be formed of a single block or plate.

[0085] like Figure 8 As shown in FIG. 1 , in the first holding state, the hand 17 moves toward the connector 93 along the length direction of the cable 92, so that Fig. 9 As shown, the connector 93 is in contact with each clamping piece 171 and the posture adjustment portion 172. In this contact state, the movement of the connector 93 in the direction along the length of the cable 92 and the rotation around the axis along the length of the cable 92 or the central axis of the dividing space 174 are restricted by the surface on the posture adjustment portion 172 side of the clamping piece 171 and the restriction surface 175 of the posture adjustment portion 172. Thus, in this state, the connector 93 is held by the hand 17. In addition, this grip is hereinafter referred to as the "second grip". In other words, Fig. 9 The illustrated state is a state where the hand 17 performs the second gripping of the connector 93 .

[0086] In addition, a tool point is set at the tip of the hand 17 , that is, the tip of the gripping piece 171 , and a tip coordinate system having the tool point as the origin is set in the robot 1A.

[0087] For hand 18

[0088] like Figure 1 As shown in FIG. 1 , a hand 18 is mounted on the top end of the robot arm 10 of the robot 1B. In addition, the hand 18 can rotate around the axis O6 by rotating the arm 16. The hand 18 is a second gripping part having the function of gripping the connector 93 that is second gripped by the hand 17 and rotating the connector 93 to adjust the posture of the connector 93. In this embodiment, as shown in FIG. Fig.10 as well as Fig.11 As shown, the hand 18 has a pair of gripping pieces 181 configured to be able to contact and separate from each other.

[0089] Each clamping piece 181 is connected to a driving unit (not shown), and the driving unit is electrically connected to the control device 5, and its operation is controlled. In addition, the connector 93 can be held between the clamping pieces 181 by bringing them closer in the contact direction. The grip of the connector 93 can be released by separating the clamping pieces 181 from each other.

[0090] In addition, in the structure shown in the figure, the hand 18 is a structure that holds the connector 93 by a pair of clamping pieces 181, but it is not limited to this. It can also be a structure that holds the connector 93 by more than three clamping pieces, or a structure that holds the connector 93 by suction.

[0091] In addition, a tool point is set at the tip of the hand 18 , that is, the tip of the gripping piece 181 , and a tip coordinate system having the tool point as the origin is set in the robot 1B.

[0092] For shooting section 19

[0093] like Figure 1 , Fig.10 as well as Fig.11 As shown, the imaging unit 19 is provided at the top end of the robot arm 10 of the robot 1B. The imaging unit 19 can use, for example, a CCD (Charge Coupled Device) camera or the like. The imaging unit 19 is in a state of being withdrawn from each clamping piece 181 of the hand 18, that is, located on the robot arm 10 side. Thus, when each clamping piece 181 grasps the connector 93, interference with the connector 93 is easily prevented.

[0094] In addition, the imaging unit 19 has a light source 191 at its top end, that is, at the outer periphery of the lens. Thus, even if the space where the robots 1A and 1B work is dark or the connector 93 enters the shadow area of ​​the robot 1A due to the position of the lighting installed in the space, the connector 93 can be photographed well and clearly.

[0095] In addition, the photographing unit 19 is electrically connected to the control device 5, and its photographing result, that is, the image, is sent to the control device 5. In addition, the image mentioned here includes a static image and a dynamic image. In addition, the photographing unit 19 is not limited to a CCD camera, and can also be a spectroscopic camera. In this case, the spectroscopic data, that is, the spectroscopic spectrum is sent to the control device 5.

[0096] In addition, an image coordinate system is set in the image output by the imaging unit 19. The coordinate system of the tip of the hand 17, the coordinate system of the tip of the hand 18, and the image coordinate system are in a state of being respectively associated, that is, in a state of being calibrated.

[0097] Controls

[0098] like Figure 3As shown, the control device 5 has a function of controlling the driving of the robot 1A and the robot 1B, and is connected to the robot 1A and the robot 1B in a communicable manner. In addition, they can be connected by wire or wirelessly. In addition, in the structure shown in the figure, the control device 5 is arranged at a different position from the robot 1A and the robot 1B, but it can also be built into one of the robot 1A and the robot 1B, or it can be built into both.

[0099] Furthermore, the control device 5 is connected to a display device 401 including a monitor (not shown) and an input device 402 including, for example, a keyboard, a mouse, a teaching pendant, and the like.

[0100] like Figure 3 As shown, the control device 5 includes a control unit 51 including a processor, a storage unit 52 including a memory, and an external input / output unit 53 including an external interface (I / F). The components of the control device 5 are connected to each other via various buses so as to be able to communicate with each other.

[0101] The control unit 51 includes a processor such as a CPU (Central Processing Unit) and executes various programs stored in the storage unit 52. This enables control of the driving of the robot 1A and the robot 1B, various calculations, and determinations.

[0102] The storage unit 52 stores various programs that can be executed by the control unit 51, such as programs for executing the control method described later, reference data, threshold values, standard curves, etc. used in the control action. In addition, the storage unit 52 can store various data accepted by the external input and output unit 53. The storage unit 52 is configured to include volatile memories such as RAM (Random Access Memory), non-volatile memories such as ROM (Read Only Memory), etc. In addition, the storage unit 52 is not limited to a non-detachable type, and can also be a structure with a detachable external storage device (not shown). In addition, the storage unit 52 can also be set in other places through a network such as a LAN (Local Area Network).

[0103] The external input / output unit 53 includes an external interface (I / F) for connecting the robot 1A, the robot 1B, the display device 401, the input device 402, etc. The external input / output unit 53 also functions as a receiving unit for receiving information related to the image from the imaging unit 19.

[0104] In addition, the control device 5 may have other structures in addition to the above-mentioned structure. In addition, various programs, data, etc. stored in the storage unit 52 may be pre-stored in the storage unit 52, or stored in a recording medium such as a CD-ROM, and may be provided by the recording medium or provided through a network, etc.

[0105] Here, the control device 5 can perform position control and force control as control operations for driving the robot arm 10 .

[0106] Position control refers to control that drives the robot 1A or 1B so that the tool point is located at a predetermined coordinate, for example. That is, position control refers to control that drives the robot 1A or 1B based on the position information of the target and the position information of the tool point. Such position control is performed on the premise that there are no obstacles on the route to the target position, and can move the robot arm at a faster speed than force control, which helps to speed up the work. In addition, the speed of the robot 1A or 1B in the position control may be constant or not.

[0107] The force control refers to control for driving the robot 1A or the robot 1B based on the detection result of the force detection unit 120. The force control includes, for example, impedance control and trigger force control.

[0108] In the trigger force control, force detection is performed by the force detection unit 120 , and the robot 1A or the robot 1B is caused to move or change its posture until a predetermined force is detected by the force detection unit 120 .

[0109] Impedance control includes contour control. First, to briefly explain, in impedance control, the action of the robot 1A or the robot 1B is controlled so that the force applied to the top end of the robot arm 10, the hand 17 or the hand 18 is maintained at a prescribed force as much as possible, that is, the force in a prescribed direction detected by the force detection unit 120 is maintained at a target value as much as possible.

[0110] Control Methods

[0111] Next, the main reference Figure 4 , Figure 5 as well as Figure 12 to Figure 27 The control operation performed by the control device 5 will be described.

[0112] In the following description, moving the tool point of the hand 17 to a predetermined position is referred to as “moving the hand 17 to a predetermined position” or “moving the robot 1A to a predetermined position”.

[0113] The present control method is a control method performed using robot 1A and robot 1B, and includes [1] a preparation step, [2] a first gripping step, [3] a movement step, [4] a second gripping step, [5] a photographing step, [6] a posture adjustment step, [7] an insertion step, and [8] a fixing step.

[0114] [1] Preparation steps

[0115] The preparation step is a step of preparing the robot 1A equipped with the hand 17 and the robot 1B equipped with the hand 18 and the imaging unit 19. Here, "preparation" means starting the robot system 100 to an operable state when the robot system 100 performs connection operations such as calibration of the above-mentioned coordinate systems.

[0116] In addition, in the preparation step, such as Fig.12 as well as Fig.13 As shown, it is preferred that the robot 1B is driven in advance to move the hand 18 and the imaging unit 19 toward the +X axis side and the +Z axis side of the substrate 91, so that the hand 18 and the imaging unit 19 are in a state facing the -X axis side. In this way, the [5] imaging step and the [6] posture adjustment step can be smoothly performed. In addition, this movement can also be performed simultaneously with any one of the [1] preparation step to the [4] second gripping step.

[0117] [2] First control step

[0118] Fig.12 as well as Fig.13 The first holding step shown is a step of causing the hand 17 to hold the cable 92 so as to limit the radial movement of the cable 92. Specifically, Fig.13 As shown, the hand 17 is moved to the position P1 and lowered toward the cable 92, that is, toward the position P2, while the clamping pieces 171 are separated. Then, the clamping pieces 171 are brought close to each other and contacted to store the cable 92 in the partitioned space 174, forming the first gripping state of the hand 17.

[0119] Position P1 and position P2 are coordinates pre-stored in the storage unit 52, and the coordinates may be input by the operator or may be coordinates determined based on an image pre-photographed by the imaging unit 19. In the present embodiment, position P1 is an arbitrary coordinate near the fixed end of the cable 92, and position P2 is a coordinate on the -Z axis side of position P1.

[0120] That is, the portion of the hand 17 that performs the first grip as the gripping portion is the portion of the cable 92 that is biased toward the fixed end. In other words, the distance from one end of the cable 92 to the portion of the hand 17 that performs the first grip is longer than the distance from the other end of the cable 92 to the portion of the hand 17 that performs the first grip. The position of the fixed end is predetermined, and the vicinity of the fixed end in the cable 92 is located at a roughly determined position regardless of the position of the connector 93 on the substrate 91. Therefore, the movement of the hand 17 until the first grip is performed can be controlled using position control. As a result, the first grip can be performed quickly and with high accuracy.

[0121] [3] Moving steps

[0122] like Fig.14 as well as Fig.15 As shown, in the moving step, the hand 17 is moved toward the connector 93 along the cable 92 in the first gripping state. In this step, in order to quickly perform the photographing step performed after this step, the hand 17 is moved toward the position P3 near the -X axis side of the photographing unit 19. The moving route may be a straight line or an arc.

[0123] Furthermore, in the present embodiment, when the hand 17 is moved from the position P2 to the position P3, the hand 17 is moved to the position P4 before the position P3 by the position control, and the hand 17 is moved from the position P4 to the position P3 by the force control. That is, the section is included in which the control device 5 moves the hand 17 as the gripping part toward the connector 93 by the position control in the first gripping state. Thus, rapid movement can be performed by the position control.

[0124] In addition, position P4 is set on the moving route between position P2 and position P3. Position P3 and position P4 are coordinates pre-stored in the storage unit 52. In addition, it is preferred that position P4 is biased toward position P3 in the moving route between position P2 and position P3. Thus, the hand 17 can be moved to position P3 more quickly. In the moving route of the hand 17, it is preferred that the distance from position P4 to position P3 is less than 5% of the distance from position P2 to position P4. Thus, the above-mentioned effect can be more significantly exerted.

[0125] The position of the cable 92, that is, the bending state, changes depending on the position of the connector 93 on the substrate. However, as described above, in the first gripping state, the cable 92 is restricted from moving outside the partition space 174. As a result, the portion of the cable 92 after the hand 17 passes through extends substantially along the moving path of the hand 17. In addition, when the hand 17 is moved from position P2 to position P4 by position control, due to the Figure 6The area of ​​the divided space 174 is larger than the cross-sectional area of ​​the cable 92 , so the possibility of the cable 92 contacting the clamping piece 171 can be sufficiently reduced, and damage to the cable 92 can be prevented or suppressed.

[0126] Then, when the hand 17 is moved to the position P4, the force control is switched to the force control. The force control is a mode in which the force detection of the force detection unit 120 is performed while the hand 17 is moved at a slower moving speed than the moving speed of the hand 17 in the position control. Therefore, when the hand 17 is judged to be in contact with the connector 93 and the hand 17 is holding the connector 93 when moving toward the position P3, the movement of the hand 17 can be stopped immediately, and the excessive tension on the cable 92 can be prevented or suppressed.

[0127] In addition, in the present embodiment, the moving step is set until the hand 17 and the connector 93 are about to come into contact.

[0128] [4] Second holding step

[0129] like Fig. 9 , Fig.14 as well as Fig.15 As shown in FIG. 1 , the second gripping step is a step of stopping the movement of the hand 17 based on the detection result of the force detection unit 120 and performing the second gripping of the connector 93 by the hand 17. When the hand 17 that performed the first gripping moves toward the position P3 by force control, the hand 17 contacts the connector 93. When the force received by the hand 17 when contacting the connector 93, that is, the force detected by the force detection unit 120, reaches a predetermined value, the movement of the hand 17 is stopped.

[0130] At this time, if Fig. 9 As shown, the connector 93 is restricted from moving in the direction along the length direction of the cable 92 and rotating around the axis along the length direction of the cable 92 or the central axis of the partition space 174 by the surface of the clamping piece 171 on the side of the posture adjusting portion 172 and the restriction surface 175 of the posture adjusting portion 172. Thus, the second grip can be performed.

[0131] In this way, by sequentially performing the first grip and the second grip by the hand 17, the connector 93 can be held in a stable and simple manner. In the past, for example, the entire substrate was photographed by a photographing unit to determine at which position of the substrate the connector was disposed, and the hand was moved to that position to hold the connector. In such a conventional method, for example, sometimes a good image cannot be captured depending on the shooting conditions such as the brightness of the room and the shooting direction, and it is difficult to determine the position of the connector. Moreover, in the conventional method, it is necessary to perform a process such as determining the connector in the image, and the process is complicated. That is, in the conventional method, it is difficult to easily and accurately hold the connector. In contrast, in the present invention, a simple method such as sequentially performing the first grip and the second grip by the hand 17 is used, and there is no need to perform the complicated process as in the past, and the connector can be accurately held. In summary, according to the present invention, the connector can be easily and accurately held.

[0132] In the second gripping state, which surface of the connector 93 contacts the posture adjusting unit 172 is random each time. That is, in the second gripping state of the hand 17, it is impossible to know whether the posture of the connector 93 in the circumferential direction of the cable 92 is appropriate.

[0133] [5] Shooting steps

[0134] like Fig.14 as well as Fig.15 As shown in FIG. 1 , the photographing step is a step of photographing the connector 93 held by the hand 17 in the second grip by the photographing unit 19. In addition, at position P3, the connector 93 held by the hand 17 is located at the same height as the photographing unit 19, that is, at a position substantially the same as the position in the Z-axis direction. Therefore, when the connector 93 is photographed, the connector 93 is located in the center of the image. In addition, as described above, when the photographing step is performed, the hand 18 is previously located at the center of the image. Fig.14 as well as Fig.15 The position shown in the figure can therefore be quickly transferred to this step when the second holding step is completed.

[0135] The image captured in this step is sent to the control device 5 .

[0136] [6] Posture adjustment steps

[0137] The posture adjustment step is a step of using the hand 18 to make the hand 17 hold the connector 93 in a desired posture when the posture of the connector 93 being held in the second grip is not the desired posture. Figure 5 As shown, the posture adjustment step has the following steps [6A] to [6E].

[0138] like Fig.16As shown, step [6A] is a step of making the hand 18 hold the connector 93 for the second holding. That is, in this step, the connector 93 is held by the hand 17 and the hand 18. Thus, when the connector 93 is transferred between the hand 17 and the hand 18, the connector 93 can be prevented from accidentally falling off.

[0139] like Fig.17 As shown, in step [6B], while the hand 18 is maintained in the state of holding the connector 93, the hand 17 is moved in the direction of separation from the hand 18 to release the second holding of the hand 17. Thus, after this step, the connector 93 is held only by the hand 18.

[0140] like Fig.18 As shown, step [6C] is a step of rotating the hand 18 around the axis O6 to adjust the orientation of the connector 93 to a desired posture. In this step, the rotation amount of the hand 18 is determined based on the image obtained in the imaging step [5].

[0141] Specifically, for example, a method can be used in which a plurality of feature points in a captured image are extracted and the amount of rotation is calculated by comparing the arrangement of the feature points with the arrangement of feature points in an image of connector 93 in a desired posture pre-stored in storage unit 52. In addition, other methods such as a method of comparing the center line of the end face of connector 93 with the center line in an image pre-stored in storage unit 52 and calculating the amount of rotation based on the difference amount can also be used.

[0142] Through such step [6C], the connector 93 can be in a desired posture. The desired posture here refers to a posture in which the connector 93 can be inserted into the insertion hole 911 in a desired direction when the hand 17 reaches a preset route while holding the connector 93.

[0143] like Fig.19 As shown, step [6D] is a step of causing hand 17 to hold connector 93 in a desired posture held by hand 18. That is, in this step, connector 93 in a desired posture is held by hand 17 and hand 18. Thus, when connector 93 is transferred between hand 17 and hand 18, connector 93 can be prevented from accidentally falling off.

[0144] like Fig. 20 As shown, in step [6E], while the hand 17 is maintained in the state of holding the connector 93, the hand 18 is moved in a direction away from the hand 17 to release the holding of the hand 18. Thus, after this step, the connector 93 is held only by the hand 17, that is, the second holding state is achieved.

[0145] By performing such steps [6A] to [6E], the posture of the connector 93 can be adjusted to a desired posture from the state in which the hand 17 performs the second grip, and the state in which the hand 17 performs the second grip can be restored. Thus, in the subsequent insertion step, the connector 93 can be inserted into the insertion hole 911 by simple control. In addition, by a simple method of alternately gripping the connector 93 and rotating it, the posture can be adjusted without applying excessive tension to the cable 92.

[0146] In addition, when the object is in a desired posture in the captured image, steps [6A] to [6E] can be omitted and the process can proceed to the insertion step.

[0147] In addition, after step [6E] is completed, if Fig.21 As shown, the hand 18 is rotated around the axis O6 and returned to Figure 12 to Figure 15 The camera moves to the initial position and the posture shown in the figure. Thus, the next shooting step can be smoothly performed.

[0148] like Figure 22 to Figure 25 As shown in FIG. 7 , the insertion step is a step of inserting the connector 93 into the insertion hole 911 of the substrate 91. Specifically, first, the tip of the hand 17 that is performing the second grip on the connector 93 in the desired posture is moved along the Fig. 22 Move in the direction of the middle arrow to the preset position P5.

[0149] Position P5 is a coordinate that is on the +Y axis side of the substrate 91 and in the X axis direction and is the same as the center of the insertion hole 911. In addition, the hand 17 is rotated around the axis O6 so that the end surface of the connector 93 on the side opposite to the cable 92 side faces the insertion hole 911. Such movement and rotation can be performed simultaneously or sequentially. When these are performed sequentially, the order is not limited.

[0150] Then, if Fig.23 as well as Fig.24 As shown in FIG. 1 , the hand 17 moves to a position P6 set between the position P5 and the insertion hole 911. The movement of the hand 17 to the position P5 or the position P6 is performed by position control, but after moving to the position P6, the hand 17 is moved toward the insertion hole 911 by force control. Then, when the force applied to the hand 17 when the insertion of the connector 93 into the insertion hole 911 is completed, that is, the force detected by the force detection unit 120 reaches a predetermined value, the movement of the hand 17 is stopped.

[0151] The predetermined value used in this step is a value stored in advance in the storage unit 52 and is different from the value used to detect the contact between the hand 17 and the connector 93 during the second grip as described above.

[0152] After the above steps, if Fig.25 As shown, the insertion of the connector 93 into the insertion hole 911 is completed.

[0153] like Fig.26 as well as Fig. 27 As shown, [8] the fixing step is a step of fixing the middle portion of the cable 92 in the longitudinal direction to the substrate 91. In this embodiment, the cable 92 is fixed to the substrate 91 at two locations in the longitudinal direction. Here, the substrate 91 is provided with a fixing portion 912 and a fixing portion 913. The fixing portion 912 and the fixing portion 913 are, for example, a groove, a pair of protrusions, etc.

[0154] Position P7 is set in the fixing unit 912, and position P8 is set in the fixing unit 913. Position P7 and position P8 are coordinates pre-stored in the storage unit 52, and the coordinates may be input by an operator or may be determined based on an image pre-photographed by the imaging unit 19.

[0155] Then, if Fig. 27 As shown, by moving the hand 17 to the position P7, the tip of the hand 17 can press and fix the cable 92 to the fixing portion 912. Then, by moving the hand 17 to the position P8, the tip of the hand 17 can press and fix the cable 92 to the fixing portion 913.

[0156] After the above steps, if Fig. 27 As shown, the connector 93 can be inserted into the insertion hole 911 and the middle portion of the cable 92 in the longitudinal direction can be fixed to the substrate 91 , thereby completing the operation of the robot system 100 .

[0157] As described above, the robot system 100 includes: a robot 1A having a robot arm 10 as an arm; a control unit 51 for controlling the operation of the robot 1A; a hand 17 as a gripping unit connected to the robot arm 10 and gripping a cable 92 having a connector 93 at one end thereof; and a force detection unit 120 as a detection unit for detecting contact between the hand 17 and the connector 93. In addition, the control unit 51 performs the following processing: causing the hand 17 to perform a first grip in which the cable 92 is gripped in such a manner as to restrict movement of the cable 92 in the direction of thickness of the cable 92; causing the hand 17 to move toward the connector 93 while performing the first grip; stopping the movement of the hand 17 based on the detection result of the force detection unit 120; and causing the hand 17 to perform a second grip in which the connector 93 is gripped.

[0158] In addition, in a control method of a robot system 100, the robot system 100 includes: a robot 1A having a robot arm 10 as an arm; a hand 17 as a gripping part connected to the robot arm 10 and gripping a cable 92 having a connector 93 at one end; and a force detection part 120 as a detection part, which detects contact between the hand 17 and the connector 93. And, the control method includes the following steps: performing a first gripping of the cable 92 by the hand 17 in a manner of restricting movement of the cable 92 in a direction of thickness of the cable 92; moving the hand 17 toward the connector 93 while performing the first gripping; stopping the movement of the hand 17 based on the detection result of the force detection part 120; and performing a second gripping of the connector 93 by the hand 17.

[0159] As described above, according to the present invention, the connector can be accurately grasped without the need for conventional complicated processing by the simple method of sequentially performing the first grasp and the second grasp by the hand 17. In summary, according to the present invention, the connector can be easily and accurately grasped.

[0160] Second embodiment

[0161] Below, refer to Fig.28 A second embodiment of the robot system of the present invention will be described, with the description focusing on the differences from the above-described embodiment, and descriptions of the same matters being omitted.

[0162] like Fig.28 As shown, in this embodiment, the hand 17 has a plate-shaped or block-shaped guide piece 176 provided on the side of the clamping piece 171 opposite to the posture adjustment portion 172. The guide piece 176 has a function of guiding the cable 92 between the clamping pieces 171 while contacting the cable 92 and adjusting the posture of the cable 92 when the hand 17 performs the first grip.

[0163] According to this embodiment, the same effects as those of the above-described first embodiment can be obtained, and further, the first grip can be performed more stably.

[0164] Other examples of robot system configuration

[0165] Fig.29 This is a block diagram used to explain the robot system with a hardware focus.

[0166] exist Fig.29 , the overall structure of a robot system 100A is shown in which the robot 1A and the robot 1B are connected to a controller 61 and a computer 62. The robot 1 can be controlled by the processor in the controller 61 reading instructions in the memory, or by the processor in the computer 62 reading instructions in the memory and executing them using the controller 61.

[0167] Therefore, any one or both of the controller 61 and the computer 62 can be understood as a “control device”.

[0168] Modification 1

[0169] Fig.30 This is a block diagram showing Modification 1 focusing on the hardware of the robot system.

[0170] exist Fig.30 2 shows the overall configuration of a robot system 100B in which the robot 1A and the robot 1B are directly connected to a computer 63. The robot 1A and the robot 1B are controlled by a processor in the computer 63 reading instructions stored in a memory and directly executing the instructions.

[0171] Therefore, the computer 63 can be understood as a "control device".

[0172] Modification 2

[0173] Fig.31 This is a block diagram showing a second modification centered on the hardware of the robot system.

[0174] exist Fig.31 , the overall structure of a robot system 100C is shown in which a robot 1A and a robot 1B each having a built-in controller 61 are connected to a computer 66, and the computer 66 is connected to a cloud 64 via a network 65 such as a LAN. The control of the robot 1A and the robot 1B can be executed by a processor in the computer 66 reading instructions in a memory, or by a processor in the cloud 64 using the computer 66 to read instructions in a memory.

[0175] Therefore, any one, any two, or any three of the controller 61 , the computer 66 , and the cloud 64 can be understood as a “control device”.

[0176] The robot system and control method of the present invention are described above based on the illustrated embodiments, but the present invention is not limited thereto, and the structure of each part can be replaced by any structure having the same function. In addition, other arbitrary structures can also be added to the present invention. In addition, the various embodiments can also be appropriately combined.

[0177] In addition, in the above-mentioned embodiment, as the robot possessed by the robot system of the present invention, a so-called 6-axis vertical multi-joint robot is shown, but the robot may also be other robots such as a SCARA robot. In addition, the robot is not limited to a single-arm robot, for example, it may also be other robots such as a dual-arm robot. Therefore, the number of movable parts is not limited to one, and may be more than two. In addition, the number of arms possessed by the mechanical arm possessed by the movable part is 6 in the above-mentioned embodiment, but may also be 1 to 5 or more than 7.

Claims

1. A robot system, characterized in that: have: a first robot having a first arm and a second robot having a second arm; A control unit, for controlling the operation of the robot; a first gripping portion connected to the first arm and having a first claw portion, a second claw portion and a posture adjustment portion, the first claw portion and the second claw portion having a first open state and a first closed state for releasing and holding the cable, the first claw portion and the second claw portion respectively having cutouts formed at opposing portions, the first claw portion and the second claw portion forming a hole portion for inserting the cable having a connector at one end thereof in the first closed state, the cross-sectional area of ​​the hole portion being larger than the cross-sectional area of ​​the cable, the posture adjustment portion being located above the hole portion, the posture adjustment portion being block-shaped, protruding from one side of the first claw portion and the second claw portion respectively, and the lower end surface of the posture adjustment portion being a plane; a second gripping portion connected to the second arm and having a first clamping piece and a second clamping piece, wherein the second gripping portion is connected to the second arm via a disc-shaped arm; a force sensor, configured to detect an external force applied to the first gripping portion and output detection information corresponding to the detected external force; A photographing unit, for photographing the posture of the connector; a memory configured to store a program; as well as processor, The processor implements by executing the program: causing the first holding portion to hold the cable in the hole; In a state where the first holding portion holds the cable, moving the first holding portion toward the connector; If it is determined that the detection information corresponds to a predetermined force, stopping the movement of the first gripping portion; When the movement of the first gripping portion stops, the connector is in contact with the first claw, the second claw, and the posture adjustment portion. In the contact state, the surfaces of the first claw and the second claw on the posture adjustment portion side and the limiting surface of the posture adjustment portion are in contact with the connector to limit the movement of the connector along the length direction of the cable and the rotation around the axis along the length direction of the cable. When the movement or rotation of the connector is restricted by the first gripping portion, determining whether the posture of the connector is a predetermined posture based on the image captured by the imaging portion; If it is determined that the posture of the connector is not a predetermined posture, determining a rotation angle required to correct the posture of the connector based on the captured image; When it is determined that the posture of the connector is not a predetermined posture, the second holding portion clamps the connector through the first clamping piece and the second clamping piece while limiting the movement or rotation of the connector by the first holding portion; After the second holding portion clamps the connector, moving the first holding portion to leave the connector; After the first holding portion leaves the connector, when the second holding portion clamps the connector, the second holding portion is rotated around the central axis of the disc-shaped arm by the required rotation angle; After the second gripping portion rotates to the required rotation angle, the first gripping portion is moved toward the connector while the second gripping portion is clamping the connector, and when it is determined that the detection information corresponds to the predetermined force, the movement of the first gripping portion is stopped, and the movement or rotation of the connector is restricted; After the first holding portion restricts the movement or rotation of the connector, the first clamping piece and the second clamping piece release the connector, and the second holding portion moves to leave the connector; In a state where the first gripping portion restricts movement or rotation of the connector, the first gripping portion is moved toward the insertion hole to insert the connector into the insertion hole.

2. The robot system according to claim 1, characterized in that: The other end of the cable is a fixed end. A distance from one end of the cable to a first point at which the first gripping portion initially grips the cable is greater than a distance from the other end of the cable to the first point of the cable.

3. The robot system according to claim 1, characterized in that: The first claw portion or the second claw portion overlaps with the connector when viewed from a direction perpendicular to a thickness direction of the cable.

4. A control method, characterized in that: The control method is a control method of a robot system, The robot system comprises: a first robot having a first arm and a second robot having a second arm; A control unit, for controlling the operation of the robot; a first gripping portion connected to the first arm and having a first claw portion, a second claw portion and a posture adjustment portion, the first claw portion and the second claw portion having a first open state and a first closed state for releasing and holding the cable, the first claw portion and the second claw portion respectively having cutouts formed at opposing portions, the first claw portion and the second claw portion forming a hole portion for inserting the cable having a connector at one end thereof in the first closed state, the cross-sectional area of ​​the hole portion being larger than the cross-sectional area of ​​the cable, the posture adjustment portion being located above the hole portion, the posture adjustment portion being block-shaped, protruding from one side of the first claw portion and the second claw portion respectively, and the lower end surface of the posture adjustment portion being a plane; a second gripping portion connected to the second arm and having a first clamping piece and a second clamping piece, wherein the second gripping portion is connected to the second arm via a disc-shaped arm; a force sensor, configured to detect an external force applied to the first gripping portion and output detection information corresponding to the detected external force; A photographing unit, for photographing the posture of the connector; a memory configured to store a program; as well as processor, By executing the program by the processor, the control method performs the following steps: The first holding portion holds the cable in the hole; The force sensor detects an external force applied to the first gripping portion and outputs detection information corresponding to the detected external force. In a state where the first holding portion holds the cable, the first holding portion moves toward the connector; If it is determined that the detection information corresponds to a predetermined force, stopping the movement of the first gripping portion; When the movement of the first gripping portion stops, the connector is in contact with the first claw, the second claw, and the posture adjustment portion. In the contact state, the surfaces of the first claw and the second claw on the posture adjustment portion side and the limiting surface of the posture adjustment portion are in contact with the connector to limit the movement of the connector along the length direction of the cable and the rotation around the axis along the length direction of the cable. When the movement or rotation of the connector is restricted by the first gripping portion, determining whether the posture of the connector is a predetermined posture based on the image captured by the imaging portion; If it is determined that the posture of the connector is not a predetermined posture, determining a rotation angle required to correct the posture of the connector based on the captured image; When it is determined that the posture of the connector is not a predetermined posture, the second holding portion clamps the connector through the first clamping piece and the second clamping piece while limiting the movement or rotation of the connector by the first holding portion; After the second holding portion clamps the connector, the first holding portion moves to leave the connector; After the first holding portion leaves the connector, when the second holding portion clamps the connector, the second holding portion rotates around the central axis of the disc-shaped arm by the required rotation angle; After the second gripping portion rotates to the required rotation angle, the first gripping portion moves toward the connector while the second gripping portion holds the connector, and when it is determined that the detection information corresponds to the predetermined force, the movement of the first gripping portion is stopped, and the movement or rotation of the connector is restricted; After the first holding portion restricts the movement or rotation of the connector, the first clamping piece and the second clamping piece release the connector, and the second holding portion moves to leave the connector; In a state where the first gripping portion restricts movement or rotation of the connector, the first gripping portion is moved toward the insertion hole to insert the connector into the insertion hole.