Closest Pair algorithm for CS 5050