microsoft
/
WSL2-Linux-Kernel
зеркало из https://github.com/microsoft/WSL2-Linux-Kernel.git
1
0
Форкнуть 0
Код Задачи Пакеты Проекты Релизы Вики Активность

ASoC: SSM2602: convert to soc-cache 

Signed-off-by: Cliff Cai <cliff.cai@analog.com>
Signed-off-by: Mike Frysinger <vapier@gentoo.org>
Acked-by: Liam Girdwood <lrg@ti.com>
Signed-off-by: Mark Brown <broonie@opensource.wolfsonmicro.com>
This commit is contained in:
Cliff Cai 2011-03-27 17:22:57 -04:00 коммит произвёл Mark Brown
Родитель 1afa98b807
Коммит 93547e89b6
1 изменённых файлов: 42 добавлений и 94 удалений
Показать статистику Скачать Patch файл Скачать Diff файл Показать все файлы Свернуть все файлы

136
sound/soc/codecs/ssm2602.c
Просмотреть файл

@ -48,7 +48,6 @@
struct ssm2602_priv { struct ssm2602_priv {
unsigned int sysclk; unsigned int sysclk;
enum snd_soc_control_type control_type; enum snd_soc_control_type control_type;
void *control_data;
struct snd_pcm_substream *master_substream; struct snd_pcm_substream *master_substream;
struct snd_pcm_substream *slave_substream; struct snd_pcm_substream *slave_substream;
}; };
@ -65,55 +64,7 @@ static const u16 ssm2602_reg[SSM2602_CACHEREGNUM] = {
0x0000, 0x0000 0x0000, 0x0000
}; };
/* #define ssm2602_reset(c) snd_soc_write(c, SSM2602_RESET, 0)
* read ssm2602 register cache
*/
static inline unsigned int ssm2602_read_reg_cache(struct snd_soc_codec *codec,
unsigned int reg)
{
u16 *cache = codec->reg_cache;
if (reg == SSM2602_RESET)
return 0;
if (reg >= SSM2602_CACHEREGNUM)
return -1;
return cache[reg];
}
/*
* write ssm2602 register cache
*/
static inline void ssm2602_write_reg_cache(struct snd_soc_codec *codec,
u16 reg, unsigned int value)
{
u16 *cache = codec->reg_cache;
if (reg >= SSM2602_CACHEREGNUM)
return;
cache[reg] = value;
}
/*
* write to the ssm2602 register space
*/
static int ssm2602_write(struct snd_soc_codec *codec, unsigned int reg,
unsigned int value)
{
u8 data[2];
/* data is
* D15..D9 ssm2602 register offset
* D8...D0 register data
*/
data[0] = (reg << 1) | ((value >> 8) & 0x0001);
data[1] = value & 0x00ff;
ssm2602_write_reg_cache(codec, reg, value);
if (codec->hw_write(codec->control_data, data, 2) == 2)
return 0;
else
return -EIO;
}
#define ssm2602_reset(c) ssm2602_write(c, SSM2602_RESET, 0)
/*Appending several "None"s just for OSS mixer use*/ /*Appending several "None"s just for OSS mixer use*/
static const char *ssm2602_input_select[] = { static const char *ssm2602_input_select[] = {
@ -278,12 +229,11 @@ static int ssm2602_hw_params(struct snd_pcm_substream *substream,
struct snd_soc_pcm_runtime *rtd = substream->private_data; struct snd_soc_pcm_runtime *rtd = substream->private_data;
struct snd_soc_codec *codec = rtd->codec; struct snd_soc_codec *codec = rtd->codec;
struct ssm2602_priv *ssm2602 = snd_soc_codec_get_drvdata(codec); struct ssm2602_priv *ssm2602 = snd_soc_codec_get_drvdata(codec);
struct i2c_client *i2c = codec->control_data; u16 iface = snd_soc_read(codec, SSM2602_IFACE) & 0xfff3;
u16 iface = ssm2602_read_reg_cache(codec, SSM2602_IFACE) & 0xfff3;
int i = get_coeff(ssm2602->sysclk, params_rate(params)); int i = get_coeff(ssm2602->sysclk, params_rate(params));
if (substream == ssm2602->slave_substream) { if (substream == ssm2602->slave_substream) {
dev_dbg(&i2c->dev, "Ignoring hw_params for slave substream\n"); dev_dbg(codec->dev, "Ignoring hw_params for slave substream\n");
return 0; return 0;
} }
@ -294,8 +244,8 @@ static int ssm2602_hw_params(struct snd_pcm_substream *substream,
srate = (coeff_div[i].sr << 2) | srate = (coeff_div[i].sr << 2) |
(coeff_div[i].bosr << 1) | coeff_div[i].usb; (coeff_div[i].bosr << 1) | coeff_div[i].usb;
ssm2602_write(codec, SSM2602_ACTIVE, 0); snd_soc_write(codec, SSM2602_ACTIVE, 0);
ssm2602_write(codec, SSM2602_SRATE, srate); snd_soc_write(codec, SSM2602_SRATE, srate);
/* bit size */ /* bit size */
switch (params_format(params)) { switch (params_format(params)) {
@ -311,8 +261,8 @@ static int ssm2602_hw_params(struct snd_pcm_substream *substream,
iface |= 0x000c; iface |= 0x000c;
break; break;
} }
ssm2602_write(codec, SSM2602_IFACE, iface); snd_soc_write(codec, SSM2602_IFACE, iface);
ssm2602_write(codec, SSM2602_ACTIVE, ACTIVE_ACTIVATE_CODEC); snd_soc_write(codec, SSM2602_ACTIVE, ACTIVE_ACTIVATE_CODEC);
return 0; return 0;
} }
@ -360,7 +310,7 @@ static int ssm2602_pcm_prepare(struct snd_pcm_substream *substream,
struct snd_soc_pcm_runtime *rtd = substream->private_data; struct snd_soc_pcm_runtime *rtd = substream->private_data;
struct snd_soc_codec *codec = rtd->codec; struct snd_soc_codec *codec = rtd->codec;
/* set active */ /* set active */
ssm2602_write(codec, SSM2602_ACTIVE, ACTIVE_ACTIVATE_CODEC); snd_soc_write(codec, SSM2602_ACTIVE, ACTIVE_ACTIVATE_CODEC);
return 0; return 0;
} }
@ -374,7 +324,7 @@ static void ssm2602_shutdown(struct snd_pcm_substream *substream,
/* deactivate */ /* deactivate */
if (!codec->active) if (!codec->active)
ssm2602_write(codec, SSM2602_ACTIVE, 0); snd_soc_write(codec, SSM2602_ACTIVE, 0);
if (ssm2602->master_substream == substream) if (ssm2602->master_substream == substream)
ssm2602->master_substream = ssm2602->slave_substream; ssm2602->master_substream = ssm2602->slave_substream;
@ -385,12 +335,12 @@ static void ssm2602_shutdown(struct snd_pcm_substream *substream,
static int ssm2602_mute(struct snd_soc_dai *dai, int mute) static int ssm2602_mute(struct snd_soc_dai *dai, int mute)
{ {
struct snd_soc_codec *codec = dai->codec; struct snd_soc_codec *codec = dai->codec;
u16 mute_reg = ssm2602_read_reg_cache(codec, SSM2602_APDIGI) & ~APDIGI_ENABLE_DAC_MUTE; u16 mute_reg = snd_soc_read(codec, SSM2602_APDIGI) & ~APDIGI_ENABLE_DAC_MUTE;
if (mute) if (mute)
ssm2602_write(codec, SSM2602_APDIGI, snd_soc_write(codec, SSM2602_APDIGI,
mute_reg | APDIGI_ENABLE_DAC_MUTE); mute_reg | APDIGI_ENABLE_DAC_MUTE);
else else
ssm2602_write(codec, SSM2602_APDIGI, mute_reg); snd_soc_write(codec, SSM2602_APDIGI, mute_reg);
return 0; return 0;
} }
@ -466,30 +416,30 @@ static int ssm2602_set_dai_fmt(struct snd_soc_dai *codec_dai,
} }
/* set iface */ /* set iface */
ssm2602_write(codec, SSM2602_IFACE, iface); snd_soc_write(codec, SSM2602_IFACE, iface);
return 0; return 0;
} }
static int ssm2602_set_bias_level(struct snd_soc_codec *codec, static int ssm2602_set_bias_level(struct snd_soc_codec *codec,
enum snd_soc_bias_level level) enum snd_soc_bias_level level)
{ {
u16 reg = ssm2602_read_reg_cache(codec, SSM2602_PWR) & 0xff7f; u16 reg = snd_soc_read(codec, SSM2602_PWR) & 0xff7f;
switch (level) { switch (level) {
case SND_SOC_BIAS_ON: case SND_SOC_BIAS_ON:
/* vref/mid, osc on, dac unmute */ /* vref/mid, osc on, dac unmute */
ssm2602_write(codec, SSM2602_PWR, reg); snd_soc_write(codec, SSM2602_PWR, reg);
break; break;
case SND_SOC_BIAS_PREPARE: case SND_SOC_BIAS_PREPARE:
break; break;
case SND_SOC_BIAS_STANDBY: case SND_SOC_BIAS_STANDBY:
/* everything off except vref/vmid, */ /* everything off except vref/vmid, */
ssm2602_write(codec, SSM2602_PWR, reg | PWR_CLK_OUT_PDN); snd_soc_write(codec, SSM2602_PWR, reg | PWR_CLK_OUT_PDN);
break; break;
case SND_SOC_BIAS_OFF: case SND_SOC_BIAS_OFF:
/* everything off, dac mute, inactive */ /* everything off, dac mute, inactive */
ssm2602_write(codec, SSM2602_ACTIVE, 0); snd_soc_write(codec, SSM2602_ACTIVE, 0);
ssm2602_write(codec, SSM2602_PWR, 0xffff); snd_soc_write(codec, SSM2602_PWR, 0xffff);
break; break;
} }
@ -539,17 +489,10 @@ static int ssm2602_suspend(struct snd_soc_codec *codec, pm_message_t state)
static int ssm2602_resume(struct snd_soc_codec *codec) static int ssm2602_resume(struct snd_soc_codec *codec)
{ {
int i; snd_soc_cache_sync(codec);
u8 data[2];
u16 *cache = codec->reg_cache;
/* Sync reg_cache with the hardware */
for (i = 0; i < ARRAY_SIZE(ssm2602_reg); i++) {
data[0] = (i << 1) | ((cache[i] >> 8) & 0x0001);
data[1] = cache[i] & 0x00ff;
codec->hw_write(codec->control_data, data, 2);
}
ssm2602_set_bias_level(codec, SND_SOC_BIAS_STANDBY); ssm2602_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
return 0; return 0;
} }
@ -560,31 +503,39 @@ static int ssm2602_probe(struct snd_soc_codec *codec)
pr_info("ssm2602 Audio Codec %s", SSM2602_VERSION); pr_info("ssm2602 Audio Codec %s", SSM2602_VERSION);
codec->control_data = ssm2602->control_data; ret = snd_soc_codec_set_cache_io(codec, 7, 9, ssm2602->control_type);
if (ret < 0) {
dev_err(codec->dev, "Failed to set cache I/O: %d\n", ret);
return ret;
}
ssm2602_reset(codec); ret = ssm2602_reset(codec);
if (ret < 0) {
dev_err(codec->dev, "Failed to issue reset: %d\n", ret);
return ret;
}
/*power on device*/ /*power on device*/
ssm2602_write(codec, SSM2602_ACTIVE, 0); snd_soc_write(codec, SSM2602_ACTIVE, 0);
/* set the update bits */ /* set the update bits */
reg = ssm2602_read_reg_cache(codec, SSM2602_LINVOL); reg = snd_soc_read(codec, SSM2602_LINVOL);
ssm2602_write(codec, SSM2602_LINVOL, reg | LINVOL_LRIN_BOTH); snd_soc_write(codec, SSM2602_LINVOL, reg | LINVOL_LRIN_BOTH);
reg = ssm2602_read_reg_cache(codec, SSM2602_RINVOL); reg = snd_soc_read(codec, SSM2602_RINVOL);
ssm2602_write(codec, SSM2602_RINVOL, reg | RINVOL_RLIN_BOTH); snd_soc_write(codec, SSM2602_RINVOL, reg | RINVOL_RLIN_BOTH);
reg = ssm2602_read_reg_cache(codec, SSM2602_LOUT1V); reg = snd_soc_read(codec, SSM2602_LOUT1V);
ssm2602_write(codec, SSM2602_LOUT1V, reg | LOUT1V_LRHP_BOTH); snd_soc_write(codec, SSM2602_LOUT1V, reg | LOUT1V_LRHP_BOTH);
reg = ssm2602_read_reg_cache(codec, SSM2602_ROUT1V); reg = snd_soc_read(codec, SSM2602_ROUT1V);
ssm2602_write(codec, SSM2602_ROUT1V, reg | ROUT1V_RLHP_BOTH); snd_soc_write(codec, SSM2602_ROUT1V, reg | ROUT1V_RLHP_BOTH);
/*select Line in as default input*/ /*select Line in as default input*/
ssm2602_write(codec, SSM2602_APANA, APANA_SELECT_DAC | snd_soc_write(codec, SSM2602_APANA, APANA_SELECT_DAC |
APANA_ENABLE_MIC_BOOST); APANA_ENABLE_MIC_BOOST);
ssm2602_write(codec, SSM2602_PWR, 0); snd_soc_write(codec, SSM2602_PWR, 0);
snd_soc_add_controls(codec, ssm2602_snd_controls, snd_soc_add_controls(codec, ssm2602_snd_controls,
ARRAY_SIZE(ssm2602_snd_controls)); ARRAY_SIZE(ssm2602_snd_controls));
ssm2602_add_widgets(codec); ssm2602_add_widgets(codec);
return ret; return 0;
} }
/* remove everything here */ /* remove everything here */
@ -599,8 +550,6 @@ static struct snd_soc_codec_driver soc_codec_dev_ssm2602 = {
.remove = ssm2602_remove, .remove = ssm2602_remove,
.suspend = ssm2602_suspend, .suspend = ssm2602_suspend,
.resume = ssm2602_resume, .resume = ssm2602_resume,
.read = ssm2602_read_reg_cache,
.write = ssm2602_write,
.set_bias_level = ssm2602_set_bias_level, .set_bias_level = ssm2602_set_bias_level,
.reg_cache_size = sizeof(ssm2602_reg), .reg_cache_size = sizeof(ssm2602_reg),
.reg_word_size = sizeof(u16), .reg_word_size = sizeof(u16),
@ -625,7 +574,6 @@ static int ssm2602_i2c_probe(struct i2c_client *i2c,
return -ENOMEM; return -ENOMEM;
i2c_set_clientdata(i2c, ssm2602); i2c_set_clientdata(i2c, ssm2602);
ssm2602->control_data = i2c;
ssm2602->control_type = SND_SOC_I2C; ssm2602->control_type = SND_SOC_I2C;
ret = snd_soc_register_codec(&i2c->dev, ret = snd_soc_register_codec(&i2c->dev,