Linear interpolating method for robot control
AssigneeSamsung Electronics Co., Ltd.
InventorJin-Il Song
Life of this patent
Estimating the term…
Abstract
A linear interpolating method used for controlling the movement of a robot in which a speed distribution at the time of linear movement of a multi-articular robot involves a linear acceleration and deceleration so that precision of movement is improved at a driving start point and an end point of the robot. Linear acceleration and deceleration are realized by a discrete time state equation so that a sampling time is reduced and the precision of a straight line is improved while making high speed movement possible. The method computes a positional deviation on the basis of the present position and a target position and then exact driving is maintained via compensating for positional deviation.
Claims6
A linear interpolating method for movement control of a robot, said method comprising the steps of:
- obtaining a present position of at least a part of said robot in a coordinate system;
- obtaining a target position of said at least part of said robot in a coordinate system;
- determining moving quantities, sampling times and number of sampling times during which said robot will move said at least part of said robot by said moving quantity along each axis to reach said target position, where no acceleration exists;
- computing a positional increment quantity to execute a linear acceleration where acceleration exists;
- computing a value of a moving pulse based on said positional increment quantity where acceleration exists and moving quantities where acceleration does not exist;
- compensating for a decimal value of the positional increment quantity;
- computing a positional deviation by detecting the present position of said at least part of said robot and executing a proportional integral and differential control of said positional deviation;
- and
- moving said robot based on said positional deviation.
A linear interpolating method for moving an element of a robot in an X-Y plane comprising the steps of:
- determining a present position and a target position for moving the robot in the X-Y plane based on the present position and a last target position in a coordinate system;
- calculating a moving quantity in the X-direction and the Y-direction respectively for moving the robot in dependance on the present position and the target position in the X-Y plane;
- comparing the magnitudes of the moving quantities and assigning a velocity along the axis of the moving quantity which is larger;
- determining a number of steps and a distance the robot is moved along the axis of the larger moving quantity;
- computing a positional increment quantity based on the distance the robot is moved and compensating for a decimal value of the positional increment quantity;
- detecting a present position of the robot on each axis and calculating a positional deviation based on the present articular position and the moving pulse of each articulation;
- and
- executing proportional integral and differential control to the positional deviation and driving a servo-motor of the robot based on said positional deviation.
Dependencies are inferred from the claim text.