An advanced map matching algorithm is disclosed, which embeds the road topology inherently in a set of path candidates. Road connectivity is maintained even in special situations such as U-turns, reverse driving, and tunnels. Careful path candidate management is designed to reduce the candidate count while preserving well-matching candidates. Paths are treated and evaluated independently using multiple criteria, which makes the algorithm reliable and robust in different scenarios.