Solved single iteration issue

-Multiple iterations possible
-Much better paths found
-Possible better estimates to follow