Automated robot alignment system and method using kinematic pins and end effector sensor
First Claim
1. A method for aligning a movable arm with a target, comprising the steps of:
- bringing a spherical portion of a probe on the movable arm in contact with a pin on the target, the probe contacting the pin at a first probe position;
moving the probe to contact the pin at two additional probe positions;
determining a location of the pin based on the location being a solution for an intersection of three spheres, each of the spheres being centered at a respective one of the probe positions and having a radius equal to a radius of the spherical portion of the probe plus a radius of a spherical portion of the pin;
moving the probe to contact the pin at a further probe position when there is no solution for the intersection of the three spheres and returning to determining the location; and
repeating the steps of bringing, storing, moving and determining for at least two additional pins on the target when the solution is determined.
1 Assignment
0 Petitions
Accused Products
Abstract
A method and system can align a robot arm with a payload station. A probe and a contact detector may be positioned on the robot arm and three pins may be placed on the payload station. A controller may move the robot arm in a pattern over the payload station until contact may be made between the probe and one of the pins. A search about the contact location may be performed to obtain additional contacts. The search may be interrupted when contact is made between the probe and one of the pins. The position of the pin may be calculated from three such contacts on the spherical portion of the pin. The location of the probe at the time of contact may be stored and a localized search about the pin location may be performed. If the position of the pin cannot be resolved from three contacts, additional contacts may be made until a combination of three contacts does provide a solution. Three such pins may be so located such that the robot arm may learn the position of the payload station without operator intervention.
11 Citations
17 Claims
-
1. A method for aligning a movable arm with a target, comprising the steps of:
-
bringing a spherical portion of a probe on the movable arm in contact with a pin on the target, the probe contacting the pin at a first probe position; moving the probe to contact the pin at two additional probe positions; determining a location of the pin based on the location being a solution for an intersection of three spheres, each of the spheres being centered at a respective one of the probe positions and having a radius equal to a radius of the spherical portion of the probe plus a radius of a spherical portion of the pin; moving the probe to contact the pin at a further probe position when there is no solution for the intersection of the three spheres and returning to determining the location; and repeating the steps of bringing, storing, moving and determining for at least two additional pins on the target when the solution is determined. - View Dependent Claims (2, 3, 4, 5, 6, 7)
-
-
8. A system for aligning a movable arm with a target, comprising:
-
a probe having a spherical portion and mounted on the movable arm; at least three pins, each of the pins baying a spherical portion and mounted on the target; a controller controlling movement of the movable arm; a contact detector detecting at least three contacts between the spherical portion of the probe and each of the three pins; and a processor determining locations for the pins based on probe positions when the contacts are detected from an intersection of three spheres being centered at respective probe positions.
-
-
9. A method for aligning a movable arm with a target, comprising the steps of:
-
bringing a probe on the movable arm in contact with a pin on the target, the probe contacting the pin at a first probe position; moving the probe to contact the pin at additional probe positions; determining a location of the pin based on the location being a solution of possible locations for the pin determined from the respective probe positions; moving the probe to contact the pin at further probe positions when the solution is not obtained and returning to determining the location; and repeating the steps of bringing, moving and determining for additional pins on the target.
-
-
10. A method for aligning a movable arm with a target, comprising the steps of:
-
bringing a spherical portion of a probe on the movable arm in contact with a spherical portion of a pin on the target, the probe contacting the pin at a first probe position; moving the probe to contact the spherical portion of the pin at least two additional probe positions; determining a location of the pin based on the location being an intersection of at least three spheres, each of the spheres being centered at a respective one of the first and the at least two additional probe positions and having a radius equal to a radius of the spherical portion of the probe plus a radius of the spherical portion of the pin; and repeating the steps of bringing, moving and determining for at least two additional pins on the target. - View Dependent Claims (11, 12, 13, 14, 15)
-
-
16. A system tin aligning a movable arm with a target, comprising:
-
a probe having a spherical portion and mounted on the movable arm; at least three pins, each of the pins having a spherical portion and mounted on the target, a controller controlling movement of the movable arm;
.a contact detector detecting at least three contacts between the spherical portion of the probe and each of the spherical portions of the three pins; and processor determining locations for the pins based on probe positions when the contacts are detected from an intersection of three spheres being centered at respective probe positions.
-
-
17. A method for aligning a movable arm with a target, comprising the steps of:
-
bringing a probe on the movable arm in contact with a pin an the target, the probe contacting at a first probe position; moving the probe to contact the pin at additional probe positions; determining a location of the pin based on the location being a solution of possible locations for the pin determined from the first and additional probe positions; and repeating the steps of bringing, moving and determining for additional pins on the target.
-
Specification