I'm controlling a turtlebot, and would like to measure the latency of the system.

Specifically, I'd like to see how long between when a frame is taken on the connect, to when it is read by the subscriber in movebase, and then to when the cmdvel corresponding to it is published.

Does anyone have an idea of how I might measure these times?

Thanks