Add exception for blocked way between points, method for setting heading