Patent EP0299403A1 successfully refreshed from Google Patents.
EP0299403A1
Expired / Lapsed
EP
⏱️ 0.0 years remaining
Method and apparatus for moving a tool along a curved path
Assignee: Milacron Inc
•
Filing: 1988-07-11
•
Granted: —
•
Expires: 2008-07-11
Abstract
Abstract A method of positioning a tool along a circular arc. The tool is carried by an automaton which is moved through a teaching phase during which it is taught coordinates and wrist orientation angles for three reference points. The method then proceeds into a work phase in which calculations are performed to determine coordinates and wrist angles for a series of work points spaced along the circular arc defined by the three reference points. Thereafter the automaton is direct to position the tool at the calculated coordinates and orientations.
Inventors
- 👤 Ronald Lee Tarvin
- 👤 Joseph William Schnelle
- 👤 Gregory Webb
- 👤 James Vaughn Brown
Bibliographic Details
Application Number
—
Jurisdiction
EP
Data Source
google_patents
Last Synchronized
2026-11-04 10:45
CPC Classifications
G; G05; G05B; G05B19/00; G05B19/02; G05B19/18; G05B19/41; G05B2219/00; G05B2219/30; G05B2219/45; G05B2219/45104
Claims Analysis
Total Claims: 33
Claim 1
Independent Claim
266 words
A method for controlling motion of a function element carried by a manilpulator and having associated therewith a workpoint, the motion described by an arc defining a path to be traversed by the workpoint and by a velocity of the workpoint, the arc being defined by input signals representing coordinates of three reference positions on the arc including the arc end positions, the velocity of the workpoint being defined by further input signals, the manipulator including movable members for effecting motion of the wrist and a servomechanism circuit for controlling the motion of the movable members, the method comprising the steps of: (a) calculating work plane orientation angles in response to the input signals representing the arc reference positions, the work plane orientation angles defining the attitude of a plane in which the arc lies; (b) producing arc intermediate position signals in response to the work plane orientation angles and the input signals defining the arc reference positions, and the velocity of the workpoint, the arc intermediate position signals representing a location on the arc to which the workpoint is to be moved in a predetermined time; (c) producing machine coordinate signals in response to the arc intermediate position signals, the machine coordinate signals defining the motion of the machine members between their positions at the current location of the workpoint and the location of the workpoint defined by the arc intermediate position; (d) applying the machine coordinate signals to the servomechanism circuit to move the workpoint to the arc intermediate position; and (e) iterating steps (b) through (d) to move the workpoint through the arc.
Claim 2
Independent Claim
266 words
A method for controlling motion of a function element carried by a manilpulator and having associated therewith a workpoint, the motion described by an arc defining a path to be traversed by the workpoint and by a velocity of the workpoint, the arc being defined by input signals representing coordinates of three reference positions on the arc including the arc end positions, the velocity of the workpoint being defined by further input signals, the manipulator including movable members for effecting motion of the wrist and a servomechanism circuit for controlling the motion of the movable members, the method comprising the steps of: (a) calculating work plane orientation angles in response to the input signals representing the arc reference positions, the work plane orientation angles defining the attitude of a plane in which the arc lies; (b) producing arc intermediate position signals in response to the work plane orientation angles and the input signals defining the arc reference positions, and the velocity of the workpoint, the arc intermediate position signals representing a location on the arc to which the workpoint is to be moved in a predetermined time; (c) producing machine coordinate signals in response to the arc intermediate position signals, the machine coordinate signals defining the motion of the machine members between their positions at the current location of the workpoint and the location of the workpoint defined by the arc intermediate position; (d) applying the machine coordinate signals to the servomechanism circuit to move the workpoint to the arc intermediate position; and (e) iterating steps (b) through (d) to move the workpoint through the arc.
Claim 3
Dependent Claim
80 words
The method according to Claim 1 wherein the step of producing arc intermediate position signals further comprises the steps of: (a) calculating an arc angle between the arc end positions; (b) calculating an arc length included by the arc angle; (c) calculating an angular increment to be traversed by the workpoint in a predetermined time interval; and (d) calculating the coordinates of a position on the arc located away from the present position of the workpoint by the angular increment.
Claim 4
Dependent Claim
74 words
The method according to Claim 2 wherein the step of producing machine coordinate signals further comprises the steps of: (a) producing a servointerrupt signal representing an increment time interval; (b) calculating coordinates of a workpoint location on a linear path between two successive arc intermediate positions in a response to the servointerrupt signal, the input signal representing velocity, and the arc intermediate position signals; and (c) transforming the workpoint location to machine coordinate signals.
Claim 5
Independent Claim
370 words
A method for controlling motion of a function element carried by a wrist of a manipulator and having associated therewith a workpoint and a tool vector, the motion described by an arc defining a path to be traversed by the workpoint, by a desired line of approach of the tool vector, and by a velocity of the workpoint, the arc being defined by input signals representing coordinates of three reference positions on the arc including the arc end positions, the line of approach being defined by input signals representing the orientation of the wrist at the reference positions, the velocity of the workpoint being defined by further input signals, the manipulator including movable members for effecting motion of the wrist and servomechanism circuit for controlling the motion of the movable members, the method comprising the steps of: (a) calculating work plane orientation angles in response to the input signals representing the arc reference positions, the work plane orientation angles defining the attitude of a plane in which the arc lies; (b) producing arc intermediate position signals in response to the work plane orientation angles and the input signals defining the arc reference positions and the velocity of the workpoint, the arc intermediate position signals representing a location on the arc to which the workpoint is to be moved in a predetermined time; (c) producing intermediate wrist orientation signals in response to the input signals representing the wrist orientation and the tool vector, the intermediate wrist orientation signals defining the attitude of the function element at the arc intermediate position; (d) producing machine coordinate signals in response to the intermediate wrist orientation signals and the arc intermediate position signals, the machine coordinate signals defining the motion of the machine movable members between their current positions and the positions defined by the arc intermediate position signals and the intermediate wrist orientation signals; (e) applying the machine coordinate signals to the servomechanism circuit to move the workpoint to the arc intermediate position and to move the function element to the attitude defined by the intermediate orientation signal; and (f) iterating the steps (b) through (e) to move the workpoint through the arc while maintaining the tool vector on the desired line of approach.
Claim 6
Independent Claim
370 words
A method for controlling motion of a function element carried by a wrist of a manipulator and having associated therewith a workpoint and a tool vector, the motion described by an arc defining a path to be traversed by the workpoint, by a desired line of approach of the tool vector, and by a velocity of the workpoint, the arc being defined by input signals representing coordinates of three reference positions on the arc including the arc end positions, the line of approach being defined by input signals representing the orientation of the wrist at the reference positions, the velocity of the workpoint being defined by further input signals, the manipulator including movable members for effecting motion of the wrist and servomechanism circuit for controlling the motion of the movable members, the method comprising the steps of: (a) calculating work plane orientation angles in response to the input signals representing the arc reference positions, the work plane orientation angles defining the attitude of a plane in which the arc lies; (b) producing arc intermediate position signals in response to the work plane orientation angles and the input signals defining the arc reference positions and the velocity of the workpoint, the arc intermediate position signals representing a location on the arc to which the workpoint is to be moved in a predetermined time; (c) producing intermediate wrist orientation signals in response to the input signals representing the wrist orientation and the tool vector, the intermediate wrist orientation signals defining the attitude of the function element at the arc intermediate position; (d) producing machine coordinate signals in response to the intermediate wrist orientation signals and the arc intermediate position signals, the machine coordinate signals defining the motion of the machine movable members between their current positions and the positions defined by the arc intermediate position signals and the intermediate wrist orientation signals; (e) applying the machine coordinate signals to the servomechanism circuit to move the workpoint to the arc intermediate position and to move the function element to the attitude defined by the intermediate orientation signal; and (f) iterating the steps (b) through (e) to move the workpoint through the arc while maintaining the tool vector on the desired line of approach.
Claim 7
Dependent Claim
80 words
The method according to Claim 4 wherein the step of producing arc intermediate position signals further comprises the steps of: (a) calculating the arc angle between the arc end positions; (b) calculating an arc length included by the arc angle; (c) calculating an angular increment to be traversed by the workpoint in a predetermined time interval; and (d) calculating the coordinates of a position on the arc located away from the present position of the workpoint by the angular increment.
Claim 8
Independent Claim
282 words
The method according to Clam 5 wherein the step of producing intermediate wrist orientation signals further comprises the steps of: (a) calculating process angles at the arc reference positions, the process angles defining the line of approach of the tool vector at the arc reference positions; (b) calculating process angles at the arc intermediate position in response to the angular increment and the process angles at the arc reference positions; (c) calculating a work plane orientation matrix in response to the work plane orientation angles, the work plane orientation matrix defining a transformation from a reference frame on the arc and including a normal to the work to a reference frame having a coincident origin and being parallel to the coordinate system from which the input signals are referenced; (d) calculating a process angle orientation matrix in response to the process angles at the arc intermediate position, the process angle orientation matrix defining a transformation from a reference frame at the workpoint and including the line of approach to a reference frame at the workpoint parallel to the coordinate system from which the input signals are referenced; (e) calculating a tool vector orientation matrix in response to the input signals defining the tool vector, the tool vector orientation matrix defining a transformation from a reference frame at the workpoint and including the tool vector to a reference frame at the workpoint parallel to the coordinate system from which the input signals are referenced; (f) calculating a wrist orientation matrix in response to the work plane orientation matrix, the process angle orientation matrix and the tool vector orientation matrix; and (g) calculating the wrist orientation angles in response to the wrist orientation matrix.
Claim 9
Independent Claim
282 words
The method according to Clam 5 wherein the step of producing intermediate wrist orientation signals further comprises the steps of: (a) calculating process angles at the arc reference positions, the process angles defining the line of approach of the tool vector at the arc reference positions; (b) calculating process angles at the arc intermediate position in response to the angular increment and the process angles at the arc reference positions; (c) calculating a work plane orientation matrix in response to the work plane orientation angles, the work plane orientation matrix defining a transformation from a reference frame on the arc and including a normal to the work to a reference frame having a coincident origin and being parallel to the coordinate system from which the input signals are referenced; (d) calculating a process angle orientation matrix in response to the process angles at the arc intermediate position, the process angle orientation matrix defining a transformation from a reference frame at the workpoint and including the line of approach to a reference frame at the workpoint parallel to the coordinate system from which the input signals are referenced; (e) calculating a tool vector orientation matrix in response to the input signals defining the tool vector, the tool vector orientation matrix defining a transformation from a reference frame at the workpoint and including the tool vector to a reference frame at the workpoint parallel to the coordinate system from which the input signals are referenced; (f) calculating a wrist orientation matrix in response to the work plane orientation matrix, the process angle orientation matrix and the tool vector orientation matrix; and (g) calculating the wrist orientation angles in response to the wrist orientation matrix.
Claim 10
Dependent Claim
102 words
The method according to Claim 4 wherein the step of producing machine coordinate signals further comprises the steps of: (a) producing a servointerrupt signal representing an increment time interval; (b) calculating coordinates of a workpoint location on a linear path between two successive arc intermediate positions in response to the servointerrupt signal and the arc intermediate position signals; (c) calculating wrist orientation angles to be associated with the workpoint location in response to the servointerrupt signal, the arc intermediate position signals and the intermediate wrist orientation signals; and (d) transforming the workpoint location and the wrist orientation angles to machine coordinate signals.
Claim 11
Independent Claim
443 words
A method for controlling motion of a function element mounted to a faceplate of a wrist of a manipulator and having associated therewith a workpoint and a tool vector, the motion described by an arc defining a path to be traversed by the workpoint, by a desired line of approach of the tool vector, and by a velocity of the workpoint, the arc being defined by input signals representing coordinates of three reference positions on the arc including the arc end positions, and further input signals defining the desired line of approach at each arc reference position, the velocity of the workpoint being defined by further input signals, and the tool vector being defined by further input signals, the manipulator including movable members for effecting motion of the wrist and servomechanism circuit for controlling the motion of the movable members, the method comprising the steps of: (a) calculating work plane orientation angles in response to the input signals representing the arc reference positions, the work plane orientation angles defining the attitude of a plane in which the arc lies; (b) producing process angle signals in response to the input signals defining the line of approach of the tool vector and the input signals defining the tool vector and in response to the work plane orientation angles, the process angle signals defining the attitude of the desired line of approach of the tool vector at each reference position; (c) producing arc intermediate position signals in response to the input signals defining the reference positions and the velocity of the workpoint and in response to the work plane orientation angles, the arc intermediate position signals representing a position on the arc to which the workpoint is to be moved in a predetermined time; (d) producing intermediate wrist orientation signals in response to the process angle signals and the work plane orientation angles, the intermediate wrist orientation signals defining the attitude of the tool vector at the position represented by the arc intermediate position signals; (e) producing machine coordinate signals in response to the intermediate wrist orientation signals and the arc intermediate position signals, the machine coordinate signals defining the motion of the movable machine members between their current positions and the positions defined by the arc intermediate position signals and the intermediate wrist orientation signals; (f) applying the machine coordinate signals to the servomechanism circuit to move the workpoint to the arc intermediate position and to move the function element to the attitude defined by the intermediate wrist orientation signals, and (g) iterating steps (c) through (f) to move the workpoint through the arc while maintaining the tool vector on the desired line of approach.
Claim 12
Independent Claim
443 words
A method for controlling motion of a function element mounted to a faceplate of a wrist of a manipulator and having associated therewith a workpoint and a tool vector, the motion described by an arc defining a path to be traversed by the workpoint, by a desired line of approach of the tool vector, and by a velocity of the workpoint, the arc being defined by input signals representing coordinates of three reference positions on the arc including the arc end positions, and further input signals defining the desired line of approach at each arc reference position, the velocity of the workpoint being defined by further input signals, and the tool vector being defined by further input signals, the manipulator including movable members for effecting motion of the wrist and servomechanism circuit for controlling the motion of the movable members, the method comprising the steps of: (a) calculating work plane orientation angles in response to the input signals representing the arc reference positions, the work plane orientation angles defining the attitude of a plane in which the arc lies; (b) producing process angle signals in response to the input signals defining the line of approach of the tool vector and the input signals defining the tool vector and in response to the work plane orientation angles, the process angle signals defining the attitude of the desired line of approach of the tool vector at each reference position; (c) producing arc intermediate position signals in response to the input signals defining the reference positions and the velocity of the workpoint and in response to the work plane orientation angles, the arc intermediate position signals representing a position on the arc to which the workpoint is to be moved in a predetermined time; (d) producing intermediate wrist orientation signals in response to the process angle signals and the work plane orientation angles, the intermediate wrist orientation signals defining the attitude of the tool vector at the position represented by the arc intermediate position signals; (e) producing machine coordinate signals in response to the intermediate wrist orientation signals and the arc intermediate position signals, the machine coordinate signals defining the motion of the movable machine members between their current positions and the positions defined by the arc intermediate position signals and the intermediate wrist orientation signals; (f) applying the machine coordinate signals to the servomechanism circuit to move the workpoint to the arc intermediate position and to move the function element to the attitude defined by the intermediate wrist orientation signals, and (g) iterating steps (c) through (f) to move the workpoint through the arc while maintaining the tool vector on the desired line of approach.
Claim 13
Dependent Claim
276 words
The method according to Claim 8 wherein the input signals defining the line of approach of the tool vector represent orientation angles of the wrist and the step of producing process angle signals further comprises the steps of: (a) calculating a work plane orientation matrix in response to the work plane orientation angles, the work plane orientation matrix defining a transformation between a frame of reference located on the arc and including a normal to the work plane and a frame of reference having a coincident origin and being parallel to the coordinate system from which the input signals are referenced; (b) calculating a wrist orientation matrix in response to the input signals representing the orientation angles of the wrist, the wrist orientation matrix defining a transformation from a frame of reference at the workpoint and including an axis parallel to a normal to the faceplate to a frame of reference at the workpoint and parallel to the coordinate system from which the input signals are referenced; (c) calculating a tool vector matrix in response to the input signals defining the tool vector, the tool vector matrix representing a transformation from a frame of reference at the workpoint and including the tool vector to a frame of reference at the workpoint and parallel to the coordinate system from which the input signals are referenced; (d) calculating a process angle orientation matrix in response to the work plane orientation matrix, the wrist orientation matrix and the tool vector matrix; and (e) calculating the process angles in response to the process angle orientation matrix; and (f) iteratively repeating the steps (a) through (e) for each arc reference position.
Claim 14
Dependent Claim
81 words
The method according to Claim 9 wherein the step of producing arc intermediate position signals further comprises the steps of: (a) calculating an arc angle included between the arc end positions; (b) calculating an arc length included by the arc angle; (c) calculating an angular increment to be traversed by the workpoint in a predetermined time interval; and (d) calculating the coordinates of a position on the arc located away from the present position of the workpoint by the angular increment.
Claim 15
Dependent Claim
65 words
The method according to Claim 10 wherein the step of producing intermediate wrist orientation signals further comprises the steps of: (a) calculating process angles at the arc intermediate positions; (b) calculating a wrist orientation matrix in response to the work plane matrix, the process angle matrix and the tool vector matrix; and (c) calculating the wrist orientation angles in response to the wrist orientation matrix.
Claim 16
Dependent Claim
112 words
The method according to Claim 11 wherein the step of producing machine coordinate signals further comprises the steps of: (a) producing a servointerrupt signal representing an increment time interval; (b) calculating coordinates of a workpoint location on a linear path between two successive arc intermediate positions in response to the servointerrupt signal, the input signal representing the velocity of the workpoint and the arc intermediate position signals; (c) calculating wrist orientation angles to be associated with the work point location in response to the servointerrupt signal, the arc intermediate position signals and the intermediate wrist orientation signals; and (d) transforming the workpoint location and the wrist orientation angles to machine coordinate signals.
Claim 17
Dependent Claim
263 words
The method according to Claim 8 wherein the input signals defining the line of approach of the tool vector represents desired process angles and the tool vector orientation angles and the step of calculating intermediate wrist orientation angles further comprises the steps of: (a) calculating process angles at the arc intermediate position; (b) calculating a process angle matrix in response to the process angles, the process angle matrix defining a transformation from a reference frame at the workpoint including the desired line of approach to a reference frame at the workpoint parallel to the coordinate system from which the input signals are referenced; (c) calculating a tool vector orientation matrix in response to the tool vector orientation angles the tool vector orientation matrix defining a transformation from a frame of reference at the workpoint including the tool vector to a frame of reference at the workpoint parallel to the coordinate system from which the input signals are referenced; (d) calculating a work plane orientation matrix at the intermediate position in response to the work plane orientation angles, the work plane orientation matrix defining a transformation from a frame of reference on the arc and including a normal to the work plane to a frame of reference having a coincident origin and being parallel to the coordinate system from which the input signals are referenced; (e) calculating a wrist orientation matrix in response to the process angle orientation matrix, the tool vector orientation matrix and the work plane orientation matrix; and (f) calculating the wrist orientation angles in response to the wrist orientation matrix.
Claim 18
Independent Claim
369 words
A method for controlling motion of a function element mounted to a faceplate of a wrist of a manipulator and having associated therewith a workpoint and a tool vector, the motion described by an arc defining a path to be traversed by the workpoint, by a desired line of approach of the tool vector, and by a velocity of the workpoint, the arc being defined by input signals representing coordinates of three reference positions on the arc including the arc end positions, and further input signals defining the line of approach of the tool vector at the arc reference positions, the velocity of the workpoint being defined by further input signals, and the tool vector being defined by still further input signals, the manipulator including movable members for effecting motion of the wrist and a servomechanism circuit for controlling the motion of the movable members, the method comprising the steps of: (a) producing process angle signals representing angles of the desired line of approach of the tool vector at each reference position; (b) producing arc intermediate position signals in response to the input signals defining the reference positions and the velocity of the workpoint, the arc intermediate position signals representing a position on the arc to which the workpoint is to be moved in a predetermined time; (c) producing intermediate wrist orientation signals in response to the process angle signals and the arc intermediate position signals, the intermediate wrist orientation signals defining the attitude of the function element at the position represented by the arc intermediate position signals; (d) producing machine coordinate signals in response to the intermediate wrist orientation signals and the arc intermediate position signals, the machine coordinate signals defining the motion of the machine members between their current positions and the positions defined by the arc intermediate position signals and the intermediate wrist orientation signals; (e) applying the machine coordinate signals to the servomechansim circuit to move the workpoint to the arc intermediate position and to move the function element to the attitude defined by the intermediate wrist orientation signals; and (f) iteratively repeating steps (b) through (e) to move the workpoint through the arc while maintaining the tool vector on the desired line of approach.
Claim 19
Independent Claim
369 words
A method for controlling motion of a function element mounted to a faceplate of a wrist of a manipulator and having associated therewith a workpoint and a tool vector, the motion described by an arc defining a path to be traversed by the workpoint, by a desired line of approach of the tool vector, and by a velocity of the workpoint, the arc being defined by input signals representing coordinates of three reference positions on the arc including the arc end positions, and further input signals defining the line of approach of the tool vector at the arc reference positions, the velocity of the workpoint being defined by further input signals, and the tool vector being defined by still further input signals, the manipulator including movable members for effecting motion of the wrist and a servomechanism circuit for controlling the motion of the movable members, the method comprising the steps of: (a) producing process angle signals representing angles of the desired line of approach of the tool vector at each reference position; (b) producing arc intermediate position signals in response to the input signals defining the reference positions and the velocity of the workpoint, the arc intermediate position signals representing a position on the arc to which the workpoint is to be moved in a predetermined time; (c) producing intermediate wrist orientation signals in response to the process angle signals and the arc intermediate position signals, the intermediate wrist orientation signals defining the attitude of the function element at the position represented by the arc intermediate position signals; (d) producing machine coordinate signals in response to the intermediate wrist orientation signals and the arc intermediate position signals, the machine coordinate signals defining the motion of the machine members between their current positions and the positions defined by the arc intermediate position signals and the intermediate wrist orientation signals; (e) applying the machine coordinate signals to the servomechansim circuit to move the workpoint to the arc intermediate position and to move the function element to the attitude defined by the intermediate wrist orientation signals; and (f) iteratively repeating steps (b) through (e) to move the workpoint through the arc while maintaining the tool vector on the desired line of approach.
Claim 20
Dependent Claim
207 words
The method according to Claim 14 wherein the input signals defining the line of approach of the tool vector represent orientation angles of the wrist and the step of producing process angle signals further comprises the steps of: (a) calculating a wrist orientation matrix in response to the input signals representing the orientation angles of the wrist, the wrist orientation matrix defining a transformation from a frame of reference at the workpoint and including an axis parallel to a normal to the faceplate to a frame of reference at the workpoint parallel to the coordinate system from which the input signals are referenced; (b) calculating a tool vector orientation matrix in response to the input signals defining the tool vector, the tool vector orientation matrix defining a transformation from a frame of reference at the workpoint and including the tool vector to a frame of reference at the workpoint parallel to the coordinate system from which the input signals are referenced; (c) calculating a process angle orientation matrix in response to the wrist orientation matrix and the tool vector orientation matrix; (d) calculating the process angles in response to the process angle orientation matrix; and (e) iterating the steps (a) through (d) for each arc reference position.
Claim 21
Dependent Claim
78 words
The method according to Claim 15 wherein the step of producing arc intermediate position signals further comprises the steps of: (a) calculating an arc angle included between the arc end positions; (b) calculating an arc length including the arc angle; (c) calculating an angular increment to be traversed in a predetermined period of time; and (d) calculating the coordinates of a position on the arc located away from the present position of the workpoint by the angular increment.
Claim 22
Independent Claim
61 words
The method according to Clam 16 wherein the step of producing intermediate wrist orientation signals further comprises the steps of: (a) calculating process angles at the arc intermediate position; (b) calculating a wrist orientation matrix in response to the process angle matrix and the tool vector matrix; and (c) calculating the wrist orientation angles in response to the wrist orientation matrix.
Claim 23
Independent Claim
61 words
The method according to Clam 16 wherein the step of producing intermediate wrist orientation signals further comprises the steps of: (a) calculating process angles at the arc intermediate position; (b) calculating a wrist orientation matrix in response to the process angle matrix and the tool vector matrix; and (c) calculating the wrist orientation angles in response to the wrist orientation matrix.
Claim 24
Dependent Claim
108 words
The method according to Claim 17 wherein the step of producing machine coordinate signals further comprises the steps of: (a) producing a servointerrupt signal representing an increment time interval; (b) calculating coordinates of a workpoint location on a linear path between two successive arc intermediate positions in response to the servointerrupt signal, the arc intermediate position signals and the input signal representing workpoint velocity; (c) calculating wrist orientation angles to be associated with the workpoint location in response to the servointerrupt signal, the arc intermediate position signals and the intermediate wrist orientation signals; and (d) transforming the workpoint location and the wrist orientation angles to machine coordinate signals.
Claim 25
Dependent Claim
195 words
The method according to Claim 14 wherein the input signals defining the line of approach of the tool vector represent desired process angles and the tool vector orientation angles and the step of producing intermediate wirst orientation angles further comprises the steps of: (a) calculating process angles at the intermediate point; (b) calculating a process angle orientation matrix in response to the process angles the process angle orientation matrix defining a transformation from a frame of reference at the workpoint and including the desired line of approach to a frame of reference at the workpoint parallel to the coordinate system from which the input signals are referenced; (c) calculating a tool vector matrix in response to the tool vector orientation angles the tool vector orientation matrix defining a transformation from a frame of reference at the workpoint and including the tool vector to a frame of reference at the workpoint parallel to the coordinate system from which the input signals are referenced; (d) calculating a wrist orientation matrix in response to the process angle orientation matrix and the tool vector matrix; and (e) calculating the wrist orientation angles in response to the wrist orientation matrix.
Claim 26
Independent Claim
255 words
An apparatus for controlling the motion of a function element mounted to a faceplate of a wrist of a manipulator and having associated therewith a workpoint and a tool vector, the motion being described by an arc defining a path to be travsersed by the workpoint, by a desired line of approach of the tool vector and by a velocity of the workpoint, the arc being defined by input signals representing coordinates of three reference positions on the arc including the arc end positions, the line of approach being defined by further signals, the velocity of the workpoint being defined by further input signals, the manipulator including movable members for effecting motion of the wrist and a servomechanism circuit for controlling the motion of the movable members, the apparatus comprising: (a) means for calculating work plane orientation angles in response to the input signals representing the arc reference positions, the work plane orientation angles defining the attitude of a plane in which the arc lies; (b) means for producing arc intermediate position signals in response to the input signals defining the arc reference positions, the velocity of the workpoint, and the work plane orientation angles, the arc intermediate position signals representing a location on the arc to which the workpoint is to be moved; (c) means for producing machine coordinate signals in response to the arc intermediate position signals, the machine coordinate signals defining the motion of the machine movable members between their current positions and the positions defined by the arc intermediate position signals.
Claim 27
Independent Claim
255 words
An apparatus for controlling the motion of a function element mounted to a faceplate of a wrist of a manipulator and having associated therewith a workpoint and a tool vector, the motion being described by an arc defining a path to be travsersed by the workpoint, by a desired line of approach of the tool vector and by a velocity of the workpoint, the arc being defined by input signals representing coordinates of three reference positions on the arc including the arc end positions, the line of approach being defined by further signals, the velocity of the workpoint being defined by further input signals, the manipulator including movable members for effecting motion of the wrist and a servomechanism circuit for controlling the motion of the movable members, the apparatus comprising: (a) means for calculating work plane orientation angles in response to the input signals representing the arc reference positions, the work plane orientation angles defining the attitude of a plane in which the arc lies; (b) means for producing arc intermediate position signals in response to the input signals defining the arc reference positions, the velocity of the workpoint, and the work plane orientation angles, the arc intermediate position signals representing a location on the arc to which the workpoint is to be moved; (c) means for producing machine coordinate signals in response to the arc intermediate position signals, the machine coordinate signals defining the motion of the machine movable members between their current positions and the positions defined by the arc intermediate position signals.
Claim 28
Dependent Claim
82 words
the apparatus of Claim 20 wherein the means for producing arc intermediate position signals further comprises: (a) means for calculating an arc angle included between the arc end positions; (b) means for calculating an arc length including the arc angle; (c) means for calculating an angular increment to be traversed in a predetermined period of time; and (d) means for calculating the coordinates of a position on the arc located away from the present position of the workpoint by the angular increment.
Claim 29
Dependent Claim
70 words
The apparatus according to Claim 21 wherein the means for producing machine coordinate signals further comprises: (a) means for producing a servointerrupt signal representing an increment time interval; (b) means responsive to the servointerrupt signal and the arc intermediate position signals for calculating coordinates of a workpoint location on a linear path between two successive arc intermediate positions; and (c) means for transforming the workpoint location to machine coordinate signals.
Claim 30
Dependent Claim
84 words
The apparatus according to Claim 22 wherein the input signals defining the line of approach of the tool vector represents orientation angles of the wrist and the apparatus for producing intermediate wrist orientation signals further comprises means for producing process angle signals in response to the work plane orientation angles, and the input signals representing the wrist orientation angles and the tool vector, the process angle signals representing angles of the desired line of approach of the tool vector at each arc reference position.
Claim 31
Dependent Claim
237 words
The apparatus according to Claim 23 wherein the apparatus for producing process angle signals further comprises: (a) means responsive to the work plane orientation angle calculating means for calculating a work plane orientation matrix defining a transformation from a frame of reference on the arc and including a normal to the work plane to a frame of reference having its origin coincident and being parallel to the coordinate system from which the input signals are referenced: (b) means responsive to the input signals representing the orientation angles of the wrist for calculating a wrist orientation matrix, the wrist orientation matrix defining a transformation from a reference frame at the workpoint and including an axis parallel to a normal to the faceplate to a reference frame at the workpoint parallel to the coordinate system from which the input signals are referenced: (c) means responsive to the input signals defining the tool vector for calculating a tool vector orientation matrix, the tool vector orientation matrix defining a transformation from a reference frame at the workpoint and including the tool vector to a reference frame at the workpoint parallel to the coordinate system from which the input signals are referenced; (d) means responsive to the work plane orientation matrix, the wrist orientation matrix, and the tool vector matrix for calculating a process angle orientation matrix; and (e) means responsive to the process angle orientation matrix for calculating the process angles.
Claim 32
Dependent Claim
74 words
The apparatus according to Claim 24 wherein the means for producing intermediate wrist orientation signals further comprises: (a) means responsive to the angular increment for calculating process angles at the arc intermediate position; (b) means responsive to the work plane orientation matrix, the process angle orientation matrix, and the tool vector orientation matrix for calculating a wrist orientation matrix; and (c) means responsive to the wrist orientation matrix for calculating the wrist orientation angles.
Claim 33
Dependent Claim
47 words
The apparatus according to Claim 20 further comprising means for producing intermediate wrist orientation signals in response to the input signals representing the line of approach of the tool vector, the intermediate wrist orientation signals defining the attitude of the function element at the arc intermediate positions.
References Cited (Backward Citations)
EP0071378A1
Cited
EP0144442A1
Cited
USPTO Annuity & Maintenance Windows
Maintenance schedule is calculated for granted US utility patents.