Added some custom tests to support PCL CPD implementation