Fixed bug in the index image creation, and added indices into both types of pointclouds
Fixed bug in the index image creation, and added indices into both types of pointclouds

WPI-ARC/softkinetic_camera_driver