Fixed a bug for FPFH preventing proper transformation of model.
Fixed far plane filtering
Fixed ICP