Time optimal trajectory for cluster tool robots
AssigneeBrooks Automation, Inc.
InventorBrian Mark Lucas
Life of this patent
Estimating the term…
Abstract
A method and apparatus involving the application of an algorithm used for finding the time optimal trajectory for torque limited Industrial Robots, to achieve the operation of Cluster Tool Robots in an improved manner by modifying the applied algorithm through adding two additional constraints, i.e., jerk (the rate of change of acceleration) and the acceleration seen by the load. This modification renders it possible to create a robot arm trajectory that minimizes travel time by minimizing the excitation of uncontrolled resonances and avoiding command of an acceleration that would exceed the force of friction between a substrate holder on the end of the arm and a substrate held thereon by friction.
Claims15
A method of operating a workpiece handling tool, with a friction-type workpiece holder disposed at the end of a motor-driven, articulated arm of said tool, to maximize workpiece throughput, which method minimizes the time required for said workpiece holder to travel a set distance from a start end point to a final end point with a workpiece supported thereon, comprising the steps of:
- determining points of trajectory of arm travel by evaluating successive dynamic states of said workpiece holder by moving from one dynamic state to a next dynamic state thereof;
- and
- choosing points of said trajectory of arm travel while moving from one dynamic state to a next dynamic state by selecting as said points of said trajectory dynamic states where the maximum velocity of said workpiece holder is maintained while limiting the horizontal acceleration at a workpiece supported thereon so as not exceed the frictional force between said workpiece and said workpiece holder, and where the final dynamic state chosen is with said workpiece holder at one of said start end point and said final end point at a lower velocity than said maximum velocity.
Apparatus for operating a workpiece handling tool, having a friction-type workpiece holder disposed at the end of a motor-driven, articulated arm of said tool, with maximum workpiece throughput by minimizing the time required for said workpiece holder to travel a set distance from a start end point to a final end point with a workpiece supported thereon, comprising:
- means for moving from one dynamic state to a next dynamic state of said workpiece holder;
- and
- means for determining points of trajectory of arm travel by evaluating successive dynamic states of said workpiece holder, said determining means comprising:
- means for selecting as said points of said trajectory dynamic states where the maximum velocity of said workpiece holder is maintained while limiting the horizontal acceleration and deceleration of a workpiece supported thereon so as not exceed the frictional force between said workpiece and said workpiece holder;
- and
- means for choosing the final dynamic state with said workpiece holder at one of said start end point and said final end point and at a lower velocity than said maximum velocity.
A method of operating a substrate handling tool, having a friction-type substrate holder disposed at the end of a motor-driven, articulated arm of said tool, with maximum substrate throughput, which method minimizes the time required for said substrate holder to travel a set distance to a final end point from a start end point with a substrate supported thereon, comprising the steps of:
- determining points of trajectory of arm travel by determining the dynamic states thereof by the steps comprising:
- STEP 1:
- determining and storing the values of the maximum acceleration and the maximum deceleration that does not exceed the horizontal frictional force between said substrate and said holder;
- STEP 2:
- evaluating a point on the trajectory using the criterion that such a point has a valid dynamic state if the maximum acceleration is greater than the maximum deceleration, in accordance with said stored values;
- STEP 3:
- if a point being evaluated on the trajectory has a valid dynamic state, then going to STEP 5 wherein the maximum acceleration is applied at said point;
- STEP 4:
- if a point being evaluated on the trajectory does not have a valid dynamic state, then going back down the states found until the last point the maximum acceleration was applied is found, and applying the maximum deceleration instead, and determining a next dynamic state by going to STEP 6;
- STEP 5:
- applying the maximum acceleration, and determining a next dynamic state by going to STEP 6;
- and
- STEP 6:
- if said start end point or said final end point of the trajectory has not been passed then determining a next dynamic state by going to STEP 2, otherwise END.
Dependencies are inferred from the claim text.