225 lines
		
	
	
		
			5.3 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			225 lines
		
	
	
		
			5.3 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| // SPDX-License-Identifier: GPL-2.0+
 | |
| //
 | |
| // h1940_uda1380.c - ALSA SoC Audio Layer
 | |
| //
 | |
| // Copyright (c) 2010 Arnaud Patard <arnaud.patard@rtp-net.org>
 | |
| // Copyright (c) 2010 Vasily Khoruzhick <anarsoul@gmail.com>
 | |
| //
 | |
| // Based on version from Arnaud Patard <arnaud.patard@rtp-net.org>
 | |
| 
 | |
| #include <linux/types.h>
 | |
| #include <linux/gpio/consumer.h>
 | |
| #include <linux/module.h>
 | |
| 
 | |
| #include <sound/soc.h>
 | |
| #include <sound/jack.h>
 | |
| 
 | |
| #include "regs-iis.h"
 | |
| #include "s3c24xx-i2s.h"
 | |
| 
 | |
| static const unsigned int rates[] = {
 | |
| 	11025,
 | |
| 	22050,
 | |
| 	44100,
 | |
| };
 | |
| 
 | |
| static const struct snd_pcm_hw_constraint_list hw_rates = {
 | |
| 	.count = ARRAY_SIZE(rates),
 | |
| 	.list = rates,
 | |
| };
 | |
| 
 | |
| static struct gpio_desc *gpiod_speaker_power;
 | |
| 
 | |
| static struct snd_soc_jack hp_jack;
 | |
| 
 | |
| static struct snd_soc_jack_pin hp_jack_pins[] = {
 | |
| 	{
 | |
| 		.pin	= "Headphone Jack",
 | |
| 		.mask	= SND_JACK_HEADPHONE,
 | |
| 	},
 | |
| 	{
 | |
| 		.pin	= "Speaker",
 | |
| 		.mask	= SND_JACK_HEADPHONE,
 | |
| 		.invert	= 1,
 | |
| 	},
 | |
| };
 | |
| 
 | |
| static struct snd_soc_jack_gpio hp_jack_gpios[] = {
 | |
| 	{
 | |
| 		.name			= "hp-gpio",
 | |
| 		.report			= SND_JACK_HEADPHONE,
 | |
| 		.invert			= 1,
 | |
| 		.debounce_time		= 200,
 | |
| 	},
 | |
| };
 | |
| 
 | |
| static int h1940_startup(struct snd_pcm_substream *substream)
 | |
| {
 | |
| 	struct snd_pcm_runtime *runtime = substream->runtime;
 | |
| 
 | |
| 	return snd_pcm_hw_constraint_list(runtime, 0,
 | |
| 					SNDRV_PCM_HW_PARAM_RATE,
 | |
| 					&hw_rates);
 | |
| }
 | |
| 
 | |
| static int h1940_hw_params(struct snd_pcm_substream *substream,
 | |
| 				struct snd_pcm_hw_params *params)
 | |
| {
 | |
| 	struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
 | |
| 	struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
 | |
| 	int div;
 | |
| 	int ret;
 | |
| 	unsigned int rate = params_rate(params);
 | |
| 
 | |
| 	switch (rate) {
 | |
| 	case 11025:
 | |
| 	case 22050:
 | |
| 	case 44100:
 | |
| 		div = s3c24xx_i2s_get_clockrate() / (384 * rate);
 | |
| 		if (s3c24xx_i2s_get_clockrate() % (384 * rate) > (192 * rate))
 | |
| 			div++;
 | |
| 		break;
 | |
| 	default:
 | |
| 		dev_err(rtd->dev, "%s: rate %d is not supported\n",
 | |
| 			__func__, rate);
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	/* select clock source */
 | |
| 	ret = snd_soc_dai_set_sysclk(cpu_dai, S3C24XX_CLKSRC_PCLK, rate,
 | |
| 			SND_SOC_CLOCK_OUT);
 | |
| 	if (ret < 0)
 | |
| 		return ret;
 | |
| 
 | |
| 	/* set MCLK division for sample rate */
 | |
| 	ret = snd_soc_dai_set_clkdiv(cpu_dai, S3C24XX_DIV_MCLK,
 | |
| 		S3C2410_IISMOD_384FS);
 | |
| 	if (ret < 0)
 | |
| 		return ret;
 | |
| 
 | |
| 	/* set BCLK division for sample rate */
 | |
| 	ret = snd_soc_dai_set_clkdiv(cpu_dai, S3C24XX_DIV_BCLK,
 | |
| 		S3C2410_IISMOD_32FS);
 | |
| 	if (ret < 0)
 | |
| 		return ret;
 | |
| 
 | |
| 	/* set prescaler division for sample rate */
 | |
| 	ret = snd_soc_dai_set_clkdiv(cpu_dai, S3C24XX_DIV_PRESCALER,
 | |
| 		S3C24XX_PRESCALE(div, div));
 | |
| 	if (ret < 0)
 | |
| 		return ret;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static const struct snd_soc_ops h1940_ops = {
 | |
| 	.startup	= h1940_startup,
 | |
| 	.hw_params	= h1940_hw_params,
 | |
| };
 | |
| 
 | |
| static int h1940_spk_power(struct snd_soc_dapm_widget *w,
 | |
| 				struct snd_kcontrol *kcontrol, int event)
 | |
| {
 | |
| 	if (SND_SOC_DAPM_EVENT_ON(event))
 | |
| 		gpiod_set_value(gpiod_speaker_power, 1);
 | |
| 	else
 | |
| 		gpiod_set_value(gpiod_speaker_power, 0);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| /* h1940 machine dapm widgets */
 | |
| static const struct snd_soc_dapm_widget uda1380_dapm_widgets[] = {
 | |
| 	SND_SOC_DAPM_HP("Headphone Jack", NULL),
 | |
| 	SND_SOC_DAPM_MIC("Mic Jack", NULL),
 | |
| 	SND_SOC_DAPM_SPK("Speaker", h1940_spk_power),
 | |
| };
 | |
| 
 | |
| /* h1940 machine audio_map */
 | |
| static const struct snd_soc_dapm_route audio_map[] = {
 | |
| 	/* headphone connected to VOUTLHP, VOUTRHP */
 | |
| 	{"Headphone Jack", NULL, "VOUTLHP"},
 | |
| 	{"Headphone Jack", NULL, "VOUTRHP"},
 | |
| 
 | |
| 	/* ext speaker connected to VOUTL, VOUTR  */
 | |
| 	{"Speaker", NULL, "VOUTL"},
 | |
| 	{"Speaker", NULL, "VOUTR"},
 | |
| 
 | |
| 	/* mic is connected to VINM */
 | |
| 	{"VINM", NULL, "Mic Jack"},
 | |
| };
 | |
| 
 | |
| static int h1940_uda1380_init(struct snd_soc_pcm_runtime *rtd)
 | |
| {
 | |
| 	snd_soc_card_jack_new_pins(rtd->card, "Headphone Jack",
 | |
| 		SND_JACK_HEADPHONE,
 | |
| 		&hp_jack, hp_jack_pins, ARRAY_SIZE(hp_jack_pins));
 | |
| 
 | |
| 	snd_soc_jack_add_gpios(&hp_jack, ARRAY_SIZE(hp_jack_gpios),
 | |
| 		hp_jack_gpios);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| /* s3c24xx digital audio interface glue - connects codec <--> CPU */
 | |
| SND_SOC_DAILINK_DEFS(uda1380,
 | |
| 	DAILINK_COMP_ARRAY(COMP_CPU("s3c24xx-iis")),
 | |
| 	DAILINK_COMP_ARRAY(COMP_CODEC("uda1380-codec.0-001a", "uda1380-hifi")),
 | |
| 	DAILINK_COMP_ARRAY(COMP_PLATFORM("s3c24xx-iis")));
 | |
| 
 | |
| static struct snd_soc_dai_link h1940_uda1380_dai[] = {
 | |
| 	{
 | |
| 		.name		= "uda1380",
 | |
| 		.stream_name	= "UDA1380 Duplex",
 | |
| 		.init		= h1940_uda1380_init,
 | |
| 		.dai_fmt	= SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF |
 | |
| 				  SND_SOC_DAIFMT_CBS_CFS,
 | |
| 		.ops		= &h1940_ops,
 | |
| 		SND_SOC_DAILINK_REG(uda1380),
 | |
| 	},
 | |
| };
 | |
| 
 | |
| static struct snd_soc_card h1940_asoc = {
 | |
| 	.name = "h1940",
 | |
| 	.owner = THIS_MODULE,
 | |
| 	.dai_link = h1940_uda1380_dai,
 | |
| 	.num_links = ARRAY_SIZE(h1940_uda1380_dai),
 | |
| 
 | |
| 	.dapm_widgets = uda1380_dapm_widgets,
 | |
| 	.num_dapm_widgets = ARRAY_SIZE(uda1380_dapm_widgets),
 | |
| 	.dapm_routes = audio_map,
 | |
| 	.num_dapm_routes = ARRAY_SIZE(audio_map),
 | |
| };
 | |
| 
 | |
| static int h1940_probe(struct platform_device *pdev)
 | |
| {
 | |
| 	struct device *dev = &pdev->dev;
 | |
| 
 | |
| 	h1940_asoc.dev = dev;
 | |
| 	hp_jack_gpios[0].gpiod_dev = dev;
 | |
| 	gpiod_speaker_power = devm_gpiod_get(&pdev->dev, "speaker-power",
 | |
| 					     GPIOD_OUT_LOW);
 | |
| 
 | |
| 	if (IS_ERR(gpiod_speaker_power)) {
 | |
| 		dev_err(dev, "Could not get gpio\n");
 | |
| 		return PTR_ERR(gpiod_speaker_power);
 | |
| 	}
 | |
| 
 | |
| 	return devm_snd_soc_register_card(dev, &h1940_asoc);
 | |
| }
 | |
| 
 | |
| static struct platform_driver h1940_audio_driver = {
 | |
| 	.driver = {
 | |
| 		.name = "h1940-audio",
 | |
| 		.pm = &snd_soc_pm_ops,
 | |
| 	},
 | |
| 	.probe = h1940_probe,
 | |
| };
 | |
| module_platform_driver(h1940_audio_driver);
 | |
| 
 | |
| /* Module information */
 | |
| MODULE_AUTHOR("Arnaud Patard, Vasily Khoruzhick");
 | |
| MODULE_DESCRIPTION("ALSA SoC H1940");
 | |
| MODULE_LICENSE("GPL");
 | |
| MODULE_ALIAS("platform:h1940-audio");
 |