forked from Minki/linux
1b6ebdd7bb
Add support for EXTMUTE in Zoom2 machine driver. This is necessary to further reduce pop noise problem. Signal EXTMUTE is connected to signal GPIO 153 in Zoom2 board. In addition, change ramp delay value to 3 (218/161/109 ms). With previous ramp delay value, pop noise was louder. With a longer value the beep tone can be observed. Signed-off-by: Jorge Eduardo Candelaria <x0107209@ti.com> Acked-by: Peter Ujfalusi <peter.ujfalusi@nokia.com> Signed-off-by: Mark Brown <broonie@opensource.wolfsonmicro.com>
315 lines
8.1 KiB
C
315 lines
8.1 KiB
C
/*
|
|
* zoom2.c -- SoC audio for Zoom2
|
|
*
|
|
* Author: Misael Lopez Cruz <x0052729@ti.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/platform_device.h>
|
|
#include <sound/core.h>
|
|
#include <sound/pcm.h>
|
|
#include <sound/soc.h>
|
|
#include <sound/soc-dapm.h>
|
|
|
|
#include <asm/mach-types.h>
|
|
#include <mach/hardware.h>
|
|
#include <mach/gpio.h>
|
|
#include <mach/mcbsp.h>
|
|
|
|
#include "omap-mcbsp.h"
|
|
#include "omap-pcm.h"
|
|
#include "../codecs/twl4030.h"
|
|
|
|
#define ZOOM2_HEADSET_MUX_GPIO (OMAP_MAX_GPIO_LINES + 15)
|
|
#define ZOOM2_HEADSET_EXTMUTE_GPIO 153
|
|
|
|
static int zoom2_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->dai->codec_dai;
|
|
struct snd_soc_dai *cpu_dai = rtd->dai->cpu_dai;
|
|
int ret;
|
|
|
|
/* Set codec DAI configuration */
|
|
ret = snd_soc_dai_set_fmt(codec_dai,
|
|
SND_SOC_DAIFMT_I2S |
|
|
SND_SOC_DAIFMT_NB_NF |
|
|
SND_SOC_DAIFMT_CBM_CFM);
|
|
if (ret < 0) {
|
|
printk(KERN_ERR "can't set codec DAI configuration\n");
|
|
return ret;
|
|
}
|
|
|
|
/* Set cpu DAI configuration */
|
|
ret = snd_soc_dai_set_fmt(cpu_dai,
|
|
SND_SOC_DAIFMT_I2S |
|
|
SND_SOC_DAIFMT_NB_NF |
|
|
SND_SOC_DAIFMT_CBM_CFM);
|
|
if (ret < 0) {
|
|
printk(KERN_ERR "can't set cpu DAI configuration\n");
|
|
return ret;
|
|
}
|
|
|
|
/* Set the codec system clock for DAC and ADC */
|
|
ret = snd_soc_dai_set_sysclk(codec_dai, 0, 26000000,
|
|
SND_SOC_CLOCK_IN);
|
|
if (ret < 0) {
|
|
printk(KERN_ERR "can't set codec system clock\n");
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct snd_soc_ops zoom2_ops = {
|
|
.hw_params = zoom2_hw_params,
|
|
};
|
|
|
|
static int zoom2_hw_voice_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->dai->codec_dai;
|
|
struct snd_soc_dai *cpu_dai = rtd->dai->cpu_dai;
|
|
int ret;
|
|
|
|
/* Set codec DAI configuration */
|
|
ret = snd_soc_dai_set_fmt(codec_dai,
|
|
SND_SOC_DAIFMT_DSP_A |
|
|
SND_SOC_DAIFMT_IB_NF |
|
|
SND_SOC_DAIFMT_CBM_CFM);
|
|
if (ret) {
|
|
printk(KERN_ERR "can't set codec DAI configuration\n");
|
|
return ret;
|
|
}
|
|
|
|
/* Set cpu DAI configuration */
|
|
ret = snd_soc_dai_set_fmt(cpu_dai,
|
|
SND_SOC_DAIFMT_DSP_A |
|
|
SND_SOC_DAIFMT_IB_NF |
|
|
SND_SOC_DAIFMT_CBM_CFM);
|
|
if (ret < 0) {
|
|
printk(KERN_ERR "can't set cpu DAI configuration\n");
|
|
return ret;
|
|
}
|
|
|
|
/* Set the codec system clock for DAC and ADC */
|
|
ret = snd_soc_dai_set_sysclk(codec_dai, 0, 26000000,
|
|
SND_SOC_CLOCK_IN);
|
|
if (ret < 0) {
|
|
printk(KERN_ERR "can't set codec system clock\n");
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct snd_soc_ops zoom2_voice_ops = {
|
|
.hw_params = zoom2_hw_voice_params,
|
|
};
|
|
|
|
/* Zoom2 machine DAPM */
|
|
static const struct snd_soc_dapm_widget zoom2_twl4030_dapm_widgets[] = {
|
|
SND_SOC_DAPM_MIC("Ext Mic", NULL),
|
|
SND_SOC_DAPM_SPK("Ext Spk", NULL),
|
|
SND_SOC_DAPM_MIC("Headset Mic", NULL),
|
|
SND_SOC_DAPM_HP("Headset Stereophone", NULL),
|
|
SND_SOC_DAPM_LINE("Aux In", NULL),
|
|
};
|
|
|
|
static const struct snd_soc_dapm_route audio_map[] = {
|
|
/* External Mics: MAINMIC, SUBMIC with bias*/
|
|
{"MAINMIC", NULL, "Mic Bias 1"},
|
|
{"SUBMIC", NULL, "Mic Bias 2"},
|
|
{"Mic Bias 1", NULL, "Ext Mic"},
|
|
{"Mic Bias 2", NULL, "Ext Mic"},
|
|
|
|
/* External Speakers: HFL, HFR */
|
|
{"Ext Spk", NULL, "HFL"},
|
|
{"Ext Spk", NULL, "HFR"},
|
|
|
|
/* Headset Stereophone: HSOL, HSOR */
|
|
{"Headset Stereophone", NULL, "HSOL"},
|
|
{"Headset Stereophone", NULL, "HSOR"},
|
|
|
|
/* Headset Mic: HSMIC with bias */
|
|
{"HSMIC", NULL, "Headset Mic Bias"},
|
|
{"Headset Mic Bias", NULL, "Headset Mic"},
|
|
|
|
/* Aux In: AUXL, AUXR */
|
|
{"Aux In", NULL, "AUXL"},
|
|
{"Aux In", NULL, "AUXR"},
|
|
};
|
|
|
|
static int zoom2_twl4030_init(struct snd_soc_codec *codec)
|
|
{
|
|
int ret;
|
|
|
|
/* Add Zoom2 specific widgets */
|
|
ret = snd_soc_dapm_new_controls(codec, zoom2_twl4030_dapm_widgets,
|
|
ARRAY_SIZE(zoom2_twl4030_dapm_widgets));
|
|
if (ret)
|
|
return ret;
|
|
|
|
/* Set up Zoom2 specific audio path audio_map */
|
|
snd_soc_dapm_add_routes(codec, audio_map, ARRAY_SIZE(audio_map));
|
|
|
|
/* Zoom2 connected pins */
|
|
snd_soc_dapm_enable_pin(codec, "Ext Mic");
|
|
snd_soc_dapm_enable_pin(codec, "Ext Spk");
|
|
snd_soc_dapm_enable_pin(codec, "Headset Mic");
|
|
snd_soc_dapm_enable_pin(codec, "Headset Stereophone");
|
|
snd_soc_dapm_enable_pin(codec, "Aux In");
|
|
|
|
/* TWL4030 not connected pins */
|
|
snd_soc_dapm_nc_pin(codec, "CARKITMIC");
|
|
snd_soc_dapm_nc_pin(codec, "DIGIMIC0");
|
|
snd_soc_dapm_nc_pin(codec, "DIGIMIC1");
|
|
|
|
snd_soc_dapm_nc_pin(codec, "OUTL");
|
|
snd_soc_dapm_nc_pin(codec, "OUTR");
|
|
snd_soc_dapm_nc_pin(codec, "EARPIECE");
|
|
snd_soc_dapm_nc_pin(codec, "PREDRIVEL");
|
|
snd_soc_dapm_nc_pin(codec, "PREDRIVER");
|
|
snd_soc_dapm_nc_pin(codec, "CARKITL");
|
|
snd_soc_dapm_nc_pin(codec, "CARKITR");
|
|
|
|
ret = snd_soc_dapm_sync(codec);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int zoom2_twl4030_voice_init(struct snd_soc_codec *codec)
|
|
{
|
|
unsigned short reg;
|
|
|
|
/* Enable voice interface */
|
|
reg = codec->read(codec, TWL4030_REG_VOICE_IF);
|
|
reg |= TWL4030_VIF_DIN_EN | TWL4030_VIF_DOUT_EN | TWL4030_VIF_EN;
|
|
codec->write(codec, TWL4030_REG_VOICE_IF, reg);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* Digital audio interface glue - connects codec <--> CPU */
|
|
static struct snd_soc_dai_link zoom2_dai[] = {
|
|
{
|
|
.name = "TWL4030 I2S",
|
|
.stream_name = "TWL4030 Audio",
|
|
.cpu_dai = &omap_mcbsp_dai[0],
|
|
.codec_dai = &twl4030_dai[TWL4030_DAI_HIFI],
|
|
.init = zoom2_twl4030_init,
|
|
.ops = &zoom2_ops,
|
|
},
|
|
{
|
|
.name = "TWL4030 PCM",
|
|
.stream_name = "TWL4030 Voice",
|
|
.cpu_dai = &omap_mcbsp_dai[1],
|
|
.codec_dai = &twl4030_dai[TWL4030_DAI_VOICE],
|
|
.init = zoom2_twl4030_voice_init,
|
|
.ops = &zoom2_voice_ops,
|
|
},
|
|
};
|
|
|
|
/* Audio machine driver */
|
|
static struct snd_soc_card snd_soc_zoom2 = {
|
|
.name = "Zoom2",
|
|
.platform = &omap_soc_platform,
|
|
.dai_link = zoom2_dai,
|
|
.num_links = ARRAY_SIZE(zoom2_dai),
|
|
};
|
|
|
|
/* EXTMUTE callback function */
|
|
void zoom2_set_hs_extmute(int mute)
|
|
{
|
|
gpio_set_value(ZOOM2_HEADSET_EXTMUTE_GPIO, mute);
|
|
}
|
|
|
|
/* twl4030 setup */
|
|
static struct twl4030_setup_data twl4030_setup = {
|
|
.ramp_delay_value = 3, /* 161 ms */
|
|
.sysclk = 26000,
|
|
.hs_extmute = 1,
|
|
.set_hs_extmute = zoom2_set_hs_extmute,
|
|
};
|
|
|
|
/* Audio subsystem */
|
|
static struct snd_soc_device zoom2_snd_devdata = {
|
|
.card = &snd_soc_zoom2,
|
|
.codec_dev = &soc_codec_dev_twl4030,
|
|
.codec_data = &twl4030_setup,
|
|
};
|
|
|
|
static struct platform_device *zoom2_snd_device;
|
|
|
|
static int __init zoom2_soc_init(void)
|
|
{
|
|
int ret;
|
|
|
|
if (!machine_is_omap_zoom2()) {
|
|
pr_debug("Not Zoom2!\n");
|
|
return -ENODEV;
|
|
}
|
|
printk(KERN_INFO "Zoom2 SoC init\n");
|
|
|
|
zoom2_snd_device = platform_device_alloc("soc-audio", -1);
|
|
if (!zoom2_snd_device) {
|
|
printk(KERN_ERR "Platform device allocation failed\n");
|
|
return -ENOMEM;
|
|
}
|
|
|
|
platform_set_drvdata(zoom2_snd_device, &zoom2_snd_devdata);
|
|
zoom2_snd_devdata.dev = &zoom2_snd_device->dev;
|
|
*(unsigned int *)zoom2_dai[0].cpu_dai->private_data = 1; /* McBSP2 */
|
|
*(unsigned int *)zoom2_dai[1].cpu_dai->private_data = 2; /* McBSP3 */
|
|
|
|
ret = platform_device_add(zoom2_snd_device);
|
|
if (ret)
|
|
goto err1;
|
|
|
|
BUG_ON(gpio_request(ZOOM2_HEADSET_MUX_GPIO, "hs_mux") < 0);
|
|
gpio_direction_output(ZOOM2_HEADSET_MUX_GPIO, 0);
|
|
|
|
BUG_ON(gpio_request(ZOOM2_HEADSET_EXTMUTE_GPIO, "ext_mute") < 0);
|
|
gpio_direction_output(ZOOM2_HEADSET_EXTMUTE_GPIO, 0);
|
|
|
|
return 0;
|
|
|
|
err1:
|
|
printk(KERN_ERR "Unable to add platform device\n");
|
|
platform_device_put(zoom2_snd_device);
|
|
|
|
return ret;
|
|
}
|
|
module_init(zoom2_soc_init);
|
|
|
|
static void __exit zoom2_soc_exit(void)
|
|
{
|
|
gpio_free(ZOOM2_HEADSET_MUX_GPIO);
|
|
gpio_free(ZOOM2_HEADSET_EXTMUTE_GPIO);
|
|
|
|
platform_device_unregister(zoom2_snd_device);
|
|
}
|
|
module_exit(zoom2_soc_exit);
|
|
|
|
MODULE_AUTHOR("Misael Lopez Cruz <x0052729@ti.com>");
|
|
MODULE_DESCRIPTION("ALSA SoC Zoom2");
|
|
MODULE_LICENSE("GPL");
|
|
|