From: Viktor Krivak viktor.krivak@gmail.com
Signed-off-by: Viktor Krivak viktor.krivak@gmail.com --- Simple spi driver which only cache input data and send them back on next call. Usefull for high level testing in sandbox.
drivers/spi/Makefile | 1 + drivers/spi/sandbox.c | 162 +++++++++++++++++++++++++++++++++++++++++++++ include/configs/sandbox.h | 3 + 3 files changed, 166 insertions(+) create mode 100644 drivers/spi/sandbox.c
diff --git a/drivers/spi/Makefile b/drivers/spi/Makefile index f0b82c6..a3b44fd 100644 --- a/drivers/spi/Makefile +++ b/drivers/spi/Makefile @@ -46,6 +46,7 @@ COBJS-$(CONFIG_SH_SPI) += sh_spi.o COBJS-$(CONFIG_FSL_ESPI) += fsl_espi.o COBJS-$(CONFIG_TEGRA_SPI) += tegra_spi.o COBJS-$(CONFIG_XILINX_SPI) += xilinx_spi.o +COBJS-$(CONFIG_SANDBOX_SPI) += sandbox.o
COBJS := $(COBJS-y) SRCS := $(COBJS:.o=.c) diff --git a/drivers/spi/sandbox.c b/drivers/spi/sandbox.c new file mode 100644 index 0000000..d76e38cf --- /dev/null +++ b/drivers/spi/sandbox.c @@ -0,0 +1,162 @@ +/* + * (C) Copyright 2012 + * Viktor Krivak viktor.krivak@gmail.com + * + * 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 <linux/types.h> +#include <asm/errno.h> +#include <spi.h> +#include <malloc.h> + +#ifndef CONFIG_SANDBOX_SPI_BUS_NUM + #define CONFIG_SANDBOX_SPI_BUS_NUM 1 +#endif + +#ifndef CONFIG_SANDBOX_SPI_CS_NUM + #define CONFIG_SANDBOX_SPI_CS_NUM 1 +#endif + +#ifndef CONFIG_SANDBOX_SPI_BUFFER_LEN + #define CONFIG_SANDBOX_SPI_BUFFER_LEN 32 +#endif + +static unsigned char spi_bus_claimed[CONFIG_SANDBOX_SPI_BUS_NUM]; +static unsigned char *buffer[CONFIG_SANDBOX_SPI_BUFFER_LEN]; + +/* + * spi_init() - Init spi + * + * Empty function. No init in sandbox. + */ +void spi_init(void) +{ + /* Do nothing */ +} + +/* + * spi_cs_is_valid() - Check if bus and cs are valid number + * + * @bus: Bus id + * @cs: Chip select id + * + * Compare bus and cs against defined constant. Return 0 if everything is ok + * and other value on error. + */ +int spi_cs_is_valid(unsigned int bus, unsigned int cs) +{ + if (!(bus < CONFIG_SANDBOX_SPI_BUS_NUM || + cs < CONFIG_SANDBOX_SPI_CS_NUM)) + return -EINVAL; + else + return 0; +} + +/* + * spi_setup() - Setup spi + * + * @bus: Bus id + * @cs: Chip select id + * @max_hz: Maximum SCK rate in Hz (ignored) + * @mode: Clock polarity, clock phase and other parameters(ignored) + * + * Check if bus and cs are valid and allocate memory for slave structure. + * Return pointer to slave stucture of NULL if something fail. + */ +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(slave)); + if (!slave) + return NULL; + slave->bus = bus; + slave->cs = cs; + return slave; +} + +/* + * spi_claim_bus() - Claim bus + * + * @slave: Pointer to slave struct + * + * Check if slave struct contain valid data and claim bus for it. If bus + * already claimed return error. If everything ok return 0. + */ +int spi_claim_bus(struct spi_slave *slave) +{ + if (spi_cs_is_valid(slave->bus, slave->cs)) + return -EINVAL; + if (!spi_bus_claimed[slave->bus]) { + spi_bus_claimed[slave->bus] = 1; + return 0; + } + return -EBUSY; +} + +/* + * spi_release_bus() - Release claim on bus + * + * @slave: Pointer to slave struct + * + * Release claim on bus defined in slave struct + */ +void spi_release_bus(struct spi_slave *slave) +{ + if (spi_cs_is_valid(slave->bus, slave->cs)) + return; + spi_bus_claimed[slave->bus] = 0; +} + +/* + * spi_xfer() - Send data throw SPI + * + * @slave: Pointer to slave struct + * @bitlen: Number of send or received bits + * @dout: Pointer to send buffer + * @din: Pointer to receive buffer + * @flags: Flags for SPI(ignored) + * + * Return data that was send in prevois call. Copy din to internal buffer and + * copy internal buffer to dout. Use temp variable for case when din = dout. + */ +int spi_xfer(struct spi_slave *slave, unsigned int bitlen, const void *dout, + void *din, unsigned long flags) +{ + unsigned char *buffer_temp[CONFIG_SANDBOX_SPI_BUFFER_LEN]; + memcpy(buffer_temp, dout, bitlen); + memcpy(din, buffer, bitlen); + memcpy(buffer, buffer_temp, bitlen); + return 0; +} + +/* + * spi_free_slave() - Destroy slave struct + * + * @slave: Pointer to slave struct + * + * Call free on slave struct + */ +void spi_free_slave(struct spi_slave *slave) +{ + free(slave); +} diff --git a/include/configs/sandbox.h b/include/configs/sandbox.h index 9c431bf..0ea4438 100644 --- a/include/configs/sandbox.h +++ b/include/configs/sandbox.h @@ -38,6 +38,9 @@ #define CONFIG_SANDBOX_GPIO #define CONFIG_SANDBOX_GPIO_COUNT 20
+#define CONFIG_CMD_SPI +#define CONFIG_SANDBOX_SPI + /* * Size of malloc() pool, although we don't actually use this yet. */