combined the polygon accessibility test with point test and perimeter test, improved the data management of the map and added the obtacles from the local costmap
Merge branch 'master' of github.com:ipa320/cob_scenario_states into master-320