ASoC: rt5651: Move 2 functions higher up in rt5651.c
Move 2 functions higher up in rt5651.c, this is a preparation patch to avoid needing forward declarations when moving over from a codec private function to the standard snd_soc_component_set_jack(). This commit purely moves these 2 functions up, not a single line is changed. Signed-off-by: Hans de Goede <hdegoede@redhat.com> Signed-off-by: Mark Brown <broonie@kernel.org>
This commit is contained in:
Родитель
f06da4fdb5
Коммит
d8b8c878e8
|
@ -1583,6 +1583,83 @@ static int rt5651_set_bias_level(struct snd_soc_component *component,
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static irqreturn_t rt5651_irq(int irq, void *data)
|
||||||
|
{
|
||||||
|
struct rt5651_priv *rt5651 = data;
|
||||||
|
|
||||||
|
queue_delayed_work(system_power_efficient_wq,
|
||||||
|
&rt5651->jack_detect_work, msecs_to_jiffies(250));
|
||||||
|
|
||||||
|
return IRQ_HANDLED;
|
||||||
|
}
|
||||||
|
|
||||||
|
int rt5651_set_jack_detect(struct snd_soc_component *component,
|
||||||
|
struct snd_soc_jack *hp_jack)
|
||||||
|
{
|
||||||
|
struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
|
||||||
|
struct rt5651_priv *rt5651 = snd_soc_component_get_drvdata(component);
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
if (!rt5651->irq)
|
||||||
|
return -EINVAL;
|
||||||
|
|
||||||
|
/* IRQ output on GPIO1 */
|
||||||
|
snd_soc_component_update_bits(component, RT5651_GPIO_CTRL1,
|
||||||
|
RT5651_GP1_PIN_MASK, RT5651_GP1_PIN_IRQ);
|
||||||
|
|
||||||
|
/* Select jack detect source */
|
||||||
|
switch (rt5651->jd_src) {
|
||||||
|
case RT5651_JD1_1:
|
||||||
|
snd_soc_component_update_bits(component, RT5651_JD_CTRL2,
|
||||||
|
RT5651_JD_TRG_SEL_MASK, RT5651_JD_TRG_SEL_JD1_1);
|
||||||
|
snd_soc_component_update_bits(component, RT5651_IRQ_CTRL1,
|
||||||
|
RT5651_JD1_1_IRQ_EN, RT5651_JD1_1_IRQ_EN);
|
||||||
|
break;
|
||||||
|
case RT5651_JD1_2:
|
||||||
|
snd_soc_component_update_bits(component, RT5651_JD_CTRL2,
|
||||||
|
RT5651_JD_TRG_SEL_MASK, RT5651_JD_TRG_SEL_JD1_2);
|
||||||
|
snd_soc_component_update_bits(component, RT5651_IRQ_CTRL1,
|
||||||
|
RT5651_JD1_2_IRQ_EN, RT5651_JD1_2_IRQ_EN);
|
||||||
|
break;
|
||||||
|
case RT5651_JD2:
|
||||||
|
snd_soc_component_update_bits(component, RT5651_JD_CTRL2,
|
||||||
|
RT5651_JD_TRG_SEL_MASK, RT5651_JD_TRG_SEL_JD2);
|
||||||
|
snd_soc_component_update_bits(component, RT5651_IRQ_CTRL1,
|
||||||
|
RT5651_JD2_IRQ_EN, RT5651_JD2_IRQ_EN);
|
||||||
|
break;
|
||||||
|
case RT5651_JD_NULL:
|
||||||
|
return 0;
|
||||||
|
default:
|
||||||
|
dev_err(component->dev, "Currently only JD1_1 / JD1_2 / JD2 are supported\n");
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
|
||||||
|
snd_soc_dapm_force_enable_pin(dapm, "JD Power");
|
||||||
|
snd_soc_dapm_force_enable_pin(dapm, "LDO");
|
||||||
|
snd_soc_dapm_sync(dapm);
|
||||||
|
|
||||||
|
snd_soc_component_update_bits(component, RT5651_MICBIAS, 0x38, 0x38);
|
||||||
|
|
||||||
|
rt5651->hp_jack = hp_jack;
|
||||||
|
|
||||||
|
ret = devm_request_threaded_irq(component->dev, rt5651->irq, NULL,
|
||||||
|
rt5651_irq,
|
||||||
|
IRQF_TRIGGER_RISING |
|
||||||
|
IRQF_TRIGGER_FALLING |
|
||||||
|
IRQF_ONESHOT, "rt5651", rt5651);
|
||||||
|
if (ret) {
|
||||||
|
dev_err(component->dev, "Failed to reguest IRQ: %d\n", ret);
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* sync initial jack state */
|
||||||
|
queue_delayed_work(system_power_efficient_wq,
|
||||||
|
&rt5651->jack_detect_work, 0);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
EXPORT_SYMBOL_GPL(rt5651_set_jack_detect);
|
||||||
|
|
||||||
static int rt5651_probe(struct snd_soc_component *component)
|
static int rt5651_probe(struct snd_soc_component *component)
|
||||||
{
|
{
|
||||||
struct rt5651_priv *rt5651 = snd_soc_component_get_drvdata(component);
|
struct rt5651_priv *rt5651 = snd_soc_component_get_drvdata(component);
|
||||||
|
@ -1752,16 +1829,6 @@ static const struct dmi_system_id rt5651_quirk_table[] = {
|
||||||
{}
|
{}
|
||||||
};
|
};
|
||||||
|
|
||||||
static irqreturn_t rt5651_irq(int irq, void *data)
|
|
||||||
{
|
|
||||||
struct rt5651_priv *rt5651 = data;
|
|
||||||
|
|
||||||
queue_delayed_work(system_power_efficient_wq,
|
|
||||||
&rt5651->jack_detect_work, msecs_to_jiffies(250));
|
|
||||||
|
|
||||||
return IRQ_HANDLED;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int rt5651_jack_detect(struct snd_soc_component *component, int jack_insert)
|
static int rt5651_jack_detect(struct snd_soc_component *component, int jack_insert)
|
||||||
{
|
{
|
||||||
struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
|
struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
|
||||||
|
@ -1827,73 +1894,6 @@ static void rt5651_jack_detect_work(struct work_struct *work)
|
||||||
snd_soc_jack_report(rt5651->hp_jack, report, SND_JACK_HEADSET);
|
snd_soc_jack_report(rt5651->hp_jack, report, SND_JACK_HEADSET);
|
||||||
}
|
}
|
||||||
|
|
||||||
int rt5651_set_jack_detect(struct snd_soc_component *component,
|
|
||||||
struct snd_soc_jack *hp_jack)
|
|
||||||
{
|
|
||||||
struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
|
|
||||||
struct rt5651_priv *rt5651 = snd_soc_component_get_drvdata(component);
|
|
||||||
int ret;
|
|
||||||
|
|
||||||
if (!rt5651->irq)
|
|
||||||
return -EINVAL;
|
|
||||||
|
|
||||||
/* IRQ output on GPIO1 */
|
|
||||||
snd_soc_component_update_bits(component, RT5651_GPIO_CTRL1,
|
|
||||||
RT5651_GP1_PIN_MASK, RT5651_GP1_PIN_IRQ);
|
|
||||||
|
|
||||||
/* Select jack detect source */
|
|
||||||
switch (rt5651->jd_src) {
|
|
||||||
case RT5651_JD1_1:
|
|
||||||
snd_soc_component_update_bits(component, RT5651_JD_CTRL2,
|
|
||||||
RT5651_JD_TRG_SEL_MASK, RT5651_JD_TRG_SEL_JD1_1);
|
|
||||||
snd_soc_component_update_bits(component, RT5651_IRQ_CTRL1,
|
|
||||||
RT5651_JD1_1_IRQ_EN, RT5651_JD1_1_IRQ_EN);
|
|
||||||
break;
|
|
||||||
case RT5651_JD1_2:
|
|
||||||
snd_soc_component_update_bits(component, RT5651_JD_CTRL2,
|
|
||||||
RT5651_JD_TRG_SEL_MASK, RT5651_JD_TRG_SEL_JD1_2);
|
|
||||||
snd_soc_component_update_bits(component, RT5651_IRQ_CTRL1,
|
|
||||||
RT5651_JD1_2_IRQ_EN, RT5651_JD1_2_IRQ_EN);
|
|
||||||
break;
|
|
||||||
case RT5651_JD2:
|
|
||||||
snd_soc_component_update_bits(component, RT5651_JD_CTRL2,
|
|
||||||
RT5651_JD_TRG_SEL_MASK, RT5651_JD_TRG_SEL_JD2);
|
|
||||||
snd_soc_component_update_bits(component, RT5651_IRQ_CTRL1,
|
|
||||||
RT5651_JD2_IRQ_EN, RT5651_JD2_IRQ_EN);
|
|
||||||
break;
|
|
||||||
case RT5651_JD_NULL:
|
|
||||||
return 0;
|
|
||||||
default:
|
|
||||||
dev_err(component->dev, "Currently only JD1_1 / JD1_2 / JD2 are supported\n");
|
|
||||||
return -EINVAL;
|
|
||||||
}
|
|
||||||
|
|
||||||
snd_soc_dapm_force_enable_pin(dapm, "JD Power");
|
|
||||||
snd_soc_dapm_force_enable_pin(dapm, "LDO");
|
|
||||||
snd_soc_dapm_sync(dapm);
|
|
||||||
|
|
||||||
snd_soc_component_update_bits(component, RT5651_MICBIAS, 0x38, 0x38);
|
|
||||||
|
|
||||||
rt5651->hp_jack = hp_jack;
|
|
||||||
|
|
||||||
ret = devm_request_threaded_irq(component->dev, rt5651->irq, NULL,
|
|
||||||
rt5651_irq,
|
|
||||||
IRQF_TRIGGER_RISING |
|
|
||||||
IRQF_TRIGGER_FALLING |
|
|
||||||
IRQF_ONESHOT, "rt5651", rt5651);
|
|
||||||
if (ret) {
|
|
||||||
dev_err(component->dev, "Failed to reguest IRQ: %d\n", ret);
|
|
||||||
return ret;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* sync initial jack state */
|
|
||||||
queue_delayed_work(system_power_efficient_wq,
|
|
||||||
&rt5651->jack_detect_work, 0);
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
EXPORT_SYMBOL_GPL(rt5651_set_jack_detect);
|
|
||||||
|
|
||||||
static int rt5651_i2c_probe(struct i2c_client *i2c,
|
static int rt5651_i2c_probe(struct i2c_client *i2c,
|
||||||
const struct i2c_device_id *id)
|
const struct i2c_device_id *id)
|
||||||
{
|
{
|
||||||
|
|
Загрузка…
Ссылка в новой задаче