aosp12/external/arm-trusted-firmware/drivers/brcm/spi_sf.c

61 lines
1.3 KiB
C

/*
* Copyright (c) 2019-2020, Broadcom
*
* SPDX-License-Identifier: BSD-3-Clause
*/
#include <common/debug.h>
#include <spi.h>
#define BITS_PER_BYTE 8
#define CMD_LEN1 1
static int spi_flash_read_write(const uint8_t *cmd,
size_t cmd_len,
const uint8_t *data_out,
uint8_t *data_in,
size_t data_len)
{
unsigned long flags = SPI_XFER_BEGIN;
int ret;
if (data_len == 0)
flags |= SPI_XFER_END;
ret = spi_xfer(cmd_len * BITS_PER_BYTE, cmd, NULL, flags);
if (ret) {
ERROR("SF: Failed to send command (%zu bytes): %d\n",
cmd_len, ret);
} else if (data_len != 0) {
ret = spi_xfer(data_len * BITS_PER_BYTE, data_out,
data_in, SPI_XFER_END);
if (ret)
ERROR("SF: Failed to transfer %zu bytes of data: %d\n",
data_len, ret);
}
return ret;
}
int spi_flash_cmd_read(const uint8_t *cmd,
size_t cmd_len,
void *data,
size_t data_len)
{
return spi_flash_read_write(cmd, cmd_len, NULL, data, data_len);
}
int spi_flash_cmd(uint8_t cmd, void *response, size_t len)
{
return spi_flash_cmd_read(&cmd, CMD_LEN1, response, len);
}
int spi_flash_cmd_write(const uint8_t *cmd,
size_t cmd_len,
const void *data,
size_t data_len)
{
return spi_flash_read_write(cmd, cmd_len, data, NULL, data_len);
}