davinci-mcasp.c 55 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122
  1. /*
  2. * ALSA SoC McASP Audio Layer for TI DAVINCI processor
  3. *
  4. * Multi-channel Audio Serial Port Driver
  5. *
  6. * Author: Nirmal Pandey <n-pandey@ti.com>,
  7. * Suresh Rajashekara <suresh.r@ti.com>
  8. * Steve Chen <schen@.mvista.com>
  9. *
  10. * Copyright: (C) 2009 MontaVista Software, Inc., <source@mvista.com>
  11. * Copyright: (C) 2009 Texas Instruments, India
  12. *
  13. * This program is free software; you can redistribute it and/or modify
  14. * it under the terms of the GNU General Public License version 2 as
  15. * published by the Free Software Foundation.
  16. */
  17. #include <linux/init.h>
  18. #include <linux/module.h>
  19. #include <linux/device.h>
  20. #include <linux/slab.h>
  21. #include <linux/delay.h>
  22. #include <linux/io.h>
  23. #include <linux/clk.h>
  24. #include <linux/pm_runtime.h>
  25. #include <linux/of.h>
  26. #include <linux/of_platform.h>
  27. #include <linux/of_device.h>
  28. #include <linux/platform_data/davinci_asp.h>
  29. #include <linux/math64.h>
  30. #include <sound/asoundef.h>
  31. #include <sound/core.h>
  32. #include <sound/pcm.h>
  33. #include <sound/pcm_params.h>
  34. #include <sound/initval.h>
  35. #include <sound/soc.h>
  36. #include <sound/dmaengine_pcm.h>
  37. #include "edma-pcm.h"
  38. #include "../omap/sdma-pcm.h"
  39. #include "davinci-mcasp.h"
  40. #define MCASP_MAX_AFIFO_DEPTH 64
  41. #ifdef CONFIG_PM
  42. static u32 context_regs[] = {
  43. DAVINCI_MCASP_TXFMCTL_REG,
  44. DAVINCI_MCASP_RXFMCTL_REG,
  45. DAVINCI_MCASP_TXFMT_REG,
  46. DAVINCI_MCASP_RXFMT_REG,
  47. DAVINCI_MCASP_ACLKXCTL_REG,
  48. DAVINCI_MCASP_ACLKRCTL_REG,
  49. DAVINCI_MCASP_AHCLKXCTL_REG,
  50. DAVINCI_MCASP_AHCLKRCTL_REG,
  51. DAVINCI_MCASP_PDIR_REG,
  52. DAVINCI_MCASP_RXMASK_REG,
  53. DAVINCI_MCASP_TXMASK_REG,
  54. DAVINCI_MCASP_RXTDM_REG,
  55. DAVINCI_MCASP_TXTDM_REG,
  56. };
  57. struct davinci_mcasp_context {
  58. u32 config_regs[ARRAY_SIZE(context_regs)];
  59. u32 afifo_regs[2]; /* for read/write fifo control registers */
  60. u32 *xrsr_regs; /* for serializer configuration */
  61. bool pm_state;
  62. };
  63. #endif
  64. struct davinci_mcasp_ruledata {
  65. struct davinci_mcasp *mcasp;
  66. int serializers;
  67. };
  68. struct davinci_mcasp {
  69. struct snd_dmaengine_dai_dma_data dma_data[2];
  70. void __iomem *base;
  71. u32 fifo_base;
  72. struct device *dev;
  73. struct snd_pcm_substream *substreams[2];
  74. unsigned int dai_fmt;
  75. /* McASP specific data */
  76. int tdm_slots;
  77. u32 tdm_mask[2];
  78. int slot_width;
  79. u8 op_mode;
  80. u8 num_serializer;
  81. u8 *serial_dir;
  82. u8 version;
  83. u8 bclk_div;
  84. int streams;
  85. u32 irq_request[2];
  86. int dma_request[2];
  87. int sysclk_freq;
  88. bool bclk_master;
  89. /* McASP FIFO related */
  90. u8 txnumevt;
  91. u8 rxnumevt;
  92. bool dat_port;
  93. /* Used for comstraint setting on the second stream */
  94. u32 channels;
  95. #ifdef CONFIG_PM_SLEEP
  96. struct davinci_mcasp_context context;
  97. #endif
  98. struct davinci_mcasp_ruledata ruledata[2];
  99. struct snd_pcm_hw_constraint_list chconstr[2];
  100. };
  101. static inline void mcasp_set_bits(struct davinci_mcasp *mcasp, u32 offset,
  102. u32 val)
  103. {
  104. void __iomem *reg = mcasp->base + offset;
  105. __raw_writel(__raw_readl(reg) | val, reg);
  106. }
  107. static inline void mcasp_clr_bits(struct davinci_mcasp *mcasp, u32 offset,
  108. u32 val)
  109. {
  110. void __iomem *reg = mcasp->base + offset;
  111. __raw_writel((__raw_readl(reg) & ~(val)), reg);
  112. }
  113. static inline void mcasp_mod_bits(struct davinci_mcasp *mcasp, u32 offset,
  114. u32 val, u32 mask)
  115. {
  116. void __iomem *reg = mcasp->base + offset;
  117. __raw_writel((__raw_readl(reg) & ~mask) | val, reg);
  118. }
  119. static inline void mcasp_set_reg(struct davinci_mcasp *mcasp, u32 offset,
  120. u32 val)
  121. {
  122. __raw_writel(val, mcasp->base + offset);
  123. }
  124. static inline u32 mcasp_get_reg(struct davinci_mcasp *mcasp, u32 offset)
  125. {
  126. return (u32)__raw_readl(mcasp->base + offset);
  127. }
  128. static void mcasp_set_ctl_reg(struct davinci_mcasp *mcasp, u32 ctl_reg, u32 val)
  129. {
  130. int i = 0;
  131. mcasp_set_bits(mcasp, ctl_reg, val);
  132. /* programming GBLCTL needs to read back from GBLCTL and verfiy */
  133. /* loop count is to avoid the lock-up */
  134. for (i = 0; i < 1000; i++) {
  135. if ((mcasp_get_reg(mcasp, ctl_reg) & val) == val)
  136. break;
  137. }
  138. if (i == 1000 && ((mcasp_get_reg(mcasp, ctl_reg) & val) != val))
  139. printk(KERN_ERR "GBLCTL write error\n");
  140. }
  141. static bool mcasp_is_synchronous(struct davinci_mcasp *mcasp)
  142. {
  143. u32 rxfmctl = mcasp_get_reg(mcasp, DAVINCI_MCASP_RXFMCTL_REG);
  144. u32 aclkxctl = mcasp_get_reg(mcasp, DAVINCI_MCASP_ACLKXCTL_REG);
  145. return !(aclkxctl & TX_ASYNC) && rxfmctl & AFSRE;
  146. }
  147. static void mcasp_start_rx(struct davinci_mcasp *mcasp)
  148. {
  149. if (mcasp->rxnumevt) { /* enable FIFO */
  150. u32 reg = mcasp->fifo_base + MCASP_RFIFOCTL_OFFSET;
  151. mcasp_clr_bits(mcasp, reg, FIFO_ENABLE);
  152. mcasp_set_bits(mcasp, reg, FIFO_ENABLE);
  153. }
  154. /* Start clocks */
  155. mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXHCLKRST);
  156. mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXCLKRST);
  157. /*
  158. * When ASYNC == 0 the transmit and receive sections operate
  159. * synchronously from the transmit clock and frame sync. We need to make
  160. * sure that the TX signlas are enabled when starting reception.
  161. */
  162. if (mcasp_is_synchronous(mcasp)) {
  163. mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXHCLKRST);
  164. mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXCLKRST);
  165. }
  166. /* Activate serializer(s) */
  167. mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXSERCLR);
  168. /* Release RX state machine */
  169. mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXSMRST);
  170. /* Release Frame Sync generator */
  171. mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXFSRST);
  172. if (mcasp_is_synchronous(mcasp))
  173. mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXFSRST);
  174. /* enable receive IRQs */
  175. mcasp_set_bits(mcasp, DAVINCI_MCASP_EVTCTLR_REG,
  176. mcasp->irq_request[SNDRV_PCM_STREAM_CAPTURE]);
  177. }
  178. static void mcasp_start_tx(struct davinci_mcasp *mcasp)
  179. {
  180. u32 cnt;
  181. if (mcasp->txnumevt) { /* enable FIFO */
  182. u32 reg = mcasp->fifo_base + MCASP_WFIFOCTL_OFFSET;
  183. mcasp_clr_bits(mcasp, reg, FIFO_ENABLE);
  184. mcasp_set_bits(mcasp, reg, FIFO_ENABLE);
  185. }
  186. /* Start clocks */
  187. mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXHCLKRST);
  188. mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXCLKRST);
  189. /* Activate serializer(s) */
  190. mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXSERCLR);
  191. /* wait for XDATA to be cleared */
  192. cnt = 0;
  193. while ((mcasp_get_reg(mcasp, DAVINCI_MCASP_TXSTAT_REG) & XRDATA) &&
  194. (cnt < 100000))
  195. cnt++;
  196. /* Release TX state machine */
  197. mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXSMRST);
  198. /* Release Frame Sync generator */
  199. mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXFSRST);
  200. /* enable transmit IRQs */
  201. mcasp_set_bits(mcasp, DAVINCI_MCASP_EVTCTLX_REG,
  202. mcasp->irq_request[SNDRV_PCM_STREAM_PLAYBACK]);
  203. }
  204. static void davinci_mcasp_start(struct davinci_mcasp *mcasp, int stream)
  205. {
  206. mcasp->streams++;
  207. if (stream == SNDRV_PCM_STREAM_PLAYBACK)
  208. mcasp_start_tx(mcasp);
  209. else
  210. mcasp_start_rx(mcasp);
  211. }
  212. static void mcasp_stop_rx(struct davinci_mcasp *mcasp)
  213. {
  214. /* disable IRQ sources */
  215. mcasp_clr_bits(mcasp, DAVINCI_MCASP_EVTCTLR_REG,
  216. mcasp->irq_request[SNDRV_PCM_STREAM_CAPTURE]);
  217. /*
  218. * In synchronous mode stop the TX clocks if no other stream is
  219. * running
  220. */
  221. if (mcasp_is_synchronous(mcasp) && !mcasp->streams)
  222. mcasp_set_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, 0);
  223. mcasp_set_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, 0);
  224. mcasp_set_reg(mcasp, DAVINCI_MCASP_RXSTAT_REG, 0xFFFFFFFF);
  225. if (mcasp->rxnumevt) { /* disable FIFO */
  226. u32 reg = mcasp->fifo_base + MCASP_RFIFOCTL_OFFSET;
  227. mcasp_clr_bits(mcasp, reg, FIFO_ENABLE);
  228. }
  229. }
  230. static void mcasp_stop_tx(struct davinci_mcasp *mcasp)
  231. {
  232. u32 val = 0;
  233. /* disable IRQ sources */
  234. mcasp_clr_bits(mcasp, DAVINCI_MCASP_EVTCTLX_REG,
  235. mcasp->irq_request[SNDRV_PCM_STREAM_PLAYBACK]);
  236. /*
  237. * In synchronous mode keep TX clocks running if the capture stream is
  238. * still running.
  239. */
  240. if (mcasp_is_synchronous(mcasp) && mcasp->streams)
  241. val = TXHCLKRST | TXCLKRST | TXFSRST;
  242. mcasp_set_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, val);
  243. mcasp_set_reg(mcasp, DAVINCI_MCASP_TXSTAT_REG, 0xFFFFFFFF);
  244. if (mcasp->txnumevt) { /* disable FIFO */
  245. u32 reg = mcasp->fifo_base + MCASP_WFIFOCTL_OFFSET;
  246. mcasp_clr_bits(mcasp, reg, FIFO_ENABLE);
  247. }
  248. }
  249. static void davinci_mcasp_stop(struct davinci_mcasp *mcasp, int stream)
  250. {
  251. mcasp->streams--;
  252. if (stream == SNDRV_PCM_STREAM_PLAYBACK)
  253. mcasp_stop_tx(mcasp);
  254. else
  255. mcasp_stop_rx(mcasp);
  256. }
  257. static irqreturn_t davinci_mcasp_tx_irq_handler(int irq, void *data)
  258. {
  259. struct davinci_mcasp *mcasp = (struct davinci_mcasp *)data;
  260. struct snd_pcm_substream *substream;
  261. u32 irq_mask = mcasp->irq_request[SNDRV_PCM_STREAM_PLAYBACK];
  262. u32 handled_mask = 0;
  263. u32 stat;
  264. stat = mcasp_get_reg(mcasp, DAVINCI_MCASP_TXSTAT_REG);
  265. if (stat & XUNDRN & irq_mask) {
  266. dev_warn(mcasp->dev, "Transmit buffer underflow\n");
  267. handled_mask |= XUNDRN;
  268. substream = mcasp->substreams[SNDRV_PCM_STREAM_PLAYBACK];
  269. if (substream)
  270. snd_pcm_stop_xrun(substream);
  271. }
  272. if (!handled_mask)
  273. dev_warn(mcasp->dev, "unhandled tx event. txstat: 0x%08x\n",
  274. stat);
  275. if (stat & XRERR)
  276. handled_mask |= XRERR;
  277. /* Ack the handled event only */
  278. mcasp_set_reg(mcasp, DAVINCI_MCASP_TXSTAT_REG, handled_mask);
  279. return IRQ_RETVAL(handled_mask);
  280. }
  281. static irqreturn_t davinci_mcasp_rx_irq_handler(int irq, void *data)
  282. {
  283. struct davinci_mcasp *mcasp = (struct davinci_mcasp *)data;
  284. struct snd_pcm_substream *substream;
  285. u32 irq_mask = mcasp->irq_request[SNDRV_PCM_STREAM_CAPTURE];
  286. u32 handled_mask = 0;
  287. u32 stat;
  288. stat = mcasp_get_reg(mcasp, DAVINCI_MCASP_RXSTAT_REG);
  289. if (stat & ROVRN & irq_mask) {
  290. dev_warn(mcasp->dev, "Receive buffer overflow\n");
  291. handled_mask |= ROVRN;
  292. substream = mcasp->substreams[SNDRV_PCM_STREAM_CAPTURE];
  293. if (substream)
  294. snd_pcm_stop_xrun(substream);
  295. }
  296. if (!handled_mask)
  297. dev_warn(mcasp->dev, "unhandled rx event. rxstat: 0x%08x\n",
  298. stat);
  299. if (stat & XRERR)
  300. handled_mask |= XRERR;
  301. /* Ack the handled event only */
  302. mcasp_set_reg(mcasp, DAVINCI_MCASP_RXSTAT_REG, handled_mask);
  303. return IRQ_RETVAL(handled_mask);
  304. }
  305. static irqreturn_t davinci_mcasp_common_irq_handler(int irq, void *data)
  306. {
  307. struct davinci_mcasp *mcasp = (struct davinci_mcasp *)data;
  308. irqreturn_t ret = IRQ_NONE;
  309. if (mcasp->substreams[SNDRV_PCM_STREAM_PLAYBACK])
  310. ret = davinci_mcasp_tx_irq_handler(irq, data);
  311. if (mcasp->substreams[SNDRV_PCM_STREAM_CAPTURE])
  312. ret |= davinci_mcasp_rx_irq_handler(irq, data);
  313. return ret;
  314. }
  315. static int davinci_mcasp_set_dai_fmt(struct snd_soc_dai *cpu_dai,
  316. unsigned int fmt)
  317. {
  318. struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(cpu_dai);
  319. int ret = 0;
  320. u32 data_delay;
  321. bool fs_pol_rising;
  322. bool inv_fs = false;
  323. if (!fmt)
  324. return 0;
  325. pm_runtime_get_sync(mcasp->dev);
  326. switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
  327. case SND_SOC_DAIFMT_DSP_A:
  328. mcasp_clr_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, FSXDUR);
  329. mcasp_clr_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, FSRDUR);
  330. /* 1st data bit occur one ACLK cycle after the frame sync */
  331. data_delay = 1;
  332. break;
  333. case SND_SOC_DAIFMT_DSP_B:
  334. case SND_SOC_DAIFMT_AC97:
  335. mcasp_clr_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, FSXDUR);
  336. mcasp_clr_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, FSRDUR);
  337. /* No delay after FS */
  338. data_delay = 0;
  339. break;
  340. case SND_SOC_DAIFMT_I2S:
  341. /* configure a full-word SYNC pulse (LRCLK) */
  342. mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, FSXDUR);
  343. mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, FSRDUR);
  344. /* 1st data bit occur one ACLK cycle after the frame sync */
  345. data_delay = 1;
  346. /* FS need to be inverted */
  347. inv_fs = true;
  348. break;
  349. case SND_SOC_DAIFMT_LEFT_J:
  350. /* configure a full-word SYNC pulse (LRCLK) */
  351. mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, FSXDUR);
  352. mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, FSRDUR);
  353. /* No delay after FS */
  354. data_delay = 0;
  355. break;
  356. default:
  357. ret = -EINVAL;
  358. goto out;
  359. }
  360. mcasp_mod_bits(mcasp, DAVINCI_MCASP_TXFMT_REG, FSXDLY(data_delay),
  361. FSXDLY(3));
  362. mcasp_mod_bits(mcasp, DAVINCI_MCASP_RXFMT_REG, FSRDLY(data_delay),
  363. FSRDLY(3));
  364. switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
  365. case SND_SOC_DAIFMT_CBS_CFS:
  366. /* codec is clock and frame slave */
  367. mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXE);
  368. mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, AFSXE);
  369. mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRE);
  370. mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, AFSRE);
  371. mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, ACLKX | ACLKR);
  372. mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AFSX | AFSR);
  373. mcasp->bclk_master = 1;
  374. break;
  375. case SND_SOC_DAIFMT_CBS_CFM:
  376. /* codec is clock slave and frame master */
  377. mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXE);
  378. mcasp_clr_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, AFSXE);
  379. mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRE);
  380. mcasp_clr_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, AFSRE);
  381. mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, ACLKX | ACLKR);
  382. mcasp_clr_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AFSX | AFSR);
  383. mcasp->bclk_master = 1;
  384. break;
  385. case SND_SOC_DAIFMT_CBM_CFS:
  386. /* codec is clock master and frame slave */
  387. mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXE);
  388. mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, AFSXE);
  389. mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRE);
  390. mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, AFSRE);
  391. mcasp_clr_bits(mcasp, DAVINCI_MCASP_PDIR_REG, ACLKX | ACLKR);
  392. mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AFSX | AFSR);
  393. mcasp->bclk_master = 0;
  394. break;
  395. case SND_SOC_DAIFMT_CBM_CFM:
  396. /* codec is clock and frame master */
  397. mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXE);
  398. mcasp_clr_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, AFSXE);
  399. mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRE);
  400. mcasp_clr_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, AFSRE);
  401. mcasp_clr_bits(mcasp, DAVINCI_MCASP_PDIR_REG,
  402. ACLKX | AFSX | ACLKR | AHCLKR | AFSR);
  403. mcasp->bclk_master = 0;
  404. break;
  405. default:
  406. ret = -EINVAL;
  407. goto out;
  408. }
  409. switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
  410. case SND_SOC_DAIFMT_IB_NF:
  411. mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXPOL);
  412. mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRPOL);
  413. fs_pol_rising = true;
  414. break;
  415. case SND_SOC_DAIFMT_NB_IF:
  416. mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXPOL);
  417. mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRPOL);
  418. fs_pol_rising = false;
  419. break;
  420. case SND_SOC_DAIFMT_IB_IF:
  421. mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXPOL);
  422. mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRPOL);
  423. fs_pol_rising = false;
  424. break;
  425. case SND_SOC_DAIFMT_NB_NF:
  426. mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXPOL);
  427. mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRPOL);
  428. fs_pol_rising = true;
  429. break;
  430. default:
  431. ret = -EINVAL;
  432. goto out;
  433. }
  434. if (inv_fs)
  435. fs_pol_rising = !fs_pol_rising;
  436. if (fs_pol_rising) {
  437. mcasp_clr_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, FSXPOL);
  438. mcasp_clr_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, FSRPOL);
  439. } else {
  440. mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, FSXPOL);
  441. mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, FSRPOL);
  442. }
  443. mcasp->dai_fmt = fmt;
  444. out:
  445. pm_runtime_put(mcasp->dev);
  446. return ret;
  447. }
  448. static int __davinci_mcasp_set_clkdiv(struct davinci_mcasp *mcasp, int div_id,
  449. int div, bool explicit)
  450. {
  451. pm_runtime_get_sync(mcasp->dev);
  452. switch (div_id) {
  453. case MCASP_CLKDIV_AUXCLK: /* MCLK divider */
  454. mcasp_mod_bits(mcasp, DAVINCI_MCASP_AHCLKXCTL_REG,
  455. AHCLKXDIV(div - 1), AHCLKXDIV_MASK);
  456. mcasp_mod_bits(mcasp, DAVINCI_MCASP_AHCLKRCTL_REG,
  457. AHCLKRDIV(div - 1), AHCLKRDIV_MASK);
  458. break;
  459. case MCASP_CLKDIV_BCLK: /* BCLK divider */
  460. mcasp_mod_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG,
  461. ACLKXDIV(div - 1), ACLKXDIV_MASK);
  462. mcasp_mod_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG,
  463. ACLKRDIV(div - 1), ACLKRDIV_MASK);
  464. if (explicit)
  465. mcasp->bclk_div = div;
  466. break;
  467. case MCASP_CLKDIV_BCLK_FS_RATIO:
  468. /*
  469. * BCLK/LRCLK ratio descries how many bit-clock cycles
  470. * fit into one frame. The clock ratio is given for a
  471. * full period of data (for I2S format both left and
  472. * right channels), so it has to be divided by number
  473. * of tdm-slots (for I2S - divided by 2).
  474. * Instead of storing this ratio, we calculate a new
  475. * tdm_slot width by dividing the the ratio by the
  476. * number of configured tdm slots.
  477. */
  478. mcasp->slot_width = div / mcasp->tdm_slots;
  479. if (div % mcasp->tdm_slots)
  480. dev_warn(mcasp->dev,
  481. "%s(): BCLK/LRCLK %d is not divisible by %d tdm slots",
  482. __func__, div, mcasp->tdm_slots);
  483. break;
  484. default:
  485. return -EINVAL;
  486. }
  487. pm_runtime_put(mcasp->dev);
  488. return 0;
  489. }
  490. static int davinci_mcasp_set_clkdiv(struct snd_soc_dai *dai, int div_id,
  491. int div)
  492. {
  493. struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);
  494. return __davinci_mcasp_set_clkdiv(mcasp, div_id, div, 1);
  495. }
  496. static int davinci_mcasp_set_sysclk(struct snd_soc_dai *dai, int clk_id,
  497. unsigned int freq, int dir)
  498. {
  499. struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);
  500. pm_runtime_get_sync(mcasp->dev);
  501. if (dir == SND_SOC_CLOCK_OUT) {
  502. mcasp_set_bits(mcasp, DAVINCI_MCASP_AHCLKXCTL_REG, AHCLKXE);
  503. mcasp_set_bits(mcasp, DAVINCI_MCASP_AHCLKRCTL_REG, AHCLKRE);
  504. mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AHCLKX);
  505. } else {
  506. mcasp_clr_bits(mcasp, DAVINCI_MCASP_AHCLKXCTL_REG, AHCLKXE);
  507. mcasp_clr_bits(mcasp, DAVINCI_MCASP_AHCLKRCTL_REG, AHCLKRE);
  508. mcasp_clr_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AHCLKX);
  509. }
  510. mcasp->sysclk_freq = freq;
  511. pm_runtime_put(mcasp->dev);
  512. return 0;
  513. }
  514. /* All serializers must have equal number of channels */
  515. static int davinci_mcasp_ch_constraint(struct davinci_mcasp *mcasp, int stream,
  516. int serializers)
  517. {
  518. struct snd_pcm_hw_constraint_list *cl = &mcasp->chconstr[stream];
  519. unsigned int *list = (unsigned int *) cl->list;
  520. int slots = mcasp->tdm_slots;
  521. int i, count = 0;
  522. if (mcasp->tdm_mask[stream])
  523. slots = hweight32(mcasp->tdm_mask[stream]);
  524. for (i = 1; i <= slots; i++)
  525. list[count++] = i;
  526. for (i = 2; i <= serializers; i++)
  527. list[count++] = i*slots;
  528. cl->count = count;
  529. return 0;
  530. }
  531. static int davinci_mcasp_set_ch_constraints(struct davinci_mcasp *mcasp)
  532. {
  533. int rx_serializers = 0, tx_serializers = 0, ret, i;
  534. for (i = 0; i < mcasp->num_serializer; i++)
  535. if (mcasp->serial_dir[i] == TX_MODE)
  536. tx_serializers++;
  537. else if (mcasp->serial_dir[i] == RX_MODE)
  538. rx_serializers++;
  539. ret = davinci_mcasp_ch_constraint(mcasp, SNDRV_PCM_STREAM_PLAYBACK,
  540. tx_serializers);
  541. if (ret)
  542. return ret;
  543. ret = davinci_mcasp_ch_constraint(mcasp, SNDRV_PCM_STREAM_CAPTURE,
  544. rx_serializers);
  545. return ret;
  546. }
  547. static int davinci_mcasp_set_tdm_slot(struct snd_soc_dai *dai,
  548. unsigned int tx_mask,
  549. unsigned int rx_mask,
  550. int slots, int slot_width)
  551. {
  552. struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);
  553. dev_dbg(mcasp->dev,
  554. "%s() tx_mask 0x%08x rx_mask 0x%08x slots %d width %d\n",
  555. __func__, tx_mask, rx_mask, slots, slot_width);
  556. if (tx_mask >= (1<<slots) || rx_mask >= (1<<slots)) {
  557. dev_err(mcasp->dev,
  558. "Bad tdm mask tx: 0x%08x rx: 0x%08x slots %d\n",
  559. tx_mask, rx_mask, slots);
  560. return -EINVAL;
  561. }
  562. if (slot_width &&
  563. (slot_width < 8 || slot_width > 32 || slot_width % 4 != 0)) {
  564. dev_err(mcasp->dev, "%s: Unsupported slot_width %d\n",
  565. __func__, slot_width);
  566. return -EINVAL;
  567. }
  568. mcasp->tdm_slots = slots;
  569. mcasp->tdm_mask[SNDRV_PCM_STREAM_PLAYBACK] = tx_mask;
  570. mcasp->tdm_mask[SNDRV_PCM_STREAM_CAPTURE] = rx_mask;
  571. mcasp->slot_width = slot_width;
  572. return davinci_mcasp_set_ch_constraints(mcasp);
  573. }
  574. static int davinci_config_channel_size(struct davinci_mcasp *mcasp,
  575. int sample_width)
  576. {
  577. u32 fmt;
  578. u32 tx_rotate = (sample_width / 4) & 0x7;
  579. u32 mask = (1ULL << sample_width) - 1;
  580. u32 slot_width = sample_width;
  581. /*
  582. * For captured data we should not rotate, inversion and masking is
  583. * enoguh to get the data to the right position:
  584. * Format data from bus after reverse (XRBUF)
  585. * S16_LE: |LSB|MSB|xxx|xxx| |xxx|xxx|MSB|LSB|
  586. * S24_3LE: |LSB|DAT|MSB|xxx| |xxx|MSB|DAT|LSB|
  587. * S24_LE: |LSB|DAT|MSB|xxx| |xxx|MSB|DAT|LSB|
  588. * S32_LE: |LSB|DAT|DAT|MSB| |MSB|DAT|DAT|LSB|
  589. */
  590. u32 rx_rotate = 0;
  591. /*
  592. * Setting the tdm slot width either with set_clkdiv() or
  593. * set_tdm_slot() allows us to for example send 32 bits per
  594. * channel to the codec, while only 16 of them carry audio
  595. * payload.
  596. */
  597. if (mcasp->slot_width) {
  598. /*
  599. * When we have more bclk then it is needed for the
  600. * data, we need to use the rotation to move the
  601. * received samples to have correct alignment.
  602. */
  603. slot_width = mcasp->slot_width;
  604. rx_rotate = (slot_width - sample_width) / 4;
  605. }
  606. /* mapping of the XSSZ bit-field as described in the datasheet */
  607. fmt = (slot_width >> 1) - 1;
  608. if (mcasp->op_mode != DAVINCI_MCASP_DIT_MODE) {
  609. mcasp_mod_bits(mcasp, DAVINCI_MCASP_RXFMT_REG, RXSSZ(fmt),
  610. RXSSZ(0x0F));
  611. mcasp_mod_bits(mcasp, DAVINCI_MCASP_TXFMT_REG, TXSSZ(fmt),
  612. TXSSZ(0x0F));
  613. mcasp_mod_bits(mcasp, DAVINCI_MCASP_TXFMT_REG, TXROT(tx_rotate),
  614. TXROT(7));
  615. mcasp_mod_bits(mcasp, DAVINCI_MCASP_RXFMT_REG, RXROT(rx_rotate),
  616. RXROT(7));
  617. mcasp_set_reg(mcasp, DAVINCI_MCASP_RXMASK_REG, mask);
  618. }
  619. mcasp_set_reg(mcasp, DAVINCI_MCASP_TXMASK_REG, mask);
  620. return 0;
  621. }
  622. static int mcasp_common_hw_param(struct davinci_mcasp *mcasp, int stream,
  623. int period_words, int channels)
  624. {
  625. struct snd_dmaengine_dai_dma_data *dma_data = &mcasp->dma_data[stream];
  626. int i;
  627. u8 tx_ser = 0;
  628. u8 rx_ser = 0;
  629. u8 slots = mcasp->tdm_slots;
  630. u8 max_active_serializers = (channels + slots - 1) / slots;
  631. int active_serializers, numevt;
  632. u32 reg;
  633. /* Default configuration */
  634. if (mcasp->version < MCASP_VERSION_3)
  635. mcasp_set_bits(mcasp, DAVINCI_MCASP_PWREMUMGT_REG, MCASP_SOFT);
  636. /* All PINS as McASP */
  637. mcasp_set_reg(mcasp, DAVINCI_MCASP_PFUNC_REG, 0x00000000);
  638. if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
  639. mcasp_set_reg(mcasp, DAVINCI_MCASP_TXSTAT_REG, 0xFFFFFFFF);
  640. mcasp_clr_bits(mcasp, DAVINCI_MCASP_XEVTCTL_REG, TXDATADMADIS);
  641. } else {
  642. mcasp_set_reg(mcasp, DAVINCI_MCASP_RXSTAT_REG, 0xFFFFFFFF);
  643. mcasp_clr_bits(mcasp, DAVINCI_MCASP_REVTCTL_REG, RXDATADMADIS);
  644. }
  645. for (i = 0; i < mcasp->num_serializer; i++) {
  646. mcasp_set_bits(mcasp, DAVINCI_MCASP_XRSRCTL_REG(i),
  647. mcasp->serial_dir[i]);
  648. if (mcasp->serial_dir[i] == TX_MODE &&
  649. tx_ser < max_active_serializers) {
  650. mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AXR(i));
  651. mcasp_mod_bits(mcasp, DAVINCI_MCASP_XRSRCTL_REG(i),
  652. DISMOD_LOW, DISMOD_MASK);
  653. tx_ser++;
  654. } else if (mcasp->serial_dir[i] == RX_MODE &&
  655. rx_ser < max_active_serializers) {
  656. mcasp_clr_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AXR(i));
  657. rx_ser++;
  658. } else if (mcasp->serial_dir[i] == INACTIVE_MODE) {
  659. mcasp_mod_bits(mcasp, DAVINCI_MCASP_XRSRCTL_REG(i),
  660. SRMOD_INACTIVE, SRMOD_MASK);
  661. }
  662. }
  663. if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
  664. active_serializers = tx_ser;
  665. numevt = mcasp->txnumevt;
  666. reg = mcasp->fifo_base + MCASP_WFIFOCTL_OFFSET;
  667. } else {
  668. active_serializers = rx_ser;
  669. numevt = mcasp->rxnumevt;
  670. reg = mcasp->fifo_base + MCASP_RFIFOCTL_OFFSET;
  671. }
  672. if (active_serializers < max_active_serializers) {
  673. dev_warn(mcasp->dev, "stream has more channels (%d) than are "
  674. "enabled in mcasp (%d)\n", channels,
  675. active_serializers * slots);
  676. return -EINVAL;
  677. }
  678. /* AFIFO is not in use */
  679. if (!numevt) {
  680. /* Configure the burst size for platform drivers */
  681. if (active_serializers > 1) {
  682. /*
  683. * If more than one serializers are in use we have one
  684. * DMA request to provide data for all serializers.
  685. * For example if three serializers are enabled the DMA
  686. * need to transfer three words per DMA request.
  687. */
  688. dma_data->maxburst = active_serializers;
  689. } else {
  690. dma_data->maxburst = 0;
  691. }
  692. return 0;
  693. }
  694. if (period_words % active_serializers) {
  695. dev_err(mcasp->dev, "Invalid combination of period words and "
  696. "active serializers: %d, %d\n", period_words,
  697. active_serializers);
  698. return -EINVAL;
  699. }
  700. /*
  701. * Calculate the optimal AFIFO depth for platform side:
  702. * The number of words for numevt need to be in steps of active
  703. * serializers.
  704. */
  705. numevt = (numevt / active_serializers) * active_serializers;
  706. while (period_words % numevt && numevt > 0)
  707. numevt -= active_serializers;
  708. if (numevt <= 0)
  709. numevt = active_serializers;
  710. mcasp_mod_bits(mcasp, reg, active_serializers, NUMDMA_MASK);
  711. mcasp_mod_bits(mcasp, reg, NUMEVT(numevt), NUMEVT_MASK);
  712. /* Configure the burst size for platform drivers */
  713. if (numevt == 1)
  714. numevt = 0;
  715. dma_data->maxburst = numevt;
  716. return 0;
  717. }
  718. static int mcasp_i2s_hw_param(struct davinci_mcasp *mcasp, int stream,
  719. int channels)
  720. {
  721. int i, active_slots;
  722. int total_slots;
  723. int active_serializers;
  724. u32 mask = 0;
  725. u32 busel = 0;
  726. total_slots = mcasp->tdm_slots;
  727. /*
  728. * If more than one serializer is needed, then use them with
  729. * all the specified tdm_slots. Otherwise, one serializer can
  730. * cope with the transaction using just as many slots as there
  731. * are channels in the stream.
  732. */
  733. if (mcasp->tdm_mask[stream]) {
  734. active_slots = hweight32(mcasp->tdm_mask[stream]);
  735. active_serializers = (channels + active_slots - 1) /
  736. active_slots;
  737. if (active_serializers == 1)
  738. active_slots = channels;
  739. for (i = 0; i < total_slots; i++) {
  740. if ((1 << i) & mcasp->tdm_mask[stream]) {
  741. mask |= (1 << i);
  742. if (--active_slots <= 0)
  743. break;
  744. }
  745. }
  746. } else {
  747. active_serializers = (channels + total_slots - 1) / total_slots;
  748. if (active_serializers == 1)
  749. active_slots = channels;
  750. else
  751. active_slots = total_slots;
  752. for (i = 0; i < active_slots; i++)
  753. mask |= (1 << i);
  754. }
  755. mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, TX_ASYNC);
  756. if (!mcasp->dat_port)
  757. busel = TXSEL;
  758. if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
  759. mcasp_set_reg(mcasp, DAVINCI_MCASP_TXTDM_REG, mask);
  760. mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMT_REG, busel | TXORD);
  761. mcasp_mod_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG,
  762. FSXMOD(total_slots), FSXMOD(0x1FF));
  763. } else if (stream == SNDRV_PCM_STREAM_CAPTURE) {
  764. mcasp_set_reg(mcasp, DAVINCI_MCASP_RXTDM_REG, mask);
  765. mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMT_REG, busel | RXORD);
  766. mcasp_mod_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG,
  767. FSRMOD(total_slots), FSRMOD(0x1FF));
  768. /*
  769. * If McASP is set to be TX/RX synchronous and the playback is
  770. * not running already we need to configure the TX slots in
  771. * order to have correct FSX on the bus
  772. */
  773. if (mcasp_is_synchronous(mcasp) && !mcasp->channels)
  774. mcasp_mod_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG,
  775. FSXMOD(total_slots), FSXMOD(0x1FF));
  776. }
  777. return 0;
  778. }
  779. /* S/PDIF */
  780. static int mcasp_dit_hw_param(struct davinci_mcasp *mcasp,
  781. unsigned int rate)
  782. {
  783. u32 cs_value = 0;
  784. u8 *cs_bytes = (u8*) &cs_value;
  785. /* Set the TX format : 24 bit right rotation, 32 bit slot, Pad 0
  786. and LSB first */
  787. mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMT_REG, TXROT(6) | TXSSZ(15));
  788. /* Set TX frame synch : DIT Mode, 1 bit width, internal, rising edge */
  789. mcasp_set_reg(mcasp, DAVINCI_MCASP_TXFMCTL_REG, AFSXE | FSXMOD(0x180));
  790. /* Set the TX tdm : for all the slots */
  791. mcasp_set_reg(mcasp, DAVINCI_MCASP_TXTDM_REG, 0xFFFFFFFF);
  792. /* Set the TX clock controls : div = 1 and internal */
  793. mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXE | TX_ASYNC);
  794. mcasp_clr_bits(mcasp, DAVINCI_MCASP_XEVTCTL_REG, TXDATADMADIS);
  795. /* Only 44100 and 48000 are valid, both have the same setting */
  796. mcasp_set_bits(mcasp, DAVINCI_MCASP_AHCLKXCTL_REG, AHCLKXDIV(3));
  797. /* Enable the DIT */
  798. mcasp_set_bits(mcasp, DAVINCI_MCASP_TXDITCTL_REG, DITEN);
  799. /* Set S/PDIF channel status bits */
  800. cs_bytes[0] = IEC958_AES0_CON_NOT_COPYRIGHT;
  801. cs_bytes[1] = IEC958_AES1_CON_PCM_CODER;
  802. switch (rate) {
  803. case 22050:
  804. cs_bytes[3] |= IEC958_AES3_CON_FS_22050;
  805. break;
  806. case 24000:
  807. cs_bytes[3] |= IEC958_AES3_CON_FS_24000;
  808. break;
  809. case 32000:
  810. cs_bytes[3] |= IEC958_AES3_CON_FS_32000;
  811. break;
  812. case 44100:
  813. cs_bytes[3] |= IEC958_AES3_CON_FS_44100;
  814. break;
  815. case 48000:
  816. cs_bytes[3] |= IEC958_AES3_CON_FS_48000;
  817. break;
  818. case 88200:
  819. cs_bytes[3] |= IEC958_AES3_CON_FS_88200;
  820. break;
  821. case 96000:
  822. cs_bytes[3] |= IEC958_AES3_CON_FS_96000;
  823. break;
  824. case 176400:
  825. cs_bytes[3] |= IEC958_AES3_CON_FS_176400;
  826. break;
  827. case 192000:
  828. cs_bytes[3] |= IEC958_AES3_CON_FS_192000;
  829. break;
  830. default:
  831. printk(KERN_WARNING "unsupported sampling rate: %d\n", rate);
  832. return -EINVAL;
  833. }
  834. mcasp_set_reg(mcasp, DAVINCI_MCASP_DITCSRA_REG, cs_value);
  835. mcasp_set_reg(mcasp, DAVINCI_MCASP_DITCSRB_REG, cs_value);
  836. return 0;
  837. }
  838. static int davinci_mcasp_calc_clk_div(struct davinci_mcasp *mcasp,
  839. unsigned int bclk_freq, bool set)
  840. {
  841. int error_ppm;
  842. unsigned int sysclk_freq = mcasp->sysclk_freq;
  843. u32 reg = mcasp_get_reg(mcasp, DAVINCI_MCASP_AHCLKXCTL_REG);
  844. int div = sysclk_freq / bclk_freq;
  845. int rem = sysclk_freq % bclk_freq;
  846. int aux_div = 1;
  847. if (div > (ACLKXDIV_MASK + 1)) {
  848. if (reg & AHCLKXE) {
  849. aux_div = div / (ACLKXDIV_MASK + 1);
  850. if (div % (ACLKXDIV_MASK + 1))
  851. aux_div++;
  852. sysclk_freq /= aux_div;
  853. div = sysclk_freq / bclk_freq;
  854. rem = sysclk_freq % bclk_freq;
  855. } else if (set) {
  856. dev_warn(mcasp->dev, "Too fast reference clock (%u)\n",
  857. sysclk_freq);
  858. }
  859. }
  860. if (rem != 0) {
  861. if (div == 0 ||
  862. ((sysclk_freq / div) - bclk_freq) >
  863. (bclk_freq - (sysclk_freq / (div+1)))) {
  864. div++;
  865. rem = rem - bclk_freq;
  866. }
  867. }
  868. error_ppm = (div*1000000 + (int)div64_long(1000000LL*rem,
  869. (int)bclk_freq)) / div - 1000000;
  870. if (set) {
  871. if (error_ppm)
  872. dev_info(mcasp->dev, "Sample-rate is off by %d PPM\n",
  873. error_ppm);
  874. __davinci_mcasp_set_clkdiv(mcasp, MCASP_CLKDIV_BCLK, div, 0);
  875. if (reg & AHCLKXE)
  876. __davinci_mcasp_set_clkdiv(mcasp, MCASP_CLKDIV_AUXCLK,
  877. aux_div, 0);
  878. }
  879. return error_ppm;
  880. }
  881. static int davinci_mcasp_hw_params(struct snd_pcm_substream *substream,
  882. struct snd_pcm_hw_params *params,
  883. struct snd_soc_dai *cpu_dai)
  884. {
  885. struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(cpu_dai);
  886. int word_length;
  887. int channels = params_channels(params);
  888. int period_size = params_period_size(params);
  889. int ret;
  890. ret = davinci_mcasp_set_dai_fmt(cpu_dai, mcasp->dai_fmt);
  891. if (ret)
  892. return ret;
  893. /*
  894. * If mcasp is BCLK master, and a BCLK divider was not provided by
  895. * the machine driver, we need to calculate the ratio.
  896. */
  897. if (mcasp->bclk_master && mcasp->bclk_div == 0 && mcasp->sysclk_freq) {
  898. int slots = mcasp->tdm_slots;
  899. int rate = params_rate(params);
  900. int sbits = params_width(params);
  901. if (mcasp->slot_width)
  902. sbits = mcasp->slot_width;
  903. davinci_mcasp_calc_clk_div(mcasp, rate * sbits * slots, true);
  904. }
  905. ret = mcasp_common_hw_param(mcasp, substream->stream,
  906. period_size * channels, channels);
  907. if (ret)
  908. return ret;
  909. if (mcasp->op_mode == DAVINCI_MCASP_DIT_MODE)
  910. ret = mcasp_dit_hw_param(mcasp, params_rate(params));
  911. else
  912. ret = mcasp_i2s_hw_param(mcasp, substream->stream,
  913. channels);
  914. if (ret)
  915. return ret;
  916. switch (params_format(params)) {
  917. case SNDRV_PCM_FORMAT_U8:
  918. case SNDRV_PCM_FORMAT_S8:
  919. word_length = 8;
  920. break;
  921. case SNDRV_PCM_FORMAT_U16_LE:
  922. case SNDRV_PCM_FORMAT_S16_LE:
  923. word_length = 16;
  924. break;
  925. case SNDRV_PCM_FORMAT_U24_3LE:
  926. case SNDRV_PCM_FORMAT_S24_3LE:
  927. word_length = 24;
  928. break;
  929. case SNDRV_PCM_FORMAT_U24_LE:
  930. case SNDRV_PCM_FORMAT_S24_LE:
  931. word_length = 24;
  932. break;
  933. case SNDRV_PCM_FORMAT_U32_LE:
  934. case SNDRV_PCM_FORMAT_S32_LE:
  935. word_length = 32;
  936. break;
  937. default:
  938. printk(KERN_WARNING "davinci-mcasp: unsupported PCM format");
  939. return -EINVAL;
  940. }
  941. davinci_config_channel_size(mcasp, word_length);
  942. if (mcasp->op_mode == DAVINCI_MCASP_IIS_MODE)
  943. mcasp->channels = channels;
  944. return 0;
  945. }
  946. static int davinci_mcasp_trigger(struct snd_pcm_substream *substream,
  947. int cmd, struct snd_soc_dai *cpu_dai)
  948. {
  949. struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(cpu_dai);
  950. int ret = 0;
  951. switch (cmd) {
  952. case SNDRV_PCM_TRIGGER_RESUME:
  953. case SNDRV_PCM_TRIGGER_START:
  954. case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
  955. davinci_mcasp_start(mcasp, substream->stream);
  956. break;
  957. case SNDRV_PCM_TRIGGER_SUSPEND:
  958. case SNDRV_PCM_TRIGGER_STOP:
  959. case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
  960. davinci_mcasp_stop(mcasp, substream->stream);
  961. break;
  962. default:
  963. ret = -EINVAL;
  964. }
  965. return ret;
  966. }
  967. static int davinci_mcasp_hw_rule_slot_width(struct snd_pcm_hw_params *params,
  968. struct snd_pcm_hw_rule *rule)
  969. {
  970. struct davinci_mcasp_ruledata *rd = rule->private;
  971. struct snd_mask *fmt = hw_param_mask(params, SNDRV_PCM_HW_PARAM_FORMAT);
  972. struct snd_mask nfmt;
  973. int i, slot_width;
  974. snd_mask_none(&nfmt);
  975. slot_width = rd->mcasp->slot_width;
  976. for (i = 0; i <= SNDRV_PCM_FORMAT_LAST; i++) {
  977. if (snd_mask_test(fmt, i)) {
  978. if (snd_pcm_format_width(i) <= slot_width) {
  979. snd_mask_set(&nfmt, i);
  980. }
  981. }
  982. }
  983. return snd_mask_refine(fmt, &nfmt);
  984. }
  985. static const unsigned int davinci_mcasp_dai_rates[] = {
  986. 8000, 11025, 16000, 22050, 32000, 44100, 48000, 64000,
  987. 88200, 96000, 176400, 192000,
  988. };
  989. #define DAVINCI_MAX_RATE_ERROR_PPM 1000
  990. static int davinci_mcasp_hw_rule_rate(struct snd_pcm_hw_params *params,
  991. struct snd_pcm_hw_rule *rule)
  992. {
  993. struct davinci_mcasp_ruledata *rd = rule->private;
  994. struct snd_interval *ri =
  995. hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE);
  996. int sbits = params_width(params);
  997. int slots = rd->mcasp->tdm_slots;
  998. struct snd_interval range;
  999. int i;
  1000. if (rd->mcasp->slot_width)
  1001. sbits = rd->mcasp->slot_width;
  1002. snd_interval_any(&range);
  1003. range.empty = 1;
  1004. for (i = 0; i < ARRAY_SIZE(davinci_mcasp_dai_rates); i++) {
  1005. if (snd_interval_test(ri, davinci_mcasp_dai_rates[i])) {
  1006. uint bclk_freq = sbits*slots*
  1007. davinci_mcasp_dai_rates[i];
  1008. int ppm;
  1009. ppm = davinci_mcasp_calc_clk_div(rd->mcasp, bclk_freq,
  1010. false);
  1011. if (abs(ppm) < DAVINCI_MAX_RATE_ERROR_PPM) {
  1012. if (range.empty) {
  1013. range.min = davinci_mcasp_dai_rates[i];
  1014. range.empty = 0;
  1015. }
  1016. range.max = davinci_mcasp_dai_rates[i];
  1017. }
  1018. }
  1019. }
  1020. dev_dbg(rd->mcasp->dev,
  1021. "Frequencies %d-%d -> %d-%d for %d sbits and %d tdm slots\n",
  1022. ri->min, ri->max, range.min, range.max, sbits, slots);
  1023. return snd_interval_refine(hw_param_interval(params, rule->var),
  1024. &range);
  1025. }
  1026. static int davinci_mcasp_hw_rule_format(struct snd_pcm_hw_params *params,
  1027. struct snd_pcm_hw_rule *rule)
  1028. {
  1029. struct davinci_mcasp_ruledata *rd = rule->private;
  1030. struct snd_mask *fmt = hw_param_mask(params, SNDRV_PCM_HW_PARAM_FORMAT);
  1031. struct snd_mask nfmt;
  1032. int rate = params_rate(params);
  1033. int slots = rd->mcasp->tdm_slots;
  1034. int i, count = 0;
  1035. snd_mask_none(&nfmt);
  1036. for (i = 0; i <= SNDRV_PCM_FORMAT_LAST; i++) {
  1037. if (snd_mask_test(fmt, i)) {
  1038. uint sbits = snd_pcm_format_width(i);
  1039. int ppm;
  1040. if (rd->mcasp->slot_width)
  1041. sbits = rd->mcasp->slot_width;
  1042. ppm = davinci_mcasp_calc_clk_div(rd->mcasp,
  1043. sbits * slots * rate,
  1044. false);
  1045. if (abs(ppm) < DAVINCI_MAX_RATE_ERROR_PPM) {
  1046. snd_mask_set(&nfmt, i);
  1047. count++;
  1048. }
  1049. }
  1050. }
  1051. dev_dbg(rd->mcasp->dev,
  1052. "%d possible sample format for %d Hz and %d tdm slots\n",
  1053. count, rate, slots);
  1054. return snd_mask_refine(fmt, &nfmt);
  1055. }
  1056. static int davinci_mcasp_hw_rule_min_periodsize(
  1057. struct snd_pcm_hw_params *params, struct snd_pcm_hw_rule *rule)
  1058. {
  1059. struct snd_interval *period_size = hw_param_interval(params,
  1060. SNDRV_PCM_HW_PARAM_PERIOD_SIZE);
  1061. struct snd_interval frames;
  1062. snd_interval_any(&frames);
  1063. frames.min = 64;
  1064. frames.integer = 1;
  1065. return snd_interval_refine(period_size, &frames);
  1066. }
  1067. static int davinci_mcasp_startup(struct snd_pcm_substream *substream,
  1068. struct snd_soc_dai *cpu_dai)
  1069. {
  1070. struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(cpu_dai);
  1071. struct davinci_mcasp_ruledata *ruledata =
  1072. &mcasp->ruledata[substream->stream];
  1073. u32 max_channels = 0;
  1074. int i, dir, ret;
  1075. int tdm_slots = mcasp->tdm_slots;
  1076. /* Do not allow more then one stream per direction */
  1077. if (mcasp->substreams[substream->stream])
  1078. return -EBUSY;
  1079. mcasp->substreams[substream->stream] = substream;
  1080. if (mcasp->tdm_mask[substream->stream])
  1081. tdm_slots = hweight32(mcasp->tdm_mask[substream->stream]);
  1082. if (mcasp->op_mode == DAVINCI_MCASP_DIT_MODE)
  1083. return 0;
  1084. /*
  1085. * Limit the maximum allowed channels for the first stream:
  1086. * number of serializers for the direction * tdm slots per serializer
  1087. */
  1088. if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
  1089. dir = TX_MODE;
  1090. else
  1091. dir = RX_MODE;
  1092. for (i = 0; i < mcasp->num_serializer; i++) {
  1093. if (mcasp->serial_dir[i] == dir)
  1094. max_channels++;
  1095. }
  1096. ruledata->serializers = max_channels;
  1097. ruledata->mcasp = mcasp;
  1098. max_channels *= tdm_slots;
  1099. /*
  1100. * If the already active stream has less channels than the calculated
  1101. * limnit based on the seirializers * tdm_slots, we need to use that as
  1102. * a constraint for the second stream.
  1103. * Otherwise (first stream or less allowed channels) we use the
  1104. * calculated constraint.
  1105. */
  1106. if (mcasp->channels && mcasp->channels < max_channels)
  1107. max_channels = mcasp->channels;
  1108. /*
  1109. * But we can always allow channels upto the amount of
  1110. * the available tdm_slots.
  1111. */
  1112. if (max_channels < tdm_slots)
  1113. max_channels = tdm_slots;
  1114. snd_pcm_hw_constraint_minmax(substream->runtime,
  1115. SNDRV_PCM_HW_PARAM_CHANNELS,
  1116. 0, max_channels);
  1117. snd_pcm_hw_constraint_list(substream->runtime,
  1118. 0, SNDRV_PCM_HW_PARAM_CHANNELS,
  1119. &mcasp->chconstr[substream->stream]);
  1120. if (mcasp->slot_width) {
  1121. /* Only allow formats require <= slot_width bits on the bus */
  1122. ret = snd_pcm_hw_rule_add(substream->runtime, 0,
  1123. SNDRV_PCM_HW_PARAM_FORMAT,
  1124. davinci_mcasp_hw_rule_slot_width,
  1125. ruledata,
  1126. SNDRV_PCM_HW_PARAM_FORMAT, -1);
  1127. if (ret)
  1128. return ret;
  1129. }
  1130. /*
  1131. * If we rely on implicit BCLK divider setting we should
  1132. * set constraints based on what we can provide.
  1133. */
  1134. if (mcasp->bclk_master && mcasp->bclk_div == 0 && mcasp->sysclk_freq) {
  1135. ret = snd_pcm_hw_rule_add(substream->runtime, 0,
  1136. SNDRV_PCM_HW_PARAM_RATE,
  1137. davinci_mcasp_hw_rule_rate,
  1138. ruledata,
  1139. SNDRV_PCM_HW_PARAM_FORMAT, -1);
  1140. if (ret)
  1141. return ret;
  1142. ret = snd_pcm_hw_rule_add(substream->runtime, 0,
  1143. SNDRV_PCM_HW_PARAM_FORMAT,
  1144. davinci_mcasp_hw_rule_format,
  1145. ruledata,
  1146. SNDRV_PCM_HW_PARAM_RATE, -1);
  1147. if (ret)
  1148. return ret;
  1149. }
  1150. snd_pcm_hw_rule_add(substream->runtime, 0,
  1151. SNDRV_PCM_HW_PARAM_PERIOD_SIZE,
  1152. davinci_mcasp_hw_rule_min_periodsize, NULL,
  1153. SNDRV_PCM_HW_PARAM_PERIOD_SIZE, -1);
  1154. return 0;
  1155. }
  1156. static void davinci_mcasp_shutdown(struct snd_pcm_substream *substream,
  1157. struct snd_soc_dai *cpu_dai)
  1158. {
  1159. struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(cpu_dai);
  1160. mcasp->substreams[substream->stream] = NULL;
  1161. if (mcasp->op_mode == DAVINCI_MCASP_DIT_MODE)
  1162. return;
  1163. if (!cpu_dai->active)
  1164. mcasp->channels = 0;
  1165. }
  1166. static const struct snd_soc_dai_ops davinci_mcasp_dai_ops = {
  1167. .startup = davinci_mcasp_startup,
  1168. .shutdown = davinci_mcasp_shutdown,
  1169. .trigger = davinci_mcasp_trigger,
  1170. .hw_params = davinci_mcasp_hw_params,
  1171. .set_fmt = davinci_mcasp_set_dai_fmt,
  1172. .set_clkdiv = davinci_mcasp_set_clkdiv,
  1173. .set_sysclk = davinci_mcasp_set_sysclk,
  1174. .set_tdm_slot = davinci_mcasp_set_tdm_slot,
  1175. };
  1176. static int davinci_mcasp_dai_probe(struct snd_soc_dai *dai)
  1177. {
  1178. struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);
  1179. dai->playback_dma_data = &mcasp->dma_data[SNDRV_PCM_STREAM_PLAYBACK];
  1180. dai->capture_dma_data = &mcasp->dma_data[SNDRV_PCM_STREAM_CAPTURE];
  1181. return 0;
  1182. }
  1183. #ifdef CONFIG_PM_SLEEP
  1184. static int davinci_mcasp_suspend(struct snd_soc_dai *dai)
  1185. {
  1186. struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);
  1187. struct davinci_mcasp_context *context = &mcasp->context;
  1188. u32 reg;
  1189. int i;
  1190. context->pm_state = pm_runtime_active(mcasp->dev);
  1191. if (!context->pm_state)
  1192. pm_runtime_get_sync(mcasp->dev);
  1193. for (i = 0; i < ARRAY_SIZE(context_regs); i++)
  1194. context->config_regs[i] = mcasp_get_reg(mcasp, context_regs[i]);
  1195. if (mcasp->txnumevt) {
  1196. reg = mcasp->fifo_base + MCASP_WFIFOCTL_OFFSET;
  1197. context->afifo_regs[0] = mcasp_get_reg(mcasp, reg);
  1198. }
  1199. if (mcasp->rxnumevt) {
  1200. reg = mcasp->fifo_base + MCASP_RFIFOCTL_OFFSET;
  1201. context->afifo_regs[1] = mcasp_get_reg(mcasp, reg);
  1202. }
  1203. for (i = 0; i < mcasp->num_serializer; i++)
  1204. context->xrsr_regs[i] = mcasp_get_reg(mcasp,
  1205. DAVINCI_MCASP_XRSRCTL_REG(i));
  1206. pm_runtime_put_sync(mcasp->dev);
  1207. return 0;
  1208. }
  1209. static int davinci_mcasp_resume(struct snd_soc_dai *dai)
  1210. {
  1211. struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);
  1212. struct davinci_mcasp_context *context = &mcasp->context;
  1213. u32 reg;
  1214. int i;
  1215. pm_runtime_get_sync(mcasp->dev);
  1216. for (i = 0; i < ARRAY_SIZE(context_regs); i++)
  1217. mcasp_set_reg(mcasp, context_regs[i], context->config_regs[i]);
  1218. if (mcasp->txnumevt) {
  1219. reg = mcasp->fifo_base + MCASP_WFIFOCTL_OFFSET;
  1220. mcasp_set_reg(mcasp, reg, context->afifo_regs[0]);
  1221. }
  1222. if (mcasp->rxnumevt) {
  1223. reg = mcasp->fifo_base + MCASP_RFIFOCTL_OFFSET;
  1224. mcasp_set_reg(mcasp, reg, context->afifo_regs[1]);
  1225. }
  1226. for (i = 0; i < mcasp->num_serializer; i++)
  1227. mcasp_set_reg(mcasp, DAVINCI_MCASP_XRSRCTL_REG(i),
  1228. context->xrsr_regs[i]);
  1229. if (!context->pm_state)
  1230. pm_runtime_put_sync(mcasp->dev);
  1231. return 0;
  1232. }
  1233. #else
  1234. #define davinci_mcasp_suspend NULL
  1235. #define davinci_mcasp_resume NULL
  1236. #endif
  1237. #define DAVINCI_MCASP_RATES SNDRV_PCM_RATE_8000_192000
  1238. #define DAVINCI_MCASP_PCM_FMTS (SNDRV_PCM_FMTBIT_S8 | \
  1239. SNDRV_PCM_FMTBIT_U8 | \
  1240. SNDRV_PCM_FMTBIT_S16_LE | \
  1241. SNDRV_PCM_FMTBIT_U16_LE | \
  1242. SNDRV_PCM_FMTBIT_S24_LE | \
  1243. SNDRV_PCM_FMTBIT_U24_LE | \
  1244. SNDRV_PCM_FMTBIT_S24_3LE | \
  1245. SNDRV_PCM_FMTBIT_U24_3LE | \
  1246. SNDRV_PCM_FMTBIT_S32_LE | \
  1247. SNDRV_PCM_FMTBIT_U32_LE)
  1248. static struct snd_soc_dai_driver davinci_mcasp_dai[] = {
  1249. {
  1250. .name = "davinci-mcasp.0",
  1251. .probe = davinci_mcasp_dai_probe,
  1252. .suspend = davinci_mcasp_suspend,
  1253. .resume = davinci_mcasp_resume,
  1254. .playback = {
  1255. .channels_min = 1,
  1256. .channels_max = 32 * 16,
  1257. .rates = DAVINCI_MCASP_RATES,
  1258. .formats = DAVINCI_MCASP_PCM_FMTS,
  1259. },
  1260. .capture = {
  1261. .channels_min = 1,
  1262. .channels_max = 32 * 16,
  1263. .rates = DAVINCI_MCASP_RATES,
  1264. .formats = DAVINCI_MCASP_PCM_FMTS,
  1265. },
  1266. .ops = &davinci_mcasp_dai_ops,
  1267. .symmetric_samplebits = 1,
  1268. .symmetric_rates = 1,
  1269. },
  1270. {
  1271. .name = "davinci-mcasp.1",
  1272. .probe = davinci_mcasp_dai_probe,
  1273. .playback = {
  1274. .channels_min = 1,
  1275. .channels_max = 384,
  1276. .rates = DAVINCI_MCASP_RATES,
  1277. .formats = DAVINCI_MCASP_PCM_FMTS,
  1278. },
  1279. .ops = &davinci_mcasp_dai_ops,
  1280. },
  1281. };
  1282. static const struct snd_soc_component_driver davinci_mcasp_component = {
  1283. .name = "davinci-mcasp",
  1284. };
  1285. /* Some HW specific values and defaults. The rest is filled in from DT. */
  1286. static struct davinci_mcasp_pdata dm646x_mcasp_pdata = {
  1287. .tx_dma_offset = 0x400,
  1288. .rx_dma_offset = 0x400,
  1289. .version = MCASP_VERSION_1,
  1290. };
  1291. static struct davinci_mcasp_pdata da830_mcasp_pdata = {
  1292. .tx_dma_offset = 0x2000,
  1293. .rx_dma_offset = 0x2000,
  1294. .version = MCASP_VERSION_2,
  1295. };
  1296. static struct davinci_mcasp_pdata am33xx_mcasp_pdata = {
  1297. .tx_dma_offset = 0,
  1298. .rx_dma_offset = 0,
  1299. .version = MCASP_VERSION_3,
  1300. };
  1301. static struct davinci_mcasp_pdata dra7_mcasp_pdata = {
  1302. /* The CFG port offset will be calculated if it is needed */
  1303. .tx_dma_offset = 0,
  1304. .rx_dma_offset = 0,
  1305. .version = MCASP_VERSION_4,
  1306. };
  1307. static const struct of_device_id mcasp_dt_ids[] = {
  1308. {
  1309. .compatible = "ti,dm646x-mcasp-audio",
  1310. .data = &dm646x_mcasp_pdata,
  1311. },
  1312. {
  1313. .compatible = "ti,da830-mcasp-audio",
  1314. .data = &da830_mcasp_pdata,
  1315. },
  1316. {
  1317. .compatible = "ti,am33xx-mcasp-audio",
  1318. .data = &am33xx_mcasp_pdata,
  1319. },
  1320. {
  1321. .compatible = "ti,dra7-mcasp-audio",
  1322. .data = &dra7_mcasp_pdata,
  1323. },
  1324. { /* sentinel */ }
  1325. };
  1326. MODULE_DEVICE_TABLE(of, mcasp_dt_ids);
  1327. static int mcasp_reparent_fck(struct platform_device *pdev)
  1328. {
  1329. struct device_node *node = pdev->dev.of_node;
  1330. struct clk *gfclk, *parent_clk;
  1331. const char *parent_name;
  1332. int ret;
  1333. if (!node)
  1334. return 0;
  1335. parent_name = of_get_property(node, "fck_parent", NULL);
  1336. if (!parent_name)
  1337. return 0;
  1338. dev_warn(&pdev->dev, "Update the bindings to use assigned-clocks!\n");
  1339. gfclk = clk_get(&pdev->dev, "fck");
  1340. if (IS_ERR(gfclk)) {
  1341. dev_err(&pdev->dev, "failed to get fck\n");
  1342. return PTR_ERR(gfclk);
  1343. }
  1344. parent_clk = clk_get(NULL, parent_name);
  1345. if (IS_ERR(parent_clk)) {
  1346. dev_err(&pdev->dev, "failed to get parent clock\n");
  1347. ret = PTR_ERR(parent_clk);
  1348. goto err1;
  1349. }
  1350. ret = clk_set_parent(gfclk, parent_clk);
  1351. if (ret) {
  1352. dev_err(&pdev->dev, "failed to reparent fck\n");
  1353. goto err2;
  1354. }
  1355. err2:
  1356. clk_put(parent_clk);
  1357. err1:
  1358. clk_put(gfclk);
  1359. return ret;
  1360. }
  1361. static struct davinci_mcasp_pdata *davinci_mcasp_set_pdata_from_of(
  1362. struct platform_device *pdev)
  1363. {
  1364. struct device_node *np = pdev->dev.of_node;
  1365. struct davinci_mcasp_pdata *pdata = NULL;
  1366. const struct of_device_id *match =
  1367. of_match_device(mcasp_dt_ids, &pdev->dev);
  1368. struct of_phandle_args dma_spec;
  1369. const u32 *of_serial_dir32;
  1370. u32 val;
  1371. int i, ret = 0;
  1372. if (pdev->dev.platform_data) {
  1373. pdata = pdev->dev.platform_data;
  1374. return pdata;
  1375. } else if (match) {
  1376. pdata = devm_kmemdup(&pdev->dev, match->data, sizeof(*pdata),
  1377. GFP_KERNEL);
  1378. if (!pdata) {
  1379. ret = -ENOMEM;
  1380. return pdata;
  1381. }
  1382. } else {
  1383. /* control shouldn't reach here. something is wrong */
  1384. ret = -EINVAL;
  1385. goto nodata;
  1386. }
  1387. ret = of_property_read_u32(np, "op-mode", &val);
  1388. if (ret >= 0)
  1389. pdata->op_mode = val;
  1390. ret = of_property_read_u32(np, "tdm-slots", &val);
  1391. if (ret >= 0) {
  1392. if (val < 2 || val > 32) {
  1393. dev_err(&pdev->dev,
  1394. "tdm-slots must be in rage [2-32]\n");
  1395. ret = -EINVAL;
  1396. goto nodata;
  1397. }
  1398. pdata->tdm_slots = val;
  1399. }
  1400. of_serial_dir32 = of_get_property(np, "serial-dir", &val);
  1401. val /= sizeof(u32);
  1402. if (of_serial_dir32) {
  1403. u8 *of_serial_dir = devm_kzalloc(&pdev->dev,
  1404. (sizeof(*of_serial_dir) * val),
  1405. GFP_KERNEL);
  1406. if (!of_serial_dir) {
  1407. ret = -ENOMEM;
  1408. goto nodata;
  1409. }
  1410. for (i = 0; i < val; i++)
  1411. of_serial_dir[i] = be32_to_cpup(&of_serial_dir32[i]);
  1412. pdata->num_serializer = val;
  1413. pdata->serial_dir = of_serial_dir;
  1414. }
  1415. ret = of_property_match_string(np, "dma-names", "tx");
  1416. if (ret < 0)
  1417. goto nodata;
  1418. ret = of_parse_phandle_with_args(np, "dmas", "#dma-cells", ret,
  1419. &dma_spec);
  1420. if (ret < 0)
  1421. goto nodata;
  1422. pdata->tx_dma_channel = dma_spec.args[0];
  1423. /* RX is not valid in DIT mode */
  1424. if (pdata->op_mode != DAVINCI_MCASP_DIT_MODE) {
  1425. ret = of_property_match_string(np, "dma-names", "rx");
  1426. if (ret < 0)
  1427. goto nodata;
  1428. ret = of_parse_phandle_with_args(np, "dmas", "#dma-cells", ret,
  1429. &dma_spec);
  1430. if (ret < 0)
  1431. goto nodata;
  1432. pdata->rx_dma_channel = dma_spec.args[0];
  1433. }
  1434. ret = of_property_read_u32(np, "tx-num-evt", &val);
  1435. if (ret >= 0)
  1436. pdata->txnumevt = val;
  1437. ret = of_property_read_u32(np, "rx-num-evt", &val);
  1438. if (ret >= 0)
  1439. pdata->rxnumevt = val;
  1440. ret = of_property_read_u32(np, "sram-size-playback", &val);
  1441. if (ret >= 0)
  1442. pdata->sram_size_playback = val;
  1443. ret = of_property_read_u32(np, "sram-size-capture", &val);
  1444. if (ret >= 0)
  1445. pdata->sram_size_capture = val;
  1446. return pdata;
  1447. nodata:
  1448. if (ret < 0) {
  1449. dev_err(&pdev->dev, "Error populating platform data, err %d\n",
  1450. ret);
  1451. pdata = NULL;
  1452. }
  1453. return pdata;
  1454. }
  1455. enum {
  1456. PCM_EDMA,
  1457. PCM_SDMA,
  1458. };
  1459. static const char *sdma_prefix = "ti,omap";
  1460. static int davinci_mcasp_get_dma_type(struct davinci_mcasp *mcasp)
  1461. {
  1462. struct dma_chan *chan;
  1463. const char *tmp;
  1464. int ret = PCM_EDMA;
  1465. if (!mcasp->dev->of_node)
  1466. return PCM_EDMA;
  1467. tmp = mcasp->dma_data[SNDRV_PCM_STREAM_PLAYBACK].filter_data;
  1468. chan = dma_request_slave_channel_reason(mcasp->dev, tmp);
  1469. if (IS_ERR(chan)) {
  1470. if (PTR_ERR(chan) != -EPROBE_DEFER)
  1471. dev_err(mcasp->dev,
  1472. "Can't verify DMA configuration (%ld)\n",
  1473. PTR_ERR(chan));
  1474. return PTR_ERR(chan);
  1475. }
  1476. if (WARN_ON(!chan->device || !chan->device->dev)) {
  1477. dma_release_channel(chan);
  1478. return -EINVAL;
  1479. }
  1480. if (chan->device->dev->of_node)
  1481. ret = of_property_read_string(chan->device->dev->of_node,
  1482. "compatible", &tmp);
  1483. else
  1484. dev_dbg(mcasp->dev, "DMA controller has no of-node\n");
  1485. dma_release_channel(chan);
  1486. if (ret)
  1487. return ret;
  1488. dev_dbg(mcasp->dev, "DMA controller compatible = \"%s\"\n", tmp);
  1489. if (!strncmp(tmp, sdma_prefix, strlen(sdma_prefix)))
  1490. return PCM_SDMA;
  1491. return PCM_EDMA;
  1492. }
  1493. static u32 davinci_mcasp_txdma_offset(struct davinci_mcasp_pdata *pdata)
  1494. {
  1495. int i;
  1496. u32 offset = 0;
  1497. if (pdata->version != MCASP_VERSION_4)
  1498. return pdata->tx_dma_offset;
  1499. for (i = 0; i < pdata->num_serializer; i++) {
  1500. if (pdata->serial_dir[i] == TX_MODE) {
  1501. if (!offset) {
  1502. offset = DAVINCI_MCASP_TXBUF_REG(i);
  1503. } else {
  1504. pr_err("%s: Only one serializer allowed!\n",
  1505. __func__);
  1506. break;
  1507. }
  1508. }
  1509. }
  1510. return offset;
  1511. }
  1512. static u32 davinci_mcasp_rxdma_offset(struct davinci_mcasp_pdata *pdata)
  1513. {
  1514. int i;
  1515. u32 offset = 0;
  1516. if (pdata->version != MCASP_VERSION_4)
  1517. return pdata->rx_dma_offset;
  1518. for (i = 0; i < pdata->num_serializer; i++) {
  1519. if (pdata->serial_dir[i] == RX_MODE) {
  1520. if (!offset) {
  1521. offset = DAVINCI_MCASP_RXBUF_REG(i);
  1522. } else {
  1523. pr_err("%s: Only one serializer allowed!\n",
  1524. __func__);
  1525. break;
  1526. }
  1527. }
  1528. }
  1529. return offset;
  1530. }
  1531. static int davinci_mcasp_probe(struct platform_device *pdev)
  1532. {
  1533. struct snd_dmaengine_dai_dma_data *dma_data;
  1534. struct resource *mem, *res, *dat;
  1535. struct davinci_mcasp_pdata *pdata;
  1536. struct davinci_mcasp *mcasp;
  1537. char *irq_name;
  1538. int *dma;
  1539. int irq;
  1540. int ret;
  1541. if (!pdev->dev.platform_data && !pdev->dev.of_node) {
  1542. dev_err(&pdev->dev, "No platform data supplied\n");
  1543. return -EINVAL;
  1544. }
  1545. mcasp = devm_kzalloc(&pdev->dev, sizeof(struct davinci_mcasp),
  1546. GFP_KERNEL);
  1547. if (!mcasp)
  1548. return -ENOMEM;
  1549. pdata = davinci_mcasp_set_pdata_from_of(pdev);
  1550. if (!pdata) {
  1551. dev_err(&pdev->dev, "no platform data\n");
  1552. return -EINVAL;
  1553. }
  1554. mem = platform_get_resource_byname(pdev, IORESOURCE_MEM, "mpu");
  1555. if (!mem) {
  1556. dev_warn(mcasp->dev,
  1557. "\"mpu\" mem resource not found, using index 0\n");
  1558. mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  1559. if (!mem) {
  1560. dev_err(&pdev->dev, "no mem resource?\n");
  1561. return -ENODEV;
  1562. }
  1563. }
  1564. mcasp->base = devm_ioremap_resource(&pdev->dev, mem);
  1565. if (IS_ERR(mcasp->base))
  1566. return PTR_ERR(mcasp->base);
  1567. pm_runtime_enable(&pdev->dev);
  1568. mcasp->op_mode = pdata->op_mode;
  1569. /* sanity check for tdm slots parameter */
  1570. if (mcasp->op_mode == DAVINCI_MCASP_IIS_MODE) {
  1571. if (pdata->tdm_slots < 2) {
  1572. dev_err(&pdev->dev, "invalid tdm slots: %d\n",
  1573. pdata->tdm_slots);
  1574. mcasp->tdm_slots = 2;
  1575. } else if (pdata->tdm_slots > 32) {
  1576. dev_err(&pdev->dev, "invalid tdm slots: %d\n",
  1577. pdata->tdm_slots);
  1578. mcasp->tdm_slots = 32;
  1579. } else {
  1580. mcasp->tdm_slots = pdata->tdm_slots;
  1581. }
  1582. }
  1583. mcasp->num_serializer = pdata->num_serializer;
  1584. #ifdef CONFIG_PM_SLEEP
  1585. mcasp->context.xrsr_regs = devm_kcalloc(&pdev->dev,
  1586. mcasp->num_serializer, sizeof(u32),
  1587. GFP_KERNEL);
  1588. if (!mcasp->context.xrsr_regs) {
  1589. ret = -ENOMEM;
  1590. goto err;
  1591. }
  1592. #endif
  1593. mcasp->serial_dir = pdata->serial_dir;
  1594. mcasp->version = pdata->version;
  1595. mcasp->txnumevt = pdata->txnumevt;
  1596. mcasp->rxnumevt = pdata->rxnumevt;
  1597. mcasp->dev = &pdev->dev;
  1598. irq = platform_get_irq_byname(pdev, "common");
  1599. if (irq >= 0) {
  1600. irq_name = devm_kasprintf(&pdev->dev, GFP_KERNEL, "%s_common",
  1601. dev_name(&pdev->dev));
  1602. if (!irq_name) {
  1603. ret = -ENOMEM;
  1604. goto err;
  1605. }
  1606. ret = devm_request_threaded_irq(&pdev->dev, irq, NULL,
  1607. davinci_mcasp_common_irq_handler,
  1608. IRQF_ONESHOT | IRQF_SHARED,
  1609. irq_name, mcasp);
  1610. if (ret) {
  1611. dev_err(&pdev->dev, "common IRQ request failed\n");
  1612. goto err;
  1613. }
  1614. mcasp->irq_request[SNDRV_PCM_STREAM_PLAYBACK] = XUNDRN;
  1615. mcasp->irq_request[SNDRV_PCM_STREAM_CAPTURE] = ROVRN;
  1616. }
  1617. irq = platform_get_irq_byname(pdev, "rx");
  1618. if (irq >= 0) {
  1619. irq_name = devm_kasprintf(&pdev->dev, GFP_KERNEL, "%s_rx",
  1620. dev_name(&pdev->dev));
  1621. if (!irq_name) {
  1622. ret = -ENOMEM;
  1623. goto err;
  1624. }
  1625. ret = devm_request_threaded_irq(&pdev->dev, irq, NULL,
  1626. davinci_mcasp_rx_irq_handler,
  1627. IRQF_ONESHOT, irq_name, mcasp);
  1628. if (ret) {
  1629. dev_err(&pdev->dev, "RX IRQ request failed\n");
  1630. goto err;
  1631. }
  1632. mcasp->irq_request[SNDRV_PCM_STREAM_CAPTURE] = ROVRN;
  1633. }
  1634. irq = platform_get_irq_byname(pdev, "tx");
  1635. if (irq >= 0) {
  1636. irq_name = devm_kasprintf(&pdev->dev, GFP_KERNEL, "%s_tx",
  1637. dev_name(&pdev->dev));
  1638. if (!irq_name) {
  1639. ret = -ENOMEM;
  1640. goto err;
  1641. }
  1642. ret = devm_request_threaded_irq(&pdev->dev, irq, NULL,
  1643. davinci_mcasp_tx_irq_handler,
  1644. IRQF_ONESHOT, irq_name, mcasp);
  1645. if (ret) {
  1646. dev_err(&pdev->dev, "TX IRQ request failed\n");
  1647. goto err;
  1648. }
  1649. mcasp->irq_request[SNDRV_PCM_STREAM_PLAYBACK] = XUNDRN;
  1650. }
  1651. dat = platform_get_resource_byname(pdev, IORESOURCE_MEM, "dat");
  1652. if (dat)
  1653. mcasp->dat_port = true;
  1654. dma_data = &mcasp->dma_data[SNDRV_PCM_STREAM_PLAYBACK];
  1655. if (dat)
  1656. dma_data->addr = dat->start;
  1657. else
  1658. dma_data->addr = mem->start + davinci_mcasp_txdma_offset(pdata);
  1659. dma = &mcasp->dma_request[SNDRV_PCM_STREAM_PLAYBACK];
  1660. res = platform_get_resource(pdev, IORESOURCE_DMA, 0);
  1661. if (res)
  1662. *dma = res->start;
  1663. else
  1664. *dma = pdata->tx_dma_channel;
  1665. /* dmaengine filter data for DT and non-DT boot */
  1666. if (pdev->dev.of_node)
  1667. dma_data->filter_data = "tx";
  1668. else
  1669. dma_data->filter_data = dma;
  1670. /* RX is not valid in DIT mode */
  1671. if (mcasp->op_mode != DAVINCI_MCASP_DIT_MODE) {
  1672. dma_data = &mcasp->dma_data[SNDRV_PCM_STREAM_CAPTURE];
  1673. if (dat)
  1674. dma_data->addr = dat->start;
  1675. else
  1676. dma_data->addr =
  1677. mem->start + davinci_mcasp_rxdma_offset(pdata);
  1678. dma = &mcasp->dma_request[SNDRV_PCM_STREAM_CAPTURE];
  1679. res = platform_get_resource(pdev, IORESOURCE_DMA, 1);
  1680. if (res)
  1681. *dma = res->start;
  1682. else
  1683. *dma = pdata->rx_dma_channel;
  1684. /* dmaengine filter data for DT and non-DT boot */
  1685. if (pdev->dev.of_node)
  1686. dma_data->filter_data = "rx";
  1687. else
  1688. dma_data->filter_data = dma;
  1689. }
  1690. if (mcasp->version < MCASP_VERSION_3) {
  1691. mcasp->fifo_base = DAVINCI_MCASP_V2_AFIFO_BASE;
  1692. /* dma_params->dma_addr is pointing to the data port address */
  1693. mcasp->dat_port = true;
  1694. } else {
  1695. mcasp->fifo_base = DAVINCI_MCASP_V3_AFIFO_BASE;
  1696. }
  1697. /* Allocate memory for long enough list for all possible
  1698. * scenarios. Maximum number tdm slots is 32 and there cannot
  1699. * be more serializers than given in the configuration. The
  1700. * serializer directions could be taken into account, but it
  1701. * would make code much more complex and save only couple of
  1702. * bytes.
  1703. */
  1704. mcasp->chconstr[SNDRV_PCM_STREAM_PLAYBACK].list =
  1705. devm_kcalloc(mcasp->dev,
  1706. 32 + mcasp->num_serializer - 1,
  1707. sizeof(unsigned int),
  1708. GFP_KERNEL);
  1709. mcasp->chconstr[SNDRV_PCM_STREAM_CAPTURE].list =
  1710. devm_kcalloc(mcasp->dev,
  1711. 32 + mcasp->num_serializer - 1,
  1712. sizeof(unsigned int),
  1713. GFP_KERNEL);
  1714. if (!mcasp->chconstr[SNDRV_PCM_STREAM_PLAYBACK].list ||
  1715. !mcasp->chconstr[SNDRV_PCM_STREAM_CAPTURE].list) {
  1716. ret = -ENOMEM;
  1717. goto err;
  1718. }
  1719. ret = davinci_mcasp_set_ch_constraints(mcasp);
  1720. if (ret)
  1721. goto err;
  1722. dev_set_drvdata(&pdev->dev, mcasp);
  1723. mcasp_reparent_fck(pdev);
  1724. ret = devm_snd_soc_register_component(&pdev->dev,
  1725. &davinci_mcasp_component,
  1726. &davinci_mcasp_dai[pdata->op_mode], 1);
  1727. if (ret != 0)
  1728. goto err;
  1729. ret = davinci_mcasp_get_dma_type(mcasp);
  1730. switch (ret) {
  1731. case PCM_EDMA:
  1732. #if IS_BUILTIN(CONFIG_SND_EDMA_SOC) || \
  1733. (IS_MODULE(CONFIG_SND_DAVINCI_SOC_MCASP) && \
  1734. IS_MODULE(CONFIG_SND_EDMA_SOC))
  1735. ret = edma_pcm_platform_register(&pdev->dev);
  1736. #else
  1737. dev_err(&pdev->dev, "Missing SND_EDMA_SOC\n");
  1738. ret = -EINVAL;
  1739. goto err;
  1740. #endif
  1741. break;
  1742. case PCM_SDMA:
  1743. #if IS_BUILTIN(CONFIG_SND_SDMA_SOC) || \
  1744. (IS_MODULE(CONFIG_SND_DAVINCI_SOC_MCASP) && \
  1745. IS_MODULE(CONFIG_SND_SDMA_SOC))
  1746. ret = sdma_pcm_platform_register(&pdev->dev, NULL, NULL);
  1747. #else
  1748. dev_err(&pdev->dev, "Missing SND_SDMA_SOC\n");
  1749. ret = -EINVAL;
  1750. goto err;
  1751. #endif
  1752. break;
  1753. default:
  1754. dev_err(&pdev->dev, "No DMA controller found (%d)\n", ret);
  1755. case -EPROBE_DEFER:
  1756. goto err;
  1757. break;
  1758. }
  1759. if (ret) {
  1760. dev_err(&pdev->dev, "register PCM failed: %d\n", ret);
  1761. goto err;
  1762. }
  1763. return 0;
  1764. err:
  1765. pm_runtime_disable(&pdev->dev);
  1766. return ret;
  1767. }
  1768. static int davinci_mcasp_remove(struct platform_device *pdev)
  1769. {
  1770. pm_runtime_disable(&pdev->dev);
  1771. return 0;
  1772. }
  1773. static struct platform_driver davinci_mcasp_driver = {
  1774. .probe = davinci_mcasp_probe,
  1775. .remove = davinci_mcasp_remove,
  1776. .driver = {
  1777. .name = "davinci-mcasp",
  1778. .of_match_table = mcasp_dt_ids,
  1779. },
  1780. };
  1781. module_platform_driver(davinci_mcasp_driver);
  1782. MODULE_AUTHOR("Steve Chen");
  1783. MODULE_DESCRIPTION("TI DAVINCI McASP SoC Interface");
  1784. MODULE_LICENSE("GPL");