61 lines
1.3 KiB
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);
|
||
|
|
}
|