fixing lookahead distance calculation

improving performance of map method

switching order of shouldStop checks to look for vehicles first
reducing change lane lookahead criteria to standard lookahead distance