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");
 |