Started change to sets class so that it uses the vector class to maintain a list of nodes.
Added function to create a new node in a_star.cpp. Node creation will be made by a_star. Sets will just maintain lists of nodes, regardless of their relation.
Added a function to compute the a_star heuristic
Updated code to check neighbour and maintain the sets.
Added function to recover path from solution and convert it into a set of robot commands. Unfinished.
Solved some compile issues. More on this after dinner.