Add tranceback()
1. root point set index to -1; 2. __contains__()
Dijkstra's algorithm with heap