Method and apparatus for limiting the movement of a robot, and a robot equipped with said apparatus
First Claim
1. A method of limiting the movement of a robot, said method comprising the steps of:
- constructing a physical safety barrier surrounding a movable robot including a base mounted on a floor;
defining in a memory a virtual safety barrier including a trajectory of a work or a tool mounted on a wrist of an arm of the robot in operation, the virtual safety barrier having boundaries spaced inward from the physical safety barrier and surrounding the work or tool;
defining in the memory a margin width of the virtual safety barrier, wherein a degree of freedom of a movement of the work or tool can be obtained;
defining in the memory at least two three-dimensional spatial regions including parts of the arm of the robot including said work or tool, wherein each of the three-dimensional spatial regions has a substantially spherical shape with a predetermined radius, wherein the radius for each of the three-dimensional spatial regions is configured to maintain a space efficiency;
calculating a movement trajectory of the work or tool included in the defined three-dimensional spatial regions;
determining a predicted position of each of the defined three-dimensional spatial regions based on the trajectory calculation;
matching the predicted position of each of the defined three-dimensional spatial regions with said virtual safety barrier;
recognizing a forward position of at least one of the three-dimensional spatial regions spaced apart from the virtual safety barrier by a predetermined distance as a deceleration start position to safely stop the work or tool; and
carrying out a control to start the deceleration of the work or tool when at least one of the three-dimensional spatial regions is at the predetermined distance ahead of the virtual safety barrier and stop the movement of the work or tool ahead of the virtual safety barrier.
1 Assignment
0 Petitions
Accused Products
Abstract
The safety in robotic operations is enhanced and the floor space in a factory or the like is effectively utilized. A virtual safety barrier 50 including the trajectory of movement of a work or tool 7 mounted on a wrist 5 of a robot 1 in operation is defined in a memory. At least two three-dimensional spatial regions S (S1 to S3) including a part of the robot including the work or tool are defined. Predicted positions of the defined three-dimensional spatial regions obtained by trajectory calculations are matched with the virtual safety barrier 50, and if the predicted position of any one of the defined three-dimensional spatial regions based on trajectory calculations is included in the virtual safety barrier 50, a control is effected to stop the movement of the robot arms 3 and 4.
-
Citations
8 Claims
-
1. A method of limiting the movement of a robot, said method comprising the steps of:
-
constructing a physical safety barrier surrounding a movable robot including a base mounted on a floor; defining in a memory a virtual safety barrier including a trajectory of a work or a tool mounted on a wrist of an arm of the robot in operation, the virtual safety barrier having boundaries spaced inward from the physical safety barrier and surrounding the work or tool; defining in the memory a margin width of the virtual safety barrier, wherein a degree of freedom of a movement of the work or tool can be obtained; defining in the memory at least two three-dimensional spatial regions including parts of the arm of the robot including said work or tool, wherein each of the three-dimensional spatial regions has a substantially spherical shape with a predetermined radius, wherein the radius for each of the three-dimensional spatial regions is configured to maintain a space efficiency; calculating a movement trajectory of the work or tool included in the defined three-dimensional spatial regions; determining a predicted position of each of the defined three-dimensional spatial regions based on the trajectory calculation; matching the predicted position of each of the defined three-dimensional spatial regions with said virtual safety barrier; recognizing a forward position of at least one of the three-dimensional spatial regions spaced apart from the virtual safety barrier by a predetermined distance as a deceleration start position to safely stop the work or tool; and carrying out a control to start the deceleration of the work or tool when at least one of the three-dimensional spatial regions is at the predetermined distance ahead of the virtual safety barrier and stop the movement of the work or tool ahead of the virtual safety barrier. - View Dependent Claims (2)
-
-
3. A robot movement limiting apparatus comprising:
-
means for constructing a physical safety barrier surrounding a movable robot including a base mounted on a floor and defining in a memory a virtual safety barrier including a movement trajectory of a work or a tool mounted on a wrist of an arm of the robot in operation, the virtual safety barrier having boundaries spaced inward from the physical safety barrier and surrounding the work or tool, wherein the virtual safety barrier has a margin width such that a degree of freedom of the movement of the work or tool can be obtained; means for defining in the memory at least two three-dimensional spatial regions including a part of the robot including said work or tool, wherein each of the three-dimensional spatial regions has a substantially spherical shape with a predetermined radius, wherein the radius for each of the three-dimensional spatial regions is configured to maintain a space efficiency; means for calculating a movement trajectory of the work or tool included in the defined three-dimensional spatial regions, and calculating a predicted position of each of said three-dimensional spatial regions based on the trajectory calculation; means for matching the predicted position of each three-dimensional spatial region with said virtual safety barrier; means for recognizing a forward position of at least one of the three-dimensional spatial regions spaced apart from the virtual safety barrier by a predetermined distance as a deceleration start position to safely stop the work or tool; and control means for starting the deceleration of the work or tool when at least one of the three-dimensional spatial regions is at the predetermined distance ahead of the virtual safety barrier and stopping the movement of the work or tool. - View Dependent Claims (4, 5, 6)
-
-
7. A method of limiting the movement of a robot, said method comprising the steps of:
-
constructing a physical safety barrier surrounding a movable robot including a base mounted on a floor; defining in a memory a virtual safety barrier including a trajectory of a work or a tool mounted on a wrist of an arm of the robot in operation, the virtual safety barrier having boundaries spaced inward from the physical safety barrier and surrounding the work or tool, wherein the virtual safety barrier is defined to be immovable with the robot under a working environment; defining in the memory a margin width of the virtual safety barrier, wherein a degree of freedom of a movement of the work or tool can be obtained; defining in the memory at least two three-dimensional spatial regions including parts of the arm of the robot including said work or tool, wherein each of the three-dimensional spatial regions has a substantially spherical shape with a predetermined radius, wherein the radius for each of the three-dimensional spatial regions is configured to maintain a space efficiency; calculating the movement trajectory of the work or tool included in the defined three-dimensional spatial regions; determining a predicted position of each of the defined three-dimensional spatial regions based on the trajectory calculation; matching the predicted position of each of the defined three-dimensional spatial regions with said virtual safety barrier; recognizing a forward position of at least one of the three-dimensional spatial regions spaced apart from the virtual safety barrier by a predetermined distance as a deceleration start position to safely stop the work or tool; and carrying out a control to start the deceleration of the work or tool when at least one of the three-dimensional spatial regions is at the predetermined distance ahead of the virtual safety barrier and stop the movement of the work or tool ahead of the virtual safety barrier. - View Dependent Claims (8)
-
Specification