Bayesian A* tree search with expected O (N) convergence rates for road tracking