Vision seam tracking method and apparatus for a manipulator

Abstract

A three-dimensional vision seam tracking method and apparatus for controlling the motion of the center point of a tool mounted on a manipulator. The manipulator is provided with a control to operate the manipulator members to move the tool center point at programmed velocities along a programmed path corresponding to the seam. The manipulator is provided with a vision system including a laser scanner/camera head mounted ahead of the function element. The control is programmed with dynamically varying orientation angles to control the orientation of the tool during seam tracking. The laser scanner/camera head scans the seam at predetermined time intervals. A set of coordinates for the center point of the seam in a coordinate system relative to the camera is provided for each scan. The sets of camera coordinates are transformed to the coordinate system of the manipulator using transformation matrices employing the orientation angles in effect at the time of the scan for the set of camera coordinates being transformed. The transformed coordinates are stored in a FIFO buffer until needed. The seam tracking routine of the manipulator control removes FIFO entries at some later time and alters the manipulator's programmed path to move the tool center point along the seam.