Refactoring again to use multiple robots instead
Adding goal verification
Getting ready for primetime