latester: Cleanup and correct subtraction with negative results

- Cleanup = move more complex calculation from RT thread to processing
  thread.
- Negative result happened what message TX time was greater than
  timestamp difference. This can happen if first timestamp is delayed
  and the second not.