TebObstacleManager

Create class to manage obstacles for teb

Something like this: \

TebObstacleManager builder(&teb_obstacles);
builder.clear();

builder.addStaticObjects(scene.staticScene->objects);