5.2 快速鲁棒的ICP（Fast and Robust Iterative Closest Point）