diff --git a/Inc/CanSerialPortFrameTP.h b/Inc/CanSerialPortFrameTP.h
index 41bc79f..b3dd254 100644
--- a/Inc/CanSerialPortFrameTP.h
+++ b/Inc/CanSerialPortFrameTP.h
@@ -11,6 +11,8 @@
 #include "CmsisRtosThreadUtils.h"
 #include "SystemMutexCmsis.h"
 
+#define UDS_TP_CAN_HANDLER 1
+
 #define LOG_UDS_TP 0
 
 #define TP_FRAME_PADDING 0xAA
diff --git a/Src/CanSerialPortFrameTP.c b/Src/CanSerialPortFrameTP.c
index 7566479..a1893da 100644
--- a/Src/CanSerialPortFrameTP.c
+++ b/Src/CanSerialPortFrameTP.c
@@ -107,7 +107,7 @@ uint16_t sendFlowFrame(tCanSerialPortFrameTp *env, uint32_t id, uint32_t timeout
 
 //    SystemDelayMs(timeout_Br);
     uint16_t sent = env->ioCanFrame->transmit(env->ioCanFrame->env, (uint8_t *) frame, 8, id,
-                                              PROTOCOL_CAN_TYPE_UDS, timeout);
+                                              PROTOCOL_CAN_TYPE_UDS, timeout, UDS_TP_CAN_HANDLER);
 
     return sent;
 }
@@ -126,7 +126,7 @@ uint16_t sendSingleFrame(tCanSerialPortFrameTp *env, uint8_t *data, uint16_t siz
 
 //    SystemDelayMs(timeout_Br); // ??
     uint16_t sent = env->ioCanFrame->transmit(env->ioCanFrame->env, (uint8_t *) frame, 8, id,
-                                              PROTOCOL_CAN_TYPE_UDS, timeout);
+                                              PROTOCOL_CAN_TYPE_UDS, timeout, UDS_TP_CAN_HANDLER);
 
     return sent;
 }
@@ -146,7 +146,7 @@ uint16_t sendConsecutiveFrame(tCanSerialPortFrameTp *env, uint8_t *data, uint16_
     SystemDelayMs(timeout_StMin);
 
     uint16_t sent = env->ioCanFrame->transmit(env->ioCanFrame->env, (uint8_t *) frame, 8, id,
-                                              PROTOCOL_CAN_TYPE_UDS, timeout);
+                                              PROTOCOL_CAN_TYPE_UDS, timeout, UDS_TP_CAN_HANDLER);
 
 
     return sent;
@@ -365,7 +365,7 @@ bool sendFirstFrame(tCanSerialPortFrameTp *env, uint8_t *data, uint16_t size, ui
 
 //    SystemDelayMs(timeout_Br); // ??
     env->ioCanFrame->transmit(env->ioCanFrame->env, (uint8_t *) frame, 8, id,
-                              PROTOCOL_CAN_TYPE_UDS, timeout);
+                              PROTOCOL_CAN_TYPE_UDS, timeout, UDS_TP_CAN_HANDLER);
 
     bool result = waitFlowControl(env);
     if (!result)