diff --git a/Core/Src/setcan.c b/Core/Src/setcan.c
index 68a599c..fb6f72d 100644
--- a/Core/Src/setcan.c
+++ b/Core/Src/setcan.c
@@ -804,7 +804,7 @@ SETCAN_StatusTypeDef SETCAN_SEND_CORE(const SetCanId_t id, const struct SetCanCo
 				TxHeader.DLC = regsInPacket;
 				for(int i = 0; i < regsInPacket; i++)
 				{
-					canData[i] = coreData.Data[coreData.DataCount - regsRemaining];
+					canData[i] = coreData.Data[coreData.DataCount - regsRemaining + i];
 				}
 				HAL_StatusTypeDef status = HAL_CAN_AddTxMessage(_HCAN, &TxHeader, canData, &TxMailBox);
 				if(status != HAL_OK)