add kmd_tools ros package

[plusk01]

This ROS package is particularly useful for extrinsic calibrations.

This also provides code for publishing odometry and pose graphs from the output of past kimera multi experiments - the original purpose was to be able to benchmark new algorithms against previous runs of kimera multi / dpgo in a deterministic way.