Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 1 | /* |
| 2 | * Freescale SSI ALSA SoC Digital Audio Interface (DAI) driver |
| 3 | * |
| 4 | * Author: Timur Tabi <timur@freescale.com> |
| 5 | * |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 6 | * Copyright 2007-2010 Freescale Semiconductor, Inc. |
| 7 | * |
| 8 | * This file is licensed under the terms of the GNU General Public License |
| 9 | * version 2. This program is licensed "as is" without any warranty of any |
| 10 | * kind, whether express or implied. |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 11 | */ |
| 12 | |
| 13 | #include <linux/init.h> |
| 14 | #include <linux/module.h> |
| 15 | #include <linux/interrupt.h> |
| 16 | #include <linux/device.h> |
| 17 | #include <linux/delay.h> |
Tejun Heo | 5a0e3ad | 2010-03-24 17:04:11 +0900 | [diff] [blame] | 18 | #include <linux/slab.h> |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 19 | #include <linux/of_platform.h> |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 20 | |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 21 | #include <sound/core.h> |
| 22 | #include <sound/pcm.h> |
| 23 | #include <sound/pcm_params.h> |
| 24 | #include <sound/initval.h> |
| 25 | #include <sound/soc.h> |
| 26 | |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 27 | #include "fsl_ssi.h" |
| 28 | |
| 29 | /** |
| 30 | * FSLSSI_I2S_RATES: sample rates supported by the I2S |
| 31 | * |
| 32 | * This driver currently only supports the SSI running in I2S slave mode, |
| 33 | * which means the codec determines the sample rate. Therefore, we tell |
| 34 | * ALSA that we support all rates and let the codec driver decide what rates |
| 35 | * are really supported. |
| 36 | */ |
| 37 | #define FSLSSI_I2S_RATES (SNDRV_PCM_RATE_5512 | SNDRV_PCM_RATE_8000_192000 | \ |
| 38 | SNDRV_PCM_RATE_CONTINUOUS) |
| 39 | |
| 40 | /** |
| 41 | * FSLSSI_I2S_FORMATS: audio formats supported by the SSI |
| 42 | * |
| 43 | * This driver currently only supports the SSI running in I2S slave mode. |
| 44 | * |
| 45 | * The SSI has a limitation in that the samples must be in the same byte |
| 46 | * order as the host CPU. This is because when multiple bytes are written |
| 47 | * to the STX register, the bytes and bits must be written in the same |
| 48 | * order. The STX is a shift register, so all the bits need to be aligned |
| 49 | * (bit-endianness must match byte-endianness). Processors typically write |
| 50 | * the bits within a byte in the same order that the bytes of a word are |
| 51 | * written in. So if the host CPU is big-endian, then only big-endian |
| 52 | * samples will be written to STX properly. |
| 53 | */ |
| 54 | #ifdef __BIG_ENDIAN |
| 55 | #define FSLSSI_I2S_FORMATS (SNDRV_PCM_FMTBIT_S8 | SNDRV_PCM_FMTBIT_S16_BE | \ |
| 56 | SNDRV_PCM_FMTBIT_S18_3BE | SNDRV_PCM_FMTBIT_S20_3BE | \ |
| 57 | SNDRV_PCM_FMTBIT_S24_3BE | SNDRV_PCM_FMTBIT_S24_BE) |
| 58 | #else |
| 59 | #define FSLSSI_I2S_FORMATS (SNDRV_PCM_FMTBIT_S8 | SNDRV_PCM_FMTBIT_S16_LE | \ |
| 60 | SNDRV_PCM_FMTBIT_S18_3LE | SNDRV_PCM_FMTBIT_S20_3LE | \ |
| 61 | SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_S24_LE) |
| 62 | #endif |
| 63 | |
Timur Tabi | d5a908b | 2009-03-26 11:42:38 -0500 | [diff] [blame] | 64 | /* SIER bitflag of interrupts to enable */ |
| 65 | #define SIER_FLAGS (CCSR_SSI_SIER_TFRC_EN | CCSR_SSI_SIER_TDMAE | \ |
| 66 | CCSR_SSI_SIER_TIE | CCSR_SSI_SIER_TUE0_EN | \ |
| 67 | CCSR_SSI_SIER_TUE1_EN | CCSR_SSI_SIER_RFRC_EN | \ |
| 68 | CCSR_SSI_SIER_RDMAE | CCSR_SSI_SIER_RIE | \ |
| 69 | CCSR_SSI_SIER_ROE0_EN | CCSR_SSI_SIER_ROE1_EN) |
| 70 | |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 71 | /** |
| 72 | * fsl_ssi_private: per-SSI private data |
| 73 | * |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 74 | * @ssi: pointer to the SSI's registers |
| 75 | * @ssi_phys: physical address of the SSI registers |
| 76 | * @irq: IRQ of this SSI |
Timur Tabi | be41e94 | 2008-07-28 17:04:39 -0500 | [diff] [blame] | 77 | * @first_stream: pointer to the stream that was opened first |
| 78 | * @second_stream: pointer to second stream |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 79 | * @playback: the number of playback streams opened |
| 80 | * @capture: the number of capture streams opened |
Timur Tabi | a454dad | 2009-03-05 17:23:37 -0600 | [diff] [blame] | 81 | * @asynchronous: 0=synchronous mode, 1=asynchronous mode |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 82 | * @cpu_dai: the CPU DAI for this device |
| 83 | * @dev_attr: the sysfs device attribute structure |
| 84 | * @stats: SSI statistics |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 85 | * @name: name for this device |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 86 | */ |
| 87 | struct fsl_ssi_private { |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 88 | struct ccsr_ssi __iomem *ssi; |
| 89 | dma_addr_t ssi_phys; |
| 90 | unsigned int irq; |
Timur Tabi | be41e94 | 2008-07-28 17:04:39 -0500 | [diff] [blame] | 91 | struct snd_pcm_substream *first_stream; |
| 92 | struct snd_pcm_substream *second_stream; |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 93 | unsigned int playback; |
| 94 | unsigned int capture; |
Timur Tabi | a454dad | 2009-03-05 17:23:37 -0600 | [diff] [blame] | 95 | int asynchronous; |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 96 | struct snd_soc_dai_driver cpu_dai_drv; |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 97 | struct device_attribute dev_attr; |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 98 | struct platform_device *pdev; |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 99 | |
| 100 | struct { |
| 101 | unsigned int rfrc; |
| 102 | unsigned int tfrc; |
| 103 | unsigned int cmdau; |
| 104 | unsigned int cmddu; |
| 105 | unsigned int rxt; |
| 106 | unsigned int rdr1; |
| 107 | unsigned int rdr0; |
| 108 | unsigned int tde1; |
| 109 | unsigned int tde0; |
| 110 | unsigned int roe1; |
| 111 | unsigned int roe0; |
| 112 | unsigned int tue1; |
| 113 | unsigned int tue0; |
| 114 | unsigned int tfs; |
| 115 | unsigned int rfs; |
| 116 | unsigned int tls; |
| 117 | unsigned int rls; |
| 118 | unsigned int rff1; |
| 119 | unsigned int rff0; |
| 120 | unsigned int tfe1; |
| 121 | unsigned int tfe0; |
| 122 | } stats; |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 123 | |
| 124 | char name[1]; |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 125 | }; |
| 126 | |
| 127 | /** |
| 128 | * fsl_ssi_isr: SSI interrupt handler |
| 129 | * |
| 130 | * Although it's possible to use the interrupt handler to send and receive |
| 131 | * data to/from the SSI, we use the DMA instead. Programming is more |
| 132 | * complicated, but the performance is much better. |
| 133 | * |
| 134 | * This interrupt handler is used only to gather statistics. |
| 135 | * |
| 136 | * @irq: IRQ of the SSI device |
| 137 | * @dev_id: pointer to the ssi_private structure for this SSI device |
| 138 | */ |
| 139 | static irqreturn_t fsl_ssi_isr(int irq, void *dev_id) |
| 140 | { |
| 141 | struct fsl_ssi_private *ssi_private = dev_id; |
| 142 | struct ccsr_ssi __iomem *ssi = ssi_private->ssi; |
| 143 | irqreturn_t ret = IRQ_NONE; |
| 144 | __be32 sisr; |
| 145 | __be32 sisr2 = 0; |
| 146 | |
| 147 | /* We got an interrupt, so read the status register to see what we |
| 148 | were interrupted for. We mask it with the Interrupt Enable register |
| 149 | so that we only check for events that we're interested in. |
| 150 | */ |
Timur Tabi | d5a908b | 2009-03-26 11:42:38 -0500 | [diff] [blame] | 151 | sisr = in_be32(&ssi->sisr) & SIER_FLAGS; |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 152 | |
| 153 | if (sisr & CCSR_SSI_SISR_RFRC) { |
| 154 | ssi_private->stats.rfrc++; |
| 155 | sisr2 |= CCSR_SSI_SISR_RFRC; |
| 156 | ret = IRQ_HANDLED; |
| 157 | } |
| 158 | |
| 159 | if (sisr & CCSR_SSI_SISR_TFRC) { |
| 160 | ssi_private->stats.tfrc++; |
| 161 | sisr2 |= CCSR_SSI_SISR_TFRC; |
| 162 | ret = IRQ_HANDLED; |
| 163 | } |
| 164 | |
| 165 | if (sisr & CCSR_SSI_SISR_CMDAU) { |
| 166 | ssi_private->stats.cmdau++; |
| 167 | ret = IRQ_HANDLED; |
| 168 | } |
| 169 | |
| 170 | if (sisr & CCSR_SSI_SISR_CMDDU) { |
| 171 | ssi_private->stats.cmddu++; |
| 172 | ret = IRQ_HANDLED; |
| 173 | } |
| 174 | |
| 175 | if (sisr & CCSR_SSI_SISR_RXT) { |
| 176 | ssi_private->stats.rxt++; |
| 177 | ret = IRQ_HANDLED; |
| 178 | } |
| 179 | |
| 180 | if (sisr & CCSR_SSI_SISR_RDR1) { |
| 181 | ssi_private->stats.rdr1++; |
| 182 | ret = IRQ_HANDLED; |
| 183 | } |
| 184 | |
| 185 | if (sisr & CCSR_SSI_SISR_RDR0) { |
| 186 | ssi_private->stats.rdr0++; |
| 187 | ret = IRQ_HANDLED; |
| 188 | } |
| 189 | |
| 190 | if (sisr & CCSR_SSI_SISR_TDE1) { |
| 191 | ssi_private->stats.tde1++; |
| 192 | ret = IRQ_HANDLED; |
| 193 | } |
| 194 | |
| 195 | if (sisr & CCSR_SSI_SISR_TDE0) { |
| 196 | ssi_private->stats.tde0++; |
| 197 | ret = IRQ_HANDLED; |
| 198 | } |
| 199 | |
| 200 | if (sisr & CCSR_SSI_SISR_ROE1) { |
| 201 | ssi_private->stats.roe1++; |
| 202 | sisr2 |= CCSR_SSI_SISR_ROE1; |
| 203 | ret = IRQ_HANDLED; |
| 204 | } |
| 205 | |
| 206 | if (sisr & CCSR_SSI_SISR_ROE0) { |
| 207 | ssi_private->stats.roe0++; |
| 208 | sisr2 |= CCSR_SSI_SISR_ROE0; |
| 209 | ret = IRQ_HANDLED; |
| 210 | } |
| 211 | |
| 212 | if (sisr & CCSR_SSI_SISR_TUE1) { |
| 213 | ssi_private->stats.tue1++; |
| 214 | sisr2 |= CCSR_SSI_SISR_TUE1; |
| 215 | ret = IRQ_HANDLED; |
| 216 | } |
| 217 | |
| 218 | if (sisr & CCSR_SSI_SISR_TUE0) { |
| 219 | ssi_private->stats.tue0++; |
| 220 | sisr2 |= CCSR_SSI_SISR_TUE0; |
| 221 | ret = IRQ_HANDLED; |
| 222 | } |
| 223 | |
| 224 | if (sisr & CCSR_SSI_SISR_TFS) { |
| 225 | ssi_private->stats.tfs++; |
| 226 | ret = IRQ_HANDLED; |
| 227 | } |
| 228 | |
| 229 | if (sisr & CCSR_SSI_SISR_RFS) { |
| 230 | ssi_private->stats.rfs++; |
| 231 | ret = IRQ_HANDLED; |
| 232 | } |
| 233 | |
| 234 | if (sisr & CCSR_SSI_SISR_TLS) { |
| 235 | ssi_private->stats.tls++; |
| 236 | ret = IRQ_HANDLED; |
| 237 | } |
| 238 | |
| 239 | if (sisr & CCSR_SSI_SISR_RLS) { |
| 240 | ssi_private->stats.rls++; |
| 241 | ret = IRQ_HANDLED; |
| 242 | } |
| 243 | |
| 244 | if (sisr & CCSR_SSI_SISR_RFF1) { |
| 245 | ssi_private->stats.rff1++; |
| 246 | ret = IRQ_HANDLED; |
| 247 | } |
| 248 | |
| 249 | if (sisr & CCSR_SSI_SISR_RFF0) { |
| 250 | ssi_private->stats.rff0++; |
| 251 | ret = IRQ_HANDLED; |
| 252 | } |
| 253 | |
| 254 | if (sisr & CCSR_SSI_SISR_TFE1) { |
| 255 | ssi_private->stats.tfe1++; |
| 256 | ret = IRQ_HANDLED; |
| 257 | } |
| 258 | |
| 259 | if (sisr & CCSR_SSI_SISR_TFE0) { |
| 260 | ssi_private->stats.tfe0++; |
| 261 | ret = IRQ_HANDLED; |
| 262 | } |
| 263 | |
| 264 | /* Clear the bits that we set */ |
| 265 | if (sisr2) |
| 266 | out_be32(&ssi->sisr, sisr2); |
| 267 | |
| 268 | return ret; |
| 269 | } |
| 270 | |
| 271 | /** |
| 272 | * fsl_ssi_startup: create a new substream |
| 273 | * |
| 274 | * This is the first function called when a stream is opened. |
| 275 | * |
| 276 | * If this is the first stream open, then grab the IRQ and program most of |
| 277 | * the SSI registers. |
| 278 | */ |
Mark Brown | dee89c4 | 2008-11-18 22:11:38 +0000 | [diff] [blame] | 279 | static int fsl_ssi_startup(struct snd_pcm_substream *substream, |
| 280 | struct snd_soc_dai *dai) |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 281 | { |
| 282 | struct snd_soc_pcm_runtime *rtd = substream->private_data; |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 283 | struct fsl_ssi_private *ssi_private = snd_soc_dai_get_drvdata(rtd->cpu_dai); |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 284 | |
| 285 | /* |
| 286 | * If this is the first stream opened, then request the IRQ |
| 287 | * and initialize the SSI registers. |
| 288 | */ |
| 289 | if (!ssi_private->playback && !ssi_private->capture) { |
| 290 | struct ccsr_ssi __iomem *ssi = ssi_private->ssi; |
| 291 | int ret; |
| 292 | |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 293 | /* The 'name' should not have any slashes in it. */ |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 294 | ret = request_irq(ssi_private->irq, fsl_ssi_isr, 0, |
| 295 | ssi_private->name, ssi_private); |
| 296 | if (ret < 0) { |
| 297 | dev_err(substream->pcm->card->dev, |
| 298 | "could not claim irq %u\n", ssi_private->irq); |
| 299 | return ret; |
| 300 | } |
| 301 | |
| 302 | /* |
| 303 | * Section 16.5 of the MPC8610 reference manual says that the |
| 304 | * SSI needs to be disabled before updating the registers we set |
| 305 | * here. |
| 306 | */ |
| 307 | clrbits32(&ssi->scr, CCSR_SSI_SCR_SSIEN); |
| 308 | |
| 309 | /* |
| 310 | * Program the SSI into I2S Slave Non-Network Synchronous mode. |
| 311 | * Also enable the transmit and receive FIFO. |
| 312 | * |
| 313 | * FIXME: Little-endian samples require a different shift dir |
| 314 | */ |
Timur Tabi | a454dad | 2009-03-05 17:23:37 -0600 | [diff] [blame] | 315 | clrsetbits_be32(&ssi->scr, |
| 316 | CCSR_SSI_SCR_I2S_MODE_MASK | CCSR_SSI_SCR_SYN, |
| 317 | CCSR_SSI_SCR_TFR_CLK_DIS | CCSR_SSI_SCR_I2S_MODE_SLAVE |
| 318 | | (ssi_private->asynchronous ? 0 : CCSR_SSI_SCR_SYN)); |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 319 | |
| 320 | out_be32(&ssi->stcr, |
| 321 | CCSR_SSI_STCR_TXBIT0 | CCSR_SSI_STCR_TFEN0 | |
| 322 | CCSR_SSI_STCR_TFSI | CCSR_SSI_STCR_TEFS | |
| 323 | CCSR_SSI_STCR_TSCKP); |
| 324 | |
| 325 | out_be32(&ssi->srcr, |
| 326 | CCSR_SSI_SRCR_RXBIT0 | CCSR_SSI_SRCR_RFEN0 | |
| 327 | CCSR_SSI_SRCR_RFSI | CCSR_SSI_SRCR_REFS | |
| 328 | CCSR_SSI_SRCR_RSCKP); |
| 329 | |
| 330 | /* |
| 331 | * The DC and PM bits are only used if the SSI is the clock |
| 332 | * master. |
| 333 | */ |
| 334 | |
| 335 | /* 4. Enable the interrupts and DMA requests */ |
Timur Tabi | d5a908b | 2009-03-26 11:42:38 -0500 | [diff] [blame] | 336 | out_be32(&ssi->sier, SIER_FLAGS); |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 337 | |
| 338 | /* |
| 339 | * Set the watermark for transmit FIFI 0 and receive FIFO 0. We |
| 340 | * don't use FIFO 1. Since the SSI only supports stereo, the |
| 341 | * watermark should never be an odd number. |
| 342 | */ |
| 343 | out_be32(&ssi->sfcsr, |
| 344 | CCSR_SSI_SFCSR_TFWM0(6) | CCSR_SSI_SFCSR_RFWM0(2)); |
| 345 | |
| 346 | /* |
| 347 | * We keep the SSI disabled because if we enable it, then the |
| 348 | * DMA controller will start. It's not supposed to start until |
| 349 | * the SCR.TE (or SCR.RE) bit is set, but it does anyway. The |
| 350 | * DMA controller will transfer one "BWC" of data (i.e. the |
| 351 | * amount of data that the MR.BWC bits are set to). The reason |
| 352 | * this is bad is because at this point, the PCM driver has not |
| 353 | * finished initializing the DMA controller. |
| 354 | */ |
| 355 | } |
| 356 | |
Timur Tabi | be41e94 | 2008-07-28 17:04:39 -0500 | [diff] [blame] | 357 | if (!ssi_private->first_stream) |
| 358 | ssi_private->first_stream = substream; |
| 359 | else { |
| 360 | /* This is the second stream open, so we need to impose sample |
| 361 | * rate and maybe sample size constraints. Note that this can |
| 362 | * cause a race condition if the second stream is opened before |
| 363 | * the first stream is fully initialized. |
| 364 | * |
| 365 | * We provide some protection by checking to make sure the first |
| 366 | * stream is initialized, but it's not perfect. ALSA sometimes |
| 367 | * re-initializes the driver with a different sample rate or |
| 368 | * size. If the second stream is opened before the first stream |
| 369 | * has received its final parameters, then the second stream may |
| 370 | * be constrained to the wrong sample rate or size. |
| 371 | * |
| 372 | * FIXME: This code does not handle opening and closing streams |
| 373 | * repeatedly. If you open two streams and then close the first |
| 374 | * one, you may not be able to open another stream until you |
| 375 | * close the second one as well. |
| 376 | */ |
| 377 | struct snd_pcm_runtime *first_runtime = |
| 378 | ssi_private->first_stream->runtime; |
| 379 | |
Mark Brown | 08d15f0 | 2009-05-23 10:41:05 +0100 | [diff] [blame] | 380 | if (!first_runtime->sample_bits) { |
Timur Tabi | be41e94 | 2008-07-28 17:04:39 -0500 | [diff] [blame] | 381 | dev_err(substream->pcm->card->dev, |
Mark Brown | 08d15f0 | 2009-05-23 10:41:05 +0100 | [diff] [blame] | 382 | "set sample size in %s stream first\n", |
Timur Tabi | be41e94 | 2008-07-28 17:04:39 -0500 | [diff] [blame] | 383 | substream->stream == SNDRV_PCM_STREAM_PLAYBACK |
| 384 | ? "capture" : "playback"); |
| 385 | return -EAGAIN; |
| 386 | } |
| 387 | |
Timur Tabi | a454dad | 2009-03-05 17:23:37 -0600 | [diff] [blame] | 388 | /* If we're in synchronous mode, then we need to constrain |
| 389 | * the sample size as well. We don't support independent sample |
| 390 | * rates in asynchronous mode. |
| 391 | */ |
| 392 | if (!ssi_private->asynchronous) |
| 393 | snd_pcm_hw_constraint_minmax(substream->runtime, |
| 394 | SNDRV_PCM_HW_PARAM_SAMPLE_BITS, |
| 395 | first_runtime->sample_bits, |
| 396 | first_runtime->sample_bits); |
Timur Tabi | be41e94 | 2008-07-28 17:04:39 -0500 | [diff] [blame] | 397 | |
| 398 | ssi_private->second_stream = substream; |
| 399 | } |
| 400 | |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 401 | if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) |
| 402 | ssi_private->playback++; |
| 403 | |
| 404 | if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) |
| 405 | ssi_private->capture++; |
| 406 | |
| 407 | return 0; |
| 408 | } |
| 409 | |
| 410 | /** |
Timur Tabi | 85ef237 | 2009-02-05 17:56:02 -0600 | [diff] [blame] | 411 | * fsl_ssi_hw_params - program the sample size |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 412 | * |
| 413 | * Most of the SSI registers have been programmed in the startup function, |
| 414 | * but the word length must be programmed here. Unfortunately, programming |
| 415 | * the SxCCR.WL bits requires the SSI to be temporarily disabled. This can |
| 416 | * cause a problem with supporting simultaneous playback and capture. If |
| 417 | * the SSI is already playing a stream, then that stream may be temporarily |
| 418 | * stopped when you start capture. |
| 419 | * |
| 420 | * Note: The SxCCR.DC and SxCCR.PM bits are only used if the SSI is the |
| 421 | * clock master. |
| 422 | */ |
Timur Tabi | 85ef237 | 2009-02-05 17:56:02 -0600 | [diff] [blame] | 423 | static int fsl_ssi_hw_params(struct snd_pcm_substream *substream, |
| 424 | struct snd_pcm_hw_params *hw_params, struct snd_soc_dai *cpu_dai) |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 425 | { |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 426 | struct fsl_ssi_private *ssi_private = snd_soc_dai_get_drvdata(cpu_dai); |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 427 | |
Timur Tabi | be41e94 | 2008-07-28 17:04:39 -0500 | [diff] [blame] | 428 | if (substream == ssi_private->first_stream) { |
Timur Tabi | 85ef237 | 2009-02-05 17:56:02 -0600 | [diff] [blame] | 429 | struct ccsr_ssi __iomem *ssi = ssi_private->ssi; |
| 430 | unsigned int sample_size = |
| 431 | snd_pcm_format_width(params_format(hw_params)); |
Timur Tabi | a454dad | 2009-03-05 17:23:37 -0600 | [diff] [blame] | 432 | u32 wl = CCSR_SSI_SxCCR_WL(sample_size); |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 433 | |
Timur Tabi | be41e94 | 2008-07-28 17:04:39 -0500 | [diff] [blame] | 434 | /* The SSI should always be disabled at this points (SSIEN=0) */ |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 435 | |
Timur Tabi | be41e94 | 2008-07-28 17:04:39 -0500 | [diff] [blame] | 436 | /* In synchronous mode, the SSI uses STCCR for capture */ |
Timur Tabi | a454dad | 2009-03-05 17:23:37 -0600 | [diff] [blame] | 437 | if ((substream->stream == SNDRV_PCM_STREAM_PLAYBACK) || |
| 438 | !ssi_private->asynchronous) |
| 439 | clrsetbits_be32(&ssi->stccr, |
| 440 | CCSR_SSI_SxCCR_WL_MASK, wl); |
| 441 | else |
| 442 | clrsetbits_be32(&ssi->srccr, |
| 443 | CCSR_SSI_SxCCR_WL_MASK, wl); |
Timur Tabi | be41e94 | 2008-07-28 17:04:39 -0500 | [diff] [blame] | 444 | } |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 445 | |
| 446 | return 0; |
| 447 | } |
| 448 | |
| 449 | /** |
| 450 | * fsl_ssi_trigger: start and stop the DMA transfer. |
| 451 | * |
| 452 | * This function is called by ALSA to start, stop, pause, and resume the DMA |
| 453 | * transfer of data. |
| 454 | * |
| 455 | * The DMA channel is in external master start and pause mode, which |
| 456 | * means the SSI completely controls the flow of data. |
| 457 | */ |
Mark Brown | dee89c4 | 2008-11-18 22:11:38 +0000 | [diff] [blame] | 458 | static int fsl_ssi_trigger(struct snd_pcm_substream *substream, int cmd, |
| 459 | struct snd_soc_dai *dai) |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 460 | { |
| 461 | struct snd_soc_pcm_runtime *rtd = substream->private_data; |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 462 | struct fsl_ssi_private *ssi_private = snd_soc_dai_get_drvdata(rtd->cpu_dai); |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 463 | struct ccsr_ssi __iomem *ssi = ssi_private->ssi; |
| 464 | |
| 465 | switch (cmd) { |
| 466 | case SNDRV_PCM_TRIGGER_START: |
Timur Tabi | 3a638ff | 2009-03-06 18:39:34 -0600 | [diff] [blame] | 467 | clrbits32(&ssi->scr, CCSR_SSI_SCR_SSIEN); |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 468 | case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: |
Timur Tabi | a4d11fe | 2009-03-25 18:20:37 -0500 | [diff] [blame] | 469 | if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) |
Timur Tabi | be41e94 | 2008-07-28 17:04:39 -0500 | [diff] [blame] | 470 | setbits32(&ssi->scr, |
| 471 | CCSR_SSI_SCR_SSIEN | CCSR_SSI_SCR_TE); |
Timur Tabi | a4d11fe | 2009-03-25 18:20:37 -0500 | [diff] [blame] | 472 | else |
Timur Tabi | be41e94 | 2008-07-28 17:04:39 -0500 | [diff] [blame] | 473 | setbits32(&ssi->scr, |
| 474 | CCSR_SSI_SCR_SSIEN | CCSR_SSI_SCR_RE); |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 475 | break; |
| 476 | |
| 477 | case SNDRV_PCM_TRIGGER_STOP: |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 478 | case SNDRV_PCM_TRIGGER_PAUSE_PUSH: |
| 479 | if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) |
| 480 | clrbits32(&ssi->scr, CCSR_SSI_SCR_TE); |
| 481 | else |
| 482 | clrbits32(&ssi->scr, CCSR_SSI_SCR_RE); |
| 483 | break; |
| 484 | |
| 485 | default: |
| 486 | return -EINVAL; |
| 487 | } |
| 488 | |
| 489 | return 0; |
| 490 | } |
| 491 | |
| 492 | /** |
| 493 | * fsl_ssi_shutdown: shutdown the SSI |
| 494 | * |
| 495 | * Shutdown the SSI if there are no other substreams open. |
| 496 | */ |
Mark Brown | dee89c4 | 2008-11-18 22:11:38 +0000 | [diff] [blame] | 497 | static void fsl_ssi_shutdown(struct snd_pcm_substream *substream, |
| 498 | struct snd_soc_dai *dai) |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 499 | { |
| 500 | struct snd_soc_pcm_runtime *rtd = substream->private_data; |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 501 | struct fsl_ssi_private *ssi_private = snd_soc_dai_get_drvdata(rtd->cpu_dai); |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 502 | |
| 503 | if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) |
| 504 | ssi_private->playback--; |
| 505 | |
| 506 | if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) |
| 507 | ssi_private->capture--; |
| 508 | |
Timur Tabi | be41e94 | 2008-07-28 17:04:39 -0500 | [diff] [blame] | 509 | if (ssi_private->first_stream == substream) |
| 510 | ssi_private->first_stream = ssi_private->second_stream; |
| 511 | |
| 512 | ssi_private->second_stream = NULL; |
| 513 | |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 514 | /* |
| 515 | * If this is the last active substream, disable the SSI and release |
| 516 | * the IRQ. |
| 517 | */ |
| 518 | if (!ssi_private->playback && !ssi_private->capture) { |
| 519 | struct ccsr_ssi __iomem *ssi = ssi_private->ssi; |
| 520 | |
| 521 | clrbits32(&ssi->scr, CCSR_SSI_SCR_SSIEN); |
| 522 | |
| 523 | free_irq(ssi_private->irq, ssi_private); |
| 524 | } |
| 525 | } |
| 526 | |
Eric Miao | 6335d05 | 2009-03-03 09:41:00 +0800 | [diff] [blame] | 527 | static struct snd_soc_dai_ops fsl_ssi_dai_ops = { |
| 528 | .startup = fsl_ssi_startup, |
| 529 | .hw_params = fsl_ssi_hw_params, |
| 530 | .shutdown = fsl_ssi_shutdown, |
| 531 | .trigger = fsl_ssi_trigger, |
Eric Miao | 6335d05 | 2009-03-03 09:41:00 +0800 | [diff] [blame] | 532 | }; |
| 533 | |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 534 | /* Template for the CPU dai driver structure */ |
| 535 | static struct snd_soc_dai_driver fsl_ssi_dai_template = { |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 536 | .playback = { |
| 537 | /* The SSI does not support monaural audio. */ |
| 538 | .channels_min = 2, |
| 539 | .channels_max = 2, |
| 540 | .rates = FSLSSI_I2S_RATES, |
| 541 | .formats = FSLSSI_I2S_FORMATS, |
| 542 | }, |
| 543 | .capture = { |
| 544 | .channels_min = 2, |
| 545 | .channels_max = 2, |
| 546 | .rates = FSLSSI_I2S_RATES, |
| 547 | .formats = FSLSSI_I2S_FORMATS, |
| 548 | }, |
Eric Miao | 6335d05 | 2009-03-03 09:41:00 +0800 | [diff] [blame] | 549 | .ops = &fsl_ssi_dai_ops, |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 550 | }; |
| 551 | |
Timur Tabi | d5a908b | 2009-03-26 11:42:38 -0500 | [diff] [blame] | 552 | /* Show the statistics of a flag only if its interrupt is enabled. The |
| 553 | * compiler will optimze this code to a no-op if the interrupt is not |
| 554 | * enabled. |
| 555 | */ |
| 556 | #define SIER_SHOW(flag, name) \ |
| 557 | do { \ |
| 558 | if (SIER_FLAGS & CCSR_SSI_SIER_##flag) \ |
| 559 | length += sprintf(buf + length, #name "=%u\n", \ |
| 560 | ssi_private->stats.name); \ |
| 561 | } while (0) |
| 562 | |
| 563 | |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 564 | /** |
| 565 | * fsl_sysfs_ssi_show: display SSI statistics |
| 566 | * |
Timur Tabi | d5a908b | 2009-03-26 11:42:38 -0500 | [diff] [blame] | 567 | * Display the statistics for the current SSI device. To avoid confusion, |
| 568 | * we only show those counts that are enabled. |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 569 | */ |
| 570 | static ssize_t fsl_sysfs_ssi_show(struct device *dev, |
| 571 | struct device_attribute *attr, char *buf) |
| 572 | { |
| 573 | struct fsl_ssi_private *ssi_private = |
Timur Tabi | d5a908b | 2009-03-26 11:42:38 -0500 | [diff] [blame] | 574 | container_of(attr, struct fsl_ssi_private, dev_attr); |
| 575 | ssize_t length = 0; |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 576 | |
Timur Tabi | d5a908b | 2009-03-26 11:42:38 -0500 | [diff] [blame] | 577 | SIER_SHOW(RFRC_EN, rfrc); |
| 578 | SIER_SHOW(TFRC_EN, tfrc); |
| 579 | SIER_SHOW(CMDAU_EN, cmdau); |
| 580 | SIER_SHOW(CMDDU_EN, cmddu); |
| 581 | SIER_SHOW(RXT_EN, rxt); |
| 582 | SIER_SHOW(RDR1_EN, rdr1); |
| 583 | SIER_SHOW(RDR0_EN, rdr0); |
| 584 | SIER_SHOW(TDE1_EN, tde1); |
| 585 | SIER_SHOW(TDE0_EN, tde0); |
| 586 | SIER_SHOW(ROE1_EN, roe1); |
| 587 | SIER_SHOW(ROE0_EN, roe0); |
| 588 | SIER_SHOW(TUE1_EN, tue1); |
| 589 | SIER_SHOW(TUE0_EN, tue0); |
| 590 | SIER_SHOW(TFS_EN, tfs); |
| 591 | SIER_SHOW(RFS_EN, rfs); |
| 592 | SIER_SHOW(TLS_EN, tls); |
| 593 | SIER_SHOW(RLS_EN, rls); |
| 594 | SIER_SHOW(RFF1_EN, rff1); |
| 595 | SIER_SHOW(RFF0_EN, rff0); |
| 596 | SIER_SHOW(TFE1_EN, tfe1); |
| 597 | SIER_SHOW(TFE0_EN, tfe0); |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 598 | |
| 599 | return length; |
| 600 | } |
| 601 | |
| 602 | /** |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 603 | * Make every character in a string lower-case |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 604 | */ |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 605 | static void make_lowercase(char *s) |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 606 | { |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 607 | char *p = s; |
| 608 | char c; |
| 609 | |
| 610 | while ((c = *p)) { |
| 611 | if ((c >= 'A') && (c <= 'Z')) |
| 612 | *p = c + ('a' - 'A'); |
| 613 | p++; |
| 614 | } |
| 615 | } |
| 616 | |
| 617 | static int __devinit fsl_ssi_probe(struct of_device *of_dev, |
| 618 | const struct of_device_id *match) |
| 619 | { |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 620 | struct fsl_ssi_private *ssi_private; |
| 621 | int ret = 0; |
Timur Tabi | 87a0632 | 2010-08-03 17:55:28 -0500 | [diff] [blame] | 622 | struct device_attribute *dev_attr = NULL; |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 623 | struct device_node *np = of_dev->dev.of_node; |
| 624 | const char *p, *sprop; |
| 625 | struct resource res; |
| 626 | char name[64]; |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 627 | |
Timur Tabi | ff71334 | 2010-08-04 17:51:08 -0500 | [diff] [blame^] | 628 | /* SSIs that are not connected on the board should have a |
| 629 | * status = "disabled" |
| 630 | * property in their device tree nodes. |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 631 | */ |
Timur Tabi | ff71334 | 2010-08-04 17:51:08 -0500 | [diff] [blame^] | 632 | if (!of_device_is_available(np)) |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 633 | return -ENODEV; |
| 634 | |
Timur Tabi | ff71334 | 2010-08-04 17:51:08 -0500 | [diff] [blame^] | 635 | /* Check for a codec-handle property. */ |
| 636 | if (!of_get_property(np, "codec-handle", NULL)) { |
| 637 | dev_err(&of_dev->dev, "missing codec-handle property\n"); |
| 638 | return -ENODEV; |
| 639 | } |
| 640 | |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 641 | /* We only support the SSI in "I2S Slave" mode */ |
| 642 | sprop = of_get_property(np, "fsl,mode", NULL); |
| 643 | if (!sprop || strcmp(sprop, "i2s-slave")) { |
| 644 | dev_notice(&of_dev->dev, "mode %s is unsupported\n", sprop); |
| 645 | return -ENODEV; |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 646 | } |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 647 | |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 648 | /* The DAI name is the last part of the full name of the node. */ |
| 649 | p = strrchr(np->full_name, '/') + 1; |
| 650 | ssi_private = kzalloc(sizeof(struct fsl_ssi_private) + strlen(p), |
| 651 | GFP_KERNEL); |
| 652 | if (!ssi_private) { |
| 653 | dev_err(&of_dev->dev, "could not allocate DAI object\n"); |
| 654 | return -ENOMEM; |
| 655 | } |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 656 | |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 657 | strcpy(ssi_private->name, p); |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 658 | |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 659 | /* Initialize this copy of the CPU DAI driver structure */ |
| 660 | memcpy(&ssi_private->cpu_dai_drv, &fsl_ssi_dai_template, |
| 661 | sizeof(fsl_ssi_dai_template)); |
| 662 | ssi_private->cpu_dai_drv.name = ssi_private->name; |
| 663 | |
| 664 | /* Get the addresses and IRQ */ |
| 665 | ret = of_address_to_resource(np, 0, &res); |
| 666 | if (ret) { |
| 667 | dev_err(&of_dev->dev, "could not determine device resources\n"); |
| 668 | kfree(ssi_private); |
| 669 | return ret; |
| 670 | } |
| 671 | ssi_private->ssi = ioremap(res.start, 1 + res.end - res.start); |
| 672 | ssi_private->ssi_phys = res.start; |
| 673 | ssi_private->irq = irq_of_parse_and_map(np, 0); |
| 674 | |
| 675 | /* Are the RX and the TX clocks locked? */ |
| 676 | if (of_find_property(np, "fsl,ssi-asynchronous", NULL)) |
| 677 | ssi_private->asynchronous = 1; |
| 678 | else |
| 679 | ssi_private->cpu_dai_drv.symmetric_rates = 1; |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 680 | |
| 681 | /* Initialize the the device_attribute structure */ |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 682 | dev_attr = &ssi_private->dev_attr; |
| 683 | dev_attr->attr.name = "statistics"; |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 684 | dev_attr->attr.mode = S_IRUGO; |
| 685 | dev_attr->show = fsl_sysfs_ssi_show; |
| 686 | |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 687 | ret = device_create_file(&of_dev->dev, dev_attr); |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 688 | if (ret) { |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 689 | dev_err(&of_dev->dev, "could not create sysfs %s file\n", |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 690 | ssi_private->dev_attr.attr.name); |
Timur Tabi | 87a0632 | 2010-08-03 17:55:28 -0500 | [diff] [blame] | 691 | goto error; |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 692 | } |
| 693 | |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 694 | /* Register with ASoC */ |
| 695 | dev_set_drvdata(&of_dev->dev, ssi_private); |
Mark Brown | 3f4b783 | 2008-12-03 19:26:35 +0000 | [diff] [blame] | 696 | |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 697 | ret = snd_soc_register_dai(&of_dev->dev, &ssi_private->cpu_dai_drv); |
Timur Tabi | 87a0632 | 2010-08-03 17:55:28 -0500 | [diff] [blame] | 698 | if (ret) { |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 699 | dev_err(&of_dev->dev, "failed to register DAI: %d\n", ret); |
Timur Tabi | 87a0632 | 2010-08-03 17:55:28 -0500 | [diff] [blame] | 700 | goto error; |
Mark Brown | 3f4b783 | 2008-12-03 19:26:35 +0000 | [diff] [blame] | 701 | } |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 702 | |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 703 | /* Trigger the machine driver's probe function. The platform driver |
| 704 | * name of the machine driver is taken from the /model property of the |
| 705 | * device tree. We also pass the address of the CPU DAI driver |
| 706 | * structure. |
| 707 | */ |
| 708 | sprop = of_get_property(of_find_node_by_path("/"), "model", NULL); |
| 709 | /* Sometimes the model name has a "fsl," prefix, so we strip that. */ |
| 710 | p = strrchr(sprop, ','); |
| 711 | if (p) |
| 712 | sprop = p + 1; |
| 713 | snprintf(name, sizeof(name), "snd-soc-%s", sprop); |
| 714 | make_lowercase(name); |
| 715 | |
| 716 | ssi_private->pdev = |
| 717 | platform_device_register_data(&of_dev->dev, name, 0, NULL, 0); |
| 718 | if (IS_ERR(ssi_private->pdev)) { |
| 719 | ret = PTR_ERR(ssi_private->pdev); |
| 720 | dev_err(&of_dev->dev, "failed to register platform: %d\n", ret); |
Timur Tabi | 87a0632 | 2010-08-03 17:55:28 -0500 | [diff] [blame] | 721 | goto error; |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 722 | } |
| 723 | |
| 724 | return 0; |
Timur Tabi | 87a0632 | 2010-08-03 17:55:28 -0500 | [diff] [blame] | 725 | |
| 726 | error: |
| 727 | snd_soc_unregister_dai(&of_dev->dev); |
| 728 | dev_set_drvdata(&of_dev->dev, NULL); |
| 729 | if (dev_attr) |
| 730 | device_remove_file(&of_dev->dev, dev_attr); |
| 731 | irq_dispose_mapping(ssi_private->irq); |
| 732 | iounmap(ssi_private->ssi); |
| 733 | kfree(ssi_private); |
| 734 | |
| 735 | return ret; |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 736 | } |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 737 | |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 738 | static int fsl_ssi_remove(struct of_device *of_dev) |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 739 | { |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 740 | struct fsl_ssi_private *ssi_private = dev_get_drvdata(&of_dev->dev); |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 741 | |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 742 | platform_device_unregister(ssi_private->pdev); |
| 743 | snd_soc_unregister_dai(&of_dev->dev); |
| 744 | device_remove_file(&of_dev->dev, &ssi_private->dev_attr); |
Mark Brown | 3f4b783 | 2008-12-03 19:26:35 +0000 | [diff] [blame] | 745 | |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 746 | kfree(ssi_private); |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 747 | dev_set_drvdata(&of_dev->dev, NULL); |
| 748 | |
| 749 | return 0; |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 750 | } |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 751 | |
| 752 | static const struct of_device_id fsl_ssi_ids[] = { |
| 753 | { .compatible = "fsl,mpc8610-ssi", }, |
| 754 | {} |
| 755 | }; |
| 756 | MODULE_DEVICE_TABLE(of, fsl_ssi_ids); |
| 757 | |
| 758 | static struct of_platform_driver fsl_ssi_driver = { |
| 759 | .driver = { |
| 760 | .name = "fsl-ssi-dai", |
| 761 | .owner = THIS_MODULE, |
| 762 | .of_match_table = fsl_ssi_ids, |
| 763 | }, |
| 764 | .probe = fsl_ssi_probe, |
| 765 | .remove = fsl_ssi_remove, |
| 766 | }; |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 767 | |
Timur Tabi | a454dad | 2009-03-05 17:23:37 -0600 | [diff] [blame] | 768 | static int __init fsl_ssi_init(void) |
| 769 | { |
| 770 | printk(KERN_INFO "Freescale Synchronous Serial Interface (SSI) ASoC Driver\n"); |
| 771 | |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 772 | return of_register_platform_driver(&fsl_ssi_driver); |
Timur Tabi | a454dad | 2009-03-05 17:23:37 -0600 | [diff] [blame] | 773 | } |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 774 | |
| 775 | static void __exit fsl_ssi_exit(void) |
| 776 | { |
| 777 | of_unregister_platform_driver(&fsl_ssi_driver); |
| 778 | } |
| 779 | |
Timur Tabi | a454dad | 2009-03-05 17:23:37 -0600 | [diff] [blame] | 780 | module_init(fsl_ssi_init); |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 781 | module_exit(fsl_ssi_exit); |
Timur Tabi | a454dad | 2009-03-05 17:23:37 -0600 | [diff] [blame] | 782 | |
Timur Tabi | 17467f2 | 2008-01-11 18:15:26 +0100 | [diff] [blame] | 783 | MODULE_AUTHOR("Timur Tabi <timur@freescale.com>"); |
| 784 | MODULE_DESCRIPTION("Freescale Synchronous Serial Interface (SSI) ASoC Driver"); |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 785 | MODULE_LICENSE("GPL v2"); |