Add error checking for moveAgent
Use set for nodes in Graph