p3: before merge
Merge branch 'master' of github.com:peterkty/pr2-drake-planner
Beehive and drawer are done