diff --git a/src/system/can_bus.cpp b/src/system/can_bus.cpp
index 04fedc3..fb10781 100644
--- a/src/system/can_bus.cpp
+++ b/src/system/can_bus.cpp
@@ -76,7 +76,7 @@ namespace sta
 	{
 		CanTxHeader header;
 		header.id.format     = static_cast<CanIdFormat>(msg.header.format);
-		header.id.sid        = msg.header.sid & STA_CAN_SID_SYS_BITS;
+		header.id.sid        = msg.header.sid;
 		header.id.eid        = msg.header.eid;
 		header.payloadLength = msg.header.payloadLength;
 
@@ -87,7 +87,7 @@ namespace sta
 	{
 		CanFrameId frameID;
 		frameID.format = static_cast<CanIdFormat>(msg.header.format);
-		frameID.sid    = msg.header.sid & ~STA_CAN_SID_SYS_BITS;
+		frameID.sid    = msg.header.sid;
 		frameID.eid    = msg.header.eid;
 
 		// Start transmission via ISO-TP