| /* |
| * (C) Copyright 2004, Li-Pro.Net <www.li-pro.net> |
| * Stephan Linz <linz@li-pro.net> |
| * |
| * See file CREDITS for list of people who contributed to this |
| * project. |
| * |
| * This program is free software; you can redistribute it and/or |
| * modify it under the terms of the GNU General Public License as |
| * published by the Free Software Foundation; either version 2 of |
| * the License, or (at your option) any later version. |
| * |
| * This program is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| * |
| * You should have received a copy of the GNU General Public License |
| * along with this program; if not, write to the Free Software |
| * Foundation, Inc., 59 Temple Place, Suite 330, Boston, |
| * MA 02111-1307 USA |
| */ |
| |
| #include <common.h> |
| #include <linux/ctype.h> |
| |
| #if defined(CONFIG_NIOS_SPI) |
| #include <nios-io.h> |
| #include <spi.h> |
| |
| #if !defined(CONFIG_SYS_NIOS_SPIBASE) |
| #error "*** CONFIG_SYS_NIOS_SPIBASE not defined ***" |
| #endif |
| |
| #if !defined(CONFIG_SYS_NIOS_SPIBITS) |
| #error "*** CONFIG_SYS_NIOS_SPIBITS not defined ***" |
| #endif |
| |
| #if (CONFIG_SYS_NIOS_SPIBITS != 8) && (CONFIG_SYS_NIOS_SPIBITS != 16) |
| #error "*** CONFIG_SYS_NIOS_SPIBITS should be either 8 or 16 ***" |
| #endif |
| |
| static nios_spi_t *spi = (nios_spi_t *)CONFIG_SYS_NIOS_SPIBASE; |
| |
| /* Warning: |
| * You cannot enable DEBUG for early system initalization, i. e. when |
| * this driver is used to read environment parameters like "baudrate" |
| * from EEPROM which are used to initialize the serial port which is |
| * needed to print the debug messages... |
| */ |
| #undef DEBUG |
| |
| #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 (const void *pv, int num) |
| { |
| int i; |
| const unsigned char *pc = (const 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) |
| #define memdump(p,n) |
| |
| #endif /* DEBUG */ |
| |
| |
| struct spi_slave *spi_setup_slave(unsigned int bus, unsigned int cs, |
| unsigned int max_hz, unsigned int mode) |
| { |
| struct spi_slave *slave; |
| |
| if (!spi_cs_is_valid(bus, cs)) |
| return NULL; |
| |
| slave = malloc(sizeof(struct spi_slave)); |
| if (!slave) |
| return NULL; |
| |
| slave->bus = bus; |
| slave->cs = cs; |
| |
| /* TODO: Add support for different modes and speeds */ |
| |
| return slave; |
| } |
| |
| void spi_free_slave(struct spi_slave *slave) |
| { |
| free(slave); |
| } |
| |
| int spi_claim_bus(struct spi_slave *slave) |
| { |
| return 0; |
| } |
| |
| void spi_release_bus(struct spi_slave *slave) |
| { |
| |
| } |
| |
| /* |
| * SPI transfer: |
| * |
| * See include/spi.h and http://www.altera.com/literature/ds/ds_nios_spi.pdf |
| * for more informations. |
| */ |
| int spi_xfer(struct spi_slave *slave, int bitlen, const void *dout, |
| void *din, unsigned long flags) |
| { |
| const u8 *txd = dout; |
| u8 *rxd = din; |
| int j; |
| |
| DPRINT(("spi_xfer: slave %u:%u dout %08X din %08X bitlen %d\n", |
| slave->bus, slave->cs, *(uint *)dout, *(uint *)din, bitlen)); |
| |
| memdump(dout, (bitlen + 7) / 8); |
| |
| if (flags & SPI_XFER_BEGIN) |
| spi_cs_activate(slave); |
| |
| if (!(flags & SPI_XFER_END) || bitlen > CONFIG_SYS_NIOS_SPIBITS) { |
| /* leave chip select active */ |
| spi->control |= NIOS_SPI_SSO; |
| } |
| |
| for ( j = 0; /* count each byte in */ |
| j < ((bitlen + 7) / 8); /* dout[] and din[] */ |
| |
| #if (CONFIG_SYS_NIOS_SPIBITS == 8) |
| j++) { |
| |
| while ((spi->status & NIOS_SPI_TRDY) == 0) |
| ; |
| spi->txdata = (unsigned)(txd[j]); |
| |
| while ((spi->status & NIOS_SPI_RRDY) == 0) |
| ; |
| rxd[j] = (unsigned char)(spi->rxdata & 0xff); |
| |
| #elif (CONFIG_SYS_NIOS_SPIBITS == 16) |
| j++, j++) { |
| |
| while ((spi->status & NIOS_SPI_TRDY) == 0) |
| ; |
| if ((j+1) < ((bitlen + 7) / 8)) |
| spi->txdata = (unsigned)((txd[j] << 8) | txd[j+1]); |
| else |
| spi->txdata = (unsigned)(txd[j] << 8); |
| |
| while ((spi->status & NIOS_SPI_RRDY) == 0) |
| ; |
| rxd[j] = (unsigned char)((spi->rxdata >> 8) & 0xff); |
| if ((j+1) < ((bitlen + 7) / 8)) |
| rxd[j+1] = (unsigned char)(spi->rxdata & 0xff); |
| |
| #else |
| #error "*** unsupported value of CONFIG_SYS_NIOS_SPIBITS ***" |
| #endif |
| |
| } |
| |
| if (bitlen > CONFIG_SYS_NIOS_SPIBITS && (flags & SPI_XFER_END)) { |
| spi->control &= ~NIOS_SPI_SSO; |
| } |
| |
| if (flags & SPI_XFER_END) |
| spi_cs_deactivate(slave); |
| |
| memdump(din, (bitlen + 7) / 8); |
| |
| return 0; |
| } |
| |
| #endif /* CONFIG_NIOS_SPI */ |