123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404 |
- /*
- * pxa2xx-i2s.c -- ALSA Soc Audio Layer
- *
- * Copyright 2005 Wolfson Microelectronics PLC.
- * Author: Liam Girdwood
- * lrg@slimlogic.co.uk
- *
- * This program is free software; you can redistribute it and/or modify it
- * under the terms of the GNU General Public License as published by the
- * Free Software Foundation; either version 2 of the License, or (at your
- * option) any later version.
- */
- #include <linux/init.h>
- #include <linux/module.h>
- #include <linux/device.h>
- #include <linux/delay.h>
- #include <linux/clk.h>
- #include <linux/platform_device.h>
- #include <linux/io.h>
- #include <sound/core.h>
- #include <sound/pcm.h>
- #include <sound/initval.h>
- #include <sound/soc.h>
- #include <sound/pxa2xx-lib.h>
- #include <sound/dmaengine_pcm.h>
- #include <mach/hardware.h>
- #include <mach/audio.h>
- #include "pxa2xx-i2s.h"
- /*
- * I2S Controller Register and Bit Definitions
- */
- #define SACR0 __REG(0x40400000) /* Global Control Register */
- #define SACR1 __REG(0x40400004) /* Serial Audio I 2 S/MSB-Justified Control Register */
- #define SASR0 __REG(0x4040000C) /* Serial Audio I 2 S/MSB-Justified Interface and FIFO Status Register */
- #define SAIMR __REG(0x40400014) /* Serial Audio Interrupt Mask Register */
- #define SAICR __REG(0x40400018) /* Serial Audio Interrupt Clear Register */
- #define SADIV __REG(0x40400060) /* Audio Clock Divider Register. */
- #define SADR __REG(0x40400080) /* Serial Audio Data Register (TX and RX FIFO access Register). */
- #define SACR0_RFTH(x) ((x) << 12) /* Rx FIFO Interrupt or DMA Trigger Threshold */
- #define SACR0_TFTH(x) ((x) << 8) /* Tx FIFO Interrupt or DMA Trigger Threshold */
- #define SACR0_STRF (1 << 5) /* FIFO Select for EFWR Special Function */
- #define SACR0_EFWR (1 << 4) /* Enable EFWR Function */
- #define SACR0_RST (1 << 3) /* FIFO, i2s Register Reset */
- #define SACR0_BCKD (1 << 2) /* Bit Clock Direction */
- #define SACR0_ENB (1 << 0) /* Enable I2S Link */
- #define SACR1_ENLBF (1 << 5) /* Enable Loopback */
- #define SACR1_DRPL (1 << 4) /* Disable Replaying Function */
- #define SACR1_DREC (1 << 3) /* Disable Recording Function */
- #define SACR1_AMSL (1 << 0) /* Specify Alternate Mode */
- #define SASR0_I2SOFF (1 << 7) /* Controller Status */
- #define SASR0_ROR (1 << 6) /* Rx FIFO Overrun */
- #define SASR0_TUR (1 << 5) /* Tx FIFO Underrun */
- #define SASR0_RFS (1 << 4) /* Rx FIFO Service Request */
- #define SASR0_TFS (1 << 3) /* Tx FIFO Service Request */
- #define SASR0_BSY (1 << 2) /* I2S Busy */
- #define SASR0_RNE (1 << 1) /* Rx FIFO Not Empty */
- #define SASR0_TNF (1 << 0) /* Tx FIFO Not Empty */
- #define SAICR_ROR (1 << 6) /* Clear Rx FIFO Overrun Interrupt */
- #define SAICR_TUR (1 << 5) /* Clear Tx FIFO Underrun Interrupt */
- #define SAIMR_ROR (1 << 6) /* Enable Rx FIFO Overrun Condition Interrupt */
- #define SAIMR_TUR (1 << 5) /* Enable Tx FIFO Underrun Condition Interrupt */
- #define SAIMR_RFS (1 << 4) /* Enable Rx FIFO Service Interrupt */
- #define SAIMR_TFS (1 << 3) /* Enable Tx FIFO Service Interrupt */
- struct pxa_i2s_port {
- u32 sadiv;
- u32 sacr0;
- u32 sacr1;
- u32 saimr;
- int master;
- u32 fmt;
- };
- static struct pxa_i2s_port pxa_i2s;
- static struct clk *clk_i2s;
- static int clk_ena = 0;
- static unsigned long pxa2xx_i2s_pcm_stereo_out_req = 3;
- static struct snd_dmaengine_dai_dma_data pxa2xx_i2s_pcm_stereo_out = {
- .addr = __PREG(SADR),
- .addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES,
- .maxburst = 32,
- .filter_data = &pxa2xx_i2s_pcm_stereo_out_req,
- };
- static unsigned long pxa2xx_i2s_pcm_stereo_in_req = 2;
- static struct snd_dmaengine_dai_dma_data pxa2xx_i2s_pcm_stereo_in = {
- .addr = __PREG(SADR),
- .addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES,
- .maxburst = 32,
- .filter_data = &pxa2xx_i2s_pcm_stereo_in_req,
- };
- static int pxa2xx_i2s_startup(struct snd_pcm_substream *substream,
- struct snd_soc_dai *dai)
- {
- struct snd_soc_pcm_runtime *rtd = substream->private_data;
- struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
- if (IS_ERR(clk_i2s))
- return PTR_ERR(clk_i2s);
- if (!cpu_dai->active)
- SACR0 = 0;
- return 0;
- }
- /* wait for I2S controller to be ready */
- static int pxa_i2s_wait(void)
- {
- int i;
- /* flush the Rx FIFO */
- for(i = 0; i < 16; i++)
- SADR;
- return 0;
- }
- static int pxa2xx_i2s_set_dai_fmt(struct snd_soc_dai *cpu_dai,
- unsigned int fmt)
- {
- /* interface format */
- switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
- case SND_SOC_DAIFMT_I2S:
- pxa_i2s.fmt = 0;
- break;
- case SND_SOC_DAIFMT_LEFT_J:
- pxa_i2s.fmt = SACR1_AMSL;
- break;
- }
- switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
- case SND_SOC_DAIFMT_CBS_CFS:
- pxa_i2s.master = 1;
- break;
- case SND_SOC_DAIFMT_CBM_CFS:
- pxa_i2s.master = 0;
- break;
- default:
- break;
- }
- return 0;
- }
- static int pxa2xx_i2s_set_dai_sysclk(struct snd_soc_dai *cpu_dai,
- int clk_id, unsigned int freq, int dir)
- {
- if (clk_id != PXA2XX_I2S_SYSCLK)
- return -ENODEV;
- return 0;
- }
- static int pxa2xx_i2s_hw_params(struct snd_pcm_substream *substream,
- struct snd_pcm_hw_params *params,
- struct snd_soc_dai *dai)
- {
- struct snd_dmaengine_dai_dma_data *dma_data;
- if (WARN_ON(IS_ERR(clk_i2s)))
- return -EINVAL;
- clk_prepare_enable(clk_i2s);
- clk_ena = 1;
- pxa_i2s_wait();
- if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
- dma_data = &pxa2xx_i2s_pcm_stereo_out;
- else
- dma_data = &pxa2xx_i2s_pcm_stereo_in;
- snd_soc_dai_set_dma_data(dai, substream, dma_data);
- /* is port used by another stream */
- if (!(SACR0 & SACR0_ENB)) {
- SACR0 = 0;
- if (pxa_i2s.master)
- SACR0 |= SACR0_BCKD;
- SACR0 |= SACR0_RFTH(14) | SACR0_TFTH(1);
- SACR1 |= pxa_i2s.fmt;
- }
- if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
- SAIMR |= SAIMR_TFS;
- else
- SAIMR |= SAIMR_RFS;
- switch (params_rate(params)) {
- case 8000:
- SADIV = 0x48;
- break;
- case 11025:
- SADIV = 0x34;
- break;
- case 16000:
- SADIV = 0x24;
- break;
- case 22050:
- SADIV = 0x1a;
- break;
- case 44100:
- SADIV = 0xd;
- break;
- case 48000:
- SADIV = 0xc;
- break;
- case 96000: /* not in manual and possibly slightly inaccurate */
- SADIV = 0x6;
- break;
- }
- return 0;
- }
- static int pxa2xx_i2s_trigger(struct snd_pcm_substream *substream, int cmd,
- struct snd_soc_dai *dai)
- {
- int ret = 0;
- switch (cmd) {
- case SNDRV_PCM_TRIGGER_START:
- if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
- SACR1 &= ~SACR1_DRPL;
- else
- SACR1 &= ~SACR1_DREC;
- SACR0 |= SACR0_ENB;
- break;
- case SNDRV_PCM_TRIGGER_RESUME:
- case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
- case SNDRV_PCM_TRIGGER_STOP:
- case SNDRV_PCM_TRIGGER_SUSPEND:
- case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
- break;
- default:
- ret = -EINVAL;
- }
- return ret;
- }
- static void pxa2xx_i2s_shutdown(struct snd_pcm_substream *substream,
- struct snd_soc_dai *dai)
- {
- if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
- SACR1 |= SACR1_DRPL;
- SAIMR &= ~SAIMR_TFS;
- } else {
- SACR1 |= SACR1_DREC;
- SAIMR &= ~SAIMR_RFS;
- }
- if ((SACR1 & (SACR1_DREC | SACR1_DRPL)) == (SACR1_DREC | SACR1_DRPL)) {
- SACR0 &= ~SACR0_ENB;
- pxa_i2s_wait();
- if (clk_ena) {
- clk_disable_unprepare(clk_i2s);
- clk_ena = 0;
- }
- }
- }
- #ifdef CONFIG_PM
- static int pxa2xx_i2s_suspend(struct snd_soc_dai *dai)
- {
- /* store registers */
- pxa_i2s.sacr0 = SACR0;
- pxa_i2s.sacr1 = SACR1;
- pxa_i2s.saimr = SAIMR;
- pxa_i2s.sadiv = SADIV;
- /* deactivate link */
- SACR0 &= ~SACR0_ENB;
- pxa_i2s_wait();
- return 0;
- }
- static int pxa2xx_i2s_resume(struct snd_soc_dai *dai)
- {
- pxa_i2s_wait();
- SACR0 = pxa_i2s.sacr0 & ~SACR0_ENB;
- SACR1 = pxa_i2s.sacr1;
- SAIMR = pxa_i2s.saimr;
- SADIV = pxa_i2s.sadiv;
- SACR0 = pxa_i2s.sacr0;
- return 0;
- }
- #else
- #define pxa2xx_i2s_suspend NULL
- #define pxa2xx_i2s_resume NULL
- #endif
- static int pxa2xx_i2s_probe(struct snd_soc_dai *dai)
- {
- clk_i2s = clk_get(dai->dev, "I2SCLK");
- if (IS_ERR(clk_i2s))
- return PTR_ERR(clk_i2s);
- /*
- * PXA Developer's Manual:
- * If SACR0[ENB] is toggled in the middle of a normal operation,
- * the SACR0[RST] bit must also be set and cleared to reset all
- * I2S controller registers.
- */
- SACR0 = SACR0_RST;
- SACR0 = 0;
- /* Make sure RPL and REC are disabled */
- SACR1 = SACR1_DRPL | SACR1_DREC;
- /* Along with FIFO servicing */
- SAIMR &= ~(SAIMR_RFS | SAIMR_TFS);
- snd_soc_dai_init_dma_data(dai, &pxa2xx_i2s_pcm_stereo_out,
- &pxa2xx_i2s_pcm_stereo_in);
- return 0;
- }
- static int pxa2xx_i2s_remove(struct snd_soc_dai *dai)
- {
- clk_put(clk_i2s);
- clk_i2s = ERR_PTR(-ENOENT);
- return 0;
- }
- #define PXA2XX_I2S_RATES (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |\
- SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 | SNDRV_PCM_RATE_44100 | \
- SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_96000)
- static const struct snd_soc_dai_ops pxa_i2s_dai_ops = {
- .startup = pxa2xx_i2s_startup,
- .shutdown = pxa2xx_i2s_shutdown,
- .trigger = pxa2xx_i2s_trigger,
- .hw_params = pxa2xx_i2s_hw_params,
- .set_fmt = pxa2xx_i2s_set_dai_fmt,
- .set_sysclk = pxa2xx_i2s_set_dai_sysclk,
- };
- static struct snd_soc_dai_driver pxa_i2s_dai = {
- .probe = pxa2xx_i2s_probe,
- .remove = pxa2xx_i2s_remove,
- .suspend = pxa2xx_i2s_suspend,
- .resume = pxa2xx_i2s_resume,
- .playback = {
- .channels_min = 2,
- .channels_max = 2,
- .rates = PXA2XX_I2S_RATES,
- .formats = SNDRV_PCM_FMTBIT_S16_LE,},
- .capture = {
- .channels_min = 2,
- .channels_max = 2,
- .rates = PXA2XX_I2S_RATES,
- .formats = SNDRV_PCM_FMTBIT_S16_LE,},
- .ops = &pxa_i2s_dai_ops,
- .symmetric_rates = 1,
- };
- static const struct snd_soc_component_driver pxa_i2s_component = {
- .name = "pxa-i2s",
- };
- static int pxa2xx_i2s_drv_probe(struct platform_device *pdev)
- {
- return devm_snd_soc_register_component(&pdev->dev, &pxa_i2s_component,
- &pxa_i2s_dai, 1);
- }
- static struct platform_driver pxa2xx_i2s_driver = {
- .probe = pxa2xx_i2s_drv_probe,
- .driver = {
- .name = "pxa2xx-i2s",
- },
- };
- static int __init pxa2xx_i2s_init(void)
- {
- clk_i2s = ERR_PTR(-ENOENT);
- return platform_driver_register(&pxa2xx_i2s_driver);
- }
- static void __exit pxa2xx_i2s_exit(void)
- {
- platform_driver_unregister(&pxa2xx_i2s_driver);
- }
- module_init(pxa2xx_i2s_init);
- module_exit(pxa2xx_i2s_exit);
- /* Module information */
- MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk");
- MODULE_DESCRIPTION("pxa2xx I2S SoC Interface");
- MODULE_LICENSE("GPL");
- MODULE_ALIAS("platform:pxa2xx-i2s");
|