move librfid to new location in repository

git-svn-id: https://svn.gnumonks.org/trunk/librfid@1181 e0336214-984f-0b4b-a45f-81c69e1f0ede

1 files changed, 276 insertions, 0 deletions

diff --git a/rfid_reader_cm5121.c b/rfid_reader_cm5121.c
new file mode 100644
index 0000000..30d1c67
--- /dev/null
+++ b/rfid_reader_cm5121.c
@@ -0,0 +1,276 @@
+/* Omnikey CardMan 5121 specific RC632 transport layer 
+ *
+ * (C) 2005 by Harald Welte <laforge@gnumonks.org>
+ *
+ * The 5121 is an Atmel AT98C5122 based USB CCID reader (probably the same
+ * design like the 3121).  It's CL RC632 is connected via address/data bus,
+ * not via SPI.
+ *
+ * The vendor-supplied reader firmware provides some undocumented extensions 
+ * to CCID (via PC_to_RDR_Escape) that allow access to registers and FIFO of
+ * the RC632.
+ * 
+ */
+
+#include <stdlib.h>
+#include <unistd.h>
+#include <string.h>
+
+#include <rfid/rfid.h>
+#include <rfid/rfid_reader.h>
+#include <rfid/rfid_asic.h>
+#include <rfid/rfid_asic_rc632.h>
+#include <rfid/rfid_reader_cm5121.h>
+
+#define SENDBUF_LEN	40
+#define RECVBUF_LEN	40
+
+static
+int Write1ByteToReg(struct rfid_asic_transport_handle *rath,
+		    unsigned char reg, unsigned char value)
+{
+	unsigned char sndbuf[SENDBUF_LEN];
+	unsigned char rcvbuf[RECVBUF_LEN];
+	unsigned int retlen = RECVBUF_LEN;
+
+	sndbuf[0] = 0x20;
+	sndbuf[1] = 0x00;
+	sndbuf[2] = 0x01;
+	sndbuf[3] = 0x00;
+	sndbuf[4] = 0x00;
+	sndbuf[5] = 0x00;
+	sndbuf[6] = reg;
+	sndbuf[7] = value;
+
+	DEBUGP("reg=0x%02x, val=%02x\n", reg, value);
+
+	if (PC_to_RDR_Escape(rath->data, sndbuf, 8, rcvbuf, 
+			     &retlen) == 0)
+		return 0;
+
+	return -1;
+}
+
+static int Read1ByteFromReg(struct rfid_asic_transport_handle *rath,
+			    unsigned char reg,
+			    unsigned char *value)
+{
+	unsigned char sndbuf[SENDBUF_LEN];
+	unsigned char recvbuf[RECVBUF_LEN];
+	unsigned int retlen = sizeof(recvbuf);
+
+	sndbuf[0] = 0x20;
+	sndbuf[1] = 0x00;
+	sndbuf[2] = 0x00;
+	sndbuf[3] = 0x00;
+	sndbuf[4] = 0x01;
+	sndbuf[5] = 0x00;
+	sndbuf[6] = reg;
+
+	if (PC_to_RDR_Escape(rath->data, sndbuf, 7, recvbuf, 
+			     &retlen) == 0) {
+		*value = recvbuf[1];
+		DEBUGP("reg=0x%02x, val=%02x\n", reg, *value);
+		return 0;
+	}
+
+	return -1;
+}
+
+static int ReadNBytesFromFIFO(struct rfid_asic_transport_handle *rath,
+			      unsigned char num_bytes,
+			      unsigned char *buf)
+{
+	unsigned char sndbuf[SENDBUF_LEN];
+	unsigned char recvbuf[0x7f];
+	unsigned int retlen = sizeof(recvbuf);
+
+	sndbuf[0] = 0x20;
+	sndbuf[1] = 0x00;
+	sndbuf[2] = 0x00;
+	sndbuf[3] = 0x00;
+	sndbuf[4] = num_bytes;
+	sndbuf[5] = 0x00;
+	sndbuf[6] = 0x02;
+
+	if (PC_to_RDR_Escape(rath->data, sndbuf, 7, recvbuf, &retlen) == 0) {
+		DEBUGP("%s\n", rfid_hexdump(recvbuf+1, num_bytes));
+		memcpy(buf, recvbuf+1, num_bytes); // len == 0x7f
+		return 0;
+	}
+
+	return -1;
+}
+
+static int WriteNBytesToFIFO(struct rfid_asic_transport_handle *rath,
+			     unsigned char len,
+			     const unsigned char *bytes,
+			     unsigned char flags)
+{
+	unsigned char sndbuf[SENDBUF_LEN];
+	unsigned char recvbuf[0x7f];
+	unsigned int retlen = sizeof(recvbuf);
+
+	sndbuf[0] = 0x20;
+	sndbuf[1] = 0x00;
+	sndbuf[2] = len;
+	sndbuf[3] = 0x00;
+	sndbuf[4] = 0x00;
+	sndbuf[5] = flags;
+	sndbuf[6] = 0x02;
+
+	DEBUGP("%s\n", rfid_hexdump(bytes, len));
+
+	memcpy(sndbuf+7, bytes, len);
+
+	if (PC_to_RDR_Escape(rath->data, sndbuf, len+7, recvbuf, &retlen) == 0) {
+		return 0;
+	}
+
+	return -1;
+}
+
+#if 0
+static int TestFIFO(struct rc632_handle *handle)
+{
+	unsigned char sndbuf[60]; // 0x3c
+
+	// FIXME: repne stosd, call
+
+	memset(sndbuf, 0, sizeof(sndbuf));
+
+	if (WriteNBytesToFIFO(handle, sizeof(sndbuf), sndbuf, 0) < 0)
+		return -1;
+
+	return ReadNBytesFromFIFO(handle, sizeof(sndbuf), sndbuf);
+}
+#endif
+
+static int cm5121_transcieve(struct rfid_reader_handle *rh,
+			     const unsigned char *tx_data, unsigned int tx_len,
+			     unsigned char *rx_data, unsigned int *rx_len,
+			     unsigned int timeout, unsigned int flags)
+{
+	return rh->ah->asic->priv.rc632.fn.transcieve(rh->ah, tx_data,
+							   tx_len, rx_data,
+							   rx_len, timeout,
+							   flags);
+}
+
+static int cm5121_transcieve_sf(struct rfid_reader_handle *rh,
+			       unsigned char cmd, struct iso14443a_atqa *atqa)
+{
+	return rh->ah->asic->priv.rc632.fn.iso14443a.transcieve_sf(rh->ah,
+									cmd,
+						(unsigned char *) atqa);
+}
+
+static int
+cm5121_transcieve_acf(struct rfid_reader_handle *rh, struct iso14443a_anticol_cmd *cmd,
+					      unsigned int *bit_of_col)
+{
+	return rh->ah->asic->priv.rc632.fn.iso14443a.transcieve_acf(rh->ah,
+							 cmd, bit_of_col);
+}
+
+static int
+cm5121_14443a_init(struct rfid_reader_handle *rh)
+{
+	return rh->ah->asic->priv.rc632.fn.iso14443a.init(rh->ah);
+}
+
+static int
+cm5121_14443b_init(struct rfid_reader_handle *rh)
+{
+	return rh->ah->asic->priv.rc632.fn.iso14443b.init(rh->ah);
+}
+
+
+struct rfid_asic_transport cm5121_ccid = {
+	.name = "CM5121 OpenCT",
+	.priv.rc632 = {
+		.fn = {
+			.reg_write 	= &Write1ByteToReg,
+			.reg_read 	= &Read1ByteFromReg,
+			.fifo_write	= &WriteNBytesToFIFO,
+			.fifo_read	= &ReadNBytesFromFIFO,
+		},
+	},
+};
+
+static int cm5121_enable_rc632(struct rfid_asic_transport_handle *rath)
+{
+	unsigned char tx_buf[1] = { 0x01 };	
+	unsigned char rx_buf[64];
+	unsigned int rx_len = sizeof(rx_buf);
+
+	PC_to_RDR_Escape(rath->data, tx_buf, 1, rx_buf, &rx_len);
+	printf("received %d bytes from 01 command\n", rx_len);
+
+	return 0;
+}
+
+static struct rfid_reader_handle *
+cm5121_open(void *data)
+{
+	struct rfid_reader_handle *rh;
+	struct rfid_asic_transport_handle *rath;
+
+	rh = malloc(sizeof(*rh));
+	if (!rh)
+		return NULL;
+	memset(rh, 0, sizeof(*rh));
+
+	rath = malloc(sizeof(*rath));
+	if (!rath)
+		goto out_rh;
+	memset(rath, 0, sizeof(*rath));
+
+	rath->rat = &cm5121_ccid;
+	rath->data = data;
+
+	rh->reader = &rfid_reader_cm5121;
+
+	if (cm5121_enable_rc632(rath) < 0)
+		goto out_rath;
+
+	rh->ah = rc632_open(rath);
+	if (!rh->ah) 
+		goto out_rath;
+
+	DEBUGP("returning %p\n", rh);
+	return rh;
+
+out_rath:
+	free(rath);
+out_rh:
+	free(rh);
+
+	return NULL;
+}
+
+static void
+cm5121_close(struct rfid_reader_handle *rh)
+{
+	struct rfid_asic_transport_handle *rath = rh->ah->rath;
+	rc632_close(rh->ah);
+	free(rath);
+	free(rh);
+}
+
+struct rfid_reader rfid_reader_cm5121 = {
+	.name 	= "Omnikey CardMan 5121 RFID",
+	.open = &cm5121_open,
+	.close = &cm5121_close,
+	.transcieve = &cm5121_transcieve,
+	.iso14443a = {
+		.init = &cm5121_14443a_init,
+		.transcieve_sf = &cm5121_transcieve_sf,
+		.transcieve_acf = &cm5121_transcieve_acf,
+	},
+	.iso14443b = {
+		.init = &cm5121_14443b_init,
+	},
+};
+
+