Scenario manager cli fixes

This should fix issue #14 (closed),#16 (closed),#17 (closed),#18 (closed)

Also this should be merged together with the ArmarXGui merge request named ScenarioManagerFixes