Diagnostics

Tested with TCP on the TIM551.