Added A* and changed node implementation
Merge remote-tracking branch 'origin/master' into develop
Cleaned Node
Check if node is already in the frontier
Trying to fix merge
Check if node is in frontier