This paper presents an approach to formulating task-level motion-control for holonomically constrained multibody systems based on a mass-weighted orthogonal decomposition. The basis for this approach involves the formation of a recursive null space for constraints and motion-control tasks onto which subsequent motion-control tasks are projected. The recursive null space arises out of the process of orthogonalizing individual task Jacobian matrices. This orthogonalization process is analogous to the Gram–Schmidt process used for orthogonalizing a vector basis. Based on this mass-weighted orthogonal decomposition, recursive algorithms are developed for formulating the overall motion-control equations. The natural symmetry between task-level dynamics and the dynamics of constrained systems is exploited in this approach. An example is presented to illustrate the practical application of this methodology.

1.
De Sapio
,
V.
,
Khatib
,
O.
, and
Delp
,
S.
, 2006, “
Task-Level Approaches for the Control of Constrained Multibody Systems
,”
Multibody Syst. Dyn.
1384-5640,
16
(
1
), pp.
73
102
.
2.
DeSapio
,
V.
,
Holzbaur
,
K.
, and
Khatib
,
O.
, 2006, “
The Control of Kinematically Constrained Shoulder Complexes: Physiological and Humanoid Examples
,”
Proceedings of the 2006 IEEE International Conference on Robotics and Automation
,
IEEE
,
New York
, Vol.
1
, pp.
470
475
.
3.
Bruyninckx
,
H.
, and
Khatib
,
O.
, 2000., “
Gauss’ Principle and the Dynamics of Redundant and Constrained Manipulators
,”
Proceedings of the 2000 IEEE International Conference on Robotics and Automation
,
IEEE
,
New York
, Vol.
3
, pp.
2563
2568
.
4.
Khatib
,
O.
, 1987, “
A Unified Approach to Motion and Force Control of Robot Manipulators: The Operational Space Formulation
,”
IEEE J. Rob. Autom.
0882-4967,
3
(
1
), pp.
43
53
.
5.
Khatib
,
O.
, 1995, “
Inertial Properties in Robotic Manipulation: An Object Level Framework
,”
Int. J. Robot. Res.
0278-3649,
14
(
1
), pp.
19
36
.
6.
Burdick
,
J.
, 1989, “
On the Inverse Kinematics of Redundant Manipulators: Characterization of the Self-Motion Manifolds
,”
Proceedings of the 1989 IEEE International Conference on Robotics and Automation
,
IEEE
,
New York
, Vols.
1–3
, pp.
264
270
.
7.
Khatib
,
O.
, 2004, “
Whole-Body Dynamic Behavior and Control of Human-Like Robots
,”
Int. J. Humanoid Robot.
,
1
(
1
), pp.
29
43
.
8.
Khatib
,
O.
,
Sentis
,
L.
, and
Park
,
J.
, 2008, “
A Unified Framework for Whole-Body Humanoid Robot Control With Multiple Constraints and Contacts
,”
European Robotics Symposium
,
H.
Bruyninckx
,
L.
Preucil
, and
M.
Kulich
, eds.,
Springer-Verlag
,
New York
, pp.
303
312
.
9.
Papastavridis
,
J. G.
, 2002,
Analytical Mechanics: A Comprehensive Treatise on the Dynamics of Constrained Systems for Engineers, Physicists, and Mathematicians
,
Oxford University Press
,
Oxford
.
10.
Axler
,
S.
, 2001,
Linear Algebra Done Right
,
2nd ed.
,
Springer
,
New York
.
11.
Bretscher
,
O.
, 2001,
Linear Algebra With Applications
,
2nd ed.
,
Prentice-Hall
,
Englewood Cliffs, NJ
.
12.
Lanczos
,
C.
, 1986,
The Variational Principles of Mechanics
,
Dover
,
New York
.
You do not currently have access to this content.