Define and test full feature demo script

[adamantivm]

This should include:

• First teleoperation for map generation (using floor plan occupancy grid)
• Then navigation using generated occupancy grid (ROS map)