Commit 90f601ef authored by Bard Liao's avatar Bard Liao Committed by Mark Brown

ASoC: rt286: Fix null pointer issue

To make the interrupt safe if it happens to be called before the card is
ready, we use regmap read/write in the interrupt handler. Also, we try to
prevent the interrupt happen before the card is ready by enabling codec's
IRQ in the ASoC probe.
Signed-off-by: default avatarBard Liao <bardliao@realtek.com>
Signed-off-by: default avatarMark Brown <broonie@linaro.org>
parent 23c4fd5c
...@@ -36,7 +36,6 @@ ...@@ -36,7 +36,6 @@
struct rt286_priv { struct rt286_priv {
struct regmap *regmap; struct regmap *regmap;
struct snd_soc_codec *codec;
struct rt286_platform_data pdata; struct rt286_platform_data pdata;
struct i2c_client *i2c; struct i2c_client *i2c;
struct snd_soc_jack *jack; struct snd_soc_jack *jack;
...@@ -295,9 +294,8 @@ static int rt286_support_power_controls[] = { ...@@ -295,9 +294,8 @@ static int rt286_support_power_controls[] = {
}; };
#define RT286_POWER_REG_LEN ARRAY_SIZE(rt286_support_power_controls) #define RT286_POWER_REG_LEN ARRAY_SIZE(rt286_support_power_controls)
static int rt286_jack_detect(struct snd_soc_codec *codec, bool *hp, bool *mic) static int rt286_jack_detect(struct rt286_priv *rt286, bool *hp, bool *mic)
{ {
struct rt286_priv *rt286 = snd_soc_codec_get_drvdata(codec);
unsigned int val, buf; unsigned int val, buf;
int i; int i;
...@@ -305,23 +303,23 @@ static int rt286_jack_detect(struct snd_soc_codec *codec, bool *hp, bool *mic) ...@@ -305,23 +303,23 @@ static int rt286_jack_detect(struct snd_soc_codec *codec, bool *hp, bool *mic)
*mic = false; *mic = false;
if (rt286->pdata.cbj_en) { if (rt286->pdata.cbj_en) {
buf = snd_soc_read(codec, RT286_GET_HP_SENSE); regmap_read(rt286->regmap, RT286_GET_HP_SENSE, &buf);
*hp = buf & 0x80000000; *hp = buf & 0x80000000;
if (*hp) { if (*hp) {
/* power on HV,VERF */ /* power on HV,VERF */
snd_soc_update_bits(codec, regmap_update_bits(rt286->regmap,
RT286_POWER_CTRL1, 0x1001, 0x0); RT286_POWER_CTRL1, 0x1001, 0x0);
/* power LDO1 */ /* power LDO1 */
snd_soc_update_bits(codec, regmap_update_bits(rt286->regmap,
RT286_POWER_CTRL2, 0x4, 0x4); RT286_POWER_CTRL2, 0x4, 0x4);
snd_soc_write(codec, RT286_SET_MIC1, 0x24); regmap_write(rt286->regmap, RT286_SET_MIC1, 0x24);
val = snd_soc_read(codec, RT286_CBJ_CTRL2); regmap_read(rt286->regmap, RT286_CBJ_CTRL2, &val);
msleep(200); msleep(200);
i = 40; i = 40;
while (((val & 0x0800) == 0) && (i > 0)) { while (((val & 0x0800) == 0) && (i > 0)) {
val = snd_soc_read(codec, regmap_read(rt286->regmap,
RT286_CBJ_CTRL2); RT286_CBJ_CTRL2, &val);
i--; i--;
msleep(20); msleep(20);
} }
...@@ -329,53 +327,53 @@ static int rt286_jack_detect(struct snd_soc_codec *codec, bool *hp, bool *mic) ...@@ -329,53 +327,53 @@ static int rt286_jack_detect(struct snd_soc_codec *codec, bool *hp, bool *mic)
if (0x0400 == (val & 0x0700)) { if (0x0400 == (val & 0x0700)) {
*mic = false; *mic = false;
snd_soc_write(codec, regmap_write(rt286->regmap,
RT286_SET_MIC1, 0x20); RT286_SET_MIC1, 0x20);
/* power off HV,VERF */ /* power off HV,VERF */
snd_soc_update_bits(codec, regmap_update_bits(rt286->regmap,
RT286_POWER_CTRL1, 0x1001, 0x1001); RT286_POWER_CTRL1, 0x1001, 0x1001);
snd_soc_update_bits(codec, regmap_update_bits(rt286->regmap,
RT286_A_BIAS_CTRL3, 0xc000, 0x0000); RT286_A_BIAS_CTRL3, 0xc000, 0x0000);
snd_soc_update_bits(codec, regmap_update_bits(rt286->regmap,
RT286_CBJ_CTRL1, 0x0030, 0x0000); RT286_CBJ_CTRL1, 0x0030, 0x0000);
snd_soc_update_bits(codec, regmap_update_bits(rt286->regmap,
RT286_A_BIAS_CTRL2, 0xc000, 0x0000); RT286_A_BIAS_CTRL2, 0xc000, 0x0000);
} else if ((0x0200 == (val & 0x0700)) || } else if ((0x0200 == (val & 0x0700)) ||
(0x0100 == (val & 0x0700))) { (0x0100 == (val & 0x0700))) {
*mic = true; *mic = true;
snd_soc_update_bits(codec, regmap_update_bits(rt286->regmap,
RT286_A_BIAS_CTRL3, 0xc000, 0x8000); RT286_A_BIAS_CTRL3, 0xc000, 0x8000);
snd_soc_update_bits(codec, regmap_update_bits(rt286->regmap,
RT286_CBJ_CTRL1, 0x0030, 0x0020); RT286_CBJ_CTRL1, 0x0030, 0x0020);
snd_soc_update_bits(codec, regmap_update_bits(rt286->regmap,
RT286_A_BIAS_CTRL2, 0xc000, 0x8000); RT286_A_BIAS_CTRL2, 0xc000, 0x8000);
} else { } else {
*mic = false; *mic = false;
} }
snd_soc_update_bits(codec, regmap_update_bits(rt286->regmap,
RT286_MISC_CTRL1, RT286_MISC_CTRL1,
0x0060, 0x0000); 0x0060, 0x0000);
} else { } else {
snd_soc_update_bits(codec, regmap_update_bits(rt286->regmap,
RT286_MISC_CTRL1, RT286_MISC_CTRL1,
0x0060, 0x0020); 0x0060, 0x0020);
snd_soc_update_bits(codec, regmap_update_bits(rt286->regmap,
RT286_A_BIAS_CTRL3, RT286_A_BIAS_CTRL3,
0xc000, 0x8000); 0xc000, 0x8000);
snd_soc_update_bits(codec, regmap_update_bits(rt286->regmap,
RT286_CBJ_CTRL1, RT286_CBJ_CTRL1,
0x0030, 0x0020); 0x0030, 0x0020);
snd_soc_update_bits(codec, regmap_update_bits(rt286->regmap,
RT286_A_BIAS_CTRL2, RT286_A_BIAS_CTRL2,
0xc000, 0x8000); 0xc000, 0x8000);
*mic = false; *mic = false;
} }
} else { } else {
buf = snd_soc_read(codec, RT286_GET_HP_SENSE); regmap_read(rt286->regmap, RT286_GET_HP_SENSE, &buf);
*hp = buf & 0x80000000; *hp = buf & 0x80000000;
buf = snd_soc_read(codec, RT286_GET_MIC1_SENSE); regmap_read(rt286->regmap, RT286_GET_MIC1_SENSE, &buf);
*mic = buf & 0x80000000; *mic = buf & 0x80000000;
} }
...@@ -390,7 +388,7 @@ static void rt286_jack_detect_work(struct work_struct *work) ...@@ -390,7 +388,7 @@ static void rt286_jack_detect_work(struct work_struct *work)
bool hp = false; bool hp = false;
bool mic = false; bool mic = false;
rt286_jack_detect(rt286->codec, &hp, &mic); rt286_jack_detect(rt286, &hp, &mic);
if (hp == true) if (hp == true)
status |= SND_JACK_HEADPHONE; status |= SND_JACK_HEADPHONE;
...@@ -940,11 +938,10 @@ static irqreturn_t rt286_irq(int irq, void *data) ...@@ -940,11 +938,10 @@ static irqreturn_t rt286_irq(int irq, void *data)
bool mic = false; bool mic = false;
int status = 0; int status = 0;
rt286_jack_detect(rt286->codec, &hp, &mic); rt286_jack_detect(rt286, &hp, &mic);
/* Clear IRQ */ /* Clear IRQ */
snd_soc_update_bits(rt286->codec, regmap_update_bits(rt286->regmap, RT286_IRQ_CTRL, 0x1, 0x1);
RT286_IRQ_CTRL, 0x1, 0x1);
if (hp == true) if (hp == true)
status |= SND_JACK_HEADPHONE; status |= SND_JACK_HEADPHONE;
...@@ -965,7 +962,16 @@ static int rt286_probe(struct snd_soc_codec *codec) ...@@ -965,7 +962,16 @@ static int rt286_probe(struct snd_soc_codec *codec)
struct rt286_priv *rt286 = snd_soc_codec_get_drvdata(codec); struct rt286_priv *rt286 = snd_soc_codec_get_drvdata(codec);
codec->dapm.bias_level = SND_SOC_BIAS_OFF; codec->dapm.bias_level = SND_SOC_BIAS_OFF;
rt286->codec = codec;
if (rt286->i2c->irq) {
regmap_update_bits(rt286->regmap,
RT286_IRQ_CTRL, 0x2, 0x2);
INIT_DELAYED_WORK(&rt286->jack_detect_work,
rt286_jack_detect_work);
schedule_delayed_work(&rt286->jack_detect_work,
msecs_to_jiffies(1250));
}
return 0; return 0;
} }
...@@ -1171,14 +1177,6 @@ static int rt286_i2c_probe(struct i2c_client *i2c, ...@@ -1171,14 +1177,6 @@ static int rt286_i2c_probe(struct i2c_client *i2c,
regmap_update_bits(rt286->regmap, RT286_DEPOP_CTRL4, 0x00ff, 0x003f); regmap_update_bits(rt286->regmap, RT286_DEPOP_CTRL4, 0x00ff, 0x003f);
if (rt286->i2c->irq) { if (rt286->i2c->irq) {
regmap_update_bits(rt286->regmap,
RT286_IRQ_CTRL, 0x2, 0x2);
INIT_DELAYED_WORK(&rt286->jack_detect_work,
rt286_jack_detect_work);
schedule_delayed_work(&rt286->jack_detect_work,
msecs_to_jiffies(1250));
ret = request_threaded_irq(rt286->i2c->irq, NULL, rt286_irq, ret = request_threaded_irq(rt286->i2c->irq, NULL, rt286_irq,
IRQF_TRIGGER_HIGH | IRQF_ONESHOT, "rt286", rt286); IRQF_TRIGGER_HIGH | IRQF_ONESHOT, "rt286", rt286);
if (ret != 0) { if (ret != 0) {
......
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