Shape discovery and body_model: enhancements

* Cleans some code
Cleaner: new cleaner class

* All cleaning was put together in Cleaner.
* First config file.