Adding some documentation before moving to rtt_rosclock
Large-scale refactor to use the new rtt_rosclock, reduce complexity.