Merge pull request #11 from eschneider1992/feature/state_machine

Testing/fixing robot grab behaviors
Fixing compilation error with missing service ClearMap.srv
sample_seen_test: debugging the 4 cases (driving over is a work in progress)