Rao-Blackwellized particle filtering for probing-based 6-DOF localization in robotic assembly