Rigid body kinematics calculations
