Added the code used for data collection

Should be same as LIDAR_FINAL, save for pan-tilt angle ranges
Modifications

Added comments, played with plot 3k