Implement the simple heuristic solution for TSP problem.
(Tested. Comments will be added later)