An Improved Trajectory Map Matching Algorithm