Started refactoring jbox2d code