Robot control scheme
First Claim
Patent Images
1. A method of controlling a moving robot arm to minimize vibrations, comprising the steps of:
- determining a maximum step distance the robot arm can move in a single step;
determining a total task distance the robot arm is required to move to complete a specified task, wherein the total task distance is less than or equal to the maximum step distance;
applying a series of discrete step inputs of varying magnitudes in a timed sequence to the robot arm, the series comprising;
applying a first step input of a magnitude corresponding to approximately one-half the total task distance;
measuring the time it takes the robot arm to move one-half of the total task distance, wherein a measured time and a measure velocity are determined;
estimating robot arm damping using the measured time and the measured velocity;
calculating and applying a second step input magnitude and application time and a third step magnitude and application time, wherein the magnitude and application time of both the second and third step inputs are based on the estimated robot damping, and further wherein the third step input magnitude is approximately equal to the magnitude of the first step input less the second step input magnitude.
1 Assignment
0 Petitions
Accused Products
Abstract
A simple open loop control scheme that minimizes both robot response time and the resulting residual vibration while requiring little computational effort through the intelligent use of conventional servo control technology and the robot'"'"'s vibration characteristics.
46 Citations
12 Claims
-
1. A method of controlling a moving robot arm to minimize vibrations, comprising the steps of:
-
determining a maximum step distance the robot arm can move in a single step; determining a total task distance the robot arm is required to move to complete a specified task, wherein the total task distance is less than or equal to the maximum step distance; applying a series of discrete step inputs of varying magnitudes in a timed sequence to the robot arm, the series comprising; applying a first step input of a magnitude corresponding to approximately one-half the total task distance; measuring the time it takes the robot arm to move one-half of the total task distance, wherein a measured time and a measure velocity are determined; estimating robot arm damping using the measured time and the measured velocity; calculating and applying a second step input magnitude and application time and a third step magnitude and application time, wherein the magnitude and application time of both the second and third step inputs are based on the estimated robot damping, and further wherein the third step input magnitude is approximately equal to the magnitude of the first step input less the second step input magnitude. - View Dependent Claims (2, 3, 4, 5, 6)
-
-
7. A method of controlling a moving robot and to minimize vibrations, comprising the steps of:
-
determining a maximum step distance the robot arm can move in a single step; determining a total task distance the robot and is required to move to complete a specified task, wherein the total task distance is greater than the maximum step distance; applying a series of discrete step inputs of varying magnitudes in a timed sequence to the robot arm, the series comprising; analyzing the total task distance to determine a constant velocity displacement and to estimate a linear rise time; applying a first step input of a magnitude resulting in the highest constant velocity, the first step input having a magnitude of the maximum step distance divided by two; measuring the time it takes the robot arm to move one-half the maximum step distance; measuring the robot arm velocity at one-half the maximum step distance; estimating robot arm damping using the measured time and the measured robot arm velocity; applying a linear input motion to provide for linear motion of the robot arm based on the actual robot arm velocity at the one-half maximum step distance; and calculating and applying a second step input magnitude and application time and a third step magnitude and application time, wherein the magnitude and application time of both the second and third step inputs are based on the estimated robot damping, and further wherein the third step input magnitude is approximately equal to the magnitude of the first step input less the second step input magnitude. - View Dependent Claims (8, 9, 10, 11, 12)
-
Specification