Copy pointcloud on landmark set

Add tests for this, fix a few pieces of ugly code