Finish Path
Add for greedy implementation, main executable is preliminarily code complete