summaryrefslogtreecommitdiff
path: root/openpcd/firmware/src/pcd/rc632.c
diff options
context:
space:
mode:
Diffstat (limited to 'openpcd/firmware/src/pcd/rc632.c')
-rw-r--r--openpcd/firmware/src/pcd/rc632.c624
1 files changed, 0 insertions, 624 deletions
diff --git a/openpcd/firmware/src/pcd/rc632.c b/openpcd/firmware/src/pcd/rc632.c
deleted file mode 100644
index 5d45955..0000000
--- a/openpcd/firmware/src/pcd/rc632.c
+++ /dev/null
@@ -1,624 +0,0 @@
-/* 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 const 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 = req_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 */
personal git repositories of Harald Welte. Your mileage may vary