Add qemu 2.4.0
[kvmfornfv.git] / qemu / roms / u-boot / arch / powerpc / cpu / mpc5xx / spi.c
diff --git a/qemu/roms/u-boot/arch/powerpc/cpu/mpc5xx/spi.c b/qemu/roms/u-boot/arch/powerpc/cpu/mpc5xx/spi.c
new file mode 100644 (file)
index 0000000..ef8b55f
--- /dev/null
@@ -0,0 +1,396 @@
+/*
+ * Copyright (c) 2001 Navin Boppuri / Prashant Patel
+ *     <nboppuri@trinetcommunication.com>,
+ *     <pmpatel@trinetcommunication.com>
+ * Copyright (c) 2001 Gerd Mennchen <Gerd.Mennchen@icn.siemens.de>
+ * Copyright (c) 2001 Wolfgang Denk, DENX Software Engineering, <wd@denx.de>.
+ *
+ * SPDX-License-Identifier:    GPL-2.0+
+ */
+
+/*
+ * MPC5xx CPM SPI interface.
+ *
+ * Parts of this code are probably not portable and/or specific to
+ * the board which I used for the tests. Please send fixes/complaints
+ * to wd@denx.de
+ *
+ * Ported to MPC5xx
+ * Copyright (c) 2003 Denis Peter, MPL AG Switzerland, d.petr@mpl.ch.
+ */
+
+#include <common.h>
+#include <mpc5xx.h>
+#include <asm/5xx_immap.h>
+#include <linux/ctype.h>
+#include <malloc.h>
+#include <post.h>
+#include <net.h>
+
+#if defined(CONFIG_SPI)
+
+#undef DEBUG
+
+#define SPI_EEPROM_WREN                0x06
+#define SPI_EEPROM_RDSR                0x05
+#define SPI_EEPROM_READ                0x03
+#define SPI_EEPROM_WRITE       0x02
+
+
+#ifdef DEBUG
+
+#define        DPRINT(a)       printf a;
+/* -----------------------------------------------
+ * Helper functions to peek into tx and rx buffers
+ * ----------------------------------------------- */
+static const char * const hex_digit = "0123456789ABCDEF";
+
+static char quickhex (int i)
+{
+       return hex_digit[i];
+}
+
+static void memdump (void *pv, int num)
+{
+       int i;
+       unsigned char *pc = (unsigned char *) pv;
+
+       for (i = 0; i < num; i++)
+               printf ("%c%c ", quickhex (pc[i] >> 4), quickhex (pc[i] & 0x0f));
+       printf ("\t");
+       for (i = 0; i < num; i++)
+               printf ("%c", isprint (pc[i]) ? pc[i] : '.');
+       printf ("\n");
+}
+#else  /* !DEBUG */
+
+#define        DPRINT(a)
+
+#endif /* DEBUG */
+
+/* -------------------
+ * Function prototypes
+ * ------------------- */
+void spi_init (void);
+
+ssize_t spi_read (uchar *, int, uchar *, int);
+ssize_t spi_write (uchar *, int, uchar *, int);
+ssize_t spi_xfer (size_t);
+
+
+/* **************************************************************************
+ *
+ *  Function:    spi_init_f
+ *
+ *  Description: Init SPI-Controller (ROM part)
+ *
+ *  return:      ---
+ *
+ * *********************************************************************** */
+
+void spi_init_f (void)
+{
+       int i;
+
+       volatile immap_t *immr;
+       volatile qsmcm5xx_t *qsmcm;
+
+       immr = (immap_t *)  CONFIG_SYS_IMMR;
+       qsmcm = (qsmcm5xx_t *)&immr->im_qsmcm;
+
+       qsmcm->qsmcm_qsmcr = 0; /* all accesses enabled */
+       qsmcm->qsmcm_qspi_il = 0; /* lowest IRQ */
+
+       /* --------------------------------------------
+        * GPIO or per. Function
+        * PQSPAR[00] = 0 reserved
+        * PQSPAR[01] = 1 [0x4000] -> PERI: (SPICS3)
+        * PQSPAR[02] = 0 [0x0000] -> GPIO
+        * PQSPAR[03] = 0 [0x0000] -> GPIO
+        * PQSPAR[04] = 1 [0x0800] -> PERI: (SPICS0)
+        * PQSPAR[05] = 0 reseved
+        * PQSPAR[06] = 1 [0x0200] -> PERI: (SPIMOSI)
+        * PQSPAR[07] = 1 [0x0100] -> PERI: (SPIMISO)
+        * -------------------------------------------- */
+       qsmcm->qsmcm_pqspar =  0x3 | (CONFIG_SYS_SPI_CS_USED << 3);
+
+        /* --------------------------------------------
+        * DDRQS[00] = 0 reserved
+        * DDRQS[01] = 1 [0x0040] -> SPICS3 Output
+        * DDRQS[02] = 0 [0x0000] -> GPIO Output
+        * DDRQS[03] = 0 [0x0000] -> GPIO Output
+        * DDRQS[04] = 1 [0x0008] -> SPICS0 Output
+        * DDRQS[05] = 1 [0x0004] -> SPICLK Output
+        * DDRQS[06] = 1 [0x0002] -> SPIMOSI Output
+        * DDRQS[07] = 0 [0x0001] -> SPIMISO Input
+        * -------------------------------------------- */
+       qsmcm->qsmcm_ddrqs = 0x7E;
+        /* --------------------------------------------
+        * Base state for used SPI CS pins, if base = 0 active must be 1
+        * PORTQS[00] = 0 reserved
+        * PORTQS[01] = 0 reserved
+        * PORTQS[02] = 0 reserved
+        * PORTQS[03] = 0 reserved
+        * PORTQS[04] = 0 [0x0000] RxD2
+        * PORTQS[05] = 1 [0x0400] TxD2
+        * PORTQS[06] = 0 [0x0000] RxD1
+        * PORTQS[07] = 1 [0x0100] TxD1
+        * PORTQS[08] = 0 reserved
+        * PORTQS[09] = 0 [0x0000] -> SPICS3 Base Output
+        * PORTQS[10] = 0 [0x0000] -> SPICS2 Base Output
+        * PORTQS[11] = 0 [0x0000] -> SPICS1 Base Output
+        * PORTQS[12] = 0 [0x0000] -> SPICS0 Base Output
+        * PORTQS[13] = 0 [0x0004] -> SPICLK Output
+        * PORTQS[14] = 0 [0x0002] -> SPIMOSI Output
+        * PORTQS[15] = 0 [0x0001] -> SPIMISO Input
+        * -------------------------------------------- */
+       qsmcm->qsmcm_portqs |= (CONFIG_SYS_SPI_CS_BASE << 3);
+       /* --------------------------------------------
+        * Controll Register 0
+        * SPCR0[00] = 1 (0x8000) Master
+        * SPCR0[01] = 0 (0x0000) Wired-Or
+        * SPCR0[2..5] = (0x2000) Bits per transfer (default 8)
+        * SPCR0[06] = 0 (0x0000) Normal polarity
+        * SPCR0[07] = 0 (0x0000) Normal Clock Phase
+        * SPCR0[08..15] = 14 1.4MHz
+        */
+       qsmcm->qsmcm_spcr0=0xA00E;
+       /* --------------------------------------------
+        * Controll Register 1
+        * SPCR1[00] = 0 (0x0000) QSPI enabled
+        * SPCR1[1..7] =  (0x7F00) Delay before Transfer
+        * SPCR1[8..15] = (0x0000) Delay After transfer (204.8usec@40MHz)
+        */
+       qsmcm->qsmcm_spcr1=0x7F00;
+       /* --------------------------------------------
+        * Controll Register 2
+        * SPCR2[00] = 0 (0x0000) SPI IRQs Disabeld
+        * SPCR2[01] = 0 (0x0000) No Wrap around
+        * SPCR2[02] = 0 (0x0000) Wrap to 0
+        * SPCR2[3..7] = (0x0000) End Queue pointer = 0
+        * SPCR2[8..10] = 0 (0x0000) reserved
+        * SPCR2[11..15] = 0 (0x0000) NewQueue Address = 0
+        */
+       qsmcm->qsmcm_spcr2=0x0000;
+       /* --------------------------------------------
+        * Controll Register 3
+        * SPCR3[00..04] = 0 (0x0000) reserved
+        * SPCR3[05] = 0 (0x0000) Feedback disabled
+        * SPCR3[06] = 0 (0x0000) IRQ on HALTA & MODF disabled
+        * SPCR3[07] = 0 (0x0000) Not halted
+        */
+       qsmcm->qsmcm_spcr3=0x00;
+       /* --------------------------------------------
+        * SPSR (Controll Register 3) Read only/ reset Flags 08,09,10
+        * SPCR3[08] = 1 (0x80) QSPI finished
+        * SPCR3[09] = 1 (0x40) Mode Fault Flag
+        * SPCR3[10] = 1 (0x20) HALTA
+        * SPCR3[11..15] = 0 (0x0000) Last executed command
+        */
+       qsmcm->qsmcm_spsr=0xE0;
+       /*-------------------------------------------
+        * Setup RAM
+        */
+       for(i=0;i<32;i++) {
+                qsmcm->qsmcm_recram[i]=0x0000;
+                qsmcm->qsmcm_tranram[i]=0x0000;
+                qsmcm->qsmcm_comdram[i]=0x00;
+       }
+       return;
+}
+
+/* **************************************************************************
+ *
+ *  Function:    spi_init_r
+ *  Dummy, all initializations have been done in spi_init_r
+ * *********************************************************************** */
+void spi_init_r (void)
+{
+       return;
+
+}
+
+/****************************************************************************
+ *  Function:    spi_write
+ **************************************************************************** */
+ssize_t short_spi_write (uchar *addr, int alen, uchar *buffer, int len)
+{
+       int i,dlen;
+       volatile immap_t *immr;
+       volatile qsmcm5xx_t *qsmcm;
+
+       immr = (immap_t *)  CONFIG_SYS_IMMR;
+       qsmcm = (qsmcm5xx_t *)&immr->im_qsmcm;
+       for(i=0;i<32;i++) {
+                qsmcm->qsmcm_recram[i]=0x0000;
+                qsmcm->qsmcm_tranram[i]=0x0000;
+                qsmcm->qsmcm_comdram[i]=0x00;
+       }
+       qsmcm->qsmcm_tranram[0] =  SPI_EEPROM_WREN; /* write enable */
+       spi_xfer(1);
+       i=0;
+       qsmcm->qsmcm_tranram[i++] =  SPI_EEPROM_WRITE; /* WRITE memory array */
+       qsmcm->qsmcm_tranram[i++] =  addr[0];
+       qsmcm->qsmcm_tranram[i++] =  addr[1];
+
+       for(dlen=0;dlen<len;dlen++) {
+               qsmcm->qsmcm_tranram[i+dlen] = buffer[dlen]; /* WRITE memory array */
+       }
+       /* transmit it */
+       spi_xfer(i+dlen);
+       /* ignore received data */
+       for (i = 0; i < 1000; i++) {
+               qsmcm->qsmcm_tranram[0] =  SPI_EEPROM_RDSR; /* read status */
+               qsmcm->qsmcm_tranram[1] = 0;
+               spi_xfer(2);
+               if (!(qsmcm->qsmcm_recram[1] & 1)) {
+                       break;
+               }
+               udelay(1000);
+       }
+       if (i >= 1000) {
+               printf ("*** spi_write: Time out while writing!\n");
+       }
+       return len;
+}
+
+#define TRANSFER_LEN 16
+
+ssize_t spi_write (uchar *addr, int alen, uchar *buffer, int len)
+{
+       int index,i,newlen;
+       uchar newaddr[2];
+       int curraddr;
+
+       curraddr=(addr[alen-2]<<8)+addr[alen-1];
+       i=len;
+       index=0;
+       do {
+               newaddr[1]=(curraddr & 0xff);
+               newaddr[0]=((curraddr>>8) & 0xff);
+               if(i>TRANSFER_LEN) {
+                       newlen=TRANSFER_LEN;
+                       i-=TRANSFER_LEN;
+               }
+               else {
+                       newlen=i;
+                       i=0;
+               }
+               short_spi_write (newaddr, 2, &buffer[index], newlen);
+               index+=newlen;
+               curraddr+=newlen;
+       }while(i);
+       return (len);
+}
+
+/****************************************************************************
+ *  Function:    spi_read
+ **************************************************************************** */
+ssize_t short_spi_read (uchar *addr, int alen, uchar *buffer, int len)
+{
+       int i;
+       volatile immap_t *immr;
+       volatile qsmcm5xx_t *qsmcm;
+
+       immr = (immap_t *)  CONFIG_SYS_IMMR;
+       qsmcm = (qsmcm5xx_t *)&immr->im_qsmcm;
+
+       for(i=0;i<32;i++) {
+                qsmcm->qsmcm_recram[i]=0x0000;
+                qsmcm->qsmcm_tranram[i]=0x0000;
+                qsmcm->qsmcm_comdram[i]=0x00;
+       }
+       i=0;
+       qsmcm->qsmcm_tranram[i++] = (SPI_EEPROM_READ); /* READ memory array */
+       qsmcm->qsmcm_tranram[i++] = addr[0] & 0xff;
+       qsmcm->qsmcm_tranram[i++] = addr[1] & 0xff;
+       spi_xfer(3 + len);
+       for(i=0;i<len;i++) {
+               *buffer++=(char)qsmcm->qsmcm_recram[i+3];
+       }
+       return len;
+}
+
+ssize_t spi_read (uchar *addr, int alen, uchar *buffer, int len)
+{
+       int index,i,newlen;
+       uchar newaddr[2];
+       int curraddr;
+
+       curraddr=(addr[alen-2]<<8)+addr[alen-1];
+       i=len;
+       index=0;
+       do {
+               newaddr[1]=(curraddr & 0xff);
+               newaddr[0]=((curraddr>>8) & 0xff);
+               if(i>TRANSFER_LEN) {
+                       newlen=TRANSFER_LEN;
+                       i-=TRANSFER_LEN;
+               }
+               else {
+                       newlen=i;
+                       i=0;
+               }
+               short_spi_read (newaddr, 2, &buffer[index], newlen);
+               index+=newlen;
+               curraddr+=newlen;
+       }while(i);
+       return (len);
+}
+
+/****************************************************************************
+ *  Function:    spi_xfer
+ **************************************************************************** */
+ssize_t spi_xfer (size_t count)
+{
+       volatile immap_t *immr;
+       volatile qsmcm5xx_t *qsmcm;
+       int i;
+       int tm;
+       ushort status;
+       immr = (immap_t *)  CONFIG_SYS_IMMR;
+       qsmcm = (qsmcm5xx_t *)&immr->im_qsmcm;
+       DPRINT (("*** spi_xfer entered count %d***\n",count));
+
+       /* Set CS for device */
+       for(i=0;i<(count-1);i++)
+               qsmcm->qsmcm_comdram[i] = 0x80 | CONFIG_SYS_SPI_CS_ACT;  /* CS3 is connected to the SPI EEPROM */
+
+       qsmcm->qsmcm_comdram[i] = CONFIG_SYS_SPI_CS_ACT; /* CS3 is connected to the SPI EEPROM */
+       qsmcm->qsmcm_spcr2=((count-1)&0x1F)<<8;
+
+       DPRINT (("*** spi_xfer: Bytes to be xferred: %d ***\n", count));
+
+       qsmcm->qsmcm_spsr=0xE0; /* clear all flags */
+
+       /* start spi transfer */
+       DPRINT (("*** spi_xfer: Performing transfer ...\n"));
+       qsmcm->qsmcm_spcr1 |= 0x8000;           /* Start transmit */
+
+       /* --------------------------------
+        * Wait for SPI transmit to get out
+        * or time out (1 second = 1000 ms)
+        * -------------------------------- */
+       for (tm=0; tm<1000; ++tm) {
+               status=qsmcm->qsmcm_spcr1;
+               if((status & 0x8000)==0)
+                       break;
+               udelay (1000);
+       }
+       if (tm >= 1000) {
+               printf ("*** spi_xfer: Time out while xferring to/from SPI!\n");
+       }
+#ifdef DEBUG
+       printf ("\nspi_xfer: txbuf after xfer\n");
+       memdump ((void *) qsmcm->qsmcm_tranram, 32);    /* dump of txbuf before transmit */
+       printf ("spi_xfer: rxbuf after xfer\n");
+       memdump ((void *) qsmcm->qsmcm_recram, 32);     /* dump of rxbuf after transmit */
+       printf ("\nspi_xfer: commbuf after xfer\n");
+       memdump ((void *) qsmcm->qsmcm_comdram, 32);    /* dump of txbuf before transmit */
+       printf ("\n");
+#endif
+
+       return count;
+}
+
+#endif /* CONFIG_SPI  */