Initial Fast Marching Method

Realization until extracting point among the narrow band.