Usage Require MATLAB Run lidar_pipeline.m to show the setup of the problem Question Problem I am trying to solve is stated in lidar_pipeline.m line 19. You may wanna look at project3to2.m and projectPoints.m.