// 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>

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

  /*
   * Values from last command.
   */

  static unsigned int	bus;
  static unsigned int	cs;
  static unsigned int	mode;

  static unsigned int	freq;

  static int   		bitlen;
  static uchar 		dout[MAX_SPI_BYTES];
  static uchar 		din[MAX_SPI_BYTES];

  static int do_spi_xfer(int bus, int cs)
  {
  	struct spi_slave *slave;

  	int ret = 0;

  #ifdef CONFIG_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
  ", bus, cs);
  		return -EINVAL;
  	}

  #endif

  	ret = spi_claim_bus(slave);
  	if (ret)
  		goto done;
  	ret = spi_xfer(slave, bitlen, dout, din,
  		       SPI_XFER_BEGIN | SPI_XFER_END);
  #ifndef CONFIG_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
  ", ret);

  	} else {
  		int j;
  
  		for (j = 0; j < ((bitlen + 7) / 8); j++)
  			printf("%02X", din[j]);
  		printf("
  ");
  	}

  done:

  	spi_release_bus(slave);

  #ifndef CONFIG_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 (cmd_tbl_t *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 = simple_strtoul(argv[1], &cp, 10);
  			if (*cp == ':') {
  				cs = simple_strtoul(cp+1, &cp, 10);
  			} else {
  				cs = bus;
  				bus = CONFIG_DEFAULT_SPI_BUS;
  			}

  			if (*cp == '.')

  				mode = simple_strtoul(cp+1, &cp, 10);
  			if (*cp == '@')
  				freq = simple_strtoul(cp+1, &cp, 10);

  		}

  		if (argc >= 3)
  			bitlen = simple_strtoul(argv[2], NULL, 10);

  		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
  ", *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
  ", 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
  "

  	"<bus>     - Identifies the SPI bus
  "
  	"<cs>      - Identifies the chip select
  "
  	"<mode>    - Identifies the SPI mode to use
  "

  	"<freq>    - Identifies the SPI bus frequency in Hz
  "

  	"<bit_len> - Number of bits to send (base 10)
  "

  	"<dout>    - Hexadecimal string that gets sent"

  );