Half functional dijkstra, drawing route needs some work