Rigid body mechanics

Summary