Automatic seam tracker and real time error cumulative control system for an industrial robot
AssigneeWestinghouse Electric Corp.
InventorLawrence J. Zana
Life of this patent
Estimating the term…
Abstract
A control processor in a robotic system treats optically sensed locations along the seam path ahead of the tool, which are classified in relation to elapsed distances and identified in 3-D coordinates and 3-axes tool orientation, to apply in real time and under feedforward a control signal representing the error between anticipated tool position and anticipated sensed location on the path. In the process, the anticipated sensed location is obtained by interpolation between actually sensed locations. A taught path is recovered from the robot. The control processor operation is also based on elapsed distances and related to actual tool position provided by the robot.
Claims8
A method of tracking a seam path with an effector end controlled by a robot, under supervision of an image processor having a look-ahead sensor for deriving a series of seam samples by sensing the seam ahead of the effector end, using a control processor responsive to successive present positions of the effector end derived from the robot, comprising with said control processor the steps of:
- deriving from said successive effector end present positions an elapsed distance for the last position thereof;
- deriving for said series of seam samples corresponding elapsed distances;
- determining with at least two last ones of said present positions an anticipated elapsed distance for a subsequent position;
- generating with at least the last, and one before the last, of said successive present positions a representation of a parametric function of the elapsed distance characterizing the effector end path as defined geometrically by said at least the last positions, said function having specified parameters;
- determining in response to said anticipated elapsed distance and with said specified function parameters an anticipated effector end position;
- identifying with said seam sampled by interpolation with said anticipated elapsed distance a corresponding seam sample;
- comparing said anticipated effector end position with said corresponding seam sample for deriving an error therebetween;
- and
- controlling the robot in accordance with said derived error for bringing the effector end on track with the seam path.
A method according to claim 6 wherein the robot is iteratively providing a first signal representative of the present effector end position;
- the control processor being responsive to said first signal and to said seam samples for generating a control signal as an indication of said error between effector end position and seam sample;
- comprising the following operative steps by the control processor;
- calculating and storing iteratively, in response to said control signal and to said first signal, the elapsed distance of the effector end from the first down to the present effector end position;
- calculating and storing iteratively, in response to said control signal and to said first signal, the elapsed distance from the first down to the present sensed seam location by correlation with the distance between the effector end and the sensor;
- ordering and storing said data by reference to, and correlating said successive sensed locations with, said sensed location elapsed distances to provide a look-up table thereof;
- deriving iteratively with said first signal for a present effector end position and with said control signal for a present positioning of the effector end successive positions representing the effector end path;
- extrapolating by a predetermined amount from past positions on said effector end path to an anticipated position thereon;
- extrapolating by said predetermined amount from past elapsed distances to an anticipated elapsed distance for said effector end;
- determining from said anticipated elapsed distance in relation to said stored sensed location elapsed distances of said look-up table a corresponding anticipated sensed location;
- whereby said robot controlling step moves the effector end to said anticipated position following each past position of the effector end and each past control signal therefor.
Dependencies are inferred from the claim text.