kirkwood-i2s.c 16 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653
  1. /*
  2. * kirkwood-i2s.c
  3. *
  4. * (c) 2010 Arnaud Patard <apatard@mandriva.com>
  5. * (c) 2010 Arnaud Patard <arnaud.patard@rtp-net.org>
  6. *
  7. * This program is free software; you can redistribute it and/or modify it
  8. * under the terms of the GNU General Public License as published by the
  9. * Free Software Foundation; either version 2 of the License, or (at your
  10. * option) any later version.
  11. */
  12. #include <linux/init.h>
  13. #include <linux/module.h>
  14. #include <linux/platform_device.h>
  15. #include <linux/io.h>
  16. #include <linux/slab.h>
  17. #include <linux/mbus.h>
  18. #include <linux/delay.h>
  19. #include <linux/clk.h>
  20. #include <sound/pcm.h>
  21. #include <sound/pcm_params.h>
  22. #include <sound/soc.h>
  23. #include <linux/platform_data/asoc-kirkwood.h>
  24. #include <linux/of.h>
  25. #include "kirkwood.h"
  26. #define DRV_NAME "mvebu-audio"
  27. #define KIRKWOOD_I2S_FORMATS \
  28. (SNDRV_PCM_FMTBIT_S16_LE | \
  29. SNDRV_PCM_FMTBIT_S24_LE | \
  30. SNDRV_PCM_FMTBIT_S32_LE)
  31. static int kirkwood_i2s_set_fmt(struct snd_soc_dai *cpu_dai,
  32. unsigned int fmt)
  33. {
  34. struct kirkwood_dma_data *priv = snd_soc_dai_get_drvdata(cpu_dai);
  35. unsigned long mask;
  36. unsigned long value;
  37. switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
  38. case SND_SOC_DAIFMT_RIGHT_J:
  39. mask = KIRKWOOD_I2S_CTL_RJ;
  40. break;
  41. case SND_SOC_DAIFMT_LEFT_J:
  42. mask = KIRKWOOD_I2S_CTL_LJ;
  43. break;
  44. case SND_SOC_DAIFMT_I2S:
  45. mask = KIRKWOOD_I2S_CTL_I2S;
  46. break;
  47. default:
  48. return -EINVAL;
  49. }
  50. /*
  51. * Set same format for playback and record
  52. * This avoids some troubles.
  53. */
  54. value = readl(priv->io+KIRKWOOD_I2S_PLAYCTL);
  55. value &= ~KIRKWOOD_I2S_CTL_JUST_MASK;
  56. value |= mask;
  57. writel(value, priv->io+KIRKWOOD_I2S_PLAYCTL);
  58. value = readl(priv->io+KIRKWOOD_I2S_RECCTL);
  59. value &= ~KIRKWOOD_I2S_CTL_JUST_MASK;
  60. value |= mask;
  61. writel(value, priv->io+KIRKWOOD_I2S_RECCTL);
  62. return 0;
  63. }
  64. static inline void kirkwood_set_dco(void __iomem *io, unsigned long rate)
  65. {
  66. unsigned long value;
  67. value = KIRKWOOD_DCO_CTL_OFFSET_0;
  68. switch (rate) {
  69. default:
  70. case 44100:
  71. value |= KIRKWOOD_DCO_CTL_FREQ_11;
  72. break;
  73. case 48000:
  74. value |= KIRKWOOD_DCO_CTL_FREQ_12;
  75. break;
  76. case 96000:
  77. value |= KIRKWOOD_DCO_CTL_FREQ_24;
  78. break;
  79. }
  80. writel(value, io + KIRKWOOD_DCO_CTL);
  81. /* wait for dco locked */
  82. do {
  83. cpu_relax();
  84. value = readl(io + KIRKWOOD_DCO_SPCR_STATUS);
  85. value &= KIRKWOOD_DCO_SPCR_STATUS_DCO_LOCK;
  86. } while (value == 0);
  87. }
  88. static void kirkwood_set_rate(struct snd_soc_dai *dai,
  89. struct kirkwood_dma_data *priv, unsigned long rate)
  90. {
  91. uint32_t clks_ctrl;
  92. if (IS_ERR(priv->extclk)) {
  93. /* use internal dco for the supported rates
  94. * defined in kirkwood_i2s_dai */
  95. dev_dbg(dai->dev, "%s: dco set rate = %lu\n",
  96. __func__, rate);
  97. kirkwood_set_dco(priv->io, rate);
  98. clks_ctrl = KIRKWOOD_MCLK_SOURCE_DCO;
  99. } else {
  100. /* use the external clock for the other rates
  101. * defined in kirkwood_i2s_dai_extclk */
  102. dev_dbg(dai->dev, "%s: extclk set rate = %lu -> %lu\n",
  103. __func__, rate, 256 * rate);
  104. clk_set_rate(priv->extclk, 256 * rate);
  105. clks_ctrl = KIRKWOOD_MCLK_SOURCE_EXTCLK;
  106. }
  107. writel(clks_ctrl, priv->io + KIRKWOOD_CLOCKS_CTRL);
  108. }
  109. static int kirkwood_i2s_startup(struct snd_pcm_substream *substream,
  110. struct snd_soc_dai *dai)
  111. {
  112. struct kirkwood_dma_data *priv = snd_soc_dai_get_drvdata(dai);
  113. snd_soc_dai_set_dma_data(dai, substream, priv);
  114. return 0;
  115. }
  116. static int kirkwood_i2s_hw_params(struct snd_pcm_substream *substream,
  117. struct snd_pcm_hw_params *params,
  118. struct snd_soc_dai *dai)
  119. {
  120. struct kirkwood_dma_data *priv = snd_soc_dai_get_drvdata(dai);
  121. uint32_t ctl_play, ctl_rec;
  122. unsigned int i2s_reg;
  123. unsigned long i2s_value;
  124. if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
  125. i2s_reg = KIRKWOOD_I2S_PLAYCTL;
  126. } else {
  127. i2s_reg = KIRKWOOD_I2S_RECCTL;
  128. }
  129. kirkwood_set_rate(dai, priv, params_rate(params));
  130. i2s_value = readl(priv->io+i2s_reg);
  131. i2s_value &= ~KIRKWOOD_I2S_CTL_SIZE_MASK;
  132. /*
  133. * Size settings in play/rec i2s control regs and play/rec control
  134. * regs must be the same.
  135. */
  136. switch (params_format(params)) {
  137. case SNDRV_PCM_FORMAT_S16_LE:
  138. i2s_value |= KIRKWOOD_I2S_CTL_SIZE_16;
  139. ctl_play = KIRKWOOD_PLAYCTL_SIZE_16_C |
  140. KIRKWOOD_PLAYCTL_I2S_EN |
  141. KIRKWOOD_PLAYCTL_SPDIF_EN;
  142. ctl_rec = KIRKWOOD_RECCTL_SIZE_16_C |
  143. KIRKWOOD_RECCTL_I2S_EN |
  144. KIRKWOOD_RECCTL_SPDIF_EN;
  145. break;
  146. /*
  147. * doesn't work... S20_3LE != kirkwood 20bit format ?
  148. *
  149. case SNDRV_PCM_FORMAT_S20_3LE:
  150. i2s_value |= KIRKWOOD_I2S_CTL_SIZE_20;
  151. ctl_play = KIRKWOOD_PLAYCTL_SIZE_20 |
  152. KIRKWOOD_PLAYCTL_I2S_EN;
  153. ctl_rec = KIRKWOOD_RECCTL_SIZE_20 |
  154. KIRKWOOD_RECCTL_I2S_EN;
  155. break;
  156. */
  157. case SNDRV_PCM_FORMAT_S24_LE:
  158. i2s_value |= KIRKWOOD_I2S_CTL_SIZE_24;
  159. ctl_play = KIRKWOOD_PLAYCTL_SIZE_24 |
  160. KIRKWOOD_PLAYCTL_I2S_EN |
  161. KIRKWOOD_PLAYCTL_SPDIF_EN;
  162. ctl_rec = KIRKWOOD_RECCTL_SIZE_24 |
  163. KIRKWOOD_RECCTL_I2S_EN |
  164. KIRKWOOD_RECCTL_SPDIF_EN;
  165. break;
  166. case SNDRV_PCM_FORMAT_S32_LE:
  167. i2s_value |= KIRKWOOD_I2S_CTL_SIZE_32;
  168. ctl_play = KIRKWOOD_PLAYCTL_SIZE_32 |
  169. KIRKWOOD_PLAYCTL_I2S_EN;
  170. ctl_rec = KIRKWOOD_RECCTL_SIZE_32 |
  171. KIRKWOOD_RECCTL_I2S_EN;
  172. break;
  173. default:
  174. return -EINVAL;
  175. }
  176. if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
  177. if (params_channels(params) == 1)
  178. ctl_play |= KIRKWOOD_PLAYCTL_MONO_BOTH;
  179. else
  180. ctl_play |= KIRKWOOD_PLAYCTL_MONO_OFF;
  181. priv->ctl_play &= ~(KIRKWOOD_PLAYCTL_MONO_MASK |
  182. KIRKWOOD_PLAYCTL_ENABLE_MASK |
  183. KIRKWOOD_PLAYCTL_SIZE_MASK);
  184. priv->ctl_play |= ctl_play;
  185. } else {
  186. priv->ctl_rec &= ~KIRKWOOD_RECCTL_SIZE_MASK;
  187. priv->ctl_rec |= ctl_rec;
  188. }
  189. writel(i2s_value, priv->io+i2s_reg);
  190. return 0;
  191. }
  192. static int kirkwood_i2s_play_trigger(struct snd_pcm_substream *substream,
  193. int cmd, struct snd_soc_dai *dai)
  194. {
  195. struct kirkwood_dma_data *priv = snd_soc_dai_get_drvdata(dai);
  196. uint32_t ctl, value;
  197. ctl = readl(priv->io + KIRKWOOD_PLAYCTL);
  198. if (ctl & KIRKWOOD_PLAYCTL_PAUSE) {
  199. unsigned timeout = 5000;
  200. /*
  201. * The Armada510 spec says that if we enter pause mode, the
  202. * busy bit must be read back as clear _twice_. Make sure
  203. * we respect that otherwise we get DMA underruns.
  204. */
  205. do {
  206. value = ctl;
  207. ctl = readl(priv->io + KIRKWOOD_PLAYCTL);
  208. if (!((ctl | value) & KIRKWOOD_PLAYCTL_PLAY_BUSY))
  209. break;
  210. udelay(1);
  211. } while (timeout--);
  212. if ((ctl | value) & KIRKWOOD_PLAYCTL_PLAY_BUSY)
  213. dev_notice(dai->dev, "timed out waiting for busy to deassert: %08x\n",
  214. ctl);
  215. }
  216. if (dai->id == 0)
  217. ctl &= ~KIRKWOOD_PLAYCTL_SPDIF_EN; /* i2s */
  218. else
  219. ctl &= ~KIRKWOOD_PLAYCTL_I2S_EN; /* spdif */
  220. switch (cmd) {
  221. case SNDRV_PCM_TRIGGER_START:
  222. /* configure */
  223. ctl = priv->ctl_play;
  224. value = ctl & ~KIRKWOOD_PLAYCTL_ENABLE_MASK;
  225. writel(value, priv->io + KIRKWOOD_PLAYCTL);
  226. /* enable interrupts */
  227. value = readl(priv->io + KIRKWOOD_INT_MASK);
  228. value |= KIRKWOOD_INT_CAUSE_PLAY_BYTES;
  229. writel(value, priv->io + KIRKWOOD_INT_MASK);
  230. /* enable playback */
  231. writel(ctl, priv->io + KIRKWOOD_PLAYCTL);
  232. break;
  233. case SNDRV_PCM_TRIGGER_STOP:
  234. /* stop audio, disable interrupts */
  235. ctl |= KIRKWOOD_PLAYCTL_PAUSE | KIRKWOOD_PLAYCTL_I2S_MUTE |
  236. KIRKWOOD_PLAYCTL_SPDIF_MUTE;
  237. writel(ctl, priv->io + KIRKWOOD_PLAYCTL);
  238. value = readl(priv->io + KIRKWOOD_INT_MASK);
  239. value &= ~KIRKWOOD_INT_CAUSE_PLAY_BYTES;
  240. writel(value, priv->io + KIRKWOOD_INT_MASK);
  241. /* disable all playbacks */
  242. ctl &= ~KIRKWOOD_PLAYCTL_ENABLE_MASK;
  243. writel(ctl, priv->io + KIRKWOOD_PLAYCTL);
  244. break;
  245. case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
  246. case SNDRV_PCM_TRIGGER_SUSPEND:
  247. ctl |= KIRKWOOD_PLAYCTL_PAUSE | KIRKWOOD_PLAYCTL_I2S_MUTE |
  248. KIRKWOOD_PLAYCTL_SPDIF_MUTE;
  249. writel(ctl, priv->io + KIRKWOOD_PLAYCTL);
  250. break;
  251. case SNDRV_PCM_TRIGGER_RESUME:
  252. case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
  253. ctl &= ~(KIRKWOOD_PLAYCTL_PAUSE | KIRKWOOD_PLAYCTL_I2S_MUTE |
  254. KIRKWOOD_PLAYCTL_SPDIF_MUTE);
  255. writel(ctl, priv->io + KIRKWOOD_PLAYCTL);
  256. break;
  257. default:
  258. return -EINVAL;
  259. }
  260. return 0;
  261. }
  262. static int kirkwood_i2s_rec_trigger(struct snd_pcm_substream *substream,
  263. int cmd, struct snd_soc_dai *dai)
  264. {
  265. struct kirkwood_dma_data *priv = snd_soc_dai_get_drvdata(dai);
  266. uint32_t ctl, value;
  267. value = readl(priv->io + KIRKWOOD_RECCTL);
  268. switch (cmd) {
  269. case SNDRV_PCM_TRIGGER_START:
  270. /* configure */
  271. ctl = priv->ctl_rec;
  272. if (dai->id == 0)
  273. ctl &= ~KIRKWOOD_RECCTL_SPDIF_EN; /* i2s */
  274. else
  275. ctl &= ~KIRKWOOD_RECCTL_I2S_EN; /* spdif */
  276. value = ctl & ~(KIRKWOOD_RECCTL_I2S_EN |
  277. KIRKWOOD_RECCTL_SPDIF_EN);
  278. writel(value, priv->io + KIRKWOOD_RECCTL);
  279. /* enable interrupts */
  280. value = readl(priv->io + KIRKWOOD_INT_MASK);
  281. value |= KIRKWOOD_INT_CAUSE_REC_BYTES;
  282. writel(value, priv->io + KIRKWOOD_INT_MASK);
  283. /* enable record */
  284. writel(ctl, priv->io + KIRKWOOD_RECCTL);
  285. break;
  286. case SNDRV_PCM_TRIGGER_STOP:
  287. /* stop audio, disable interrupts */
  288. value = readl(priv->io + KIRKWOOD_RECCTL);
  289. value |= KIRKWOOD_RECCTL_PAUSE | KIRKWOOD_RECCTL_MUTE;
  290. writel(value, priv->io + KIRKWOOD_RECCTL);
  291. value = readl(priv->io + KIRKWOOD_INT_MASK);
  292. value &= ~KIRKWOOD_INT_CAUSE_REC_BYTES;
  293. writel(value, priv->io + KIRKWOOD_INT_MASK);
  294. /* disable all records */
  295. value = readl(priv->io + KIRKWOOD_RECCTL);
  296. value &= ~(KIRKWOOD_RECCTL_I2S_EN | KIRKWOOD_RECCTL_SPDIF_EN);
  297. writel(value, priv->io + KIRKWOOD_RECCTL);
  298. break;
  299. case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
  300. case SNDRV_PCM_TRIGGER_SUSPEND:
  301. value = readl(priv->io + KIRKWOOD_RECCTL);
  302. value |= KIRKWOOD_RECCTL_PAUSE | KIRKWOOD_RECCTL_MUTE;
  303. writel(value, priv->io + KIRKWOOD_RECCTL);
  304. break;
  305. case SNDRV_PCM_TRIGGER_RESUME:
  306. case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
  307. value = readl(priv->io + KIRKWOOD_RECCTL);
  308. value &= ~(KIRKWOOD_RECCTL_PAUSE | KIRKWOOD_RECCTL_MUTE);
  309. writel(value, priv->io + KIRKWOOD_RECCTL);
  310. break;
  311. default:
  312. return -EINVAL;
  313. }
  314. return 0;
  315. }
  316. static int kirkwood_i2s_trigger(struct snd_pcm_substream *substream, int cmd,
  317. struct snd_soc_dai *dai)
  318. {
  319. if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
  320. return kirkwood_i2s_play_trigger(substream, cmd, dai);
  321. else
  322. return kirkwood_i2s_rec_trigger(substream, cmd, dai);
  323. return 0;
  324. }
  325. static int kirkwood_i2s_init(struct kirkwood_dma_data *priv)
  326. {
  327. unsigned long value;
  328. unsigned int reg_data;
  329. /* put system in a "safe" state : */
  330. /* disable audio interrupts */
  331. writel(0xffffffff, priv->io + KIRKWOOD_INT_CAUSE);
  332. writel(0, priv->io + KIRKWOOD_INT_MASK);
  333. reg_data = readl(priv->io + 0x1200);
  334. reg_data &= (~(0x333FF8));
  335. reg_data |= 0x111D18;
  336. writel(reg_data, priv->io + 0x1200);
  337. msleep(500);
  338. reg_data = readl(priv->io + 0x1200);
  339. reg_data &= (~(0x333FF8));
  340. reg_data |= 0x111D18;
  341. writel(reg_data, priv->io + 0x1200);
  342. /* disable playback/record */
  343. value = readl(priv->io + KIRKWOOD_PLAYCTL);
  344. value &= ~KIRKWOOD_PLAYCTL_ENABLE_MASK;
  345. writel(value, priv->io + KIRKWOOD_PLAYCTL);
  346. value = readl(priv->io + KIRKWOOD_RECCTL);
  347. value &= ~(KIRKWOOD_RECCTL_I2S_EN | KIRKWOOD_RECCTL_SPDIF_EN);
  348. writel(value, priv->io + KIRKWOOD_RECCTL);
  349. return 0;
  350. }
  351. static const struct snd_soc_dai_ops kirkwood_i2s_dai_ops = {
  352. .startup = kirkwood_i2s_startup,
  353. .trigger = kirkwood_i2s_trigger,
  354. .hw_params = kirkwood_i2s_hw_params,
  355. .set_fmt = kirkwood_i2s_set_fmt,
  356. };
  357. static struct snd_soc_dai_driver kirkwood_i2s_dai[2] = {
  358. {
  359. .name = "i2s",
  360. .id = 0,
  361. .playback = {
  362. .channels_min = 1,
  363. .channels_max = 2,
  364. .rates = SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000 |
  365. SNDRV_PCM_RATE_96000,
  366. .formats = KIRKWOOD_I2S_FORMATS,
  367. },
  368. .capture = {
  369. .channels_min = 1,
  370. .channels_max = 2,
  371. .rates = SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000 |
  372. SNDRV_PCM_RATE_96000,
  373. .formats = KIRKWOOD_I2S_FORMATS,
  374. },
  375. .ops = &kirkwood_i2s_dai_ops,
  376. },
  377. {
  378. .name = "spdif",
  379. .id = 1,
  380. .playback = {
  381. .channels_min = 1,
  382. .channels_max = 2,
  383. .rates = SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000 |
  384. SNDRV_PCM_RATE_96000,
  385. .formats = KIRKWOOD_I2S_FORMATS,
  386. },
  387. .capture = {
  388. .channels_min = 1,
  389. .channels_max = 2,
  390. .rates = SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000 |
  391. SNDRV_PCM_RATE_96000,
  392. .formats = KIRKWOOD_I2S_FORMATS,
  393. },
  394. .ops = &kirkwood_i2s_dai_ops,
  395. },
  396. };
  397. static struct snd_soc_dai_driver kirkwood_i2s_dai_extclk[2] = {
  398. {
  399. .name = "i2s",
  400. .id = 0,
  401. .playback = {
  402. .channels_min = 1,
  403. .channels_max = 2,
  404. .rates = SNDRV_PCM_RATE_8000_192000 |
  405. SNDRV_PCM_RATE_CONTINUOUS |
  406. SNDRV_PCM_RATE_KNOT,
  407. .formats = KIRKWOOD_I2S_FORMATS,
  408. },
  409. .capture = {
  410. .channels_min = 1,
  411. .channels_max = 2,
  412. .rates = SNDRV_PCM_RATE_8000_192000 |
  413. SNDRV_PCM_RATE_CONTINUOUS |
  414. SNDRV_PCM_RATE_KNOT,
  415. .formats = KIRKWOOD_I2S_FORMATS,
  416. },
  417. .ops = &kirkwood_i2s_dai_ops,
  418. },
  419. {
  420. .name = "spdif",
  421. .id = 1,
  422. .playback = {
  423. .channels_min = 1,
  424. .channels_max = 2,
  425. .rates = SNDRV_PCM_RATE_8000_192000 |
  426. SNDRV_PCM_RATE_CONTINUOUS |
  427. SNDRV_PCM_RATE_KNOT,
  428. .formats = KIRKWOOD_I2S_FORMATS,
  429. },
  430. .capture = {
  431. .channels_min = 1,
  432. .channels_max = 2,
  433. .rates = SNDRV_PCM_RATE_8000_192000 |
  434. SNDRV_PCM_RATE_CONTINUOUS |
  435. SNDRV_PCM_RATE_KNOT,
  436. .formats = KIRKWOOD_I2S_FORMATS,
  437. },
  438. .ops = &kirkwood_i2s_dai_ops,
  439. },
  440. };
  441. static const struct snd_soc_component_driver kirkwood_i2s_component = {
  442. .name = DRV_NAME,
  443. };
  444. static int kirkwood_i2s_dev_probe(struct platform_device *pdev)
  445. {
  446. struct kirkwood_asoc_platform_data *data = pdev->dev.platform_data;
  447. struct snd_soc_dai_driver *soc_dai = kirkwood_i2s_dai;
  448. struct kirkwood_dma_data *priv;
  449. struct resource *mem;
  450. struct device_node *np = pdev->dev.of_node;
  451. int err;
  452. priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
  453. if (!priv) {
  454. dev_err(&pdev->dev, "allocation failed\n");
  455. return -ENOMEM;
  456. }
  457. dev_set_drvdata(&pdev->dev, priv);
  458. mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  459. priv->io = devm_ioremap_resource(&pdev->dev, mem);
  460. if (IS_ERR(priv->io))
  461. return PTR_ERR(priv->io);
  462. priv->irq = platform_get_irq(pdev, 0);
  463. if (priv->irq <= 0) {
  464. dev_err(&pdev->dev, "platform_get_irq failed\n");
  465. return -ENXIO;
  466. }
  467. if (np) {
  468. priv->burst = 128; /* might be 32 or 128 */
  469. } else if (data) {
  470. priv->burst = data->burst;
  471. } else {
  472. dev_err(&pdev->dev, "no DT nor platform data ?!\n");
  473. return -EINVAL;
  474. }
  475. priv->clk = devm_clk_get(&pdev->dev, np ? "internal" : NULL);
  476. if (IS_ERR(priv->clk)) {
  477. dev_err(&pdev->dev, "no clock\n");
  478. return PTR_ERR(priv->clk);
  479. }
  480. err = clk_prepare_enable(priv->clk);
  481. if (err < 0)
  482. return err;
  483. priv->extclk = devm_clk_get(&pdev->dev, "extclk");
  484. if (IS_ERR(priv->extclk)) {
  485. if (PTR_ERR(priv->extclk) == -EPROBE_DEFER)
  486. return -EPROBE_DEFER;
  487. } else {
  488. if (priv->extclk == priv->clk) {
  489. devm_clk_put(&pdev->dev, priv->extclk);
  490. priv->extclk = ERR_PTR(-EINVAL);
  491. } else {
  492. dev_info(&pdev->dev, "found external clock\n");
  493. clk_prepare_enable(priv->extclk);
  494. soc_dai = kirkwood_i2s_dai_extclk;
  495. }
  496. }
  497. /* Some sensible defaults - this reflects the powerup values */
  498. priv->ctl_play = KIRKWOOD_PLAYCTL_SIZE_24;
  499. priv->ctl_rec = KIRKWOOD_RECCTL_SIZE_24;
  500. /* Select the burst size */
  501. if (priv->burst == 32) {
  502. priv->ctl_play |= KIRKWOOD_PLAYCTL_BURST_32;
  503. priv->ctl_rec |= KIRKWOOD_RECCTL_BURST_32;
  504. } else {
  505. priv->ctl_play |= KIRKWOOD_PLAYCTL_BURST_128;
  506. priv->ctl_rec |= KIRKWOOD_RECCTL_BURST_128;
  507. }
  508. err = snd_soc_register_component(&pdev->dev, &kirkwood_i2s_component,
  509. soc_dai, 2);
  510. if (err) {
  511. dev_err(&pdev->dev, "snd_soc_register_component failed\n");
  512. goto err_component;
  513. }
  514. err = snd_soc_register_platform(&pdev->dev, &kirkwood_soc_platform);
  515. if (err) {
  516. dev_err(&pdev->dev, "snd_soc_register_platform failed\n");
  517. goto err_platform;
  518. }
  519. kirkwood_i2s_init(priv);
  520. return 0;
  521. err_platform:
  522. snd_soc_unregister_component(&pdev->dev);
  523. err_component:
  524. if (!IS_ERR(priv->extclk))
  525. clk_disable_unprepare(priv->extclk);
  526. clk_disable_unprepare(priv->clk);
  527. return err;
  528. }
  529. static int kirkwood_i2s_dev_remove(struct platform_device *pdev)
  530. {
  531. struct kirkwood_dma_data *priv = dev_get_drvdata(&pdev->dev);
  532. snd_soc_unregister_platform(&pdev->dev);
  533. snd_soc_unregister_component(&pdev->dev);
  534. if (!IS_ERR(priv->extclk))
  535. clk_disable_unprepare(priv->extclk);
  536. clk_disable_unprepare(priv->clk);
  537. return 0;
  538. }
  539. #ifdef CONFIG_OF
  540. static struct of_device_id mvebu_audio_of_match[] = {
  541. { .compatible = "marvell,kirkwood-audio" },
  542. { .compatible = "marvell,dove-audio" },
  543. { }
  544. };
  545. MODULE_DEVICE_TABLE(of, mvebu_audio_of_match);
  546. #endif
  547. static struct platform_driver kirkwood_i2s_driver = {
  548. .probe = kirkwood_i2s_dev_probe,
  549. .remove = kirkwood_i2s_dev_remove,
  550. .driver = {
  551. .name = DRV_NAME,
  552. .owner = THIS_MODULE,
  553. .of_match_table = of_match_ptr(mvebu_audio_of_match),
  554. },
  555. };
  556. module_platform_driver(kirkwood_i2s_driver);
  557. /* Module information */
  558. MODULE_AUTHOR("Arnaud Patard, <arnaud.patard@rtp-net.org>");
  559. MODULE_DESCRIPTION("Kirkwood I2S SoC Interface");
  560. MODULE_LICENSE("GPL");
  561. MODULE_ALIAS("platform:mvebu-audio");