Added proper correction for world collision test.
Physics body now properly handles position updates.