Reworked cartesian-centric code to node-centric.
90% done - Implemented goodness calculation and rest of Best-First.
Created four Robot instances, weird bugs without doing so, don't have time to investigate right now.
Merge pull request #1 from timkendall/refactor

Refactor