Fix bug in ros latency measurement