Fix errors in world stepping