Fast Algorithms for Optimal Control, Anisotropic Front Propagation and Multiple Arrivals