Implement rigid body class