kirkwood-i2s.c 16 KB

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