246 lines
		
	
	
		
			6.0 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			246 lines
		
	
	
		
			6.0 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| // SPDX-License-Identifier: GPL-2.0+
 | |
| //
 | |
| // rx1950.c - ALSA SoC Audio Layer
 | |
| //
 | |
| // Copyright (c) 2010 Vasily Khoruzhick <anarsoul@gmail.com>
 | |
| //
 | |
| // Based on smdk2440.c and magician.c
 | |
| //
 | |
| // Authors: Graeme Gregory graeme.gregory@wolfsonmicro.com
 | |
| //          Philipp Zabel <philipp.zabel@gmail.com>
 | |
| //          Denis Grigoriev <dgreenday@gmail.com>
 | |
| //          Vasily Khoruzhick <anarsoul@gmail.com>
 | |
| 
 | |
| #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 int rx1950_uda1380_init(struct snd_soc_pcm_runtime *rtd);
 | |
| static int rx1950_startup(struct snd_pcm_substream *substream);
 | |
| static int rx1950_hw_params(struct snd_pcm_substream *substream,
 | |
| 				struct snd_pcm_hw_params *params);
 | |
| static int rx1950_spk_power(struct snd_soc_dapm_widget *w,
 | |
| 				struct snd_kcontrol *kcontrol, int event);
 | |
| 
 | |
| static const unsigned int rates[] = {
 | |
| 	16000,
 | |
| 	44100,
 | |
| 	48000,
 | |
| };
 | |
| 
 | |
| static const struct snd_pcm_hw_constraint_list hw_rates = {
 | |
| 	.count = ARRAY_SIZE(rates),
 | |
| 	.list = rates,
 | |
| };
 | |
| 
 | |
| 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[] = {
 | |
| 	[0] = {
 | |
| 		.name			= "hp-gpio",
 | |
| 		.report			= SND_JACK_HEADPHONE,
 | |
| 		.invert			= 1,
 | |
| 		.debounce_time		= 200,
 | |
| 	},
 | |
| };
 | |
| 
 | |
| static const struct snd_soc_ops rx1950_ops = {
 | |
| 	.startup	= rx1950_startup,
 | |
| 	.hw_params	= rx1950_hw_params,
 | |
| };
 | |
| 
 | |
| /* 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 rx1950_uda1380_dai[] = {
 | |
| 	{
 | |
| 		.name		= "uda1380",
 | |
| 		.stream_name	= "UDA1380 Duplex",
 | |
| 		.init		= rx1950_uda1380_init,
 | |
| 		.dai_fmt	= SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF |
 | |
| 				  SND_SOC_DAIFMT_CBS_CFS,
 | |
| 		.ops		= &rx1950_ops,
 | |
| 		SND_SOC_DAILINK_REG(uda1380),
 | |
| 	},
 | |
| };
 | |
| 
 | |
| /* rx1950 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", rx1950_spk_power),
 | |
| };
 | |
| 
 | |
| /* rx1950 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 struct snd_soc_card rx1950_asoc = {
 | |
| 	.name = "rx1950",
 | |
| 	.owner = THIS_MODULE,
 | |
| 	.dai_link = rx1950_uda1380_dai,
 | |
| 	.num_links = ARRAY_SIZE(rx1950_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 rx1950_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 struct gpio_desc *gpiod_speaker_power;
 | |
| 
 | |
| static int rx1950_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;
 | |
| }
 | |
| 
 | |
| static int rx1950_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);
 | |
| 	int clk_source, fs_mode;
 | |
| 
 | |
| 	switch (rate) {
 | |
| 	case 16000:
 | |
| 	case 48000:
 | |
| 		clk_source = S3C24XX_CLKSRC_PCLK;
 | |
| 		fs_mode = S3C2410_IISMOD_256FS;
 | |
| 		div = s3c24xx_i2s_get_clockrate() / (256 * rate);
 | |
| 		if (s3c24xx_i2s_get_clockrate() % (256 * rate) > (128 * rate))
 | |
| 			div++;
 | |
| 		break;
 | |
| 	case 44100:
 | |
| 	case 88200:
 | |
| 		clk_source = S3C24XX_CLKSRC_MPLL;
 | |
| 		fs_mode = S3C2410_IISMOD_384FS;
 | |
| 		div = 1;
 | |
| 		break;
 | |
| 	default:
 | |
| 		printk(KERN_ERR "%s: rate %d is not supported\n",
 | |
| 			__func__, rate);
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	/* select clock source */
 | |
| 	ret = snd_soc_dai_set_sysclk(cpu_dai, clk_source, 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,
 | |
| 		fs_mode);
 | |
| 	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 int rx1950_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;
 | |
| }
 | |
| 
 | |
| static int rx1950_probe(struct platform_device *pdev)
 | |
| {
 | |
| 	struct device *dev = &pdev->dev;
 | |
| 
 | |
| 	/* configure some gpios */
 | |
| 	gpiod_speaker_power = devm_gpiod_get(dev, "speaker-power", GPIOD_OUT_LOW);
 | |
| 	if (IS_ERR(gpiod_speaker_power)) {
 | |
| 		dev_err(dev, "cannot get gpio\n");
 | |
| 		return PTR_ERR(gpiod_speaker_power);
 | |
| 	}
 | |
| 
 | |
| 	hp_jack_gpios[0].gpiod_dev = dev;
 | |
| 	rx1950_asoc.dev = dev;
 | |
| 
 | |
| 	return devm_snd_soc_register_card(dev, &rx1950_asoc);
 | |
| }
 | |
| 
 | |
| static struct platform_driver rx1950_audio = {
 | |
| 	.driver = {
 | |
| 		.name = "rx1950-audio",
 | |
| 		.pm = &snd_soc_pm_ops,
 | |
| 	},
 | |
| 	.probe = rx1950_probe,
 | |
| };
 | |
| 
 | |
| module_platform_driver(rx1950_audio);
 | |
| 
 | |
| /* Module information */
 | |
| MODULE_AUTHOR("Vasily Khoruzhick");
 | |
| MODULE_DESCRIPTION("ALSA SoC RX1950");
 | |
| MODULE_LICENSE("GPL");
 | |
| MODULE_ALIAS("platform:rx1950-audio");
 |