Improved lidar test; Added third party libraries