Counting the Number of Connected Components of a Set and Its Application to Robotics