add a PointCloud2 iterator
add tests