Industrial robot with servo
First Claim
Patent Images
1. A servocontrolled apparatus comprising:
- a proximal member and a distal member, said members being driven relative to each other by an actuator;
means for supplying a velocity command signal;
means affixed to one of said members for sensing the relative velocity between said members, said sensing means providing a member velocity signal;
means for comparing said velocity command signal to said member velocity signal, said sensing means providing a velocity error signal; and
a velocity compensation network receiving said velocity error signal, said velocity compensation network providing a torque command signal;
means for sensing the torque exerted between said first and second members on said distal member by said actuator, said sensing means providing a member torque signal;
means for comparing said torque command signal to said member torque signal, said comparing means providing a torque error signal;
a torque compensation network receiving said torque error signal providing an output signal;
means for amplifying said output signal; and
means for supplying said amplified signal to said actuator whereby a force is produced in response thereto.
0 Assignments
0 Petitions
Accused Products
Abstract
In a device having a first member and a second member which are driven relative to one another by an actuator, a servocontrol derives feedback by sensing the torque applied on one of the members by the actuator. The actuator drive signal is modified by a compensation network in response to the torque measurement to provide stability across a bandwidth extending beyond the resonant frequency of the members, thereby providing smooth, accurate and precise motion.
199 Citations
19 Claims
-
1. A servocontrolled apparatus comprising:
-
a proximal member and a distal member, said members being driven relative to each other by an actuator; means for supplying a velocity command signal; means affixed to one of said members for sensing the relative velocity between said members, said sensing means providing a member velocity signal; means for comparing said velocity command signal to said member velocity signal, said sensing means providing a velocity error signal; and a velocity compensation network receiving said velocity error signal, said velocity compensation network providing a torque command signal; means for sensing the torque exerted between said first and second members on said distal member by said actuator, said sensing means providing a member torque signal; means for comparing said torque command signal to said member torque signal, said comparing means providing a torque error signal; a torque compensation network receiving said torque error signal providing an output signal; means for amplifying said output signal; and means for supplying said amplified signal to said actuator whereby a force is produced in response thereto. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 17)
-
-
18. A method of position control in a structure having a first member and a second member connected by a drive system comprising the steps of:
-
a. determining the relative position between said first and second members and producing in response thereto an instantaneous position signal; b. comparing said instantaneous position signal to a reference position signal and producing in response thereto a velocity goal signal; c. determining the relative velocity between said first and second members and producing in response thereto an instantaneous velocity signal; d. comparing said instantaneous velocity signal to said velocity goal signal and producing in response thereto an acceleration goal signal; e. determining the motive force supplied by said drive system between said first and second members and producing in response thereto an instantaneous force signal; and f. comparing said instantaneous force signal to said acceleration goal signal and producing in response thereto a drive system command signal.
-
-
19. A method of improved dynamic and static position control of a manipulator endpoint, the manipulator having a proximal structural member and a distal structural member driven relative to each other by a drive mechanism, comprising the steps of:
-
a. providing a position error signal indicative of the difference between the desired position of said distal member relative to said proximal member and the actual position of said distal member relative to said proximal member; b. providing a velocity signal indicative of the actual velocity of said distal member relative to said proximal member; c. combining said position error signal and velocity signal to produce an output signal; d. providing a force signal indicative of the force between said distal member and said proximal member; e. combining said output signal and said force signal to produce a drive signal whereby said drive signal corrects for nonideal mechanical properties or vibrations that otherwise would affect the position of said manipulator endpoint.
-
Specification