http://www.codecodex.com/wiki/Calculate_distance_between_two_points_on_a_globe
Take your pick of languages, including C++