Patent US4833381A successfully refreshed from Google Patents.
US4833381A
Expired / Lapsed
US
⏱️ 0.0 years remaining
Optical automatic seam tracker and real time control system for an industrial robot
Assignee: Westinghouse Electric Corp
•
Filing: 1987-12-31
•
Granted: 1989-05-23
•
Expires: 2007-12-31
Abstract
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 acutally 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.
Inventors
- 👤 Jeffrey D. Taft
- 👤 James F. Ellison
- 👤 Gerald A. Breakey
Bibliographic Details
Application Number
—
Jurisdiction
US
Data Source
google_patents
Last Synchronized
2026-10-29 07:06
CPC Classifications
G; G05; G05B; G05B19/00; G05B19/02; G05B19/42; G05B19/425; B; B23; B23Q; B23Q35/00; B23Q35/04; B23Q35/08; B23Q35/12; B23Q35/127; B23Q35/128; G05B2219/00; G05B2219/30; G05B2219/36; G05B2219/36417; G05B2219/45; G05B2219/45104; G05B2219/47; G05B2219/4701
Claims Analysis
Total Claims: 20
Claim 1
Independent Claim
193 words
A robotic control system controlling an effector end in real time behind the look-ahead sensor of an optical seam tracker associated with an image processor, and including a control processor responsive to the present position of the effector end for feedforward control thereof toward a new position anticipated by reference to a taught path and in relation to a corresponding seam location; wherein the image processor provides an indication of the successive sensed locations on the seam, whereas the control processor relates such sensed locations to elapsed distances from the start of the sensor and relates the successive effector end positions to elapsed distances from the start of the effector end; with the look-ahead sensor being a predetermined distance from the effector end, the elapsed distances for the effector end positions and for the sensed seam locations being in relation to said predetermined distance; said corresponding seam location being determined by the control processor in relation to sensed locations derived from the image processor and an elapsed distance corresponding to said anticipated position; the control processor detecting an error between said corresponding seam location and said effector end new position for feedforward control.
Claim 2
Dependent Claim
193 words
A robotic control system controlling an effector end in real time behind the look-ahead sensor of an optical seam tracker associated with an image processor, and including a control processor responsive to the present position of the effector end for feedforward control thereof toward a new position anticipated by reference to a taught path and in relation to a corresponding seam location; wherein the image processor provides an indication of the successive sensed locations on the seam, whereas the control processor relates such sensed locations to elapsed distances from the start of the sensor and relates the successive effector end positions to elapsed distances from the start of the effector end; with the look-ahead sensor being a predetermined distance from the effector end, the elapsed distances for the effector end positions and for the sensed seam locations being in relation to said predetermined distance; said corresponding seam location being determined by the control processor in relation to sensed locations derived from the image processor and an elapsed distance corresponding to said anticipated position; the control processor detecting an error between said corresponding seam location and said effector end new position for feedforward control.
Claim 3
Dependent Claim
58 words
The system of claim 1, with said taught path being provided by the robot, with said anticipated position being determined by the control processor in relation to an extrapolated elapsed distance established on the taught path of the robot and said corresponding seam location being derived from said sensed locations as a function of said extrapolated elapsed distance.
Claim 4
Dependent Claim
34 words
The system of claim 2, with said corresponding seam location being derived by the control processor by interpolation between two consecutive said sensed seam locations associated with elapsed distances bordering said extrapolated elapsed distance.
Claim 5
Dependent Claim
86 words
The system of claim 2, with feedforward control of the effector end being performed from a present position related to a taught path by reference to the associated corresponding seam location, the taught path being recovered from the robot by the control processor in relation to such effector end present position, said extrapolated effector end position being determined from said present position and providing said anticipated elapsed distance, said derived corresponding seam location defining an error for feedforward control in relation to said recovered taught path.
Claim 6
Dependent Claim
35 words
The sytem of claim 4, with such feedforward control being effected cyclically, and the elapsed distance and corresponding sensed location being determined by the control processor upon each new effector end position and extrapolated position.
Claim 7
Independent Claim
374 words
A method of operating a robot system including: a robot controller for iteratively controlling an effector end with an error compensating control signal in relation to a taught path; a seam sensor system having a sensor disposed ahead of the effector end for iteratively deriving data representing discrete successive sensed locations upon the seam ahead of the effector end, the robot controller iteratively providing a first signal representative of the present effector end position; and a control processor responsive to said first signal and to said sensed locations representative data for generating said control signal as an indication of an error between effector end position and sensed seam location; 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 taught path as recovered therefrom; extrapolating by a predetermined amount from past positions on said recovered taught 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; comparing said anticipated sensed location with said anticipated recovered taught path position for deriving a present control signal in relation to said anticipated effector end position; and controlling by feedforward the robot controller in response to said present control signal; thereby to move the effector end to said anticipated position following each past position of the effector end and each past control signal therefor.
Claim 8
Independent Claim
374 words
A method of operating a robot system including: a robot controller for iteratively controlling an effector end with an error compensating control signal in relation to a taught path; a seam sensor system having a sensor disposed ahead of the effector end for iteratively deriving data representing discrete successive sensed locations upon the seam ahead of the effector end, the robot controller iteratively providing a first signal representative of the present effector end position; and a control processor responsive to said first signal and to said sensed locations representative data for generating said control signal as an indication of an error between effector end position and sensed seam location; 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 taught path as recovered therefrom; extrapolating by a predetermined amount from past positions on said recovered taught 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; comparing said anticipated sensed location with said anticipated recovered taught path position for deriving a present control signal in relation to said anticipated effector end position; and controlling by feedforward the robot controller in response to said present control signal; thereby to move the effector end to said anticipated position following each past position of the effector end and each past control signal therefor.
Claim 9
Dependent Claim
156 words
The method of claim 6 with said seam sensor system providing position and orientation coordinates for a location a predetermined distance ahead of said effector end; with each of said sensed location derived data representing the seam location in world coordinates; with said first signal providing for each present effector end control the effector end present position in world coordinates; with the additional control processor steps of: determining in world coordinates the chord of said predetermined distance extending between a present effector end position and a present sensed seam location; deriving from said effector end present position world coordinates an indication of the effector end direction of travel along the path; determining with said chord and direction of travel an angle therebetween; and moving the sensor by rotation about said effector end by the amount of said determined angle; thereby to bring the sensor into position upon the seam prior to sensing another seam location thereupon.
Claim 10
Dependent Claim
38 words
The method of claim 7 with said control signal including position world coordinates for the effector end and orientation angles in world coordinates therefor; with said sensor moving step providing an additional orientation angle within said control signal.
Claim 11
Dependent Claim
190 words
The method of claim 8 with said effector end past position being at instant (k) and said effector end anticipated position being at instant (k+3) said correcting and comparing steps are conducted with: (a) w T t (k+3) as aid taught path anticipated position at instant (k+3); (b) w R T S as said reference signal; (c) w T S (k+3) as said anticipated sensed position at instant (k+3); and in accordance with: .sub.w T.sup.S (k+3):{.sub.w T.sup.t (k+3):.sup.R.sub.w T.sup.S }=.sup.err.sub.w T.sup.w (k+3) where err w T w (k+3) is the differential transformation matrix and wherefrom are derived a positional error err p w (k+3) for the position vector p of the effector end and a rotational error vector err w S w (k+3), obtained by derivation from said differential transformation matrix err w T w (k+3) by recognizing the form of the orientation submatrix for small angle deviations as: ##EQU29## leading to a differential motion vector Δ w (k+3) defining said control signal, where: ##EQU30## as representative of the control signal for axis directions x, y, z, and for axis rotations δ x , δ y , δ z .
Claim 12
Dependent Claim
53 words
The method of claim 6 with said first and control signals being provided cyclically upon each of a series of tick cycles, whereby the effector end is being moved, under a present control signal and upon each tick, from a present position to a next position along successive sensed locations of the seam.
Claim 13
Dependent Claim
33 words
The method of claim 10 with a present control signal being determined by said control processor in relation to an anticipated effector end location situated three-ticks ahead of a present effector end position.
Claim 14
Dependent Claim
189 words
The robot system of claim 6 wherein the error between effector end positioning and matching corresponding seam location is applied cyclically as a first signal by the control processor to the robot controller and is compensated by the robot controller in response thereto through concurrent control of the effector end in relation to a taught path therein; wherein the robot controller cyclically, and following said effector end cyclical control, provides the control processor with a first signal representative of such present position; wherein the control processor cyclically generates with said first and control signals successive additional signals representative of successive corresponding present positions characteristic of a recovered taught path; wherein said extrapolating step provides, with consecutive said additional signals for a present and a last position characteristic on said recovered taught path, another signal representative of an extrapolated position on said recovered taught path; means being provided for interpolating said another signal between two consecutive sensed locations from said look-up table for deriving a last signal representative of a corresponding seam location; the control processor being responsive to said another and last signals for deriving said present control signal.
Claim 15
Dependent Claim
327 words
In a robot system including a robot controller for controlling an effector end along a seam in relation to a taught path and a seam tracker control system, the seam tracker control system, including a sensor, for sensing the seam ahead of the effector end and for deriving data representing discrete successive sensed locations upon the seam, and a control processor responsive to said seam tracker control system and to said robot controller for deriving a control signal representative of an error between effector end positioning and a matching sensed location, the effector end being controlled by said robot controller in response to said control signal to provide seam tracking with the effector end; the combination of: means responsive to said robot controller and associated with said control processor for successively calculating the distances between two consecutive sensed locations, for accumulating said distances to provide iteratively the elapsed distance down to the last sensed location and for providing orderly samples each classified by elapsed distance to identify the respective sensed locations upon the seam; look-up table means for storing data representing coordinates derived by the sensor system for each of said sensed locations in relation to and in the order of said orderly samples; with the control processor being successively responsive to a present and a last position of said effector end for extrapolating therefrom to an anticipated position and for deriving an anticipated elapsed distance thereto; with the control processor being operative with said look-up table for correlating said anticipated elapsed distance of the effector end with closely related samples of said look-up table to derive coordinates for an anticipated location on the seam corresponding to such anticipated elapsed distance; with the control processor deriving a present control signal in relation to said derived coordinates; and the control processor controlling the robot controller with said control signal so as to effectuate feedforward control of the effector end toward a new position defined by said anticipated location.
Claim 16
Dependent Claim
327 words
In a robot system including a robot controller for controlling an effector end along a seam in relation to a taught path and a seam tracker control system, the seam tracker control system, including a sensor, for sensing the seam ahead of the effector end and for deriving data representing discrete successive sensed locations upon the seam, and a control processor responsive to said seam tracker control system and to said robot controller for deriving a control signal representative of an error between effector end positioning and a matching sensed location, the effector end being controlled by said robot controller in response to said control signal to provide seam tracking with the effector end; the combination of: means responsive to said robot controller and associated with said control processor for successively calculating the distances between two consecutive sensed locations, for accumulating said distances to provide iteratively the elapsed distance down to the last sensed location and for providing orderly samples each classified by elapsed distance to identify the respective sensed locations upon the seam; look-up table means for storing data representing coordinates derived by the sensor system for each of said sensed locations in relation to and in the order of said orderly samples; with the control processor being successively responsive to a present and a last position of said effector end for extrapolating therefrom to an anticipated position and for deriving an anticipated elapsed distance thereto; with the control processor being operative with said look-up table for correlating said anticipated elapsed distance of the effector end with closely related samples of said look-up table to derive coordinates for an anticipated location on the seam corresponding to such anticipated elapsed distance; with the control processor deriving a present control signal in relation to said derived coordinates; and the control processor controlling the robot controller with said control signal so as to effectuate feedforward control of the effector end toward a new position defined by said anticipated location.
Claim 17
Independent Claim
419 words
A method of operating a robot system including: a robot controller for iteratively controlling an effector end with an error compensating control signal in relation to a taught path; said robot controller providing a first signal representative of the present effector end position; a seam sensor system having a sensor disposed ahead of the effector end for iteratively deriving data representing discrete successive sensed locations upon the seam ahead of the effector end; a control processor for generating and applying to said robot controller said control signal as an indication of an error between effector end and sensed seam location; comprising the following operative steps by the control process: applying to said control processor said first signal; applying to said control processor a reference signal characteristic of the spatial relation between a present effector end position and a present seam location; 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 said data by reference, and correlating said successive sensed locations with, said sensed locations 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 taught path as recovered therefrom; extrapolating by a predetermined amount from past positions on said recovered taught path to an anticipated position thereon; extrapolating by said predetermined amount from past elapsed distances to an anticipated elapsed distance for said effector end; interpolating said anticipated elapsed distance with at least two bounding said sensed locations elapsed distances in said look-up table for deriving a corresponding anticipated sensed location; correcting said anticipated sensed location in relation to said reference signal to provide an anticipated effector end position; comparing said anticipated effector end position with said anticipated recovered taught path position for deriving a present control signal in relation to said anticipated effector end position and said reference signal; and controlling by feedforward the robot controller in response to said present control signal; thereby to move the effector end to said anticipated position following each past position of the effector end and each past control signal therefor.
Claim 18
Independent Claim
419 words
A method of operating a robot system including: a robot controller for iteratively controlling an effector end with an error compensating control signal in relation to a taught path; said robot controller providing a first signal representative of the present effector end position; a seam sensor system having a sensor disposed ahead of the effector end for iteratively deriving data representing discrete successive sensed locations upon the seam ahead of the effector end; a control processor for generating and applying to said robot controller said control signal as an indication of an error between effector end and sensed seam location; comprising the following operative steps by the control process: applying to said control processor said first signal; applying to said control processor a reference signal characteristic of the spatial relation between a present effector end position and a present seam location; 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 said data by reference, and correlating said successive sensed locations with, said sensed locations 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 taught path as recovered therefrom; extrapolating by a predetermined amount from past positions on said recovered taught path to an anticipated position thereon; extrapolating by said predetermined amount from past elapsed distances to an anticipated elapsed distance for said effector end; interpolating said anticipated elapsed distance with at least two bounding said sensed locations elapsed distances in said look-up table for deriving a corresponding anticipated sensed location; correcting said anticipated sensed location in relation to said reference signal to provide an anticipated effector end position; comparing said anticipated effector end position with said anticipated recovered taught path position for deriving a present control signal in relation to said anticipated effector end position and said reference signal; and controlling by feedforward the robot controller in response to said present control signal; thereby to move the effector end to said anticipated position following each past position of the effector end and each past control signal therefor.
Claim 19
Dependent Claim
354 words
In a robot system including a robot controller for controlling an effector end along a seam in relation to a taught path and a seam tracker control system, the seam tracker system including a sensor system for sensing the seam ahead of the effector end and for deriving data representing discrete successive sensed locations upon the seam, and a control processor responsive to said sensor system and to said robot controller for deriving a control signal representative of an error between an effector end present position and a new position matching a sensed location, the effector end being controlled by said robot controller in relation to a present effector end position representative signal derived from said robot controller and to said control signal to provide continuous operation upon the seam with said effector end; the combination of: means responsive to said robot controller and associated with said control processor for successively calculating the distances between two consecutive sensed locations, for accumulating said distances to provide iteratively the elapsed distance down to the last sensed location and for providing orderly samples each representing such elapsed distance to identify the respective sensed locations upon the seam; look-up table means for storing data representing coordinates derived by the sensor system for each of said sensed locations in relation to and in order of said orderly samples; means within said control processor successively responsive to a present and a last position of said effector end for extrapolating therefrom to an anticipated position and for deriving an anticipated elapsed distance thereto; means responsive to a reference signal and operating within said control processor with said look-up table for correlating said anticipated elapsed distance of the effector end with a corresponding sample of said storing means to derive corresponding coordinates of an anticipated effector end location on the seam; comparator means within said control processor for deriving a present control signal in relation to said corresponding coordinates; and the control processor controlling the robot controller with said present control signal so as to effectuate feedforward control of the effector end toward a new position defined by said anticipated elapsed distance.
Claim 20
Dependent Claim
354 words
In a robot system including a robot controller for controlling an effector end along a seam in relation to a taught path and a seam tracker control system, the seam tracker system including a sensor system for sensing the seam ahead of the effector end and for deriving data representing discrete successive sensed locations upon the seam, and a control processor responsive to said sensor system and to said robot controller for deriving a control signal representative of an error between an effector end present position and a new position matching a sensed location, the effector end being controlled by said robot controller in relation to a present effector end position representative signal derived from said robot controller and to said control signal to provide continuous operation upon the seam with said effector end; the combination of: means responsive to said robot controller and associated with said control processor for successively calculating the distances between two consecutive sensed locations, for accumulating said distances to provide iteratively the elapsed distance down to the last sensed location and for providing orderly samples each representing such elapsed distance to identify the respective sensed locations upon the seam; look-up table means for storing data representing coordinates derived by the sensor system for each of said sensed locations in relation to and in order of said orderly samples; means within said control processor successively responsive to a present and a last position of said effector end for extrapolating therefrom to an anticipated position and for deriving an anticipated elapsed distance thereto; means responsive to a reference signal and operating within said control processor with said look-up table for correlating said anticipated elapsed distance of the effector end with a corresponding sample of said storing means to derive corresponding coordinates of an anticipated effector end location on the seam; comparator means within said control processor for deriving a present control signal in relation to said corresponding coordinates; and the control processor controlling the robot controller with said present control signal so as to effectuate feedforward control of the effector end toward a new position defined by said anticipated elapsed distance.
References Cited (Backward Citations)
US3150624A
Cited
US4215299A
Cited
USPTO Annuity & Maintenance Windows
| Annuity Stage | Window Opens | Payment Deadline | Surcharge Period Until | Estimated Fee | Status |
|---|---|---|---|---|---|
| 3.5 Years (Year 4) | 1992-05-22 | 1992-11-21 | 1993-05-23 | $2000.00 | Window Closed / Lapsed |
| 7.5 Years (Year 8) | 1996-05-22 | 1996-11-21 | 1997-05-23 | $3760.00 | Window Closed / Lapsed |
| 11.5 Years (Year 12) | 2000-05-22 | 2000-11-21 | 2001-05-23 | $7700.00 | Window Closed / Lapsed |