|
@@ -14,32 +14,10 @@
|
|
|
|
|
|
#include "spi_flash_internal.h"
|
|
|
|
|
|
-int spi_flash_cmd(struct spi_slave *spi, u8 cmd, void *response, size_t len)
|
|
|
-{
|
|
|
- unsigned long flags = SPI_XFER_BEGIN;
|
|
|
- int ret;
|
|
|
-
|
|
|
- if (len == 0)
|
|
|
- flags |= SPI_XFER_END;
|
|
|
-
|
|
|
- ret = spi_xfer(spi, 8, &cmd, NULL, flags);
|
|
|
- if (ret) {
|
|
|
- debug("SF: Failed to send command %02x: %d\n", cmd, ret);
|
|
|
- return ret;
|
|
|
- }
|
|
|
-
|
|
|
- if (len) {
|
|
|
- ret = spi_xfer(spi, len * 8, NULL, response, SPI_XFER_END);
|
|
|
- if (ret)
|
|
|
- debug("SF: Failed to read response (%zu bytes): %d\n",
|
|
|
- len, ret);
|
|
|
- }
|
|
|
-
|
|
|
- return ret;
|
|
|
-}
|
|
|
-
|
|
|
-int spi_flash_cmd_read(struct spi_slave *spi, const u8 *cmd,
|
|
|
- size_t cmd_len, void *data, size_t data_len)
|
|
|
+static int spi_flash_read_write(struct spi_slave *spi,
|
|
|
+ const u8 *cmd, size_t cmd_len,
|
|
|
+ const u8 *data_out, u8 *data_in,
|
|
|
+ size_t data_len)
|
|
|
{
|
|
|
unsigned long flags = SPI_XFER_BEGIN;
|
|
|
int ret;
|
|
@@ -49,41 +27,34 @@ int spi_flash_cmd_read(struct spi_slave *spi, const u8 *cmd,
|
|
|
|
|
|
ret = spi_xfer(spi, cmd_len * 8, cmd, NULL, flags);
|
|
|
if (ret) {
|
|
|
- debug("SF: Failed to send read command (%zu bytes): %d\n",
|
|
|
+ debug("SF: Failed to send command (%zu bytes): %d\n",
|
|
|
cmd_len, ret);
|
|
|
} else if (data_len != 0) {
|
|
|
- ret = spi_xfer(spi, data_len * 8, NULL, data, SPI_XFER_END);
|
|
|
+ ret = spi_xfer(spi, data_len * 8, data_out, data_in, SPI_XFER_END);
|
|
|
if (ret)
|
|
|
- debug("SF: Failed to read %zu bytes of data: %d\n",
|
|
|
+ debug("SF: Failed to transfer %zu bytes of data: %d\n",
|
|
|
data_len, ret);
|
|
|
}
|
|
|
|
|
|
return ret;
|
|
|
}
|
|
|
|
|
|
-int spi_flash_cmd_write(struct spi_slave *spi, const u8 *cmd, size_t cmd_len,
|
|
|
- const void *data, size_t data_len)
|
|
|
+int spi_flash_cmd(struct spi_slave *spi, u8 cmd, void *response, size_t len)
|
|
|
{
|
|
|
- unsigned long flags = SPI_XFER_BEGIN;
|
|
|
- int ret;
|
|
|
-
|
|
|
- if (data_len == 0)
|
|
|
- flags |= SPI_XFER_END;
|
|
|
-
|
|
|
- ret = spi_xfer(spi, cmd_len * 8, cmd, NULL, flags);
|
|
|
- if (ret) {
|
|
|
- debug("SF: Failed to send read command (%zu bytes): %d\n",
|
|
|
- cmd_len, ret);
|
|
|
- } else if (data_len != 0) {
|
|
|
- ret = spi_xfer(spi, data_len * 8, data, NULL, SPI_XFER_END);
|
|
|
- if (ret)
|
|
|
- debug("SF: Failed to read %zu bytes of data: %d\n",
|
|
|
- data_len, ret);
|
|
|
- }
|
|
|
+ return spi_flash_cmd_read(spi, &cmd, 1, response, len);
|
|
|
+}
|
|
|
|
|
|
- return ret;
|
|
|
+int spi_flash_cmd_read(struct spi_slave *spi, const u8 *cmd,
|
|
|
+ size_t cmd_len, void *data, size_t data_len)
|
|
|
+{
|
|
|
+ return spi_flash_read_write(spi, cmd, cmd_len, NULL, data, data_len);
|
|
|
}
|
|
|
|
|
|
+int spi_flash_cmd_write(struct spi_slave *spi, const u8 *cmd, size_t cmd_len,
|
|
|
+ const void *data, size_t data_len)
|
|
|
+{
|
|
|
+ return spi_flash_read_write(spi, cmd, cmd_len, data, NULL, data_len);
|
|
|
+}
|
|
|
|
|
|
int spi_flash_read_common(struct spi_flash *flash, const u8 *cmd,
|
|
|
size_t cmd_len, void *data, size_t data_len)
|