Apparatus and method for inserting object

The gripped object insertion device uses reaction force detection and calculation to efficiently locate and insert objects into high-friction surfaces by scanning and controlling the object's movement, addressing inefficiencies in existing methods.

JP7580997B2Active Publication Date: 2024-11-12HITACHI LTD
View PDF 7 Cites 0 Cited by

Patent Information

Application Number
JP2020161904
Authority / Receiving Office
JP · JP
Patent Type
Patents
Current Assignee / Owner
Filing Date
2020-09-28
Publication Date
2024-11-12
Estimated Expiration
2040-09-28

AI Technical Summary

Technical Problem

Existing methods for inserting objects into holes on high-friction surfaces are inefficient due to increased frictional forces, which require significant robotic effort, scratch the object, and obscure the detection of the hole's center position, leading to prolonged insertion times.

Method used

A device and method that utilize a gripped object insertion device with a reaction force detection unit and calculation unit to quickly identify the hole's center by scanning and controlling the gripped object's movement based on detected reaction forces, allowing precise insertion into the hole.

Benefits of technology

The method enables rapid detection and insertion of objects into high-friction surfaces by accurately determining the hole's center position, reducing insertion time and minimizing surface scratches.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 0007580997000012
    Figure 0007580997000012
  • Figure 0007580997000013
    Figure 0007580997000013
  • Figure 0007580997000014
    Figure 0007580997000014
Patent Text Reader

Abstract

To provide a method by which a hole formed on an insertion object surface having a high frictional coefficient is promptly detected, and by which a gripping object can be inserted to the hole in a short time.SOLUTION: A gripping object insertion device 1 scans a gripping object 2 gripped by a gripping object drive part while pressing the gripping object against an insertion object, searches for a hole 4 formed in the insertion object, and inserts the gripping object to the hole using the gripping object drive part. The gripping object insertion device comprises: a control part 10 for controlling the gripping object drive part; a reaction force detection part 7 for detecting a reaction force received by the gripping object from the insertion object; and a computation part 11 for computing a center direction of the hole on the basis of a signal detected by the reaction force detection part. When the reaction force detected by the reaction force detection part exceeds a predetermined threshold, the computation part computes a center direction of the hole from a direction of the reaction force detected by the reaction force detection part, and the control part controls the gripping object drive part so that the gripping object is inserted to the hole, on the basis of a result computed by the computation part.SELECTED DRAWING: Figure 1(a)
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] The present invention relates to an apparatus and method for inserting an object to be held, and more particularly to an apparatus and method for inserting an object to be held that are suitable for searching for a hole formed in an object to be inserted and inserting an object into the hole. [Background technology]

[0002] In the manufacturing industry, inserting one part into another is a common task in assembly work. To achieve this, systems are known that consist of a 3D positioning device such as a multi-degree-of-freedom robot that moves the assembly parts, a gripper that grips the assembly parts, the part to be gripped (hereinafter referred to as the gripped object), a workpiece with a hole into which the gripped object is to be inserted, and a reaction force detector that detects the reaction force generated when the gripped object is inserted into the hole of the workpiece.

[0003] The typical method of controlling this system to perform the part insertion task involves pressing the gripped object against the workpiece surface near the hole to be inserted, sliding the object across the workpiece surface, and estimating the center position of the hole to be inserted from the reaction force and torque measured by the reaction force detection unit.

[0004] However, with the above method, when the coefficient of friction of the workpiece surface around the hole is high, the insertion part of the gripped object is scratched by the frictional force, increasing the effort required by the robot, and making it difficult to estimate the center position of the hole to be inserted because the torque and force signals for detecting the hole are covered by noise.

[0005] To solve this problem, a hole search method using a robot is described in Patent Document 1. This patent document describes a hole search method in which a gripped object is tilted at a specific θ angle, the tilted object is slid several times within a predetermined area of ​​a workpiece where a hole to be inserted is expected to be located, and the center position of the hole is estimated based on the shear force of the gripped object detected by a reaction force detection unit. but It has been disclosed. [Prior art documents] [Patent documents]

[0006] [Patent Document 1] JP 2014-155994 A Summary of the Invention [Problem to be solved by the invention]

[0007] However, the hole search method described in Patent Document 1 mentioned above requires the grasped object to be slid over a wide area multiple times in order to estimate the center position of the hole, which has the drawback that it takes time to search for the hole and requires a long operation to insert the grasped object.

[0008] The present invention has been made in consideration of the above-mentioned points, and its object is to provide an object insertion device and method that can quickly find holes formed on the surface of an insertion object having a high friction coefficient, and can insert an object into the hole in a short period of time. [Means for solving the problem]

[0009] In order to achieve the above object, the object insertion device of the present invention is a device for inserting an object by pressing an object held by a drive unit against an object to be inserted and scanning the object. Circular in cross section A gripped object insertion device that searches for a hole and inserts the gripped object into the hole by the gripped object drive unit, A control unit that controls the object drive unit, a reaction force detection unit that detects a reaction force that the object receives from the insertion target, and a calculation unit that calculates a direction in which the object moves toward the center of the hole based on a signal detected by the reaction force detection unit, The calculation unit calculates the direction in which the reaction force detected by the reaction force detection unit faces the center of the hole when the reaction force detected by the reaction force detection unit exceeds a predetermined threshold value, and the control unit controls the object drive unit to insert the object into the hole based on the result of the calculation by the calculation unit.

[0010] In order to achieve the above object, the present invention provides a method for inserting an object, comprising: scanning an object held by a drive unit for the object to be inserted while pressing the object against the object to be inserted; Circular in cross section A method for inserting an object to be held, comprising: searching for a hole; and inserting the object to be held into the hole by the object to be held driving unit, The method is characterized in that a reaction force that the object to be held receives from the object to be inserted is detected by a reaction force detection unit, and when the reaction force detected by the reaction force detection unit exceeds a predetermined threshold value, a calculation unit calculates the direction of the reaction force detected by the reaction force detection unit toward the center of the hole, and based on the result of the calculation by the calculation unit, a control unit controls the object to be held drive unit so as to insert the object to the hole. Effect of the Invention

[0011] According to the present invention, a hole formed in the surface of an object to be inserted, which has a high coefficient of friction, can be quickly found, and an object to be held can be inserted into the hole in a short period of time. [Brief description of the drawings]

[0012] [Figure 1(a)] FIG. 1 shows a schematic configuration of a gripped object insertion device according to a first embodiment of the present invention, illustrating a state in which an object is slid along the surface of a workpiece. [Figure 1(b)] This figure shows the state in which part of the grasped object enters the hole from the state in Figure 1(a), the grasped object comes into contact with the edge of the hole, and the movement of the grasped object is stopped when the force in the y direction of the grasped object's coordinate system exceeds a predetermined threshold. [Figure 1(c)] FIG. 1(b) shows a state in which the object is further moved in the +z direction of the coordinate system until the bottom surface of the object comes into contact with the edge of the hole. [Figure 1(d)] FIG. 1C shows a state in which the robot has retreated in the −z direction of the coordinate system and is completely away from the hole after the center position of the hole has been determined from the state shown in FIG. [Figure 1(e)] FIG. 2 is a diagram showing a state in which the object to be held rotates around the x-axis of the coordinate system, starting from the state in FIG. 1(d), with the center position of the hole as the center on the x-axis. [Figure 1(f)]FIG. 1(c) is a diagram showing a state in which the object to be held is moved in the +z-axis direction of the coordinate system from the state in FIG. 1(e) and inserted into a hole. [Figure 2(a)] 10 is a diagram showing details of a contact state between a tilted object and a hole in the first embodiment of the object insertion device of the present invention. FIG. [Figure 2(b)] FIG. 3 is a top view showing a hole portion in the state of FIG. 2(a). [Diagram 3] 1 is a diagram showing positions for calculating detailed dimensions of a gripped object and holes used in calculating trigonometric functions in the first embodiment of the gripped object insertion device of the present invention, and positions for calculating hole center positions. FIG. [Figure 4] 10 is a top view showing a processing algorithm in which a search path on the y-axis of a workpiece coordinate system does not pass through the center position of a hole in the first embodiment of the object insertion device of the present invention. FIG. [Diagram 5] FIG. 2 is a diagram showing a flowchart of a control algorithm for inserting an object to be held in the first embodiment of the object insertion device of the present invention. [Figure 6(a)] FIG. 11 shows a schematic configuration of a gripped object insertion device according to a second embodiment of the present invention, illustrating a state in which the gripped object is moved in the +Z direction of the workpiece coordinate system until the reaction force Fz detected by the reaction force detection unit exceeds a predetermined threshold value. [Figure 6(b)] FIG. 7 is a diagram showing a state in which the workpiece and the gripped object come into contact with each other from the state shown in FIG. 6(a). [Figure 6(c)] FIG. 7 is a diagram showing a state in which the object to be held is pulled back from the state of FIG. 6(b) to a predetermined initial position Pz on the z-axis and then moved a predetermined movement amount Dxy in the y-direction. [Figure 6(d)] FIG. 7 is a diagram showing a state in which the grasped object has entered the taper from the state shown in FIG. 6(c). [Figure 6(e)] FIG. 7 is a diagram showing a state in which, when the movement distance Dz from the state of FIG. 6(d) is longer than a predetermined threshold value of the movement distance Dz, the control ends because insertion into the hole is possible. [Figure 6(f)] 13 is a diagram showing a state in which an object to be held is inserted into a hole having a taper formed therein; FIG. [Figure 7] FIG. 11 is a diagram showing a flowchart of a control algorithm for inserting an object to be held in the object insertion device according to the second embodiment of the present invention. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0013] The object insertion device and method of the present invention will be described below based on the illustrated embodiments. In each drawing, the same reference numerals are used for the same components. EXAMPLES

[0014] Figures 1(a) to 1(f) show a schematic configuration of a first embodiment of the object insertion device 1 of the present invention and an insertion procedure in which the object insertion device 1 inserts an object 2 to be gripped into a hole 4 formed in a workpiece 3, which is the object to be inserted, using a robot 6, which is the object drive unit, and a gripping unit 5.

[0015] As shown in FIG. 1(a), the gripped object insertion device 1 of this embodiment is roughly composed of a gripped object (e.g., an anchor bolt for an elevator, etc.) 2, a workpiece (e.g., a concrete wall in an elevator hoistway, etc.) 3 with a hole 4 drilled in it, a gripping unit (e.g., a robot hand, etc.) 5, a robot 6, a control unit 10 that controls the robot 6 and the gripping unit 5, a reaction force detection unit (e.g., a force sensor, etc.) 7 that detects the reaction force that the gripped object 2 receives from the workpiece 3, and a calculation unit 11 that calculates the center direction of the hole 4 based on the signal detected by the reaction force detection unit 7, and the control unit 10 and the calculation unit 11 together constitute a control device 9.

[0016] In the object insertion device 1 of this embodiment, when the reaction force detected by the reaction force detection unit 7 exceeds a predetermined threshold value, the calculation unit 11 calculates the center direction of the hole 4 from the direction of the reaction force detected by the reaction force detection unit 7, and the control unit 10 controls the robot 6 and the gripping unit (robot hand) 5 to insert the object 2 to be gripped into the hole 4 based on the result of the calculation by the calculation unit 11.

[0017] In the first embodiment, the surface of the workpiece 3 is flat. In this case, the control unit 10 controls the robot 6 and the gripping unit (robot hand) 5 so as to scan the surface of the workpiece 3 while tilting the gripped object 2 at an angle of θ with respect to the surface of the workpiece 3.

[0018] In this case, the gripped object 2 is scanned with the surface of the workpiece 3 tilted at an angle of θ. After the reaction force detected by the reaction force detection unit 7 exceeds a predetermined threshold value, Grasped object 2 The object to be held 2 is rotated around the axial direction of hole 4 around the contact point between object to be held 2 and hole 4 so that the bottom of object to be held faces the direction in which hole 4 is formed (the downward direction in FIG. 1(a)).

[0019] In addition, as will be described later Grasped object 2 The object 2 is rotated so that the bottom of the object 2 faces the direction in which the hole 4 is formed, and then the object 2 is rotated further in the direction in which the hole 4 is formed. Grasped object 2 Pressing, Grasped object 2 The edge of hole 4 is touched at three points, and the edge of hole 4 and Grasped object 2 The center position of the hole 4 is obtained based on a coordinate system of the three contact points, the dimensions of the hole 4 and the object to be held 2.

[0020] In this embodiment, the object to be grasped 2 and the hole 4 are cylindrical, and the diameters of the object to be grasped 2 and the hole 4 are the same. However, in the object to be grasped insertion device 1 of this embodiment, the diameter of the hole 4 may be larger than the diameter of the object to be grasped 2. Also, the robot 6 may be any robot capable of changing the position and posture of the object to be grasped 2 in three-dimensional space.

[0021] Next, the procedure for inserting the object to be grasped 2 in this embodiment will be described with reference to Figs. 1(a) to 1(f).

[0022] First, the object 2 to be held is tilted around the X-axis of the coordinate system Ow of the workpiece 3 at an angle of θ between 0 degrees and 90 degrees, and the object 2 to be held is moved in the z direction of the coordinate system Op of the object 2 toward the workpiece 3 (the object 2 to be held in the z direction (diagonally downward)) until the force with which the object 2 to be held in the z direction presses the workpiece 3 detected by the reaction force detection unit 7 exceeds a predetermined threshold. After that, while pressing the object 2 in the z direction, the object 2 to be held is slid along the surface of the workpiece 3 as indicated by the thick arrow S (see FIG. 1(a)).

[0023] The area against which the workpiece 3 is pressed is the surface near the center position 8 of the hole 4 that has been detected in advance using a camera and a hole detection algorithm, but since it is difficult to accurately detect the center position 8 of the hole 4 using only a camera and a hole detection algorithm, it is necessary to search for the hole 4. Even if the hole 4 can be accurately detected using a camera and a hole detection algorithm, a positioning error may occur due to the positioning accuracy of the robot 6 or play in the gripping part 5, so it is necessary to search for the hole 4.

[0024] After starting to slide the object 2 along the surface of the workpiece 3, when part of the object 2 enters the hole 4, the object 2 comes into contact with the edge of the hole 4, and the force in the y direction of the coordinate system Op of the object 2 exceeds a predetermined threshold, the movement of the object 2 is stopped (see Figure 1(b)).

[0025] The object to be gripped 2 is pressed in the z direction of the Op coordinate system while sliding along the surface of the workpiece 3, so when the part of the object to be gripped 2 that contacts the surface of the workpiece 3 enters the hole 4, the object to be gripped 3 moves further in the z direction, and part of the side of the object to be gripped 2 always comes into contact with the edge of the hole 4. Next, the object to be gripped 2 is moved further in the +z direction of the Op coordinate system until the bottom surface of the object to be gripped comes into contact with the edge of the hole 4 (see Fig. 1(c)).

[0026] 2(a) and 2(b) are diagrams showing details of the contact state between the object to be gripped 2 and the workpiece 3 in FIG. 1(c).

[0027] As shown in FIG. 2(a) and FIG. 2(b), in the state of FIG. 1(c), thing 2 comes into contact with three points (contact points 21, 22, 23) on the edge of hole 4. The area of ​​the gripped object 2 tilted so that it can contact the workpiece 3 can be considered as the cross section of the gripped object 2 as shown in Figure 2(a). The cross section is an ellipse with minor axis r and major axis r / sinθ as shown in Figure 2(b). If this ellipse is placed on the surface of hole 4 with radius r, three contact points 21, 22, 23 between the gripped object 2 and hole 4 are obtained.

[0028] Contact point 21 is a contact point between the side surface of object 2 to be held and the edge of hole 4 , and contact points 22 and 23 are contact points between the bottom surface of object 2 to be held and the edges of hole 4 .

[0029] In Figure 2(b), the origin of hole 4 is (x o , y o ), and the origin of the ellipse area is (x e , y e ), and the positions of contact points 21, 22 and 23 are represented as (x21, y21), (x22, y22) and (x23, y23), respectively.

[0030] The positions of the contact points 21, 22, and 23 on the work coordinate frame Ow are given as follows: (x o , y o ) is (0, 0), the position of each contact point can be calculated using equations (1) to (6) below.

[0031]

number

[0032]

number

[0033]

number

[0034]

number

[0035]

number

[0036]

number

[0037] In addition, the contact point between the object 2 and the edge of the hole 4 can be used to obtain the center position 8 of the hole 4 using trigonometric methods according to the following equations (7) to (10).

[0038]

number

[0039]

number

[0040]

number

[0041]

number

[0042] In the above formula, P1 is the center position of the bottom surface of the gripped object 2, P2 is the contact point 21 between the side surface of the gripped object 2 and the edge of the hole 4, and P3 is The point where the central axis of the gripped object 2 intersects with the plane of the workpiece 3 In the above equation, the superscripts Op and Ow represent the positions in the coordinate system of the gripped object 2 and the coordinate system of the workpiece 3, respectively.

[0043]

number

[0044] is the transformation matrix from the Op coordinate system to the Ow coordinate system.

[0045] FIG. 3 is a diagram showing detailed dimensions of the object 2 and hole 4 used in the calculation of trigonometric functions, and positions for calculating the center position 8 of the hole 4.

[0046] After the center position 8 of the hole 4 is found, the object 2 retreats by dr (see FIG. 3) in the -z direction of the Op coordinate system and completely leaves the hole 4 (see FIG. 1(d)). After that, the object 2 rotates around the x-axis of the Ow coordinate system, centered on the center position 8 of the hole 4 (see FIG. 1(e)). Finally, the object 2 is moved in the +z-axis direction of the Ow coordinate system and inserted into the hole 4 (see FIG. 1(f)).

[0047] FIG. 4 is a top view showing a processing algorithm when a search movement path 41 on the y-axis of the coordinate system of the workpiece 3 does not pass through the center position 8 of the hole 4. In FIG.

[0048] If the search movement path 41 in the y-axis of the coordinate system of the workpiece 3 does not pass through the central position 8 of the hole 4, when the object to be held 2 contacts the edge of the hole 4 at the contact point 42, the generated reaction force F will be distributed on the x-axis and y-axis, and the direction of the force will be directed toward the central position 8 of the hole 4 (see Fig. 3). After that, to proceed to the step shown in Fig. 1(c), it is only necessary to rotate the object to be held 2 around the z-axis of the Ow coordinate system, centered on the contact point 42.

[0049] To improve robustness, it is possible to confirm the direction of the center position 8 of the hole 4. In this case, the object 2 moves in a new direction obtained by the search movement path 41 shown in FIG. 4(a) until the side of the object 2 comes into contact (contact point 44) with the edge on the opposite side of the hole 4 (opposite side of the contact point 42) (search movement path 43 shown in FIG. 4(b)). If it is found that the reaction force F generated at that time is directed in the opposite direction to the search movement path 43, it is found that the center position 8 of the hole 4 is on the search movement path 43. After that, by proceeding to the step shown in FIG. 1(c), it becomes possible to insert the object 2.

[0050] It is necessary to change the inclination of the object to be held 2 in order to proceed to the search movement path 43. To achieve this, the object to be held 2 is rotated around the z-axis of the Ow coordinate system with the contact point 42 as the center.

[0051] 5 shows a flowchart of a control algorithm for inserting the object 2 in this embodiment. This flowchart is an algorithm for the case where the center position 8 of the hole 4 is not confirmed in the search movement path 43 shown in FIG. 4(b).

[0052] 5, first, the center position 8 of the hole 4 is roughly detected by a well-known hole detection method using image recognition (step 501). The object 2 to be held is tilted at an angle of θ with respect to the surface of the workpiece 3 (step 502, FIG. 1(a)), and the object 2 to be held is pressed against the workpiece 3 in the z-axis direction of Op (step 503, FIG. 1(b)).

[0053] Next, the object 2 is slid in the y direction of the coordinate system of the workpiece 3 (step 504) until the reaction force Fy of the y axis of Op exceeds a predetermined threshold (step 505, FIG. 1(b)). Next, when the reaction force Fx of the x axis of Op also exceeds a predetermined threshold (normally zero) (step 506), the direction of the center position 8 of the hole 4 is calculated by the calculation unit 11, and the amount of rotation required to orient the bottom surface of the object 2 toward the center position 8 of the hole 4 is calculated by the calculation unit 11 (step 507). Then, the object 2 is rotated around the z axis of Ow around the contact point 21, and the bottom of the object 2 is orientated toward the hole 4 (step 508).

[0054] Next, the object 2 is moved in the +z-axis direction (step 509, FIG. 1(c)) until the force Fz in the z-direction exceeds a predetermined threshold (step 510). Then, the center position 8 of the hole 4 is calculated (step 511), and the object 2 is moved by dr in the -z-axis direction of Op (step 512, FIG. 1(d)).

[0055] Next, the object 2 is rotated by θ degrees around the center position 8 of the hole 4 (step 513, FIG. 1(e)). Finally, the object 2 is moved in the +z direction of Ow, and the object 2 is inserted into the hole 4 (step 514, FIG. 1(f)).

[0056] According to this embodiment, it is possible to quickly find the hole 4 formed in the surface of the workpiece 3 having a high friction coefficient, and to insert the object to be gripped 2 into the hole 4 in a short time. EXAMPLES

[0057] 6(a) to 6(f) show a schematic configuration of the embodiment 2 of the object insertion device 1A of the present invention and an insertion procedure in which the object insertion device 1A inserts the object 2 into a hole 62 formed in a workpiece 61, which is an insertion target, using a robot 6, which is a drive unit for the object, and a gripper 5. In this embodiment, a taper 63 is formed in the hole 62 in the workpiece 61. The taper 63 is for widening the opening of the hole 62.

[0058] As shown in FIG. 6(a), the grasped object insertion device 1A of this embodiment is roughly composed of an object to be grasped (e.g., an anchor bolt for an elevator, etc.) 2, a workpiece (e.g., a concrete wall in an elevator hoistway, etc.) 61 with a hole 62 drilled therein, a grasper (e.g., a robot hand, etc.) 5, a robot 6, a control unit 10 that controls the robot 6 and the grasper 5, a reaction force detection unit (e.g., a force sensor, etc.) 7 that detects the reaction force that the grasped object 2 receives from the workpiece 61, and a calculation unit 11 that calculates the center direction of the hole 62 based on the signal detected by the reaction force detection unit 7.

[0059] The calculation unit 11 also includes a movement distance calculation means 65 which calculates the movement distance from an initial position away from the hole 62 in the axial direction of the hole 62 to the position where the held object 2 comes into contact with the workpiece 61, a hole proximity determination means 66 which determines whether or not the held object 2 is approaching the hole 62 and / or recognizes that it is approaching the hole 62 and determines whether it is away from the hole 62 based on the movement distance calculated by the movement distance calculation means 65, and a progress movement amount adjustment means 67 which adjusts the amount of progress movement for searching for the hole 62 based on the determination of the hole proximity determination means 66, and the calculation unit 11 and the control unit 10 constitute the control device 9.

[0060] In the gripped object insertion device 1A of this embodiment, when the reaction force detected by the reaction force detection unit 7 exceeds a predetermined threshold value, the calculation unit 11 calculates the center direction of the hole 62 from the direction of the reaction force detected by the reaction force detection unit 7, and the control unit 10 controls the robot 6 and the gripping unit 5 so as to insert the gripped object 2 into the hole 62 based on the result of the calculation by the calculation unit 11. In this embodiment, a taper 63 is formed at the entrance of the hole 62, and in this case, the gripped object 2 is pushed into the workpiece 61 in a state parallel to the axial direction of the hole 62 with the taper 63 formed at the entrance. death In addition, the control unit 10 controls the robot 6 and the gripping unit (robot hand) 5 to change the position at which the workpiece 61 is pressed when the reaction force detected by the reaction force detection unit 7 is within a predetermined threshold value.

[0061] In this case, before moving the object to be grasped 2 in the search direction of the hole 62, the object to be grasped 2 is pulled to an initial position away from the hole 62 in the axial direction of the hole 62, and then the object to be grasped 2 is moved to the next step in the search direction of the hole 62, and then the object to be grasped 2 is pressed toward the workpiece 61.

[0062] Next, the procedure for inserting the object to be grasped 2 in this embodiment will be described with reference to FIGS. 6(a) to 6(f) and 7. FIG.

[0063] 6(a) to 6(f) show an insertion procedure for inserting the object to be held 2 into the hole 62, and FIG. 7 is a flow chart of the insertion procedure.

[0064] As shown in the figure, in this embodiment, first, the center position of the hole 62 is detected by a well-known hole detection method using image recognition. but Next, the reaction force Fz detected by the reaction force detection unit 7 is roughly detected (step 701). Super The workpiece 61 is moved in the +Z direction of the coordinate system Ow (step 702, FIG. 6(a)) until the workpiece 61 reaches the predetermined threshold (step 703). This indicates contact with the object 2 at the workpiece 61 (FIG. 6(b)). If the reaction force Fz detected by the reaction force detection unit 7 does not reach the predetermined threshold, the movement distance Dz is checked (step 704).

[0065] If the travel distance Dz is longer than the preset travel distance Dz threshold, insertion into the hole 62 is possible, and control ends (FIG. 6(e)). Otherwise, the check continues until the reaction force Fz exceeds the threshold. If the reaction force Fz exceeds the threshold, it is checked whether Fy has exceeded the threshold (step 705). If Fy does not exceed the threshold, this indicates that the object 2 is not inside the taper 63, as shown in FIG. 6(b), and if Fy exceeds the threshold, it indicates that the object 2 is inside the taper 63, as shown in FIG. 6(d).

[0066] In the situation of Fig. 6(b), the object 2 is pulled back to a predetermined initial position Pz on the z-axis of Ow, and then moved in the y-direction of Ow by a predetermined movement amount Dxy (Fig. 6(c)). Then, the process returns to step 702. In the situation of Fig. 6(d), the object 2 also retreats at Pz, but moves by a movement amount Dxy in the direction of the center position of the hole 62 calculated by detecting Fy and Fx (step 710).

[0067] However, before step 709, the movement distance Dz is compared with the previous movement distance Dz to check whether the object to be held 2 is approaching the hole 62 (step 707).

[0068] If the moving distance Dz is greater than the previous moving distance Dz, the object 2 is approaching the hole 62. That If the object 2 has passed through the hole 62, the direction of travel is reversed (step 708) and the travel amount Dxy is increased by 1. but Then, the process proceeds to step 710. This allows the amount of movement Dxy to be finer, and the hole 62 can be found.

[0069] In the above-mentioned method of inserting the gripped object, the movement distance calculation means 65 calculates the movement distance Dz from the initial position Pz away from the hole 62 in the axial direction of the hole 62 to the position where the gripped object 2 comes into contact with the workpiece 61, and based on the movement distance Dz calculated by the movement distance calculation means 65, the hole proximity determination means 66 determines whether the gripped object 2 is approaching the hole 62 and / or recognizes that it is approaching the hole 62 and determines that it is away from the hole 62, and based on the determination by the hole proximity determination means 66, the progress movement amount for searching for the hole 62 is adjusted by the progress movement amount adjustment means 67.

[0070] According to this embodiment, even if a taper 63 is formed in the hole 62 of the workpiece 61, the hole 62 formed in the surface of the workpiece 61 having a high coefficient of friction can be quickly found, and the object to be held 2 can be inserted into the hole 62 in a short period of time.

[0071] The present invention is not limited to the above-mentioned embodiment, and various modifications are included. For example, the above-mentioned embodiment has been described in detail to easily explain the present invention, and is not necessarily limited to those having all the configurations described. Also, it is possible to replace a part of the configuration of one embodiment with the configuration of another embodiment, and it is also possible to add the configuration of another embodiment to the configuration of one embodiment. Also, it is possible to add, delete, or replace a part of the configuration of each embodiment with another configuration. [Explanation of symbols]

[0072] 1, 1A...grasped object insertion device, 2...grasped object, 3, 61...workpiece, 4, 62...hole, 5...grasping unit, 6...robot, 7...reaction force detection unit, 8...center position of hole, 9...control device, 10...control unit, 11...calculation unit, 21, 42, 44...contact point between side of gripped object and edge of hole, 22, 23...contact point between bottom surface of gripped object and edge of hole, 41, 43...search movement path, 63...taper, 64...initial position of z-axis movement in work coordinate system, 65...movement distance calculation means, 66...hole proximity determination means, 67...progress movement amount adjustment means, 501-514...steps of work flow of Example 1, 701-710...steps of work flow of Example 2.

Claims

1. A gripped object insertion device in which a gripped object drive unit scans a gripped object while pressing it against an insertion object, searches for a hole having a circular cross section formed in the insertion object, and the gripped object is inserted into the hole by the gripped object drive unit, A control unit that controls the object drive unit, a reaction force detection unit that detects a reaction force that the object receives from the insertion target, and a calculation unit that calculates a direction in which the object moves toward the center of the hole based on a signal detected by the reaction force detection unit, The calculation unit calculates the direction in which the reaction force detected by the reaction force detection unit faces the center of the hole when the reaction force detected by the reaction force detection unit exceeds a predetermined threshold value, and the control unit controls the object drive unit to insert the object into the hole based on the result of the calculation by the calculation unit.

2. The object insertion device according to claim 1, The control unit controls the object drive unit to scan the surface of the object to be inserted while tilting the object at an angle of θ with respect to the surface of the object to be inserted.

3. The object insertion device according to claim 2, A gripped object insertion device characterized in that the gripped object is scanned while tilted at an angle of θ with respect to the surface of the object to be inserted, and after the reaction force detected by the reaction force detection unit exceeds a predetermined threshold, the gripped object is rotated around the contact point between the gripped object and the hole so that the bottom of the gripped object is in the direction in which the hole is formed.

4. The object insertion device according to claim 3, A gripped object insertion device characterized in that after rotating the gripped object so that the bottom of the gripped object faces the direction in which the hole is formed, the gripped object is further pressed in the direction in which the hole is formed, and the gripped object is brought into contact with three points on the edge of the hole.

5. The object insertion device according to claim 4, A gripped object insertion device, characterized in that the center position of the hole is determined using a coordinate system of three contact points between the edge of the hole and the gripped object, and the dimensions of the hole and the gripped object.

6. The object insertion device according to claim 1, The hole has an entrance formed in a tapered shape, and the object is pressed against the object to be inserted in a state parallel to an axial direction of the hole having the entrance formed in a tapered shape; The control unit controls the object drive unit to change the position against which the object to be inserted is pressed when the reaction force detected by the reaction force detection unit is within a predetermined threshold value.

7. The object insertion device according to claim 6, A gripped object insertion device characterized in that before moving the gripped object in the search direction of the hole, the gripped object is pulled to an initial position away from the hole in the axial direction of the hole, and then the gripped object is moved to the next step in the search direction of the hole and then pressed toward the insertion object.

8. The object insertion device according to claim 7, a movement distance calculation means for calculating a movement distance of the gripped object from the initial position to a position where the gripped object comes into contact with the insertion target; a hole proximity determination means for determining whether the robot is approaching the hole and / or recognizing that the robot is approaching the hole and determining that the robot is away from the hole based on the movement distance calculated by the movement distance calculation means; a travel distance adjustment means for adjusting a travel distance for searching for the hole based on a determination made by the hole proximity determination means.

9. The object insertion device according to any one of claims 1 to 8, the insertion object is a workpiece, the gripping object driving unit is a robot and a robot hand, and the reaction force detection unit is a force sensor, The calculation unit calculates the direction in which the reaction force detected by the force sensor moves toward the center of the hole formed on the workpiece when the reaction force detected by the force sensor exceeds a predetermined threshold, and the control unit controls the robot and robot hand to insert the object into the hole based on the result of the calculation by the calculation unit.

10. A method for inserting an object, comprising: scanning an object held by a gripping object driving unit while pressing the object against an insertion object; searching for a hole having a circular cross section formed in the insertion object; and inserting the object into the hole by the gripping object driving unit, A method for inserting an object to be held, comprising the steps of: detecting a reaction force that the object to be held receives from the object to be inserted using a reaction force detection unit; when the reaction force detected by the reaction force detection unit exceeds a predetermined threshold value, calculating by a calculation unit the direction of the reaction force detected by the reaction force detection unit, which is the direction in which the object to be held faces the center of the hole; and controlling by a control unit the object to be held drive unit so as to insert the object into the hole based on the result of the calculation by the calculation unit.

11. The method for inserting an object according to claim 10, A method for inserting an object to be held, characterized in that the control unit controls the object to be held drive unit to scan the surface of the object to be inserted while the object to be held is tilted at an angle of θ with respect to the surface of the object to be inserted.

12. The method for inserting an object according to claim 11, A method for inserting an object, comprising: scanning the object while tilted at an angle of θ with respect to the surface of the object to be inserted; and rotating the object around the contact point between the object and the hole so that the bottom of the object is in the direction in which the hole is to be formed after the reaction force detected by the reaction force detection unit exceeds a predetermined threshold.

13. The method for inserting an object according to claim 12, A method for inserting a gripped object, comprising: rotating the gripped object so that the bottom of the gripped object faces the direction in which the hole is formed; then, pressing the gripped object further in the direction in which the hole is formed, bringing the gripped object into contact with three points on the edge of the hole; and determining the center position of the hole using a coordinate system of the three contact points between the edge of the hole and the gripped object and the dimensions of the hole and the gripped object.

14. The method for inserting an object according to claim 10, The hole has an entrance formed in a tapered shape, and the object is pressed against the object to be inserted in a state parallel to an axial direction of the hole having the entrance formed in a tapered shape; A method for inserting an object to be held, characterized in that when the reaction force detected by the reaction force detection unit is within a predetermined threshold value, a control unit controls the object to be held drive unit to change the position against which the object to be inserted is pressed.

15. The method for inserting an object according to claim 14, A method for inserting an object to be gripped, characterized in that before moving the object to be gripped in the search direction of the hole, the object is pulled to an initial position away from the hole in the axial direction of the hole, and then the object is moved to the next step in the search direction of the hole and then pressed toward the object to be inserted.

16. The method for inserting an object according to any one of claims 10 to 15, the insertion object is a workpiece, the gripping object driving unit is a robot and a robot hand, and the reaction force detection unit is a force sensor, A method for inserting an object to be grasped, characterized in that, based on a signal detected by the force sensor which detects the reaction force received by the workpiece by the calculation unit, when the reaction force detected by the force sensor exceeds a predetermined threshold value, the calculation unit calculates the direction of the reaction force detected by the force sensor to be the direction in which the object to be grasped faces the center of the hole, and, based on the result of the calculation by the calculation unit, a control unit controls the robot and robot hand to insert the object to the hole.

Citation Information

Patent Citations

  • Control method of manipulator

    JP1986208514A

  • Assembling method and device

    JP2008221387A

  • Control method and control device for assembly operation robot

    JP2009061550A

  • Pin fitting method and pin pulling out method

    JP2010099784A

  • Assembly robot

    JP2013107175A