Merge pull request #1 from chiwunau/go_through_door_demo

start solving obj-cds problem
Merge branch 'go_through_door_demo' of github.com:chiwunau/au-ros-pkg
Merge pull request #2 from chiwunau/master

i