mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-11-01 00:48:50 +00:00
96b61bc546
Use WARN_ON() and handle the error cases accordingly. Acked-by: Jarkko Nikula <jarkko.nikula@bitmer.com> Signed-off-by: Takashi Iwai <tiwai@suse.de> Signed-off-by: Mark Brown <broonie@linaro.org>
385 lines
9.5 KiB
C
385 lines
9.5 KiB
C
/*
|
|
* n810.c -- SoC audio for Nokia N810
|
|
*
|
|
* Copyright (C) 2008 Nokia Corporation
|
|
*
|
|
* Contact: Jarkko Nikula <jarkko.nikula@bitmer.com>
|
|
*
|
|
* 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.
|
|
*
|
|
* This program is distributed in the hope that it will be useful, but
|
|
* WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
* General Public License for more details.
|
|
*
|
|
* 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., 51 Franklin St, Fifth Floor, Boston, MA
|
|
* 02110-1301 USA
|
|
*
|
|
*/
|
|
|
|
#include <linux/clk.h>
|
|
#include <linux/i2c.h>
|
|
#include <linux/platform_device.h>
|
|
#include <sound/core.h>
|
|
#include <sound/pcm.h>
|
|
#include <sound/soc.h>
|
|
|
|
#include <asm/mach-types.h>
|
|
#include <linux/gpio.h>
|
|
#include <linux/module.h>
|
|
#include <linux/platform_data/asoc-ti-mcbsp.h>
|
|
|
|
#include "omap-mcbsp.h"
|
|
|
|
#define N810_HEADSET_AMP_GPIO 10
|
|
#define N810_SPEAKER_AMP_GPIO 101
|
|
|
|
enum {
|
|
N810_JACK_DISABLED,
|
|
N810_JACK_HP,
|
|
N810_JACK_HS,
|
|
N810_JACK_MIC,
|
|
};
|
|
|
|
static struct clk *sys_clkout2;
|
|
static struct clk *sys_clkout2_src;
|
|
static struct clk *func96m_clk;
|
|
|
|
static int n810_spk_func;
|
|
static int n810_jack_func;
|
|
static int n810_dmic_func;
|
|
|
|
static void n810_ext_control(struct snd_soc_dapm_context *dapm)
|
|
{
|
|
int hp = 0, line1l = 0;
|
|
|
|
switch (n810_jack_func) {
|
|
case N810_JACK_HS:
|
|
line1l = 1;
|
|
case N810_JACK_HP:
|
|
hp = 1;
|
|
break;
|
|
case N810_JACK_MIC:
|
|
line1l = 1;
|
|
break;
|
|
}
|
|
|
|
if (n810_spk_func)
|
|
snd_soc_dapm_enable_pin(dapm, "Ext Spk");
|
|
else
|
|
snd_soc_dapm_disable_pin(dapm, "Ext Spk");
|
|
|
|
if (hp)
|
|
snd_soc_dapm_enable_pin(dapm, "Headphone Jack");
|
|
else
|
|
snd_soc_dapm_disable_pin(dapm, "Headphone Jack");
|
|
if (line1l)
|
|
snd_soc_dapm_enable_pin(dapm, "LINE1L");
|
|
else
|
|
snd_soc_dapm_disable_pin(dapm, "LINE1L");
|
|
|
|
if (n810_dmic_func)
|
|
snd_soc_dapm_enable_pin(dapm, "DMic");
|
|
else
|
|
snd_soc_dapm_disable_pin(dapm, "DMic");
|
|
|
|
snd_soc_dapm_sync(dapm);
|
|
}
|
|
|
|
static int n810_startup(struct snd_pcm_substream *substream)
|
|
{
|
|
struct snd_pcm_runtime *runtime = substream->runtime;
|
|
struct snd_soc_pcm_runtime *rtd = substream->private_data;
|
|
struct snd_soc_codec *codec = rtd->codec;
|
|
|
|
snd_pcm_hw_constraint_minmax(runtime,
|
|
SNDRV_PCM_HW_PARAM_CHANNELS, 2, 2);
|
|
|
|
n810_ext_control(&codec->dapm);
|
|
return clk_enable(sys_clkout2);
|
|
}
|
|
|
|
static void n810_shutdown(struct snd_pcm_substream *substream)
|
|
{
|
|
clk_disable(sys_clkout2);
|
|
}
|
|
|
|
static int n810_hw_params(struct snd_pcm_substream *substream,
|
|
struct snd_pcm_hw_params *params)
|
|
{
|
|
struct snd_soc_pcm_runtime *rtd = substream->private_data;
|
|
struct snd_soc_dai *codec_dai = rtd->codec_dai;
|
|
int err;
|
|
|
|
/* Set the codec system clock for DAC and ADC */
|
|
err = snd_soc_dai_set_sysclk(codec_dai, 0, 12000000,
|
|
SND_SOC_CLOCK_IN);
|
|
|
|
return err;
|
|
}
|
|
|
|
static struct snd_soc_ops n810_ops = {
|
|
.startup = n810_startup,
|
|
.hw_params = n810_hw_params,
|
|
.shutdown = n810_shutdown,
|
|
};
|
|
|
|
static int n810_get_spk(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
ucontrol->value.integer.value[0] = n810_spk_func;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int n810_set_spk(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
struct snd_soc_card *card = snd_kcontrol_chip(kcontrol);
|
|
|
|
if (n810_spk_func == ucontrol->value.integer.value[0])
|
|
return 0;
|
|
|
|
n810_spk_func = ucontrol->value.integer.value[0];
|
|
n810_ext_control(&card->dapm);
|
|
|
|
return 1;
|
|
}
|
|
|
|
static int n810_get_jack(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
ucontrol->value.integer.value[0] = n810_jack_func;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int n810_set_jack(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
struct snd_soc_card *card = snd_kcontrol_chip(kcontrol);
|
|
|
|
if (n810_jack_func == ucontrol->value.integer.value[0])
|
|
return 0;
|
|
|
|
n810_jack_func = ucontrol->value.integer.value[0];
|
|
n810_ext_control(&card->dapm);
|
|
|
|
return 1;
|
|
}
|
|
|
|
static int n810_get_input(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
ucontrol->value.integer.value[0] = n810_dmic_func;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int n810_set_input(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
struct snd_soc_card *card = snd_kcontrol_chip(kcontrol);
|
|
|
|
if (n810_dmic_func == ucontrol->value.integer.value[0])
|
|
return 0;
|
|
|
|
n810_dmic_func = ucontrol->value.integer.value[0];
|
|
n810_ext_control(&card->dapm);
|
|
|
|
return 1;
|
|
}
|
|
|
|
static int n810_spk_event(struct snd_soc_dapm_widget *w,
|
|
struct snd_kcontrol *k, int event)
|
|
{
|
|
if (SND_SOC_DAPM_EVENT_ON(event))
|
|
gpio_set_value(N810_SPEAKER_AMP_GPIO, 1);
|
|
else
|
|
gpio_set_value(N810_SPEAKER_AMP_GPIO, 0);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int n810_jack_event(struct snd_soc_dapm_widget *w,
|
|
struct snd_kcontrol *k, int event)
|
|
{
|
|
if (SND_SOC_DAPM_EVENT_ON(event))
|
|
gpio_set_value(N810_HEADSET_AMP_GPIO, 1);
|
|
else
|
|
gpio_set_value(N810_HEADSET_AMP_GPIO, 0);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct snd_soc_dapm_widget aic33_dapm_widgets[] = {
|
|
SND_SOC_DAPM_SPK("Ext Spk", n810_spk_event),
|
|
SND_SOC_DAPM_HP("Headphone Jack", n810_jack_event),
|
|
SND_SOC_DAPM_MIC("DMic", NULL),
|
|
};
|
|
|
|
static const struct snd_soc_dapm_route audio_map[] = {
|
|
{"Headphone Jack", NULL, "HPLOUT"},
|
|
{"Headphone Jack", NULL, "HPROUT"},
|
|
|
|
{"Ext Spk", NULL, "LLOUT"},
|
|
{"Ext Spk", NULL, "RLOUT"},
|
|
|
|
{"DMic Rate 64", NULL, "Mic Bias"},
|
|
{"Mic Bias", NULL, "DMic"},
|
|
};
|
|
|
|
static const char *spk_function[] = {"Off", "On"};
|
|
static const char *jack_function[] = {"Off", "Headphone", "Headset", "Mic"};
|
|
static const char *input_function[] = {"ADC", "Digital Mic"};
|
|
static const struct soc_enum n810_enum[] = {
|
|
SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(spk_function), spk_function),
|
|
SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(jack_function), jack_function),
|
|
SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(input_function), input_function),
|
|
};
|
|
|
|
static const struct snd_kcontrol_new aic33_n810_controls[] = {
|
|
SOC_ENUM_EXT("Speaker Function", n810_enum[0],
|
|
n810_get_spk, n810_set_spk),
|
|
SOC_ENUM_EXT("Jack Function", n810_enum[1],
|
|
n810_get_jack, n810_set_jack),
|
|
SOC_ENUM_EXT("Input Select", n810_enum[2],
|
|
n810_get_input, n810_set_input),
|
|
};
|
|
|
|
static int n810_aic33_init(struct snd_soc_pcm_runtime *rtd)
|
|
{
|
|
struct snd_soc_codec *codec = rtd->codec;
|
|
struct snd_soc_dapm_context *dapm = &codec->dapm;
|
|
|
|
/* Not connected */
|
|
snd_soc_dapm_nc_pin(dapm, "MONO_LOUT");
|
|
snd_soc_dapm_nc_pin(dapm, "HPLCOM");
|
|
snd_soc_dapm_nc_pin(dapm, "HPRCOM");
|
|
snd_soc_dapm_nc_pin(dapm, "MIC3L");
|
|
snd_soc_dapm_nc_pin(dapm, "MIC3R");
|
|
snd_soc_dapm_nc_pin(dapm, "LINE1R");
|
|
snd_soc_dapm_nc_pin(dapm, "LINE2L");
|
|
snd_soc_dapm_nc_pin(dapm, "LINE2R");
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* Digital audio interface glue - connects codec <--> CPU */
|
|
static struct snd_soc_dai_link n810_dai = {
|
|
.name = "TLV320AIC33",
|
|
.stream_name = "AIC33",
|
|
.cpu_dai_name = "omap-mcbsp.2",
|
|
.platform_name = "omap-pcm-audio",
|
|
.codec_name = "tlv320aic3x-codec.2-0018",
|
|
.codec_dai_name = "tlv320aic3x-hifi",
|
|
.dai_fmt = SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF |
|
|
SND_SOC_DAIFMT_CBM_CFM,
|
|
.init = n810_aic33_init,
|
|
.ops = &n810_ops,
|
|
};
|
|
|
|
/* Audio machine driver */
|
|
static struct snd_soc_card snd_soc_n810 = {
|
|
.name = "N810",
|
|
.owner = THIS_MODULE,
|
|
.dai_link = &n810_dai,
|
|
.num_links = 1,
|
|
|
|
.controls = aic33_n810_controls,
|
|
.num_controls = ARRAY_SIZE(aic33_n810_controls),
|
|
.dapm_widgets = aic33_dapm_widgets,
|
|
.num_dapm_widgets = ARRAY_SIZE(aic33_dapm_widgets),
|
|
.dapm_routes = audio_map,
|
|
.num_dapm_routes = ARRAY_SIZE(audio_map),
|
|
};
|
|
|
|
static struct platform_device *n810_snd_device;
|
|
|
|
static int __init n810_soc_init(void)
|
|
{
|
|
int err;
|
|
struct device *dev;
|
|
|
|
if (!(machine_is_nokia_n810() || machine_is_nokia_n810_wimax()))
|
|
return -ENODEV;
|
|
|
|
n810_snd_device = platform_device_alloc("soc-audio", -1);
|
|
if (!n810_snd_device)
|
|
return -ENOMEM;
|
|
|
|
platform_set_drvdata(n810_snd_device, &snd_soc_n810);
|
|
err = platform_device_add(n810_snd_device);
|
|
if (err)
|
|
goto err1;
|
|
|
|
dev = &n810_snd_device->dev;
|
|
|
|
sys_clkout2_src = clk_get(dev, "sys_clkout2_src");
|
|
if (IS_ERR(sys_clkout2_src)) {
|
|
dev_err(dev, "Could not get sys_clkout2_src clock\n");
|
|
err = PTR_ERR(sys_clkout2_src);
|
|
goto err2;
|
|
}
|
|
sys_clkout2 = clk_get(dev, "sys_clkout2");
|
|
if (IS_ERR(sys_clkout2)) {
|
|
dev_err(dev, "Could not get sys_clkout2\n");
|
|
err = PTR_ERR(sys_clkout2);
|
|
goto err3;
|
|
}
|
|
/*
|
|
* Configure 12 MHz output on SYS_CLKOUT2. Therefore we must use
|
|
* 96 MHz as its parent in order to get 12 MHz
|
|
*/
|
|
func96m_clk = clk_get(dev, "func_96m_ck");
|
|
if (IS_ERR(func96m_clk)) {
|
|
dev_err(dev, "Could not get func 96M clock\n");
|
|
err = PTR_ERR(func96m_clk);
|
|
goto err4;
|
|
}
|
|
clk_set_parent(sys_clkout2_src, func96m_clk);
|
|
clk_set_rate(sys_clkout2, 12000000);
|
|
|
|
if (WARN_ON((gpio_request(N810_HEADSET_AMP_GPIO, "hs_amp") < 0) ||
|
|
(gpio_request(N810_SPEAKER_AMP_GPIO, "spk_amp") < 0))) {
|
|
err = -EINVAL;
|
|
goto err4;
|
|
}
|
|
|
|
gpio_direction_output(N810_HEADSET_AMP_GPIO, 0);
|
|
gpio_direction_output(N810_SPEAKER_AMP_GPIO, 0);
|
|
|
|
return 0;
|
|
err4:
|
|
clk_put(sys_clkout2);
|
|
err3:
|
|
clk_put(sys_clkout2_src);
|
|
err2:
|
|
platform_device_del(n810_snd_device);
|
|
err1:
|
|
platform_device_put(n810_snd_device);
|
|
|
|
return err;
|
|
}
|
|
|
|
static void __exit n810_soc_exit(void)
|
|
{
|
|
gpio_free(N810_SPEAKER_AMP_GPIO);
|
|
gpio_free(N810_HEADSET_AMP_GPIO);
|
|
clk_put(sys_clkout2_src);
|
|
clk_put(sys_clkout2);
|
|
clk_put(func96m_clk);
|
|
|
|
platform_device_unregister(n810_snd_device);
|
|
}
|
|
|
|
module_init(n810_soc_init);
|
|
module_exit(n810_soc_exit);
|
|
|
|
MODULE_AUTHOR("Jarkko Nikula <jarkko.nikula@bitmer.com>");
|
|
MODULE_DESCRIPTION("ALSA SoC Nokia N810");
|
|
MODULE_LICENSE("GPL");
|