Implementation of Rigid Body