System for compensated motion of coupled robot axes
First Claim
1. Apparatus for controlling a manipulator to effect motion of a tool centerpoint, the manipulator including a first rotating member, first drive means for effecting rotation of the first member, a second rotating member and a second drive means for effecting rotation of the second member, the first and second members being mechanically coupled such that absent counter action by the second drive means, rotation of the first member by the first drive means effects rotation of the second member relative to the first member, the apparatus comprising:
- (a) control means commanding a location of the tool centerpoint;
(b) first measuring means responsive to actual rotation of the first member relative to a reference for measuring rotation of the first member relative to the reference;
(c) second measuring means responsive to actual rotation of the second member relative to the first member for measuring rotation of the second member relative to the first member, the second measuring means measuring the rotation of the second member caused by the mechanical coupling of rotation of the first member;
(d) first servomechanism means responsive to the control means and the first measuring means for producing a first error signal for controlling the first drive means; and
(e) second servomechanism means responsive to the control means, the second measuring means, and the first error signal for producing a second error signal for controlling the second drive means to counteract the rotation of the second member caused by the coupled rotation of the first member.
1 Assignment
0 Petitions
Accused Products
Abstract
A system for accurately and smoothly moving the tool centerpoint of a manipulator device. The system includes means for measuring the angles at the elbow pivot joint and shoulder pivot joint of the manipulator device. Required compensating movement in a second axis of the manipulator linkage as a result of movement in a first axis thereof is anticipated by the control system to enable substantially simultaneous movement of both axes, and feedback of the angular position of the pivot joints during such movements enables enhancement of the precision of the tool centerpoint movement.
-
Citations
16 Claims
-
1. Apparatus for controlling a manipulator to effect motion of a tool centerpoint, the manipulator including a first rotating member, first drive means for effecting rotation of the first member, a second rotating member and a second drive means for effecting rotation of the second member, the first and second members being mechanically coupled such that absent counter action by the second drive means, rotation of the first member by the first drive means effects rotation of the second member relative to the first member, the apparatus comprising:
-
(a) control means commanding a location of the tool centerpoint; (b) first measuring means responsive to actual rotation of the first member relative to a reference for measuring rotation of the first member relative to the reference; (c) second measuring means responsive to actual rotation of the second member relative to the first member for measuring rotation of the second member relative to the first member, the second measuring means measuring the rotation of the second member caused by the mechanical coupling of rotation of the first member; (d) first servomechanism means responsive to the control means and the first measuring means for producing a first error signal for controlling the first drive means; and (e) second servomechanism means responsive to the control means, the second measuring means, and the first error signal for producing a second error signal for controlling the second drive means to counteract the rotation of the second member caused by the coupled rotation of the first member. - View Dependent Claims (2, 3, 4, 5, 6, 7)
-
-
8. Apparatus for controlling a manipulator to effect motion of a tool centerpoint, the manipulator including an upper arm pivotally mounted on a base at a first pivot, a forearm pivotally mounted on the upper arm, a first link pivotally connected to the base at the first pivot, a second link pivotally connected to the first link and pivotally connected to the forearm, the upper arm, forearm, first link, and second link defining a four bar link mechanism, a first drive means for effecting rotation of the upper arm, and second drive means for effecting rotation of the first link, the apparatus comprising:
-
(a) control means for commanding a position of the tool centerpoint; (b) first measuring means responsive to actual rotation of the upper arm relative to the base for measuring rotation of the upper arm relative to the base; (c) second measuring means responsive to actual rotation of the forearm relative to the upper arm for measuring rotation of the forearm relative to the upper arm, the second measuring means measuring rotation of the forearm caused by the mechanically coupled rotation of the upper arm; (d) first servomechanism means responsive to the control means and the first measuring means for producing a first error signal for controlling the first drive means; and (e) second servomechanism means responsive to the control means, the first error signal and the second measuring means for producing a second error signal for controlling the second drive means to counteract the rotation of the forearm caused by coupled rotation of the upper arm. - View Dependent Claims (9, 10, 11, 12, 13, 14)
-
-
15. Method for controlling a manipulator to effect motion of a tool centerpoint, the manipulator including two rotating members which are mechanically coupled such that rotation of a first member effects rotation of a second member relative to the first member, first drive means for effecting rotation of the first member, and second drive means for effecting rotation of the second member, the first drive means being responsive to a first servomechanism means and the second drive means being responsive to a second servomechanism means, the method comprising the step of:
-
(a) producing first control signals representing a desired rotation of the first member defined by a desired position of the tool centerpoint; (b) producing second control signals representing a desired rotation of the second member defined by a desired position of the tool centerpoint; (c) producing in response to actual rotation of the first member a first position signal representing the actual rotation of the first member relative to a reference; (d) producing in response to actual rotation of the second member relative to the first member a second position signal representing the actual rotation of the second member relative to the first member, the second position signal representing rotation of the second member caused by the coupled rotation of the first member; (e) producing a first error signal in response to the first control signal and the first position signal, the first error signal controlling the first drive means; and (f) producing a second error signal in response to the first error signal, the second control signal, and the second position signal, the second error signal controlling the second drive means to counteract the rotation of the second member relative to the first member resulting from the coupled rotation of the first member. - View Dependent Claims (16)
-
Specification