Add new scenarii from aterm experiment
Add pr2 robot cost function