lidar code runs, but looks wrong