Improved code for GlobalEstimator and RobotPoseDisambiguator.