Fixed B2Body constructor/ cleaned up a bit