Fixed this "peace" of code
Made PrintError and PrintSuccess public
Add functionality that makes sure that a path can not be calculated if
you input the node that is your current frontnode