/* * Copyright (C) 2009, Yauhen Kharuzhy * OpenInkpot project * Copyright (C) 2010, Lars-Peter Clausen * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. * * You should have received a copy of the GNU General Public License along * with this program; if not, write to the Free Software Foundation, Inc., * 675 Mass Ave, Cambridge, MA 02139, USA. * */ #include #include #include #include #include #include #include #include #include #include #include "../codecs/jzcodec.h" #include "jz4740-pcm.h" #include "jz4740-i2s.h" #include enum { N516_SPEAKER_AUTO = 0, N516_SPEAKER_OFF = 1, N516_SPEAKER_ON = 2, }; static int n516_speaker_mode; static struct snd_soc_codec *n516_codec; static struct work_struct n516_headphone_work; static void n516_ext_control(void) { if (!n516_codec) return; switch (n516_speaker_mode) { case N516_SPEAKER_ON: snd_soc_dapm_enable_pin(n516_codec, "Speaker"); break; case N516_SPEAKER_OFF: snd_soc_dapm_disable_pin(n516_codec, "Speaker"); break; case N516_SPEAKER_AUTO: if (snd_soc_dapm_get_pin_status(n516_codec, "Headphone")) snd_soc_dapm_disable_pin(n516_codec, "Speaker"); else snd_soc_dapm_enable_pin(n516_codec, "Speaker"); break; default: break; } /* signal a DAPM event */ snd_soc_dapm_sync(n516_codec); } static int n516_speaker_event(struct snd_soc_dapm_widget *widget, struct snd_kcontrol *ctrl, int event) { int on = !SND_SOC_DAPM_EVENT_OFF(event); gpio_set_value(GPIO_SPEAKER_ENABLE, on); return 0; } static void n516_headphone_event_work(struct work_struct *work) { n516_ext_control(); } static int n516_headphone_event(struct snd_soc_dapm_widget *widget, struct snd_kcontrol *ctrl, int event) { /* We can't call soc_dapm_sync from a event handler */ if (event & (SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD)) schedule_work(&n516_headphone_work); return 0; } static const struct snd_soc_dapm_widget n516_widgets[] = { SND_SOC_DAPM_SPK("Speaker", n516_speaker_event), SND_SOC_DAPM_HP("Headphone", n516_headphone_event), SND_SOC_DAPM_MIC("Mic", NULL), }; static const struct snd_soc_dapm_route n516_routes[] = { {"Mic", NULL, "MIC"}, {"Speaker", NULL, "LOUT"}, {"Speaker", NULL, "ROUT"}, {"Headphone", NULL, "LOUT"}, {"Headphone", NULL, "ROUT"}, }; static const char *n516_speaker_modes[] = {"Auto", "Off", "On"}; static const struct soc_enum n516_speaker_mode_enum = SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(n516_speaker_modes), n516_speaker_modes); static int n516_get_speaker_mode(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { ucontrol->value.integer.value[0] = n516_speaker_mode; return 0; } static int n516_set_speaker_mode(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { if (n516_speaker_mode == ucontrol->value.integer.value[0]) return 0; n516_speaker_mode = ucontrol->value.integer.value[0]; n516_ext_control(); return 1; } static const struct snd_kcontrol_new n516_controls[] = { SOC_ENUM_EXT("Speaker Function", n516_speaker_mode_enum, n516_get_speaker_mode, n516_set_speaker_mode), }; #define N516_DAIFMT (SND_SOC_DAIFMT_I2S | \ SND_SOC_DAIFMT_NB_NF | \ SND_SOC_DAIFMT_CBM_CFM) static int n516_codec_init(struct snd_soc_codec *codec) { int ret; struct snd_soc_dai *cpu_dai = codec->socdev->card->dai_link->cpu_dai; struct snd_soc_dai *codec_dai = codec->socdev->card->dai_link->codec_dai; n516_codec = codec; snd_soc_dapm_nc_pin(codec, "LIN"); snd_soc_dapm_nc_pin(codec, "RIN"); ret = snd_soc_dai_set_fmt(codec_dai, N516_DAIFMT); if (ret < 0) { dev_err(codec->dev, "Failed to set codec dai format: %d\n", ret); return ret; } ret = snd_soc_dai_set_fmt(cpu_dai, N516_DAIFMT); if (ret < 0) { dev_err(codec->dev, "Failed to set cpu dai format: %d\n", ret); return ret; } ret = snd_soc_dai_set_sysclk(codec_dai, JZCODEC_SYSCLK, 111, SND_SOC_CLOCK_IN); if (ret < 0) { dev_err(codec->dev, "Failed to set codec dai sysclk: %d\n", ret); return ret; } ret = snd_soc_add_controls(codec, n516_controls, ARRAY_SIZE(n516_controls)); if (ret) { dev_err(codec->dev, "Failed to add controls: %d\n", ret); return ret; } ret = snd_soc_dapm_new_controls(codec, n516_widgets, ARRAY_SIZE(n516_widgets)); if (ret) { dev_err(codec->dev, "Failed to add dapm controls: %d\n", ret); return ret; } ret = snd_soc_dapm_add_routes(codec, n516_routes, ARRAY_SIZE(n516_routes)); if (ret) { dev_err(codec->dev, "Failed to add dapm routes: %d\n", ret); return ret; } snd_soc_dapm_sync(codec); return 0; } static struct snd_soc_dai_link n516_dai = { .name = "jz-codec", .stream_name = "JZCODEC", .cpu_dai = &jz4740_i2s_dai, .codec_dai = &jz_codec_dai, .init = n516_codec_init, }; static struct snd_soc_card n516_card = { .name = "N516", .dai_link = &n516_dai, .num_links = 1, .platform = &jz4740_soc_platform, }; static struct snd_soc_device n516_snd_devdata = { .card = &n516_card, .codec_dev = &soc_codec_dev_jzcodec, }; static struct platform_device *n516_snd_device; static struct snd_soc_jack n516_hp_jack; static struct snd_soc_jack_pin n516_hp_pin = { .pin = "Headphone", .mask = SND_JACK_HEADPHONE, }; static struct snd_soc_jack_gpio n516_hp_gpio = { .gpio = GPIO_HPHONE_DETECT, .name = "Headphone detect", .report = SND_JACK_HEADPHONE, .debounce_time = 100, }; static int __init n516_add_headphone_jack(void) { int ret; ret = snd_soc_jack_new(&n516_card, "Headphone jack", SND_JACK_HEADPHONE, &n516_hp_jack); if (ret) return ret; ret = snd_soc_jack_add_pins(&n516_hp_jack, 1, &n516_hp_pin); if (ret) return ret; ret = snd_soc_jack_add_gpios(&n516_hp_jack, 1, &n516_hp_gpio); return ret; } static int __init n516_init(void) { int ret; n516_snd_device = platform_device_alloc("soc-audio", -1); if (!n516_snd_device) return -ENOMEM; ret = gpio_request(GPIO_SPEAKER_ENABLE, "Speaker enable"); if (ret) { pr_err("n516 snd: Failed to request SPEAKER_ENABLE GPIO(%d): %d\n", GPIO_SPEAKER_ENABLE, ret); goto err_device_put; } gpio_direction_output(GPIO_SPEAKER_ENABLE, 0); INIT_WORK(&n516_headphone_work, n516_headphone_event_work); platform_set_drvdata(n516_snd_device, &n516_snd_devdata); n516_snd_devdata.dev = &n516_snd_device->dev; ret = platform_device_add(n516_snd_device); if (ret) { pr_err("n516 snd: Failed to add snd soc device: %d\n", ret); goto err_unset_pdata; } ret = n516_add_headphone_jack(); /* We can live without it, so just print a warning */ if (ret) pr_warning("n516 snd: Failed to initalise headphone jack: %d\n", ret); return 0; err_unset_pdata: platform_set_drvdata(n516_snd_device, NULL); /*err_gpio_free_speaker:*/ gpio_free(GPIO_SPEAKER_ENABLE); err_device_put: platform_device_put(n516_snd_device); return ret; } module_init(n516_init); static void __exit n516_exit(void) { snd_soc_jack_free_gpios(&n516_hp_jack, 1, &n516_hp_gpio); gpio_free(GPIO_SPEAKER_ENABLE); platform_device_unregister(n516_snd_device); } module_exit(n516_exit); MODULE_AUTHOR("Lars-Peter Clausen "); MODULE_DESCRIPTION("ALSA SoC N516 Audio support"); MODULE_LICENSE("GPL v2");