A* algorithm + steering behaviour test