Data Processing Algorithms and Applications of LiDAR-Enhanced Connected Infrastructure Sensing