added ICP algorithm and PointSet data object, also used eigen transform for the linear transform object