Closest point search working and added README.