improve trajectory planning
Merge branch 'master' of github.com:ipa-rmb/hermes into master-rmb
working on scenario
added shoe detection launch files to scenario