Adjusted world scale to be 500x500 meters.
Correctly integrating with each simulation step now