Customized PCL Iterative Closest Point Program