Rigid Body Dynamics, Constraints, and Inverses

Rigid body dynamics are traditionally formulated by Lagrangian or Newton-Euler methods. A particular state space form using Euler angles and angular velocities expressed in the body coordinate system is employed here to address constrained rigid body dynamics. We study gliding and rolling, and we develop inverse systems for estimation of internal and contact forces of constraint. A primitive approximation of biped locomotion serves as a motivation for this work. A class of constraints is formulated in this state space. Rolling and gliding are common in contact sports, in interaction of humans and robots with their environment where one surface makes contact with another surface, and at skeletal joints in living systems. This formulation of constraints is important for control purposes. The estimation of applied and constraint forces and torques at the joints of natural and robotic systems is a challenge. Direct and indirect measurement methods involving a combination of kinematic data and computation are discussed. The basic methodology is developed for one single rigid body for simplicity, brevity, and precision. Computer simulations are presented to demonstrate the feasibility and effectiveness of the approaches presented. The methodology can be applied to a multilink model of bipedal systems where natural and/or artificial connectors and actuators are modeled. Estimation of the forces is accomplished by the inverse of the nonlinear plant designed by using a robust high gain feedback system. The inverse is shown to be stable, and bounds on the tracking error are developed. Lyapunov stability methods are used to establish global stability of the inverse system.