gpi.c 64 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Copyright (c) 2017-2020, The Linux Foundation. All rights reserved.
  4. * Copyright (c) 2020, Linaro Limited
  5. */
  6. #include <dt-bindings/dma/qcom-gpi.h>
  7. #include <linux/bitfield.h>
  8. #include <linux/dma-mapping.h>
  9. #include <linux/dmaengine.h>
  10. #include <linux/module.h>
  11. #include <linux/of_dma.h>
  12. #include <linux/platform_device.h>
  13. #include <linux/dma/qcom-gpi-dma.h>
  14. #include <linux/scatterlist.h>
  15. #include <linux/slab.h>
  16. #include "../dmaengine.h"
  17. #include "../virt-dma.h"
  18. #define TRE_TYPE_DMA 0x10
  19. #define TRE_TYPE_GO 0x20
  20. #define TRE_TYPE_CONFIG0 0x22
  21. /* TRE flags */
  22. #define TRE_FLAGS_CHAIN BIT(0)
  23. #define TRE_FLAGS_IEOB BIT(8)
  24. #define TRE_FLAGS_IEOT BIT(9)
  25. #define TRE_FLAGS_BEI BIT(10)
  26. #define TRE_FLAGS_LINK BIT(11)
  27. #define TRE_FLAGS_TYPE GENMASK(23, 16)
  28. /* SPI CONFIG0 WD0 */
  29. #define TRE_SPI_C0_WORD_SZ GENMASK(4, 0)
  30. #define TRE_SPI_C0_LOOPBACK BIT(8)
  31. #define TRE_SPI_C0_CS BIT(11)
  32. #define TRE_SPI_C0_CPHA BIT(12)
  33. #define TRE_SPI_C0_CPOL BIT(13)
  34. #define TRE_SPI_C0_TX_PACK BIT(24)
  35. #define TRE_SPI_C0_RX_PACK BIT(25)
  36. /* CONFIG0 WD2 */
  37. #define TRE_C0_CLK_DIV GENMASK(11, 0)
  38. #define TRE_C0_CLK_SRC GENMASK(19, 16)
  39. /* SPI GO WD0 */
  40. #define TRE_SPI_GO_CMD GENMASK(4, 0)
  41. #define TRE_SPI_GO_CS GENMASK(10, 8)
  42. #define TRE_SPI_GO_FRAG BIT(26)
  43. /* GO WD2 */
  44. #define TRE_RX_LEN GENMASK(23, 0)
  45. /* I2C Config0 WD0 */
  46. #define TRE_I2C_C0_TLOW GENMASK(7, 0)
  47. #define TRE_I2C_C0_THIGH GENMASK(15, 8)
  48. #define TRE_I2C_C0_TCYL GENMASK(23, 16)
  49. #define TRE_I2C_C0_TX_PACK BIT(24)
  50. #define TRE_I2C_C0_RX_PACK BIT(25)
  51. /* I2C GO WD0 */
  52. #define TRE_I2C_GO_CMD GENMASK(4, 0)
  53. #define TRE_I2C_GO_ADDR GENMASK(14, 8)
  54. #define TRE_I2C_GO_STRETCH BIT(26)
  55. /* DMA TRE */
  56. #define TRE_DMA_LEN GENMASK(23, 0)
  57. /* Register offsets from gpi-top */
  58. #define GPII_n_CH_k_CNTXT_0_OFFS(n, k) (0x20000 + (0x4000 * (n)) + (0x80 * (k)))
  59. #define GPII_n_CH_k_CNTXT_0_EL_SIZE GENMASK(31, 24)
  60. #define GPII_n_CH_k_CNTXT_0_CHSTATE GENMASK(23, 20)
  61. #define GPII_n_CH_k_CNTXT_0_ERIDX GENMASK(18, 14)
  62. #define GPII_n_CH_k_CNTXT_0_DIR BIT(3)
  63. #define GPII_n_CH_k_CNTXT_0_PROTO GENMASK(2, 0)
  64. #define GPII_n_CH_k_CNTXT_0(el_size, erindex, dir, chtype_proto) \
  65. (FIELD_PREP(GPII_n_CH_k_CNTXT_0_EL_SIZE, el_size) | \
  66. FIELD_PREP(GPII_n_CH_k_CNTXT_0_ERIDX, erindex) | \
  67. FIELD_PREP(GPII_n_CH_k_CNTXT_0_DIR, dir) | \
  68. FIELD_PREP(GPII_n_CH_k_CNTXT_0_PROTO, chtype_proto))
  69. #define GPI_CHTYPE_DIR_IN (0)
  70. #define GPI_CHTYPE_DIR_OUT (1)
  71. #define GPI_CHTYPE_PROTO_GPI (0x2)
  72. #define GPII_n_CH_k_DOORBELL_0_OFFS(n, k) (0x22000 + (0x4000 * (n)) + (0x8 * (k)))
  73. #define GPII_n_CH_CMD_OFFS(n) (0x23008 + (0x4000 * (n)))
  74. #define GPII_n_CH_CMD_OPCODE GENMASK(31, 24)
  75. #define GPII_n_CH_CMD_CHID GENMASK(7, 0)
  76. #define GPII_n_CH_CMD(opcode, chid) \
  77. (FIELD_PREP(GPII_n_CH_CMD_OPCODE, opcode) | \
  78. FIELD_PREP(GPII_n_CH_CMD_CHID, chid))
  79. #define GPII_n_CH_CMD_ALLOCATE (0)
  80. #define GPII_n_CH_CMD_START (1)
  81. #define GPII_n_CH_CMD_STOP (2)
  82. #define GPII_n_CH_CMD_RESET (9)
  83. #define GPII_n_CH_CMD_DE_ALLOC (10)
  84. #define GPII_n_CH_CMD_UART_SW_STALE (32)
  85. #define GPII_n_CH_CMD_UART_RFR_READY (33)
  86. #define GPII_n_CH_CMD_UART_RFR_NOT_READY (34)
  87. /* EV Context Array */
  88. #define GPII_n_EV_CH_k_CNTXT_0_OFFS(n, k) (0x21000 + (0x4000 * (n)) + (0x80 * (k)))
  89. #define GPII_n_EV_k_CNTXT_0_EL_SIZE GENMASK(31, 24)
  90. #define GPII_n_EV_k_CNTXT_0_CHSTATE GENMASK(23, 20)
  91. #define GPII_n_EV_k_CNTXT_0_INTYPE BIT(16)
  92. #define GPII_n_EV_k_CNTXT_0_CHTYPE GENMASK(3, 0)
  93. #define GPII_n_EV_k_CNTXT_0(el_size, inttype, chtype) \
  94. (FIELD_PREP(GPII_n_EV_k_CNTXT_0_EL_SIZE, el_size) | \
  95. FIELD_PREP(GPII_n_EV_k_CNTXT_0_INTYPE, inttype) | \
  96. FIELD_PREP(GPII_n_EV_k_CNTXT_0_CHTYPE, chtype))
  97. #define GPI_INTTYPE_IRQ (1)
  98. #define GPI_CHTYPE_GPI_EV (0x2)
  99. enum CNTXT_OFFS {
  100. CNTXT_0_CONFIG = 0x0,
  101. CNTXT_1_R_LENGTH = 0x4,
  102. CNTXT_2_RING_BASE_LSB = 0x8,
  103. CNTXT_3_RING_BASE_MSB = 0xC,
  104. CNTXT_4_RING_RP_LSB = 0x10,
  105. CNTXT_5_RING_RP_MSB = 0x14,
  106. CNTXT_6_RING_WP_LSB = 0x18,
  107. CNTXT_7_RING_WP_MSB = 0x1C,
  108. CNTXT_8_RING_INT_MOD = 0x20,
  109. CNTXT_9_RING_INTVEC = 0x24,
  110. CNTXT_10_RING_MSI_LSB = 0x28,
  111. CNTXT_11_RING_MSI_MSB = 0x2C,
  112. CNTXT_12_RING_RP_UPDATE_LSB = 0x30,
  113. CNTXT_13_RING_RP_UPDATE_MSB = 0x34,
  114. };
  115. #define GPII_n_EV_CH_k_DOORBELL_0_OFFS(n, k) (0x22100 + (0x4000 * (n)) + (0x8 * (k)))
  116. #define GPII_n_EV_CH_CMD_OFFS(n) (0x23010 + (0x4000 * (n)))
  117. #define GPII_n_EV_CMD_OPCODE GENMASK(31, 24)
  118. #define GPII_n_EV_CMD_CHID GENMASK(7, 0)
  119. #define GPII_n_EV_CMD(opcode, chid) \
  120. (FIELD_PREP(GPII_n_EV_CMD_OPCODE, opcode) | \
  121. FIELD_PREP(GPII_n_EV_CMD_CHID, chid))
  122. #define GPII_n_EV_CH_CMD_ALLOCATE (0x00)
  123. #define GPII_n_EV_CH_CMD_RESET (0x09)
  124. #define GPII_n_EV_CH_CMD_DE_ALLOC (0x0A)
  125. #define GPII_n_CNTXT_TYPE_IRQ_OFFS(n) (0x23080 + (0x4000 * (n)))
  126. /* mask type register */
  127. #define GPII_n_CNTXT_TYPE_IRQ_MSK_OFFS(n) (0x23088 + (0x4000 * (n)))
  128. #define GPII_n_CNTXT_TYPE_IRQ_MSK_BMSK GENMASK(6, 0)
  129. #define GPII_n_CNTXT_TYPE_IRQ_MSK_GENERAL BIT(6)
  130. #define GPII_n_CNTXT_TYPE_IRQ_MSK_IEOB BIT(3)
  131. #define GPII_n_CNTXT_TYPE_IRQ_MSK_GLOB BIT(2)
  132. #define GPII_n_CNTXT_TYPE_IRQ_MSK_EV_CTRL BIT(1)
  133. #define GPII_n_CNTXT_TYPE_IRQ_MSK_CH_CTRL BIT(0)
  134. #define GPII_n_CNTXT_SRC_GPII_CH_IRQ_OFFS(n) (0x23090 + (0x4000 * (n)))
  135. #define GPII_n_CNTXT_SRC_EV_CH_IRQ_OFFS(n) (0x23094 + (0x4000 * (n)))
  136. /* Mask channel control interrupt register */
  137. #define GPII_n_CNTXT_SRC_CH_IRQ_MSK_OFFS(n) (0x23098 + (0x4000 * (n)))
  138. #define GPII_n_CNTXT_SRC_CH_IRQ_MSK_BMSK GENMASK(1, 0)
  139. /* Mask event control interrupt register */
  140. #define GPII_n_CNTXT_SRC_EV_CH_IRQ_MSK_OFFS(n) (0x2309C + (0x4000 * (n)))
  141. #define GPII_n_CNTXT_SRC_EV_CH_IRQ_MSK_BMSK BIT(0)
  142. #define GPII_n_CNTXT_SRC_CH_IRQ_CLR_OFFS(n) (0x230A0 + (0x4000 * (n)))
  143. #define GPII_n_CNTXT_SRC_EV_CH_IRQ_CLR_OFFS(n) (0x230A4 + (0x4000 * (n)))
  144. /* Mask event interrupt register */
  145. #define GPII_n_CNTXT_SRC_IEOB_IRQ_MSK_OFFS(n) (0x230B8 + (0x4000 * (n)))
  146. #define GPII_n_CNTXT_SRC_IEOB_IRQ_MSK_BMSK BIT(0)
  147. #define GPII_n_CNTXT_SRC_IEOB_IRQ_CLR_OFFS(n) (0x230C0 + (0x4000 * (n)))
  148. #define GPII_n_CNTXT_GLOB_IRQ_STTS_OFFS(n) (0x23100 + (0x4000 * (n)))
  149. #define GPI_GLOB_IRQ_ERROR_INT_MSK BIT(0)
  150. /* GPII specific Global - Enable bit register */
  151. #define GPII_n_CNTXT_GLOB_IRQ_EN_OFFS(n) (0x23108 + (0x4000 * (n)))
  152. #define GPII_n_CNTXT_GLOB_IRQ_CLR_OFFS(n) (0x23110 + (0x4000 * (n)))
  153. #define GPII_n_CNTXT_GPII_IRQ_STTS_OFFS(n) (0x23118 + (0x4000 * (n)))
  154. /* GPII general interrupt - Enable bit register */
  155. #define GPII_n_CNTXT_GPII_IRQ_EN_OFFS(n) (0x23120 + (0x4000 * (n)))
  156. #define GPII_n_CNTXT_GPII_IRQ_EN_BMSK GENMASK(3, 0)
  157. #define GPII_n_CNTXT_GPII_IRQ_CLR_OFFS(n) (0x23128 + (0x4000 * (n)))
  158. /* GPII Interrupt Type register */
  159. #define GPII_n_CNTXT_INTSET_OFFS(n) (0x23180 + (0x4000 * (n)))
  160. #define GPII_n_CNTXT_INTSET_BMSK BIT(0)
  161. #define GPII_n_CNTXT_MSI_BASE_LSB_OFFS(n) (0x23188 + (0x4000 * (n)))
  162. #define GPII_n_CNTXT_MSI_BASE_MSB_OFFS(n) (0x2318C + (0x4000 * (n)))
  163. #define GPII_n_CNTXT_SCRATCH_0_OFFS(n) (0x23400 + (0x4000 * (n)))
  164. #define GPII_n_CNTXT_SCRATCH_1_OFFS(n) (0x23404 + (0x4000 * (n)))
  165. #define GPII_n_ERROR_LOG_OFFS(n) (0x23200 + (0x4000 * (n)))
  166. /* QOS Registers */
  167. #define GPII_n_CH_k_QOS_OFFS(n, k) (0x2005C + (0x4000 * (n)) + (0x80 * (k)))
  168. /* Scratch registers */
  169. #define GPII_n_CH_k_SCRATCH_0_OFFS(n, k) (0x20060 + (0x4000 * (n)) + (0x80 * (k)))
  170. #define GPII_n_CH_k_SCRATCH_0_SEID GENMASK(2, 0)
  171. #define GPII_n_CH_k_SCRATCH_0_PROTO GENMASK(7, 4)
  172. #define GPII_n_CH_k_SCRATCH_0_PAIR GENMASK(20, 16)
  173. #define GPII_n_CH_k_SCRATCH_0(pair, proto, seid) \
  174. (FIELD_PREP(GPII_n_CH_k_SCRATCH_0_PAIR, pair) | \
  175. FIELD_PREP(GPII_n_CH_k_SCRATCH_0_PROTO, proto) | \
  176. FIELD_PREP(GPII_n_CH_k_SCRATCH_0_SEID, seid))
  177. #define GPII_n_CH_k_SCRATCH_1_OFFS(n, k) (0x20064 + (0x4000 * (n)) + (0x80 * (k)))
  178. #define GPII_n_CH_k_SCRATCH_2_OFFS(n, k) (0x20068 + (0x4000 * (n)) + (0x80 * (k)))
  179. #define GPII_n_CH_k_SCRATCH_3_OFFS(n, k) (0x2006C + (0x4000 * (n)) + (0x80 * (k)))
  180. struct __packed gpi_tre {
  181. u32 dword[4];
  182. };
  183. enum msm_gpi_tce_code {
  184. MSM_GPI_TCE_SUCCESS = 1,
  185. MSM_GPI_TCE_EOT = 2,
  186. MSM_GPI_TCE_EOB = 4,
  187. MSM_GPI_TCE_UNEXP_ERR = 16,
  188. };
  189. #define CMD_TIMEOUT_MS (250)
  190. #define MAX_CHANNELS_PER_GPII (2)
  191. #define GPI_TX_CHAN (0)
  192. #define GPI_RX_CHAN (1)
  193. #define STATE_IGNORE (U32_MAX)
  194. #define EV_FACTOR (2)
  195. #define REQ_OF_DMA_ARGS (5) /* # of arguments required from client */
  196. #define CHAN_TRES 64
  197. struct __packed xfer_compl_event {
  198. u64 ptr;
  199. u32 length:24;
  200. u8 code;
  201. u16 status;
  202. u8 type;
  203. u8 chid;
  204. };
  205. struct __packed immediate_data_event {
  206. u8 data_bytes[8];
  207. u8 length:4;
  208. u8 resvd:4;
  209. u16 tre_index;
  210. u8 code;
  211. u16 status;
  212. u8 type;
  213. u8 chid;
  214. };
  215. struct __packed qup_notif_event {
  216. u32 status;
  217. u32 time;
  218. u32 count:24;
  219. u8 resvd;
  220. u16 resvd1;
  221. u8 type;
  222. u8 chid;
  223. };
  224. struct __packed gpi_ere {
  225. u32 dword[4];
  226. };
  227. enum GPI_EV_TYPE {
  228. XFER_COMPLETE_EV_TYPE = 0x22,
  229. IMMEDIATE_DATA_EV_TYPE = 0x30,
  230. QUP_NOTIF_EV_TYPE = 0x31,
  231. STALE_EV_TYPE = 0xFF,
  232. };
  233. union __packed gpi_event {
  234. struct __packed xfer_compl_event xfer_compl_event;
  235. struct __packed immediate_data_event immediate_data_event;
  236. struct __packed qup_notif_event qup_notif_event;
  237. struct __packed gpi_ere gpi_ere;
  238. };
  239. enum gpii_irq_settings {
  240. DEFAULT_IRQ_SETTINGS,
  241. MASK_IEOB_SETTINGS,
  242. };
  243. enum gpi_ev_state {
  244. DEFAULT_EV_CH_STATE = 0,
  245. EV_STATE_NOT_ALLOCATED = DEFAULT_EV_CH_STATE,
  246. EV_STATE_ALLOCATED,
  247. MAX_EV_STATES
  248. };
  249. static const char *const gpi_ev_state_str[MAX_EV_STATES] = {
  250. [EV_STATE_NOT_ALLOCATED] = "NOT ALLOCATED",
  251. [EV_STATE_ALLOCATED] = "ALLOCATED",
  252. };
  253. #define TO_GPI_EV_STATE_STR(_state) (((_state) >= MAX_EV_STATES) ? \
  254. "INVALID" : gpi_ev_state_str[(_state)])
  255. enum gpi_ch_state {
  256. DEFAULT_CH_STATE = 0x0,
  257. CH_STATE_NOT_ALLOCATED = DEFAULT_CH_STATE,
  258. CH_STATE_ALLOCATED = 0x1,
  259. CH_STATE_STARTED = 0x2,
  260. CH_STATE_STOPPED = 0x3,
  261. CH_STATE_STOP_IN_PROC = 0x4,
  262. CH_STATE_ERROR = 0xf,
  263. MAX_CH_STATES
  264. };
  265. enum gpi_cmd {
  266. GPI_CH_CMD_BEGIN,
  267. GPI_CH_CMD_ALLOCATE = GPI_CH_CMD_BEGIN,
  268. GPI_CH_CMD_START,
  269. GPI_CH_CMD_STOP,
  270. GPI_CH_CMD_RESET,
  271. GPI_CH_CMD_DE_ALLOC,
  272. GPI_CH_CMD_UART_SW_STALE,
  273. GPI_CH_CMD_UART_RFR_READY,
  274. GPI_CH_CMD_UART_RFR_NOT_READY,
  275. GPI_CH_CMD_END = GPI_CH_CMD_UART_RFR_NOT_READY,
  276. GPI_EV_CMD_BEGIN,
  277. GPI_EV_CMD_ALLOCATE = GPI_EV_CMD_BEGIN,
  278. GPI_EV_CMD_RESET,
  279. GPI_EV_CMD_DEALLOC,
  280. GPI_EV_CMD_END = GPI_EV_CMD_DEALLOC,
  281. GPI_MAX_CMD,
  282. };
  283. #define IS_CHAN_CMD(_cmd) ((_cmd) <= GPI_CH_CMD_END)
  284. static const char *const gpi_cmd_str[GPI_MAX_CMD] = {
  285. [GPI_CH_CMD_ALLOCATE] = "CH ALLOCATE",
  286. [GPI_CH_CMD_START] = "CH START",
  287. [GPI_CH_CMD_STOP] = "CH STOP",
  288. [GPI_CH_CMD_RESET] = "CH_RESET",
  289. [GPI_CH_CMD_DE_ALLOC] = "DE ALLOC",
  290. [GPI_CH_CMD_UART_SW_STALE] = "UART SW STALE",
  291. [GPI_CH_CMD_UART_RFR_READY] = "UART RFR READY",
  292. [GPI_CH_CMD_UART_RFR_NOT_READY] = "UART RFR NOT READY",
  293. [GPI_EV_CMD_ALLOCATE] = "EV ALLOCATE",
  294. [GPI_EV_CMD_RESET] = "EV RESET",
  295. [GPI_EV_CMD_DEALLOC] = "EV DEALLOC",
  296. };
  297. #define TO_GPI_CMD_STR(_cmd) (((_cmd) >= GPI_MAX_CMD) ? "INVALID" : \
  298. gpi_cmd_str[(_cmd)])
  299. /*
  300. * @DISABLE_STATE: no register access allowed
  301. * @CONFIG_STATE: client has configured the channel
  302. * @PREP_HARDWARE: register access is allowed
  303. * however, no processing EVENTS
  304. * @ACTIVE_STATE: channels are fully operational
  305. * @PREPARE_TERMINATE: graceful termination of channels
  306. * register access is allowed
  307. * @PAUSE_STATE: channels are active, but not processing any events
  308. */
  309. enum gpi_pm_state {
  310. DISABLE_STATE,
  311. CONFIG_STATE,
  312. PREPARE_HARDWARE,
  313. ACTIVE_STATE,
  314. PREPARE_TERMINATE,
  315. PAUSE_STATE,
  316. MAX_PM_STATE
  317. };
  318. #define REG_ACCESS_VALID(_pm_state) ((_pm_state) >= PREPARE_HARDWARE)
  319. static const char *const gpi_pm_state_str[MAX_PM_STATE] = {
  320. [DISABLE_STATE] = "DISABLE",
  321. [CONFIG_STATE] = "CONFIG",
  322. [PREPARE_HARDWARE] = "PREPARE HARDWARE",
  323. [ACTIVE_STATE] = "ACTIVE",
  324. [PREPARE_TERMINATE] = "PREPARE TERMINATE",
  325. [PAUSE_STATE] = "PAUSE",
  326. };
  327. #define TO_GPI_PM_STR(_state) (((_state) >= MAX_PM_STATE) ? \
  328. "INVALID" : gpi_pm_state_str[(_state)])
  329. static const struct {
  330. enum gpi_cmd gpi_cmd;
  331. u32 opcode;
  332. u32 state;
  333. } gpi_cmd_info[GPI_MAX_CMD] = {
  334. {
  335. GPI_CH_CMD_ALLOCATE,
  336. GPII_n_CH_CMD_ALLOCATE,
  337. CH_STATE_ALLOCATED,
  338. },
  339. {
  340. GPI_CH_CMD_START,
  341. GPII_n_CH_CMD_START,
  342. CH_STATE_STARTED,
  343. },
  344. {
  345. GPI_CH_CMD_STOP,
  346. GPII_n_CH_CMD_STOP,
  347. CH_STATE_STOPPED,
  348. },
  349. {
  350. GPI_CH_CMD_RESET,
  351. GPII_n_CH_CMD_RESET,
  352. CH_STATE_ALLOCATED,
  353. },
  354. {
  355. GPI_CH_CMD_DE_ALLOC,
  356. GPII_n_CH_CMD_DE_ALLOC,
  357. CH_STATE_NOT_ALLOCATED,
  358. },
  359. {
  360. GPI_CH_CMD_UART_SW_STALE,
  361. GPII_n_CH_CMD_UART_SW_STALE,
  362. STATE_IGNORE,
  363. },
  364. {
  365. GPI_CH_CMD_UART_RFR_READY,
  366. GPII_n_CH_CMD_UART_RFR_READY,
  367. STATE_IGNORE,
  368. },
  369. {
  370. GPI_CH_CMD_UART_RFR_NOT_READY,
  371. GPII_n_CH_CMD_UART_RFR_NOT_READY,
  372. STATE_IGNORE,
  373. },
  374. {
  375. GPI_EV_CMD_ALLOCATE,
  376. GPII_n_EV_CH_CMD_ALLOCATE,
  377. EV_STATE_ALLOCATED,
  378. },
  379. {
  380. GPI_EV_CMD_RESET,
  381. GPII_n_EV_CH_CMD_RESET,
  382. EV_STATE_ALLOCATED,
  383. },
  384. {
  385. GPI_EV_CMD_DEALLOC,
  386. GPII_n_EV_CH_CMD_DE_ALLOC,
  387. EV_STATE_NOT_ALLOCATED,
  388. },
  389. };
  390. struct gpi_ring {
  391. void *pre_aligned;
  392. size_t alloc_size;
  393. phys_addr_t phys_addr;
  394. dma_addr_t dma_handle;
  395. void *base;
  396. void *wp;
  397. void *rp;
  398. u32 len;
  399. u32 el_size;
  400. u32 elements;
  401. bool configured;
  402. };
  403. struct gpi_dev {
  404. struct dma_device dma_device;
  405. struct device *dev;
  406. struct resource *res;
  407. void __iomem *regs;
  408. void __iomem *ee_base; /*ee register base address*/
  409. u32 max_gpii; /* maximum # of gpii instances available per gpi block */
  410. u32 gpii_mask; /* gpii instances available for apps */
  411. u32 ev_factor; /* ev ring length factor */
  412. struct gpii *gpiis;
  413. };
  414. struct gchan {
  415. struct virt_dma_chan vc;
  416. u32 chid;
  417. u32 seid;
  418. u32 protocol;
  419. struct gpii *gpii;
  420. enum gpi_ch_state ch_state;
  421. enum gpi_pm_state pm_state;
  422. void __iomem *ch_cntxt_base_reg;
  423. void __iomem *ch_cntxt_db_reg;
  424. void __iomem *ch_cmd_reg;
  425. u32 dir;
  426. struct gpi_ring ch_ring;
  427. void *config;
  428. };
  429. struct gpii {
  430. u32 gpii_id;
  431. struct gchan gchan[MAX_CHANNELS_PER_GPII];
  432. struct gpi_dev *gpi_dev;
  433. int irq;
  434. void __iomem *regs; /* points to gpi top */
  435. void __iomem *ev_cntxt_base_reg;
  436. void __iomem *ev_cntxt_db_reg;
  437. void __iomem *ev_ring_rp_lsb_reg;
  438. void __iomem *ev_cmd_reg;
  439. void __iomem *ieob_clr_reg;
  440. struct mutex ctrl_lock;
  441. enum gpi_ev_state ev_state;
  442. bool configured_irq;
  443. enum gpi_pm_state pm_state;
  444. rwlock_t pm_lock;
  445. struct gpi_ring ev_ring;
  446. struct tasklet_struct ev_task; /* event processing tasklet */
  447. struct completion cmd_completion;
  448. enum gpi_cmd gpi_cmd;
  449. u32 cntxt_type_irq_msk;
  450. bool ieob_set;
  451. };
  452. #define MAX_TRE 3
  453. struct gpi_desc {
  454. struct virt_dma_desc vd;
  455. size_t len;
  456. void *db; /* DB register to program */
  457. struct gchan *gchan;
  458. struct gpi_tre tre[MAX_TRE];
  459. u32 num_tre;
  460. };
  461. static const u32 GPII_CHAN_DIR[MAX_CHANNELS_PER_GPII] = {
  462. GPI_CHTYPE_DIR_OUT, GPI_CHTYPE_DIR_IN
  463. };
  464. static irqreturn_t gpi_handle_irq(int irq, void *data);
  465. static void gpi_ring_recycle_ev_element(struct gpi_ring *ring);
  466. static int gpi_ring_add_element(struct gpi_ring *ring, void **wp);
  467. static void gpi_process_events(struct gpii *gpii);
  468. static inline struct gchan *to_gchan(struct dma_chan *dma_chan)
  469. {
  470. return container_of(dma_chan, struct gchan, vc.chan);
  471. }
  472. static inline struct gpi_desc *to_gpi_desc(struct virt_dma_desc *vd)
  473. {
  474. return container_of(vd, struct gpi_desc, vd);
  475. }
  476. static inline phys_addr_t to_physical(const struct gpi_ring *const ring,
  477. void *addr)
  478. {
  479. return ring->phys_addr + (addr - ring->base);
  480. }
  481. static inline void *to_virtual(const struct gpi_ring *const ring, phys_addr_t addr)
  482. {
  483. return ring->base + (addr - ring->phys_addr);
  484. }
  485. static inline u32 gpi_read_reg(struct gpii *gpii, void __iomem *addr)
  486. {
  487. return readl_relaxed(addr);
  488. }
  489. static inline void gpi_write_reg(struct gpii *gpii, void __iomem *addr, u32 val)
  490. {
  491. writel_relaxed(val, addr);
  492. }
  493. /* gpi_write_reg_field - write to specific bit field */
  494. static inline void gpi_write_reg_field(struct gpii *gpii, void __iomem *addr,
  495. u32 mask, u32 shift, u32 val)
  496. {
  497. u32 tmp = gpi_read_reg(gpii, addr);
  498. tmp &= ~mask;
  499. val = tmp | ((val << shift) & mask);
  500. gpi_write_reg(gpii, addr, val);
  501. }
  502. static __always_inline void
  503. gpi_update_reg(struct gpii *gpii, u32 offset, u32 mask, u32 val)
  504. {
  505. void __iomem *addr = gpii->regs + offset;
  506. u32 tmp = gpi_read_reg(gpii, addr);
  507. tmp &= ~mask;
  508. tmp |= u32_encode_bits(val, mask);
  509. gpi_write_reg(gpii, addr, tmp);
  510. }
  511. static void gpi_disable_interrupts(struct gpii *gpii)
  512. {
  513. gpi_update_reg(gpii, GPII_n_CNTXT_TYPE_IRQ_MSK_OFFS(gpii->gpii_id),
  514. GPII_n_CNTXT_TYPE_IRQ_MSK_BMSK, 0);
  515. gpi_update_reg(gpii, GPII_n_CNTXT_SRC_IEOB_IRQ_MSK_OFFS(gpii->gpii_id),
  516. GPII_n_CNTXT_SRC_IEOB_IRQ_MSK_BMSK, 0);
  517. gpi_update_reg(gpii, GPII_n_CNTXT_SRC_CH_IRQ_MSK_OFFS(gpii->gpii_id),
  518. GPII_n_CNTXT_SRC_CH_IRQ_MSK_BMSK, 0);
  519. gpi_update_reg(gpii, GPII_n_CNTXT_SRC_EV_CH_IRQ_MSK_OFFS(gpii->gpii_id),
  520. GPII_n_CNTXT_SRC_EV_CH_IRQ_MSK_BMSK, 0);
  521. gpi_update_reg(gpii, GPII_n_CNTXT_GLOB_IRQ_EN_OFFS(gpii->gpii_id),
  522. GPII_n_CNTXT_GPII_IRQ_EN_BMSK, 0);
  523. gpi_update_reg(gpii, GPII_n_CNTXT_GPII_IRQ_EN_OFFS(gpii->gpii_id),
  524. GPII_n_CNTXT_GPII_IRQ_EN_BMSK, 0);
  525. gpi_update_reg(gpii, GPII_n_CNTXT_INTSET_OFFS(gpii->gpii_id),
  526. GPII_n_CNTXT_INTSET_BMSK, 0);
  527. gpii->cntxt_type_irq_msk = 0;
  528. devm_free_irq(gpii->gpi_dev->dev, gpii->irq, gpii);
  529. gpii->configured_irq = false;
  530. }
  531. /* configure and enable interrupts */
  532. static int gpi_config_interrupts(struct gpii *gpii, enum gpii_irq_settings settings, bool mask)
  533. {
  534. const u32 enable = (GPII_n_CNTXT_TYPE_IRQ_MSK_GENERAL |
  535. GPII_n_CNTXT_TYPE_IRQ_MSK_IEOB |
  536. GPII_n_CNTXT_TYPE_IRQ_MSK_GLOB |
  537. GPII_n_CNTXT_TYPE_IRQ_MSK_EV_CTRL |
  538. GPII_n_CNTXT_TYPE_IRQ_MSK_CH_CTRL);
  539. int ret;
  540. if (!gpii->configured_irq) {
  541. ret = devm_request_irq(gpii->gpi_dev->dev, gpii->irq,
  542. gpi_handle_irq, IRQF_TRIGGER_HIGH,
  543. "gpi-dma", gpii);
  544. if (ret < 0) {
  545. dev_err(gpii->gpi_dev->dev, "error request irq:%d ret:%d\n",
  546. gpii->irq, ret);
  547. return ret;
  548. }
  549. }
  550. if (settings == MASK_IEOB_SETTINGS) {
  551. /*
  552. * GPII only uses one EV ring per gpii so we can globally
  553. * enable/disable IEOB interrupt
  554. */
  555. if (mask)
  556. gpii->cntxt_type_irq_msk |= GPII_n_CNTXT_TYPE_IRQ_MSK_IEOB;
  557. else
  558. gpii->cntxt_type_irq_msk &= ~(GPII_n_CNTXT_TYPE_IRQ_MSK_IEOB);
  559. gpi_update_reg(gpii, GPII_n_CNTXT_TYPE_IRQ_MSK_OFFS(gpii->gpii_id),
  560. GPII_n_CNTXT_TYPE_IRQ_MSK_BMSK, gpii->cntxt_type_irq_msk);
  561. } else {
  562. gpi_update_reg(gpii, GPII_n_CNTXT_TYPE_IRQ_MSK_OFFS(gpii->gpii_id),
  563. GPII_n_CNTXT_TYPE_IRQ_MSK_BMSK, enable);
  564. gpi_update_reg(gpii, GPII_n_CNTXT_SRC_IEOB_IRQ_MSK_OFFS(gpii->gpii_id),
  565. GPII_n_CNTXT_SRC_IEOB_IRQ_MSK_BMSK,
  566. GPII_n_CNTXT_SRC_IEOB_IRQ_MSK_BMSK);
  567. gpi_update_reg(gpii, GPII_n_CNTXT_SRC_CH_IRQ_MSK_OFFS(gpii->gpii_id),
  568. GPII_n_CNTXT_SRC_CH_IRQ_MSK_BMSK,
  569. GPII_n_CNTXT_SRC_CH_IRQ_MSK_BMSK);
  570. gpi_update_reg(gpii, GPII_n_CNTXT_SRC_EV_CH_IRQ_MSK_OFFS(gpii->gpii_id),
  571. GPII_n_CNTXT_SRC_EV_CH_IRQ_MSK_BMSK,
  572. GPII_n_CNTXT_SRC_EV_CH_IRQ_MSK_BMSK);
  573. gpi_update_reg(gpii, GPII_n_CNTXT_GLOB_IRQ_EN_OFFS(gpii->gpii_id),
  574. GPII_n_CNTXT_GPII_IRQ_EN_BMSK,
  575. GPII_n_CNTXT_GPII_IRQ_EN_BMSK);
  576. gpi_update_reg(gpii, GPII_n_CNTXT_GPII_IRQ_EN_OFFS(gpii->gpii_id),
  577. GPII_n_CNTXT_GPII_IRQ_EN_BMSK, GPII_n_CNTXT_GPII_IRQ_EN_BMSK);
  578. gpi_update_reg(gpii, GPII_n_CNTXT_MSI_BASE_LSB_OFFS(gpii->gpii_id), U32_MAX, 0);
  579. gpi_update_reg(gpii, GPII_n_CNTXT_MSI_BASE_MSB_OFFS(gpii->gpii_id), U32_MAX, 0);
  580. gpi_update_reg(gpii, GPII_n_CNTXT_SCRATCH_0_OFFS(gpii->gpii_id), U32_MAX, 0);
  581. gpi_update_reg(gpii, GPII_n_CNTXT_SCRATCH_1_OFFS(gpii->gpii_id), U32_MAX, 0);
  582. gpi_update_reg(gpii, GPII_n_CNTXT_INTSET_OFFS(gpii->gpii_id),
  583. GPII_n_CNTXT_INTSET_BMSK, 1);
  584. gpi_update_reg(gpii, GPII_n_ERROR_LOG_OFFS(gpii->gpii_id), U32_MAX, 0);
  585. gpii->cntxt_type_irq_msk = enable;
  586. }
  587. gpii->configured_irq = true;
  588. return 0;
  589. }
  590. /* Sends gpii event or channel command */
  591. static int gpi_send_cmd(struct gpii *gpii, struct gchan *gchan,
  592. enum gpi_cmd gpi_cmd)
  593. {
  594. u32 chid = MAX_CHANNELS_PER_GPII;
  595. unsigned long timeout;
  596. void __iomem *cmd_reg;
  597. u32 cmd;
  598. if (gpi_cmd >= GPI_MAX_CMD)
  599. return -EINVAL;
  600. if (IS_CHAN_CMD(gpi_cmd))
  601. chid = gchan->chid;
  602. dev_dbg(gpii->gpi_dev->dev,
  603. "sending cmd: %s:%u\n", TO_GPI_CMD_STR(gpi_cmd), chid);
  604. /* send opcode and wait for completion */
  605. reinit_completion(&gpii->cmd_completion);
  606. gpii->gpi_cmd = gpi_cmd;
  607. cmd_reg = IS_CHAN_CMD(gpi_cmd) ? gchan->ch_cmd_reg : gpii->ev_cmd_reg;
  608. cmd = IS_CHAN_CMD(gpi_cmd) ? GPII_n_CH_CMD(gpi_cmd_info[gpi_cmd].opcode, chid) :
  609. GPII_n_EV_CMD(gpi_cmd_info[gpi_cmd].opcode, 0);
  610. gpi_write_reg(gpii, cmd_reg, cmd);
  611. timeout = wait_for_completion_timeout(&gpii->cmd_completion,
  612. msecs_to_jiffies(CMD_TIMEOUT_MS));
  613. if (!timeout) {
  614. dev_err(gpii->gpi_dev->dev, "cmd: %s completion timeout:%u\n",
  615. TO_GPI_CMD_STR(gpi_cmd), chid);
  616. return -EIO;
  617. }
  618. /* confirm new ch state is correct , if the cmd is a state change cmd */
  619. if (gpi_cmd_info[gpi_cmd].state == STATE_IGNORE)
  620. return 0;
  621. if (IS_CHAN_CMD(gpi_cmd) && gchan->ch_state == gpi_cmd_info[gpi_cmd].state)
  622. return 0;
  623. if (!IS_CHAN_CMD(gpi_cmd) && gpii->ev_state == gpi_cmd_info[gpi_cmd].state)
  624. return 0;
  625. return -EIO;
  626. }
  627. /* program transfer ring DB register */
  628. static inline void gpi_write_ch_db(struct gchan *gchan,
  629. struct gpi_ring *ring, void *wp)
  630. {
  631. struct gpii *gpii = gchan->gpii;
  632. phys_addr_t p_wp;
  633. p_wp = to_physical(ring, wp);
  634. gpi_write_reg(gpii, gchan->ch_cntxt_db_reg, p_wp);
  635. }
  636. /* program event ring DB register */
  637. static inline void gpi_write_ev_db(struct gpii *gpii,
  638. struct gpi_ring *ring, void *wp)
  639. {
  640. phys_addr_t p_wp;
  641. p_wp = ring->phys_addr + (wp - ring->base);
  642. gpi_write_reg(gpii, gpii->ev_cntxt_db_reg, p_wp);
  643. }
  644. /* process transfer completion interrupt */
  645. static void gpi_process_ieob(struct gpii *gpii)
  646. {
  647. gpi_write_reg(gpii, gpii->ieob_clr_reg, BIT(0));
  648. gpi_config_interrupts(gpii, MASK_IEOB_SETTINGS, 0);
  649. tasklet_hi_schedule(&gpii->ev_task);
  650. }
  651. /* process channel control interrupt */
  652. static void gpi_process_ch_ctrl_irq(struct gpii *gpii)
  653. {
  654. u32 gpii_id = gpii->gpii_id;
  655. u32 offset = GPII_n_CNTXT_SRC_GPII_CH_IRQ_OFFS(gpii_id);
  656. u32 ch_irq = gpi_read_reg(gpii, gpii->regs + offset);
  657. struct gchan *gchan;
  658. u32 chid, state;
  659. /* clear the status */
  660. offset = GPII_n_CNTXT_SRC_CH_IRQ_CLR_OFFS(gpii_id);
  661. gpi_write_reg(gpii, gpii->regs + offset, (u32)ch_irq);
  662. for (chid = 0; chid < MAX_CHANNELS_PER_GPII; chid++) {
  663. if (!(BIT(chid) & ch_irq))
  664. continue;
  665. gchan = &gpii->gchan[chid];
  666. state = gpi_read_reg(gpii, gchan->ch_cntxt_base_reg +
  667. CNTXT_0_CONFIG);
  668. state = FIELD_GET(GPII_n_CH_k_CNTXT_0_CHSTATE, state);
  669. /*
  670. * CH_CMD_DEALLOC cmd always successful. However cmd does
  671. * not change hardware status. So overwriting software state
  672. * to default state.
  673. */
  674. if (gpii->gpi_cmd == GPI_CH_CMD_DE_ALLOC)
  675. state = DEFAULT_CH_STATE;
  676. gchan->ch_state = state;
  677. /*
  678. * Triggering complete all if ch_state is not a stop in process.
  679. * Stop in process is a transition state and we will wait for
  680. * stop interrupt before notifying.
  681. */
  682. if (gchan->ch_state != CH_STATE_STOP_IN_PROC)
  683. complete_all(&gpii->cmd_completion);
  684. }
  685. }
  686. /* processing gpi general error interrupts */
  687. static void gpi_process_gen_err_irq(struct gpii *gpii)
  688. {
  689. u32 gpii_id = gpii->gpii_id;
  690. u32 offset = GPII_n_CNTXT_GPII_IRQ_STTS_OFFS(gpii_id);
  691. u32 irq_stts = gpi_read_reg(gpii, gpii->regs + offset);
  692. /* clear the status */
  693. dev_dbg(gpii->gpi_dev->dev, "irq_stts:0x%x\n", irq_stts);
  694. /* Clear the register */
  695. offset = GPII_n_CNTXT_GPII_IRQ_CLR_OFFS(gpii_id);
  696. gpi_write_reg(gpii, gpii->regs + offset, irq_stts);
  697. }
  698. /* processing gpi level error interrupts */
  699. static void gpi_process_glob_err_irq(struct gpii *gpii)
  700. {
  701. u32 gpii_id = gpii->gpii_id;
  702. u32 offset = GPII_n_CNTXT_GLOB_IRQ_STTS_OFFS(gpii_id);
  703. u32 irq_stts = gpi_read_reg(gpii, gpii->regs + offset);
  704. offset = GPII_n_CNTXT_GLOB_IRQ_CLR_OFFS(gpii_id);
  705. gpi_write_reg(gpii, gpii->regs + offset, irq_stts);
  706. /* only error interrupt should be set */
  707. if (irq_stts & ~GPI_GLOB_IRQ_ERROR_INT_MSK) {
  708. dev_err(gpii->gpi_dev->dev, "invalid error status:0x%x\n", irq_stts);
  709. return;
  710. }
  711. offset = GPII_n_ERROR_LOG_OFFS(gpii_id);
  712. gpi_write_reg(gpii, gpii->regs + offset, 0);
  713. }
  714. /* gpii interrupt handler */
  715. static irqreturn_t gpi_handle_irq(int irq, void *data)
  716. {
  717. struct gpii *gpii = data;
  718. u32 gpii_id = gpii->gpii_id;
  719. u32 type, offset;
  720. unsigned long flags;
  721. read_lock_irqsave(&gpii->pm_lock, flags);
  722. /*
  723. * States are out of sync to receive interrupt
  724. * while software state is in DISABLE state, bailing out.
  725. */
  726. if (!REG_ACCESS_VALID(gpii->pm_state)) {
  727. dev_err(gpii->gpi_dev->dev, "receive interrupt while in %s state\n",
  728. TO_GPI_PM_STR(gpii->pm_state));
  729. goto exit_irq;
  730. }
  731. offset = GPII_n_CNTXT_TYPE_IRQ_OFFS(gpii->gpii_id);
  732. type = gpi_read_reg(gpii, gpii->regs + offset);
  733. do {
  734. /* global gpii error */
  735. if (type & GPII_n_CNTXT_TYPE_IRQ_MSK_GLOB) {
  736. gpi_process_glob_err_irq(gpii);
  737. type &= ~(GPII_n_CNTXT_TYPE_IRQ_MSK_GLOB);
  738. }
  739. /* transfer complete interrupt */
  740. if (type & GPII_n_CNTXT_TYPE_IRQ_MSK_IEOB) {
  741. gpi_process_ieob(gpii);
  742. type &= ~GPII_n_CNTXT_TYPE_IRQ_MSK_IEOB;
  743. }
  744. /* event control irq */
  745. if (type & GPII_n_CNTXT_TYPE_IRQ_MSK_EV_CTRL) {
  746. u32 ev_state;
  747. u32 ev_ch_irq;
  748. dev_dbg(gpii->gpi_dev->dev,
  749. "processing EV CTRL interrupt\n");
  750. offset = GPII_n_CNTXT_SRC_EV_CH_IRQ_OFFS(gpii_id);
  751. ev_ch_irq = gpi_read_reg(gpii, gpii->regs + offset);
  752. offset = GPII_n_CNTXT_SRC_EV_CH_IRQ_CLR_OFFS
  753. (gpii_id);
  754. gpi_write_reg(gpii, gpii->regs + offset, ev_ch_irq);
  755. ev_state = gpi_read_reg(gpii, gpii->ev_cntxt_base_reg +
  756. CNTXT_0_CONFIG);
  757. ev_state = FIELD_GET(GPII_n_EV_k_CNTXT_0_CHSTATE, ev_state);
  758. /*
  759. * CMD EV_CMD_DEALLOC is always successful. However
  760. * cmd does not change hardware status. So overwriting
  761. * software state to default state.
  762. */
  763. if (gpii->gpi_cmd == GPI_EV_CMD_DEALLOC)
  764. ev_state = DEFAULT_EV_CH_STATE;
  765. gpii->ev_state = ev_state;
  766. dev_dbg(gpii->gpi_dev->dev, "setting EV state to %s\n",
  767. TO_GPI_EV_STATE_STR(gpii->ev_state));
  768. complete_all(&gpii->cmd_completion);
  769. type &= ~(GPII_n_CNTXT_TYPE_IRQ_MSK_EV_CTRL);
  770. }
  771. /* channel control irq */
  772. if (type & GPII_n_CNTXT_TYPE_IRQ_MSK_CH_CTRL) {
  773. dev_dbg(gpii->gpi_dev->dev, "process CH CTRL interrupts\n");
  774. gpi_process_ch_ctrl_irq(gpii);
  775. type &= ~(GPII_n_CNTXT_TYPE_IRQ_MSK_CH_CTRL);
  776. }
  777. if (type) {
  778. dev_err(gpii->gpi_dev->dev, "Unhandled interrupt status:0x%x\n", type);
  779. gpi_process_gen_err_irq(gpii);
  780. goto exit_irq;
  781. }
  782. offset = GPII_n_CNTXT_TYPE_IRQ_OFFS(gpii->gpii_id);
  783. type = gpi_read_reg(gpii, gpii->regs + offset);
  784. } while (type);
  785. exit_irq:
  786. read_unlock_irqrestore(&gpii->pm_lock, flags);
  787. return IRQ_HANDLED;
  788. }
  789. /* process DMA Immediate completion data events */
  790. static void gpi_process_imed_data_event(struct gchan *gchan,
  791. struct immediate_data_event *imed_event)
  792. {
  793. struct gpii *gpii = gchan->gpii;
  794. struct gpi_ring *ch_ring = &gchan->ch_ring;
  795. void *tre = ch_ring->base + (ch_ring->el_size * imed_event->tre_index);
  796. struct dmaengine_result result;
  797. struct gpi_desc *gpi_desc;
  798. struct virt_dma_desc *vd;
  799. unsigned long flags;
  800. u32 chid;
  801. /*
  802. * If channel not active don't process event
  803. */
  804. if (gchan->pm_state != ACTIVE_STATE) {
  805. dev_err(gpii->gpi_dev->dev, "skipping processing event because ch @ %s state\n",
  806. TO_GPI_PM_STR(gchan->pm_state));
  807. return;
  808. }
  809. spin_lock_irqsave(&gchan->vc.lock, flags);
  810. vd = vchan_next_desc(&gchan->vc);
  811. if (!vd) {
  812. struct gpi_ere *gpi_ere;
  813. struct gpi_tre *gpi_tre;
  814. spin_unlock_irqrestore(&gchan->vc.lock, flags);
  815. dev_dbg(gpii->gpi_dev->dev, "event without a pending descriptor!\n");
  816. gpi_ere = (struct gpi_ere *)imed_event;
  817. dev_dbg(gpii->gpi_dev->dev,
  818. "Event: %08x %08x %08x %08x\n",
  819. gpi_ere->dword[0], gpi_ere->dword[1],
  820. gpi_ere->dword[2], gpi_ere->dword[3]);
  821. gpi_tre = tre;
  822. dev_dbg(gpii->gpi_dev->dev,
  823. "Pending TRE: %08x %08x %08x %08x\n",
  824. gpi_tre->dword[0], gpi_tre->dword[1],
  825. gpi_tre->dword[2], gpi_tre->dword[3]);
  826. return;
  827. }
  828. gpi_desc = to_gpi_desc(vd);
  829. spin_unlock_irqrestore(&gchan->vc.lock, flags);
  830. /*
  831. * RP pointed by Event is to last TRE processed,
  832. * we need to update ring rp to tre + 1
  833. */
  834. tre += ch_ring->el_size;
  835. if (tre >= (ch_ring->base + ch_ring->len))
  836. tre = ch_ring->base;
  837. ch_ring->rp = tre;
  838. /* make sure rp updates are immediately visible to all cores */
  839. smp_wmb();
  840. chid = imed_event->chid;
  841. if (imed_event->code == MSM_GPI_TCE_EOT && gpii->ieob_set) {
  842. if (chid == GPI_RX_CHAN)
  843. goto gpi_free_desc;
  844. else
  845. return;
  846. }
  847. if (imed_event->code == MSM_GPI_TCE_UNEXP_ERR)
  848. result.result = DMA_TRANS_ABORTED;
  849. else
  850. result.result = DMA_TRANS_NOERROR;
  851. result.residue = gpi_desc->len - imed_event->length;
  852. dma_cookie_complete(&vd->tx);
  853. dmaengine_desc_get_callback_invoke(&vd->tx, &result);
  854. gpi_free_desc:
  855. spin_lock_irqsave(&gchan->vc.lock, flags);
  856. list_del(&vd->node);
  857. spin_unlock_irqrestore(&gchan->vc.lock, flags);
  858. kfree(gpi_desc);
  859. gpi_desc = NULL;
  860. }
  861. /* processing transfer completion events */
  862. static void gpi_process_xfer_compl_event(struct gchan *gchan,
  863. struct xfer_compl_event *compl_event)
  864. {
  865. struct gpii *gpii = gchan->gpii;
  866. struct gpi_ring *ch_ring = &gchan->ch_ring;
  867. void *ev_rp = to_virtual(ch_ring, compl_event->ptr);
  868. struct virt_dma_desc *vd;
  869. struct gpi_desc *gpi_desc;
  870. struct dmaengine_result result;
  871. unsigned long flags;
  872. u32 chid;
  873. /* only process events on active channel */
  874. if (unlikely(gchan->pm_state != ACTIVE_STATE)) {
  875. dev_err(gpii->gpi_dev->dev, "skipping processing event because ch @ %s state\n",
  876. TO_GPI_PM_STR(gchan->pm_state));
  877. return;
  878. }
  879. spin_lock_irqsave(&gchan->vc.lock, flags);
  880. vd = vchan_next_desc(&gchan->vc);
  881. if (!vd) {
  882. struct gpi_ere *gpi_ere;
  883. spin_unlock_irqrestore(&gchan->vc.lock, flags);
  884. dev_err(gpii->gpi_dev->dev, "Event without a pending descriptor!\n");
  885. gpi_ere = (struct gpi_ere *)compl_event;
  886. dev_err(gpii->gpi_dev->dev,
  887. "Event: %08x %08x %08x %08x\n",
  888. gpi_ere->dword[0], gpi_ere->dword[1],
  889. gpi_ere->dword[2], gpi_ere->dword[3]);
  890. return;
  891. }
  892. gpi_desc = to_gpi_desc(vd);
  893. spin_unlock_irqrestore(&gchan->vc.lock, flags);
  894. /*
  895. * RP pointed by Event is to last TRE processed,
  896. * we need to update ring rp to ev_rp + 1
  897. */
  898. ev_rp += ch_ring->el_size;
  899. if (ev_rp >= (ch_ring->base + ch_ring->len))
  900. ev_rp = ch_ring->base;
  901. ch_ring->rp = ev_rp;
  902. /* update must be visible to other cores */
  903. smp_wmb();
  904. chid = compl_event->chid;
  905. if (compl_event->code == MSM_GPI_TCE_EOT && gpii->ieob_set) {
  906. if (chid == GPI_RX_CHAN)
  907. goto gpi_free_desc;
  908. else
  909. return;
  910. }
  911. if (compl_event->code == MSM_GPI_TCE_UNEXP_ERR) {
  912. dev_err(gpii->gpi_dev->dev, "Error in Transaction\n");
  913. result.result = DMA_TRANS_ABORTED;
  914. } else {
  915. dev_dbg(gpii->gpi_dev->dev, "Transaction Success\n");
  916. result.result = DMA_TRANS_NOERROR;
  917. }
  918. result.residue = gpi_desc->len - compl_event->length;
  919. dev_dbg(gpii->gpi_dev->dev, "Residue %d\n", result.residue);
  920. dma_cookie_complete(&vd->tx);
  921. dmaengine_desc_get_callback_invoke(&vd->tx, &result);
  922. gpi_free_desc:
  923. spin_lock_irqsave(&gchan->vc.lock, flags);
  924. list_del(&vd->node);
  925. spin_unlock_irqrestore(&gchan->vc.lock, flags);
  926. kfree(gpi_desc);
  927. gpi_desc = NULL;
  928. }
  929. /* process all events */
  930. static void gpi_process_events(struct gpii *gpii)
  931. {
  932. struct gpi_ring *ev_ring = &gpii->ev_ring;
  933. phys_addr_t cntxt_rp;
  934. void *rp;
  935. union gpi_event *gpi_event;
  936. struct gchan *gchan;
  937. u32 chid, type;
  938. cntxt_rp = gpi_read_reg(gpii, gpii->ev_ring_rp_lsb_reg);
  939. rp = to_virtual(ev_ring, cntxt_rp);
  940. do {
  941. while (rp != ev_ring->rp) {
  942. gpi_event = ev_ring->rp;
  943. chid = gpi_event->xfer_compl_event.chid;
  944. type = gpi_event->xfer_compl_event.type;
  945. dev_dbg(gpii->gpi_dev->dev,
  946. "Event: CHID:%u, type:%x %08x %08x %08x %08x\n",
  947. chid, type, gpi_event->gpi_ere.dword[0],
  948. gpi_event->gpi_ere.dword[1], gpi_event->gpi_ere.dword[2],
  949. gpi_event->gpi_ere.dword[3]);
  950. switch (type) {
  951. case XFER_COMPLETE_EV_TYPE:
  952. gchan = &gpii->gchan[chid];
  953. gpi_process_xfer_compl_event(gchan,
  954. &gpi_event->xfer_compl_event);
  955. break;
  956. case STALE_EV_TYPE:
  957. dev_dbg(gpii->gpi_dev->dev, "stale event, not processing\n");
  958. break;
  959. case IMMEDIATE_DATA_EV_TYPE:
  960. gchan = &gpii->gchan[chid];
  961. gpi_process_imed_data_event(gchan,
  962. &gpi_event->immediate_data_event);
  963. break;
  964. case QUP_NOTIF_EV_TYPE:
  965. dev_dbg(gpii->gpi_dev->dev, "QUP_NOTIF_EV_TYPE\n");
  966. break;
  967. default:
  968. dev_dbg(gpii->gpi_dev->dev,
  969. "not supported event type:0x%x\n", type);
  970. }
  971. gpi_ring_recycle_ev_element(ev_ring);
  972. }
  973. gpi_write_ev_db(gpii, ev_ring, ev_ring->wp);
  974. /* clear pending IEOB events */
  975. gpi_write_reg(gpii, gpii->ieob_clr_reg, BIT(0));
  976. cntxt_rp = gpi_read_reg(gpii, gpii->ev_ring_rp_lsb_reg);
  977. rp = to_virtual(ev_ring, cntxt_rp);
  978. } while (rp != ev_ring->rp);
  979. }
  980. /* processing events using tasklet */
  981. static void gpi_ev_tasklet(unsigned long data)
  982. {
  983. struct gpii *gpii = (struct gpii *)data;
  984. read_lock(&gpii->pm_lock);
  985. if (!REG_ACCESS_VALID(gpii->pm_state)) {
  986. read_unlock(&gpii->pm_lock);
  987. dev_err(gpii->gpi_dev->dev, "not processing any events, pm_state:%s\n",
  988. TO_GPI_PM_STR(gpii->pm_state));
  989. return;
  990. }
  991. /* process the events */
  992. gpi_process_events(gpii);
  993. /* enable IEOB, switching back to interrupts */
  994. gpi_config_interrupts(gpii, MASK_IEOB_SETTINGS, 1);
  995. read_unlock(&gpii->pm_lock);
  996. }
  997. /* marks all pending events for the channel as stale */
  998. static void gpi_mark_stale_events(struct gchan *gchan)
  999. {
  1000. struct gpii *gpii = gchan->gpii;
  1001. struct gpi_ring *ev_ring = &gpii->ev_ring;
  1002. u32 cntxt_rp, local_rp;
  1003. void *ev_rp;
  1004. cntxt_rp = gpi_read_reg(gpii, gpii->ev_ring_rp_lsb_reg);
  1005. ev_rp = ev_ring->rp;
  1006. local_rp = (u32)to_physical(ev_ring, ev_rp);
  1007. while (local_rp != cntxt_rp) {
  1008. union gpi_event *gpi_event = ev_rp;
  1009. u32 chid = gpi_event->xfer_compl_event.chid;
  1010. if (chid == gchan->chid)
  1011. gpi_event->xfer_compl_event.type = STALE_EV_TYPE;
  1012. ev_rp += ev_ring->el_size;
  1013. if (ev_rp >= (ev_ring->base + ev_ring->len))
  1014. ev_rp = ev_ring->base;
  1015. cntxt_rp = gpi_read_reg(gpii, gpii->ev_ring_rp_lsb_reg);
  1016. local_rp = (u32)to_physical(ev_ring, ev_rp);
  1017. }
  1018. }
  1019. /* reset sw state and issue channel reset or de-alloc */
  1020. static int gpi_reset_chan(struct gchan *gchan, enum gpi_cmd gpi_cmd)
  1021. {
  1022. struct gpii *gpii = gchan->gpii;
  1023. struct gpi_ring *ch_ring = &gchan->ch_ring;
  1024. LIST_HEAD(list);
  1025. int ret;
  1026. ret = gpi_send_cmd(gpii, gchan, gpi_cmd);
  1027. if (ret) {
  1028. dev_err(gpii->gpi_dev->dev, "Error with cmd:%s ret:%d\n",
  1029. TO_GPI_CMD_STR(gpi_cmd), ret);
  1030. return ret;
  1031. }
  1032. /* initialize the local ring ptrs */
  1033. ch_ring->rp = ch_ring->base;
  1034. ch_ring->wp = ch_ring->base;
  1035. /* visible to other cores */
  1036. smp_wmb();
  1037. /* check event ring for any stale events */
  1038. write_lock_irq(&gpii->pm_lock);
  1039. gpi_mark_stale_events(gchan);
  1040. /* remove all async descriptors */
  1041. spin_lock(&gchan->vc.lock);
  1042. vchan_get_all_descriptors(&gchan->vc, &list);
  1043. spin_unlock(&gchan->vc.lock);
  1044. write_unlock_irq(&gpii->pm_lock);
  1045. vchan_dma_desc_free_list(&gchan->vc, &list);
  1046. return 0;
  1047. }
  1048. static int gpi_start_chan(struct gchan *gchan)
  1049. {
  1050. struct gpii *gpii = gchan->gpii;
  1051. int ret;
  1052. ret = gpi_send_cmd(gpii, gchan, GPI_CH_CMD_START);
  1053. if (ret) {
  1054. dev_err(gpii->gpi_dev->dev, "Error with cmd:%s ret:%d\n",
  1055. TO_GPI_CMD_STR(GPI_CH_CMD_START), ret);
  1056. return ret;
  1057. }
  1058. /* gpii CH is active now */
  1059. write_lock_irq(&gpii->pm_lock);
  1060. gchan->pm_state = ACTIVE_STATE;
  1061. write_unlock_irq(&gpii->pm_lock);
  1062. return 0;
  1063. }
  1064. static int gpi_stop_chan(struct gchan *gchan)
  1065. {
  1066. struct gpii *gpii = gchan->gpii;
  1067. int ret;
  1068. ret = gpi_send_cmd(gpii, gchan, GPI_CH_CMD_STOP);
  1069. if (ret) {
  1070. dev_err(gpii->gpi_dev->dev, "Error with cmd:%s ret:%d\n",
  1071. TO_GPI_CMD_STR(GPI_CH_CMD_STOP), ret);
  1072. return ret;
  1073. }
  1074. return 0;
  1075. }
  1076. /* allocate and configure the transfer channel */
  1077. static int gpi_alloc_chan(struct gchan *chan, bool send_alloc_cmd)
  1078. {
  1079. struct gpii *gpii = chan->gpii;
  1080. struct gpi_ring *ring = &chan->ch_ring;
  1081. int ret;
  1082. u32 id = gpii->gpii_id;
  1083. u32 chid = chan->chid;
  1084. u32 pair_chid = !chid;
  1085. if (send_alloc_cmd) {
  1086. ret = gpi_send_cmd(gpii, chan, GPI_CH_CMD_ALLOCATE);
  1087. if (ret) {
  1088. dev_err(gpii->gpi_dev->dev, "Error with cmd:%s ret:%d\n",
  1089. TO_GPI_CMD_STR(GPI_CH_CMD_ALLOCATE), ret);
  1090. return ret;
  1091. }
  1092. }
  1093. gpi_write_reg(gpii, chan->ch_cntxt_base_reg + CNTXT_0_CONFIG,
  1094. GPII_n_CH_k_CNTXT_0(ring->el_size, 0, chan->dir, GPI_CHTYPE_PROTO_GPI));
  1095. gpi_write_reg(gpii, chan->ch_cntxt_base_reg + CNTXT_1_R_LENGTH, ring->len);
  1096. gpi_write_reg(gpii, chan->ch_cntxt_base_reg + CNTXT_2_RING_BASE_LSB, ring->phys_addr);
  1097. gpi_write_reg(gpii, chan->ch_cntxt_base_reg + CNTXT_3_RING_BASE_MSB,
  1098. upper_32_bits(ring->phys_addr));
  1099. gpi_write_reg(gpii, chan->ch_cntxt_db_reg + CNTXT_5_RING_RP_MSB - CNTXT_4_RING_RP_LSB,
  1100. upper_32_bits(ring->phys_addr));
  1101. gpi_write_reg(gpii, gpii->regs + GPII_n_CH_k_SCRATCH_0_OFFS(id, chid),
  1102. GPII_n_CH_k_SCRATCH_0(pair_chid, chan->protocol, chan->seid));
  1103. gpi_write_reg(gpii, gpii->regs + GPII_n_CH_k_SCRATCH_1_OFFS(id, chid), 0);
  1104. gpi_write_reg(gpii, gpii->regs + GPII_n_CH_k_SCRATCH_2_OFFS(id, chid), 0);
  1105. gpi_write_reg(gpii, gpii->regs + GPII_n_CH_k_SCRATCH_3_OFFS(id, chid), 0);
  1106. gpi_write_reg(gpii, gpii->regs + GPII_n_CH_k_QOS_OFFS(id, chid), 1);
  1107. /* flush all the writes */
  1108. wmb();
  1109. return 0;
  1110. }
  1111. /* allocate and configure event ring */
  1112. static int gpi_alloc_ev_chan(struct gpii *gpii)
  1113. {
  1114. struct gpi_ring *ring = &gpii->ev_ring;
  1115. void __iomem *base = gpii->ev_cntxt_base_reg;
  1116. int ret;
  1117. ret = gpi_send_cmd(gpii, NULL, GPI_EV_CMD_ALLOCATE);
  1118. if (ret) {
  1119. dev_err(gpii->gpi_dev->dev, "error with cmd:%s ret:%d\n",
  1120. TO_GPI_CMD_STR(GPI_EV_CMD_ALLOCATE), ret);
  1121. return ret;
  1122. }
  1123. /* program event context */
  1124. gpi_write_reg(gpii, base + CNTXT_0_CONFIG,
  1125. GPII_n_EV_k_CNTXT_0(ring->el_size, GPI_INTTYPE_IRQ, GPI_CHTYPE_GPI_EV));
  1126. gpi_write_reg(gpii, base + CNTXT_1_R_LENGTH, ring->len);
  1127. gpi_write_reg(gpii, base + CNTXT_2_RING_BASE_LSB, lower_32_bits(ring->phys_addr));
  1128. gpi_write_reg(gpii, base + CNTXT_3_RING_BASE_MSB, upper_32_bits(ring->phys_addr));
  1129. gpi_write_reg(gpii, gpii->ev_cntxt_db_reg + CNTXT_5_RING_RP_MSB - CNTXT_4_RING_RP_LSB,
  1130. upper_32_bits(ring->phys_addr));
  1131. gpi_write_reg(gpii, base + CNTXT_8_RING_INT_MOD, 0);
  1132. gpi_write_reg(gpii, base + CNTXT_10_RING_MSI_LSB, 0);
  1133. gpi_write_reg(gpii, base + CNTXT_11_RING_MSI_MSB, 0);
  1134. gpi_write_reg(gpii, base + CNTXT_8_RING_INT_MOD, 0);
  1135. gpi_write_reg(gpii, base + CNTXT_12_RING_RP_UPDATE_LSB, 0);
  1136. gpi_write_reg(gpii, base + CNTXT_13_RING_RP_UPDATE_MSB, 0);
  1137. /* add events to ring */
  1138. ring->wp = (ring->base + ring->len - ring->el_size);
  1139. /* flush all the writes */
  1140. wmb();
  1141. /* gpii is active now */
  1142. write_lock_irq(&gpii->pm_lock);
  1143. gpii->pm_state = ACTIVE_STATE;
  1144. write_unlock_irq(&gpii->pm_lock);
  1145. gpi_write_ev_db(gpii, ring, ring->wp);
  1146. return 0;
  1147. }
  1148. /* calculate # of ERE/TRE available to queue */
  1149. static int gpi_ring_num_elements_avail(const struct gpi_ring * const ring)
  1150. {
  1151. int elements = 0;
  1152. if (ring->wp < ring->rp) {
  1153. elements = ((ring->rp - ring->wp) / ring->el_size) - 1;
  1154. } else {
  1155. elements = (ring->rp - ring->base) / ring->el_size;
  1156. elements += ((ring->base + ring->len - ring->wp) / ring->el_size) - 1;
  1157. }
  1158. return elements;
  1159. }
  1160. static int gpi_ring_add_element(struct gpi_ring *ring, void **wp)
  1161. {
  1162. if (gpi_ring_num_elements_avail(ring) <= 0)
  1163. return -ENOMEM;
  1164. *wp = ring->wp;
  1165. ring->wp += ring->el_size;
  1166. if (ring->wp >= (ring->base + ring->len))
  1167. ring->wp = ring->base;
  1168. /* visible to other cores */
  1169. smp_wmb();
  1170. return 0;
  1171. }
  1172. static void gpi_ring_recycle_ev_element(struct gpi_ring *ring)
  1173. {
  1174. /* Update the WP */
  1175. ring->wp += ring->el_size;
  1176. if (ring->wp >= (ring->base + ring->len))
  1177. ring->wp = ring->base;
  1178. /* Update the RP */
  1179. ring->rp += ring->el_size;
  1180. if (ring->rp >= (ring->base + ring->len))
  1181. ring->rp = ring->base;
  1182. /* visible to other cores */
  1183. smp_wmb();
  1184. }
  1185. static void gpi_free_ring(struct gpi_ring *ring,
  1186. struct gpii *gpii)
  1187. {
  1188. dma_free_coherent(gpii->gpi_dev->dev, ring->alloc_size,
  1189. ring->pre_aligned, ring->dma_handle);
  1190. memset(ring, 0, sizeof(*ring));
  1191. }
  1192. /* allocate memory for transfer and event rings */
  1193. static int gpi_alloc_ring(struct gpi_ring *ring, u32 elements,
  1194. u32 el_size, struct gpii *gpii)
  1195. {
  1196. u64 len = elements * el_size;
  1197. int bit;
  1198. /* ring len must be power of 2 */
  1199. bit = find_last_bit((unsigned long *)&len, 32);
  1200. if (((1 << bit) - 1) & len)
  1201. bit++;
  1202. len = 1 << bit;
  1203. ring->alloc_size = (len + (len - 1));
  1204. dev_dbg(gpii->gpi_dev->dev,
  1205. "#el:%u el_size:%u len:%u actual_len:%llu alloc_size:%zu\n",
  1206. elements, el_size, (elements * el_size), len,
  1207. ring->alloc_size);
  1208. ring->pre_aligned = dma_alloc_coherent(gpii->gpi_dev->dev,
  1209. ring->alloc_size,
  1210. &ring->dma_handle, GFP_KERNEL);
  1211. if (!ring->pre_aligned) {
  1212. dev_err(gpii->gpi_dev->dev, "could not alloc size:%zu mem for ring\n",
  1213. ring->alloc_size);
  1214. return -ENOMEM;
  1215. }
  1216. /* align the physical mem */
  1217. ring->phys_addr = (ring->dma_handle + (len - 1)) & ~(len - 1);
  1218. ring->base = ring->pre_aligned + (ring->phys_addr - ring->dma_handle);
  1219. ring->rp = ring->base;
  1220. ring->wp = ring->base;
  1221. ring->len = len;
  1222. ring->el_size = el_size;
  1223. ring->elements = ring->len / ring->el_size;
  1224. memset(ring->base, 0, ring->len);
  1225. ring->configured = true;
  1226. /* update to other cores */
  1227. smp_wmb();
  1228. dev_dbg(gpii->gpi_dev->dev,
  1229. "phy_pre:%pad phy_alig:%pa len:%u el_size:%u elements:%u\n",
  1230. &ring->dma_handle, &ring->phys_addr, ring->len,
  1231. ring->el_size, ring->elements);
  1232. return 0;
  1233. }
  1234. /* copy tre into transfer ring */
  1235. static void gpi_queue_xfer(struct gpii *gpii, struct gchan *gchan,
  1236. struct gpi_tre *gpi_tre, void **wp)
  1237. {
  1238. struct gpi_tre *ch_tre;
  1239. int ret;
  1240. /* get next tre location we can copy */
  1241. ret = gpi_ring_add_element(&gchan->ch_ring, (void **)&ch_tre);
  1242. if (unlikely(ret)) {
  1243. dev_err(gpii->gpi_dev->dev, "Error adding ring element to xfer ring\n");
  1244. return;
  1245. }
  1246. /* copy the tre info */
  1247. memcpy(ch_tre, gpi_tre, sizeof(*ch_tre));
  1248. *wp = ch_tre;
  1249. }
  1250. /* reset and restart transfer channel */
  1251. static int gpi_terminate_all(struct dma_chan *chan)
  1252. {
  1253. struct gchan *gchan = to_gchan(chan);
  1254. struct gpii *gpii = gchan->gpii;
  1255. int schid, echid, i;
  1256. int ret = 0;
  1257. mutex_lock(&gpii->ctrl_lock);
  1258. /*
  1259. * treat both channels as a group if its protocol is not UART
  1260. * STOP, RESET, or START needs to be in lockstep
  1261. */
  1262. schid = (gchan->protocol == QCOM_GPI_UART) ? gchan->chid : 0;
  1263. echid = (gchan->protocol == QCOM_GPI_UART) ? schid + 1 : MAX_CHANNELS_PER_GPII;
  1264. /* stop the channel */
  1265. for (i = schid; i < echid; i++) {
  1266. gchan = &gpii->gchan[i];
  1267. /* disable ch state so no more TRE processing */
  1268. write_lock_irq(&gpii->pm_lock);
  1269. gchan->pm_state = PREPARE_TERMINATE;
  1270. write_unlock_irq(&gpii->pm_lock);
  1271. /* send command to Stop the channel */
  1272. ret = gpi_stop_chan(gchan);
  1273. }
  1274. /* reset the channels (clears any pending tre) */
  1275. for (i = schid; i < echid; i++) {
  1276. gchan = &gpii->gchan[i];
  1277. ret = gpi_reset_chan(gchan, GPI_CH_CMD_RESET);
  1278. if (ret) {
  1279. dev_err(gpii->gpi_dev->dev, "Error resetting channel ret:%d\n", ret);
  1280. goto terminate_exit;
  1281. }
  1282. /* reprogram channel CNTXT */
  1283. ret = gpi_alloc_chan(gchan, false);
  1284. if (ret) {
  1285. dev_err(gpii->gpi_dev->dev, "Error alloc_channel ret:%d\n", ret);
  1286. goto terminate_exit;
  1287. }
  1288. }
  1289. /* restart the channels */
  1290. for (i = schid; i < echid; i++) {
  1291. gchan = &gpii->gchan[i];
  1292. ret = gpi_start_chan(gchan);
  1293. if (ret) {
  1294. dev_err(gpii->gpi_dev->dev, "Error Starting Channel ret:%d\n", ret);
  1295. goto terminate_exit;
  1296. }
  1297. }
  1298. terminate_exit:
  1299. mutex_unlock(&gpii->ctrl_lock);
  1300. return ret;
  1301. }
  1302. /* pause dma transfer for all channels */
  1303. static int gpi_pause(struct dma_chan *chan)
  1304. {
  1305. struct gchan *gchan = to_gchan(chan);
  1306. struct gpii *gpii = gchan->gpii;
  1307. int i, ret;
  1308. mutex_lock(&gpii->ctrl_lock);
  1309. /*
  1310. * pause/resume are per gpii not per channel, so
  1311. * client needs to call pause only once
  1312. */
  1313. if (gpii->pm_state == PAUSE_STATE) {
  1314. dev_dbg(gpii->gpi_dev->dev, "channel is already paused\n");
  1315. mutex_unlock(&gpii->ctrl_lock);
  1316. return 0;
  1317. }
  1318. /* send stop command to stop the channels */
  1319. for (i = 0; i < MAX_CHANNELS_PER_GPII; i++) {
  1320. ret = gpi_stop_chan(&gpii->gchan[i]);
  1321. if (ret) {
  1322. mutex_unlock(&gpii->ctrl_lock);
  1323. return ret;
  1324. }
  1325. }
  1326. disable_irq(gpii->irq);
  1327. /* Wait for threads to complete out */
  1328. tasklet_kill(&gpii->ev_task);
  1329. write_lock_irq(&gpii->pm_lock);
  1330. gpii->pm_state = PAUSE_STATE;
  1331. write_unlock_irq(&gpii->pm_lock);
  1332. mutex_unlock(&gpii->ctrl_lock);
  1333. return 0;
  1334. }
  1335. /* resume dma transfer */
  1336. static int gpi_resume(struct dma_chan *chan)
  1337. {
  1338. struct gchan *gchan = to_gchan(chan);
  1339. struct gpii *gpii = gchan->gpii;
  1340. int i, ret;
  1341. mutex_lock(&gpii->ctrl_lock);
  1342. if (gpii->pm_state == ACTIVE_STATE) {
  1343. dev_dbg(gpii->gpi_dev->dev, "channel is already active\n");
  1344. mutex_unlock(&gpii->ctrl_lock);
  1345. return 0;
  1346. }
  1347. enable_irq(gpii->irq);
  1348. /* send start command to start the channels */
  1349. for (i = 0; i < MAX_CHANNELS_PER_GPII; i++) {
  1350. ret = gpi_send_cmd(gpii, &gpii->gchan[i], GPI_CH_CMD_START);
  1351. if (ret) {
  1352. dev_err(gpii->gpi_dev->dev, "Error starting chan, ret:%d\n", ret);
  1353. mutex_unlock(&gpii->ctrl_lock);
  1354. return ret;
  1355. }
  1356. }
  1357. write_lock_irq(&gpii->pm_lock);
  1358. gpii->pm_state = ACTIVE_STATE;
  1359. write_unlock_irq(&gpii->pm_lock);
  1360. mutex_unlock(&gpii->ctrl_lock);
  1361. return 0;
  1362. }
  1363. static void gpi_desc_free(struct virt_dma_desc *vd)
  1364. {
  1365. struct gpi_desc *gpi_desc = to_gpi_desc(vd);
  1366. kfree(gpi_desc);
  1367. gpi_desc = NULL;
  1368. }
  1369. static int
  1370. gpi_peripheral_config(struct dma_chan *chan, struct dma_slave_config *config)
  1371. {
  1372. struct gchan *gchan = to_gchan(chan);
  1373. if (!config->peripheral_config)
  1374. return -EINVAL;
  1375. gchan->config = krealloc(gchan->config, config->peripheral_size, GFP_NOWAIT);
  1376. if (!gchan->config)
  1377. return -ENOMEM;
  1378. memcpy(gchan->config, config->peripheral_config, config->peripheral_size);
  1379. return 0;
  1380. }
  1381. static int gpi_create_i2c_tre(struct gchan *chan, struct gpi_desc *desc,
  1382. struct scatterlist *sgl, enum dma_transfer_direction direction)
  1383. {
  1384. struct gpi_i2c_config *i2c = chan->config;
  1385. struct device *dev = chan->gpii->gpi_dev->dev;
  1386. unsigned int tre_idx = 0;
  1387. dma_addr_t address;
  1388. struct gpi_tre *tre;
  1389. unsigned int i;
  1390. /* first create config tre if applicable */
  1391. if (i2c->set_config) {
  1392. tre = &desc->tre[tre_idx];
  1393. tre_idx++;
  1394. tre->dword[0] = u32_encode_bits(i2c->low_count, TRE_I2C_C0_TLOW);
  1395. tre->dword[0] |= u32_encode_bits(i2c->high_count, TRE_I2C_C0_THIGH);
  1396. tre->dword[0] |= u32_encode_bits(i2c->cycle_count, TRE_I2C_C0_TCYL);
  1397. tre->dword[0] |= u32_encode_bits(i2c->pack_enable, TRE_I2C_C0_TX_PACK);
  1398. tre->dword[0] |= u32_encode_bits(i2c->pack_enable, TRE_I2C_C0_RX_PACK);
  1399. tre->dword[1] = 0;
  1400. tre->dword[2] = u32_encode_bits(i2c->clk_div, TRE_C0_CLK_DIV);
  1401. tre->dword[3] = u32_encode_bits(TRE_TYPE_CONFIG0, TRE_FLAGS_TYPE);
  1402. tre->dword[3] |= u32_encode_bits(1, TRE_FLAGS_CHAIN);
  1403. }
  1404. /* create the GO tre for Tx */
  1405. if (i2c->op == I2C_WRITE) {
  1406. tre = &desc->tre[tre_idx];
  1407. tre_idx++;
  1408. if (i2c->multi_msg)
  1409. tre->dword[0] = u32_encode_bits(I2C_READ, TRE_I2C_GO_CMD);
  1410. else
  1411. tre->dword[0] = u32_encode_bits(i2c->op, TRE_I2C_GO_CMD);
  1412. tre->dword[0] |= u32_encode_bits(i2c->addr, TRE_I2C_GO_ADDR);
  1413. tre->dword[0] |= u32_encode_bits(i2c->stretch, TRE_I2C_GO_STRETCH);
  1414. tre->dword[1] = 0;
  1415. tre->dword[2] = u32_encode_bits(i2c->rx_len, TRE_RX_LEN);
  1416. tre->dword[3] = u32_encode_bits(TRE_TYPE_GO, TRE_FLAGS_TYPE);
  1417. if (i2c->multi_msg)
  1418. tre->dword[3] |= u32_encode_bits(1, TRE_FLAGS_LINK);
  1419. else
  1420. tre->dword[3] |= u32_encode_bits(1, TRE_FLAGS_CHAIN);
  1421. }
  1422. if (i2c->op == I2C_READ || i2c->multi_msg == false) {
  1423. /* create the DMA TRE */
  1424. tre = &desc->tre[tre_idx];
  1425. tre_idx++;
  1426. address = sg_dma_address(sgl);
  1427. tre->dword[0] = lower_32_bits(address);
  1428. tre->dword[1] = upper_32_bits(address);
  1429. tre->dword[2] = u32_encode_bits(sg_dma_len(sgl), TRE_DMA_LEN);
  1430. tre->dword[3] = u32_encode_bits(TRE_TYPE_DMA, TRE_FLAGS_TYPE);
  1431. tre->dword[3] |= u32_encode_bits(1, TRE_FLAGS_IEOT);
  1432. }
  1433. for (i = 0; i < tre_idx; i++)
  1434. dev_dbg(dev, "TRE:%d %x:%x:%x:%x\n", i, desc->tre[i].dword[0],
  1435. desc->tre[i].dword[1], desc->tre[i].dword[2], desc->tre[i].dword[3]);
  1436. return tre_idx;
  1437. }
  1438. static int gpi_create_spi_tre(struct gchan *chan, struct gpi_desc *desc,
  1439. struct scatterlist *sgl, enum dma_transfer_direction direction)
  1440. {
  1441. struct gpi_spi_config *spi = chan->config;
  1442. struct device *dev = chan->gpii->gpi_dev->dev;
  1443. unsigned int tre_idx = 0;
  1444. dma_addr_t address;
  1445. struct gpi_tre *tre;
  1446. unsigned int i;
  1447. /* first create config tre if applicable */
  1448. if (direction == DMA_MEM_TO_DEV && spi->set_config) {
  1449. tre = &desc->tre[tre_idx];
  1450. tre_idx++;
  1451. tre->dword[0] = u32_encode_bits(spi->word_len, TRE_SPI_C0_WORD_SZ);
  1452. tre->dword[0] |= u32_encode_bits(spi->loopback_en, TRE_SPI_C0_LOOPBACK);
  1453. tre->dword[0] |= u32_encode_bits(spi->clock_pol_high, TRE_SPI_C0_CPOL);
  1454. tre->dword[0] |= u32_encode_bits(spi->data_pol_high, TRE_SPI_C0_CPHA);
  1455. tre->dword[0] |= u32_encode_bits(spi->pack_en, TRE_SPI_C0_TX_PACK);
  1456. tre->dword[0] |= u32_encode_bits(spi->pack_en, TRE_SPI_C0_RX_PACK);
  1457. tre->dword[1] = 0;
  1458. tre->dword[2] = u32_encode_bits(spi->clk_div, TRE_C0_CLK_DIV);
  1459. tre->dword[2] |= u32_encode_bits(spi->clk_src, TRE_C0_CLK_SRC);
  1460. tre->dword[3] = u32_encode_bits(TRE_TYPE_CONFIG0, TRE_FLAGS_TYPE);
  1461. tre->dword[3] |= u32_encode_bits(1, TRE_FLAGS_CHAIN);
  1462. }
  1463. /* create the GO tre for Tx */
  1464. if (direction == DMA_MEM_TO_DEV) {
  1465. tre = &desc->tre[tre_idx];
  1466. tre_idx++;
  1467. tre->dword[0] = u32_encode_bits(spi->fragmentation, TRE_SPI_GO_FRAG);
  1468. tre->dword[0] |= u32_encode_bits(spi->cs, TRE_SPI_GO_CS);
  1469. tre->dword[0] |= u32_encode_bits(spi->cmd, TRE_SPI_GO_CMD);
  1470. tre->dword[1] = 0;
  1471. tre->dword[2] = u32_encode_bits(spi->rx_len, TRE_RX_LEN);
  1472. tre->dword[3] = u32_encode_bits(TRE_TYPE_GO, TRE_FLAGS_TYPE);
  1473. if (spi->cmd == SPI_RX) {
  1474. tre->dword[3] |= u32_encode_bits(1, TRE_FLAGS_IEOB);
  1475. tre->dword[3] |= u32_encode_bits(1, TRE_FLAGS_LINK);
  1476. } else if (spi->cmd == SPI_TX) {
  1477. tre->dword[3] |= u32_encode_bits(1, TRE_FLAGS_CHAIN);
  1478. } else { /* SPI_DUPLEX */
  1479. tre->dword[3] |= u32_encode_bits(1, TRE_FLAGS_CHAIN);
  1480. tre->dword[3] |= u32_encode_bits(1, TRE_FLAGS_LINK);
  1481. }
  1482. }
  1483. /* create the dma tre */
  1484. tre = &desc->tre[tre_idx];
  1485. tre_idx++;
  1486. address = sg_dma_address(sgl);
  1487. tre->dword[0] = lower_32_bits(address);
  1488. tre->dword[1] = upper_32_bits(address);
  1489. tre->dword[2] = u32_encode_bits(sg_dma_len(sgl), TRE_DMA_LEN);
  1490. tre->dword[3] = u32_encode_bits(TRE_TYPE_DMA, TRE_FLAGS_TYPE);
  1491. if (direction == DMA_MEM_TO_DEV)
  1492. tre->dword[3] |= u32_encode_bits(1, TRE_FLAGS_IEOT);
  1493. for (i = 0; i < tre_idx; i++)
  1494. dev_dbg(dev, "TRE:%d %x:%x:%x:%x\n", i, desc->tre[i].dword[0],
  1495. desc->tre[i].dword[1], desc->tre[i].dword[2], desc->tre[i].dword[3]);
  1496. return tre_idx;
  1497. }
  1498. /* copy tre into transfer ring */
  1499. static struct dma_async_tx_descriptor *
  1500. gpi_prep_slave_sg(struct dma_chan *chan, struct scatterlist *sgl,
  1501. unsigned int sg_len, enum dma_transfer_direction direction,
  1502. unsigned long flags, void *context)
  1503. {
  1504. struct gchan *gchan = to_gchan(chan);
  1505. struct gpii *gpii = gchan->gpii;
  1506. struct device *dev = gpii->gpi_dev->dev;
  1507. struct gpi_ring *ch_ring = &gchan->ch_ring;
  1508. struct gpi_desc *gpi_desc;
  1509. u32 nr, nr_tre = 0;
  1510. u8 set_config;
  1511. int i;
  1512. gpii->ieob_set = false;
  1513. if (!is_slave_direction(direction)) {
  1514. dev_err(gpii->gpi_dev->dev, "invalid dma direction: %d\n", direction);
  1515. return NULL;
  1516. }
  1517. if (sg_len > 1) {
  1518. dev_err(dev, "Multi sg sent, we support only one atm: %d\n", sg_len);
  1519. return NULL;
  1520. }
  1521. nr_tre = 3;
  1522. set_config = *(u32 *)gchan->config;
  1523. if (!set_config)
  1524. nr_tre = 2;
  1525. if (direction == DMA_DEV_TO_MEM) /* rx */
  1526. nr_tre = 1;
  1527. /* calculate # of elements required & available */
  1528. nr = gpi_ring_num_elements_avail(ch_ring);
  1529. if (nr < nr_tre) {
  1530. dev_err(dev, "not enough space in ring, avail:%u required:%u\n", nr, nr_tre);
  1531. return NULL;
  1532. }
  1533. gpi_desc = kzalloc(sizeof(*gpi_desc), GFP_NOWAIT);
  1534. if (!gpi_desc)
  1535. return NULL;
  1536. /* create TREs for xfer */
  1537. if (gchan->protocol == QCOM_GPI_SPI) {
  1538. i = gpi_create_spi_tre(gchan, gpi_desc, sgl, direction);
  1539. } else if (gchan->protocol == QCOM_GPI_I2C) {
  1540. i = gpi_create_i2c_tre(gchan, gpi_desc, sgl, direction);
  1541. } else {
  1542. dev_err(dev, "invalid peripheral: %d\n", gchan->protocol);
  1543. kfree(gpi_desc);
  1544. return NULL;
  1545. }
  1546. /* set up the descriptor */
  1547. gpi_desc->gchan = gchan;
  1548. gpi_desc->len = sg_dma_len(sgl);
  1549. gpi_desc->num_tre = i;
  1550. return vchan_tx_prep(&gchan->vc, &gpi_desc->vd, flags);
  1551. }
  1552. /* rings transfer ring db to being transfer */
  1553. static void gpi_issue_pending(struct dma_chan *chan)
  1554. {
  1555. struct gchan *gchan = to_gchan(chan);
  1556. struct gpii *gpii = gchan->gpii;
  1557. unsigned long flags, pm_lock_flags;
  1558. struct virt_dma_desc *vd = NULL;
  1559. struct gpi_desc *gpi_desc;
  1560. struct gpi_ring *ch_ring = &gchan->ch_ring;
  1561. void *tre, *wp = NULL;
  1562. int i;
  1563. read_lock_irqsave(&gpii->pm_lock, pm_lock_flags);
  1564. /* move all submitted descriptors to issued list */
  1565. spin_lock_irqsave(&gchan->vc.lock, flags);
  1566. if (vchan_issue_pending(&gchan->vc))
  1567. vd = list_last_entry(&gchan->vc.desc_issued,
  1568. struct virt_dma_desc, node);
  1569. spin_unlock_irqrestore(&gchan->vc.lock, flags);
  1570. /* nothing to do list is empty */
  1571. if (!vd) {
  1572. read_unlock_irqrestore(&gpii->pm_lock, pm_lock_flags);
  1573. return;
  1574. }
  1575. gpi_desc = to_gpi_desc(vd);
  1576. for (i = 0; i < gpi_desc->num_tre; i++) {
  1577. tre = &gpi_desc->tre[i];
  1578. gpi_queue_xfer(gpii, gchan, tre, &wp);
  1579. }
  1580. gpi_desc->db = ch_ring->wp;
  1581. gpi_write_ch_db(gchan, &gchan->ch_ring, gpi_desc->db);
  1582. read_unlock_irqrestore(&gpii->pm_lock, pm_lock_flags);
  1583. }
  1584. static int gpi_ch_init(struct gchan *gchan)
  1585. {
  1586. struct gpii *gpii = gchan->gpii;
  1587. const int ev_factor = gpii->gpi_dev->ev_factor;
  1588. u32 elements;
  1589. int i = 0, ret = 0;
  1590. gchan->pm_state = CONFIG_STATE;
  1591. /* check if both channels are configured before continue */
  1592. for (i = 0; i < MAX_CHANNELS_PER_GPII; i++)
  1593. if (gpii->gchan[i].pm_state != CONFIG_STATE)
  1594. goto exit_gpi_init;
  1595. /* protocol must be same for both channels */
  1596. if (gpii->gchan[0].protocol != gpii->gchan[1].protocol) {
  1597. dev_err(gpii->gpi_dev->dev, "protocol did not match protocol %u != %u\n",
  1598. gpii->gchan[0].protocol, gpii->gchan[1].protocol);
  1599. ret = -EINVAL;
  1600. goto exit_gpi_init;
  1601. }
  1602. /* allocate memory for event ring */
  1603. elements = CHAN_TRES << ev_factor;
  1604. ret = gpi_alloc_ring(&gpii->ev_ring, elements,
  1605. sizeof(union gpi_event), gpii);
  1606. if (ret)
  1607. goto exit_gpi_init;
  1608. /* configure interrupts */
  1609. write_lock_irq(&gpii->pm_lock);
  1610. gpii->pm_state = PREPARE_HARDWARE;
  1611. write_unlock_irq(&gpii->pm_lock);
  1612. ret = gpi_config_interrupts(gpii, DEFAULT_IRQ_SETTINGS, 0);
  1613. if (ret) {
  1614. dev_err(gpii->gpi_dev->dev, "error config. interrupts, ret:%d\n", ret);
  1615. goto error_config_int;
  1616. }
  1617. /* allocate event rings */
  1618. ret = gpi_alloc_ev_chan(gpii);
  1619. if (ret) {
  1620. dev_err(gpii->gpi_dev->dev, "error alloc_ev_chan:%d\n", ret);
  1621. goto error_alloc_ev_ring;
  1622. }
  1623. /* Allocate all channels */
  1624. for (i = 0; i < MAX_CHANNELS_PER_GPII; i++) {
  1625. ret = gpi_alloc_chan(&gpii->gchan[i], true);
  1626. if (ret) {
  1627. dev_err(gpii->gpi_dev->dev, "Error allocating chan:%d\n", ret);
  1628. goto error_alloc_chan;
  1629. }
  1630. }
  1631. /* start channels */
  1632. for (i = 0; i < MAX_CHANNELS_PER_GPII; i++) {
  1633. ret = gpi_start_chan(&gpii->gchan[i]);
  1634. if (ret) {
  1635. dev_err(gpii->gpi_dev->dev, "Error start chan:%d\n", ret);
  1636. goto error_start_chan;
  1637. }
  1638. }
  1639. return ret;
  1640. error_start_chan:
  1641. for (i = i - 1; i >= 0; i--) {
  1642. gpi_stop_chan(&gpii->gchan[i]);
  1643. gpi_send_cmd(gpii, gchan, GPI_CH_CMD_RESET);
  1644. }
  1645. i = 2;
  1646. error_alloc_chan:
  1647. for (i = i - 1; i >= 0; i--)
  1648. gpi_reset_chan(gchan, GPI_CH_CMD_DE_ALLOC);
  1649. error_alloc_ev_ring:
  1650. gpi_disable_interrupts(gpii);
  1651. error_config_int:
  1652. gpi_free_ring(&gpii->ev_ring, gpii);
  1653. exit_gpi_init:
  1654. return ret;
  1655. }
  1656. /* release all channel resources */
  1657. static void gpi_free_chan_resources(struct dma_chan *chan)
  1658. {
  1659. struct gchan *gchan = to_gchan(chan);
  1660. struct gpii *gpii = gchan->gpii;
  1661. enum gpi_pm_state cur_state;
  1662. int ret, i;
  1663. mutex_lock(&gpii->ctrl_lock);
  1664. cur_state = gchan->pm_state;
  1665. /* disable ch state so no more TRE processing for this channel */
  1666. write_lock_irq(&gpii->pm_lock);
  1667. gchan->pm_state = PREPARE_TERMINATE;
  1668. write_unlock_irq(&gpii->pm_lock);
  1669. /* attempt to do graceful hardware shutdown */
  1670. if (cur_state == ACTIVE_STATE) {
  1671. gpi_stop_chan(gchan);
  1672. ret = gpi_send_cmd(gpii, gchan, GPI_CH_CMD_RESET);
  1673. if (ret)
  1674. dev_err(gpii->gpi_dev->dev, "error resetting channel:%d\n", ret);
  1675. gpi_reset_chan(gchan, GPI_CH_CMD_DE_ALLOC);
  1676. }
  1677. /* free all allocated memory */
  1678. gpi_free_ring(&gchan->ch_ring, gpii);
  1679. vchan_free_chan_resources(&gchan->vc);
  1680. kfree(gchan->config);
  1681. write_lock_irq(&gpii->pm_lock);
  1682. gchan->pm_state = DISABLE_STATE;
  1683. write_unlock_irq(&gpii->pm_lock);
  1684. /* if other rings are still active exit */
  1685. for (i = 0; i < MAX_CHANNELS_PER_GPII; i++)
  1686. if (gpii->gchan[i].ch_ring.configured)
  1687. goto exit_free;
  1688. /* deallocate EV Ring */
  1689. cur_state = gpii->pm_state;
  1690. write_lock_irq(&gpii->pm_lock);
  1691. gpii->pm_state = PREPARE_TERMINATE;
  1692. write_unlock_irq(&gpii->pm_lock);
  1693. /* wait for threads to complete out */
  1694. tasklet_kill(&gpii->ev_task);
  1695. /* send command to de allocate event ring */
  1696. if (cur_state == ACTIVE_STATE)
  1697. gpi_send_cmd(gpii, NULL, GPI_EV_CMD_DEALLOC);
  1698. gpi_free_ring(&gpii->ev_ring, gpii);
  1699. /* disable interrupts */
  1700. if (cur_state == ACTIVE_STATE)
  1701. gpi_disable_interrupts(gpii);
  1702. /* set final state to disable */
  1703. write_lock_irq(&gpii->pm_lock);
  1704. gpii->pm_state = DISABLE_STATE;
  1705. write_unlock_irq(&gpii->pm_lock);
  1706. exit_free:
  1707. mutex_unlock(&gpii->ctrl_lock);
  1708. }
  1709. /* allocate channel resources */
  1710. static int gpi_alloc_chan_resources(struct dma_chan *chan)
  1711. {
  1712. struct gchan *gchan = to_gchan(chan);
  1713. struct gpii *gpii = gchan->gpii;
  1714. int ret;
  1715. mutex_lock(&gpii->ctrl_lock);
  1716. /* allocate memory for transfer ring */
  1717. ret = gpi_alloc_ring(&gchan->ch_ring, CHAN_TRES,
  1718. sizeof(struct gpi_tre), gpii);
  1719. if (ret)
  1720. goto xfer_alloc_err;
  1721. ret = gpi_ch_init(gchan);
  1722. mutex_unlock(&gpii->ctrl_lock);
  1723. return ret;
  1724. xfer_alloc_err:
  1725. mutex_unlock(&gpii->ctrl_lock);
  1726. return ret;
  1727. }
  1728. static int gpi_find_avail_gpii(struct gpi_dev *gpi_dev, u32 seid)
  1729. {
  1730. struct gchan *tx_chan, *rx_chan;
  1731. unsigned int gpii;
  1732. /* check if same seid is already configured for another chid */
  1733. for (gpii = 0; gpii < gpi_dev->max_gpii; gpii++) {
  1734. if (!((1 << gpii) & gpi_dev->gpii_mask))
  1735. continue;
  1736. tx_chan = &gpi_dev->gpiis[gpii].gchan[GPI_TX_CHAN];
  1737. rx_chan = &gpi_dev->gpiis[gpii].gchan[GPI_RX_CHAN];
  1738. if (rx_chan->vc.chan.client_count && rx_chan->seid == seid)
  1739. return gpii;
  1740. if (tx_chan->vc.chan.client_count && tx_chan->seid == seid)
  1741. return gpii;
  1742. }
  1743. /* no channels configured with same seid, return next avail gpii */
  1744. for (gpii = 0; gpii < gpi_dev->max_gpii; gpii++) {
  1745. if (!((1 << gpii) & gpi_dev->gpii_mask))
  1746. continue;
  1747. tx_chan = &gpi_dev->gpiis[gpii].gchan[GPI_TX_CHAN];
  1748. rx_chan = &gpi_dev->gpiis[gpii].gchan[GPI_RX_CHAN];
  1749. /* check if gpii is configured */
  1750. if (tx_chan->vc.chan.client_count ||
  1751. rx_chan->vc.chan.client_count)
  1752. continue;
  1753. /* found a free gpii */
  1754. return gpii;
  1755. }
  1756. /* no gpii instance available to use */
  1757. return -EIO;
  1758. }
  1759. /* gpi_of_dma_xlate: open client requested channel */
  1760. static struct dma_chan *gpi_of_dma_xlate(struct of_phandle_args *args,
  1761. struct of_dma *of_dma)
  1762. {
  1763. struct gpi_dev *gpi_dev = (struct gpi_dev *)of_dma->of_dma_data;
  1764. u32 seid, chid;
  1765. int gpii;
  1766. struct gchan *gchan;
  1767. if (args->args_count < 3) {
  1768. dev_err(gpi_dev->dev, "gpii require minimum 2 args, client passed:%d args\n",
  1769. args->args_count);
  1770. return NULL;
  1771. }
  1772. chid = args->args[0];
  1773. if (chid >= MAX_CHANNELS_PER_GPII) {
  1774. dev_err(gpi_dev->dev, "gpii channel:%d not valid\n", chid);
  1775. return NULL;
  1776. }
  1777. seid = args->args[1];
  1778. /* find next available gpii to use */
  1779. gpii = gpi_find_avail_gpii(gpi_dev, seid);
  1780. if (gpii < 0) {
  1781. dev_err(gpi_dev->dev, "no available gpii instances\n");
  1782. return NULL;
  1783. }
  1784. gchan = &gpi_dev->gpiis[gpii].gchan[chid];
  1785. if (gchan->vc.chan.client_count) {
  1786. dev_err(gpi_dev->dev, "gpii:%d chid:%d seid:%d already configured\n",
  1787. gpii, chid, gchan->seid);
  1788. return NULL;
  1789. }
  1790. gchan->seid = seid;
  1791. gchan->protocol = args->args[2];
  1792. return dma_get_slave_channel(&gchan->vc.chan);
  1793. }
  1794. static int gpi_probe(struct platform_device *pdev)
  1795. {
  1796. struct gpi_dev *gpi_dev;
  1797. unsigned int i;
  1798. u32 ee_offset;
  1799. int ret;
  1800. gpi_dev = devm_kzalloc(&pdev->dev, sizeof(*gpi_dev), GFP_KERNEL);
  1801. if (!gpi_dev)
  1802. return -ENOMEM;
  1803. gpi_dev->dev = &pdev->dev;
  1804. gpi_dev->regs = devm_platform_get_and_ioremap_resource(pdev, 0, &gpi_dev->res);
  1805. if (IS_ERR(gpi_dev->regs))
  1806. return PTR_ERR(gpi_dev->regs);
  1807. gpi_dev->ee_base = gpi_dev->regs;
  1808. ret = of_property_read_u32(gpi_dev->dev->of_node, "dma-channels",
  1809. &gpi_dev->max_gpii);
  1810. if (ret) {
  1811. dev_err(gpi_dev->dev, "missing 'max-no-gpii' DT node\n");
  1812. return ret;
  1813. }
  1814. ret = of_property_read_u32(gpi_dev->dev->of_node, "dma-channel-mask",
  1815. &gpi_dev->gpii_mask);
  1816. if (ret) {
  1817. dev_err(gpi_dev->dev, "missing 'gpii-mask' DT node\n");
  1818. return ret;
  1819. }
  1820. ee_offset = (uintptr_t)device_get_match_data(gpi_dev->dev);
  1821. gpi_dev->ee_base = gpi_dev->ee_base - ee_offset;
  1822. gpi_dev->ev_factor = EV_FACTOR;
  1823. ret = dma_set_mask(gpi_dev->dev, DMA_BIT_MASK(64));
  1824. if (ret) {
  1825. dev_err(gpi_dev->dev, "Error setting dma_mask to 64, ret:%d\n", ret);
  1826. return ret;
  1827. }
  1828. gpi_dev->gpiis = devm_kzalloc(gpi_dev->dev, sizeof(*gpi_dev->gpiis) *
  1829. gpi_dev->max_gpii, GFP_KERNEL);
  1830. if (!gpi_dev->gpiis)
  1831. return -ENOMEM;
  1832. /* setup all the supported gpii */
  1833. INIT_LIST_HEAD(&gpi_dev->dma_device.channels);
  1834. for (i = 0; i < gpi_dev->max_gpii; i++) {
  1835. struct gpii *gpii = &gpi_dev->gpiis[i];
  1836. int chan;
  1837. if (!((1 << i) & gpi_dev->gpii_mask))
  1838. continue;
  1839. /* set up ev cntxt register map */
  1840. gpii->ev_cntxt_base_reg = gpi_dev->ee_base + GPII_n_EV_CH_k_CNTXT_0_OFFS(i, 0);
  1841. gpii->ev_cntxt_db_reg = gpi_dev->ee_base + GPII_n_EV_CH_k_DOORBELL_0_OFFS(i, 0);
  1842. gpii->ev_ring_rp_lsb_reg = gpii->ev_cntxt_base_reg + CNTXT_4_RING_RP_LSB;
  1843. gpii->ev_cmd_reg = gpi_dev->ee_base + GPII_n_EV_CH_CMD_OFFS(i);
  1844. gpii->ieob_clr_reg = gpi_dev->ee_base + GPII_n_CNTXT_SRC_IEOB_IRQ_CLR_OFFS(i);
  1845. /* set up irq */
  1846. ret = platform_get_irq(pdev, i);
  1847. if (ret < 0)
  1848. return ret;
  1849. gpii->irq = ret;
  1850. /* set up channel specific register info */
  1851. for (chan = 0; chan < MAX_CHANNELS_PER_GPII; chan++) {
  1852. struct gchan *gchan = &gpii->gchan[chan];
  1853. /* set up ch cntxt register map */
  1854. gchan->ch_cntxt_base_reg = gpi_dev->ee_base +
  1855. GPII_n_CH_k_CNTXT_0_OFFS(i, chan);
  1856. gchan->ch_cntxt_db_reg = gpi_dev->ee_base +
  1857. GPII_n_CH_k_DOORBELL_0_OFFS(i, chan);
  1858. gchan->ch_cmd_reg = gpi_dev->ee_base + GPII_n_CH_CMD_OFFS(i);
  1859. /* vchan setup */
  1860. vchan_init(&gchan->vc, &gpi_dev->dma_device);
  1861. gchan->vc.desc_free = gpi_desc_free;
  1862. gchan->chid = chan;
  1863. gchan->gpii = gpii;
  1864. gchan->dir = GPII_CHAN_DIR[chan];
  1865. }
  1866. mutex_init(&gpii->ctrl_lock);
  1867. rwlock_init(&gpii->pm_lock);
  1868. tasklet_init(&gpii->ev_task, gpi_ev_tasklet,
  1869. (unsigned long)gpii);
  1870. init_completion(&gpii->cmd_completion);
  1871. gpii->gpii_id = i;
  1872. gpii->regs = gpi_dev->ee_base;
  1873. gpii->gpi_dev = gpi_dev;
  1874. }
  1875. platform_set_drvdata(pdev, gpi_dev);
  1876. /* clear and Set capabilities */
  1877. dma_cap_zero(gpi_dev->dma_device.cap_mask);
  1878. dma_cap_set(DMA_SLAVE, gpi_dev->dma_device.cap_mask);
  1879. /* configure dmaengine apis */
  1880. gpi_dev->dma_device.directions = BIT(DMA_DEV_TO_MEM) | BIT(DMA_MEM_TO_DEV);
  1881. gpi_dev->dma_device.residue_granularity = DMA_RESIDUE_GRANULARITY_DESCRIPTOR;
  1882. gpi_dev->dma_device.src_addr_widths = DMA_SLAVE_BUSWIDTH_8_BYTES;
  1883. gpi_dev->dma_device.dst_addr_widths = DMA_SLAVE_BUSWIDTH_8_BYTES;
  1884. gpi_dev->dma_device.device_alloc_chan_resources = gpi_alloc_chan_resources;
  1885. gpi_dev->dma_device.device_free_chan_resources = gpi_free_chan_resources;
  1886. gpi_dev->dma_device.device_tx_status = dma_cookie_status;
  1887. gpi_dev->dma_device.device_issue_pending = gpi_issue_pending;
  1888. gpi_dev->dma_device.device_prep_slave_sg = gpi_prep_slave_sg;
  1889. gpi_dev->dma_device.device_config = gpi_peripheral_config;
  1890. gpi_dev->dma_device.device_terminate_all = gpi_terminate_all;
  1891. gpi_dev->dma_device.dev = gpi_dev->dev;
  1892. gpi_dev->dma_device.device_pause = gpi_pause;
  1893. gpi_dev->dma_device.device_resume = gpi_resume;
  1894. /* register with dmaengine framework */
  1895. ret = dma_async_device_register(&gpi_dev->dma_device);
  1896. if (ret) {
  1897. dev_err(gpi_dev->dev, "async_device_register failed ret:%d", ret);
  1898. return ret;
  1899. }
  1900. ret = of_dma_controller_register(gpi_dev->dev->of_node,
  1901. gpi_of_dma_xlate, gpi_dev);
  1902. if (ret) {
  1903. dev_err(gpi_dev->dev, "of_dma_controller_reg failed ret:%d", ret);
  1904. return ret;
  1905. }
  1906. return ret;
  1907. }
  1908. static const struct of_device_id gpi_of_match[] = {
  1909. { .compatible = "qcom,sdm845-gpi-dma", .data = (void *)0x0 },
  1910. { .compatible = "qcom,sm6350-gpi-dma", .data = (void *)0x10000 },
  1911. /*
  1912. * Do not grow the list for compatible devices. Instead use
  1913. * qcom,sdm845-gpi-dma (for ee_offset = 0x0) or qcom,sm6350-gpi-dma
  1914. * (for ee_offset = 0x10000).
  1915. */
  1916. { .compatible = "qcom,sc7280-gpi-dma", .data = (void *)0x10000 },
  1917. { .compatible = "qcom,sm8150-gpi-dma", .data = (void *)0x0 },
  1918. { .compatible = "qcom,sm8250-gpi-dma", .data = (void *)0x0 },
  1919. { .compatible = "qcom,sm8350-gpi-dma", .data = (void *)0x10000 },
  1920. { .compatible = "qcom,sm8450-gpi-dma", .data = (void *)0x10000 },
  1921. { },
  1922. };
  1923. MODULE_DEVICE_TABLE(of, gpi_of_match);
  1924. static struct platform_driver gpi_driver = {
  1925. .probe = gpi_probe,
  1926. .driver = {
  1927. .name = KBUILD_MODNAME,
  1928. .of_match_table = gpi_of_match,
  1929. },
  1930. };
  1931. static int __init gpi_init(void)
  1932. {
  1933. return platform_driver_register(&gpi_driver);
  1934. }
  1935. subsys_initcall(gpi_init)
  1936. MODULE_DESCRIPTION("QCOM GPI DMA engine driver");
  1937. MODULE_LICENSE("GPL v2");