rockchip_i2s.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727
  1. /* sound/soc/rockchip/rockchip_i2s.c
  2. *
  3. * ALSA SoC Audio Layer - Rockchip I2S Controller driver
  4. *
  5. * Copyright (c) 2014 Rockchip Electronics Co. Ltd.
  6. * Author: Jianqun <jay.xu@rock-chips.com>
  7. *
  8. * This program is free software; you can redistribute it and/or modify
  9. * it under the terms of the GNU General Public License version 2 as
  10. * published by the Free Software Foundation.
  11. */
  12. #include <linux/module.h>
  13. #include <linux/mfd/syscon.h>
  14. #include <linux/delay.h>
  15. #include <linux/of_gpio.h>
  16. #include <linux/of_device.h>
  17. #include <linux/clk.h>
  18. #include <linux/pm_runtime.h>
  19. #include <linux/regmap.h>
  20. #include <sound/pcm_params.h>
  21. #include <sound/dmaengine_pcm.h>
  22. #include "rockchip_i2s.h"
  23. #include "rockchip_pcm.h"
  24. #define DRV_NAME "rockchip-i2s"
  25. struct rk_i2s_pins {
  26. u32 reg_offset;
  27. u32 shift;
  28. };
  29. struct rk_i2s_dev {
  30. struct device *dev;
  31. struct clk *hclk;
  32. struct clk *mclk;
  33. struct snd_dmaengine_dai_dma_data capture_dma_data;
  34. struct snd_dmaengine_dai_dma_data playback_dma_data;
  35. struct regmap *regmap;
  36. struct regmap *grf;
  37. /*
  38. * Used to indicate the tx/rx status.
  39. * I2S controller hopes to start the tx and rx together,
  40. * also to stop them when they are both try to stop.
  41. */
  42. bool tx_start;
  43. bool rx_start;
  44. bool is_master_mode;
  45. const struct rk_i2s_pins *pins;
  46. };
  47. static int i2s_runtime_suspend(struct device *dev)
  48. {
  49. struct rk_i2s_dev *i2s = dev_get_drvdata(dev);
  50. regcache_cache_only(i2s->regmap, true);
  51. clk_disable_unprepare(i2s->mclk);
  52. return 0;
  53. }
  54. static int i2s_runtime_resume(struct device *dev)
  55. {
  56. struct rk_i2s_dev *i2s = dev_get_drvdata(dev);
  57. int ret;
  58. ret = clk_prepare_enable(i2s->mclk);
  59. if (ret) {
  60. dev_err(i2s->dev, "clock enable failed %d\n", ret);
  61. return ret;
  62. }
  63. regcache_cache_only(i2s->regmap, false);
  64. regcache_mark_dirty(i2s->regmap);
  65. ret = regcache_sync(i2s->regmap);
  66. if (ret)
  67. clk_disable_unprepare(i2s->mclk);
  68. return ret;
  69. }
  70. static inline struct rk_i2s_dev *to_info(struct snd_soc_dai *dai)
  71. {
  72. return snd_soc_dai_get_drvdata(dai);
  73. }
  74. static void rockchip_snd_txctrl(struct rk_i2s_dev *i2s, int on)
  75. {
  76. unsigned int val = 0;
  77. int retry = 10;
  78. if (on) {
  79. regmap_update_bits(i2s->regmap, I2S_DMACR,
  80. I2S_DMACR_TDE_ENABLE, I2S_DMACR_TDE_ENABLE);
  81. regmap_update_bits(i2s->regmap, I2S_XFER,
  82. I2S_XFER_TXS_START | I2S_XFER_RXS_START,
  83. I2S_XFER_TXS_START | I2S_XFER_RXS_START);
  84. i2s->tx_start = true;
  85. } else {
  86. i2s->tx_start = false;
  87. regmap_update_bits(i2s->regmap, I2S_DMACR,
  88. I2S_DMACR_TDE_ENABLE, I2S_DMACR_TDE_DISABLE);
  89. if (!i2s->rx_start) {
  90. regmap_update_bits(i2s->regmap, I2S_XFER,
  91. I2S_XFER_TXS_START |
  92. I2S_XFER_RXS_START,
  93. I2S_XFER_TXS_STOP |
  94. I2S_XFER_RXS_STOP);
  95. udelay(150);
  96. regmap_update_bits(i2s->regmap, I2S_CLR,
  97. I2S_CLR_TXC | I2S_CLR_RXC,
  98. I2S_CLR_TXC | I2S_CLR_RXC);
  99. regmap_read(i2s->regmap, I2S_CLR, &val);
  100. /* Should wait for clear operation to finish */
  101. while (val) {
  102. regmap_read(i2s->regmap, I2S_CLR, &val);
  103. retry--;
  104. if (!retry) {
  105. dev_warn(i2s->dev, "fail to clear\n");
  106. break;
  107. }
  108. }
  109. }
  110. }
  111. }
  112. static void rockchip_snd_rxctrl(struct rk_i2s_dev *i2s, int on)
  113. {
  114. unsigned int val = 0;
  115. int retry = 10;
  116. if (on) {
  117. regmap_update_bits(i2s->regmap, I2S_DMACR,
  118. I2S_DMACR_RDE_ENABLE, I2S_DMACR_RDE_ENABLE);
  119. regmap_update_bits(i2s->regmap, I2S_XFER,
  120. I2S_XFER_TXS_START | I2S_XFER_RXS_START,
  121. I2S_XFER_TXS_START | I2S_XFER_RXS_START);
  122. i2s->rx_start = true;
  123. } else {
  124. i2s->rx_start = false;
  125. regmap_update_bits(i2s->regmap, I2S_DMACR,
  126. I2S_DMACR_RDE_ENABLE, I2S_DMACR_RDE_DISABLE);
  127. if (!i2s->tx_start) {
  128. regmap_update_bits(i2s->regmap, I2S_XFER,
  129. I2S_XFER_TXS_START |
  130. I2S_XFER_RXS_START,
  131. I2S_XFER_TXS_STOP |
  132. I2S_XFER_RXS_STOP);
  133. udelay(150);
  134. regmap_update_bits(i2s->regmap, I2S_CLR,
  135. I2S_CLR_TXC | I2S_CLR_RXC,
  136. I2S_CLR_TXC | I2S_CLR_RXC);
  137. regmap_read(i2s->regmap, I2S_CLR, &val);
  138. /* Should wait for clear operation to finish */
  139. while (val) {
  140. regmap_read(i2s->regmap, I2S_CLR, &val);
  141. retry--;
  142. if (!retry) {
  143. dev_warn(i2s->dev, "fail to clear\n");
  144. break;
  145. }
  146. }
  147. }
  148. }
  149. }
  150. static int rockchip_i2s_set_fmt(struct snd_soc_dai *cpu_dai,
  151. unsigned int fmt)
  152. {
  153. struct rk_i2s_dev *i2s = to_info(cpu_dai);
  154. unsigned int mask = 0, val = 0;
  155. mask = I2S_CKR_MSS_MASK;
  156. switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
  157. case SND_SOC_DAIFMT_CBS_CFS:
  158. /* Set source clock in Master mode */
  159. val = I2S_CKR_MSS_MASTER;
  160. i2s->is_master_mode = true;
  161. break;
  162. case SND_SOC_DAIFMT_CBM_CFM:
  163. val = I2S_CKR_MSS_SLAVE;
  164. i2s->is_master_mode = false;
  165. break;
  166. default:
  167. return -EINVAL;
  168. }
  169. regmap_update_bits(i2s->regmap, I2S_CKR, mask, val);
  170. mask = I2S_CKR_CKP_MASK;
  171. switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
  172. case SND_SOC_DAIFMT_NB_NF:
  173. val = I2S_CKR_CKP_NEG;
  174. break;
  175. case SND_SOC_DAIFMT_IB_NF:
  176. val = I2S_CKR_CKP_POS;
  177. break;
  178. default:
  179. return -EINVAL;
  180. }
  181. regmap_update_bits(i2s->regmap, I2S_CKR, mask, val);
  182. mask = I2S_TXCR_IBM_MASK | I2S_TXCR_TFS_MASK | I2S_TXCR_PBM_MASK;
  183. switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
  184. case SND_SOC_DAIFMT_RIGHT_J:
  185. val = I2S_TXCR_IBM_RSJM;
  186. break;
  187. case SND_SOC_DAIFMT_LEFT_J:
  188. val = I2S_TXCR_IBM_LSJM;
  189. break;
  190. case SND_SOC_DAIFMT_I2S:
  191. val = I2S_TXCR_IBM_NORMAL;
  192. break;
  193. case SND_SOC_DAIFMT_DSP_A: /* PCM no delay mode */
  194. val = I2S_TXCR_TFS_PCM;
  195. break;
  196. case SND_SOC_DAIFMT_DSP_B: /* PCM delay 1 mode */
  197. val = I2S_TXCR_TFS_PCM | I2S_TXCR_PBM_MODE(1);
  198. break;
  199. default:
  200. return -EINVAL;
  201. }
  202. regmap_update_bits(i2s->regmap, I2S_TXCR, mask, val);
  203. mask = I2S_RXCR_IBM_MASK | I2S_RXCR_TFS_MASK | I2S_RXCR_PBM_MASK;
  204. switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
  205. case SND_SOC_DAIFMT_RIGHT_J:
  206. val = I2S_RXCR_IBM_RSJM;
  207. break;
  208. case SND_SOC_DAIFMT_LEFT_J:
  209. val = I2S_RXCR_IBM_LSJM;
  210. break;
  211. case SND_SOC_DAIFMT_I2S:
  212. val = I2S_RXCR_IBM_NORMAL;
  213. break;
  214. case SND_SOC_DAIFMT_DSP_A: /* PCM no delay mode */
  215. val = I2S_RXCR_TFS_PCM;
  216. break;
  217. case SND_SOC_DAIFMT_DSP_B: /* PCM delay 1 mode */
  218. val = I2S_RXCR_TFS_PCM | I2S_RXCR_PBM_MODE(1);
  219. break;
  220. default:
  221. return -EINVAL;
  222. }
  223. regmap_update_bits(i2s->regmap, I2S_RXCR, mask, val);
  224. return 0;
  225. }
  226. static int rockchip_i2s_hw_params(struct snd_pcm_substream *substream,
  227. struct snd_pcm_hw_params *params,
  228. struct snd_soc_dai *dai)
  229. {
  230. struct rk_i2s_dev *i2s = to_info(dai);
  231. struct snd_soc_pcm_runtime *rtd = substream->private_data;
  232. unsigned int val = 0;
  233. unsigned int mclk_rate, bclk_rate, div_bclk, div_lrck;
  234. if (i2s->is_master_mode) {
  235. mclk_rate = clk_get_rate(i2s->mclk);
  236. bclk_rate = 2 * 32 * params_rate(params);
  237. if (bclk_rate && mclk_rate % bclk_rate)
  238. return -EINVAL;
  239. div_bclk = mclk_rate / bclk_rate;
  240. div_lrck = bclk_rate / params_rate(params);
  241. regmap_update_bits(i2s->regmap, I2S_CKR,
  242. I2S_CKR_MDIV_MASK,
  243. I2S_CKR_MDIV(div_bclk));
  244. regmap_update_bits(i2s->regmap, I2S_CKR,
  245. I2S_CKR_TSD_MASK |
  246. I2S_CKR_RSD_MASK,
  247. I2S_CKR_TSD(div_lrck) |
  248. I2S_CKR_RSD(div_lrck));
  249. }
  250. switch (params_format(params)) {
  251. case SNDRV_PCM_FORMAT_S8:
  252. val |= I2S_TXCR_VDW(8);
  253. break;
  254. case SNDRV_PCM_FORMAT_S16_LE:
  255. val |= I2S_TXCR_VDW(16);
  256. break;
  257. case SNDRV_PCM_FORMAT_S20_3LE:
  258. val |= I2S_TXCR_VDW(20);
  259. break;
  260. case SNDRV_PCM_FORMAT_S24_LE:
  261. val |= I2S_TXCR_VDW(24);
  262. break;
  263. case SNDRV_PCM_FORMAT_S32_LE:
  264. val |= I2S_TXCR_VDW(32);
  265. break;
  266. default:
  267. return -EINVAL;
  268. }
  269. switch (params_channels(params)) {
  270. case 8:
  271. val |= I2S_CHN_8;
  272. break;
  273. case 6:
  274. val |= I2S_CHN_6;
  275. break;
  276. case 4:
  277. val |= I2S_CHN_4;
  278. break;
  279. case 2:
  280. val |= I2S_CHN_2;
  281. break;
  282. default:
  283. dev_err(i2s->dev, "invalid channel: %d\n",
  284. params_channels(params));
  285. return -EINVAL;
  286. }
  287. if (substream->stream == SNDRV_PCM_STREAM_CAPTURE)
  288. regmap_update_bits(i2s->regmap, I2S_RXCR,
  289. I2S_RXCR_VDW_MASK | I2S_RXCR_CSR_MASK,
  290. val);
  291. else
  292. regmap_update_bits(i2s->regmap, I2S_TXCR,
  293. I2S_TXCR_VDW_MASK | I2S_TXCR_CSR_MASK,
  294. val);
  295. if (!IS_ERR(i2s->grf) && i2s->pins) {
  296. regmap_read(i2s->regmap, I2S_TXCR, &val);
  297. val &= I2S_TXCR_CSR_MASK;
  298. switch (val) {
  299. case I2S_CHN_4:
  300. val = I2S_IO_4CH_OUT_6CH_IN;
  301. break;
  302. case I2S_CHN_6:
  303. val = I2S_IO_6CH_OUT_4CH_IN;
  304. break;
  305. case I2S_CHN_8:
  306. val = I2S_IO_8CH_OUT_2CH_IN;
  307. break;
  308. default:
  309. val = I2S_IO_2CH_OUT_8CH_IN;
  310. break;
  311. }
  312. val <<= i2s->pins->shift;
  313. val |= (I2S_IO_DIRECTION_MASK << i2s->pins->shift) << 16;
  314. regmap_write(i2s->grf, i2s->pins->reg_offset, val);
  315. }
  316. regmap_update_bits(i2s->regmap, I2S_DMACR, I2S_DMACR_TDL_MASK,
  317. I2S_DMACR_TDL(16));
  318. regmap_update_bits(i2s->regmap, I2S_DMACR, I2S_DMACR_RDL_MASK,
  319. I2S_DMACR_RDL(16));
  320. val = I2S_CKR_TRCM_TXRX;
  321. if (dai->driver->symmetric_rates && rtd->dai_link->symmetric_rates)
  322. val = I2S_CKR_TRCM_TXONLY;
  323. regmap_update_bits(i2s->regmap, I2S_CKR,
  324. I2S_CKR_TRCM_MASK,
  325. val);
  326. return 0;
  327. }
  328. static int rockchip_i2s_trigger(struct snd_pcm_substream *substream,
  329. int cmd, struct snd_soc_dai *dai)
  330. {
  331. struct rk_i2s_dev *i2s = to_info(dai);
  332. int ret = 0;
  333. switch (cmd) {
  334. case SNDRV_PCM_TRIGGER_START:
  335. case SNDRV_PCM_TRIGGER_RESUME:
  336. case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
  337. if (substream->stream == SNDRV_PCM_STREAM_CAPTURE)
  338. rockchip_snd_rxctrl(i2s, 1);
  339. else
  340. rockchip_snd_txctrl(i2s, 1);
  341. break;
  342. case SNDRV_PCM_TRIGGER_SUSPEND:
  343. case SNDRV_PCM_TRIGGER_STOP:
  344. case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
  345. if (substream->stream == SNDRV_PCM_STREAM_CAPTURE)
  346. rockchip_snd_rxctrl(i2s, 0);
  347. else
  348. rockchip_snd_txctrl(i2s, 0);
  349. break;
  350. default:
  351. ret = -EINVAL;
  352. break;
  353. }
  354. return ret;
  355. }
  356. static int rockchip_i2s_set_sysclk(struct snd_soc_dai *cpu_dai, int clk_id,
  357. unsigned int freq, int dir)
  358. {
  359. struct rk_i2s_dev *i2s = to_info(cpu_dai);
  360. int ret;
  361. ret = clk_set_rate(i2s->mclk, freq);
  362. if (ret)
  363. dev_err(i2s->dev, "Fail to set mclk %d\n", ret);
  364. return ret;
  365. }
  366. static int rockchip_i2s_dai_probe(struct snd_soc_dai *dai)
  367. {
  368. struct rk_i2s_dev *i2s = snd_soc_dai_get_drvdata(dai);
  369. dai->capture_dma_data = &i2s->capture_dma_data;
  370. dai->playback_dma_data = &i2s->playback_dma_data;
  371. return 0;
  372. }
  373. static const struct snd_soc_dai_ops rockchip_i2s_dai_ops = {
  374. .hw_params = rockchip_i2s_hw_params,
  375. .set_sysclk = rockchip_i2s_set_sysclk,
  376. .set_fmt = rockchip_i2s_set_fmt,
  377. .trigger = rockchip_i2s_trigger,
  378. };
  379. static struct snd_soc_dai_driver rockchip_i2s_dai = {
  380. .probe = rockchip_i2s_dai_probe,
  381. .playback = {
  382. .stream_name = "Playback",
  383. .channels_min = 2,
  384. .channels_max = 8,
  385. .rates = SNDRV_PCM_RATE_8000_192000,
  386. .formats = (SNDRV_PCM_FMTBIT_S8 |
  387. SNDRV_PCM_FMTBIT_S16_LE |
  388. SNDRV_PCM_FMTBIT_S20_3LE |
  389. SNDRV_PCM_FMTBIT_S24_LE |
  390. SNDRV_PCM_FMTBIT_S32_LE),
  391. },
  392. .capture = {
  393. .stream_name = "Capture",
  394. .channels_min = 2,
  395. .channels_max = 2,
  396. .rates = SNDRV_PCM_RATE_8000_192000,
  397. .formats = (SNDRV_PCM_FMTBIT_S8 |
  398. SNDRV_PCM_FMTBIT_S16_LE |
  399. SNDRV_PCM_FMTBIT_S20_3LE |
  400. SNDRV_PCM_FMTBIT_S24_LE |
  401. SNDRV_PCM_FMTBIT_S32_LE),
  402. },
  403. .ops = &rockchip_i2s_dai_ops,
  404. .symmetric_rates = 1,
  405. };
  406. static const struct snd_soc_component_driver rockchip_i2s_component = {
  407. .name = DRV_NAME,
  408. };
  409. static bool rockchip_i2s_wr_reg(struct device *dev, unsigned int reg)
  410. {
  411. switch (reg) {
  412. case I2S_TXCR:
  413. case I2S_RXCR:
  414. case I2S_CKR:
  415. case I2S_DMACR:
  416. case I2S_INTCR:
  417. case I2S_XFER:
  418. case I2S_CLR:
  419. case I2S_TXDR:
  420. return true;
  421. default:
  422. return false;
  423. }
  424. }
  425. static bool rockchip_i2s_rd_reg(struct device *dev, unsigned int reg)
  426. {
  427. switch (reg) {
  428. case I2S_TXCR:
  429. case I2S_RXCR:
  430. case I2S_CKR:
  431. case I2S_DMACR:
  432. case I2S_INTCR:
  433. case I2S_XFER:
  434. case I2S_CLR:
  435. case I2S_TXDR:
  436. case I2S_RXDR:
  437. case I2S_FIFOLR:
  438. case I2S_INTSR:
  439. return true;
  440. default:
  441. return false;
  442. }
  443. }
  444. static bool rockchip_i2s_volatile_reg(struct device *dev, unsigned int reg)
  445. {
  446. switch (reg) {
  447. case I2S_INTSR:
  448. case I2S_CLR:
  449. case I2S_FIFOLR:
  450. case I2S_TXDR:
  451. case I2S_RXDR:
  452. return true;
  453. default:
  454. return false;
  455. }
  456. }
  457. static bool rockchip_i2s_precious_reg(struct device *dev, unsigned int reg)
  458. {
  459. switch (reg) {
  460. case I2S_RXDR:
  461. return true;
  462. default:
  463. return false;
  464. }
  465. }
  466. static const struct reg_default rockchip_i2s_reg_defaults[] = {
  467. {0x00, 0x0000000f},
  468. {0x04, 0x0000000f},
  469. {0x08, 0x00071f1f},
  470. {0x10, 0x001f0000},
  471. {0x14, 0x01f00000},
  472. };
  473. static const struct regmap_config rockchip_i2s_regmap_config = {
  474. .reg_bits = 32,
  475. .reg_stride = 4,
  476. .val_bits = 32,
  477. .max_register = I2S_RXDR,
  478. .reg_defaults = rockchip_i2s_reg_defaults,
  479. .num_reg_defaults = ARRAY_SIZE(rockchip_i2s_reg_defaults),
  480. .writeable_reg = rockchip_i2s_wr_reg,
  481. .readable_reg = rockchip_i2s_rd_reg,
  482. .volatile_reg = rockchip_i2s_volatile_reg,
  483. .precious_reg = rockchip_i2s_precious_reg,
  484. .cache_type = REGCACHE_FLAT,
  485. };
  486. static const struct rk_i2s_pins rk3399_i2s_pins = {
  487. .reg_offset = 0xe220,
  488. .shift = 11,
  489. };
  490. static const struct of_device_id rockchip_i2s_match[] = {
  491. { .compatible = "rockchip,rk3066-i2s", },
  492. { .compatible = "rockchip,rk3188-i2s", },
  493. { .compatible = "rockchip,rk3288-i2s", },
  494. { .compatible = "rockchip,rk3399-i2s", .data = &rk3399_i2s_pins },
  495. {},
  496. };
  497. static int rockchip_i2s_probe(struct platform_device *pdev)
  498. {
  499. struct device_node *node = pdev->dev.of_node;
  500. const struct of_device_id *of_id;
  501. struct rk_i2s_dev *i2s;
  502. struct snd_soc_dai_driver *soc_dai;
  503. struct resource *res;
  504. void __iomem *regs;
  505. int ret;
  506. int val;
  507. i2s = devm_kzalloc(&pdev->dev, sizeof(*i2s), GFP_KERNEL);
  508. if (!i2s)
  509. return -ENOMEM;
  510. i2s->dev = &pdev->dev;
  511. i2s->grf = syscon_regmap_lookup_by_phandle(node, "rockchip,grf");
  512. if (!IS_ERR(i2s->grf)) {
  513. of_id = of_match_device(rockchip_i2s_match, &pdev->dev);
  514. if (!of_id || !of_id->data)
  515. return -EINVAL;
  516. i2s->pins = of_id->data;
  517. }
  518. /* try to prepare related clocks */
  519. i2s->hclk = devm_clk_get(&pdev->dev, "i2s_hclk");
  520. if (IS_ERR(i2s->hclk)) {
  521. dev_err(&pdev->dev, "Can't retrieve i2s bus clock\n");
  522. return PTR_ERR(i2s->hclk);
  523. }
  524. ret = clk_prepare_enable(i2s->hclk);
  525. if (ret) {
  526. dev_err(i2s->dev, "hclock enable failed %d\n", ret);
  527. return ret;
  528. }
  529. i2s->mclk = devm_clk_get(&pdev->dev, "i2s_clk");
  530. if (IS_ERR(i2s->mclk)) {
  531. dev_err(&pdev->dev, "Can't retrieve i2s master clock\n");
  532. return PTR_ERR(i2s->mclk);
  533. }
  534. res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  535. regs = devm_ioremap_resource(&pdev->dev, res);
  536. if (IS_ERR(regs))
  537. return PTR_ERR(regs);
  538. i2s->regmap = devm_regmap_init_mmio(&pdev->dev, regs,
  539. &rockchip_i2s_regmap_config);
  540. if (IS_ERR(i2s->regmap)) {
  541. dev_err(&pdev->dev,
  542. "Failed to initialise managed register map\n");
  543. return PTR_ERR(i2s->regmap);
  544. }
  545. i2s->playback_dma_data.addr = res->start + I2S_TXDR;
  546. i2s->playback_dma_data.addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES;
  547. i2s->playback_dma_data.maxburst = 4;
  548. i2s->capture_dma_data.addr = res->start + I2S_RXDR;
  549. i2s->capture_dma_data.addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES;
  550. i2s->capture_dma_data.maxburst = 4;
  551. dev_set_drvdata(&pdev->dev, i2s);
  552. pm_runtime_enable(&pdev->dev);
  553. if (!pm_runtime_enabled(&pdev->dev)) {
  554. ret = i2s_runtime_resume(&pdev->dev);
  555. if (ret)
  556. goto err_pm_disable;
  557. }
  558. soc_dai = devm_kmemdup(&pdev->dev, &rockchip_i2s_dai,
  559. sizeof(*soc_dai), GFP_KERNEL);
  560. if (!soc_dai) {
  561. ret = -ENOMEM;
  562. goto err_pm_disable;
  563. }
  564. if (!of_property_read_u32(node, "rockchip,playback-channels", &val)) {
  565. if (val >= 2 && val <= 8)
  566. soc_dai->playback.channels_max = val;
  567. }
  568. if (!of_property_read_u32(node, "rockchip,capture-channels", &val)) {
  569. if (val >= 2 && val <= 8)
  570. soc_dai->capture.channels_max = val;
  571. }
  572. ret = devm_snd_soc_register_component(&pdev->dev,
  573. &rockchip_i2s_component,
  574. soc_dai, 1);
  575. if (ret) {
  576. dev_err(&pdev->dev, "Could not register DAI\n");
  577. goto err_suspend;
  578. }
  579. ret = rockchip_pcm_platform_register(&pdev->dev);
  580. if (ret) {
  581. dev_err(&pdev->dev, "Could not register PCM\n");
  582. goto err_suspend;
  583. }
  584. return 0;
  585. err_suspend:
  586. if (!pm_runtime_status_suspended(&pdev->dev))
  587. i2s_runtime_suspend(&pdev->dev);
  588. err_pm_disable:
  589. pm_runtime_disable(&pdev->dev);
  590. return ret;
  591. }
  592. static int rockchip_i2s_remove(struct platform_device *pdev)
  593. {
  594. struct rk_i2s_dev *i2s = dev_get_drvdata(&pdev->dev);
  595. pm_runtime_disable(&pdev->dev);
  596. if (!pm_runtime_status_suspended(&pdev->dev))
  597. i2s_runtime_suspend(&pdev->dev);
  598. clk_disable_unprepare(i2s->hclk);
  599. return 0;
  600. }
  601. static const struct dev_pm_ops rockchip_i2s_pm_ops = {
  602. SET_RUNTIME_PM_OPS(i2s_runtime_suspend, i2s_runtime_resume,
  603. NULL)
  604. };
  605. static struct platform_driver rockchip_i2s_driver = {
  606. .probe = rockchip_i2s_probe,
  607. .remove = rockchip_i2s_remove,
  608. .driver = {
  609. .name = DRV_NAME,
  610. .of_match_table = of_match_ptr(rockchip_i2s_match),
  611. .pm = &rockchip_i2s_pm_ops,
  612. },
  613. };
  614. module_platform_driver(rockchip_i2s_driver);
  615. MODULE_DESCRIPTION("ROCKCHIP IIS ASoC Interface");
  616. MODULE_AUTHOR("jianqun <jay.xu@rock-chips.com>");
  617. MODULE_LICENSE("GPL v2");
  618. MODULE_ALIAS("platform:" DRV_NAME);
  619. MODULE_DEVICE_TABLE(of, rockchip_i2s_match);