Adding body index based point cloud

Using the bodyIndex image to determine if points belong to bodies or
not.