ICP and Generalized ICP algorithm based on PCL