mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-08-17 15:38:51 +09:00
![Peng Fan](/assets/img/avatar_default.png)
Check return value of strdup. Signed-off-by: Peng Fan <van.freenix@gmail.com> Cc: Przemyslaw Marczak <p.marczak@samsung.com> Cc: Bin Meng <bmeng.cn@gmail.com> Cc: Heiko Schocher <hs@denx.de> Cc: Simon Glass <sjg@chromium.org> Cc: Stefan Roese <sr@denx.de> Cc: Tom Rini <trini@konsulko.com>
177 lines
3.6 KiB
C
177 lines
3.6 KiB
C
/*
|
|
* (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 <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
|
|
|
|
#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];
|
|
|
|
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, 1000000, mode, "spi_generic_drv",
|
|
str, &dev, &slave);
|
|
if (ret)
|
|
return ret;
|
|
#else
|
|
slave = spi_setup_slave(bus, cs, 1000000, mode);
|
|
if (!slave) {
|
|
printf("Invalid device %d:%d\n", 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\n", ret);
|
|
} else {
|
|
int j;
|
|
|
|
for (j = 0; j < ((bitlen + 7) / 8); j++)
|
|
printf("%02X", din[j]);
|
|
printf("\n");
|
|
}
|
|
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 ((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\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>] <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"
|
|
"<bit_len> - Number of bits to send (base 10)\n"
|
|
"<dout> - Hexadecimal string that gets sent"
|
|
);
|