imx-ssi.c 18 KB

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