Fixed remove entity funtion so that it also removes the body from the
b2World