Device for determining interference region of robot

• US 20050055134A1
• Filed: 09/03/2004
• Published: 03/10/2005
• Est. Priority Date: 09/04/2003
• Status: Abandoned Application

• Current Assignee: Fanuc Ltd (Fanuc Corporation)
• Original Assignee: Fanuc Ltd (Fanuc Corporation)
• Inventors: Okuda, Mitsuhiro, Fuchigami, Hirokazu
• Application Number:
  US10/933,432
• Publication Number:
  US 20050055134A1
• Time in Patent Office: Days
• US Class Current: 700/245
• CPC Class Codes: B25J 9/1666 Avoiding collision or forbidden zones
• CPC Class Codes: G05B 19/4061 Avoiding collision or forbidden zones
• CPC Class Codes: Y02P 90/02 Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Abstract

A device for determining an interference region of a robot, capable of determining an interference region/non-interference region and the like on an off-line layout space without difficulty. Geometric data of a robot and peripheral objects is read from a CAD system or the like to be displayed in the form of a layout display, to thereby form a cage region. An initial occupied region is found by calculating a three-dimensional position of each arm at an initial position. An operation simulation is run, and the tree-dimensional positions are repeatedly calculated, thereby finding the aggregate sum of the occupied region. After the robot is moved, a total occupied region G, an overlapping region H, a protruding region K, a non-occupied region M and the like are displayed in different colors, to thereby perform layout correction of a peripheral object, a change of the cage region, etc. It is also possible to judge the presence or absence of the overlapping region H/protruding region K and to search “a hidden non-occupied region” by way of a sectional display in which points A, B and C are designated.

Claims

1. A device for determining an interference region of a robot, comprising:

storage means storing a geometric model of a robot arm;

position/posture calculation means for successively calculating position/posture of the robot arm in accordance with a motion command read from an operation program of the robot;

occupied region-calculating means for calculating a region occupied by the robot arm when the robot arm takes the position/posture in accordance with the motion command based on the calculated position/posture and the geometric model of the robot arm;

means for obtaining and updating a total occupied region of the robot arm by successively and aggregately adding the calculated occupied regions of the robot arm and store the updated total occupied region; and

displaying means for displaying the updated total occupied region on a display screen.

2. A device for determining an interference region of a robot according to claim 1, further comprising cage region setting means for setting a cage region, wherein said displaying means displays the set cage region on the display screen.

3. A device for determining an interference region of a robot according to claim 2, wherein said displaying means displays a non-occupied region not belonging to the total occupied region within the set cage region on the display screen.

4. A device for determining an interference region of a robot according to claim 2, wherein said displaying means displays a protruding region belonging to the total occupied region outside the set cage region on the display screen.

5. A device for determining an interference region of a robot according to claim 1, wherein said storage means further stores a geometric model of a peripheral object to be arranged in the vicinity of the robot arm, and said displaying means displays a region occupied by the peripheral object based on designated position/posture of the peripheral object and the stored geometric model of the peripheral object and displays an overlapping region where the region occupied by the peripheral object overlaps the total occupied region.

6. A device for determining an interference region of a robot according to claim 5, further comprising means for altering position/posture of the geometric model of the peripheral object on the display-screen and means for storing the altered position/posture of the peripheral object.

7. A device for determining an interference region of a robot according to claim 1, wherein said storage means further stores a geometric model of a peripheral object to be arranged in the vicinity of the robot arm, and said device further comprises:

judging means for obtaining a region occupied by the peripheral object based on designated position/posture of the peripheral object and the stored geometric model of the peripheral object, and judging whether or not an overlapping region where the region occupied by the peripheral object overlaps the total occupied region exists; and

message issuing means for issuing a message indicating an existence of the overlapping region when it is judged that there exists the overlapping region by said judging means.

8. A device for determining an interference region of a robot according to claim 7, further comprising means for altering position/posture of the geometric model of the peripheral object on the display screen and means for storing the altered position/posture of the peripheral object.

9. A device for determining an interference region of a robot according to claim 1, wherein said displaying means displays a sectional view of the total occupied region taken along a designated plane.

10. A device for determining an interference region of a robot, comprising:

storage means storing geometric models of a robot arm and an end effector mounted on the robot arm;

position/posture calculation means for successively calculating position/posture of the robot arm and the end effector in accordance with a motion command read from an operation program of the robot;

occupied region-calculating means for calculating a region occupied by the robot arm and the end effector when the robot arm and the end effector take the position/posture in accordance with the motion command based on the calculated position/posture and the geometric model of the robot arm and the end effector;

means for obtaining and updating a total occupied region of the robot arm and the end effector by successively and aggregately adding the calculated occupied regions of the robot arm and the end effector and store the updated total occupied region; and

displaying means for displaying the updated total occupied region on a display screen.