From 3bd214c21718080186a1eb8d64d21914e3e39eec Mon Sep 17 00:00:00 2001
From: Packit Service <user-cont-team+packit-service@redhat.com>
Date: Dec 10 2020 01:01:55 +0000
Subject: Apply patch ccid-1.4.26-omnikey-3121.patch


patch_name: ccid-1.4.26-omnikey-3121.patch
present_in_specfile: true

---

diff --git a/src/ccid.c b/src/ccid.c
index edded92..1c580db 100644
--- a/src/ccid.c
+++ b/src/ccid.c
@@ -55,8 +55,16 @@ int ccid_open_hack_pre(unsigned int reader_index)
 {
 	_ccid_descriptor *ccid_descriptor = get_ccid_descriptor(reader_index);
 
+	ccid_descriptor->dwNonStandardFlags = 0;
+
 	switch (ccid_descriptor->readerID)
 	{
+		case CARDMAN3121:
+			ccid_descriptor->dwNonStandardFlags = CCID_NON_STAND_OMK_3121_T1;
+			ccid_descriptor->dwFeatures &= ~CCID_CLASS_EXCHANGE_MASK;
+			ccid_descriptor->dwFeatures |= CCID_CLASS_TPDU;
+			break;
+
 		case MYSMARTPAD:
 			ccid_descriptor->dwMaxIFSD = 254;
 			break;
diff --git a/src/ccid.h b/src/ccid.h
index 46afc4c..d5cf8f6 100644
--- a/src/ccid.h
+++ b/src/ccid.h
@@ -144,6 +144,7 @@ typedef struct
 	 */
 	char zlp;
 #endif
+	unsigned int dwNonStandardFlags;
 } _ccid_descriptor;
 
 /* Features from dwFeatures */
@@ -160,6 +161,9 @@ typedef struct
 #define CCID_CLASS_EXTENDED_APDU	0x00040000
 #define CCID_CLASS_EXCHANGE_MASK	0x00070000
 
+/* Features from the swNonStandardFlags */
+#define CCID_NON_STAND_OMK_3121_T1	0x00000001
+
 /* Features from bPINSupport */
 #define CCID_CLASS_PIN_VERIFY		0x01
 #define CCID_CLASS_PIN_MODIFY		0x02
diff --git a/src/commands.c b/src/commands.c
index 4c58b39..110b8f3 100644
--- a/src/commands.c
+++ b/src/commands.c
@@ -1295,6 +1295,39 @@ RESPONSECODE CmdXfrBlock(unsigned int reader_index, unsigned int tx_length,
 	return return_value;
 } /* CmdXfrBlock */
 
+static RESPONSECODE omnikey_transmit_tpdu(unsigned int reader_index,
+        _ccid_descriptor *ccid_descriptor, unsigned int tx_length,
+        const unsigned char *tx_buffer)
+{
+	unsigned char cmd[11+CMD_BUF_SIZE];	 /* CCID + APDU buffer */
+	status_t ret;
+
+	cmd[0] = 0x6B; 				/* 3121 escape */
+	i2dw(tx_length+1, cmd+1); 	/* APDU length */
+	cmd[5] = ccid_descriptor->bCurrentSlotIndex;	/* slot number */
+	cmd[6] = (*ccid_descriptor->pbSeq)++;
+	cmd[7] = 0;
+	cmd[8] = 0;
+	cmd[9] = 0;
+	cmd[10] = 0x1A;
+
+	/* check that the command is not too large */
+	if (tx_length > CMD_BUF_SIZE)
+	{
+		DEBUG_CRITICAL2("TX Length too big: %d", tx_length);
+		return IFD_NOT_SUPPORTED;
+	}
+
+	memcpy(cmd+11, tx_buffer, tx_length);
+
+	ret = WritePort(reader_index, 11+tx_length, cmd);
+	if (STATUS_NO_SUCH_DEVICE == ret)
+		return IFD_NO_SUCH_DEVICE;
+	if (ret != STATUS_SUCCESS)
+		return IFD_COMMUNICATION_ERROR;
+
+	return IFD_SUCCESS;
+} /* omnikey_transmit_tpdu */
 
 /*****************************************************************************
  *
@@ -1351,6 +1384,13 @@ RESPONSECODE CCID_Transmit(unsigned int reader_index, unsigned int tx_length,
 	}
 #endif
 
+	/* hack for Onmikey 3121 */
+	if ((ccid_descriptor->dwNonStandardFlags & CCID_NON_STAND_OMK_3121_T1) &&
+		(ccid_descriptor->cardProtocol == SCARD_PROTOCOL_T1)) {
+		return omnikey_transmit_tpdu(reader_index, ccid_descriptor, tx_length, 
+				tx_buffer);
+	}
+
 	cmd[0] = 0x6F; /* XfrBlock */
 	i2dw(tx_length, cmd+1);	/* APDU length */
 	cmd[5] = ccid_descriptor->bCurrentSlotIndex;	/* slot number */
@@ -1376,8 +1416,9 @@ RESPONSECODE CCID_Transmit(unsigned int reader_index, unsigned int tx_length,
 RESPONSECODE CCID_Receive(unsigned int reader_index, unsigned int *rx_length,
 	unsigned char rx_buffer[], unsigned char *chain_parameter)
 {
-	unsigned char cmd[10+CMD_BUF_SIZE];	/* CCID + APDU buffer */
+	unsigned char cmd[11+CMD_BUF_SIZE];	/* CCID + APDU buffer */
 	unsigned int length;
+	unsigned char *rx_ptr = cmd+10;
 	RESPONSECODE return_value = IFD_SUCCESS;
 	status_t ret;
 	_ccid_descriptor *ccid_descriptor = get_ccid_descriptor(reader_index);
@@ -1568,6 +1609,14 @@ time_request:
 	}
 
 	length = dw2i(cmd, 1);
+
+	if (length && 
+	  (ccid_descriptor->dwNonStandardFlags & CCID_NON_STAND_OMK_3121_T1) &&
+	  (ccid_descriptor->cardProtocol == SCARD_PROTOCOL_T1)) {
+		length--;
+		rx_ptr = cmd+11;
+	}
+
 	if (length <= *rx_length)
 		*rx_length = length;
 	else
@@ -1584,7 +1633,7 @@ time_request:
 		return_value = IFD_COMMUNICATION_ERROR;
 	}
 	else
-		memcpy(rx_buffer, cmd+10, length);
+		memcpy(rx_buffer, rx_ptr, length);
 
 	/* Extended case?
 	 * Only valid for RDR_to_PC_DataBlock frames */