kirkwood-i2s.c 17 KB

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