cmd/spi.c

// SPDX-License-Identifier: GPL-2.0+
/*
 * (C) Copyright 2002
 * Gerald Van Baren, Custom IDEAS, vanbaren@cideas.com
 */

/*
 * SPI Read/Write Utilities
 */

#include <common.h>
#include <command.h>
#include <dm.h>
#include <errno.h>
#include <spi.h>

#if CONFIG_IS_ENABLED(AMLOGIC_MODIFY)
#include <linux/compat.h>
#endif
/*-----------------------------------------------------------------------
 * Definitions
 */

#ifndef MAX_SPI_BYTES
#   define MAX_SPI_BYTES 32	/* Maximum number of bytes we can handle */
#endif

#if CONFIG_IS_ENABLED(AMLOGIC_MODIFY)
#ifndef CONFIG_DEFAULT_SPI_BUS
#   define CONFIG_DEFAULT_SPI_BUS	0
#endif
#ifndef CONFIG_DEFAULT_SPI_MODE
#   define CONFIG_DEFAULT_SPI_MODE	SPI_MODE_0
#endif
#endif

/*
 * Values from last command.
 */
static unsigned int	bus;
static unsigned int	cs;
static unsigned int	mode;
static unsigned int	freq;
static int		bitlen;

#if !CONFIG_IS_ENABLED(AMLOGIC_MODIFY)
static uchar		dout[MAX_SPI_BYTES];
static uchar		din[MAX_SPI_BYTES];
#else
static int		wordlen = 8;
static unsigned int	xfer_flags;
struct spi_slave	*g_slave;
#define XFERS_MAX	8
static uchar		*buf_list[XFERS_MAX];
static int		buf_cnt;
static uchar		*dout;
static uchar		*din;
#endif

static int do_spi_xfer(int bus, int cs)
{
	struct spi_slave *slave;
	int ret = 0;
#if CONFIG_IS_ENABLED(AMLOGIC_MODIFY)
	if (g_slave && !(xfer_flags & SPI_XFER_BEGIN)) {
		slave = g_slave;
		goto next_xfer;
	}
#endif
#if CONFIG_IS_ENABLED(DM_SPI)
	char name[30], *str;
	struct udevice *dev;

	snprintf(name, sizeof(name), "generic_%d:%d", bus, cs);
	str = strdup(name);
	if (!str)
		return -ENOMEM;
	ret = _spi_get_bus_and_cs(bus, cs, freq, mode, "spi_generic_drv",
				  str, &dev, &slave);
	if (ret)
		return ret;
#else
	slave = spi_setup_slave(bus, cs, freq, mode);
	if (!slave) {
		printf("Invalid device %d:%d\n", bus, cs);
		return -EINVAL;
	}
#endif

#if CONFIG_IS_ENABLED(AMLOGIC_MODIFY)
	g_slave = slave;
	slave->wordlen = wordlen;
#endif
	ret = spi_claim_bus(slave);
	if (ret)
		goto done;
#if	!CONFIG_IS_ENABLED(AMLOGIC_MODIFY)
	ret = spi_xfer(slave, bitlen, dout, din,
				   SPI_XFER_BEGIN | SPI_XFER_END);
#else
next_xfer:
	ret = spi_xfer(slave, bitlen, dout, din, xfer_flags);
	if (ret > 0)
		return 0;
#endif
#if !CONFIG_IS_ENABLED(DM_SPI)
	/* We don't get an error code in this case */
	if (ret)
		ret = -EIO;
#endif
	if (ret) {
		printf("Error %d during SPI transaction\n", ret);
	} else {
		int j;

		for (j = 0; j < ((bitlen + 7) / 8); j++)
			printf("%02X", din[j]);
		printf("\n");
	}
done:
#if CONFIG_IS_ENABLED(AMLOGIC_MODIFY)
	g_slave = 0;
	for (int i = 0; i < buf_cnt; i++)
		kfree(buf_list[i]);
	buf_cnt = 0;
#endif
	spi_release_bus(slave);
#if !CONFIG_IS_ENABLED(DM_SPI)
	spi_free_slave(slave);
#endif

	return ret;
}

/*
 * SPI read/write
 *
 * Syntax:
 *   spi {dev} {num_bits} {dout}
 *     {dev} is the device number for controlling chip select (see TBD)
 *     {num_bits} is the number of bits to send & receive (base 10)
 *     {dout} is a hexadecimal string of data to send
 * The command prints out the hexadecimal string received via SPI.
 */

int do_spi(struct cmd_tbl *cmdtp, int flag, int argc, char *const argv[])
{
	char  *cp = 0;
	uchar tmp;
	int   j;

	/*
	 * We use the last specified parameters, unless new ones are
	 * entered.
	 */
	if (freq == 0)
		freq = 1000000;

	if ((flag & CMD_FLAG_REPEAT) == 0)
	{
		if (argc >= 2) {
			mode = CONFIG_DEFAULT_SPI_MODE;
			bus = dectoul(argv[1], &cp);
			if (*cp == ':') {
				cs = dectoul(cp + 1, &cp);
			} else {
				cs = bus;
				bus = CONFIG_DEFAULT_SPI_BUS;
			}
			if (*cp == '.')
				mode = dectoul(cp + 1, &cp);
			if (*cp == '@')
				freq = dectoul(cp + 1, &cp);
#if CONFIG_IS_ENABLED(AMLOGIC_MODIFY)
			if (*cp == '.')
				wordlen = simple_strtoul(cp + 1, &cp, 10);
			if (*cp == '.')
				xfer_flags = simple_strtoul(cp + 1, &cp, 16);
			else
				xfer_flags = SPI_XFER_BEGIN | SPI_XFER_END;
#endif
		}
#if !CONFIG_IS_ENABLED(AMLOGIC_MODIFY)
		if (argc >= 3)
			bitlen = dectoul(argv[2], NULL);
#else
		if (argc >= 3) {
			bitlen = dectoul(argv[2], NULL);
			dout = kcalloc(ALIGN(bitlen / 8, 8), 2, GFP_KERNEL);
			if (!dout)
				return -ENOMEM;
			din = dout + ALIGN(bitlen / 8, 8);
			buf_list[buf_cnt] = dout;
			if (++buf_cnt >= XFERS_MAX)
				xfer_flags |= SPI_XFER_END;
		}
#endif
		if (argc >= 4) {
			cp = argv[3];
			for(j = 0; *cp; j++, cp++) {
				tmp = *cp - '0';
				if(tmp > 9)
					tmp -= ('A' - '0') - 10;
				if(tmp > 15)
					tmp -= ('a' - 'A');
				if(tmp > 15) {
					printf("Hex conversion error on %c\n", *cp);
					return 1;
				}
				if((j % 2) == 0)
					dout[j / 2] = (tmp << 4);
				else
					dout[j / 2] |= tmp;
			}
		}
	}

	if ((bitlen < 0) || (bitlen >  (MAX_SPI_BYTES * 8))) {
		printf("Invalid bitlen %d\n", bitlen);
		return 1;
	}

	if (do_spi_xfer(bus, cs))
		return 1;

	return 0;
}

/***************************************************/

U_BOOT_CMD(
	sspi,	5,	1,	do_spi,
	"SPI utility command",
	"[<bus>:]<cs>[.<mode>][@<freq>] <bit_len> <dout> - Send and receive bits\n"
	"<bus>     - Identifies the SPI bus\n"
	"<cs>      - Identifies the chip select\n"
	"<mode>    - Identifies the SPI mode to use\n"
	"<freq>    - Identifies the SPI bus frequency in Hz\n"
	"<bit_len> - Number of bits to send (base 10)\n"
	"<dout>    - Hexadecimal string that gets sent"
);