omap-mcpdm.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615
  1. /*
  2. * omap-mcpdm.c -- OMAP ALSA SoC DAI driver using McPDM port
  3. *
  4. * Copyright (C) 2009 - 2011 Texas Instruments
  5. *
  6. * Author: Misael Lopez Cruz <[email protected]>
  7. * Contact: Jorge Eduardo Candelaria <[email protected]>
  8. * Margarita Olaya <[email protected]>
  9. * Peter Ujfalusi <[email protected]>
  10. *
  11. * This program is free software; you can redistribute it and/or
  12. * modify it under the terms of the GNU General Public License
  13. * version 2 as published by the Free Software Foundation.
  14. *
  15. * This program is distributed in the hope that it will be useful, but
  16. * WITHOUT ANY WARRANTY; without even the implied warranty of
  17. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  18. * General Public License for more details.
  19. *
  20. * You should have received a copy of the GNU General Public License
  21. * along with this program; if not, write to the Free Software
  22. * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
  23. * 02110-1301 USA
  24. *
  25. */
  26. #include <linux/init.h>
  27. #include <linux/module.h>
  28. #include <linux/platform_device.h>
  29. #include <linux/interrupt.h>
  30. #include <linux/err.h>
  31. #include <linux/io.h>
  32. #include <linux/irq.h>
  33. #include <linux/slab.h>
  34. #include <linux/pm_runtime.h>
  35. #include <linux/of_device.h>
  36. #include <sound/core.h>
  37. #include <sound/pcm.h>
  38. #include <sound/pcm_params.h>
  39. #include <sound/soc.h>
  40. #include <sound/dmaengine_pcm.h>
  41. #include <sound/omap-pcm.h>
  42. #include "omap-mcpdm.h"
  43. struct mcpdm_link_config {
  44. u32 link_mask; /* channel mask for the direction */
  45. u32 threshold; /* FIFO threshold */
  46. };
  47. struct omap_mcpdm {
  48. struct device *dev;
  49. unsigned long phys_base;
  50. void __iomem *io_base;
  51. int irq;
  52. struct pm_qos_request pm_qos_req;
  53. int latency[2];
  54. struct mutex mutex;
  55. /* Playback/Capture configuration */
  56. struct mcpdm_link_config config[2];
  57. /* McPDM dn offsets for rx1, and 2 channels */
  58. u32 dn_rx_offset;
  59. /* McPDM needs to be restarted due to runtime reconfiguration */
  60. bool restart;
  61. /* pm state for suspend/resume handling */
  62. int pm_active_count;
  63. struct snd_dmaengine_dai_dma_data dma_data[2];
  64. };
  65. /*
  66. * Stream DMA parameters
  67. */
  68. static inline void omap_mcpdm_write(struct omap_mcpdm *mcpdm, u16 reg, u32 val)
  69. {
  70. writel_relaxed(val, mcpdm->io_base + reg);
  71. }
  72. static inline int omap_mcpdm_read(struct omap_mcpdm *mcpdm, u16 reg)
  73. {
  74. return readl_relaxed(mcpdm->io_base + reg);
  75. }
  76. #ifdef DEBUG
  77. static void omap_mcpdm_reg_dump(struct omap_mcpdm *mcpdm)
  78. {
  79. dev_dbg(mcpdm->dev, "***********************\n");
  80. dev_dbg(mcpdm->dev, "IRQSTATUS_RAW: 0x%04x\n",
  81. omap_mcpdm_read(mcpdm, MCPDM_REG_IRQSTATUS_RAW));
  82. dev_dbg(mcpdm->dev, "IRQSTATUS: 0x%04x\n",
  83. omap_mcpdm_read(mcpdm, MCPDM_REG_IRQSTATUS));
  84. dev_dbg(mcpdm->dev, "IRQENABLE_SET: 0x%04x\n",
  85. omap_mcpdm_read(mcpdm, MCPDM_REG_IRQENABLE_SET));
  86. dev_dbg(mcpdm->dev, "IRQENABLE_CLR: 0x%04x\n",
  87. omap_mcpdm_read(mcpdm, MCPDM_REG_IRQENABLE_CLR));
  88. dev_dbg(mcpdm->dev, "IRQWAKE_EN: 0x%04x\n",
  89. omap_mcpdm_read(mcpdm, MCPDM_REG_IRQWAKE_EN));
  90. dev_dbg(mcpdm->dev, "DMAENABLE_SET: 0x%04x\n",
  91. omap_mcpdm_read(mcpdm, MCPDM_REG_DMAENABLE_SET));
  92. dev_dbg(mcpdm->dev, "DMAENABLE_CLR: 0x%04x\n",
  93. omap_mcpdm_read(mcpdm, MCPDM_REG_DMAENABLE_CLR));
  94. dev_dbg(mcpdm->dev, "DMAWAKEEN: 0x%04x\n",
  95. omap_mcpdm_read(mcpdm, MCPDM_REG_DMAWAKEEN));
  96. dev_dbg(mcpdm->dev, "CTRL: 0x%04x\n",
  97. omap_mcpdm_read(mcpdm, MCPDM_REG_CTRL));
  98. dev_dbg(mcpdm->dev, "DN_DATA: 0x%04x\n",
  99. omap_mcpdm_read(mcpdm, MCPDM_REG_DN_DATA));
  100. dev_dbg(mcpdm->dev, "UP_DATA: 0x%04x\n",
  101. omap_mcpdm_read(mcpdm, MCPDM_REG_UP_DATA));
  102. dev_dbg(mcpdm->dev, "FIFO_CTRL_DN: 0x%04x\n",
  103. omap_mcpdm_read(mcpdm, MCPDM_REG_FIFO_CTRL_DN));
  104. dev_dbg(mcpdm->dev, "FIFO_CTRL_UP: 0x%04x\n",
  105. omap_mcpdm_read(mcpdm, MCPDM_REG_FIFO_CTRL_UP));
  106. dev_dbg(mcpdm->dev, "***********************\n");
  107. }
  108. #else
  109. static void omap_mcpdm_reg_dump(struct omap_mcpdm *mcpdm) {}
  110. #endif
  111. /*
  112. * Enables the transfer through the PDM interface to/from the Phoenix
  113. * codec by enabling the corresponding UP or DN channels.
  114. */
  115. static void omap_mcpdm_start(struct omap_mcpdm *mcpdm)
  116. {
  117. u32 ctrl = omap_mcpdm_read(mcpdm, MCPDM_REG_CTRL);
  118. u32 link_mask = mcpdm->config[0].link_mask | mcpdm->config[1].link_mask;
  119. ctrl |= (MCPDM_SW_DN_RST | MCPDM_SW_UP_RST);
  120. omap_mcpdm_write(mcpdm, MCPDM_REG_CTRL, ctrl);
  121. ctrl |= link_mask;
  122. omap_mcpdm_write(mcpdm, MCPDM_REG_CTRL, ctrl);
  123. ctrl &= ~(MCPDM_SW_DN_RST | MCPDM_SW_UP_RST);
  124. omap_mcpdm_write(mcpdm, MCPDM_REG_CTRL, ctrl);
  125. }
  126. /*
  127. * Disables the transfer through the PDM interface to/from the Phoenix
  128. * codec by disabling the corresponding UP or DN channels.
  129. */
  130. static void omap_mcpdm_stop(struct omap_mcpdm *mcpdm)
  131. {
  132. u32 ctrl = omap_mcpdm_read(mcpdm, MCPDM_REG_CTRL);
  133. u32 link_mask = MCPDM_PDM_DN_MASK | MCPDM_PDM_UP_MASK;
  134. ctrl |= (MCPDM_SW_DN_RST | MCPDM_SW_UP_RST);
  135. omap_mcpdm_write(mcpdm, MCPDM_REG_CTRL, ctrl);
  136. ctrl &= ~(link_mask);
  137. omap_mcpdm_write(mcpdm, MCPDM_REG_CTRL, ctrl);
  138. ctrl &= ~(MCPDM_SW_DN_RST | MCPDM_SW_UP_RST);
  139. omap_mcpdm_write(mcpdm, MCPDM_REG_CTRL, ctrl);
  140. }
  141. /*
  142. * Is the physical McPDM interface active.
  143. */
  144. static inline int omap_mcpdm_active(struct omap_mcpdm *mcpdm)
  145. {
  146. return omap_mcpdm_read(mcpdm, MCPDM_REG_CTRL) &
  147. (MCPDM_PDM_DN_MASK | MCPDM_PDM_UP_MASK);
  148. }
  149. /*
  150. * Configures McPDM uplink, and downlink for audio.
  151. * This function should be called before omap_mcpdm_start.
  152. */
  153. static void omap_mcpdm_open_streams(struct omap_mcpdm *mcpdm)
  154. {
  155. u32 ctrl = omap_mcpdm_read(mcpdm, MCPDM_REG_CTRL);
  156. omap_mcpdm_write(mcpdm, MCPDM_REG_CTRL, ctrl | MCPDM_WD_EN);
  157. omap_mcpdm_write(mcpdm, MCPDM_REG_IRQENABLE_SET,
  158. MCPDM_DN_IRQ_EMPTY | MCPDM_DN_IRQ_FULL |
  159. MCPDM_UP_IRQ_EMPTY | MCPDM_UP_IRQ_FULL);
  160. /* Enable DN RX1/2 offset cancellation feature, if configured */
  161. if (mcpdm->dn_rx_offset) {
  162. u32 dn_offset = mcpdm->dn_rx_offset;
  163. omap_mcpdm_write(mcpdm, MCPDM_REG_DN_OFFSET, dn_offset);
  164. dn_offset |= (MCPDM_DN_OFST_RX1_EN | MCPDM_DN_OFST_RX2_EN);
  165. omap_mcpdm_write(mcpdm, MCPDM_REG_DN_OFFSET, dn_offset);
  166. }
  167. omap_mcpdm_write(mcpdm, MCPDM_REG_FIFO_CTRL_DN,
  168. mcpdm->config[SNDRV_PCM_STREAM_PLAYBACK].threshold);
  169. omap_mcpdm_write(mcpdm, MCPDM_REG_FIFO_CTRL_UP,
  170. mcpdm->config[SNDRV_PCM_STREAM_CAPTURE].threshold);
  171. omap_mcpdm_write(mcpdm, MCPDM_REG_DMAENABLE_SET,
  172. MCPDM_DMA_DN_ENABLE | MCPDM_DMA_UP_ENABLE);
  173. }
  174. /*
  175. * Cleans McPDM uplink, and downlink configuration.
  176. * This function should be called when the stream is closed.
  177. */
  178. static void omap_mcpdm_close_streams(struct omap_mcpdm *mcpdm)
  179. {
  180. /* Disable irq request generation for downlink */
  181. omap_mcpdm_write(mcpdm, MCPDM_REG_IRQENABLE_CLR,
  182. MCPDM_DN_IRQ_EMPTY | MCPDM_DN_IRQ_FULL);
  183. /* Disable DMA request generation for downlink */
  184. omap_mcpdm_write(mcpdm, MCPDM_REG_DMAENABLE_CLR, MCPDM_DMA_DN_ENABLE);
  185. /* Disable irq request generation for uplink */
  186. omap_mcpdm_write(mcpdm, MCPDM_REG_IRQENABLE_CLR,
  187. MCPDM_UP_IRQ_EMPTY | MCPDM_UP_IRQ_FULL);
  188. /* Disable DMA request generation for uplink */
  189. omap_mcpdm_write(mcpdm, MCPDM_REG_DMAENABLE_CLR, MCPDM_DMA_UP_ENABLE);
  190. /* Disable RX1/2 offset cancellation */
  191. if (mcpdm->dn_rx_offset)
  192. omap_mcpdm_write(mcpdm, MCPDM_REG_DN_OFFSET, 0);
  193. }
  194. static irqreturn_t omap_mcpdm_irq_handler(int irq, void *dev_id)
  195. {
  196. struct omap_mcpdm *mcpdm = dev_id;
  197. int irq_status;
  198. irq_status = omap_mcpdm_read(mcpdm, MCPDM_REG_IRQSTATUS);
  199. /* Acknowledge irq event */
  200. omap_mcpdm_write(mcpdm, MCPDM_REG_IRQSTATUS, irq_status);
  201. if (irq_status & MCPDM_DN_IRQ_FULL)
  202. dev_dbg(mcpdm->dev, "DN (playback) FIFO Full\n");
  203. if (irq_status & MCPDM_DN_IRQ_EMPTY)
  204. dev_dbg(mcpdm->dev, "DN (playback) FIFO Empty\n");
  205. if (irq_status & MCPDM_DN_IRQ)
  206. dev_dbg(mcpdm->dev, "DN (playback) write request\n");
  207. if (irq_status & MCPDM_UP_IRQ_FULL)
  208. dev_dbg(mcpdm->dev, "UP (capture) FIFO Full\n");
  209. if (irq_status & MCPDM_UP_IRQ_EMPTY)
  210. dev_dbg(mcpdm->dev, "UP (capture) FIFO Empty\n");
  211. if (irq_status & MCPDM_UP_IRQ)
  212. dev_dbg(mcpdm->dev, "UP (capture) write request\n");
  213. return IRQ_HANDLED;
  214. }
  215. static int omap_mcpdm_dai_startup(struct snd_pcm_substream *substream,
  216. struct snd_soc_dai *dai)
  217. {
  218. struct omap_mcpdm *mcpdm = snd_soc_dai_get_drvdata(dai);
  219. mutex_lock(&mcpdm->mutex);
  220. if (!dai->active)
  221. omap_mcpdm_open_streams(mcpdm);
  222. mutex_unlock(&mcpdm->mutex);
  223. return 0;
  224. }
  225. static void omap_mcpdm_dai_shutdown(struct snd_pcm_substream *substream,
  226. struct snd_soc_dai *dai)
  227. {
  228. struct omap_mcpdm *mcpdm = snd_soc_dai_get_drvdata(dai);
  229. int tx = (substream->stream == SNDRV_PCM_STREAM_PLAYBACK);
  230. int stream1 = tx ? SNDRV_PCM_STREAM_PLAYBACK : SNDRV_PCM_STREAM_CAPTURE;
  231. int stream2 = tx ? SNDRV_PCM_STREAM_CAPTURE : SNDRV_PCM_STREAM_PLAYBACK;
  232. mutex_lock(&mcpdm->mutex);
  233. if (!dai->active) {
  234. if (omap_mcpdm_active(mcpdm)) {
  235. omap_mcpdm_stop(mcpdm);
  236. omap_mcpdm_close_streams(mcpdm);
  237. mcpdm->config[0].link_mask = 0;
  238. mcpdm->config[1].link_mask = 0;
  239. }
  240. }
  241. if (mcpdm->latency[stream2])
  242. pm_qos_update_request(&mcpdm->pm_qos_req,
  243. mcpdm->latency[stream2]);
  244. else if (mcpdm->latency[stream1])
  245. pm_qos_remove_request(&mcpdm->pm_qos_req);
  246. mcpdm->latency[stream1] = 0;
  247. mutex_unlock(&mcpdm->mutex);
  248. }
  249. static int omap_mcpdm_dai_hw_params(struct snd_pcm_substream *substream,
  250. struct snd_pcm_hw_params *params,
  251. struct snd_soc_dai *dai)
  252. {
  253. struct omap_mcpdm *mcpdm = snd_soc_dai_get_drvdata(dai);
  254. int stream = substream->stream;
  255. struct snd_dmaengine_dai_dma_data *dma_data;
  256. u32 threshold;
  257. int channels, latency;
  258. int link_mask = 0;
  259. channels = params_channels(params);
  260. switch (channels) {
  261. case 5:
  262. if (stream == SNDRV_PCM_STREAM_CAPTURE)
  263. /* up to 3 channels for capture */
  264. return -EINVAL;
  265. link_mask |= 1 << 4;
  266. case 4:
  267. if (stream == SNDRV_PCM_STREAM_CAPTURE)
  268. /* up to 3 channels for capture */
  269. return -EINVAL;
  270. link_mask |= 1 << 3;
  271. case 3:
  272. link_mask |= 1 << 2;
  273. case 2:
  274. link_mask |= 1 << 1;
  275. case 1:
  276. link_mask |= 1 << 0;
  277. break;
  278. default:
  279. /* unsupported number of channels */
  280. return -EINVAL;
  281. }
  282. dma_data = snd_soc_dai_get_dma_data(dai, substream);
  283. threshold = mcpdm->config[stream].threshold;
  284. /* Configure McPDM channels, and DMA packet size */
  285. if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
  286. link_mask <<= 3;
  287. /* If capture is not running assume a stereo stream to come */
  288. if (!mcpdm->config[!stream].link_mask)
  289. mcpdm->config[!stream].link_mask = 0x3;
  290. dma_data->maxburst =
  291. (MCPDM_DN_THRES_MAX - threshold) * channels;
  292. latency = threshold;
  293. } else {
  294. /* If playback is not running assume a stereo stream to come */
  295. if (!mcpdm->config[!stream].link_mask)
  296. mcpdm->config[!stream].link_mask = (0x3 << 3);
  297. dma_data->maxburst = threshold * channels;
  298. latency = (MCPDM_DN_THRES_MAX - threshold);
  299. }
  300. /*
  301. * The DMA must act to a DMA request within latency time (usec) to avoid
  302. * under/overflow
  303. */
  304. mcpdm->latency[stream] = latency * USEC_PER_SEC / params_rate(params);
  305. if (!mcpdm->latency[stream])
  306. mcpdm->latency[stream] = 10;
  307. /* Check if we need to restart McPDM with this stream */
  308. if (mcpdm->config[stream].link_mask &&
  309. mcpdm->config[stream].link_mask != link_mask)
  310. mcpdm->restart = true;
  311. mcpdm->config[stream].link_mask = link_mask;
  312. return 0;
  313. }
  314. static int omap_mcpdm_prepare(struct snd_pcm_substream *substream,
  315. struct snd_soc_dai *dai)
  316. {
  317. struct omap_mcpdm *mcpdm = snd_soc_dai_get_drvdata(dai);
  318. struct pm_qos_request *pm_qos_req = &mcpdm->pm_qos_req;
  319. int tx = (substream->stream == SNDRV_PCM_STREAM_PLAYBACK);
  320. int stream1 = tx ? SNDRV_PCM_STREAM_PLAYBACK : SNDRV_PCM_STREAM_CAPTURE;
  321. int stream2 = tx ? SNDRV_PCM_STREAM_CAPTURE : SNDRV_PCM_STREAM_PLAYBACK;
  322. int latency = mcpdm->latency[stream2];
  323. /* Prevent omap hardware from hitting off between FIFO fills */
  324. if (!latency || mcpdm->latency[stream1] < latency)
  325. latency = mcpdm->latency[stream1];
  326. if (pm_qos_request_active(pm_qos_req))
  327. pm_qos_update_request(pm_qos_req, latency);
  328. else if (latency)
  329. pm_qos_add_request(pm_qos_req, PM_QOS_CPU_DMA_LATENCY, latency);
  330. if (!omap_mcpdm_active(mcpdm)) {
  331. omap_mcpdm_start(mcpdm);
  332. omap_mcpdm_reg_dump(mcpdm);
  333. } else if (mcpdm->restart) {
  334. omap_mcpdm_stop(mcpdm);
  335. omap_mcpdm_start(mcpdm);
  336. mcpdm->restart = false;
  337. omap_mcpdm_reg_dump(mcpdm);
  338. }
  339. return 0;
  340. }
  341. static const struct snd_soc_dai_ops omap_mcpdm_dai_ops = {
  342. .startup = omap_mcpdm_dai_startup,
  343. .shutdown = omap_mcpdm_dai_shutdown,
  344. .hw_params = omap_mcpdm_dai_hw_params,
  345. .prepare = omap_mcpdm_prepare,
  346. };
  347. static int omap_mcpdm_probe(struct snd_soc_dai *dai)
  348. {
  349. struct omap_mcpdm *mcpdm = snd_soc_dai_get_drvdata(dai);
  350. int ret;
  351. pm_runtime_enable(mcpdm->dev);
  352. /* Disable lines while request is ongoing */
  353. pm_runtime_get_sync(mcpdm->dev);
  354. omap_mcpdm_write(mcpdm, MCPDM_REG_CTRL, 0x00);
  355. ret = request_irq(mcpdm->irq, omap_mcpdm_irq_handler, 0, "McPDM",
  356. (void *)mcpdm);
  357. pm_runtime_put_sync(mcpdm->dev);
  358. if (ret) {
  359. dev_err(mcpdm->dev, "Request for IRQ failed\n");
  360. pm_runtime_disable(mcpdm->dev);
  361. }
  362. /* Configure McPDM threshold values */
  363. mcpdm->config[SNDRV_PCM_STREAM_PLAYBACK].threshold = 2;
  364. mcpdm->config[SNDRV_PCM_STREAM_CAPTURE].threshold =
  365. MCPDM_UP_THRES_MAX - 3;
  366. snd_soc_dai_init_dma_data(dai,
  367. &mcpdm->dma_data[SNDRV_PCM_STREAM_PLAYBACK],
  368. &mcpdm->dma_data[SNDRV_PCM_STREAM_CAPTURE]);
  369. return ret;
  370. }
  371. static int omap_mcpdm_remove(struct snd_soc_dai *dai)
  372. {
  373. struct omap_mcpdm *mcpdm = snd_soc_dai_get_drvdata(dai);
  374. free_irq(mcpdm->irq, (void *)mcpdm);
  375. pm_runtime_disable(mcpdm->dev);
  376. if (pm_qos_request_active(&mcpdm->pm_qos_req))
  377. pm_qos_remove_request(&mcpdm->pm_qos_req);
  378. return 0;
  379. }
  380. #ifdef CONFIG_PM_SLEEP
  381. static int omap_mcpdm_suspend(struct snd_soc_dai *dai)
  382. {
  383. struct omap_mcpdm *mcpdm = snd_soc_dai_get_drvdata(dai);
  384. if (dai->active) {
  385. omap_mcpdm_stop(mcpdm);
  386. omap_mcpdm_close_streams(mcpdm);
  387. }
  388. mcpdm->pm_active_count = 0;
  389. while (pm_runtime_active(mcpdm->dev)) {
  390. pm_runtime_put_sync(mcpdm->dev);
  391. mcpdm->pm_active_count++;
  392. }
  393. return 0;
  394. }
  395. static int omap_mcpdm_resume(struct snd_soc_dai *dai)
  396. {
  397. struct omap_mcpdm *mcpdm = snd_soc_dai_get_drvdata(dai);
  398. if (mcpdm->pm_active_count) {
  399. while (mcpdm->pm_active_count--)
  400. pm_runtime_get_sync(mcpdm->dev);
  401. if (dai->active) {
  402. omap_mcpdm_open_streams(mcpdm);
  403. omap_mcpdm_start(mcpdm);
  404. }
  405. }
  406. return 0;
  407. }
  408. #else
  409. #define omap_mcpdm_suspend NULL
  410. #define omap_mcpdm_resume NULL
  411. #endif
  412. #define OMAP_MCPDM_RATES (SNDRV_PCM_RATE_88200 | SNDRV_PCM_RATE_96000)
  413. #define OMAP_MCPDM_FORMATS SNDRV_PCM_FMTBIT_S32_LE
  414. static struct snd_soc_dai_driver omap_mcpdm_dai = {
  415. .probe = omap_mcpdm_probe,
  416. .remove = omap_mcpdm_remove,
  417. .suspend = omap_mcpdm_suspend,
  418. .resume = omap_mcpdm_resume,
  419. .probe_order = SND_SOC_COMP_ORDER_LATE,
  420. .remove_order = SND_SOC_COMP_ORDER_EARLY,
  421. .playback = {
  422. .channels_min = 1,
  423. .channels_max = 5,
  424. .rates = OMAP_MCPDM_RATES,
  425. .formats = OMAP_MCPDM_FORMATS,
  426. .sig_bits = 24,
  427. },
  428. .capture = {
  429. .channels_min = 1,
  430. .channels_max = 3,
  431. .rates = OMAP_MCPDM_RATES,
  432. .formats = OMAP_MCPDM_FORMATS,
  433. .sig_bits = 24,
  434. },
  435. .ops = &omap_mcpdm_dai_ops,
  436. };
  437. static const struct snd_soc_component_driver omap_mcpdm_component = {
  438. .name = "omap-mcpdm",
  439. };
  440. void omap_mcpdm_configure_dn_offsets(struct snd_soc_pcm_runtime *rtd,
  441. u8 rx1, u8 rx2)
  442. {
  443. struct omap_mcpdm *mcpdm = snd_soc_dai_get_drvdata(rtd->cpu_dai);
  444. mcpdm->dn_rx_offset = MCPDM_DNOFST_RX1(rx1) | MCPDM_DNOFST_RX2(rx2);
  445. }
  446. EXPORT_SYMBOL_GPL(omap_mcpdm_configure_dn_offsets);
  447. static int asoc_mcpdm_probe(struct platform_device *pdev)
  448. {
  449. struct omap_mcpdm *mcpdm;
  450. struct resource *res;
  451. int ret;
  452. mcpdm = devm_kzalloc(&pdev->dev, sizeof(struct omap_mcpdm), GFP_KERNEL);
  453. if (!mcpdm)
  454. return -ENOMEM;
  455. platform_set_drvdata(pdev, mcpdm);
  456. mutex_init(&mcpdm->mutex);
  457. res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "dma");
  458. if (res == NULL)
  459. return -ENOMEM;
  460. mcpdm->dma_data[0].addr = res->start + MCPDM_REG_DN_DATA;
  461. mcpdm->dma_data[1].addr = res->start + MCPDM_REG_UP_DATA;
  462. mcpdm->dma_data[0].filter_data = "dn_link";
  463. mcpdm->dma_data[1].filter_data = "up_link";
  464. res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "mpu");
  465. mcpdm->io_base = devm_ioremap_resource(&pdev->dev, res);
  466. if (IS_ERR(mcpdm->io_base))
  467. return PTR_ERR(mcpdm->io_base);
  468. mcpdm->irq = platform_get_irq(pdev, 0);
  469. if (mcpdm->irq < 0)
  470. return mcpdm->irq;
  471. mcpdm->dev = &pdev->dev;
  472. ret = devm_snd_soc_register_component(&pdev->dev,
  473. &omap_mcpdm_component,
  474. &omap_mcpdm_dai, 1);
  475. if (ret)
  476. return ret;
  477. return omap_pcm_platform_register(&pdev->dev);
  478. }
  479. static const struct of_device_id omap_mcpdm_of_match[] = {
  480. { .compatible = "ti,omap4-mcpdm", },
  481. { }
  482. };
  483. MODULE_DEVICE_TABLE(of, omap_mcpdm_of_match);
  484. static struct platform_driver asoc_mcpdm_driver = {
  485. .driver = {
  486. .name = "omap-mcpdm",
  487. .of_match_table = omap_mcpdm_of_match,
  488. },
  489. .probe = asoc_mcpdm_probe,
  490. };
  491. module_platform_driver(asoc_mcpdm_driver);
  492. MODULE_ALIAS("platform:omap-mcpdm");
  493. MODULE_AUTHOR("Misael Lopez Cruz <[email protected]>");
  494. MODULE_DESCRIPTION("OMAP PDM SoC Interface");
  495. MODULE_LICENSE("GPL");