SMS: Random finite sets for robot mapping and SLAM