/*
   * (C) Copyright 2002
   * Gerald Van Baren, Custom IDEAS, vanbaren@cideas.com
   *

   * SPDX-License-Identifier:	GPL-2.0+

   */
  
  /*
   * SPI Read/Write Utilities
   */
  
  #include <common.h>
  #include <command.h>
  #include <spi.h>

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

  #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

  
  /*
   * Values from last command.
   */

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

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

  
  /*
   * 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[])

  {

  	struct spi_slave *slave;

  	char  *cp = 0;
  	uchar tmp;
  	int   j;
  	int   rcode = 0;
  
  	/*
  	 * We use the last specified parameters, unless new ones are
  	 * entered.
  	 */
  
  	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, NULL, 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;

  	}

  	slave = spi_setup_slave(bus, cs, 1000000, mode);

  	if (!slave) {

  		printf("Invalid device %d:%d
  ", bus, cs);

  		return 1;
  	}

  	spi_claim_bus(slave);
  	if(spi_xfer(slave, bitlen, dout, din,
  				SPI_XFER_BEGIN | SPI_XFER_END) != 0) {

  		printf("Error during SPI transaction
  ");

  		rcode = 1;
  	} else {

  		for(j = 0; j < ((bitlen + 7) / 8); j++) {

  			printf("%02X", din[j]);

  		}
  		printf("
  ");
  	}

  	spi_release_bus(slave);
  	spi_free_slave(slave);

  
  	return rcode;
  }

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

  U_BOOT_CMD(
  	sspi,	5,	1,	do_spi,

  	"SPI utility command",
  	"[<bus>:]<cs>[.<mode>] <bit_len> <dout> - Send and receive bits
  "
  	"<bus>     - Identifies the SPI bus
  "
  	"<cs>      - Identifies the chip select
  "
  	"<mode>    - Identifies the SPI mode to use
  "

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

  	"<dout>    - Hexadecimal string that gets sent"

  );