Added realisation of DIAG_INP & DIAG_OUT packets