mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-09-03 11:23:22 +09:00
196 lines
4.6 KiB
C
196 lines
4.6 KiB
C
/*
|
|
* (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 */
|