imx-ssi.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762
  1. /*
  2. * imx-ssi.c -- ALSA Soc Audio Layer
  3. *
  4. * Copyright 2009 Sascha Hauer <s.hauer@pengutronix.de>
  5. *
  6. * This code is based on code copyrighted by Freescale,
  7. * Liam Girdwood, Javier Martin and probably others.
  8. *
  9. * This program is free software; you can redistribute it and/or modify it
  10. * under the terms of the GNU General Public License as published by the
  11. * Free Software Foundation; either version 2 of the License, or (at your
  12. * option) any later version.
  13. *
  14. *
  15. * The i.MX SSI core has some nasty limitations in AC97 mode. While most
  16. * sane processor vendors have a FIFO per AC97 slot, the i.MX has only
  17. * one FIFO which combines all valid receive slots. We cannot even select
  18. * which slots we want to receive. The WM9712 with which this driver
  19. * was developped with always sends GPIO status data in slot 12 which
  20. * we receive in our (PCM-) data stream. The only chance we have is to
  21. * manually skip this data in the FIQ handler. With sampling rates different
  22. * from 48000Hz not every frame has valid receive data, so the ratio
  23. * between pcm data and GPIO status data changes. Our FIQ handler is not
  24. * able to handle this, hence this driver only works with 48000Hz sampling
  25. * rate.
  26. * Reading and writing AC97 registers is another challange. The core
  27. * provides us status bits when the read register is updated with *another*
  28. * value. When we read the same register two times (and the register still
  29. * contains the same value) these status bits are not set. We work
  30. * around this by not polling these bits but only wait a fixed delay.
  31. *
  32. */
  33. #include <linux/clk.h>
  34. #include <linux/delay.h>
  35. #include <linux/device.h>
  36. #include <linux/dma-mapping.h>
  37. #include <linux/init.h>
  38. #include <linux/interrupt.h>
  39. #include <linux/module.h>
  40. #include <linux/platform_device.h>
  41. #include <sound/core.h>
  42. #include <sound/initval.h>
  43. #include <sound/pcm.h>
  44. #include <sound/pcm_params.h>
  45. #include <sound/soc.h>
  46. #include <mach/ssi.h>
  47. #include <mach/hardware.h>
  48. #include "imx-ssi.h"
  49. #define SSI_SACNT_DEFAULT (SSI_SACNT_AC97EN | SSI_SACNT_FV)
  50. /*
  51. * SSI Network Mode or TDM slots configuration.
  52. * Should only be called when port is inactive (i.e. SSIEN = 0).
  53. */
  54. static int imx_ssi_set_dai_tdm_slot(struct snd_soc_dai *cpu_dai,
  55. unsigned int tx_mask, unsigned int rx_mask, int slots, int slot_width)
  56. {
  57. struct imx_ssi *ssi = container_of(cpu_dai, struct imx_ssi, dai);
  58. u32 sccr;
  59. sccr = readl(ssi->base + SSI_STCCR);
  60. sccr &= ~SSI_STCCR_DC_MASK;
  61. sccr |= SSI_STCCR_DC(slots - 1);
  62. writel(sccr, ssi->base + SSI_STCCR);
  63. sccr = readl(ssi->base + SSI_SRCCR);
  64. sccr &= ~SSI_STCCR_DC_MASK;
  65. sccr |= SSI_STCCR_DC(slots - 1);
  66. writel(sccr, ssi->base + SSI_SRCCR);
  67. writel(tx_mask, ssi->base + SSI_STMSK);
  68. writel(rx_mask, ssi->base + SSI_SRMSK);
  69. return 0;
  70. }
  71. /*
  72. * SSI DAI format configuration.
  73. * Should only be called when port is inactive (i.e. SSIEN = 0).
  74. * Note: We don't use the I2S modes but instead manually configure the
  75. * SSI for I2S because the I2S mode is only a register preset.
  76. */
  77. static int imx_ssi_set_dai_fmt(struct snd_soc_dai *cpu_dai, unsigned int fmt)
  78. {
  79. struct imx_ssi *ssi = container_of(cpu_dai, struct imx_ssi, dai);
  80. u32 strcr = 0, scr;
  81. scr = readl(ssi->base + SSI_SCR) & ~(SSI_SCR_SYN | SSI_SCR_NET);
  82. /* DAI mode */
  83. switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
  84. case SND_SOC_DAIFMT_I2S:
  85. /* data on rising edge of bclk, frame low 1clk before data */
  86. strcr |= SSI_STCR_TFSI | SSI_STCR_TEFS | SSI_STCR_TXBIT0;
  87. scr |= SSI_SCR_NET;
  88. break;
  89. case SND_SOC_DAIFMT_LEFT_J:
  90. /* data on rising edge of bclk, frame high with data */
  91. strcr |= SSI_STCR_TXBIT0;
  92. break;
  93. case SND_SOC_DAIFMT_DSP_B:
  94. /* data on rising edge of bclk, frame high with data */
  95. strcr |= SSI_STCR_TFSL;
  96. break;
  97. case SND_SOC_DAIFMT_DSP_A:
  98. /* data on rising edge of bclk, frame high 1clk before data */
  99. strcr |= SSI_STCR_TFSL | SSI_STCR_TEFS;
  100. break;
  101. }
  102. /* DAI clock inversion */
  103. switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
  104. case SND_SOC_DAIFMT_IB_IF:
  105. strcr |= SSI_STCR_TFSI;
  106. strcr &= ~SSI_STCR_TSCKP;
  107. break;
  108. case SND_SOC_DAIFMT_IB_NF:
  109. strcr &= ~(SSI_STCR_TSCKP | SSI_STCR_TFSI);
  110. break;
  111. case SND_SOC_DAIFMT_NB_IF:
  112. strcr |= SSI_STCR_TFSI | SSI_STCR_TSCKP;
  113. break;
  114. case SND_SOC_DAIFMT_NB_NF:
  115. strcr &= ~SSI_STCR_TFSI;
  116. strcr |= SSI_STCR_TSCKP;
  117. break;
  118. }
  119. /* DAI clock master masks */
  120. switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
  121. case SND_SOC_DAIFMT_CBS_CFS:
  122. strcr |= SSI_STCR_TFDIR | SSI_STCR_TXDIR;
  123. break;
  124. case SND_SOC_DAIFMT_CBM_CFS:
  125. strcr |= SSI_STCR_TFDIR;
  126. break;
  127. case SND_SOC_DAIFMT_CBS_CFM:
  128. strcr |= SSI_STCR_TXDIR;
  129. break;
  130. }
  131. strcr |= SSI_STCR_TFEN0;
  132. writel(strcr, ssi->base + SSI_STCR);
  133. writel(strcr, ssi->base + SSI_SRCR);
  134. writel(scr, ssi->base + SSI_SCR);
  135. return 0;
  136. }
  137. /*
  138. * SSI system clock configuration.
  139. * Should only be called when port is inactive (i.e. SSIEN = 0).
  140. */
  141. static int imx_ssi_set_dai_sysclk(struct snd_soc_dai *cpu_dai,
  142. int clk_id, unsigned int freq, int dir)
  143. {
  144. struct imx_ssi *ssi = container_of(cpu_dai, struct imx_ssi, dai);
  145. u32 scr;
  146. scr = readl(ssi->base + SSI_SCR);
  147. switch (clk_id) {
  148. case IMX_SSP_SYS_CLK:
  149. if (dir == SND_SOC_CLOCK_OUT)
  150. scr |= SSI_SCR_SYS_CLK_EN;
  151. else
  152. scr &= ~SSI_SCR_SYS_CLK_EN;
  153. break;
  154. default:
  155. return -EINVAL;
  156. }
  157. writel(scr, ssi->base + SSI_SCR);
  158. return 0;
  159. }
  160. /*
  161. * SSI Clock dividers
  162. * Should only be called when port is inactive (i.e. SSIEN = 0).
  163. */
  164. static int imx_ssi_set_dai_clkdiv(struct snd_soc_dai *cpu_dai,
  165. int div_id, int div)
  166. {
  167. struct imx_ssi *ssi = container_of(cpu_dai, struct imx_ssi, dai);
  168. u32 stccr, srccr;
  169. stccr = readl(ssi->base + SSI_STCCR);
  170. srccr = readl(ssi->base + SSI_SRCCR);
  171. switch (div_id) {
  172. case IMX_SSI_TX_DIV_2:
  173. stccr &= ~SSI_STCCR_DIV2;
  174. stccr |= div;
  175. break;
  176. case IMX_SSI_TX_DIV_PSR:
  177. stccr &= ~SSI_STCCR_PSR;
  178. stccr |= div;
  179. break;
  180. case IMX_SSI_TX_DIV_PM:
  181. stccr &= ~0xff;
  182. stccr |= SSI_STCCR_PM(div);
  183. break;
  184. case IMX_SSI_RX_DIV_2:
  185. stccr &= ~SSI_STCCR_DIV2;
  186. stccr |= div;
  187. break;
  188. case IMX_SSI_RX_DIV_PSR:
  189. stccr &= ~SSI_STCCR_PSR;
  190. stccr |= div;
  191. break;
  192. case IMX_SSI_RX_DIV_PM:
  193. stccr &= ~0xff;
  194. stccr |= SSI_STCCR_PM(div);
  195. break;
  196. default:
  197. return -EINVAL;
  198. }
  199. writel(stccr, ssi->base + SSI_STCCR);
  200. writel(srccr, ssi->base + SSI_SRCCR);
  201. return 0;
  202. }
  203. /*
  204. * Should only be called when port is inactive (i.e. SSIEN = 0),
  205. * although can be called multiple times by upper layers.
  206. */
  207. static int imx_ssi_hw_params(struct snd_pcm_substream *substream,
  208. struct snd_pcm_hw_params *params,
  209. struct snd_soc_dai *cpu_dai)
  210. {
  211. struct imx_ssi *ssi = container_of(cpu_dai, struct imx_ssi, dai);
  212. u32 reg, sccr;
  213. /* Tx/Rx config */
  214. if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
  215. reg = SSI_STCCR;
  216. cpu_dai->dma_data = &ssi->dma_params_tx;
  217. } else {
  218. reg = SSI_SRCCR;
  219. cpu_dai->dma_data = &ssi->dma_params_rx;
  220. }
  221. sccr = readl(ssi->base + reg) & ~SSI_STCCR_WL_MASK;
  222. /* DAI data (word) size */
  223. switch (params_format(params)) {
  224. case SNDRV_PCM_FORMAT_S16_LE:
  225. sccr |= SSI_SRCCR_WL(16);
  226. break;
  227. case SNDRV_PCM_FORMAT_S20_3LE:
  228. sccr |= SSI_SRCCR_WL(20);
  229. break;
  230. case SNDRV_PCM_FORMAT_S24_LE:
  231. sccr |= SSI_SRCCR_WL(24);
  232. break;
  233. }
  234. writel(sccr, ssi->base + reg);
  235. return 0;
  236. }
  237. static int imx_ssi_trigger(struct snd_pcm_substream *substream, int cmd,
  238. struct snd_soc_dai *dai)
  239. {
  240. struct snd_soc_pcm_runtime *rtd = substream->private_data;
  241. struct snd_soc_dai *cpu_dai = rtd->dai->cpu_dai;
  242. struct imx_ssi *ssi = container_of(cpu_dai, struct imx_ssi, dai);
  243. unsigned int sier_bits, sier;
  244. unsigned int scr;
  245. scr = readl(ssi->base + SSI_SCR);
  246. sier = readl(ssi->base + SSI_SIER);
  247. if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
  248. if (ssi->flags & IMX_SSI_DMA)
  249. sier_bits = SSI_SIER_TDMAE;
  250. else
  251. sier_bits = SSI_SIER_TIE | SSI_SIER_TFE0_EN;
  252. } else {
  253. if (ssi->flags & IMX_SSI_DMA)
  254. sier_bits = SSI_SIER_RDMAE;
  255. else
  256. sier_bits = SSI_SIER_RIE | SSI_SIER_RFF0_EN;
  257. }
  258. switch (cmd) {
  259. case SNDRV_PCM_TRIGGER_START:
  260. case SNDRV_PCM_TRIGGER_RESUME:
  261. case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
  262. if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
  263. scr |= SSI_SCR_TE;
  264. else
  265. scr |= SSI_SCR_RE;
  266. sier |= sier_bits;
  267. if (++ssi->enabled == 1)
  268. scr |= SSI_SCR_SSIEN;
  269. break;
  270. case SNDRV_PCM_TRIGGER_STOP:
  271. case SNDRV_PCM_TRIGGER_SUSPEND:
  272. case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
  273. if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
  274. scr &= ~SSI_SCR_TE;
  275. else
  276. scr &= ~SSI_SCR_RE;
  277. sier &= ~sier_bits;
  278. if (--ssi->enabled == 0)
  279. scr &= ~SSI_SCR_SSIEN;
  280. break;
  281. default:
  282. return -EINVAL;
  283. }
  284. if (!(ssi->flags & IMX_SSI_USE_AC97))
  285. /* rx/tx are always enabled to access ac97 registers */
  286. writel(scr, ssi->base + SSI_SCR);
  287. writel(sier, ssi->base + SSI_SIER);
  288. return 0;
  289. }
  290. static struct snd_soc_dai_ops imx_ssi_pcm_dai_ops = {
  291. .hw_params = imx_ssi_hw_params,
  292. .set_fmt = imx_ssi_set_dai_fmt,
  293. .set_clkdiv = imx_ssi_set_dai_clkdiv,
  294. .set_sysclk = imx_ssi_set_dai_sysclk,
  295. .set_tdm_slot = imx_ssi_set_dai_tdm_slot,
  296. .trigger = imx_ssi_trigger,
  297. };
  298. static struct snd_soc_dai imx_ssi_dai = {
  299. .playback = {
  300. .channels_min = 2,
  301. .channels_max = 2,
  302. .rates = SNDRV_PCM_RATE_8000_96000,
  303. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  304. },
  305. .capture = {
  306. .channels_min = 2,
  307. .channels_max = 2,
  308. .rates = SNDRV_PCM_RATE_8000_96000,
  309. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  310. },
  311. .ops = &imx_ssi_pcm_dai_ops,
  312. };
  313. int snd_imx_pcm_mmap(struct snd_pcm_substream *substream,
  314. struct vm_area_struct *vma)
  315. {
  316. struct snd_pcm_runtime *runtime = substream->runtime;
  317. int ret;
  318. ret = dma_mmap_coherent(NULL, vma, runtime->dma_area,
  319. runtime->dma_addr, runtime->dma_bytes);
  320. pr_debug("%s: ret: %d %p 0x%08x 0x%08x\n", __func__, ret,
  321. runtime->dma_area,
  322. runtime->dma_addr,
  323. runtime->dma_bytes);
  324. return ret;
  325. }
  326. static int imx_pcm_preallocate_dma_buffer(struct snd_pcm *pcm, int stream)
  327. {
  328. struct snd_pcm_substream *substream = pcm->streams[stream].substream;
  329. struct snd_dma_buffer *buf = &substream->dma_buffer;
  330. size_t size = IMX_SSI_DMABUF_SIZE;
  331. buf->dev.type = SNDRV_DMA_TYPE_DEV;
  332. buf->dev.dev = pcm->card->dev;
  333. buf->private_data = NULL;
  334. buf->area = dma_alloc_writecombine(pcm->card->dev, size,
  335. &buf->addr, GFP_KERNEL);
  336. if (!buf->area)
  337. return -ENOMEM;
  338. buf->bytes = size;
  339. return 0;
  340. }
  341. static u64 imx_pcm_dmamask = DMA_BIT_MASK(32);
  342. int imx_pcm_new(struct snd_card *card, struct snd_soc_dai *dai,
  343. struct snd_pcm *pcm)
  344. {
  345. int ret = 0;
  346. if (!card->dev->dma_mask)
  347. card->dev->dma_mask = &imx_pcm_dmamask;
  348. if (!card->dev->coherent_dma_mask)
  349. card->dev->coherent_dma_mask = DMA_BIT_MASK(32);
  350. if (dai->playback.channels_min) {
  351. ret = imx_pcm_preallocate_dma_buffer(pcm,
  352. SNDRV_PCM_STREAM_PLAYBACK);
  353. if (ret)
  354. goto out;
  355. }
  356. if (dai->capture.channels_min) {
  357. ret = imx_pcm_preallocate_dma_buffer(pcm,
  358. SNDRV_PCM_STREAM_CAPTURE);
  359. if (ret)
  360. goto out;
  361. }
  362. out:
  363. return ret;
  364. }
  365. void imx_pcm_free(struct snd_pcm *pcm)
  366. {
  367. struct snd_pcm_substream *substream;
  368. struct snd_dma_buffer *buf;
  369. int stream;
  370. for (stream = 0; stream < 2; stream++) {
  371. substream = pcm->streams[stream].substream;
  372. if (!substream)
  373. continue;
  374. buf = &substream->dma_buffer;
  375. if (!buf->area)
  376. continue;
  377. dma_free_writecombine(pcm->card->dev, buf->bytes,
  378. buf->area, buf->addr);
  379. buf->area = NULL;
  380. }
  381. }
  382. struct snd_soc_platform imx_soc_platform = {
  383. .name = "imx-audio",
  384. };
  385. EXPORT_SYMBOL_GPL(imx_soc_platform);
  386. static struct snd_soc_dai imx_ac97_dai = {
  387. .name = "AC97",
  388. .ac97_control = 1,
  389. .playback = {
  390. .stream_name = "AC97 Playback",
  391. .channels_min = 2,
  392. .channels_max = 2,
  393. .rates = SNDRV_PCM_RATE_48000,
  394. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  395. },
  396. .capture = {
  397. .stream_name = "AC97 Capture",
  398. .channels_min = 2,
  399. .channels_max = 2,
  400. .rates = SNDRV_PCM_RATE_48000,
  401. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  402. },
  403. .ops = &imx_ssi_pcm_dai_ops,
  404. };
  405. static void setup_channel_to_ac97(struct imx_ssi *imx_ssi)
  406. {
  407. void __iomem *base = imx_ssi->base;
  408. writel(0x0, base + SSI_SCR);
  409. writel(0x0, base + SSI_STCR);
  410. writel(0x0, base + SSI_SRCR);
  411. writel(SSI_SCR_SYN | SSI_SCR_NET, base + SSI_SCR);
  412. writel(SSI_SFCSR_RFWM0(8) |
  413. SSI_SFCSR_TFWM0(8) |
  414. SSI_SFCSR_RFWM1(8) |
  415. SSI_SFCSR_TFWM1(8), base + SSI_SFCSR);
  416. writel(SSI_STCCR_WL(16) | SSI_STCCR_DC(12), base + SSI_STCCR);
  417. writel(SSI_STCCR_WL(16) | SSI_STCCR_DC(12), base + SSI_SRCCR);
  418. writel(SSI_SCR_SYN | SSI_SCR_NET | SSI_SCR_SSIEN, base + SSI_SCR);
  419. writel(SSI_SOR_WAIT(3), base + SSI_SOR);
  420. writel(SSI_SCR_SYN | SSI_SCR_NET | SSI_SCR_SSIEN |
  421. SSI_SCR_TE | SSI_SCR_RE,
  422. base + SSI_SCR);
  423. writel(SSI_SACNT_DEFAULT, base + SSI_SACNT);
  424. writel(0xff, base + SSI_SACCDIS);
  425. writel(0x300, base + SSI_SACCEN);
  426. }
  427. static struct imx_ssi *ac97_ssi;
  428. static void imx_ssi_ac97_write(struct snd_ac97 *ac97, unsigned short reg,
  429. unsigned short val)
  430. {
  431. struct imx_ssi *imx_ssi = ac97_ssi;
  432. void __iomem *base = imx_ssi->base;
  433. unsigned int lreg;
  434. unsigned int lval;
  435. if (reg > 0x7f)
  436. return;
  437. pr_debug("%s: 0x%02x 0x%04x\n", __func__, reg, val);
  438. lreg = reg << 12;
  439. writel(lreg, base + SSI_SACADD);
  440. lval = val << 4;
  441. writel(lval , base + SSI_SACDAT);
  442. writel(SSI_SACNT_DEFAULT | SSI_SACNT_WR, base + SSI_SACNT);
  443. udelay(100);
  444. }
  445. static unsigned short imx_ssi_ac97_read(struct snd_ac97 *ac97,
  446. unsigned short reg)
  447. {
  448. struct imx_ssi *imx_ssi = ac97_ssi;
  449. void __iomem *base = imx_ssi->base;
  450. unsigned short val = -1;
  451. unsigned int lreg;
  452. lreg = (reg & 0x7f) << 12 ;
  453. writel(lreg, base + SSI_SACADD);
  454. writel(SSI_SACNT_DEFAULT | SSI_SACNT_RD, base + SSI_SACNT);
  455. udelay(100);
  456. val = (readl(base + SSI_SACDAT) >> 4) & 0xffff;
  457. pr_debug("%s: 0x%02x 0x%04x\n", __func__, reg, val);
  458. return val;
  459. }
  460. static void imx_ssi_ac97_reset(struct snd_ac97 *ac97)
  461. {
  462. struct imx_ssi *imx_ssi = ac97_ssi;
  463. if (imx_ssi->ac97_reset)
  464. imx_ssi->ac97_reset(ac97);
  465. }
  466. static void imx_ssi_ac97_warm_reset(struct snd_ac97 *ac97)
  467. {
  468. struct imx_ssi *imx_ssi = ac97_ssi;
  469. if (imx_ssi->ac97_warm_reset)
  470. imx_ssi->ac97_warm_reset(ac97);
  471. }
  472. struct snd_ac97_bus_ops soc_ac97_ops = {
  473. .read = imx_ssi_ac97_read,
  474. .write = imx_ssi_ac97_write,
  475. .reset = imx_ssi_ac97_reset,
  476. .warm_reset = imx_ssi_ac97_warm_reset
  477. };
  478. EXPORT_SYMBOL_GPL(soc_ac97_ops);
  479. struct snd_soc_dai *imx_ssi_pcm_dai[2];
  480. EXPORT_SYMBOL_GPL(imx_ssi_pcm_dai);
  481. static int imx_ssi_probe(struct platform_device *pdev)
  482. {
  483. struct resource *res;
  484. struct imx_ssi *ssi;
  485. struct imx_ssi_platform_data *pdata = pdev->dev.platform_data;
  486. struct snd_soc_platform *platform;
  487. int ret = 0;
  488. unsigned int val;
  489. ssi = kzalloc(sizeof(*ssi), GFP_KERNEL);
  490. if (!ssi)
  491. return -ENOMEM;
  492. if (pdata) {
  493. ssi->ac97_reset = pdata->ac97_reset;
  494. ssi->ac97_warm_reset = pdata->ac97_warm_reset;
  495. ssi->flags = pdata->flags;
  496. }
  497. imx_ssi_pcm_dai[pdev->id] = &ssi->dai;
  498. ssi->irq = platform_get_irq(pdev, 0);
  499. ssi->clk = clk_get(&pdev->dev, NULL);
  500. if (IS_ERR(ssi->clk)) {
  501. ret = PTR_ERR(ssi->clk);
  502. dev_err(&pdev->dev, "Cannot get the clock: %d\n",
  503. ret);
  504. goto failed_clk;
  505. }
  506. clk_enable(ssi->clk);
  507. res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  508. if (!res) {
  509. ret = -ENODEV;
  510. goto failed_get_resource;
  511. }
  512. if (!request_mem_region(res->start, resource_size(res), DRV_NAME)) {
  513. dev_err(&pdev->dev, "request_mem_region failed\n");
  514. ret = -EBUSY;
  515. goto failed_get_resource;
  516. }
  517. ssi->base = ioremap(res->start, resource_size(res));
  518. if (!ssi->base) {
  519. dev_err(&pdev->dev, "ioremap failed\n");
  520. ret = -ENODEV;
  521. goto failed_ioremap;
  522. }
  523. if (ssi->flags & IMX_SSI_USE_AC97) {
  524. if (ac97_ssi) {
  525. ret = -EBUSY;
  526. goto failed_ac97;
  527. }
  528. ac97_ssi = ssi;
  529. setup_channel_to_ac97(ssi);
  530. memcpy(&ssi->dai, &imx_ac97_dai, sizeof(imx_ac97_dai));
  531. } else
  532. memcpy(&ssi->dai, &imx_ssi_dai, sizeof(imx_ssi_dai));
  533. ssi->dai.id = pdev->id;
  534. ssi->dai.dev = &pdev->dev;
  535. ssi->dai.name = kasprintf(GFP_KERNEL, "imx-ssi.%d", pdev->id);
  536. writel(0x0, ssi->base + SSI_SIER);
  537. ssi->dma_params_rx.dma_addr = res->start + SSI_SRX0;
  538. ssi->dma_params_tx.dma_addr = res->start + SSI_STX0;
  539. res = platform_get_resource_byname(pdev, IORESOURCE_DMA, "tx0");
  540. if (res)
  541. ssi->dma_params_tx.dma = res->start;
  542. res = platform_get_resource_byname(pdev, IORESOURCE_DMA, "rx0");
  543. if (res)
  544. ssi->dma_params_rx.dma = res->start;
  545. ssi->dai.id = pdev->id;
  546. ssi->dai.dev = &pdev->dev;
  547. ssi->dai.name = kasprintf(GFP_KERNEL, "imx-ssi.%d", pdev->id);
  548. if ((cpu_is_mx27() || cpu_is_mx21()) &&
  549. !(ssi->flags & IMX_SSI_USE_AC97)) {
  550. ssi->flags |= IMX_SSI_DMA;
  551. platform = imx_ssi_dma_mx2_init(pdev, ssi);
  552. } else
  553. platform = imx_ssi_fiq_init(pdev, ssi);
  554. imx_soc_platform.pcm_ops = platform->pcm_ops;
  555. imx_soc_platform.pcm_new = platform->pcm_new;
  556. imx_soc_platform.pcm_free = platform->pcm_free;
  557. val = SSI_SFCSR_TFWM0(ssi->dma_params_tx.burstsize) |
  558. SSI_SFCSR_RFWM0(ssi->dma_params_rx.burstsize);
  559. writel(val, ssi->base + SSI_SFCSR);
  560. ret = snd_soc_register_dai(&ssi->dai);
  561. if (ret) {
  562. dev_err(&pdev->dev, "register DAI failed\n");
  563. goto failed_register;
  564. }
  565. platform_set_drvdata(pdev, ssi);
  566. return 0;
  567. failed_register:
  568. failed_ac97:
  569. iounmap(ssi->base);
  570. failed_ioremap:
  571. release_mem_region(res->start, resource_size(res));
  572. failed_get_resource:
  573. clk_disable(ssi->clk);
  574. clk_put(ssi->clk);
  575. failed_clk:
  576. kfree(ssi);
  577. return ret;
  578. }
  579. static int __devexit imx_ssi_remove(struct platform_device *pdev)
  580. {
  581. struct resource *res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  582. struct imx_ssi *ssi = platform_get_drvdata(pdev);
  583. snd_soc_unregister_dai(&ssi->dai);
  584. if (ssi->flags & IMX_SSI_USE_AC97)
  585. ac97_ssi = NULL;
  586. if (!(ssi->flags & IMX_SSI_DMA))
  587. imx_ssi_fiq_exit(pdev, ssi);
  588. iounmap(ssi->base);
  589. release_mem_region(res->start, resource_size(res));
  590. clk_disable(ssi->clk);
  591. clk_put(ssi->clk);
  592. kfree(ssi);
  593. return 0;
  594. }
  595. static struct platform_driver imx_ssi_driver = {
  596. .probe = imx_ssi_probe,
  597. .remove = __devexit_p(imx_ssi_remove),
  598. .driver = {
  599. .name = DRV_NAME,
  600. .owner = THIS_MODULE,
  601. },
  602. };
  603. static int __init imx_ssi_init(void)
  604. {
  605. int ret;
  606. ret = snd_soc_register_platform(&imx_soc_platform);
  607. if (ret) {
  608. pr_err("failed to register soc platform: %d\n", ret);
  609. return ret;
  610. }
  611. ret = platform_driver_register(&imx_ssi_driver);
  612. if (ret) {
  613. snd_soc_unregister_platform(&imx_soc_platform);
  614. return ret;
  615. }
  616. return 0;
  617. }
  618. static void __exit imx_ssi_exit(void)
  619. {
  620. platform_driver_unregister(&imx_ssi_driver);
  621. snd_soc_unregister_platform(&imx_soc_platform);
  622. }
  623. module_init(imx_ssi_init);
  624. module_exit(imx_ssi_exit);
  625. /* Module information */
  626. MODULE_AUTHOR("Sascha Hauer, <s.hauer@pengutronix.de>");
  627. MODULE_DESCRIPTION("i.MX I2S/ac97 SoC Interface");
  628. MODULE_LICENSE("GPL");