Add new nodelet to transform pointcloud to make its origin equal to the pose of boundingbox and use bounding box information when running ICP