Updated arc radius and stop distance algorithm