Changes to shortest path

Change the structure of the node in 2 structure to have a better understanding of the code. Disadvantage more memory 4B for every node and possible less speed due to extra pointer.
Revert "Changes to shortest path"

This reverts commit 87ce9c718adfa6da23f28660fca5f9950cf94662.