Generalize new path finder to A*