Changes for working scenario shown at AGV meeting.
Merge pull request #2 from abubeck/master

Changes for working scenario shown at AGV meeting.