US5835684A
Expired / Lapsed
US
⏱️ 0.0 years remaining
Method for planning/controlling robot motion
Assignee: Amada Co Ltd
•
Filing: 1994-11-09
•
Granted: 1998-11-10
•
Expires: 2014-11-09
Abstract
Abstract A computerized method/system is provided for planning motion of a robot within a free space confined by obstacles, from an initial position to a goal position. In executing the method/system, a plan is generated so that the robot can hold and maneuver a workpiece throughout a sequence of bending operations to be performed by a bending apparatus. A plurality of proposed movements to be made by the robot are proposed for an mth movement within a sequence of movements, and at least a portion of the robot and the obstacles that confine the free space are modeled. A determination is made as to whether a collision will occur between the robot and an obstacle for each proposed movement, and a plan is generated including the sequence of movements by choosing for each movement in the sequence of movements, a proposed movement that will not result in a collision and that will bring the robot closer to the goal position. In choosing proposed movements, an estimated cost associated with each proposed movement may be taken into account. The estimated cost may be based upon a euclidian distance to the goal position from the position of the robot after the particular proposed movement is made as the mth movement, and/or the estimated cost may be determined as a function of the robot travel time from an (m-1)th movement to the mth movement. Different methods are provided for performing fine motion planning and gross motion planning.
Inventors
- 👤 David Alan Bourne
- 👤 Sivaraj Sivarama Krishnan
Bibliographic Details
Application Number
—
Jurisdiction
US
Data Source
google_patents
Last Synchronized
2026-11-03 16:04
CPC Classifications
B; B25; B25J; B25J9/00; B25J9/16; B25J9/1656; B25J9/1664; B25J9/1666; G; G05; G05B; G05B2219/00; G05B2219/30; G05B2219/40; G05B2219/40421; G05B2219/40444; G05B2219/40445; G05B2219/40446; G05B2219/40458; G05B2219/40463; G05B2219/40476; G05B2219/40488; G05B2219/40497; G05B2219/45; G05B2219/45143
Claims Analysis
Total Claims: 68
Claim 1
Independent Claim
181 words
In a computer having at least one processor and a memory, a method for planning motion of a robot within free space, restricted by obstacles, from an initial position to a goal position, said obstacles comprising components of a bending apparatus, said method comprising: proposing, for a movement within a sequence of movements, a plurality of proposed movements to be made by the robot; modeling at least a portion of the robot and the obstacles that restrict the free space; determining whether a collision will occur between the robot and an obstacle for a proposed movement being executed as said movement within said sequence of movements; and generating a plan including said sequence of movements, by choosing, for each movement in said sequence of movements, a proposed movement that will not result in a collision and that will bring the robot closer to the goal position, said generating a plan comprising planning a gross motion plan including movements of the robot in the free-space and planning a fine motion plan including movements of the robot to and from the bending apparatus.
Claim 2
Dependent Claim
181 words
In a computer having at least one processor and a memory, a method for planning motion of a robot within free space, restricted by obstacles, from an initial position to a goal position, said obstacles comprising components of a bending apparatus, said method comprising: proposing, for a movement within a sequence of movements, a plurality of proposed movements to be made by the robot; modeling at least a portion of the robot and the obstacles that restrict the free space; determining whether a collision will occur between the robot and an obstacle for a proposed movement being executed as said movement within said sequence of movements; and generating a plan including said sequence of movements, by choosing, for each movement in said sequence of movements, a proposed movement that will not result in a collision and that will bring the robot closer to the goal position, said generating a plan comprising planning a gross motion plan including movements of the robot in the free-space and planning a fine motion plan including movements of the robot to and from the bending apparatus.
Claim 3
Dependent Claim
32 words
The method according to claim 1, wherein said robot comprises a robot gripper for holding and maneuvering a workpiece throughout a sequence of bending operations to be performed by the bending apparatus.
Claim 4
Dependent Claim
70 words
The method according to claim 2, wherein: said fine motion planning comprises planning a plurality of free space fine motion solution paths that extend between a plurality of respective pairs of positions, q i and q g ; and said gross motion planning comprises planning a plurality of free space gross motion solution paths that extend between a plurality of respective pairs of positions, Q i and Q g .
Claim 5
Dependent Claim
69 words
The method according to claim 3, wherein said fine motion planning comprises performing said steps of proposing, modeling, determining and generating, for each pair of positions q i and q g , said proposing step comprising specifying a plurality of movements in configuration space for the said movement in said sequence of movements and identifying which ones of the specified plurality of movements are feasible by performing collision checking.
Claim 6
Dependent Claim
53 words
The method according to claim 4, wherein said gross motion planning comprises performing said steps of proposing, modeling, determining and generating, for each pair of positions Q i and Q g , said proposing step comprising proposing a set of movements within a maximal overlapping parallelepiped within the free space of said robot.
Claim 7
Dependent Claim
53 words
The method according to claim 3, wherein said gross motion planning comprises performing said steps of proposing, modeling, determining and generating, for each pair of positions Q i and Q g , said proposing step comprising proposing a set of movements within a maximal overlapping parallelepiped within the free space of said robot.
Claim 8
Dependent Claim
39 words
The method according to claim 2, further comprising: calculating whether a simple collision-free path can be determined; forming a plan including movements for traversing the simple collision-free path; and inhibiting operation of said steps of proposing, determining and generating.
Claim 9
Dependent Claim
38 words
The method according to claim 2, wherein said gross motion plan comprises movements of the robot from a loading position, where a workpiece is retrieved by the robot gripper, to a bending stage position of the bending apparatus.
Claim 10
Dependent Claim
40 words
The method according to claim 2, wherein said fine motion plan comprises movements of the robot for loading a workpiece held by the robot gripper into a die space defined between a punch tool and die of the bending apparatus.
Claim 11
Dependent Claim
41 words
The method according to claim 2, wherein said gross motion plan comprises movements of the robot for moving a workpiece held by the robot gripper from a first bending stage position to a second bending stage position of the bending apparatus.
Claim 12
Dependent Claim
40 words
The method according to claim 2, wherein said fine motion plan comprises movements of the robot for unloading a workpiece held by the robot gripper from a die space defined between a punch tool and die of the bending apparatus.
Claim 13
Dependent Claim
39 words
The method according to claim 2, wherein said gross motion plan comprises movements of the robot for moving a workpiece held by the robot gripper from a final bending stage position of the bending apparatus to an unloading position.
Claim 14
Dependent Claim
40 words
The method of claim 2, wherein said modeling comprises modeling the workpiece held by the robot and said determining comprises determining whether a collision will occur between the workpiece held by the robot and an obstacle for a proposed movement.
Claim 15
Dependent Claim
68 words
The method according to claim 1, further comprising estimating a cost to be associated with each proposed movement, whereby said generating step comprises generating a plan including said sequence of movements, by choosing, for each movement in the sequence of movements, a proposed movement that will not result in a collision, that will bring the robot closer to the goal position, and that has a lowest estimated cost.
Claim 16
Dependent Claim
44 words
The method according to claim 14, wherein the estimated cost for a particular proposed movement comprises a Euclidian distance to the goal position from the position of the robot after said particular proposed movement is made as said movement in said sequence of movements.
Claim 17
Dependent Claim
49 words
The method according to claim 14, wherein the estimated cost for a particular proposed movement comprises an estimated value indicative of the robot travel time to move from a position after an another movement is made to a position of the robot after said particular proposed movement is made.
Claim 18
Dependent Claim
57 words
The method according to claim 1, further comprising, before said proposing step, specifying a plurality of movements in configuration space for said movement in said sequence of movements, and identifying which ones of the specified plurality of movements are feasible by performing collision checking, said proposing step comprising proposing movements from among the movements identified as feasible.
Claim 19
Dependent Claim
46 words
The method according to claim 17, wherein the specified plurality of movements specified for said movement in said sequence of movements comprises a plurality of movements in directions which collectively surround the position of the robot at the said another movement in said sequence of movements.
Claim 20
Dependent Claim
28 words
The method according to claim 17, wherein the specified plurality of movements for movement in said sequence of movements comprises movements in a plurality of intelligent movement directions.
Claim 21
Dependent Claim
49 words
The method according to claim 19, said method planning motion of said robot in order to unload a malleable workpiece from a tooling punch of the bending apparatus after completion of a bend, said intelligent directions comprising a downward movement of said robot causing said workpiece to move downward.
Claim 22
Dependent Claim
54 words
The method according to claim 19, said method planning motion of said robot in order to unload a malleable workpiece from a tooling punch of the bending apparatus after completion of a bend, said intelligent directions comprising a backward movement of said robot causing said workpiece to be backed out of the bending apparatus.
Claim 23
Dependent Claim
57 words
The method according to claim 19, said method planning motion of said robot in order to unload a malleable workpiece from a tooling punch of the bending apparatus after completion of a bend, said intelligent directions comprising a movement of said robot causing said workpiece to change in pitch from an inclined position towards a horizontal position.
Claim 24
Dependent Claim
71 words
The method according to claim 19, said method planning motion of said robot in order to unload a malleable workpiece from a tooling punch of the bending apparatus after completion of a bend, said intelligent directions comprising a movement of said robot causing said workpiece to be moved downward, to be moved backward away from said bending apparatus, and to drop in pitch from an angled position towards a horizontal position.
Claim 25
Dependent Claim
36 words
The method according to claim 1, further comprising: forming an m-tree representation of a work space of said robot; and computing maximal overlapping rectangloids within the free space of said m-tree representation of said work space.
Claim 26
Dependent Claim
14 words
The method according to claim 24, wherein said m-tree representation is an octree representation.
Claim 27
Dependent Claim
15 words
The method according to claim 24, wherein said maximal overlapping rectangloids comprise maximal overlapping parallelepipeds.
Claim 28
Dependent Claim
52 words
The method according to claim 24, wherein said proposing step comprises proposing for said movement in said sequence of movements, a set of movements of the robot to locations that fall within a maximal overlapping rectangloid within which the robot is located immediately after the another movement of said sequence of movements.
Claim 29
Dependent Claim
54 words
The method according to claim 27, wherein said set of movements comprises: translating said robot to any one of eight corners of a presently occupied maximal overlapping rectangloid; and moving said robot along any one of a plurality of predetermined directions which bring said robot to a position that corresponds to said goal position.
Claim 30
Dependent Claim
119 words
The method according to claim 27, wherein said set of movements comprises: moving said robot in a first of three orthogonal directions to a position along the first orthogonal direction which corresponds to said goal position; moving said robot in a second of the three orthogonal directions to a position along the second orthogonal direction which corresponds to said goal position; moving said robot in a third of the three orthogonal directions to a position along the third orthogonal direction which corresponds to said goal position; moving said robot in order to adjust a pitch of a gripper of said robot; and moving said robot in order to adjust both pitch and yaw of the gripper of said robot.
Claim 31
Dependent Claim
39 words
The method according to claim 27, wherein said set of movements comprises moving along one of a plurality of orthogonal directions only when such movement would bring the robot to an orthogonal position that corresponds to the goal position.
Claim 32
Dependent Claim
22 words
The method according to claim 1, further comprising integrating said gross motion plan with said fine motion plan to generate said plan.
Claim 33
Dependent Claim
48 words
The method according to claim 1, wherein said robot comprises a robot gripper for holding a workpiece, and said fine motion plan comprises movements of the robot for loading and unloading the workpiece into a die space defined by a punch tool and die of the bending apparatus.
Claim 34
Dependent Claim
29 words
The method of claim 1, wherein said free space is a 3-D space environment, said plurality of proposed movements including a 3-D movement to be made by the robot.
Claim 35
Independent Claim
190 words
A system for planning motion of a robot within free space, restricted by obstacles, from an initial position to a goal position, said obstacles comprising components of a bending apparatus, said system comprising: proposing means for proposing, for a movement within a sequence of movements, a plurality of proposed movements to be made by said robot; modeling means for modeling at least a portion of said robot and the obstacles that restrict the free space; determining means for determining whether a collision will occur between the robot and an obstacle for a proposed movement being executed as said movement within said sequence of movements; and generating means for generating a plan including said sequence of movements, by choosing, for each movement in said sequence of movements, a proposed movement that will not result in a collision and that will bring said robot closer to the goal position, said generating means comprising gross motion planning means for planning a gross motion plan including movements of said robot in the free-space and fine motion planning means for planning a fine-motion plan including movements of said robot to and from the bending apparatus.
Claim 36
Independent Claim
190 words
A system for planning motion of a robot within free space, restricted by obstacles, from an initial position to a goal position, said obstacles comprising components of a bending apparatus, said system comprising: proposing means for proposing, for a movement within a sequence of movements, a plurality of proposed movements to be made by said robot; modeling means for modeling at least a portion of said robot and the obstacles that restrict the free space; determining means for determining whether a collision will occur between the robot and an obstacle for a proposed movement being executed as said movement within said sequence of movements; and generating means for generating a plan including said sequence of movements, by choosing, for each movement in said sequence of movements, a proposed movement that will not result in a collision and that will bring said robot closer to the goal position, said generating means comprising gross motion planning means for planning a gross motion plan including movements of said robot in the free-space and fine motion planning means for planning a fine-motion plan including movements of said robot to and from the bending apparatus.
Claim 37
Dependent Claim
32 words
The system according to claim 34, wherein said robot comprises a robot gripper for holding and maneuvering a workpiece throughout a sequence of bending operations to be performed by the bending apparatus.
Claim 38
Dependent Claim
76 words
The system according to claim 35, wherein: said fine motion planning means comprises means for planning a plurality of free space fine motion solution paths that extend between a plurality of respective pairs of positions, q i and q g ; and said gross motion planning means comprises means for planning a plurality of free space gross motion solution paths that extend between a plurality of respective pairs of positions, Q i and Q g .
Claim 39
Dependent Claim
79 words
The system according to claim 36, wherein said fine motion planning means comprises means for operating said proposing means, modeling means, determining means, and generating means, for each pair of positions q i and q g , said proposing means comprising specifying means for specifying a plurality of movements in configuration space for said movement in said sequence of movements and identifying means for identifying which ones of the specified plurality of movements are feasible by performing collision checking.
Claim 40
Dependent Claim
60 words
The system according to claim 36, wherein said gross motion planning means comprises means for operating said proposing means, modeling means, determining means and generating means, for each pair of positions Q i and Q q , said proposing means comprising means for proposing a set of movements within a maximal overlapping parallelepiped within the free space of said robot.
Claim 41
Dependent Claim
60 words
The system according to claim 36, wherein said gross motion planning means comprises means for operating said proposing means, modeling means, determining means and generating means, for each pair of positions Q i and Q g , said proposing means comprising means for proposing a set of movements within a maximal overlapping parallelepiped within the free space of said robot.
Claim 42
Dependent Claim
49 words
The system according to claim 35, further comprising: calculating means for calculating whether a simple collision-free path can be determined; forming means for forming a plan including movements for traversing the simple collision-free path; and inhibiting means for inhibiting operation of said proposing means, determining means, and generating means.
Claim 43
Dependent Claim
38 words
The system according to claim 35, wherein said gross motion plan comprises movements of the robot from a loading position, where a workpiece is retrieved by the robot gripper, to a bending stage position of the bending apparatus.
Claim 44
Dependent Claim
40 words
The system according to claim 35, wherein said fine motion plan comprises movements of the robot for loading a workpiece held by the robot gripper into a die space defined between a punch tool and die of the bending apparatus.
Claim 45
Dependent Claim
41 words
The system according to claim 35, wherein said gross motion plan comprises movements of the robot for moving a workpiece held by the robot gripper from a first bending stage position to a second bending stage position of the bending apparatus.
Claim 46
Dependent Claim
40 words
The system according to claim 35, wherein said fine motion plan comprises movements of the robot for unloading a workpiece held by the robot gripper from a die space defined between a punch tool and die of the bending apparatus.
Claim 47
Dependent Claim
39 words
The system according to claim 35, wherein said gross motion plan comprises movements of the robot for moving a workpiece held by the robot gripper from a final bending stage position of the bending apparatus to an unloading position.
Claim 48
Dependent Claim
46 words
The system of claim 35, wherein said modeling means comprises means for modeling the workpiece held by the robot and said determining means comprises means for determining whether a collision will occur between the workpiece held by the robot and an obstacle for a proposed movement.
Claim 49
Dependent Claim
73 words
The system according to claim 34, further comprising estimating means for estimating a cost to be associated with each proposed movement, whereby said generating means comprise means for generating a plan including said sequence of movements, by choosing, for each movement in said sequence of movements, a proposed movement that will not result in a collision, that will bring the robot closer to the goal position, and that has a lowest estimated cost.
Claim 50
Dependent Claim
44 words
The system according to claim 47, wherein the estimated cost for a particular proposed movement comprises a Euclidian distance to the goal position from the position of the robot after said particular proposed movement is made as said movement in said sequence of movements.
Claim 51
Dependent Claim
46 words
The system according to claim 47, wherein the estimated cost for a particular proposed movement comprises an estimated value indicative of the robot's travel time from an another movement to the position of the robot after said particular proposed movement is made as said mth movement.
Claim 52
Dependent Claim
65 words
The system according to claim 34, further comprising specifying means for specifying a plurality of movements in configuration space for said movement in said sequence of movements and identifying means for identifying which ones of the specified plurality of movements are feasible by performing collision checking, said proposing means comprising means for proposing movements from among the movements identified by said identifying means as feasible.
Claim 53
Dependent Claim
46 words
The system according to claim 50, wherein the specified plurality of movements specified for said movement in a sequence of movements comprises a plurality of movements and directions which collectively surround a position of the robot at the said another movement in said sequence of movements.
Claim 54
Dependent Claim
29 words
The system according to claim 50, wherein the specified plurality of movements for said movement in said sequence of movements comprises movements in a plurality of intelligent movement directions.
Claim 55
Dependent Claim
53 words
The system according to claim 52, said system further comprising means for planning motion of said robot in order to unload a malleable workpiece from a tooling punch of the bending apparatus after completion of a bend, said intelligent directions comprising a downward movement of said robot causing said workpiece to move downward.
Claim 56
Dependent Claim
58 words
The system according to claim 52, said system further comprising means for planning motion of said robot in order to unload a malleable workpiece from a tooling punch of the bending apparatus after completion of a bend, said intelligent directions comprising a backward movement of said robot causing said workpiece to be backed out of the bending apparatus.
Claim 57
Dependent Claim
61 words
The system according to claim 52, said system further comprising means for planning motion of said robot in order to unload a malleable workpiece from a tooling punch of the bending apparatus after completion of a bend, said intelligent directions comprising a movement of said robot causing said workpiece to change in pitch from an angled position towards a horizontal position.
Claim 58
Dependent Claim
76 words
The system according to claim 52, said system further comprising means for planning motion of said robot in order to unload a malleable workpiece from a tooling punch of the bending apparatus after completion of a bend, said intelligent directions comprising a movement of said robot causing said workpiece to be moved downward, to be moved backward and away from said bending apparatus, and to drop in pitch from an angled position towards a horizontal position.
Claim 59
Dependent Claim
42 words
The system according to claim 34, further comprising: forming means for forming an m-tree representation of a work space of said robot; and computing means for computing maximal overlapping rectangloids within the free space of said m-tree representation of said work space.
Claim 60
Dependent Claim
14 words
The method according to claim 57, wherein said m-tree representation is an octree representation.
Claim 61
Dependent Claim
15 words
The system according to claim 57, wherein said maximal overlapping rectangloids comprise maximal overlapping parallelepipeds.
Claim 62
Dependent Claim
54 words
The system according to claim 57, wherein said proposing means comprises means for proposing, for said movement in said sequence of movements, a set of movements of the robot to locations that fall within a maximal overlapping rectangloid within which the robot is located immediately after the another movement of said sequence of movements.
Claim 63
Dependent Claim
57 words
The system according to claim 60, wherein said set of movements comprises: translating said robot to any one of eight corners of a present maximal overlapping rectangloid; and moving said robot along any one of a plurality of predetermined directions which bring said robot to a position along a predetermined direction that corresponds to said goal position.
Claim 64
Dependent Claim
120 words
The system according to claim 60, wherein said set of movements comprises: moving said robot in a first of three orthogonal directions to a position along the first orthogonal direction which corresponds to said goal position; moving said robot in a second of the three orthogonal directions to a position along the second orthogonal direction which corresponds to said goal position; moving said robot in a third of the three orthogonal directions to a position along the third orthogonal direction which corresponds to said goal position; moving said robot in order to adjust a pitch of a gripper of said robot; and moving said robot in order to adjust both the pitch and yaw of the gripper of said robot.
Claim 65
Dependent Claim
39 words
The system according to claim 60, wherein said set of movements comprises moving along one of a plurality of orthogonal directions only when the movement would bring the robot to an orthogonal position that corresponds to the goal position.
Claim 66
Dependent Claim
24 words
The system according to claim 34, further comprising means for integrating said gross motion plan with said fine motion plan to generate said plan.
Claim 67
Dependent Claim
48 words
The system according to claim 34, wherein said robot comprises a robot gripper for holding a workpiece, and said fine motion plan comprises movements of the robot for loading and unloading the workpiece into a die space defined by a punch tool and die of the bending apparatus.
Claim 68
Dependent Claim
29 words
The system of claim 34, wherein said free space is a 3-D space environment, said plurality of proposed movements including a 3-D movement to be made by the robot.
References Cited (Backward Citations)
US4942767A
Cited
US4745812A
Cited
EP0301527A2
Cited
US5092645A
Cited
US5005394A
Cited
US5058406A
Cited
US4949277A
Cited
US5083256A
Cited
EP0335314A2
Cited
US5047916A
Cited
EP0355454A2
Cited
JPH03110018A
Cited
US5307282A
Cited
JPH03110022A
Cited
JPH03124318A
Cited
WO1991009696A1
Cited
US5513299A
Cited
JPH04309414A
Cited
JPH0631345A
Cited
WO1995003901A1
Cited
USPTO Annuity & Maintenance Windows
| Annuity Stage | Window Opens | Payment Deadline | Surcharge Period Until | Estimated Fee | Status |
|---|---|---|---|---|---|
| 3.5 Years (Year 4) | 2001-11-09 | 2002-05-11 | 2002-11-10 | $2000.00 | Window Closed / Lapsed |
| 7.5 Years (Year 8) | 2005-11-09 | 2006-05-11 | 2006-11-10 | $3760.00 | Window Closed / Lapsed |
| 11.5 Years (Year 12) | 2009-11-09 | 2010-05-11 | 2010-11-10 | $7700.00 | Window Closed / Lapsed |