normalize to avoid too-small floating number, change a*search to ida to
adapt to multiple sampling method, k shortest distance with Yen's
algorithm