Route Optimization from GPS Coordinates

Given say, 500 coordinates taken from GPS, what is an efficient way to optimize a path based on distance for these points? And afterwards, to write the data back into a .kml or .gpx format?

Any help would be greatly appreciated!