Modification to Handle diagnostic request in RTU/TCP server mode