Patent US4969108A successfully refreshed from Google Patents.
US4969108A
Expired / Lapsed
US
⏱️ 0.0 years remaining
Vision seam tracking method and apparatus for a manipulator
Assignee: ABB Robotics Inc
•
Filing: 1988-04-08
•
Granted: 1990-11-06
•
Expires: 2008-04-08
Abstract
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.
Inventors
- 👤 Gregory Webb
- 👤 Keith R. Wehmeyer
Bibliographic Details
Application Number
—
Jurisdiction
US
Data Source
google_patents
Last Synchronized
2026-10-26 19:48
CPC Classifications
B; B25; B25J; B25J9/00; B25J9/16; B25J9/1679; B25J9/1684; G; G05; G05B; G05B19/00; G05B19/02; G05B19/42; G05B19/425
Claims Analysis
Total Claims: 16
Claim 1
Independent Claim
262 words
A method of controlling a manipulator to effect motion of a tool centerpoint associated with a function element carried by the manipulator such that the tool centerpoint moves along a path detected by a sensor during execution of a program defining a cycle of operation of the manipulator, the method comprising the steps of: a. periodically producing intermediate point signals representing coordinates of an intermediate location along a predetermined path between two programmed locations, the intermediate location defining displacement along the predetermined path to be effected in a predetermined time interval; b. producing target coordinate signals in response to the intermediate point signals and the sensor, the target coordinate signals representing coordinates of a location to which the tool centerpoint is to be moved in the direction from the tool centerpoint current location toward the detected path; c. calculating a limit value defining, for the predetermined time interval, a maximum deviation of the path of actual tool centerpoint motion from the predetermined path; d. calculating coordinates of a predicted location of the tool centerpoint, the predicted location being defined by the intermediate point and an offset between the current tool centerpoint location and the immediately preceding intermediate point; e. calculating the magnitude of the distance between the target point and the predicted location; f. determining whether the magnitude of the distance exceeds the limit value; and g. modifying the target coordinate signals in response to determining that the magnitude of the distance exceeds the limit value, the modified target coordinate signals defining a location to produce a deviation equal to the limit.
Claim 2
Independent Claim
262 words
A method of controlling a manipulator to effect motion of a tool centerpoint associated with a function element carried by the manipulator such that the tool centerpoint moves along a path detected by a sensor during execution of a program defining a cycle of operation of the manipulator, the method comprising the steps of: a. periodically producing intermediate point signals representing coordinates of an intermediate location along a predetermined path between two programmed locations, the intermediate location defining displacement along the predetermined path to be effected in a predetermined time interval; b. producing target coordinate signals in response to the intermediate point signals and the sensor, the target coordinate signals representing coordinates of a location to which the tool centerpoint is to be moved in the direction from the tool centerpoint current location toward the detected path; c. calculating a limit value defining, for the predetermined time interval, a maximum deviation of the path of actual tool centerpoint motion from the predetermined path; d. calculating coordinates of a predicted location of the tool centerpoint, the predicted location being defined by the intermediate point and an offset between the current tool centerpoint location and the immediately preceding intermediate point; e. calculating the magnitude of the distance between the target point and the predicted location; f. determining whether the magnitude of the distance exceeds the limit value; and g. modifying the target coordinate signals in response to determining that the magnitude of the distance exceeds the limit value, the modified target coordinate signals defining a location to produce a deviation equal to the limit.
Claim 3
Dependent Claim
90 words
The method of claim 1 wherein the step of producing target coordinate signals further comprises the steps of: a. periodically producing detected path signals representing coordinates of a location on the detected path to which the tool centerpoint is to be moved; b. calculating an incremental distance magnitude defining the distance through which the tool centerpoint is to be moved in the predetermined time interval; and c. calculating coordinates of a location the incremental distance from the current tool centerpoint in the direction toward the location on the detected path.
Claim 4
Dependent Claim
44 words
The method of claim 2 wherein the programmed cycle of operation defines a program velocity and the limit value is calculated as a distance through which the tool centerpoint would move in the predetermined time interval at a rate proportional to the program velocity.
Claim 5
Dependent Claim
102 words
The method of claim 2 wherein the step of periodically producing detected path signals further comprises the steps of: a. periodically producing sensor coordinate signals representing the coordinates of the location on the detected path relative to a frame of reference defined by the sensor; b. transforming the sensor coordinates to define the location relative to a frame of reference associated with the manipulator; c. selecting transformed sensor coordinates which represent a location at least a predetermined distance from the location represented by the immediately previously selected coordinates; d. storing the selected transformed coordinates; and e. periodically recalling stored selected transformed coordinates.
Claim 6
Dependent Claim
39 words
The method of claim 4 wherein the step of producing target coordinates further comprises the step of selecting detected path signals which represent a location more than twice the incremental distance from the current location of the tool centerpoint.
Claim 7
Dependent Claim
25 words
The method of claim 1 wherein the sensor is a vision system including a laser scanner/camera head which is fixedly mounted to the function element.
Claim 8
Dependent Claim
24 words
The method of claim 6 wherein the programmed cycle of operation defines changes of orientation of the function element between the two programmed locations.
Claim 9
Independent Claim
260 words
An apparatus for controlling a manipulator to effect motion of a tool centerpoint associated with a function element carried by the manipulator such that the tool centerpoint moves along a path detected by a sensor during execution of a program defining a cycle of operation of the manipulator, the apparatus comprising; a. means for periodically producing intermediate point signals representing coordinates of an intermediate location along a predetermined path between two programmed locations, the intermediate location defining displacement along the predetermined path to be effected in a predetermined time interval; b. means for producing target coordinate signals in response to the intermediate point signals and the sensor, the target coordinate signals representing coordinates of a location to which the tool centerpoint is to be moved in the direction from the tool centerpoint current location toward the detected path; c. means for calculating a limit vale defining, for the predetermined time interval, a maximum deviation of the path of actual tool centerpoint motion from the predetermined path; d. means for calculating coordinates of a predicted location of the tool centerpoint, the predicted location being defined by the intermediate point and an offset between the current tool centerpoint location and the immediately preceding intermediate point; e. means for calculating the magnitude of the distance between the target point and the predicted location; f. means for determining whether the magnitude of the distance exceeds the limit value; and g. means responsive to the determining means for modifying the target coordinate signals to define a location resulting in a deviation equal to the limit.
Claim 10
Independent Claim
260 words
An apparatus for controlling a manipulator to effect motion of a tool centerpoint associated with a function element carried by the manipulator such that the tool centerpoint moves along a path detected by a sensor during execution of a program defining a cycle of operation of the manipulator, the apparatus comprising; a. means for periodically producing intermediate point signals representing coordinates of an intermediate location along a predetermined path between two programmed locations, the intermediate location defining displacement along the predetermined path to be effected in a predetermined time interval; b. means for producing target coordinate signals in response to the intermediate point signals and the sensor, the target coordinate signals representing coordinates of a location to which the tool centerpoint is to be moved in the direction from the tool centerpoint current location toward the detected path; c. means for calculating a limit vale defining, for the predetermined time interval, a maximum deviation of the path of actual tool centerpoint motion from the predetermined path; d. means for calculating coordinates of a predicted location of the tool centerpoint, the predicted location being defined by the intermediate point and an offset between the current tool centerpoint location and the immediately preceding intermediate point; e. means for calculating the magnitude of the distance between the target point and the predicted location; f. means for determining whether the magnitude of the distance exceeds the limit value; and g. means responsive to the determining means for modifying the target coordinate signals to define a location resulting in a deviation equal to the limit.
Claim 11
Dependent Claim
98 words
An apparatus in accordance with claim 8 wherein the means for producing target coordinate signals further comprises: a. means for periodically producing detected path signals representing coordinates of a location on the detected path to which the tool centerpoint is to be moved; b. means for calculating an incremental distance magnitude defining a distance through which the tool centerpoint is to be moved in the predetermined time interval; and c. means for calculating coordinates of a location the incremental distance from the current tool centerpoint location in the direction toward the location defined by the detected path signals.
Claim 12
Dependent Claim
53 words
The apparatus in accordance with claim 9 wherein the programmed cycle of operation defines a program velocity between the two predetermined points and the means for calculating the limit value calculates a distance through which the tool centerpoint would move in the predetermined time interval at a rate proportional to the program velocity.
Claim 13
Dependent Claim
106 words
An apparatus in accordance with claim 9 wherein the means for producing detected path signals further comprises: a. means for periodically producing sensor coordinate signals representing the coordinates of the location on the detected path relative to a frame of reference defined by the sensor; b. means for calculating transformed sensor coordinates defining the location on the detected path relative to a frame of reference associated with the manipulator; c. means for selecting transformed sensor coordinates which represent a location at least a predetermined distance from the location of the immediately previously selected transformed sensor coordinates; and d. means for storing the selected transformed sensor coordinates.
Claim 14
Dependent Claim
41 words
The apparatus in accordance with claim 11 wherein the means for producing target coordinate signals further comprises means for selecting detected path signals which represent a location more than twice the incremental distance for the current location of the tool centerpoint.
Claim 15
Dependent Claim
27 words
The apparatus in accordance with claim 8 wherein the sensor is a vision system including a laser scanner/camera head which is fixedly mounted to the function element.
Claim 16
Dependent Claim
27 words
The apparatus in accordance with claim 13 wherein the programmed cycle of operation defines a change of orientation of the function element between the two programmed locations.
References Cited (Backward Citations)
US3986007A
Cited
US4417127A
Cited
US4370721A
Cited
US4380696A
Cited
US4403281A
Cited
US4492847A
Cited
US4456961A
Cited
US4538233A
Cited
US4616326A
Cited
US4590577A
Cited
US4497996A
Cited
US4542279A
Cited
US4493968A
Cited
US4635206A
Cited
US4591689A
Cited
US4621185A
Cited
US4591689B1
Cited
US4761596A
Cited
US4590356A
Cited
US4727471A
Cited
US4815006A
Cited
US4843287A
Cited
USPTO Annuity & Maintenance Windows
| Annuity Stage | Window Opens | Payment Deadline | Surcharge Period Until | Estimated Fee | Status |
|---|---|---|---|---|---|
| 3.5 Years (Year 4) | 1993-11-05 | 1994-05-07 | 1994-11-06 | $2000.00 | Window Closed / Lapsed |
| 7.5 Years (Year 8) | 1997-11-05 | 1998-05-07 | 1998-11-06 | $3760.00 | Window Closed / Lapsed |
| 11.5 Years (Year 12) | 2001-11-05 | 2002-05-07 | 2002-11-06 | $7700.00 | Window Closed / Lapsed |