Fast Marching Methods for Computing Distance Maps and Shortest Paths