Obstacle search device for robot system

By using the contactless three-dimensional measurement unit in the robot system to automatically search for obstacles and divide the search space, the problem of manually inputting obstacle information and repeated search in the prior art is solved, and efficient and accurate action path generation and search efficiency are achieved. promote.

CN112045674BActive Publication Date: 2024-12-06FANUC LTD
View PDF 3 Cites 0 Cited by

Patent Information

Application Number
CN202010499797.X
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Priority Date
2019-06-07
Filing Date
2020-06-04
Publication Date
2024-12-06
Estimated Expiration
2040-06-04

AI Technical Summary

Technical Problem

In the prior art, robot systems need to manually input when updating obstacle information, which is prone to human errors, and they need to re-search the space every time they change the action range, resulting in inefficiency.

Method used

The contactless three-dimensional measurement unit automatically searches for obstacles, divides the search space into a cube area, and uses a three-dimensional measurement machine to automatically determine the area where obstacles exist and automatically generates an action path that does not interfere with the obstacles.

Benefits of technology

It realizes efficient and accurate search and action path generation, avoids human errors, improves search efficiency and path generation accuracy, and can automatically adjust the search area and reduces repeated searches.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN112045674B_ABST
    Figure CN112045674B_ABST
Patent Text Reader

Abstract

The present invention provides an obstacle search device for a robot system, which does not require manual input and does not cause human errors, thereby being able to efficiently and correctly create a robot motion path that does not interfere with obstacles. A device for automatically determining an area where obstacles exist and automatically generating a robot motion path that does not interfere with obstacles comprises: a non-contact three-dimensional measuring unit (2) mounted on a robot; and an obstacle search unit (3) which uses the three-dimensional measuring unit (2) to search for obstacles in a search space.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to an obstacle searching device of a robot system. Background Art

[0002] Conventionally, when driving a robot such as an industrial robot, for example, a technology is used that automatically generates a motion path for the robot to avoid interfering with the obstacle based on information about the obstacle.

[0003] Patent document 1 discloses the following: "A robot system includes a robot controller and a teaching device, which performs an operation of holding a workpiece arranged at a first specified position by an end effector and assembling it to a second specified position. The robot controller includes: a robot having a plurality of joints and the end effector mounted at a front end; a teaching data storage unit which stores teaching data and an operation program of the robot; an instruction generation unit which generates an action instruction for the robot based on the operation program; and a servo control unit which drives the servo motors of the joints of the robot according to the action instruction. The teaching device is connected to the robot control device. The robot system is characterized in that the robot controller includes a posture calculation unit which generates an operation program for assembling by avoiding obstacles based on temporarily taught workpiece holding points and assembly points, positions of passing points between the workpiece holding points and assembly points, the postures of the end effector at the workpiece holding points and assembly points, and positions of obstacles existing around the robot, and stores the operation program in the teaching data storage unit."

[0004] Patent document 2 shows the following: "A remote operation assistance device, characterized in that it comprises: a three-dimensional recognition unit, which three-dimensionally recognizes an object based on point group data measured by a three-dimensional measuring machine, and determines the shape, position and posture of the object; an object model representation unit, which generates an object model representation reflecting the shape, position and posture of the object determined by the three-dimensional recognition unit; a display unit, which displays the object model representation generated by the object model representation unit; a robot action sequence indication unit, which determines an operation object model operated by a robot from the object model displayed by the display unit based on indication information from the outside, and generates an action sequence of the robot for the operation object model; and an action sequence determination unit, which determines the action sequence of the robot to avoid obstacles based on the action sequence indicated by the robot action sequence indication unit, and outputs the determined action sequence to the display unit."

[0005] Prior art literature

[0006] Patent Literature

[0007] Patent Document 1: Japanese Patent Application Publication No. 2010-142910

[0008] Patent Document 2: Japanese Patent Application Publication No. 2010-94777 Summary of the invention

[0009] Problem that the invention aims to solve

[0010] However, in the method disclosed in Patent Document 1, it is necessary to prepare obstacle information in advance and manually input it into the motion path generation device, resulting in input work every time the obstacle is updated. In addition, it is also possible that the robot and the obstacle may interfere with each other due to incorrect information input. In the method disclosed in Patent Document 2, every time the robot's motion range is changed, it is necessary to search again including the space that has been searched.

[0011] Solutions for solving problems

[0012] One embodiment of the obstacle search device of the robot system disclosed in the present invention is a device that can automatically determine an area where obstacles exist and automatically generate a movement path for the robot that does not interfere with the obstacles. The obstacle search device of the robot system comprises: a non-contact three-dimensional measurement unit installed on the robot; and an obstacle search unit, which uses the three-dimensional measurement unit to search for obstacles in a search space.

[0013] Effects of the Invention

[0014] According to one embodiment of the obstacle searching device of the robot system of the present disclosure, a non-contact three-dimensional measuring unit (three-dimensional measuring machine) is mounted on the robot, and the three-dimensional measuring unit is used to search for obstacles.

[0015] Thus, the position and posture of the three-dimensional measurement unit can be automatically and freely changed by moving the robot, and a wide range in space can be efficiently and effectively searched. In addition, since blind spots are not easily generated, actions such as entering gaps between obstacles can be realized, and areas without obstacles can be efficiently and accurately determined effectively.

[0016] Therefore, by outputting / reflecting the search result to the motion path generation device, manual input as in the past is no longer necessary, and human errors are eliminated, thereby making it possible to efficiently and accurately create / realize the motion path of the robot that does not interfere with obstacles. BRIEF DESCRIPTION OF THE DRAWINGS

[0017] Figure 1 1 is a block diagram showing an obstacle search device of a robot system according to one embodiment.

[0018] Figure 2 The present invention is a flowchart showing a method of determining an area where a robot does not interfere with an obstacle using an obstacle search device of a robot system according to one embodiment.

[0019] Figure 3 This is a diagram showing a state where a search area is set when an obstacle search device of a robot system according to one embodiment is used to determine an area where the robot does not interfere with an obstacle.

[0020] Figure 4 This is a diagram showing a state in which a search area is divided when an obstacle search device of a robot system according to one embodiment is used to determine an area in which the robot does not interfere with an obstacle.

[0021] Figure 5 1 is a diagram showing a state in which a search is performed using an obstacle search device of a robot system according to one embodiment.

[0022] Figure 6 This is a diagram showing a state in which an obstacle searching device of a robot system according to one embodiment searches and continuously determines whether or not there is an obstacle in a divided area.

[0023] Figure 7 This is a diagram showing a state in which an obstacle searching device of a robot system according to one embodiment searches and continuously determines whether or not there is an obstacle in a divided area.

[0024] Description of Reference Numerals

[0025] 1: Robot; 2: Three-dimensional measuring machine (three-dimensional measuring unit); 3: Obstacle search unit; 4: Search space setting unit; 5: Search space division unit; 6: Unsearched initial setting unit; 7: Obstacle search confirmation unit; 8: Unsearched area confirmation unit; 9: Obstacle-free area setting unit; 10: Marking unit; A: Obstacle search device of the robot system; M: Obstacle; R: Search space; R1: Cube area (divided area); R2: Cube area (divided area) where obstacles exist; R3: Cube area (divided area) where obstacles do not exist. DETAILED DESCRIPTION

[0026] Below, refer to Figures 1 to 7 Here, an obstacle search device for a robot system according to an embodiment is described. Here, the device according to this embodiment is used, for example, when driving an industrial robot, to automatically determine an area where obstacles exist and automatically generate a movement path for the robot that does not interfere with the obstacles.

[0027] like Figure 1 (and Figure 3), the obstacle search device A of the robot system of this embodiment comprises: a non-contact three-dimensional measuring machine (three-dimensional measuring unit) 2, which is installed on the robot 1; and an obstacle search unit 3, which uses the three-dimensional measuring machine 2 to search for obstacles M in the search space R.

[0028] like Figure 1 (and Figure 4 ), the obstacle search unit 3 includes: a search space setting unit 4, which sets a specified space as a search space R; a search space division unit 5, which divides the search space R set by the search space setting unit 4 into cubic areas R1 of a specified size; and an unsearched initial setting unit 6 (marking unit 10), which sets all cubic areas R1 in the search space R divided by the search space division unit 5 as "unsearched", and indicates the meaning of "unsearched" by marking in a management list, etc.

[0029] And, if Figure 1 (as well as Figure 5 , Figure 6 , Figure 7 ), the obstacle search unit 3 comprises: an obstacle search confirmation unit 7, which moves the robot 1 to update the position and posture of the three-dimensional measuring machine 2, and confirms whether there is an obstacle M in the cube area R1 in the search space R; an unsearched area confirmation unit 8, which confirms whether there is an unsearched cube area R1 for all cube areas R1 other than the cube area R1 determined by the obstacle search confirmation unit 7 as being unmeasurable; and an obstacle-free area setting unit 9 (marking unit 10), which sets the cube area R1 (R3) where there is no obstacle M as "obstacle-free" and indicates the meaning of "obstacle-free" by marking it in a management list, etc.

[0030] A method of automatically specifying the region R2 where the obstacle M exists using the obstacle search device A of the robot system according to this embodiment will be described.

[0031] First, if Figure 2 and Figure 3 ( Figure 1 ), a non-contact three-dimensional measuring machine (three-dimensional measuring unit) 2 such as a laser scanner is installed on the robot 1, and it is prepared to be able to automatically search for obstacles M by changing the position and posture of the three-dimensional measuring machine 2 by moving the robot 1.

[0032] Then, if Figure 2 and Figure 4 ( Figure 1), the search space setting unit 4 sets the specified space in which the robot 1 can move as the search space R, and the search space dividing unit 5 divides the search space R set by the search space setting unit 4 into cubic areas R1 of a specified size (step 1).

[0033] Next, the unsearched initialization setting unit 6 (marking unit 10) sets all cubic regions R1 in the search space R divided by the search space dividing unit 5 as "unsearched", and marks the meaning of "unsearched" in the management list or the like (step 2).

[0034] Then, if Figure 2 and Figure 5 ( Figure 1 ), the obstacle search and confirmation unit 7 moves the robot 1 while updating the position and posture of the three-dimensional measuring machine 2, and continuously confirms whether there are obstacles M in the search space R (steps 3 and 4).

[0035] Then, when there is no obstacle M in the cube area R1 of the measurement range, the obstacle-free area setting unit 9 (marking unit 10) sets / determines the cube area R1 (R3) as "obstacle-free" and marks the meaning of "obstacle-free" in the management list, etc. (step 5).

[0036] Furthermore, the unsearched region confirmation unit 8 confirms whether there is a measurable and unsearched cubic region R1 (step 6 ). If there is no measurable and unsearched cubic region R1 , the search ends.

[0037] On the other hand, when there is an obstacle M in the cubic region R1 of the measurement range, the cubic region R1 (R2) where the obstacle M exists is set as "with an obstacle", and the meaning of "with an obstacle" is indicated by marking it in the management list or the like (step 7). In addition, at the same time, the cubic region R1 (R3) between the three-dimensional measuring machine 2 and the cubic region R1 (R2) where the obstacle M exists is set / determined as "without an obstacle", and the meaning of "without an obstacle" is indicated by marking it in the management list or the like (step 8).

[0038] Next, the unsearched area confirmation unit 8 confirms whether there is a cube area R1 that can be measured but has not been searched (step 6). If there is a cube area R1 that can be measured but has not been searched, the obstacle search confirmation unit 7 moves the robot 1 while updating the position and posture of the three-dimensional measuring machine 2, and continues to confirm whether there are obstacles M in the search space R (steps 3 and 4), and the same operations as above are repeated continuously.

[0039] The unsearched region confirmation unit 8 confirms whether there is a measurable and unsearched cubic region R1 (step 6 ). If there is no measurable and unsearched cubic region R1 , the search ends.

[0040] Furthermore, in the obstacle searching device A of the robot system of the present embodiment having the above-described structure, first, the non-contact three-dimensional measuring device 2 is mounted on the robot 1, and the obstacle M is searched for using the three-dimensional measuring device 2.

[0041] Thus, the position and posture of the three-dimensional measuring machine 2 can be automatically and freely changed by moving the robot, so that a wide range in the space can be efficiently and effectively searched. In addition, since blind spots are not easily generated, actions such as entering the gap between obstacles M can be realized, and the area R3 where there is no obstacle M can be efficiently and accurately determined.

[0042] Therefore, according to the obstacle search device A of the robot system of the present embodiment, by outputting / reflecting the search results to the motion path generation device, it is unnecessary to input manually as in the past, and human errors are not generated, and the motion path of the robot 1 that does not interfere with the obstacle M can be efficiently and correctly created / realized. Furthermore, when the search space R is expanded by changing the motion range of the robot after the search, etc., the search results of each cubic region R1 obtained by the previous search can be used, and an efficient search without duplication can be performed.

[0043] In addition, in the obstacle search device A of the robot system of the present embodiment, an arbitrary search space R is divided into cube regions R1 based on an arbitrary resolution, and the cube regions R1 are set as search units, so that the higher the resolution, the smaller the cube regions R1 can be set, and the more the number of cube regions R1 can be set. In this way, the search accuracy can be freely set as needed, so that the action path of the robot 1 that does not interfere with the obstacle M can be efficiently and effectively created / realized.

[0044] An embodiment of the obstacle searching device for a robot system has been described above, but the present invention is not limited to the above-described embodiment and can be modified as appropriate within the scope of the present invention.

[0045] For example, in the present embodiment, the search space R is divided into a plurality of cubic regions R1 , but the divided regions do not necessarily need to be cubic.

Claims

1. An obstacle search device for a robot system, which is a device capable of automatically determining an area where obstacles exist and automatically generating a movement path for the robot that does not interfere with the obstacles, the obstacle search device for the robot system comprising: a non-contact three-dimensional measuring unit installed on the robot; and an obstacle search unit that searches for obstacles in the search space using the three-dimensional measurement unit, in, The obstacle search unit includes: a search space setting unit that sets a predetermined space in which the robot can move as the search space; A search space division unit that divides the search space set by the search space setting unit into a plurality of regions of a predetermined size; as well as The obstacle search and confirmation unit is configured to confirm the presence or absence of obstacles in the divided regions of the search space while moving the robot to update the position and posture of the three-dimensional measurement unit.

2. The obstacle search device of the robot system according to claim 1, wherein: The obstacle search unit further comprises: an unsearched initial setting unit, which sets all areas cut out by the search space division part as "unsearched"; an obstacle-free area setting unit, which sets an area without obstacles as "obstacle-free"; as well as The unsearched area confirmation unit confirms whether there is an unsearched area in the area other than the area where the obstacle exists.

Citation Information

Patent Citations

  • Remote control support device

    JP2010094777A

  • Robot system

    JP2010142910A

  • Visual-based obstacle detection method and apparatus for mobile robot

    US20150314443A1