change parameter, may work on open door task
change threshold of deciding stuck
Merge pull request #5 from chiwunau/go_through_door_demo

Go through door demo