Method of controlling robot movement
First Claim
1. A method of controlling movement of a tool that is supported by a robot having a wrist that is moveable about a plurality of wrist axes that are associated with a wrist origin, comprising the steps of:
- (A) positioning the tool adjacent a preselected tool path;
(B) moving the wrist origin along a predetermined wrist path corresponding to the preselected tool path;
(C) moving the tool in a first direction away from the preselected tool path by moving only the wrist about at least one of the wrist axes;
(D) moving the tool in a second direction back toward the preselected tool path by moving only the wrist about at least one of the wrist axes; and
(E) cyclically performing steps (C) and (D) while performing step (B).
1 Assignment
0 Petitions
Accused Products
Abstract
A method of controlling movement of a robot includes moving only the wrist portion about two of the wrist axes to achieve a repeated and cyclical movement, such as a back-and-forth movement of the tool relative to a preselected path. Since only the wrist is moved, the range of available tool positions can be determined. In most instances, the desired position of the tool as it deviates from the path is outside of the range of available tool positions, given that only the wrist will move. The method of this invention includes determining a target position within the range of available positions that best corresponds to the desired position of the tool. A unique inverse kinematics solution, which includes fixing one of the wrist axes, is used to determine the wrist orientation required to place the tool into the target position.
-
Citations
29 Claims
-
1. A method of controlling movement of a tool that is supported by a robot having a wrist that is moveable about a plurality of wrist axes that are associated with a wrist origin, comprising the steps of:
-
(A) positioning the tool adjacent a preselected tool path; (B) moving the wrist origin along a predetermined wrist path corresponding to the preselected tool path; (C) moving the tool in a first direction away from the preselected tool path by moving only the wrist about at least one of the wrist axes; (D) moving the tool in a second direction back toward the preselected tool path by moving only the wrist about at least one of the wrist axes; and (E) cyclically performing steps (C) and (D) while performing step (B). - View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 20, 21)
-
-
14. A method of controlling movement of a tool that is supported by a robot having a wrist that is moveable about three wrist axes that are each associated with a wrist origin, comprising the steps of:
-
(A) moving the wrist origin along a predetermined wrist path; (B) determining a desired tool position; (C) determining a next tool position from a range of tool positions available by moving only the wrist about the wrist axes with the wrist origin in a current wrist origin position; (D) determining a position vector between the current wrist origin position and the next tool position; (E) determining a set of wrist axis positions necessary to move the tool into the next tool position from the determined position vector and the determined next tool position; (F) moving the tool from a current tool position into the next tool position by moving only the wrist into the determined set of wrist axis positions. - View Dependent Claims (15, 16)
-
-
17. A system for controlling robot movement, comprising:
-
a robot arm having a plurality of arm axes about which said arm is moveable; a robot wrist supported on one end of said arm and having a wrist origin and a plurality of wrist axes that provide movement of said wrist relative to said wrist origin; a tool supported by said wrist; a wrist actuator for moving said wrist about said wrist axes; and a controller including means for determining a desired tool position; means for determining a next tool position from a range of tool positions available by moving only the wrist about the wrist axes with the wrist origin in a current wrist origin position; means for determining a position vector between the current wrist origin position and the next tool position; means for determining a set of wrist axis positions necessary to move the tool into the next tool position from the determined position vector and the determined next tool position; and command means for commanding said wrist actuator to move the tool from a current tool position into the next tool position by moving only the wrist into the determined set of wrist axis positions. - View Dependent Claims (18, 19)
-
-
22. A method of controlling movement of a tool that is supported by a robot having a wrist that is moveable about a plurality of wrist axes that are associated with a wrist origin, comprising the steps of:
-
(A) positioning the tool adjacent a preselected tool path; (B) moving the wrist origin along a predetermined wrist path corresponding to the preselected tool path; (C) moving the tool in a first direction away from the preselected tool path by moving only the wrist about at least one of the wrist axes by determining a desired tool position that is spaced from the preselected path, determining a range of available tool positions based upon only moving the wrist about the wrist axes, determining a next tool position, from within the range of available tool positions, that corresponds to the desired tool position, and moving the tool to the next tool position by moving only the wrist while maintaining the wrist origin on the wrist path; (D) moving the tool in a second direction back toward the preselected tool path by moving only the wrist about at least one of the wrist axes; and (E) cyclically performing steps (C) and (D) while performing step (B). - View Dependent Claims (23, 24, 25, 26, 27, 28, 29)
-
Specification