|
@@ -37,74 +37,53 @@ struct uda134x_priv {
|
|
|
|
|
|
struct snd_pcm_substream *master_substream;
|
|
struct snd_pcm_substream *master_substream;
|
|
struct snd_pcm_substream *slave_substream;
|
|
struct snd_pcm_substream *slave_substream;
|
|
-};
|
|
|
|
|
|
|
|
-/* In-data addresses are hard-coded into the reg-cache values */
|
|
|
|
-static const char uda134x_reg[UDA134X_REGS_NUM] = {
|
|
|
|
- /* Extended address registers */
|
|
|
|
- 0x04, 0x04, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00,
|
|
|
|
- /* Status, data regs */
|
|
|
|
- 0x00, 0x83, 0x00, 0x40, 0x80, 0xC0, 0x00,
|
|
|
|
|
|
+ struct regmap *regmap;
|
|
|
|
+ struct uda134x_platform_data *pd;
|
|
};
|
|
};
|
|
|
|
|
|
-/*
|
|
|
|
- * The codec has no support for reading its registers except for peak level...
|
|
|
|
- */
|
|
|
|
-static inline unsigned int uda134x_read_reg_cache(struct snd_soc_codec *codec,
|
|
|
|
- unsigned int reg)
|
|
|
|
-{
|
|
|
|
- u8 *cache = codec->reg_cache;
|
|
|
|
-
|
|
|
|
- if (reg >= UDA134X_REGS_NUM)
|
|
|
|
- return -1;
|
|
|
|
- return cache[reg];
|
|
|
|
-}
|
|
|
|
-
|
|
|
|
-/*
|
|
|
|
- * Write the register cache
|
|
|
|
- */
|
|
|
|
-static inline void uda134x_write_reg_cache(struct snd_soc_codec *codec,
|
|
|
|
- u8 reg, unsigned int value)
|
|
|
|
-{
|
|
|
|
- u8 *cache = codec->reg_cache;
|
|
|
|
-
|
|
|
|
- if (reg >= UDA134X_REGS_NUM)
|
|
|
|
- return;
|
|
|
|
- cache[reg] = value;
|
|
|
|
-}
|
|
|
|
|
|
+static const struct reg_default uda134x_reg_defaults[] = {
|
|
|
|
+ { UDA134X_EA000, 0x04 },
|
|
|
|
+ { UDA134X_EA001, 0x04 },
|
|
|
|
+ { UDA134X_EA010, 0x04 },
|
|
|
|
+ { UDA134X_EA011, 0x00 },
|
|
|
|
+ { UDA134X_EA100, 0x00 },
|
|
|
|
+ { UDA134X_EA101, 0x00 },
|
|
|
|
+ { UDA134X_EA110, 0x00 },
|
|
|
|
+ { UDA134X_EA111, 0x00 },
|
|
|
|
+ { UDA134X_STATUS0, 0x00 },
|
|
|
|
+ { UDA134X_STATUS1, 0x03 },
|
|
|
|
+ { UDA134X_DATA000, 0x00 },
|
|
|
|
+ { UDA134X_DATA001, 0x00 },
|
|
|
|
+ { UDA134X_DATA010, 0x00 },
|
|
|
|
+ { UDA134X_DATA011, 0x00 },
|
|
|
|
+ { UDA134X_DATA1, 0x00 },
|
|
|
|
+};
|
|
|
|
|
|
/*
|
|
/*
|
|
* Write to the uda134x registers
|
|
* Write to the uda134x registers
|
|
*
|
|
*
|
|
*/
|
|
*/
|
|
-static int uda134x_write(struct snd_soc_codec *codec, unsigned int reg,
|
|
|
|
|
|
+static int uda134x_regmap_write(void *context, unsigned int reg,
|
|
unsigned int value)
|
|
unsigned int value)
|
|
{
|
|
{
|
|
|
|
+ struct uda134x_platform_data *pd = context;
|
|
int ret;
|
|
int ret;
|
|
u8 addr;
|
|
u8 addr;
|
|
u8 data = value;
|
|
u8 data = value;
|
|
- struct uda134x_platform_data *pd = codec->control_data;
|
|
|
|
-
|
|
|
|
- pr_debug("%s reg: %02X, value:%02X\n", __func__, reg, value);
|
|
|
|
-
|
|
|
|
- if (reg >= UDA134X_REGS_NUM) {
|
|
|
|
- printk(KERN_ERR "%s unknown register: reg: %u",
|
|
|
|
- __func__, reg);
|
|
|
|
- return -EINVAL;
|
|
|
|
- }
|
|
|
|
-
|
|
|
|
- uda134x_write_reg_cache(codec, reg, value);
|
|
|
|
|
|
|
|
switch (reg) {
|
|
switch (reg) {
|
|
case UDA134X_STATUS0:
|
|
case UDA134X_STATUS0:
|
|
case UDA134X_STATUS1:
|
|
case UDA134X_STATUS1:
|
|
addr = UDA134X_STATUS_ADDR;
|
|
addr = UDA134X_STATUS_ADDR;
|
|
|
|
+ data |= (reg - UDA134X_STATUS0) << 7;
|
|
break;
|
|
break;
|
|
case UDA134X_DATA000:
|
|
case UDA134X_DATA000:
|
|
case UDA134X_DATA001:
|
|
case UDA134X_DATA001:
|
|
case UDA134X_DATA010:
|
|
case UDA134X_DATA010:
|
|
case UDA134X_DATA011:
|
|
case UDA134X_DATA011:
|
|
addr = UDA134X_DATA0_ADDR;
|
|
addr = UDA134X_DATA0_ADDR;
|
|
|
|
+ data |= (reg - UDA134X_DATA000) << 6;
|
|
break;
|
|
break;
|
|
case UDA134X_DATA1:
|
|
case UDA134X_DATA1:
|
|
addr = UDA134X_DATA1_ADDR;
|
|
addr = UDA134X_DATA1_ADDR;
|
|
@@ -133,27 +112,28 @@ static int uda134x_write(struct snd_soc_codec *codec, unsigned int reg,
|
|
|
|
|
|
static inline void uda134x_reset(struct snd_soc_codec *codec)
|
|
static inline void uda134x_reset(struct snd_soc_codec *codec)
|
|
{
|
|
{
|
|
- u8 reset_reg = uda134x_read_reg_cache(codec, UDA134X_STATUS0);
|
|
|
|
- uda134x_write(codec, UDA134X_STATUS0, reset_reg | (1<<6));
|
|
|
|
|
|
+ struct uda134x_priv *uda134x = snd_soc_codec_get_drvdata(codec);
|
|
|
|
+ unsigned int mask = 1<<6;
|
|
|
|
+
|
|
|
|
+ regmap_update_bits(uda134x->regmap, UDA134X_STATUS0, mask, mask);
|
|
msleep(1);
|
|
msleep(1);
|
|
- uda134x_write(codec, UDA134X_STATUS0, reset_reg & ~(1<<6));
|
|
|
|
|
|
+ regmap_update_bits(uda134x->regmap, UDA134X_STATUS0, mask, 0);
|
|
}
|
|
}
|
|
|
|
|
|
static int uda134x_mute(struct snd_soc_dai *dai, int mute)
|
|
static int uda134x_mute(struct snd_soc_dai *dai, int mute)
|
|
{
|
|
{
|
|
- struct snd_soc_codec *codec = dai->codec;
|
|
|
|
- u8 mute_reg = uda134x_read_reg_cache(codec, UDA134X_DATA010);
|
|
|
|
|
|
+ struct uda134x_priv *uda134x = snd_soc_codec_get_drvdata(dai->codec);
|
|
|
|
+ unsigned int mask = 1<<2;
|
|
|
|
+ unsigned int val;
|
|
|
|
|
|
pr_debug("%s mute: %d\n", __func__, mute);
|
|
pr_debug("%s mute: %d\n", __func__, mute);
|
|
|
|
|
|
if (mute)
|
|
if (mute)
|
|
- mute_reg |= (1<<2);
|
|
|
|
|
|
+ val = mask;
|
|
else
|
|
else
|
|
- mute_reg &= ~(1<<2);
|
|
|
|
|
|
+ val = 0;
|
|
|
|
|
|
- uda134x_write(codec, UDA134X_DATA010, mute_reg);
|
|
|
|
-
|
|
|
|
- return 0;
|
|
|
|
|
|
+ return regmap_update_bits(uda134x->regmap, UDA134X_DATA010, mask, val);
|
|
}
|
|
}
|
|
|
|
|
|
static int uda134x_startup(struct snd_pcm_substream *substream,
|
|
static int uda134x_startup(struct snd_pcm_substream *substream,
|
|
@@ -205,7 +185,7 @@ static int uda134x_hw_params(struct snd_pcm_substream *substream,
|
|
{
|
|
{
|
|
struct snd_soc_codec *codec = dai->codec;
|
|
struct snd_soc_codec *codec = dai->codec;
|
|
struct uda134x_priv *uda134x = snd_soc_codec_get_drvdata(codec);
|
|
struct uda134x_priv *uda134x = snd_soc_codec_get_drvdata(codec);
|
|
- u8 hw_params;
|
|
|
|
|
|
+ unsigned int hw_params = 0;
|
|
|
|
|
|
if (substream == uda134x->slave_substream) {
|
|
if (substream == uda134x->slave_substream) {
|
|
pr_debug("%s ignoring hw_params for slave substream\n",
|
|
pr_debug("%s ignoring hw_params for slave substream\n",
|
|
@@ -213,10 +193,6 @@ static int uda134x_hw_params(struct snd_pcm_substream *substream,
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
|
|
- hw_params = uda134x_read_reg_cache(codec, UDA134X_STATUS0);
|
|
|
|
- hw_params &= STATUS0_SYSCLK_MASK;
|
|
|
|
- hw_params &= STATUS0_DAIFMT_MASK;
|
|
|
|
-
|
|
|
|
pr_debug("%s sysclk: %d, rate:%d\n", __func__,
|
|
pr_debug("%s sysclk: %d, rate:%d\n", __func__,
|
|
uda134x->sysclk, params_rate(params));
|
|
uda134x->sysclk, params_rate(params));
|
|
|
|
|
|
@@ -267,9 +243,8 @@ static int uda134x_hw_params(struct snd_pcm_substream *substream,
|
|
return -EINVAL;
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
|
|
- uda134x_write(codec, UDA134X_STATUS0, hw_params);
|
|
|
|
-
|
|
|
|
- return 0;
|
|
|
|
|
|
+ return regmap_update_bits(uda134x->regmap, UDA134X_STATUS0,
|
|
|
|
+ STATUS0_SYSCLK_MASK | STATUS0_DAIFMT_MASK, hw_params);
|
|
}
|
|
}
|
|
|
|
|
|
static int uda134x_set_dai_sysclk(struct snd_soc_dai *codec_dai,
|
|
static int uda134x_set_dai_sysclk(struct snd_soc_dai *codec_dai,
|
|
@@ -324,10 +299,8 @@ static int uda134x_set_dai_fmt(struct snd_soc_dai *codec_dai,
|
|
static int uda134x_set_bias_level(struct snd_soc_codec *codec,
|
|
static int uda134x_set_bias_level(struct snd_soc_codec *codec,
|
|
enum snd_soc_bias_level level)
|
|
enum snd_soc_bias_level level)
|
|
{
|
|
{
|
|
- struct uda134x_platform_data *pd = codec->control_data;
|
|
|
|
- int i;
|
|
|
|
- u8 *cache = codec->reg_cache;
|
|
|
|
-
|
|
|
|
|
|
+ struct uda134x_priv *uda134x = snd_soc_codec_get_drvdata(codec);
|
|
|
|
+ struct uda134x_platform_data *pd = uda134x->pd;
|
|
pr_debug("%s bias level %d\n", __func__, level);
|
|
pr_debug("%s bias level %d\n", __func__, level);
|
|
|
|
|
|
switch (level) {
|
|
switch (level) {
|
|
@@ -337,17 +310,17 @@ static int uda134x_set_bias_level(struct snd_soc_codec *codec,
|
|
/* power on */
|
|
/* power on */
|
|
if (pd->power) {
|
|
if (pd->power) {
|
|
pd->power(1);
|
|
pd->power(1);
|
|
- /* Sync reg_cache with the hardware */
|
|
|
|
- for (i = 0; i < ARRAY_SIZE(uda134x_reg); i++)
|
|
|
|
- codec->driver->write(codec, i, *cache++);
|
|
|
|
|
|
+ regcache_sync(uda134x->regmap);
|
|
}
|
|
}
|
|
break;
|
|
break;
|
|
case SND_SOC_BIAS_STANDBY:
|
|
case SND_SOC_BIAS_STANDBY:
|
|
break;
|
|
break;
|
|
case SND_SOC_BIAS_OFF:
|
|
case SND_SOC_BIAS_OFF:
|
|
/* power off */
|
|
/* power off */
|
|
- if (pd->power)
|
|
|
|
|
|
+ if (pd->power) {
|
|
pd->power(0);
|
|
pd->power(0);
|
|
|
|
+ regcache_mark_dirty(uda134x->regmap);
|
|
|
|
+ }
|
|
break;
|
|
break;
|
|
}
|
|
}
|
|
return 0;
|
|
return 0;
|
|
@@ -478,21 +451,14 @@ static struct snd_soc_dai_driver uda134x_dai = {
|
|
static int uda134x_soc_probe(struct snd_soc_codec *codec)
|
|
static int uda134x_soc_probe(struct snd_soc_codec *codec)
|
|
{
|
|
{
|
|
struct snd_soc_dapm_context *dapm = snd_soc_codec_get_dapm(codec);
|
|
struct snd_soc_dapm_context *dapm = snd_soc_codec_get_dapm(codec);
|
|
- struct uda134x_priv *uda134x;
|
|
|
|
- struct uda134x_platform_data *pd = codec->component.card->dev->platform_data;
|
|
|
|
|
|
+ struct uda134x_priv *uda134x = snd_soc_codec_get_drvdata(codec);
|
|
|
|
+ struct uda134x_platform_data *pd = uda134x->pd;
|
|
const struct snd_soc_dapm_widget *widgets;
|
|
const struct snd_soc_dapm_widget *widgets;
|
|
unsigned num_widgets;
|
|
unsigned num_widgets;
|
|
-
|
|
|
|
int ret;
|
|
int ret;
|
|
|
|
|
|
printk(KERN_INFO "UDA134X SoC Audio Codec\n");
|
|
printk(KERN_INFO "UDA134X SoC Audio Codec\n");
|
|
|
|
|
|
- if (!pd) {
|
|
|
|
- printk(KERN_ERR "UDA134X SoC codec: "
|
|
|
|
- "missing L3 bitbang function\n");
|
|
|
|
- return -ENODEV;
|
|
|
|
- }
|
|
|
|
-
|
|
|
|
switch (pd->model) {
|
|
switch (pd->model) {
|
|
case UDA134X_UDA1340:
|
|
case UDA134X_UDA1340:
|
|
case UDA134X_UDA1341:
|
|
case UDA134X_UDA1341:
|
|
@@ -506,13 +472,6 @@ static int uda134x_soc_probe(struct snd_soc_codec *codec)
|
|
return -EINVAL;
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
|
|
- uda134x = kzalloc(sizeof(struct uda134x_priv), GFP_KERNEL);
|
|
|
|
- if (uda134x == NULL)
|
|
|
|
- return -ENOMEM;
|
|
|
|
- snd_soc_codec_set_drvdata(codec, uda134x);
|
|
|
|
-
|
|
|
|
- codec->control_data = pd;
|
|
|
|
-
|
|
|
|
if (pd->power)
|
|
if (pd->power)
|
|
pd->power(1);
|
|
pd->power(1);
|
|
|
|
|
|
@@ -530,7 +489,6 @@ static int uda134x_soc_probe(struct snd_soc_codec *codec)
|
|
if (ret) {
|
|
if (ret) {
|
|
printk(KERN_ERR "%s failed to register dapm controls: %d",
|
|
printk(KERN_ERR "%s failed to register dapm controls: %d",
|
|
__func__, ret);
|
|
__func__, ret);
|
|
- kfree(uda134x);
|
|
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -551,36 +509,19 @@ static int uda134x_soc_probe(struct snd_soc_codec *codec)
|
|
default:
|
|
default:
|
|
printk(KERN_ERR "%s unknown codec type: %d",
|
|
printk(KERN_ERR "%s unknown codec type: %d",
|
|
__func__, pd->model);
|
|
__func__, pd->model);
|
|
- kfree(uda134x);
|
|
|
|
return -EINVAL;
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
|
|
if (ret < 0) {
|
|
if (ret < 0) {
|
|
printk(KERN_ERR "UDA134X: failed to register controls\n");
|
|
printk(KERN_ERR "UDA134X: failed to register controls\n");
|
|
- kfree(uda134x);
|
|
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
|
|
-/* power down chip */
|
|
|
|
-static int uda134x_soc_remove(struct snd_soc_codec *codec)
|
|
|
|
-{
|
|
|
|
- struct uda134x_priv *uda134x = snd_soc_codec_get_drvdata(codec);
|
|
|
|
-
|
|
|
|
- kfree(uda134x);
|
|
|
|
- return 0;
|
|
|
|
-}
|
|
|
|
-
|
|
|
|
static struct snd_soc_codec_driver soc_codec_dev_uda134x = {
|
|
static struct snd_soc_codec_driver soc_codec_dev_uda134x = {
|
|
.probe = uda134x_soc_probe,
|
|
.probe = uda134x_soc_probe,
|
|
- .remove = uda134x_soc_remove,
|
|
|
|
- .reg_cache_size = sizeof(uda134x_reg),
|
|
|
|
- .reg_word_size = sizeof(u8),
|
|
|
|
- .reg_cache_default = uda134x_reg,
|
|
|
|
- .reg_cache_step = 1,
|
|
|
|
- .read = uda134x_read_reg_cache,
|
|
|
|
.set_bias_level = uda134x_set_bias_level,
|
|
.set_bias_level = uda134x_set_bias_level,
|
|
.suspend_bias_off = true,
|
|
.suspend_bias_off = true,
|
|
|
|
|
|
@@ -590,8 +531,39 @@ static struct snd_soc_codec_driver soc_codec_dev_uda134x = {
|
|
.num_dapm_routes = ARRAY_SIZE(uda134x_dapm_routes),
|
|
.num_dapm_routes = ARRAY_SIZE(uda134x_dapm_routes),
|
|
};
|
|
};
|
|
|
|
|
|
|
|
+static const struct regmap_config uda134x_regmap_config = {
|
|
|
|
+ .reg_bits = 8,
|
|
|
|
+ .val_bits = 8,
|
|
|
|
+ .max_register = UDA134X_DATA1,
|
|
|
|
+ .reg_defaults = uda134x_reg_defaults,
|
|
|
|
+ .num_reg_defaults = ARRAY_SIZE(uda134x_reg_defaults),
|
|
|
|
+ .cache_type = REGCACHE_RBTREE,
|
|
|
|
+
|
|
|
|
+ .reg_write = uda134x_regmap_write,
|
|
|
|
+};
|
|
|
|
+
|
|
static int uda134x_codec_probe(struct platform_device *pdev)
|
|
static int uda134x_codec_probe(struct platform_device *pdev)
|
|
{
|
|
{
|
|
|
|
+ struct uda134x_platform_data *pd = pdev->dev.platform_data;
|
|
|
|
+ struct uda134x_priv *uda134x;
|
|
|
|
+
|
|
|
|
+ if (!pd) {
|
|
|
|
+ dev_err(&pdev->dev, "Missing L3 bitbang function\n");
|
|
|
|
+ return -ENODEV;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ uda134x = devm_kzalloc(&pdev->dev, sizeof(*uda134x), GFP_KERNEL);
|
|
|
|
+ if (!uda134x)
|
|
|
|
+ return -ENOMEM;
|
|
|
|
+
|
|
|
|
+ uda134x->pd = pd;
|
|
|
|
+ platform_set_drvdata(pdev, uda134x);
|
|
|
|
+
|
|
|
|
+ uda134x->regmap = devm_regmap_init(&pdev->dev, NULL, pd,
|
|
|
|
+ &uda134x_regmap_config);
|
|
|
|
+ if (IS_ERR(uda134x->regmap))
|
|
|
|
+ return PTR_ERR(uda134x->regmap);
|
|
|
|
+
|
|
return snd_soc_register_codec(&pdev->dev,
|
|
return snd_soc_register_codec(&pdev->dev,
|
|
&soc_codec_dev_uda134x, &uda134x_dai, 1);
|
|
&soc_codec_dev_uda134x, &uda134x_dai, 1);
|
|
}
|
|
}
|