Fixed the distance from ground plane computation and added functionality to get distance for points clicked on visualizer.
Added file that can record stream of Pointclouds from rostopic to PCD files.