belief_at is extended for robot pose