Method and apparatus for controlling robots and the like using a bubble data hierarchy placed along a medial axis

• US 6,089,742 A
• Filed: 11/01/1989
• Issued: 07/18/2000
• Est. Priority Date: 11/01/1989
• Status: Expired due to Fees

• Current Assignee: US Philips Corporation (Koninklijke Philips N.V.)
• Original Assignee: US Philips Corporation (Koninklijke Philips N.V.)
• Inventors: Warmerdam, Thomas P. H., Verwer, Bernard J. H.
• Primary Examiner(s): Ruggiero, Joseph
• Application Number:
  US07/430,749
• Time in Patent Office: 3,912 Days
• Field of Search: 364/513, 364/461, 364/424.2, 364/474.02, 364/559, 364/167.01, 901/50, 901/49, 701/301, 701/210, 701/23-28, 395/85, 395/88, 395/90
• US Class Current: 700/56
• CPC Class Codes: B25J 9/1666 Avoiding collision or forbidden zones

Abstract

A robotic controller or similar machine represents the shape of an object as a hierarchy of bubbles. The position and radius of each of the bubbles is determined by first calculating the coordinates of the medial axis of the object and then creating a hierarchy of bubbles all of which are disposed on the medial axis. The bubbles may be generated using a top-down algorithm which sequentially places bubbles around portions of the object represented by sub-divisions of branches of the medial axis. Alternatively the bubbles may be placed by using a bottom-up algorithm which combines the smallest of a large number of bubbles centered on the medial axis with its smallest neighbor to generate successively higher level bubbles in the hierarchy.

Claims

1. A machine having a memory which contains a data structure which represents the shape of a physical object in a position and/or motion control machine as a hierarchy of bubbles generated by a method comprising the steps of:

first locating the medial axis of the object and

then creating a hierarchy of bubbles on the medial axis.

2. The machine of claim 1 wherein the step of creating the hierarchy comprises a top-down procedure of:

first placing a root bubble which is centered at the center of gravity of the object and has a radius equal to the maximum distance from the center of gravity to the contour of the object;

next, if the medial axis has a plurality of branch lines, placing a plurality of first successive bubbles each of which encompasses a distinct part of the object which is described by one of said branch lines; and

then successively dividing each line of the medial axis into two new line parts and placing a pair of next successive bubbles each of which encompasses a distinct part of the object which is described by one said new line parts.

3. The machine of claim 1 wherein the step of creating the hierarchy comprises a bottom-up procedure of:

first representing the medial axis as large plurality of discrete points;

next placing the centers of a plurality of lowest level bubbles at said discrete points, where the radius of each bubble is equal to the minimum distance from the corresponding center point to the contour of the object; and

then successively creating new bubbles by merging the smallest bubble remaining with its smallest neighbor(s) to create a new bubble and repeating this step until only one root bubble remains.

4. The machine of claim 1 wherein two old bubbles are merged to yield a new bubble in accordance with the formulas:

##EQU2## wherein r1 and r2 are the radii of the old bubbles, j is the distance between the centers of the old bubbles, (x1,y1,z1) and (x2,y2,z2) are the coordinates of the center of the old bubbles, r'"'"' is the radius of the new bubble, and (x'"'"',y'"'"',z'"'"') are the coordinates of the center of the new bubble.

5. A robotic controller comprising:

means for controlling the motion of one or more objects, said means for controlling responsive to a means for generating a data structure;

said means for generating a data structure representative of the shape of one or more of said objects which includes;

a) means for calculating the position of the medial axis of said object and

b) means for creating the hierarchy of bubbles all of which have centers which are disposed on the medial axis.