Feature/new ys and peanut tango interface tests

DO NOT MERGE, DEPENDS ON PR https://github.com/ethz-asl/multiagent_mapping/pull/1214

NOTES:
-> New tango interface test data, now both peanut and yellowstone datasets are tested
-> Breaks tango_interface unit tests unless the above mentioned PR is merged to master
-> After merging, keep branch alive, make the git-link point to the master branch in the tango_interface-CMakeLists file, delete this branch