hollalinux
/
linux-sg2042
mirror of https://github.com/sophgo/linux-riscv.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

ASoC: max9877: Convert to use regmap API 

Signed-off-by: Mark Brown <broonie@linaro.org>
This commit is contained in:
Mark Brown 2013-08-13 13:10:19 +01:00
parent d4e4ab86bc
commit 997288e382
1 changed files with 114 additions and 65 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

179
sound/soc/codecs/max9877.c
View File

@ -14,27 +14,21 @@
#include <linux/module.h>
#include <linux/init.h>
#include <linux/i2c.h>
#include <linux/regmap.h>
#include <sound/soc.h>
#include <sound/tlv.h>
#include "max9877.h"
static struct i2c_client *i2c;
static struct regmap *regmap;
static u8 max9877_regs[5] = { 0x40, 0x00, 0x00, 0x00, 0x49 };
static void max9877_write_regs(void)
{
unsigned int i;
u8 data[6];
data[0] = MAX9877_INPUT_MODE;
for (i = 0; i < ARRAY_SIZE(max9877_regs); i++)
data[i + 1] = max9877_regs[i];
if (i2c_master_send(i2c, data, 6) != 6)
dev_err(&i2c->dev, "i2c write failed\n");
}
static struct reg_default max9877_regs[] = {
{ 0, 0x40 },
{ 1, 0x00 },
{ 2, 0x00 },
{ 3, 0x00 },
{ 4, 0x49 },
};
static int max9877_get_reg(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
@ -45,8 +39,14 @@ static int max9877_get_reg(struct snd_kcontrol *kcontrol,
unsigned int shift = mc->shift;
unsigned int mask = mc->max;
unsigned int invert = mc->invert;
unsigned int val;
int ret;
ucontrol->value.integer.value[0] = (max9877_regs[reg] >> shift) & mask;
ret = regmap_read(regmap, reg, &val);
if (ret != 0)
return ret;
ucontrol->value.integer.value[0] = (val >> shift) & mask;
if (invert)
ucontrol->value.integer.value[0] =
@ -65,18 +65,21 @@ static int max9877_set_reg(struct snd_kcontrol *kcontrol,
unsigned int mask = mc->max;
unsigned int invert = mc->invert;
unsigned int val = (ucontrol->value.integer.value[0] & mask);
bool change;
int ret;
if (invert)
val = mask - val;
if (((max9877_regs[reg] >> shift) & mask) == val)
ret = regmap_update_bits_check(regmap, reg, mask << shift,
val << shift, &change);
if (ret != 0)
return ret;
if (change)
return 1;
else
return 0;
max9877_regs[reg] &= ~(mask << shift);
max9877_regs[reg] |= val << shift;
max9877_write_regs();
return 1;
}
static int max9877_get_2reg(struct snd_kcontrol *kcontrol,
@ -88,9 +91,18 @@ static int max9877_get_2reg(struct snd_kcontrol *kcontrol,
unsigned int reg2 = mc->rreg;
unsigned int shift = mc->shift;
unsigned int mask = mc->max;
unsigned int val;
int ret;
ucontrol->value.integer.value[0] = (max9877_regs[reg] >> shift) & mask;
ucontrol->value.integer.value[1] = (max9877_regs[reg2] >> shift) & mask;
ret = regmap_read(regmap, reg, &val);
if (ret != 0)
return ret;
ucontrol->value.integer.value[0] = (val >> shift) & mask;
ret = regmap_read(regmap, reg2, &val);
if (ret != 0)
return ret;
ucontrol->value.integer.value[1] = (val >> shift) & mask;
return 0;
}
@ -106,77 +118,99 @@ static int max9877_set_2reg(struct snd_kcontrol *kcontrol,
unsigned int mask = mc->max;
unsigned int val = (ucontrol->value.integer.value[0] & mask);
unsigned int val2 = (ucontrol->value.integer.value[1] & mask);
unsigned int change = 0;
bool change1, change2;
int ret;
if (((max9877_regs[reg] >> shift) & mask) != val)
change = 1;
ret = regmap_update_bits_check(regmap, reg, mask << shift,
val << shift, &change1);
if (ret != 0)
return ret;
if (((max9877_regs[reg2] >> shift) & mask) != val2)
change = 1;
ret = regmap_update_bits_check(regmap, reg2, mask << shift,
val2 << shift, &change2);
if (ret != 0)
return ret;
if (change) {
max9877_regs[reg] &= ~(mask << shift);
max9877_regs[reg] |= val << shift;
max9877_regs[reg2] &= ~(mask << shift);
max9877_regs[reg2] |= val2 << shift;
max9877_write_regs();
}
return change;
if (change1 || change2)
return 1;
else
return 0;
}
static int max9877_get_out_mode(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
u8 value = max9877_regs[MAX9877_OUTPUT_MODE] & MAX9877_OUTMODE_MASK;
unsigned int val;
int ret;
if (value)
value -= 1;
ret = regmap_read(regmap, MAX9877_OUTPUT_MODE, &val);
if (ret != 0)
return ret;
val &= MAX9877_OUTMODE_MASK;
if (val)
val--;
ucontrol->value.integer.value[0] = val;
ucontrol->value.integer.value[0] = value;
return 0;
}
static int max9877_set_out_mode(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
u8 value = ucontrol->value.integer.value[0];
unsigned int val;
bool change;
int ret;
value += 1;
val = ucontrol->value.integer.value[0] + 1;
if ((max9877_regs[MAX9877_OUTPUT_MODE] & MAX9877_OUTMODE_MASK) == value)
ret = regmap_update_bits_check(regmap, MAX9877_OUTPUT_MODE,
MAX9877_OUTMODE_MASK, val, &change);
if (ret != 0)
return ret;
if (change)
return 1;
else
return 0;
max9877_regs[MAX9877_OUTPUT_MODE] &= ~MAX9877_OUTMODE_MASK;
max9877_regs[MAX9877_OUTPUT_MODE] |= value;
max9877_write_regs();
return 1;
}
static int max9877_get_osc_mode(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
u8 value = (max9877_regs[MAX9877_OUTPUT_MODE] & MAX9877_OSC_MASK);
unsigned int val;
int ret;
value = value >> MAX9877_OSC_OFFSET;
ret = regmap_read(regmap, MAX9877_OUTPUT_MODE, &val);
if (ret != 0)
return ret;
val &= MAX9877_OSC_MASK;
val >>= MAX9877_OSC_OFFSET;
ucontrol->value.integer.value[0] = val;
ucontrol->value.integer.value[0] = value;
return 0;
}
static int max9877_set_osc_mode(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
u8 value = ucontrol->value.integer.value[0];
unsigned int val;
bool change;
int ret;
value = value << MAX9877_OSC_OFFSET;
if ((max9877_regs[MAX9877_OUTPUT_MODE] & MAX9877_OSC_MASK) == value)
val = ucontrol->value.integer.value[0] << MAX9877_OSC_OFFSET;
ret = regmap_update_bits_check(regmap, MAX9877_OUTPUT_MODE,
MAX9877_OSC_MASK, val, &change);
if (ret != 0)
return ret;
if (change)
return 1;
else
return 0;
max9877_regs[MAX9877_OUTPUT_MODE] &= ~MAX9877_OSC_MASK;
max9877_regs[MAX9877_OUTPUT_MODE] |= value;
max9877_write_regs();
return 1;
}
static const unsigned int max9877_pgain_tlv[] = {
@ -258,19 +292,34 @@ int max9877_add_controls(struct snd_soc_codec *codec)
}
EXPORT_SYMBOL_GPL(max9877_add_controls);
static const struct regmap_config max9877_regmap = {
.reg_bits = 8,
.val_bits = 8,
.reg_defaults = max9877_regs,
.num_reg_defaults = ARRAY_SIZE(max9877_regs),
.cache_type = REGCACHE_RBTREE,
};
static int max9877_i2c_probe(struct i2c_client *client,
const struct i2c_device_id *id)
{
i2c = client;
int i;
max9877_write_regs();
regmap = devm_regmap_init_i2c(client, &max9877_regmap);
if (IS_ERR(regmap))
return PTR_ERR(regmap);
/* Ensure the device is in reset state */
for (i = 0; i < ARRAY_SIZE(max9877_regs); i++)
regmap_write(regmap, max9877_regs[i].reg, max9877_regs[i].def);
return 0;
}
static int max9877_i2c_remove(struct i2c_client *client)
{
i2c = NULL;
regmap = NULL;
return 0;
}