First working version of lidarProc