Fixed cost

src/algorithm.cpp

@@ -64,6 +64,7 @@ void PrintSolution(std::vector<Vertex*> solution) {
                 cost += j.weight;
             }
         }
+        lastVertex = i;
     }
     std::cout << std::endl;
     std::cout << "Cost: " << cost << std::endl;