spi: Use error return value in sf_ops

Adjust spi_flash_probe_slave() to return an error value instead of a
pointer so we get the correct error return.

Have the caller allocate memory for spi_flash to simplify error handling,
and also so that driver model can use its existing allocated memory.

Add a spi.h include in the sf_params file.

Signed-off-by: Simon Glass <sjg@chromium.org>
Reviewed-by: Jagannadha Sutradharudu Teki <jagannadh.teki@gmail.com>
This commit is contained in:
Simon Glass 2014-10-13 23:42:05 -06:00
parent ff0960f9a0
commit ae242cbfd0
1 changed files with 57 additions and 33 deletions

View File

@ -9,6 +9,7 @@
*/ */
#include <common.h> #include <common.h>
#include <errno.h>
#include <fdtdec.h> #include <fdtdec.h>
#include <malloc.h> #include <malloc.h>
#include <spi.h> #include <spi.h>
@ -95,15 +96,15 @@ static int spi_flash_set_qeb(struct spi_flash *flash, u8 idcode0)
} }
} }
static struct spi_flash *spi_flash_validate_params(struct spi_slave *spi, static int spi_flash_validate_params(struct spi_slave *spi, u8 *idcode,
u8 *idcode) struct spi_flash *flash)
{ {
const struct spi_flash_params *params; const struct spi_flash_params *params;
struct spi_flash *flash;
u8 cmd; u8 cmd;
u16 jedec = idcode[1] << 8 | idcode[2]; u16 jedec = idcode[1] << 8 | idcode[2];
u16 ext_jedec = idcode[3] << 8 | idcode[4]; u16 ext_jedec = idcode[3] << 8 | idcode[4];
/* Validate params from spi_flash_params table */
params = spi_flash_params_table; params = spi_flash_params_table;
for (; params->name != NULL; params++) { for (; params->name != NULL; params++) {
if ((params->jedec >> 16) == idcode[0]) { if ((params->jedec >> 16) == idcode[0]) {
@ -120,13 +121,7 @@ static struct spi_flash *spi_flash_validate_params(struct spi_slave *spi,
printf("SF: Unsupported flash IDs: "); printf("SF: Unsupported flash IDs: ");
printf("manuf %02x, jedec %04x, ext_jedec %04x\n", printf("manuf %02x, jedec %04x, ext_jedec %04x\n",
idcode[0], jedec, ext_jedec); idcode[0], jedec, ext_jedec);
return NULL; return -EPROTONOSUPPORT;
}
flash = calloc(1, sizeof(*flash));
if (!flash) {
debug("SF: Failed to allocate spi_flash\n");
return NULL;
} }
/* Assign spi data */ /* Assign spi data */
@ -227,15 +222,18 @@ static struct spi_flash *spi_flash_validate_params(struct spi_slave *spi,
#ifdef CONFIG_SPI_FLASH_BAR #ifdef CONFIG_SPI_FLASH_BAR
u8 curr_bank = 0; u8 curr_bank = 0;
if (flash->size > SPI_FLASH_16MB_BOUN) { if (flash->size > SPI_FLASH_16MB_BOUN) {
int ret;
flash->bank_read_cmd = (idcode[0] == 0x01) ? flash->bank_read_cmd = (idcode[0] == 0x01) ?
CMD_BANKADDR_BRRD : CMD_EXTNADDR_RDEAR; CMD_BANKADDR_BRRD : CMD_EXTNADDR_RDEAR;
flash->bank_write_cmd = (idcode[0] == 0x01) ? flash->bank_write_cmd = (idcode[0] == 0x01) ?
CMD_BANKADDR_BRWR : CMD_EXTNADDR_WREAR; CMD_BANKADDR_BRWR : CMD_EXTNADDR_WREAR;
if (spi_flash_read_common(flash, &flash->bank_read_cmd, 1, ret = spi_flash_read_common(flash, &flash->bank_read_cmd, 1,
&curr_bank, 1)) { &curr_bank, 1);
if (ret) {
debug("SF: fail to read bank addr register\n"); debug("SF: fail to read bank addr register\n");
return NULL; return ret;
} }
flash->bank_curr = curr_bank; flash->bank_curr = curr_bank;
} else { } else {
@ -250,7 +248,7 @@ static struct spi_flash *spi_flash_validate_params(struct spi_slave *spi,
spi_flash_cmd_write_status(flash, 0); spi_flash_cmd_write_status(flash, 0);
#endif #endif
return flash; return 0;
} }
#ifdef CONFIG_OF_CONTROL #ifdef CONFIG_OF_CONTROL
@ -309,23 +307,29 @@ static int spi_enable_wp_pin(struct spi_flash *flash)
} }
#endif #endif
static struct spi_flash *spi_flash_probe_slave(struct spi_slave *spi) /**
* spi_flash_probe_slave() - Probe for a SPI flash device on a bus
*
* @spi: Bus to probe
* @flashp: Pointer to place to put flash info, which may be NULL if the
* space should be allocated
*/
int spi_flash_probe_slave(struct spi_slave *spi, struct spi_flash *flash)
{ {
struct spi_flash *flash = NULL;
u8 idcode[5]; u8 idcode[5];
int ret; int ret;
/* Setup spi_slave */ /* Setup spi_slave */
if (!spi) { if (!spi) {
printf("SF: Failed to set up slave\n"); printf("SF: Failed to set up slave\n");
return NULL; return -ENODEV;
} }
/* Claim spi bus */ /* Claim spi bus */
ret = spi_claim_bus(spi); ret = spi_claim_bus(spi);
if (ret) { if (ret) {
debug("SF: Failed to claim SPI bus: %d\n", ret); debug("SF: Failed to claim SPI bus: %d\n", ret);
goto err_claim_bus; return ret;
} }
/* Read the ID codes */ /* Read the ID codes */
@ -340,10 +344,10 @@ static struct spi_flash *spi_flash_probe_slave(struct spi_slave *spi)
print_buffer(0, idcode, 1, sizeof(idcode), 0); print_buffer(0, idcode, 1, sizeof(idcode), 0);
#endif #endif
/* Validate params from spi_flash_params table */ if (spi_flash_validate_params(spi, idcode, flash)) {
flash = spi_flash_validate_params(spi, idcode); ret = -EINVAL;
if (!flash)
goto err_read_id; goto err_read_id;
}
/* Set the quad enable bit - only for quad commands */ /* Set the quad enable bit - only for quad commands */
if ((flash->read_cmd == CMD_READ_QUAD_OUTPUT_FAST) || if ((flash->read_cmd == CMD_READ_QUAD_OUTPUT_FAST) ||
@ -351,13 +355,15 @@ static struct spi_flash *spi_flash_probe_slave(struct spi_slave *spi)
(flash->write_cmd == CMD_QUAD_PAGE_PROGRAM)) { (flash->write_cmd == CMD_QUAD_PAGE_PROGRAM)) {
if (spi_flash_set_qeb(flash, idcode[0])) { if (spi_flash_set_qeb(flash, idcode[0])) {
debug("SF: Fail to set QEB for %02x\n", idcode[0]); debug("SF: Fail to set QEB for %02x\n", idcode[0]);
return NULL; ret = -EINVAL;
goto err_read_id;
} }
} }
#ifdef CONFIG_OF_CONTROL #ifdef CONFIG_OF_CONTROL
if (spi_flash_decode_fdt(gd->fdt_blob, flash)) { if (spi_flash_decode_fdt(gd->fdt_blob, flash)) {
debug("SF: FDT decode error\n"); debug("SF: FDT decode error\n");
ret = -EINVAL;
goto err_read_id; goto err_read_id;
} }
#endif #endif
@ -385,32 +391,50 @@ static struct spi_flash *spi_flash_probe_slave(struct spi_slave *spi)
/* Release spi bus */ /* Release spi bus */
spi_release_bus(spi); spi_release_bus(spi);
return flash; return 0;
err_read_id: err_read_id:
spi_release_bus(spi); spi_release_bus(spi);
err_claim_bus: return ret;
spi_free_slave(spi);
return NULL;
} }
struct spi_flash *spi_flash_probe(unsigned int bus, unsigned int cs, static struct spi_flash *spi_flash_probe_tail(struct spi_slave *bus)
{
struct spi_flash *flash;
/* Allocate space if needed (not used by sf-uclass */
flash = calloc(1, sizeof(*flash));
if (!flash) {
debug("SF: Failed to allocate spi_flash\n");
return NULL;
}
if (spi_flash_probe_slave(bus, flash)) {
spi_free_slave(bus);
free(flash);
return NULL;
}
return flash;
}
struct spi_flash *spi_flash_probe(unsigned int busnum, unsigned int cs,
unsigned int max_hz, unsigned int spi_mode) unsigned int max_hz, unsigned int spi_mode)
{ {
struct spi_slave *spi; struct spi_slave *bus;
spi = spi_setup_slave(bus, cs, max_hz, spi_mode); bus = spi_setup_slave(busnum, cs, max_hz, spi_mode);
return spi_flash_probe_slave(spi); return spi_flash_probe_tail(bus);
} }
#ifdef CONFIG_OF_SPI_FLASH #ifdef CONFIG_OF_SPI_FLASH
struct spi_flash *spi_flash_probe_fdt(const void *blob, int slave_node, struct spi_flash *spi_flash_probe_fdt(const void *blob, int slave_node,
int spi_node) int spi_node)
{ {
struct spi_slave *spi; struct spi_slave *bus;
spi = spi_setup_slave_fdt(blob, slave_node, spi_node); bus = spi_setup_slave_fdt(blob, slave_node, spi_node);
return spi_flash_probe_slave(spi); return spi_flash_probe_tail(bus);
} }
#endif #endif