Remove the current element from the path
otherwise the current element will be executed twice
Add getNextElement method to the AStar algorithm
When we explore the graph and creates the entire path we will run in to trouble handling actions and guards due to that we can't guarantee that a required action has executed before we evaluates a guard. The getNextElement will use the heuristics to guess the next element but it won't extract the entire path.