Little more implementation in b2Body, refactoring, inline...