Route finding via verticies added, drawing between points fixed