Trajectory correlation and error detection method and apparatus

Claim 2

In a programmable manipulator apparatus, the combination of, a manipulator arm movable in a plurality of axes, memory means having stored therein a plurality of command signals representing desired positions of said arm in each of said axes and representing an operational work cycle of said manipulator arm, means for developing digital position signals representing the position of said arm in each of said axes, means responsive to said memory means and said position signal developing means for moving said arm to the positions represented by said command signals, and means responsive to said position signal developing means and having stored therein a plurality of said digital position signals representing the positions of said arm at predetermined time intervals through said work cycle for detecting a predetermined deviation between each of said stored position signals and respective ones of said position signals from said position signal developing means at said predetermined time intervals.

Claim 3

The combination of claim 1 wherein said detecting means further comprises means for storing a series of said position signals from said position signal developing means as said manipulator arm is moved through a plurality of desired positions defining a first operating cycle and for reading out said stored series of position signals during operating cycles successive to said first cycle, means responsive to said storing and read out means and to said position signal developing means for comparing said stored position signals and said position signals from said position signal developing means at corresponding respective positions of said first and said successive operating cycles, said comparing means developing a difference signal related to the difference between said respective stored position signals and said signals from said position signal developing means, and means responsive to said difference signal for determining when said difference signal exceeds a predetermined limit.

Claim 4

The combination of claim 2 wherein said position signals are in a parallel data format, said storing and read out means comprising a memory stage operable in a record mode and a readout mode in a serial data format, means responsive to said position signal developing means for transforming said parallel data format to a serial data format, said parallel to serial transforming means providing said serial data format for recording into said memory stage, and means for transforming said data in a serial format read out from said memory stage to a parallel data format for presentation to said comparing means.

Claim 5

The combination of claim 3 wherein said comparing means comprises a first and a second multiplex scanning stage and a digital comparator stage, each of said multiplex scanning stages grouping an entered parallel data format into a predetermined number of parallel data groups according to a predetermined multiplex scanning signal, said number of parallel data groups being equal to the number of said axes and each corresponding to a predetermined one of said axes, said first multiplex scanning stage connected between said position signal developing means and a first digital input of said comparator stage, said second multiplex scanning stage being connected between said parallel to serial transforming means and a second digital input of said comparator means.

Claim 6

The combination of claim 4 wherein said difference signal determining means is responsive to the digital output of said comparator stage and comprises a digital-to-analog converter stage responsive to said digital comparator output and an analog comparator stage having the output of said digital-to-analog converter stage as a first input and a reference voltage as a second input.

Claim 7

The combination of claim 5 wherein said analog comparator stage develops an output whenever said output of said analog comparator exceeds said reference voltage input indicating a predetermined deviation has been exceeded between said stored position signals and said position signals from said position signal developing means.

Claim 8

The combination of claim 2 wherein said storing and readout means comprises interval timing means for controlling the recording of said position signals at predetermined intervals and the readout of said stored position signals at predetermined intervals.

Claim 9

The combination of claim 7 wherein said interval timing means comprises means for synchronizing the readout of stored position signals to the operation of said manipulator arm.

Claim 10

The combination of claim 7 wherein said command signal developing means comprises means for generating predetermined and emergency pause signals, said storing and readout means being responsive to said generating means.

Claim 11

Apparatus for detecting the occurrence of a predetermined deviation between the desired positions of a programmed manipulator and respective actual positions during a repetitive work cycle, said programmed manipulator having a manipulator arm controllable in a plurality of axes, absolute position encoders for each of said axes to develop digital position signal representations, a digital memory having stored therein a plurality of command signals representing the desired position of said manipulator, and control apparatus for moving said manipulator arm to said desired position in response to said digital position signals from said absolute position encoders and said command signals stored in said digital memory, said detecting apparatus comprising: means for storing a series of digital signals from said absolute position encoders representing desired positions of said manipulator; means for recalling said stored signals during said work cycle; means for comparing said stored signals with the actual position signals from said absolute position encoders during said work cycle; and means responsive to said comparing means for determining when said manipulator is deviating from said stored desired position representations by a predetermined amount.

Claim 12

Apparatus for detecting the occurrence of a predetermined deviation between the desired positions of a programmed manipulator and respective actual positions during a repetitive work cycle, said programmed manipulator having a manipulator arm controllable in a plurality of axes, absolute position encoders for each of said axes to develop digital position signal representations, a digital memory having stored therein a plurality of command signals representing the desired position of said manipulator, and control apparatus for moving said manipulator arm to said desired position in response to said digital position signals from said absolute position encoders and said command signals stored in said digital memory, said detecting apparatus comprising: means for storing a series of digital signals from said absolute position encoders representing desired positions of said manipulator; means for recalling said stored signals during said work cycle; means for comparing said stored signals with the actual position signals from said absolute position encoders during said work cycle; and means responsive to said comparing means for determining when said manipulator is deviating from said stored desired position representations by a predetermined amount.

Claim 15

In a programmable manipulator apparatus, the combination of, a manipulator arm movable in a plurality of axes, program control means for moving said arm over a predetermined path during a playback cycle, means for developing position signals representing the position of said arm in each of said axes as said arm is moved over said path during a playback cycle, said program control means having stored therein a plurality of command signals representing desired positions of said manipulator arm during said playback cycle and being responsive to said position signal developing means, means for recording said position signals at predetermined spaced time intervals as said arm is moved over said path during a playback cycle, and means for comparing said recorded position signals with the position signals developed as said arm is moved over said path during succeeding playback cycles.

Claim 16

In a programmable manipulator apparatus, the combination of, a manipulator arm movable in a plurality of axes, program control means for moving said arm over a predetermined path during a playback cycle, means for developing position signals representing the position of said arm in each of said axes as said arm is moved over said path during a playback cycle, said program control means having stored therein a plurality of command signals representing desired positions of said manipulator arm during said playback cycle and being responsive to said position signal developing means, means for recording said position signals at predetermined spaced time intervals as said arm is moved over said path during a playback cycle, and means for comparing said recorded position signals with the position signals developed as said arm is moved over said path during succeeding playback cycles.

Claim 17

The combination of claim 12 which includes means connected to the output of said comparing means for producing a control signal when the position signals developed by said position signal developing means differ from said recorded position signals by a predetermined amount.

Claim 18

The combination of claim 13, wherein said control signal controls an alarm circuit.

Claim 19

In a programmable manipulator apparatus, the combination of: a manipulator arm movable in a plurality of axes; means for developing command signals representing desired positions of said arm in each of said axes; means for developing position signals representing the positions of said arm in a parallel data format in each of said axes; means responsive to said command signal means and said position signal means for moving said arm to the positions represented by said command signals; and means responsive to said position signal developing means and having stored therein a plurality of said position signals representing the positions of said arm for detecting a predetermined deviation between said stored position signals and said position signals from said position signal developing means; said detecting means further comprising means for storing a series of said position signals from said position signal developing means as said manipulator arm is moved through a plurality of desired positions defining a first operating cycle and for reading out said stored series of positions signals during operating cycles successive to said first cycle; means responsive to said storing and read out means and to said position signal developing means for comparing said stored position signals and said position signals from said position signal developing means at corresponding respective positions of said first and said successive operating cycles, said comparing means developing a difference signal related to the difference between said respective stored position signals and said signals from said position signal developing means, and means responsive to said difference signal for determining when said difference signal exceeds a predetermined limit, said storing and read out means comprising a memory stage operable in a record mode and a read out mode in a serial data format, means responsive to said position signal developing means for transforming said parallel data format to a serial data format, said parallel to serial transforming means providing said serial data format for recording into said memory stage, and means for transforming said data in a series format read out from said memory stage to a parallel data format for presentation to said comparing means.

Claim 20

In a programmable manipulator apparatus, the combination of: a manipulator arm movable in a plurality of axes; means for developing command signals representing desired positions of said arm in each of said axes; means for developing position signals representing the positions of said arm in a parallel data format in each of said axes; means responsive to said command signal means and said position signal means for moving said arm to the positions represented by said command signals; and means responsive to said position signal developing means and having stored therein a plurality of said position signals representing the positions of said arm for detecting a predetermined deviation between said stored position signals and said position signals from said position signal developing means; said detecting means further comprising means for storing a series of said position signals from said position signal developing means as said manipulator arm is moved through a plurality of desired positions defining a first operating cycle and for reading out said stored series of positions signals during operating cycles successive to said first cycle; means responsive to said storing and read out means and to said position signal developing means for comparing said stored position signals and said position signals from said position signal developing means at corresponding respective positions of said first and said successive operating cycles, said comparing means developing a difference signal related to the difference between said respective stored position signals and said signals from said position signal developing means, and means responsive to said difference signal for determining when said difference signal exceeds a predetermined limit, said storing and read out means comprising a memory stage operable in a record mode and a read out mode in a serial data format, means responsive to said position signal developing means for transforming said parallel data format to a serial data format, said parallel to serial transforming means providing said serial data format for recording into said memory stage, and means for transforming said data in a series format read out from said memory stage to a parallel data format for presentation to said comparing means.

Claim 21

The combination of claim 15 wherein said comparing means comprises first and second multiplex scanning stages and a digital comparator stage, each of said multiplex scanning stages grouping an entered parallel data format into a predetermined number of parallel data groups according to a predetermined multiplex scanning signal, said number of parallel data groups being equal to the number of said axes and each corresponding to a predetermined one of said axes, said first multiplex scanning stage connected between said position signal developing means and a first digital input of said comparator stage, and said second multiplex scanning stage being connected between said parallel to serial transforming means and a second digital input of said comparator means.

Claim 22

The combination of claim 16 wherein said difference signal determining means is responsive to the digital output of said comparator stage and comprises a digital-to-analog converter stage responsive to said digital comparator output and an analog comparator stage having the output of said digital-to-analog converter stage as a first input and a reference voltage as a second input.

Claim 23

The combination of claim 17 wherein said analog comparator stage develops an output whenever said output of said analog comparator exceeds said reference voltage input indicating a predetermined deviation has been exceeded between said stored position signals and said position signals from said position signal developing means.