Use static obstacles inside TimedElasticBand

Use all static obstacles inside SceneObjectSet for teb_local_planner

Bounding box of obstacles can be obtained like this:
obstacles->getSceneObject(i)->getCollisionModel()->getBoundingBox(true)