Update GraphUtil::rigidICP().