1 files changed, 624 insertions, 0 deletions

diff --git a/openpcd/firmware/src/pcd/rc632.c b/openpcd/firmware/src/pcd/rc632.c
new file mode 100644
index 0000000..9fc7428
--- /dev/null
+++ b/openpcd/firmware/src/pcd/rc632.c
@@ -0,0 +1,624 @@
+/* Philips CL RC632 driver (via SPI) for OpenPCD firmware
+ * (C) 2006 by Harald Welte <hwelte@hmw-consulting.de>
+ *
+ * This is heavily based on the librfid RC632 driver. All primitive access
+ * functions such as rc632_{reg,fifo}_{read,write}() are API compatible to
+ * librfid in order to be able to leverage higher-level code from librfid
+ * to this OpenPCD firmware.
+ *
+ * */
+
+#include <string.h>
+#include <errno.h>
+#include <lib_AT91SAM7.h>
+#include <cl_rc632.h>
+#include <openpcd.h>
+#include "../openpcd.h"
+#include <os/fifo.h>
+#include <os/dbgu.h>
+#include <os/pcd_enumerate.h>
+#include <os/usb_handler.h>
+#include <os/req_ctx.h>
+#include "rc632.h"
+
+#define ALWAYS_RESPOND
+
+#define NOTHING  do {} while(0)
+
+#if 0
+#define DEBUGPSPI DEBUGP
+#define DEBUGPSPIIRQ DEBUGP
+#else
+#define	DEBUGPSPI(x, args ...)  NOTHING
+#define DEBUGPSPIIRQ(x, args...) NOTHING
+#endif
+
+#if 0
+#define DEBUG632 DEBUGPCRF
+#else
+#define DEBUG632(x, args ...)	NOTHING
+#endif
+
+
+/* SPI driver */
+
+#ifdef OLIMEX
+#define SPI_DEBUG_LOOPBACK
+#endif
+
+#define SPI_USES_DMA
+
+#define SPI_MAX_XFER_LEN	65
+
+static AT91PS_SPI pSPI = AT91C_BASE_SPI;
+
+/* SPI irq handler */
+static void spi_irq(void)
+{
+	u_int32_t status = pSPI->SPI_SR;
+
+	DEBUGPSPIIRQ("spi_irq: 0x%08x ", status);
+
+	if (status & AT91C_SPI_OVRES)
+		DEBUGPSPIIRQ("Overrun ");
+	if (status & AT91C_SPI_MODF)
+		DEBUGPSPIIRQ("ModeFault ");
+	if (status & AT91C_SPI_ENDRX) {
+		pSPI->SPI_IDR = AT91C_SPI_ENDRX;
+		DEBUGPSPIIRQ("ENDRX ");
+	}
+	if (status & AT91C_SPI_ENDTX) {
+		pSPI->SPI_IDR = AT91C_SPI_ENDTX;
+		DEBUGPSPIIRQ("ENDTX ");
+	}
+
+	DEBUGPSPIIRQ("\r\n");
+
+	AT91F_AIC_ClearIt(AT91C_BASE_AIC, AT91C_ID_SPI);
+}
+
+#ifdef SPI_USES_DMA
+static int spi_transceive(const u_int8_t *tx_data, u_int16_t tx_len, 
+			  u_int8_t *rx_data, u_int16_t *rx_len)
+{
+	//tx_len = *rx_len = 65;
+	DEBUGPSPI("DMA Xfer tx=%s\r\n", hexdump(tx_data, tx_len));
+	if (*rx_len < tx_len) {
+		DEBUGPCRF("rx_len=%u smaller tx_len=%u\n", *rx_len, tx_len);
+		return -1;
+	}
+	//AT91F_SPI_Disable(pSPI);
+
+	AT91F_SPI_ReceiveFrame(pSPI, rx_data, tx_len, NULL, 0);
+	AT91F_SPI_SendFrame(pSPI, tx_data, tx_len, NULL, 0);
+
+	AT91F_PDC_EnableRx(AT91C_BASE_PDC_SPI);
+	AT91F_PDC_EnableTx(AT91C_BASE_PDC_SPI);
+
+	pSPI->SPI_IER = AT91C_SPI_ENDTX|AT91C_SPI_ENDRX;
+	//pSPI->SPI_IDR = AT91C_SPI_ENDTX|AT91C_SPI_ENDRX;
+
+
+	while (! (pSPI->SPI_SR & AT91C_SPI_ENDRX)) ;
+
+	DEBUGPSPI("DMA Xfer finished rx=%s\r\n", hexdump(rx_data, tx_len));
+
+	*rx_len = tx_len;
+
+	return 0;
+}
+#else
+/* stupid polling transceiver routine */
+static int spi_transceive(const u_int8_t *tx_data, u_int16_t tx_len, 
+		   u_int8_t *rx_data, u_int16_t *rx_len)
+{
+	u_int16_t tx_cur = 0;
+	u_int16_t rx_len_max = 0;
+	u_int16_t rx_cnt = 0;
+
+	/* disable RC632 interrupt because it wants to do SPI transactions */
+	AT91F_AIC_DisableIt(AT91C_BASE_AIC, OPENPCD_IRQ_RC632);
+
+	DEBUGPSPI("spi_transceive: enter(tx_len=%u) ", tx_len);
+
+	if (rx_len) {
+		rx_len_max = *rx_len;
+		*rx_len = 0;
+	}
+
+	//AT91F_SPI_Enable(pSPI);
+	while (1) { 
+		u_int32_t sr = pSPI->SPI_SR;
+		u_int8_t tmp;
+		if (sr & AT91C_SPI_RDRF) {
+			tmp = pSPI->SPI_RDR;
+			rx_cnt++;
+			if (rx_len && *rx_len < rx_len_max)
+				rx_data[(*rx_len)++] = tmp;
+		}
+	 	if (sr & AT91C_SPI_TDRE) {
+			if (tx_len > tx_cur)
+				pSPI->SPI_TDR = tx_data[tx_cur++];
+		}
+		if (tx_cur >= tx_len && rx_cnt >= tx_len)
+			break;
+	}
+	//AT91F_SPI_Disable(pSPI);
+	if (rx_data)
+		DEBUGPSPI("leave(%02x %02x)\r\n", rx_data[0], rx_data[1]);
+	else
+		DEBUGPSPI("leave()\r\n");
+
+	/* Re-enable RC632 interrupts */
+	AT91F_AIC_EnableIt(AT91C_BASE_AIC, OPENPCD_IRQ_RC632);
+
+	return 0;
+}
+#endif
+
+/* RC632 driver */
+
+/* static buffers used by RC632 access primitives below. 
+ * Since we only have one */
+
+static u_int8_t spi_outbuf[SPI_MAX_XFER_LEN];
+static u_int8_t spi_inbuf[SPI_MAX_XFER_LEN];
+
+#define FIFO_ADDR (RC632_REG_FIFO_DATA << 1)
+
+struct rc632 {
+	u_int16_t flags;
+	struct fifo fifo;
+};
+#define RC632_F_FIFO_TX		0x0001
+static struct rc632 rc632;
+
+/* RC632 access primitives */
+
+int rc632_reg_write(struct rfid_asic_handle *hdl,
+		    u_int8_t addr, u_int8_t data)
+{
+	u_int16_t rx_len = 2;
+
+	DEBUG632("[0x%02x] <= 0x%02x", addr, data);
+
+	addr = (addr << 1) & 0x7e;
+
+	spi_outbuf[0] = addr;
+	spi_outbuf[1] = data;
+
+	//spi_transceive(spi_outbuf, 2, NULL, NULL);
+	return spi_transceive(spi_outbuf, 2, spi_inbuf, &rx_len);
+}
+
+int rc632_fifo_write(struct rfid_asic_handle *hdl,
+		     u_int8_t len, u_int8_t *data, u_int8_t flags)
+{
+	if (len > sizeof(spi_outbuf)-1)
+		len = sizeof(spi_outbuf)-1;
+
+	spi_outbuf[0] = FIFO_ADDR;
+	memcpy(&spi_outbuf[1], data, len);
+
+	DEBUG632("[FIFO] <= %s", hexdump(data, len));
+
+	return spi_transceive(spi_outbuf, len+1, NULL, NULL);
+}
+
+int rc632_reg_read(struct rfid_asic_handle *hdl, 
+		   u_int8_t addr, u_int8_t *val)
+{
+	u_int16_t rx_len = 2;
+
+	addr = (addr << 1) & 0x7e;
+
+	spi_outbuf[0] = addr | 0x80;
+	spi_outbuf[1] = 0x00;
+
+	spi_transceive(spi_outbuf, 2, spi_inbuf, &rx_len);
+	*val = spi_inbuf[1];
+
+	DEBUG632("[0x%02x] => 0x%02x", addr>>1, *val);
+
+	return 0;
+}
+
+int rc632_fifo_read(struct rfid_asic_handle *hdl,
+		    u_int8_t max_len, u_int8_t *data)
+{
+	int ret;
+	u_int8_t fifo_length;
+	u_int8_t i;
+	u_int16_t rx_len;
+
+ 	ret = rc632_reg_read(hdl, RC632_REG_FIFO_LENGTH, &fifo_length);
+	if (ret < 0)
+		return ret;
+
+	rx_len = fifo_length+1;
+
+	if (max_len < fifo_length)
+		fifo_length = max_len;
+
+	for (i = 0; i < fifo_length; i++)
+		spi_outbuf[i] = FIFO_ADDR;
+
+	spi_outbuf[0] |= 0x80;
+	spi_outbuf[fifo_length] = 0x00;
+
+	spi_transceive(spi_outbuf, fifo_length+1, spi_inbuf, &rx_len);
+	memcpy(data, spi_inbuf+1, rx_len-1);
+
+	DEBUG632("[FIFO] => %s", hexdump(data, rx_len-1));
+
+	return 0;
+}
+
+int rc632_set_bits(struct rfid_asic_handle *hdl,
+		   u_int8_t reg, u_int8_t bits)
+{
+	u_int8_t val;
+	int ret;
+	
+	ret = rc632_reg_read(hdl, reg, &val);
+	if (ret < 0)
+		return ret;
+
+	val |= bits;
+
+	return rc632_reg_write(hdl, reg, val);
+}
+
+int rc632_clear_bits(struct rfid_asic_handle *hdl,
+		     u_int8_t reg, u_int8_t bits)
+{
+	u_int8_t val;
+	int ret;
+	
+	ret = rc632_reg_read(hdl, reg, &val);
+	if (ret < 0)
+		return ret;
+
+	val &= ~bits;
+
+	return rc632_reg_write(hdl, reg, val);
+}
+
+/* RC632 interrupt handling */
+
+static void rc632_irq(void)
+{
+	struct req_ctx *irq_rctx;
+	struct openpcd_hdr *irq_opcdh;
+	u_int8_t cause;
+
+	/* CL RC632 has interrupted us */
+	rc632_reg_read(RAH, RC632_REG_INTERRUPT_RQ, &cause);
+
+	/* ACK all interrupts */
+	//rc632_reg_write(RAH, RC632_REG_INTERRUPT_RQ, cause);
+	rc632_reg_write(RAH, RC632_REG_INTERRUPT_RQ, RC632_INT_TIMER);
+	DEBUGP("rc632_irq: ");
+
+	if (cause & RC632_INT_LOALERT) {
+		/* FIFO is getting low, refill from virtual FIFO */
+		DEBUGP("FIFO_low ");
+		#if 0
+		if (!fifo_available(&rc632.fifo))
+			return;
+		#endif
+		/* FIXME */
+	}
+	if (cause & RC632_INT_HIALERT) {
+		/* FIFO is getting full, empty into virtual FIFO */
+		DEBUGP("FIFO_high ");
+		/* FIXME */
+	}
+	/* All interrupts below can be reported directly to the host */
+	if (cause & RC632_INT_TIMER)
+		DEBUGP("Timer ");
+	if (cause & RC632_INT_IDLE)
+		DEBUGP("Idle ");
+	if (cause & RC632_INT_RX)
+		DEBUGP("RxComplete ");
+	if (cause & RC632_INT_TX)
+		DEBUGP("TxComplete ");
+	
+
+	irq_rctx = req_ctx_find_get(RCTX_STATE_FREE,
+				    RCTX_STATE_RC632IRQ_BUSY);
+	if (!irq_rctx) {
+		DEBUGPCRF("NO RCTX!\n");
+		/* disable rc632 interrupt until RCTX is free */
+		AT91F_AIC_DisableIt(AT91C_BASE_AIC, OPENPCD_IRQ_RC632);
+		return;
+	}
+
+	irq_opcdh = (struct openpcd_hdr *) &irq_rctx->tx.data[0];
+
+	/* initialize static part of openpcd_hdr for USB IRQ reporting */
+	irq_opcdh->cmd = OPENPCD_CMD_IRQ;
+	irq_opcdh->flags = 0x00;
+	irq_opcdh->reg = 0x07;
+	irq_opcdh->val = cause;
+	
+	req_ctx_set_state(irq_rctx, RCTX_STATE_UDP_EP3_PENDING);
+	DEBUGPCR("");
+}
+
+void rc632_unthrottle(void)
+{
+	AT91F_AIC_EnableIt(AT91C_BASE_AIC, OPENPCD_IRQ_RC632);
+}
+
+void rc632_power(u_int8_t up)
+{
+        DEBUGPCRF("powering %s RC632", up ? "up" : "down");
+	if (up)
+		AT91F_PIO_ClearOutput(AT91C_BASE_PIOA,
+				      OPENPCD_PIO_RC632_RESET);
+	else
+		AT91F_PIO_SetOutput(AT91C_BASE_PIOA,
+				    OPENPCD_PIO_RC632_RESET);
+}
+
+void rc632_reset(void)
+{
+	volatile int i;
+
+	rc632_power(0);
+	for (i = 0; i < 0xffff; i++)
+		{}
+	rc632_power(1);
+
+	/* wait for startup phase to finish */
+	while (1) {
+		u_int8_t val;
+		rc632_reg_read(RAH, RC632_REG_COMMAND, &val);
+		if (val == 0x00)
+			break;
+	}
+
+	/* turn off register paging */
+	rc632_reg_write(RAH, RC632_REG_PAGE0, 0x00);
+}
+
+static int rc632_usb_in(struct req_ctx *rctx)
+{
+	struct openpcd_hdr *poh = (struct openpcd_hdr *) &rctx->rx.data[0];
+	struct openpcd_hdr *pih = (struct openpcd_hdr *) &rctx->tx.data[0];
+	u_int16_t len = rctx->rx.tot_len-sizeof(*poh);
+
+	switch (poh->cmd) {
+	case OPENPCD_CMD_READ_REG:
+		rc632_reg_read(RAH, poh->reg, &pih->val);
+		DEBUGP("READ REG(0x%02x)=0x%02x ", poh->reg, pih->val);
+		goto respond;
+		break;
+	case OPENPCD_CMD_READ_FIFO:
+		{
+		u_int16_t req_len = poh->val, remain_len, pih_len;
+		if (req_len > MAX_PAYLOAD_LEN) {
+			pih_len = MAX_PAYLOAD_LEN;
+			remain_len -= pih_len;
+			rc632_fifo_read(RAH, pih_len, pih->data);
+			rctx->tx.tot_len += pih_len;
+			DEBUGP("READ FIFO(len=%u)=%s ", req_len,
+				hexdump(pih->data, pih_len));
+			req_ctx_set_state(rctx, RCTX_STATE_UDP_EP2_PENDING);
+			udp_refill_ep(2, rctx);
+
+			/* get and initialize second rctx */
+			rctx = req_ctx_find_get(RCTX_STATE_FREE,
+						RCTX_STATE_MAIN_PROCESSING);
+			if (!rctx) {
+				DEBUGPCRF("FATAL_NO_RCTX!!!\n");
+				break;
+			}
+			poh = (struct openpcd_hdr *) &rctx->rx.data[0];
+			pih = (struct openpcd_hdr *) &rctx->tx.data[0];
+			memcpy(pih, poh, sizeof(*poh));
+			rctx->tx.tot_len = sizeof(*poh);
+
+			pih_len = remain_len;
+			rc632_fifo_read(RAH, pih->val, pih->data);
+			rctx->tx.tot_len += pih_len;
+			DEBUGP("READ FIFO(len=%u)=%s ", pih_len,
+				hexdump(pih->data, pih_len));
+			/* don't set state of second rctx, main function
+			 * body will do this after switch statement */
+		} else {
+			pih->val = poh->val;
+			rc632_fifo_read(RAH, poh->val, pih->data);
+			rctx->tx.tot_len += pih_len;
+			DEBUGP("READ FIFO(len=%u)=%s ", poh->val,
+				hexdump(pih->data, poh->val));
+		}
+		goto respond;
+		break;
+		}
+	case OPENPCD_CMD_WRITE_REG:
+		DEBUGP("WRITE_REG(0x%02x, 0x%02x) ", poh->reg, poh->val);
+		rc632_reg_write(RAH, poh->reg, poh->val);
+		break;
+	case OPENPCD_CMD_WRITE_FIFO:
+		DEBUGP("WRITE FIFO(len=%u): %s ", len,
+			hexdump(poh->data, len));
+		rc632_fifo_write(RAH, len, poh->data, 0);
+		break;
+	case OPENPCD_CMD_READ_VFIFO:
+		DEBUGP("READ VFIFO ");
+		DEBUGP("NOT IMPLEMENTED YET ");
+		goto respond;
+		break;
+	case OPENPCD_CMD_WRITE_VFIFO:
+		DEBUGP("WRITE VFIFO ");
+		DEBUGP("NOT IMPLEMENTED YET ");
+		break;
+	case OPENPCD_CMD_REG_BITS_CLEAR:
+		DEBUGP("CLEAR BITS ");
+		pih->val = rc632_clear_bits(RAH, poh->reg, poh->val);
+		break;
+	case OPENPCD_CMD_REG_BITS_SET:
+		DEBUGP("SET BITS ");
+		pih->val = rc632_set_bits(RAH, poh->reg, poh->val);
+		break;
+	case OPENPCD_CMD_DUMP_REGS:
+		DEBUGP("DUMP REGS ");
+		DEBUGP("NOT IMPLEMENTED YET ");
+		goto respond;
+		break;
+	default:
+		DEBUGP("UNKNOWN ");
+		return -EINVAL;
+	}
+
+#ifdef ALWAYS_RESPOND
+	goto respond;
+#endif
+
+	req_ctx_put(rctx);
+	DEBUGPCR("");
+	return 0;
+
+respond:
+	req_ctx_set_state(rctx, RCTX_STATE_UDP_EP2_PENDING);
+	/* FIXME: we could try to send this immediately */
+	udp_refill_ep(2, rctx);
+	DEBUGPCR("");
+
+	return 1;
+}
+
+void rc632_init(void)
+{
+	//fifo_init(&rc632.fifo, 256, NULL, &rc632);
+
+	DEBUGPCRF("entering");
+
+	AT91F_SPI_CfgPMC();
+
+	AT91F_PIO_CfgPeriph(AT91C_BASE_PIOA,
+				AT91C_PA11_NPCS0|AT91C_PA12_MISO|
+				AT91C_PA13_MOSI |AT91C_PA14_SPCK, 0);
+
+	AT91F_AIC_ConfigureIt(AT91C_BASE_AIC, AT91C_ID_SPI,
+			      OPENPCD_IRQ_PRIO_SPI,
+			      AT91C_AIC_SRCTYPE_INT_HIGH_LEVEL, &spi_irq);
+	AT91F_AIC_EnableIt(AT91C_BASE_AIC, AT91C_ID_SPI);
+
+	AT91F_SPI_EnableIt(pSPI, AT91C_SPI_MODF|AT91C_SPI_OVRES);
+#ifdef SPI_USES_DMA
+	AT91F_SPI_EnableIt(pSPI, AT91C_SPI_ENDRX|AT91C_SPI_ENDTX);
+#endif
+
+#ifdef SPI_DEBUG_LOOPBACK
+	AT91F_SPI_CfgMode(pSPI, AT91C_SPI_MSTR|AT91C_SPI_PS_FIXED|
+				AT91C_SPI_MODFDIS|AT91C_SPI_LLB);
+#else
+	AT91F_SPI_CfgMode(pSPI, AT91C_SPI_MSTR|AT91C_SPI_PS_FIXED|
+				AT91C_SPI_MODFDIS);
+#endif
+	/* CPOL = 0, NCPHA = 1, CSAAT = 0, BITS = 0000, SCBR = 10 (4.8MHz), 
+	 * DLYBS = 0, DLYBCT = 0 */
+#ifdef SPI_USES_DMA
+	AT91F_SPI_CfgCs(pSPI, 0, AT91C_SPI_BITS_8|AT91C_SPI_NCPHA|(10<<8));
+#else
+	/* 320 kHz in case of I/O based SPI */
+	AT91F_SPI_CfgCs(pSPI, 0, AT91C_SPI_BITS_8|AT91C_SPI_NCPHA|(0x7f<<8));
+#endif
+	AT91F_SPI_Enable(pSPI);
+
+	/* Register rc632_irq */
+	AT91F_AIC_ConfigureIt(AT91C_BASE_AIC, OPENPCD_IRQ_RC632,
+			      OPENPCD_IRQ_PRIO_RC632,
+			      AT91C_AIC_SRCTYPE_INT_HIGH_LEVEL, &rc632_irq);
+	AT91F_AIC_EnableIt(AT91C_BASE_AIC, OPENPCD_IRQ_RC632);
+
+	AT91F_PIO_CfgOutput(AT91C_BASE_PIOA, OPENPCD_PIO_RC632_RESET);
+
+	rc632_reset();
+
+	/* configure IRQ pin */
+	rc632_reg_write(RAH, RC632_REG_IRQ_PIN_CONFIG,
+			RC632_IRQCFG_CMOS|RC632_IRQCFG_INV);
+	/* enable interrupts */
+	rc632_reg_write(RAH, RC632_REG_INTERRUPT_EN, RC632_INT_TIMER);
+	
+	/* configure AUX to test signal four */
+	rc632_reg_write(RAH, RC632_REG_TEST_ANA_SELECT, 0x04);
+
+	usb_hdlr_register(&rc632_usb_in, OPENPCD_CMD_CLS_RC632);
+};
+
+#if 0
+void rc632_exit(void)
+{
+	usb_hdlr_unregister(OPENPCD_CMD_CLS_RC632);
+	AT91F_AIC_DisableIt(AT91C_BASE_AIC, OPENPCD_IRQ_RC632);
+	AT91F_AIC_DisableIt(AT91C_BASE_AIC, AT91C_ID_SPI);
+	AT91F_SPI_Disable(pSPI);
+}
+#endif
+
+#ifdef DEBUG
+static int rc632_reg_write_verify(struct rfid_asic_handle *hdl,
+				  u_int8_t reg, u_int8_t val)
+{
+	u_int8_t tmp;
+
+	rc632_reg_write(hdl, reg, val);
+	rc632_reg_read(hdl, reg, &tmp);
+
+	DEBUGPCRF("reg=0x%02x, write=0x%02x, read=0x%02x ", reg, val, tmp);
+
+	return (val == tmp);
+}
+
+int rc632_dump(void)
+{
+	u_int8_t i;
+	u_int16_t rx_len = sizeof(spi_inbuf);
+
+	for (i = 0; i <= 0x3f; i++) {
+		u_int8_t reg = i;
+		if (reg == RC632_REG_FIFO_DATA)
+			reg = 0x3e;
+			
+		spi_outbuf[i] = reg << 1;
+		spi_inbuf[i] = 0x00;
+	}
+
+	/* MSB of first byte of read spi transfer is high */
+	spi_outbuf[0] |= 0x80;
+
+	/* last byte of read spi transfer is 0x00 */
+	spi_outbuf[0x40] = 0x00;
+	spi_inbuf[0x40] = 0x00;
+
+	spi_transceive(spi_outbuf, 0x41, spi_inbuf, &rx_len);
+
+	for (i = 0; i < 0x3f; i++) {
+		if (i == RC632_REG_FIFO_DATA)
+			DEBUGPCR("REG 0x02 = NOT READ");
+		else
+			DEBUGPCR("REG 0x%02x = 0x%02x", i, spi_inbuf[i+1]);
+	}
+	
+	return 0;
+}
+
+int rc632_test(struct rfid_asic_handle *hdl)
+{
+	if (rc632_reg_write_verify(hdl, RC632_REG_RX_WAIT, 0x55) != 1)
+		return -1;
+
+	if (rc632_reg_write_verify(hdl, RC632_REG_RX_WAIT, 0xAA) != 1)
+		return -1;
+
+	return 0;
+}
+#else /* DEBUG */
+int rc632_test(struct rfid_asic_handle *hdl) {}
+int rc632_dump(void) {}
+#endif /* DEBUG */