United States Patent m
Megherbi
[54] METHOD AND APPARATUS FOR
CONTROLLING ROBOT MOTION AT AND
NEAR SINGULARITIES AND FOR ROBOT
MECHANICAL DESIGN
[76] Inventor: Dalila Megherbi, 106 E. Manning St., #1C, Providence, R.I. 02906
[21] Appl. No.: 496,675
[22] Filed: Mar. 21,1990
Related U.S. Application Data
[63] Continuation-in-part of Ser. No. 352,772, May 16, 1989, abandoned.
[51] Int. C1.5 G05B 19/18
[52] U.S. CI 318/568.1; 318/568.11;
901/8; 901/15; 395/1
[58] Field of Search 318/560-640;
364/513, 167.01, 174, 191, 192; 901/2, 3, 9, 8, 12, 13, 15, 18, 19, 20, 21, 22, 23
[56] References Cited
U.S. PATENT DOCUMENTS
4,362,977 12/1982 Evans et al 901/9 X
4,594,671 6/1986 Sugimoto et al 364/513
4,604,716 8/1986 Kato et al 318/568.11
4,680,519 7/1987 Chand et al 364/513 X
4,763,276 8/1988 Perreirra et al. 364/513
4,794,547 12/1988 Nishida 901/15 X
4,823,279 4/1989 Perzley et al 364/513
4,853,874 8/1989 Iwamoto et al 901/8 X
4,860,215 8/1989 Seraji 364/513
OTHER PUBLICATIONS
V. C. Klema and A. J. Laub, "The Singular Value
Decomposition: Its Computation and Some Applica-
tion", IEEE Transactions on Automatic Control, vol.
AC-25, No. 2, Apr. 1980, pp. 164-176.
S. K. Chan and P. D. Lawrence, "General Inverse
Kinematics With the Error Damped Pseudoinverse,"
Proceedings of the 1988 International Conference on
Robotics and Automation, pp. 834-839.
P. R. Chang and C. S. G. Lee, "Residue Arithmetic
VLSI Array Architecture for Manipulator Pseudo-In-
verse Jacobian Computation," Proc. of 1988 IEEE
...
US005159249A
[ii] Patent Number: 5,159,249 [45] Date of Patent: Oct. 27,1992
International Conference on Robotics and Automation, vol. 1, pp. 297-302.
J. Y. S. Luh, M. W. Walker and R. P. C. Paul, "Resolved-Acceleration Control of Mechanical Manipulators," IEEE Transactions On Automatic Control, vol. AC-25, No. 3, Jun. 1980, pp. 468-474. B. Armstrong, O. Khatib, J. Burdick, "The Explicit Dynamic Model and Inertial Parameters of the PUMA 560 Arm," Proceedings of the IEEE International Conference on Robotics and Automation, San Francisco, Calif. Apr., 1986, pp. 510-518.
(List continued on next page.)
Primary Examiner—Bernard Roskoski
Assistant Examiner—Paul Ip
Attorney, Agent, or Firm—Darby & Darby
[57] ABSTRACT
This invention relates to the field of computer controlled robotics. More specifically, it relates to a novel method and algorithm to symbolically decompose the robot jacobian matrix, in such a way that the robot jacobian Moore-Penrose pseudo-inverse is obtained symbolically even when the robot jacobian is ill conditioned or rank deficient, and to a general purpose computer and method to perform the symbolic steps. The resulting symbolic pseudo-inverse, after symbolic reduction techniques, is not only efficient from the point of view of number of floating point operations, but is also accurate (exact) and stable. It removes the restrictions imposed by the computational complexity of the jacobian pseudo-inverse, especially when the robot jacobian is ill conditioned (robot near/at singularities). This method is sufficiently fast to allow real time control of the robot and is sufficiently stable to allow good robot performance near singularities. In addition, the method presented in this invention is of special importance for the future design of prototypes of robot manipulators, as well as for robot trajectory planning.
12 Claims, 26 Drawing Sheets
OTHER PUBLICATIONS
M. B. Leahy, Jr., L. M. Nugent, K. P. Valavanis, and G. N. Saridis, "Efficient Dynamics for a Puma-600," Proceedings of the IEEE International Conference on Robotics and Automation, San Francisco, Calif. Apr. 1986, pp. 519-524.
C. A. Klein and C. Huang, "Review of Pseudoinverse Control for use with Kinematically Redundant Manipulators," IEEE Transactions of Systems, Man, and Cybernetics, Col. SMC-13, No. 3, Mar./Apr. 1983, pp. 245-250.
J. M. Hollerbach and K. C. Suh. "Redundancy Resolu-
tion of Manipulators through Torque Optimization,"
Proc. IEEE International Conference On Robotics and
Automation, 1985, pp. 1016-1021.
Y. Nakamura and H. Hanafusa, "Task Priority Based
Redundancy Control Of Robot Manipulators," Second
International Symposium, eds. H. Hanafusa and H.
Inoue, Cambridge, Mass., M.I.T. Press, 1985, pp. 155-162.
J. Denavit and R. S. Hartenberg, "A Kinematic Notation for lower-pair Mechanisms Based on Matrices," Journal of Applied Mechanics, pp. 215-221, Jun. 1955. M. Vukobratovic and M. Kircanski, "A Dynamic Approach to Nominal Trajectory Synthesis for Redundant Manipulators," IEEE Transactions on Systems, Man, and Cybernetics, Vol. SMC-14, No. 4, Jul./Aug. 1984, pp. 580-586.
A. Leigeois, "Automatic Supervisory Control of the Configuration and Behavior of Multibody Mechanisms," IEEE Transactions on Systems, Man, and Cybernetics, Vol. SMC-7, No. 12, Dec. 1977, pp. 868-871. A. Fournier and W. Khali], "Coordination and Reconfiguration of Mechanical Redundant Systems," Proc. of Int'l Conference on Cybernetics and Society, Sep. 19-21, 1977, pp. 227-231.
|
