RANSAC算法 http://grunt1223.iteye.com/blog/961076 ICP算法 http://www.cnblogs.com/yin52133/archive/2012/07/21/2602562.html