algo: Revisit config library.

- Small refactoring
- Add support for std::map
- Add some unittest coverage
- Add CBM_FORMAT to specify how structs should formatted in yaml