Added ability to add a shape to a rigid body