working on fixing bugs need to synch with robot
Merge branch 'cleaning' of https://github.com/mayacakmak/pr2_pbd into cleaning