I would like to use the algorithm to work with 2D data obtained from a Tim 561 LiDAR sensor. What changes would be necessary?