Algorithms for LiDAR Based Traffic Tracking: Development and Demonstration