稳健估计（抗差估计）利用c++如何实现

需要在点云处理过程中加入稳健估计来去除粗差带来的影响，网上查找了好多，没有找到c++实现的，希望能够帮助解决问题。