Commit 30539a18 authored by Dimitris Papastamos's avatar Dimitris Papastamos Committed by Mark Brown

ASoC: soc-cache: Factor-out the SPI write code

The handling of all snd_soc_x_y_spi_write() functions is similar.
Create a separate function and update all callers to use it.
Signed-off-by: default avatarDimitris Papastamos <dp@opensource.wolfsonmicro.com>
Acked-by: default avatarLiam Girdwood <lrg@ti.com>
Signed-off-by: default avatarMark Brown <broonie@opensource.wolfsonmicro.com>
parent b8cbc195
...@@ -20,6 +20,30 @@ ...@@ -20,6 +20,30 @@
#include <trace/events/asoc.h> #include <trace/events/asoc.h>
#if defined(CONFIG_SPI_MASTER)
static int do_spi_write(void *control_data, const void *msg,
int len)
{
struct spi_device *spi = control_data;
struct spi_transfer t;
struct spi_message m;
if (len <= 0)
return 0;
spi_message_init(&m);
memset(&t, 0, sizeof t);
t.tx_buf = msg;
t.len = len;
spi_message_add_tail(&t, &m);
spi_sync(spi, &m);
return len;
}
#endif
static int do_hw_write(struct snd_soc_codec *codec, unsigned int reg, static int do_hw_write(struct snd_soc_codec *codec, unsigned int reg,
unsigned int value, const void *data, int len) unsigned int value, const void *data, int len)
{ {
...@@ -89,27 +113,12 @@ static int snd_soc_4_12_write(struct snd_soc_codec *codec, unsigned int reg, ...@@ -89,27 +113,12 @@ static int snd_soc_4_12_write(struct snd_soc_codec *codec, unsigned int reg,
static int snd_soc_4_12_spi_write(void *control_data, const char *data, static int snd_soc_4_12_spi_write(void *control_data, const char *data,
int len) int len)
{ {
struct spi_device *spi = control_data;
struct spi_transfer t;
struct spi_message m;
u8 msg[2]; u8 msg[2];
if (len <= 0)
return 0;
msg[0] = data[1]; msg[0] = data[1];
msg[1] = data[0]; msg[1] = data[0];
spi_message_init(&m); return do_spi_write(control_data, msg, len);
memset(&t, 0, sizeof t);
t.tx_buf = &msg[0];
t.len = len;
spi_message_add_tail(&t, &m);
spi_sync(spi, &m);
return len;
} }
#else #else
#define snd_soc_4_12_spi_write NULL #define snd_soc_4_12_spi_write NULL
...@@ -136,27 +145,12 @@ static int snd_soc_7_9_write(struct snd_soc_codec *codec, unsigned int reg, ...@@ -136,27 +145,12 @@ static int snd_soc_7_9_write(struct snd_soc_codec *codec, unsigned int reg,
static int snd_soc_7_9_spi_write(void *control_data, const char *data, static int snd_soc_7_9_spi_write(void *control_data, const char *data,
int len) int len)
{ {
struct spi_device *spi = control_data;
struct spi_transfer t;
struct spi_message m;
u8 msg[2]; u8 msg[2];
if (len <= 0)
return 0;
msg[0] = data[0]; msg[0] = data[0];
msg[1] = data[1]; msg[1] = data[1];
spi_message_init(&m); return do_spi_write(control_data, msg, len);
memset(&t, 0, sizeof t);
t.tx_buf = &msg[0];
t.len = len;
spi_message_add_tail(&t, &m);
spi_sync(spi, &m);
return len;
} }
#else #else
#define snd_soc_7_9_spi_write NULL #define snd_soc_7_9_spi_write NULL
...@@ -184,27 +178,12 @@ static unsigned int snd_soc_8_8_read(struct snd_soc_codec *codec, ...@@ -184,27 +178,12 @@ static unsigned int snd_soc_8_8_read(struct snd_soc_codec *codec,
static int snd_soc_8_8_spi_write(void *control_data, const char *data, static int snd_soc_8_8_spi_write(void *control_data, const char *data,
int len) int len)
{ {
struct spi_device *spi = control_data;
struct spi_transfer t;
struct spi_message m;
u8 msg[2]; u8 msg[2];
if (len <= 0)
return 0;
msg[0] = data[0]; msg[0] = data[0];
msg[1] = data[1]; msg[1] = data[1];
spi_message_init(&m); return do_spi_write(control_data, msg, len);
memset(&t, 0, sizeof t);
t.tx_buf = &msg[0];
t.len = len;
spi_message_add_tail(&t, &m);
spi_sync(spi, &m);
return len;
} }
#else #else
#define snd_soc_8_8_spi_write NULL #define snd_soc_8_8_spi_write NULL
...@@ -232,28 +211,13 @@ static unsigned int snd_soc_8_16_read(struct snd_soc_codec *codec, ...@@ -232,28 +211,13 @@ static unsigned int snd_soc_8_16_read(struct snd_soc_codec *codec,
static int snd_soc_8_16_spi_write(void *control_data, const char *data, static int snd_soc_8_16_spi_write(void *control_data, const char *data,
int len) int len)
{ {
struct spi_device *spi = control_data;
struct spi_transfer t;
struct spi_message m;
u8 msg[3]; u8 msg[3];
if (len <= 0)
return 0;
msg[0] = data[0]; msg[0] = data[0];
msg[1] = data[1]; msg[1] = data[1];
msg[2] = data[2]; msg[2] = data[2];
spi_message_init(&m); return do_spi_write(control_data, msg, len);
memset(&t, 0, sizeof t);
t.tx_buf = &msg[0];
t.len = len;
spi_message_add_tail(&t, &m);
spi_sync(spi, &m);
return len;
} }
#else #else
#define snd_soc_8_16_spi_write NULL #define snd_soc_8_16_spi_write NULL
...@@ -365,28 +329,13 @@ static int snd_soc_16_8_write(struct snd_soc_codec *codec, unsigned int reg, ...@@ -365,28 +329,13 @@ static int snd_soc_16_8_write(struct snd_soc_codec *codec, unsigned int reg,
static int snd_soc_16_8_spi_write(void *control_data, const char *data, static int snd_soc_16_8_spi_write(void *control_data, const char *data,
int len) int len)
{ {
struct spi_device *spi = control_data;
struct spi_transfer t;
struct spi_message m;
u8 msg[3]; u8 msg[3];
if (len <= 0)
return 0;
msg[0] = data[0]; msg[0] = data[0];
msg[1] = data[1]; msg[1] = data[1];
msg[2] = data[2]; msg[2] = data[2];
spi_message_init(&m); return do_spi_write(control_data, msg, len);
memset(&t, 0, sizeof t);
t.tx_buf = &msg[0];
t.len = len;
spi_message_add_tail(&t, &m);
spi_sync(spi, &m);
return len;
} }
#else #else
#define snd_soc_16_8_spi_write NULL #define snd_soc_16_8_spi_write NULL
...@@ -432,29 +381,14 @@ static int snd_soc_16_16_write(struct snd_soc_codec *codec, unsigned int reg, ...@@ -432,29 +381,14 @@ static int snd_soc_16_16_write(struct snd_soc_codec *codec, unsigned int reg,
static int snd_soc_16_16_spi_write(void *control_data, const char *data, static int snd_soc_16_16_spi_write(void *control_data, const char *data,
int len) int len)
{ {
struct spi_device *spi = control_data;
struct spi_transfer t;
struct spi_message m;
u8 msg[4]; u8 msg[4];
if (len <= 0)
return 0;
msg[0] = data[0]; msg[0] = data[0];
msg[1] = data[1]; msg[1] = data[1];
msg[2] = data[2]; msg[2] = data[2];
msg[3] = data[3]; msg[3] = data[3];
spi_message_init(&m); return do_spi_write(control_data, msg, len);
memset(&t, 0, sizeof t);
t.tx_buf = &msg[0];
t.len = len;
spi_message_add_tail(&t, &m);
spi_sync(spi, &m);
return len;
} }
#else #else
#define snd_soc_16_16_spi_write NULL #define snd_soc_16_16_spi_write NULL
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment