115 lines
		
	
	
		
			2.5 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			115 lines
		
	
	
		
			2.5 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| 
 | |
| #include <linux/module.h>
 | |
| #include <sound/soc.h>
 | |
| 
 | |
| #include <asm/mach-types.h>
 | |
| 
 | |
| #include "../codecs/wm8940.h"
 | |
| #include "pxa2xx-i2s.h"
 | |
| #include "pxa2xx-pcm.h"
 | |
| 
 | |
| static int imote2_asoc_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;
 | |
| 	unsigned int clk = 0;
 | |
| 	int ret;
 | |
| 
 | |
| 	switch (params_rate(params)) {
 | |
| 	case 8000:
 | |
| 	case 16000:
 | |
| 	case 48000:
 | |
| 	case 96000:
 | |
| 		clk = 12288000;
 | |
| 		break;
 | |
| 	case 11025:
 | |
| 	case 22050:
 | |
| 	case 44100:
 | |
| 		clk = 11289600;
 | |
| 		break;
 | |
| 	}
 | |
| 
 | |
| 	/* set codec DAI configuration */
 | |
| 	ret = snd_soc_dai_set_fmt(codec_dai, SND_SOC_DAIFMT_I2S
 | |
| 				  | SND_SOC_DAIFMT_NB_NF
 | |
| 				  | SND_SOC_DAIFMT_CBS_CFS);
 | |
| 	if (ret < 0)
 | |
| 		return ret;
 | |
| 
 | |
| 	/* CPU should be clock master */
 | |
| 	ret = snd_soc_dai_set_fmt(cpu_dai,  SND_SOC_DAIFMT_I2S
 | |
| 				  | SND_SOC_DAIFMT_NB_NF
 | |
| 				  | SND_SOC_DAIFMT_CBS_CFS);
 | |
| 	if (ret < 0)
 | |
| 		return ret;
 | |
| 
 | |
| 	ret = snd_soc_dai_set_sysclk(codec_dai, 0, clk,
 | |
| 				     SND_SOC_CLOCK_IN);
 | |
| 	if (ret < 0)
 | |
| 		return ret;
 | |
| 
 | |
| 	/* set the I2S system clock as input (unused) */
 | |
| 	ret = snd_soc_dai_set_sysclk(cpu_dai, PXA2XX_I2S_SYSCLK, clk,
 | |
| 		SND_SOC_CLOCK_OUT);
 | |
| 
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| static struct snd_soc_ops imote2_asoc_ops = {
 | |
| 	.hw_params = imote2_asoc_hw_params,
 | |
| };
 | |
| 
 | |
| static struct snd_soc_dai_link imote2_dai = {
 | |
| 	.name = "WM8940",
 | |
| 	.stream_name = "WM8940",
 | |
| 	.cpu_dai = &pxa_i2s_dai,
 | |
| 	.codec_dai = &wm8940_dai,
 | |
| 	.ops = &imote2_asoc_ops,
 | |
| };
 | |
| 
 | |
| static struct snd_soc_card snd_soc_imote2 = {
 | |
| 	.name = "Imote2",
 | |
| 	.platform = &pxa2xx_soc_platform,
 | |
| 	.dai_link = &imote2_dai,
 | |
| 	.num_links = 1,
 | |
| };
 | |
| 
 | |
| static struct snd_soc_device imote2_snd_devdata = {
 | |
| 	.card = &snd_soc_imote2,
 | |
| 	.codec_dev = &soc_codec_dev_wm8940,
 | |
| };
 | |
| 
 | |
| static struct platform_device *imote2_snd_device;
 | |
| 
 | |
| static int __init imote2_asoc_init(void)
 | |
| {
 | |
| 	int ret;
 | |
| 
 | |
| 	if (!machine_is_intelmote2())
 | |
| 		return -ENODEV;
 | |
| 	imote2_snd_device = platform_device_alloc("soc-audio", -1);
 | |
| 	if (!imote2_snd_device)
 | |
| 		return -ENOMEM;
 | |
| 
 | |
| 	platform_set_drvdata(imote2_snd_device, &imote2_snd_devdata);
 | |
| 	imote2_snd_devdata.dev = &imote2_snd_device->dev;
 | |
| 	ret = platform_device_add(imote2_snd_device);
 | |
| 	if (ret)
 | |
| 		platform_device_put(imote2_snd_device);
 | |
| 
 | |
| 	return ret;
 | |
| }
 | |
| module_init(imote2_asoc_init);
 | |
| 
 | |
| static void __exit imote2_asoc_exit(void)
 | |
| {
 | |
| 	platform_device_unregister(imote2_snd_device);
 | |
| }
 | |
| module_exit(imote2_asoc_exit);
 | |
| 
 | |
| MODULE_AUTHOR("Jonathan Cameron");
 | |
| MODULE_DESCRIPTION("ALSA SoC Imote 2");
 | |
| MODULE_LICENSE("GPL");
 |