static int omap_abe_twl6040_init(struct snd_soc_pcm_runtime *rtd)
{
struct snd_soc_codec *codec = rtd->codec;
struct snd_soc_card *card = codec->card;
struct snd_soc_platform *platform = rtd->platform;
struct snd_soc_dapm_context *dapm = &codec->dapm;
struct snd_soc_dapm_context *card_dapm = &card->dapm;
struct omap_abe_twl6040_data *pdata = dev_get_platdata(card->dev);
struct omap_abe_data *card_data = snd_soc_card_get_drvdata(card);
u32 hsotrim, left_offset, right_offset, step_mV;
int ret = 0;
card_data->twl6040_codec = codec;
/* Disable not connected paths if not used */
twl6040_disconnect_pin(dapm, pdata->has_hs, "Headset Stereophone");
twl6040_disconnect_pin(dapm, pdata->has_hf, "Ext Spk");
twl6040_disconnect_pin(dapm, pdata->has_ep, "Earphone Spk");
twl6040_disconnect_pin(dapm, pdata->has_aux, "Line Out");
twl6040_disconnect_pin(dapm, pdata->has_vibra, "Vibrator");
twl6040_disconnect_pin(dapm, pdata->has_hsmic, "Headset Mic");
twl6040_disconnect_pin(dapm, pdata->has_mainmic, "Main Handset Mic");
twl6040_disconnect_pin(dapm, pdata->has_submic, "Sub Handset Mic");
twl6040_disconnect_pin(dapm, pdata->has_afm, "Line In");
/* allow audio paths from the audio modem to run during suspend */
snd_soc_dapm_ignore_suspend(&card->dapm, "Ext Spk");
snd_soc_dapm_ignore_suspend(dapm, "AFML");
snd_soc_dapm_ignore_suspend(dapm, "AFMR");
snd_soc_dapm_ignore_suspend(&card->dapm, "Headset Mic");
snd_soc_dapm_ignore_suspend(&card->dapm, "Headset Stereophone");
snd_soc_dapm_ignore_suspend(&card->dapm, "Digital Mic 0");
snd_soc_dapm_ignore_suspend(&card->dapm, "Digital Mic 1");
snd_soc_dapm_ignore_suspend(&card->dapm, "Digital Mic 2");
card_dapm->stream_event = omap_abe_stream_event;
/* DC offset cancellation computation only if ABE is enabled */
if (pdata->has_abe) {
hsotrim = twl6040_get_trim_value(codec, TWL6040_TRIM_HSOTRIM);
right_offset = TWL6040_HSF_TRIM_RIGHT(hsotrim);
left_offset = TWL6040_HSF_TRIM_LEFT(hsotrim);
step_mV = twl6040_get_hs_step_size(codec);
omap_abe_dc_set_hs_offset(platform, left_offset, right_offset,
step_mV);
}
/* Headset jack detection only if it is supported */
if (pdata->jack_detection) {
ret = snd_soc_jack_new(codec, "Headset Jack",
SND_JACK_HEADSET, &hs_jack);
if (ret)
return ret;
ret = snd_soc_jack_add_pins(&hs_jack, ARRAY_SIZE(hs_jack_pins),
hs_jack_pins);
if (machine_is_omap_4430sdp() ||
machine_is_omap_tabletblaze() ||
machine_is_omap5_sevm() ||
machine_is_omap5_panda())
twl6040_hs_jack_detect(codec, &hs_jack, SND_JACK_HEADSET);
else
snd_soc_jack_report(&hs_jack, SND_JACK_HEADSET, SND_JACK_HEADSET);
}
return ret;
}
static __devinit int omap_abe_probe(struct platform_device *pdev)
{
struct omap_abe_twl6040_data *pdata = dev_get_platdata(&pdev->dev);
struct snd_soc_card *card = &omap_abe_card;
struct omap_abe_data *card_data;
int ret;
card->dev = &pdev->dev;
if (!machine_is_omap_4430sdp() &&
!machine_is_omap4_panda() && !machine_is_omap5_sevm())
return -ENODEV;
pr_info("OMAP4/5 SoC init\n");
if (!pdata) {
dev_err(&pdev->dev, "Missing pdata\n");
return -ENODEV;
}
if (pdata->card_name) {
card->name = pdata->card_name;
} else {
dev_err(&pdev->dev, "Card name is not provided\n");
return -ENODEV;
}
if (!pdata->mclk_freq) {
dev_err(&pdev->dev, "MCLK frequency missing\n");
return -ENODEV;
}
if (pdata->has_abe) {
if (pdata->has_dmic) {
card->dai_link = omap_abe_dai;
card->num_links = ARRAY_SIZE(omap_abe_dai);
} else {
card->dai_link = omap_abe_no_dmic_dai;
card->num_links = ARRAY_SIZE(omap_abe_no_dmic_dai);
}
} else if (pdata->has_dmic) {
card->dai_link = twl6040_dmic_dai;
card->num_links = ARRAY_SIZE(twl6040_dmic_dai);
} else {
card->dai_link = twl6040_only_dai;
card->num_links = ARRAY_SIZE(twl6040_only_dai);
}
card_data = devm_kzalloc(&pdev->dev, sizeof(*card_data), GFP_KERNEL);
if (card_data == NULL)
return -ENOMEM;
snd_soc_card_set_drvdata(card, card_data);
/*
* Dummy symbols to enforce loading of snd-soc-omap and snd-soc-mcpdm
*/
omap_pcm_dummy();
omap_mcpdm_dummy();
ret = snd_soc_register_card(card);
if (ret)
dev_err(&pdev->dev, "snd_soc_register_card() failed: %d\n", ret);
return ret;
}
