Impemented 2opt algorithm.

2opt algorithm in working order. Still needs comments/cleaning.