Seach shortest path added. 
Stats added.
Refactoring.
Optimization.