first idea of implementation ground truth publisher for real robot
actually working version of the idea -> TODO: check if this is what we want