Starting to work more on the state machine
Working on components of SEEK behavior
Merge branch 'master' into feature/state_machine
Added the map_tools file
Building up the ability to grab objects
tested waypoint manuevers
Pushing tested waypoint code after fixing merge conflict in map_publisher.py
Merge pull request #7 from eschneider1992/feature/state_machine

Feature/state machine!