pch_udc.c 88 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950295129522953295429552956295729582959296029612962296329642965296629672968296929702971297229732974297529762977297829792980298129822983298429852986298729882989299029912992299329942995299629972998299930003001300230033004300530063007300830093010301130123013301430153016301730183019302030213022302330243025302630273028302930303031303230333034303530363037303830393040304130423043304430453046304730483049305030513052305330543055305630573058305930603061306230633064306530663067306830693070307130723073307430753076307730783079308030813082308330843085308630873088308930903091309230933094309530963097309830993100310131023103310431053106310731083109311031113112311331143115311631173118311931203121312231233124312531263127312831293130313131323133313431353136313731383139314031413142314331443145314631473148314931503151315231533154315531563157315831593160316131623163316431653166316731683169317031713172317331743175317631773178317931803181318231833184318531863187318831893190319131923193319431953196319731983199320032013202320332043205320632073208320932103211321232133214321532163217321832193220322132223223322432253226322732283229323032313232323332343235323632373238323932403241324232433244324532463247
  1. /*
  2. * Copyright (C) 2011 LAPIS Semiconductor Co., Ltd.
  3. *
  4. * This program is free software; you can redistribute it and/or modify
  5. * it under the terms of the GNU General Public License as published by
  6. * the Free Software Foundation; version 2 of the License.
  7. */
  8. #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  9. #include <linux/kernel.h>
  10. #include <linux/module.h>
  11. #include <linux/pci.h>
  12. #include <linux/delay.h>
  13. #include <linux/errno.h>
  14. #include <linux/list.h>
  15. #include <linux/interrupt.h>
  16. #include <linux/usb/ch9.h>
  17. #include <linux/usb/gadget.h>
  18. #include <linux/gpio.h>
  19. #include <linux/irq.h>
  20. /* GPIO port for VBUS detecting */
  21. static int vbus_gpio_port = -1; /* GPIO port number (-1:Not used) */
  22. #define PCH_VBUS_PERIOD 3000 /* VBUS polling period (msec) */
  23. #define PCH_VBUS_INTERVAL 10 /* VBUS polling interval (msec) */
  24. /* Address offset of Registers */
  25. #define UDC_EP_REG_SHIFT 0x20 /* Offset to next EP */
  26. #define UDC_EPCTL_ADDR 0x00 /* Endpoint control */
  27. #define UDC_EPSTS_ADDR 0x04 /* Endpoint status */
  28. #define UDC_BUFIN_FRAMENUM_ADDR 0x08 /* buffer size in / frame number out */
  29. #define UDC_BUFOUT_MAXPKT_ADDR 0x0C /* buffer size out / maxpkt in */
  30. #define UDC_SUBPTR_ADDR 0x10 /* setup buffer pointer */
  31. #define UDC_DESPTR_ADDR 0x14 /* Data descriptor pointer */
  32. #define UDC_CONFIRM_ADDR 0x18 /* Write/Read confirmation */
  33. #define UDC_DEVCFG_ADDR 0x400 /* Device configuration */
  34. #define UDC_DEVCTL_ADDR 0x404 /* Device control */
  35. #define UDC_DEVSTS_ADDR 0x408 /* Device status */
  36. #define UDC_DEVIRQSTS_ADDR 0x40C /* Device irq status */
  37. #define UDC_DEVIRQMSK_ADDR 0x410 /* Device irq mask */
  38. #define UDC_EPIRQSTS_ADDR 0x414 /* Endpoint irq status */
  39. #define UDC_EPIRQMSK_ADDR 0x418 /* Endpoint irq mask */
  40. #define UDC_DEVLPM_ADDR 0x41C /* LPM control / status */
  41. #define UDC_CSR_BUSY_ADDR 0x4f0 /* UDC_CSR_BUSY Status register */
  42. #define UDC_SRST_ADDR 0x4fc /* SOFT RESET register */
  43. #define UDC_CSR_ADDR 0x500 /* USB_DEVICE endpoint register */
  44. /* Endpoint control register */
  45. /* Bit position */
  46. #define UDC_EPCTL_MRXFLUSH (1 << 12)
  47. #define UDC_EPCTL_RRDY (1 << 9)
  48. #define UDC_EPCTL_CNAK (1 << 8)
  49. #define UDC_EPCTL_SNAK (1 << 7)
  50. #define UDC_EPCTL_NAK (1 << 6)
  51. #define UDC_EPCTL_P (1 << 3)
  52. #define UDC_EPCTL_F (1 << 1)
  53. #define UDC_EPCTL_S (1 << 0)
  54. #define UDC_EPCTL_ET_SHIFT 4
  55. /* Mask patern */
  56. #define UDC_EPCTL_ET_MASK 0x00000030
  57. /* Value for ET field */
  58. #define UDC_EPCTL_ET_CONTROL 0
  59. #define UDC_EPCTL_ET_ISO 1
  60. #define UDC_EPCTL_ET_BULK 2
  61. #define UDC_EPCTL_ET_INTERRUPT 3
  62. /* Endpoint status register */
  63. /* Bit position */
  64. #define UDC_EPSTS_XFERDONE (1 << 27)
  65. #define UDC_EPSTS_RSS (1 << 26)
  66. #define UDC_EPSTS_RCS (1 << 25)
  67. #define UDC_EPSTS_TXEMPTY (1 << 24)
  68. #define UDC_EPSTS_TDC (1 << 10)
  69. #define UDC_EPSTS_HE (1 << 9)
  70. #define UDC_EPSTS_MRXFIFO_EMP (1 << 8)
  71. #define UDC_EPSTS_BNA (1 << 7)
  72. #define UDC_EPSTS_IN (1 << 6)
  73. #define UDC_EPSTS_OUT_SHIFT 4
  74. /* Mask patern */
  75. #define UDC_EPSTS_OUT_MASK 0x00000030
  76. #define UDC_EPSTS_ALL_CLR_MASK 0x1F0006F0
  77. /* Value for OUT field */
  78. #define UDC_EPSTS_OUT_SETUP 2
  79. #define UDC_EPSTS_OUT_DATA 1
  80. /* Device configuration register */
  81. /* Bit position */
  82. #define UDC_DEVCFG_CSR_PRG (1 << 17)
  83. #define UDC_DEVCFG_SP (1 << 3)
  84. /* SPD Valee */
  85. #define UDC_DEVCFG_SPD_HS 0x0
  86. #define UDC_DEVCFG_SPD_FS 0x1
  87. #define UDC_DEVCFG_SPD_LS 0x2
  88. /* Device control register */
  89. /* Bit position */
  90. #define UDC_DEVCTL_THLEN_SHIFT 24
  91. #define UDC_DEVCTL_BRLEN_SHIFT 16
  92. #define UDC_DEVCTL_CSR_DONE (1 << 13)
  93. #define UDC_DEVCTL_SD (1 << 10)
  94. #define UDC_DEVCTL_MODE (1 << 9)
  95. #define UDC_DEVCTL_BREN (1 << 8)
  96. #define UDC_DEVCTL_THE (1 << 7)
  97. #define UDC_DEVCTL_DU (1 << 4)
  98. #define UDC_DEVCTL_TDE (1 << 3)
  99. #define UDC_DEVCTL_RDE (1 << 2)
  100. #define UDC_DEVCTL_RES (1 << 0)
  101. /* Device status register */
  102. /* Bit position */
  103. #define UDC_DEVSTS_TS_SHIFT 18
  104. #define UDC_DEVSTS_ENUM_SPEED_SHIFT 13
  105. #define UDC_DEVSTS_ALT_SHIFT 8
  106. #define UDC_DEVSTS_INTF_SHIFT 4
  107. #define UDC_DEVSTS_CFG_SHIFT 0
  108. /* Mask patern */
  109. #define UDC_DEVSTS_TS_MASK 0xfffc0000
  110. #define UDC_DEVSTS_ENUM_SPEED_MASK 0x00006000
  111. #define UDC_DEVSTS_ALT_MASK 0x00000f00
  112. #define UDC_DEVSTS_INTF_MASK 0x000000f0
  113. #define UDC_DEVSTS_CFG_MASK 0x0000000f
  114. /* value for maximum speed for SPEED field */
  115. #define UDC_DEVSTS_ENUM_SPEED_FULL 1
  116. #define UDC_DEVSTS_ENUM_SPEED_HIGH 0
  117. #define UDC_DEVSTS_ENUM_SPEED_LOW 2
  118. #define UDC_DEVSTS_ENUM_SPEED_FULLX 3
  119. /* Device irq register */
  120. /* Bit position */
  121. #define UDC_DEVINT_RWKP (1 << 7)
  122. #define UDC_DEVINT_ENUM (1 << 6)
  123. #define UDC_DEVINT_SOF (1 << 5)
  124. #define UDC_DEVINT_US (1 << 4)
  125. #define UDC_DEVINT_UR (1 << 3)
  126. #define UDC_DEVINT_ES (1 << 2)
  127. #define UDC_DEVINT_SI (1 << 1)
  128. #define UDC_DEVINT_SC (1 << 0)
  129. /* Mask patern */
  130. #define UDC_DEVINT_MSK 0x7f
  131. /* Endpoint irq register */
  132. /* Bit position */
  133. #define UDC_EPINT_IN_SHIFT 0
  134. #define UDC_EPINT_OUT_SHIFT 16
  135. #define UDC_EPINT_IN_EP0 (1 << 0)
  136. #define UDC_EPINT_OUT_EP0 (1 << 16)
  137. /* Mask patern */
  138. #define UDC_EPINT_MSK_DISABLE_ALL 0xffffffff
  139. /* UDC_CSR_BUSY Status register */
  140. /* Bit position */
  141. #define UDC_CSR_BUSY (1 << 0)
  142. /* SOFT RESET register */
  143. /* Bit position */
  144. #define UDC_PSRST (1 << 1)
  145. #define UDC_SRST (1 << 0)
  146. /* USB_DEVICE endpoint register */
  147. /* Bit position */
  148. #define UDC_CSR_NE_NUM_SHIFT 0
  149. #define UDC_CSR_NE_DIR_SHIFT 4
  150. #define UDC_CSR_NE_TYPE_SHIFT 5
  151. #define UDC_CSR_NE_CFG_SHIFT 7
  152. #define UDC_CSR_NE_INTF_SHIFT 11
  153. #define UDC_CSR_NE_ALT_SHIFT 15
  154. #define UDC_CSR_NE_MAX_PKT_SHIFT 19
  155. /* Mask patern */
  156. #define UDC_CSR_NE_NUM_MASK 0x0000000f
  157. #define UDC_CSR_NE_DIR_MASK 0x00000010
  158. #define UDC_CSR_NE_TYPE_MASK 0x00000060
  159. #define UDC_CSR_NE_CFG_MASK 0x00000780
  160. #define UDC_CSR_NE_INTF_MASK 0x00007800
  161. #define UDC_CSR_NE_ALT_MASK 0x00078000
  162. #define UDC_CSR_NE_MAX_PKT_MASK 0x3ff80000
  163. #define PCH_UDC_CSR(ep) (UDC_CSR_ADDR + ep*4)
  164. #define PCH_UDC_EPINT(in, num)\
  165. (1 << (num + (in ? UDC_EPINT_IN_SHIFT : UDC_EPINT_OUT_SHIFT)))
  166. /* Index of endpoint */
  167. #define UDC_EP0IN_IDX 0
  168. #define UDC_EP0OUT_IDX 1
  169. #define UDC_EPIN_IDX(ep) (ep * 2)
  170. #define UDC_EPOUT_IDX(ep) (ep * 2 + 1)
  171. #define PCH_UDC_EP0 0
  172. #define PCH_UDC_EP1 1
  173. #define PCH_UDC_EP2 2
  174. #define PCH_UDC_EP3 3
  175. /* Number of endpoint */
  176. #define PCH_UDC_EP_NUM 32 /* Total number of EPs (16 IN,16 OUT) */
  177. #define PCH_UDC_USED_EP_NUM 4 /* EP number of EP's really used */
  178. /* Length Value */
  179. #define PCH_UDC_BRLEN 0x0F /* Burst length */
  180. #define PCH_UDC_THLEN 0x1F /* Threshold length */
  181. /* Value of EP Buffer Size */
  182. #define UDC_EP0IN_BUFF_SIZE 16
  183. #define UDC_EPIN_BUFF_SIZE 256
  184. #define UDC_EP0OUT_BUFF_SIZE 16
  185. #define UDC_EPOUT_BUFF_SIZE 256
  186. /* Value of EP maximum packet size */
  187. #define UDC_EP0IN_MAX_PKT_SIZE 64
  188. #define UDC_EP0OUT_MAX_PKT_SIZE 64
  189. #define UDC_BULK_MAX_PKT_SIZE 512
  190. /* DMA */
  191. #define DMA_DIR_RX 1 /* DMA for data receive */
  192. #define DMA_DIR_TX 2 /* DMA for data transmit */
  193. #define DMA_ADDR_INVALID (~(dma_addr_t)0)
  194. #define UDC_DMA_MAXPACKET 65536 /* maximum packet size for DMA */
  195. /**
  196. * struct pch_udc_data_dma_desc - Structure to hold DMA descriptor information
  197. * for data
  198. * @status: Status quadlet
  199. * @reserved: Reserved
  200. * @dataptr: Buffer descriptor
  201. * @next: Next descriptor
  202. */
  203. struct pch_udc_data_dma_desc {
  204. u32 status;
  205. u32 reserved;
  206. u32 dataptr;
  207. u32 next;
  208. };
  209. /**
  210. * struct pch_udc_stp_dma_desc - Structure to hold DMA descriptor information
  211. * for control data
  212. * @status: Status
  213. * @reserved: Reserved
  214. * @data12: First setup word
  215. * @data34: Second setup word
  216. */
  217. struct pch_udc_stp_dma_desc {
  218. u32 status;
  219. u32 reserved;
  220. struct usb_ctrlrequest request;
  221. } __attribute((packed));
  222. /* DMA status definitions */
  223. /* Buffer status */
  224. #define PCH_UDC_BUFF_STS 0xC0000000
  225. #define PCH_UDC_BS_HST_RDY 0x00000000
  226. #define PCH_UDC_BS_DMA_BSY 0x40000000
  227. #define PCH_UDC_BS_DMA_DONE 0x80000000
  228. #define PCH_UDC_BS_HST_BSY 0xC0000000
  229. /* Rx/Tx Status */
  230. #define PCH_UDC_RXTX_STS 0x30000000
  231. #define PCH_UDC_RTS_SUCC 0x00000000
  232. #define PCH_UDC_RTS_DESERR 0x10000000
  233. #define PCH_UDC_RTS_BUFERR 0x30000000
  234. /* Last Descriptor Indication */
  235. #define PCH_UDC_DMA_LAST 0x08000000
  236. /* Number of Rx/Tx Bytes Mask */
  237. #define PCH_UDC_RXTX_BYTES 0x0000ffff
  238. /**
  239. * struct pch_udc_cfg_data - Structure to hold current configuration
  240. * and interface information
  241. * @cur_cfg: current configuration in use
  242. * @cur_intf: current interface in use
  243. * @cur_alt: current alt interface in use
  244. */
  245. struct pch_udc_cfg_data {
  246. u16 cur_cfg;
  247. u16 cur_intf;
  248. u16 cur_alt;
  249. };
  250. /**
  251. * struct pch_udc_ep - Structure holding a PCH USB device Endpoint information
  252. * @ep: embedded ep request
  253. * @td_stp_phys: for setup request
  254. * @td_data_phys: for data request
  255. * @td_stp: for setup request
  256. * @td_data: for data request
  257. * @dev: reference to device struct
  258. * @offset_addr: offset address of ep register
  259. * @desc: for this ep
  260. * @queue: queue for requests
  261. * @num: endpoint number
  262. * @in: endpoint is IN
  263. * @halted: endpoint halted?
  264. * @epsts: Endpoint status
  265. */
  266. struct pch_udc_ep {
  267. struct usb_ep ep;
  268. dma_addr_t td_stp_phys;
  269. dma_addr_t td_data_phys;
  270. struct pch_udc_stp_dma_desc *td_stp;
  271. struct pch_udc_data_dma_desc *td_data;
  272. struct pch_udc_dev *dev;
  273. unsigned long offset_addr;
  274. struct list_head queue;
  275. unsigned num:5,
  276. in:1,
  277. halted:1;
  278. unsigned long epsts;
  279. };
  280. /**
  281. * struct pch_vbus_gpio_data - Structure holding GPIO informaton
  282. * for detecting VBUS
  283. * @port: gpio port number
  284. * @intr: gpio interrupt number
  285. * @irq_work_fall Structure for WorkQueue
  286. * @irq_work_rise Structure for WorkQueue
  287. */
  288. struct pch_vbus_gpio_data {
  289. int port;
  290. int intr;
  291. struct work_struct irq_work_fall;
  292. struct work_struct irq_work_rise;
  293. };
  294. /**
  295. * struct pch_udc_dev - Structure holding complete information
  296. * of the PCH USB device
  297. * @gadget: gadget driver data
  298. * @driver: reference to gadget driver bound
  299. * @pdev: reference to the PCI device
  300. * @ep: array of endpoints
  301. * @lock: protects all state
  302. * @active: enabled the PCI device
  303. * @stall: stall requested
  304. * @prot_stall: protcol stall requested
  305. * @irq_registered: irq registered with system
  306. * @mem_region: device memory mapped
  307. * @registered: driver regsitered with system
  308. * @suspended: driver in suspended state
  309. * @connected: gadget driver associated
  310. * @vbus_session: required vbus_session state
  311. * @set_cfg_not_acked: pending acknowledgement 4 setup
  312. * @waiting_zlp_ack: pending acknowledgement 4 ZLP
  313. * @data_requests: DMA pool for data requests
  314. * @stp_requests: DMA pool for setup requests
  315. * @dma_addr: DMA pool for received
  316. * @ep0out_buf: Buffer for DMA
  317. * @setup_data: Received setup data
  318. * @phys_addr: of device memory
  319. * @base_addr: for mapped device memory
  320. * @irq: IRQ line for the device
  321. * @cfg_data: current cfg, intf, and alt in use
  322. * @vbus_gpio: GPIO informaton for detecting VBUS
  323. */
  324. struct pch_udc_dev {
  325. struct usb_gadget gadget;
  326. struct usb_gadget_driver *driver;
  327. struct pci_dev *pdev;
  328. struct pch_udc_ep ep[PCH_UDC_EP_NUM];
  329. spinlock_t lock; /* protects all state */
  330. unsigned active:1,
  331. stall:1,
  332. prot_stall:1,
  333. irq_registered:1,
  334. mem_region:1,
  335. suspended:1,
  336. connected:1,
  337. vbus_session:1,
  338. set_cfg_not_acked:1,
  339. waiting_zlp_ack:1;
  340. struct pci_pool *data_requests;
  341. struct pci_pool *stp_requests;
  342. dma_addr_t dma_addr;
  343. void *ep0out_buf;
  344. struct usb_ctrlrequest setup_data;
  345. unsigned long phys_addr;
  346. void __iomem *base_addr;
  347. unsigned irq;
  348. struct pch_udc_cfg_data cfg_data;
  349. struct pch_vbus_gpio_data vbus_gpio;
  350. };
  351. #define to_pch_udc(g) (container_of((g), struct pch_udc_dev, gadget))
  352. #define PCH_UDC_PCI_BAR 1
  353. #define PCI_DEVICE_ID_INTEL_EG20T_UDC 0x8808
  354. #define PCI_VENDOR_ID_ROHM 0x10DB
  355. #define PCI_DEVICE_ID_ML7213_IOH_UDC 0x801D
  356. #define PCI_DEVICE_ID_ML7831_IOH_UDC 0x8808
  357. static const char ep0_string[] = "ep0in";
  358. static DEFINE_SPINLOCK(udc_stall_spinlock); /* stall spin lock */
  359. static bool speed_fs;
  360. module_param_named(speed_fs, speed_fs, bool, S_IRUGO);
  361. MODULE_PARM_DESC(speed_fs, "true for Full speed operation");
  362. /**
  363. * struct pch_udc_request - Structure holding a PCH USB device request packet
  364. * @req: embedded ep request
  365. * @td_data_phys: phys. address
  366. * @td_data: first dma desc. of chain
  367. * @td_data_last: last dma desc. of chain
  368. * @queue: associated queue
  369. * @dma_going: DMA in progress for request
  370. * @dma_mapped: DMA memory mapped for request
  371. * @dma_done: DMA completed for request
  372. * @chain_len: chain length
  373. * @buf: Buffer memory for align adjustment
  374. * @dma: DMA memory for align adjustment
  375. */
  376. struct pch_udc_request {
  377. struct usb_request req;
  378. dma_addr_t td_data_phys;
  379. struct pch_udc_data_dma_desc *td_data;
  380. struct pch_udc_data_dma_desc *td_data_last;
  381. struct list_head queue;
  382. unsigned dma_going:1,
  383. dma_mapped:1,
  384. dma_done:1;
  385. unsigned chain_len;
  386. void *buf;
  387. dma_addr_t dma;
  388. };
  389. static inline u32 pch_udc_readl(struct pch_udc_dev *dev, unsigned long reg)
  390. {
  391. return ioread32(dev->base_addr + reg);
  392. }
  393. static inline void pch_udc_writel(struct pch_udc_dev *dev,
  394. unsigned long val, unsigned long reg)
  395. {
  396. iowrite32(val, dev->base_addr + reg);
  397. }
  398. static inline void pch_udc_bit_set(struct pch_udc_dev *dev,
  399. unsigned long reg,
  400. unsigned long bitmask)
  401. {
  402. pch_udc_writel(dev, pch_udc_readl(dev, reg) | bitmask, reg);
  403. }
  404. static inline void pch_udc_bit_clr(struct pch_udc_dev *dev,
  405. unsigned long reg,
  406. unsigned long bitmask)
  407. {
  408. pch_udc_writel(dev, pch_udc_readl(dev, reg) & ~(bitmask), reg);
  409. }
  410. static inline u32 pch_udc_ep_readl(struct pch_udc_ep *ep, unsigned long reg)
  411. {
  412. return ioread32(ep->dev->base_addr + ep->offset_addr + reg);
  413. }
  414. static inline void pch_udc_ep_writel(struct pch_udc_ep *ep,
  415. unsigned long val, unsigned long reg)
  416. {
  417. iowrite32(val, ep->dev->base_addr + ep->offset_addr + reg);
  418. }
  419. static inline void pch_udc_ep_bit_set(struct pch_udc_ep *ep,
  420. unsigned long reg,
  421. unsigned long bitmask)
  422. {
  423. pch_udc_ep_writel(ep, pch_udc_ep_readl(ep, reg) | bitmask, reg);
  424. }
  425. static inline void pch_udc_ep_bit_clr(struct pch_udc_ep *ep,
  426. unsigned long reg,
  427. unsigned long bitmask)
  428. {
  429. pch_udc_ep_writel(ep, pch_udc_ep_readl(ep, reg) & ~(bitmask), reg);
  430. }
  431. /**
  432. * pch_udc_csr_busy() - Wait till idle.
  433. * @dev: Reference to pch_udc_dev structure
  434. */
  435. static void pch_udc_csr_busy(struct pch_udc_dev *dev)
  436. {
  437. unsigned int count = 200;
  438. /* Wait till idle */
  439. while ((pch_udc_readl(dev, UDC_CSR_BUSY_ADDR) & UDC_CSR_BUSY)
  440. && --count)
  441. cpu_relax();
  442. if (!count)
  443. dev_err(&dev->pdev->dev, "%s: wait error\n", __func__);
  444. }
  445. /**
  446. * pch_udc_write_csr() - Write the command and status registers.
  447. * @dev: Reference to pch_udc_dev structure
  448. * @val: value to be written to CSR register
  449. * @addr: address of CSR register
  450. */
  451. static void pch_udc_write_csr(struct pch_udc_dev *dev, unsigned long val,
  452. unsigned int ep)
  453. {
  454. unsigned long reg = PCH_UDC_CSR(ep);
  455. pch_udc_csr_busy(dev); /* Wait till idle */
  456. pch_udc_writel(dev, val, reg);
  457. pch_udc_csr_busy(dev); /* Wait till idle */
  458. }
  459. /**
  460. * pch_udc_read_csr() - Read the command and status registers.
  461. * @dev: Reference to pch_udc_dev structure
  462. * @addr: address of CSR register
  463. *
  464. * Return codes: content of CSR register
  465. */
  466. static u32 pch_udc_read_csr(struct pch_udc_dev *dev, unsigned int ep)
  467. {
  468. unsigned long reg = PCH_UDC_CSR(ep);
  469. pch_udc_csr_busy(dev); /* Wait till idle */
  470. pch_udc_readl(dev, reg); /* Dummy read */
  471. pch_udc_csr_busy(dev); /* Wait till idle */
  472. return pch_udc_readl(dev, reg);
  473. }
  474. /**
  475. * pch_udc_rmt_wakeup() - Initiate for remote wakeup
  476. * @dev: Reference to pch_udc_dev structure
  477. */
  478. static inline void pch_udc_rmt_wakeup(struct pch_udc_dev *dev)
  479. {
  480. pch_udc_bit_set(dev, UDC_DEVCTL_ADDR, UDC_DEVCTL_RES);
  481. mdelay(1);
  482. pch_udc_bit_clr(dev, UDC_DEVCTL_ADDR, UDC_DEVCTL_RES);
  483. }
  484. /**
  485. * pch_udc_get_frame() - Get the current frame from device status register
  486. * @dev: Reference to pch_udc_dev structure
  487. * Retern current frame
  488. */
  489. static inline int pch_udc_get_frame(struct pch_udc_dev *dev)
  490. {
  491. u32 frame = pch_udc_readl(dev, UDC_DEVSTS_ADDR);
  492. return (frame & UDC_DEVSTS_TS_MASK) >> UDC_DEVSTS_TS_SHIFT;
  493. }
  494. /**
  495. * pch_udc_clear_selfpowered() - Clear the self power control
  496. * @dev: Reference to pch_udc_regs structure
  497. */
  498. static inline void pch_udc_clear_selfpowered(struct pch_udc_dev *dev)
  499. {
  500. pch_udc_bit_clr(dev, UDC_DEVCFG_ADDR, UDC_DEVCFG_SP);
  501. }
  502. /**
  503. * pch_udc_set_selfpowered() - Set the self power control
  504. * @dev: Reference to pch_udc_regs structure
  505. */
  506. static inline void pch_udc_set_selfpowered(struct pch_udc_dev *dev)
  507. {
  508. pch_udc_bit_set(dev, UDC_DEVCFG_ADDR, UDC_DEVCFG_SP);
  509. }
  510. /**
  511. * pch_udc_set_disconnect() - Set the disconnect status.
  512. * @dev: Reference to pch_udc_regs structure
  513. */
  514. static inline void pch_udc_set_disconnect(struct pch_udc_dev *dev)
  515. {
  516. pch_udc_bit_set(dev, UDC_DEVCTL_ADDR, UDC_DEVCTL_SD);
  517. }
  518. /**
  519. * pch_udc_clear_disconnect() - Clear the disconnect status.
  520. * @dev: Reference to pch_udc_regs structure
  521. */
  522. static void pch_udc_clear_disconnect(struct pch_udc_dev *dev)
  523. {
  524. /* Clear the disconnect */
  525. pch_udc_bit_set(dev, UDC_DEVCTL_ADDR, UDC_DEVCTL_RES);
  526. pch_udc_bit_clr(dev, UDC_DEVCTL_ADDR, UDC_DEVCTL_SD);
  527. mdelay(1);
  528. /* Resume USB signalling */
  529. pch_udc_bit_clr(dev, UDC_DEVCTL_ADDR, UDC_DEVCTL_RES);
  530. }
  531. /**
  532. * pch_udc_reconnect() - This API initializes usb device controller,
  533. * and clear the disconnect status.
  534. * @dev: Reference to pch_udc_regs structure
  535. */
  536. static void pch_udc_init(struct pch_udc_dev *dev);
  537. static void pch_udc_reconnect(struct pch_udc_dev *dev)
  538. {
  539. pch_udc_init(dev);
  540. /* enable device interrupts */
  541. /* pch_udc_enable_interrupts() */
  542. pch_udc_bit_clr(dev, UDC_DEVIRQMSK_ADDR,
  543. UDC_DEVINT_UR | UDC_DEVINT_ENUM);
  544. /* Clear the disconnect */
  545. pch_udc_bit_set(dev, UDC_DEVCTL_ADDR, UDC_DEVCTL_RES);
  546. pch_udc_bit_clr(dev, UDC_DEVCTL_ADDR, UDC_DEVCTL_SD);
  547. mdelay(1);
  548. /* Resume USB signalling */
  549. pch_udc_bit_clr(dev, UDC_DEVCTL_ADDR, UDC_DEVCTL_RES);
  550. }
  551. /**
  552. * pch_udc_vbus_session() - set or clearr the disconnect status.
  553. * @dev: Reference to pch_udc_regs structure
  554. * @is_active: Parameter specifying the action
  555. * 0: indicating VBUS power is ending
  556. * !0: indicating VBUS power is starting
  557. */
  558. static inline void pch_udc_vbus_session(struct pch_udc_dev *dev,
  559. int is_active)
  560. {
  561. if (is_active) {
  562. pch_udc_reconnect(dev);
  563. dev->vbus_session = 1;
  564. } else {
  565. if (dev->driver && dev->driver->disconnect) {
  566. spin_unlock(&dev->lock);
  567. dev->driver->disconnect(&dev->gadget);
  568. spin_lock(&dev->lock);
  569. }
  570. pch_udc_set_disconnect(dev);
  571. dev->vbus_session = 0;
  572. }
  573. }
  574. /**
  575. * pch_udc_ep_set_stall() - Set the stall of endpoint
  576. * @ep: Reference to structure of type pch_udc_ep_regs
  577. */
  578. static void pch_udc_ep_set_stall(struct pch_udc_ep *ep)
  579. {
  580. if (ep->in) {
  581. pch_udc_ep_bit_set(ep, UDC_EPCTL_ADDR, UDC_EPCTL_F);
  582. pch_udc_ep_bit_set(ep, UDC_EPCTL_ADDR, UDC_EPCTL_S);
  583. } else {
  584. pch_udc_ep_bit_set(ep, UDC_EPCTL_ADDR, UDC_EPCTL_S);
  585. }
  586. }
  587. /**
  588. * pch_udc_ep_clear_stall() - Clear the stall of endpoint
  589. * @ep: Reference to structure of type pch_udc_ep_regs
  590. */
  591. static inline void pch_udc_ep_clear_stall(struct pch_udc_ep *ep)
  592. {
  593. /* Clear the stall */
  594. pch_udc_ep_bit_clr(ep, UDC_EPCTL_ADDR, UDC_EPCTL_S);
  595. /* Clear NAK by writing CNAK */
  596. pch_udc_ep_bit_set(ep, UDC_EPCTL_ADDR, UDC_EPCTL_CNAK);
  597. }
  598. /**
  599. * pch_udc_ep_set_trfr_type() - Set the transfer type of endpoint
  600. * @ep: Reference to structure of type pch_udc_ep_regs
  601. * @type: Type of endpoint
  602. */
  603. static inline void pch_udc_ep_set_trfr_type(struct pch_udc_ep *ep,
  604. u8 type)
  605. {
  606. pch_udc_ep_writel(ep, ((type << UDC_EPCTL_ET_SHIFT) &
  607. UDC_EPCTL_ET_MASK), UDC_EPCTL_ADDR);
  608. }
  609. /**
  610. * pch_udc_ep_set_bufsz() - Set the maximum packet size for the endpoint
  611. * @ep: Reference to structure of type pch_udc_ep_regs
  612. * @buf_size: The buffer word size
  613. */
  614. static void pch_udc_ep_set_bufsz(struct pch_udc_ep *ep,
  615. u32 buf_size, u32 ep_in)
  616. {
  617. u32 data;
  618. if (ep_in) {
  619. data = pch_udc_ep_readl(ep, UDC_BUFIN_FRAMENUM_ADDR);
  620. data = (data & 0xffff0000) | (buf_size & 0xffff);
  621. pch_udc_ep_writel(ep, data, UDC_BUFIN_FRAMENUM_ADDR);
  622. } else {
  623. data = pch_udc_ep_readl(ep, UDC_BUFOUT_MAXPKT_ADDR);
  624. data = (buf_size << 16) | (data & 0xffff);
  625. pch_udc_ep_writel(ep, data, UDC_BUFOUT_MAXPKT_ADDR);
  626. }
  627. }
  628. /**
  629. * pch_udc_ep_set_maxpkt() - Set the Max packet size for the endpoint
  630. * @ep: Reference to structure of type pch_udc_ep_regs
  631. * @pkt_size: The packet byte size
  632. */
  633. static void pch_udc_ep_set_maxpkt(struct pch_udc_ep *ep, u32 pkt_size)
  634. {
  635. u32 data = pch_udc_ep_readl(ep, UDC_BUFOUT_MAXPKT_ADDR);
  636. data = (data & 0xffff0000) | (pkt_size & 0xffff);
  637. pch_udc_ep_writel(ep, data, UDC_BUFOUT_MAXPKT_ADDR);
  638. }
  639. /**
  640. * pch_udc_ep_set_subptr() - Set the Setup buffer pointer for the endpoint
  641. * @ep: Reference to structure of type pch_udc_ep_regs
  642. * @addr: Address of the register
  643. */
  644. static inline void pch_udc_ep_set_subptr(struct pch_udc_ep *ep, u32 addr)
  645. {
  646. pch_udc_ep_writel(ep, addr, UDC_SUBPTR_ADDR);
  647. }
  648. /**
  649. * pch_udc_ep_set_ddptr() - Set the Data descriptor pointer for the endpoint
  650. * @ep: Reference to structure of type pch_udc_ep_regs
  651. * @addr: Address of the register
  652. */
  653. static inline void pch_udc_ep_set_ddptr(struct pch_udc_ep *ep, u32 addr)
  654. {
  655. pch_udc_ep_writel(ep, addr, UDC_DESPTR_ADDR);
  656. }
  657. /**
  658. * pch_udc_ep_set_pd() - Set the poll demand bit for the endpoint
  659. * @ep: Reference to structure of type pch_udc_ep_regs
  660. */
  661. static inline void pch_udc_ep_set_pd(struct pch_udc_ep *ep)
  662. {
  663. pch_udc_ep_bit_set(ep, UDC_EPCTL_ADDR, UDC_EPCTL_P);
  664. }
  665. /**
  666. * pch_udc_ep_set_rrdy() - Set the receive ready bit for the endpoint
  667. * @ep: Reference to structure of type pch_udc_ep_regs
  668. */
  669. static inline void pch_udc_ep_set_rrdy(struct pch_udc_ep *ep)
  670. {
  671. pch_udc_ep_bit_set(ep, UDC_EPCTL_ADDR, UDC_EPCTL_RRDY);
  672. }
  673. /**
  674. * pch_udc_ep_clear_rrdy() - Clear the receive ready bit for the endpoint
  675. * @ep: Reference to structure of type pch_udc_ep_regs
  676. */
  677. static inline void pch_udc_ep_clear_rrdy(struct pch_udc_ep *ep)
  678. {
  679. pch_udc_ep_bit_clr(ep, UDC_EPCTL_ADDR, UDC_EPCTL_RRDY);
  680. }
  681. /**
  682. * pch_udc_set_dma() - Set the 'TDE' or RDE bit of device control
  683. * register depending on the direction specified
  684. * @dev: Reference to structure of type pch_udc_regs
  685. * @dir: whether Tx or Rx
  686. * DMA_DIR_RX: Receive
  687. * DMA_DIR_TX: Transmit
  688. */
  689. static inline void pch_udc_set_dma(struct pch_udc_dev *dev, int dir)
  690. {
  691. if (dir == DMA_DIR_RX)
  692. pch_udc_bit_set(dev, UDC_DEVCTL_ADDR, UDC_DEVCTL_RDE);
  693. else if (dir == DMA_DIR_TX)
  694. pch_udc_bit_set(dev, UDC_DEVCTL_ADDR, UDC_DEVCTL_TDE);
  695. }
  696. /**
  697. * pch_udc_clear_dma() - Clear the 'TDE' or RDE bit of device control
  698. * register depending on the direction specified
  699. * @dev: Reference to structure of type pch_udc_regs
  700. * @dir: Whether Tx or Rx
  701. * DMA_DIR_RX: Receive
  702. * DMA_DIR_TX: Transmit
  703. */
  704. static inline void pch_udc_clear_dma(struct pch_udc_dev *dev, int dir)
  705. {
  706. if (dir == DMA_DIR_RX)
  707. pch_udc_bit_clr(dev, UDC_DEVCTL_ADDR, UDC_DEVCTL_RDE);
  708. else if (dir == DMA_DIR_TX)
  709. pch_udc_bit_clr(dev, UDC_DEVCTL_ADDR, UDC_DEVCTL_TDE);
  710. }
  711. /**
  712. * pch_udc_set_csr_done() - Set the device control register
  713. * CSR done field (bit 13)
  714. * @dev: reference to structure of type pch_udc_regs
  715. */
  716. static inline void pch_udc_set_csr_done(struct pch_udc_dev *dev)
  717. {
  718. pch_udc_bit_set(dev, UDC_DEVCTL_ADDR, UDC_DEVCTL_CSR_DONE);
  719. }
  720. /**
  721. * pch_udc_disable_interrupts() - Disables the specified interrupts
  722. * @dev: Reference to structure of type pch_udc_regs
  723. * @mask: Mask to disable interrupts
  724. */
  725. static inline void pch_udc_disable_interrupts(struct pch_udc_dev *dev,
  726. u32 mask)
  727. {
  728. pch_udc_bit_set(dev, UDC_DEVIRQMSK_ADDR, mask);
  729. }
  730. /**
  731. * pch_udc_enable_interrupts() - Enable the specified interrupts
  732. * @dev: Reference to structure of type pch_udc_regs
  733. * @mask: Mask to enable interrupts
  734. */
  735. static inline void pch_udc_enable_interrupts(struct pch_udc_dev *dev,
  736. u32 mask)
  737. {
  738. pch_udc_bit_clr(dev, UDC_DEVIRQMSK_ADDR, mask);
  739. }
  740. /**
  741. * pch_udc_disable_ep_interrupts() - Disable endpoint interrupts
  742. * @dev: Reference to structure of type pch_udc_regs
  743. * @mask: Mask to disable interrupts
  744. */
  745. static inline void pch_udc_disable_ep_interrupts(struct pch_udc_dev *dev,
  746. u32 mask)
  747. {
  748. pch_udc_bit_set(dev, UDC_EPIRQMSK_ADDR, mask);
  749. }
  750. /**
  751. * pch_udc_enable_ep_interrupts() - Enable endpoint interrupts
  752. * @dev: Reference to structure of type pch_udc_regs
  753. * @mask: Mask to enable interrupts
  754. */
  755. static inline void pch_udc_enable_ep_interrupts(struct pch_udc_dev *dev,
  756. u32 mask)
  757. {
  758. pch_udc_bit_clr(dev, UDC_EPIRQMSK_ADDR, mask);
  759. }
  760. /**
  761. * pch_udc_read_device_interrupts() - Read the device interrupts
  762. * @dev: Reference to structure of type pch_udc_regs
  763. * Retern The device interrupts
  764. */
  765. static inline u32 pch_udc_read_device_interrupts(struct pch_udc_dev *dev)
  766. {
  767. return pch_udc_readl(dev, UDC_DEVIRQSTS_ADDR);
  768. }
  769. /**
  770. * pch_udc_write_device_interrupts() - Write device interrupts
  771. * @dev: Reference to structure of type pch_udc_regs
  772. * @val: The value to be written to interrupt register
  773. */
  774. static inline void pch_udc_write_device_interrupts(struct pch_udc_dev *dev,
  775. u32 val)
  776. {
  777. pch_udc_writel(dev, val, UDC_DEVIRQSTS_ADDR);
  778. }
  779. /**
  780. * pch_udc_read_ep_interrupts() - Read the endpoint interrupts
  781. * @dev: Reference to structure of type pch_udc_regs
  782. * Retern The endpoint interrupt
  783. */
  784. static inline u32 pch_udc_read_ep_interrupts(struct pch_udc_dev *dev)
  785. {
  786. return pch_udc_readl(dev, UDC_EPIRQSTS_ADDR);
  787. }
  788. /**
  789. * pch_udc_write_ep_interrupts() - Clear endpoint interupts
  790. * @dev: Reference to structure of type pch_udc_regs
  791. * @val: The value to be written to interrupt register
  792. */
  793. static inline void pch_udc_write_ep_interrupts(struct pch_udc_dev *dev,
  794. u32 val)
  795. {
  796. pch_udc_writel(dev, val, UDC_EPIRQSTS_ADDR);
  797. }
  798. /**
  799. * pch_udc_read_device_status() - Read the device status
  800. * @dev: Reference to structure of type pch_udc_regs
  801. * Retern The device status
  802. */
  803. static inline u32 pch_udc_read_device_status(struct pch_udc_dev *dev)
  804. {
  805. return pch_udc_readl(dev, UDC_DEVSTS_ADDR);
  806. }
  807. /**
  808. * pch_udc_read_ep_control() - Read the endpoint control
  809. * @ep: Reference to structure of type pch_udc_ep_regs
  810. * Retern The endpoint control register value
  811. */
  812. static inline u32 pch_udc_read_ep_control(struct pch_udc_ep *ep)
  813. {
  814. return pch_udc_ep_readl(ep, UDC_EPCTL_ADDR);
  815. }
  816. /**
  817. * pch_udc_clear_ep_control() - Clear the endpoint control register
  818. * @ep: Reference to structure of type pch_udc_ep_regs
  819. * Retern The endpoint control register value
  820. */
  821. static inline void pch_udc_clear_ep_control(struct pch_udc_ep *ep)
  822. {
  823. return pch_udc_ep_writel(ep, 0, UDC_EPCTL_ADDR);
  824. }
  825. /**
  826. * pch_udc_read_ep_status() - Read the endpoint status
  827. * @ep: Reference to structure of type pch_udc_ep_regs
  828. * Retern The endpoint status
  829. */
  830. static inline u32 pch_udc_read_ep_status(struct pch_udc_ep *ep)
  831. {
  832. return pch_udc_ep_readl(ep, UDC_EPSTS_ADDR);
  833. }
  834. /**
  835. * pch_udc_clear_ep_status() - Clear the endpoint status
  836. * @ep: Reference to structure of type pch_udc_ep_regs
  837. * @stat: Endpoint status
  838. */
  839. static inline void pch_udc_clear_ep_status(struct pch_udc_ep *ep,
  840. u32 stat)
  841. {
  842. return pch_udc_ep_writel(ep, stat, UDC_EPSTS_ADDR);
  843. }
  844. /**
  845. * pch_udc_ep_set_nak() - Set the bit 7 (SNAK field)
  846. * of the endpoint control register
  847. * @ep: Reference to structure of type pch_udc_ep_regs
  848. */
  849. static inline void pch_udc_ep_set_nak(struct pch_udc_ep *ep)
  850. {
  851. pch_udc_ep_bit_set(ep, UDC_EPCTL_ADDR, UDC_EPCTL_SNAK);
  852. }
  853. /**
  854. * pch_udc_ep_clear_nak() - Set the bit 8 (CNAK field)
  855. * of the endpoint control register
  856. * @ep: reference to structure of type pch_udc_ep_regs
  857. */
  858. static void pch_udc_ep_clear_nak(struct pch_udc_ep *ep)
  859. {
  860. unsigned int loopcnt = 0;
  861. struct pch_udc_dev *dev = ep->dev;
  862. if (!(pch_udc_ep_readl(ep, UDC_EPCTL_ADDR) & UDC_EPCTL_NAK))
  863. return;
  864. if (!ep->in) {
  865. loopcnt = 10000;
  866. while (!(pch_udc_read_ep_status(ep) & UDC_EPSTS_MRXFIFO_EMP) &&
  867. --loopcnt)
  868. udelay(5);
  869. if (!loopcnt)
  870. dev_err(&dev->pdev->dev, "%s: RxFIFO not Empty\n",
  871. __func__);
  872. }
  873. loopcnt = 10000;
  874. while ((pch_udc_read_ep_control(ep) & UDC_EPCTL_NAK) && --loopcnt) {
  875. pch_udc_ep_bit_set(ep, UDC_EPCTL_ADDR, UDC_EPCTL_CNAK);
  876. udelay(5);
  877. }
  878. if (!loopcnt)
  879. dev_err(&dev->pdev->dev, "%s: Clear NAK not set for ep%d%s\n",
  880. __func__, ep->num, (ep->in ? "in" : "out"));
  881. }
  882. /**
  883. * pch_udc_ep_fifo_flush() - Flush the endpoint fifo
  884. * @ep: reference to structure of type pch_udc_ep_regs
  885. * @dir: direction of endpoint
  886. * 0: endpoint is OUT
  887. * !0: endpoint is IN
  888. */
  889. static void pch_udc_ep_fifo_flush(struct pch_udc_ep *ep, int dir)
  890. {
  891. if (dir) { /* IN ep */
  892. pch_udc_ep_bit_set(ep, UDC_EPCTL_ADDR, UDC_EPCTL_F);
  893. return;
  894. }
  895. }
  896. /**
  897. * pch_udc_ep_enable() - This api enables endpoint
  898. * @regs: Reference to structure pch_udc_ep_regs
  899. * @desc: endpoint descriptor
  900. */
  901. static void pch_udc_ep_enable(struct pch_udc_ep *ep,
  902. struct pch_udc_cfg_data *cfg,
  903. const struct usb_endpoint_descriptor *desc)
  904. {
  905. u32 val = 0;
  906. u32 buff_size = 0;
  907. pch_udc_ep_set_trfr_type(ep, desc->bmAttributes);
  908. if (ep->in)
  909. buff_size = UDC_EPIN_BUFF_SIZE;
  910. else
  911. buff_size = UDC_EPOUT_BUFF_SIZE;
  912. pch_udc_ep_set_bufsz(ep, buff_size, ep->in);
  913. pch_udc_ep_set_maxpkt(ep, usb_endpoint_maxp(desc));
  914. pch_udc_ep_set_nak(ep);
  915. pch_udc_ep_fifo_flush(ep, ep->in);
  916. /* Configure the endpoint */
  917. val = ep->num << UDC_CSR_NE_NUM_SHIFT | ep->in << UDC_CSR_NE_DIR_SHIFT |
  918. ((desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) <<
  919. UDC_CSR_NE_TYPE_SHIFT) |
  920. (cfg->cur_cfg << UDC_CSR_NE_CFG_SHIFT) |
  921. (cfg->cur_intf << UDC_CSR_NE_INTF_SHIFT) |
  922. (cfg->cur_alt << UDC_CSR_NE_ALT_SHIFT) |
  923. usb_endpoint_maxp(desc) << UDC_CSR_NE_MAX_PKT_SHIFT;
  924. if (ep->in)
  925. pch_udc_write_csr(ep->dev, val, UDC_EPIN_IDX(ep->num));
  926. else
  927. pch_udc_write_csr(ep->dev, val, UDC_EPOUT_IDX(ep->num));
  928. }
  929. /**
  930. * pch_udc_ep_disable() - This api disables endpoint
  931. * @regs: Reference to structure pch_udc_ep_regs
  932. */
  933. static void pch_udc_ep_disable(struct pch_udc_ep *ep)
  934. {
  935. if (ep->in) {
  936. /* flush the fifo */
  937. pch_udc_ep_writel(ep, UDC_EPCTL_F, UDC_EPCTL_ADDR);
  938. /* set NAK */
  939. pch_udc_ep_writel(ep, UDC_EPCTL_SNAK, UDC_EPCTL_ADDR);
  940. pch_udc_ep_bit_set(ep, UDC_EPSTS_ADDR, UDC_EPSTS_IN);
  941. } else {
  942. /* set NAK */
  943. pch_udc_ep_writel(ep, UDC_EPCTL_SNAK, UDC_EPCTL_ADDR);
  944. }
  945. /* reset desc pointer */
  946. pch_udc_ep_writel(ep, 0, UDC_DESPTR_ADDR);
  947. }
  948. /**
  949. * pch_udc_wait_ep_stall() - Wait EP stall.
  950. * @dev: Reference to pch_udc_dev structure
  951. */
  952. static void pch_udc_wait_ep_stall(struct pch_udc_ep *ep)
  953. {
  954. unsigned int count = 10000;
  955. /* Wait till idle */
  956. while ((pch_udc_read_ep_control(ep) & UDC_EPCTL_S) && --count)
  957. udelay(5);
  958. if (!count)
  959. dev_err(&ep->dev->pdev->dev, "%s: wait error\n", __func__);
  960. }
  961. /**
  962. * pch_udc_init() - This API initializes usb device controller
  963. * @dev: Rreference to pch_udc_regs structure
  964. */
  965. static void pch_udc_init(struct pch_udc_dev *dev)
  966. {
  967. if (NULL == dev) {
  968. pr_err("%s: Invalid address\n", __func__);
  969. return;
  970. }
  971. /* Soft Reset and Reset PHY */
  972. pch_udc_writel(dev, UDC_SRST, UDC_SRST_ADDR);
  973. pch_udc_writel(dev, UDC_SRST | UDC_PSRST, UDC_SRST_ADDR);
  974. mdelay(1);
  975. pch_udc_writel(dev, UDC_SRST, UDC_SRST_ADDR);
  976. pch_udc_writel(dev, 0x00, UDC_SRST_ADDR);
  977. mdelay(1);
  978. /* mask and clear all device interrupts */
  979. pch_udc_bit_set(dev, UDC_DEVIRQMSK_ADDR, UDC_DEVINT_MSK);
  980. pch_udc_bit_set(dev, UDC_DEVIRQSTS_ADDR, UDC_DEVINT_MSK);
  981. /* mask and clear all ep interrupts */
  982. pch_udc_bit_set(dev, UDC_EPIRQMSK_ADDR, UDC_EPINT_MSK_DISABLE_ALL);
  983. pch_udc_bit_set(dev, UDC_EPIRQSTS_ADDR, UDC_EPINT_MSK_DISABLE_ALL);
  984. /* enable dynamic CSR programmingi, self powered and device speed */
  985. if (speed_fs)
  986. pch_udc_bit_set(dev, UDC_DEVCFG_ADDR, UDC_DEVCFG_CSR_PRG |
  987. UDC_DEVCFG_SP | UDC_DEVCFG_SPD_FS);
  988. else /* defaul high speed */
  989. pch_udc_bit_set(dev, UDC_DEVCFG_ADDR, UDC_DEVCFG_CSR_PRG |
  990. UDC_DEVCFG_SP | UDC_DEVCFG_SPD_HS);
  991. pch_udc_bit_set(dev, UDC_DEVCTL_ADDR,
  992. (PCH_UDC_THLEN << UDC_DEVCTL_THLEN_SHIFT) |
  993. (PCH_UDC_BRLEN << UDC_DEVCTL_BRLEN_SHIFT) |
  994. UDC_DEVCTL_MODE | UDC_DEVCTL_BREN |
  995. UDC_DEVCTL_THE);
  996. }
  997. /**
  998. * pch_udc_exit() - This API exit usb device controller
  999. * @dev: Reference to pch_udc_regs structure
  1000. */
  1001. static void pch_udc_exit(struct pch_udc_dev *dev)
  1002. {
  1003. /* mask all device interrupts */
  1004. pch_udc_bit_set(dev, UDC_DEVIRQMSK_ADDR, UDC_DEVINT_MSK);
  1005. /* mask all ep interrupts */
  1006. pch_udc_bit_set(dev, UDC_EPIRQMSK_ADDR, UDC_EPINT_MSK_DISABLE_ALL);
  1007. /* put device in disconnected state */
  1008. pch_udc_set_disconnect(dev);
  1009. }
  1010. /**
  1011. * pch_udc_pcd_get_frame() - This API is invoked to get the current frame number
  1012. * @gadget: Reference to the gadget driver
  1013. *
  1014. * Return codes:
  1015. * 0: Success
  1016. * -EINVAL: If the gadget passed is NULL
  1017. */
  1018. static int pch_udc_pcd_get_frame(struct usb_gadget *gadget)
  1019. {
  1020. struct pch_udc_dev *dev;
  1021. if (!gadget)
  1022. return -EINVAL;
  1023. dev = container_of(gadget, struct pch_udc_dev, gadget);
  1024. return pch_udc_get_frame(dev);
  1025. }
  1026. /**
  1027. * pch_udc_pcd_wakeup() - This API is invoked to initiate a remote wakeup
  1028. * @gadget: Reference to the gadget driver
  1029. *
  1030. * Return codes:
  1031. * 0: Success
  1032. * -EINVAL: If the gadget passed is NULL
  1033. */
  1034. static int pch_udc_pcd_wakeup(struct usb_gadget *gadget)
  1035. {
  1036. struct pch_udc_dev *dev;
  1037. unsigned long flags;
  1038. if (!gadget)
  1039. return -EINVAL;
  1040. dev = container_of(gadget, struct pch_udc_dev, gadget);
  1041. spin_lock_irqsave(&dev->lock, flags);
  1042. pch_udc_rmt_wakeup(dev);
  1043. spin_unlock_irqrestore(&dev->lock, flags);
  1044. return 0;
  1045. }
  1046. /**
  1047. * pch_udc_pcd_selfpowered() - This API is invoked to specify whether the device
  1048. * is self powered or not
  1049. * @gadget: Reference to the gadget driver
  1050. * @value: Specifies self powered or not
  1051. *
  1052. * Return codes:
  1053. * 0: Success
  1054. * -EINVAL: If the gadget passed is NULL
  1055. */
  1056. static int pch_udc_pcd_selfpowered(struct usb_gadget *gadget, int value)
  1057. {
  1058. struct pch_udc_dev *dev;
  1059. if (!gadget)
  1060. return -EINVAL;
  1061. dev = container_of(gadget, struct pch_udc_dev, gadget);
  1062. if (value)
  1063. pch_udc_set_selfpowered(dev);
  1064. else
  1065. pch_udc_clear_selfpowered(dev);
  1066. return 0;
  1067. }
  1068. /**
  1069. * pch_udc_pcd_pullup() - This API is invoked to make the device
  1070. * visible/invisible to the host
  1071. * @gadget: Reference to the gadget driver
  1072. * @is_on: Specifies whether the pull up is made active or inactive
  1073. *
  1074. * Return codes:
  1075. * 0: Success
  1076. * -EINVAL: If the gadget passed is NULL
  1077. */
  1078. static int pch_udc_pcd_pullup(struct usb_gadget *gadget, int is_on)
  1079. {
  1080. struct pch_udc_dev *dev;
  1081. if (!gadget)
  1082. return -EINVAL;
  1083. dev = container_of(gadget, struct pch_udc_dev, gadget);
  1084. if (is_on) {
  1085. pch_udc_reconnect(dev);
  1086. } else {
  1087. if (dev->driver && dev->driver->disconnect) {
  1088. spin_unlock(&dev->lock);
  1089. dev->driver->disconnect(&dev->gadget);
  1090. spin_lock(&dev->lock);
  1091. }
  1092. pch_udc_set_disconnect(dev);
  1093. }
  1094. return 0;
  1095. }
  1096. /**
  1097. * pch_udc_pcd_vbus_session() - This API is used by a driver for an external
  1098. * transceiver (or GPIO) that
  1099. * detects a VBUS power session starting/ending
  1100. * @gadget: Reference to the gadget driver
  1101. * @is_active: specifies whether the session is starting or ending
  1102. *
  1103. * Return codes:
  1104. * 0: Success
  1105. * -EINVAL: If the gadget passed is NULL
  1106. */
  1107. static int pch_udc_pcd_vbus_session(struct usb_gadget *gadget, int is_active)
  1108. {
  1109. struct pch_udc_dev *dev;
  1110. if (!gadget)
  1111. return -EINVAL;
  1112. dev = container_of(gadget, struct pch_udc_dev, gadget);
  1113. pch_udc_vbus_session(dev, is_active);
  1114. return 0;
  1115. }
  1116. /**
  1117. * pch_udc_pcd_vbus_draw() - This API is used by gadget drivers during
  1118. * SET_CONFIGURATION calls to
  1119. * specify how much power the device can consume
  1120. * @gadget: Reference to the gadget driver
  1121. * @mA: specifies the current limit in 2mA unit
  1122. *
  1123. * Return codes:
  1124. * -EINVAL: If the gadget passed is NULL
  1125. * -EOPNOTSUPP:
  1126. */
  1127. static int pch_udc_pcd_vbus_draw(struct usb_gadget *gadget, unsigned int mA)
  1128. {
  1129. return -EOPNOTSUPP;
  1130. }
  1131. static int pch_udc_start(struct usb_gadget *g,
  1132. struct usb_gadget_driver *driver);
  1133. static int pch_udc_stop(struct usb_gadget *g,
  1134. struct usb_gadget_driver *driver);
  1135. static const struct usb_gadget_ops pch_udc_ops = {
  1136. .get_frame = pch_udc_pcd_get_frame,
  1137. .wakeup = pch_udc_pcd_wakeup,
  1138. .set_selfpowered = pch_udc_pcd_selfpowered,
  1139. .pullup = pch_udc_pcd_pullup,
  1140. .vbus_session = pch_udc_pcd_vbus_session,
  1141. .vbus_draw = pch_udc_pcd_vbus_draw,
  1142. .udc_start = pch_udc_start,
  1143. .udc_stop = pch_udc_stop,
  1144. };
  1145. /**
  1146. * pch_vbus_gpio_get_value() - This API gets value of GPIO port as VBUS status.
  1147. * @dev: Reference to the driver structure
  1148. *
  1149. * Return value:
  1150. * 1: VBUS is high
  1151. * 0: VBUS is low
  1152. * -1: It is not enable to detect VBUS using GPIO
  1153. */
  1154. static int pch_vbus_gpio_get_value(struct pch_udc_dev *dev)
  1155. {
  1156. int vbus = 0;
  1157. if (dev->vbus_gpio.port)
  1158. vbus = gpio_get_value(dev->vbus_gpio.port) ? 1 : 0;
  1159. else
  1160. vbus = -1;
  1161. return vbus;
  1162. }
  1163. /**
  1164. * pch_vbus_gpio_work_fall() - This API keeps watch on VBUS becoming Low.
  1165. * If VBUS is Low, disconnect is processed
  1166. * @irq_work: Structure for WorkQueue
  1167. *
  1168. */
  1169. static void pch_vbus_gpio_work_fall(struct work_struct *irq_work)
  1170. {
  1171. struct pch_vbus_gpio_data *vbus_gpio = container_of(irq_work,
  1172. struct pch_vbus_gpio_data, irq_work_fall);
  1173. struct pch_udc_dev *dev =
  1174. container_of(vbus_gpio, struct pch_udc_dev, vbus_gpio);
  1175. int vbus_saved = -1;
  1176. int vbus;
  1177. int count;
  1178. if (!dev->vbus_gpio.port)
  1179. return;
  1180. for (count = 0; count < (PCH_VBUS_PERIOD / PCH_VBUS_INTERVAL);
  1181. count++) {
  1182. vbus = pch_vbus_gpio_get_value(dev);
  1183. if ((vbus_saved == vbus) && (vbus == 0)) {
  1184. dev_dbg(&dev->pdev->dev, "VBUS fell");
  1185. if (dev->driver
  1186. && dev->driver->disconnect) {
  1187. dev->driver->disconnect(
  1188. &dev->gadget);
  1189. }
  1190. if (dev->vbus_gpio.intr)
  1191. pch_udc_init(dev);
  1192. else
  1193. pch_udc_reconnect(dev);
  1194. return;
  1195. }
  1196. vbus_saved = vbus;
  1197. mdelay(PCH_VBUS_INTERVAL);
  1198. }
  1199. }
  1200. /**
  1201. * pch_vbus_gpio_work_rise() - This API checks VBUS is High.
  1202. * If VBUS is High, connect is processed
  1203. * @irq_work: Structure for WorkQueue
  1204. *
  1205. */
  1206. static void pch_vbus_gpio_work_rise(struct work_struct *irq_work)
  1207. {
  1208. struct pch_vbus_gpio_data *vbus_gpio = container_of(irq_work,
  1209. struct pch_vbus_gpio_data, irq_work_rise);
  1210. struct pch_udc_dev *dev =
  1211. container_of(vbus_gpio, struct pch_udc_dev, vbus_gpio);
  1212. int vbus;
  1213. if (!dev->vbus_gpio.port)
  1214. return;
  1215. mdelay(PCH_VBUS_INTERVAL);
  1216. vbus = pch_vbus_gpio_get_value(dev);
  1217. if (vbus == 1) {
  1218. dev_dbg(&dev->pdev->dev, "VBUS rose");
  1219. pch_udc_reconnect(dev);
  1220. return;
  1221. }
  1222. }
  1223. /**
  1224. * pch_vbus_gpio_irq() - IRQ handler for GPIO intrerrupt for changing VBUS
  1225. * @irq: Interrupt request number
  1226. * @dev: Reference to the device structure
  1227. *
  1228. * Return codes:
  1229. * 0: Success
  1230. * -EINVAL: GPIO port is invalid or can't be initialized.
  1231. */
  1232. static irqreturn_t pch_vbus_gpio_irq(int irq, void *data)
  1233. {
  1234. struct pch_udc_dev *dev = (struct pch_udc_dev *)data;
  1235. if (!dev->vbus_gpio.port || !dev->vbus_gpio.intr)
  1236. return IRQ_NONE;
  1237. if (pch_vbus_gpio_get_value(dev))
  1238. schedule_work(&dev->vbus_gpio.irq_work_rise);
  1239. else
  1240. schedule_work(&dev->vbus_gpio.irq_work_fall);
  1241. return IRQ_HANDLED;
  1242. }
  1243. /**
  1244. * pch_vbus_gpio_init() - This API initializes GPIO port detecting VBUS.
  1245. * @dev: Reference to the driver structure
  1246. * @vbus_gpio Number of GPIO port to detect gpio
  1247. *
  1248. * Return codes:
  1249. * 0: Success
  1250. * -EINVAL: GPIO port is invalid or can't be initialized.
  1251. */
  1252. static int pch_vbus_gpio_init(struct pch_udc_dev *dev, int vbus_gpio_port)
  1253. {
  1254. int err;
  1255. int irq_num = 0;
  1256. dev->vbus_gpio.port = 0;
  1257. dev->vbus_gpio.intr = 0;
  1258. if (vbus_gpio_port <= -1)
  1259. return -EINVAL;
  1260. err = gpio_is_valid(vbus_gpio_port);
  1261. if (!err) {
  1262. pr_err("%s: gpio port %d is invalid\n",
  1263. __func__, vbus_gpio_port);
  1264. return -EINVAL;
  1265. }
  1266. err = gpio_request(vbus_gpio_port, "pch_vbus");
  1267. if (err) {
  1268. pr_err("%s: can't request gpio port %d, err: %d\n",
  1269. __func__, vbus_gpio_port, err);
  1270. return -EINVAL;
  1271. }
  1272. dev->vbus_gpio.port = vbus_gpio_port;
  1273. gpio_direction_input(vbus_gpio_port);
  1274. INIT_WORK(&dev->vbus_gpio.irq_work_fall, pch_vbus_gpio_work_fall);
  1275. irq_num = gpio_to_irq(vbus_gpio_port);
  1276. if (irq_num > 0) {
  1277. irq_set_irq_type(irq_num, IRQ_TYPE_EDGE_BOTH);
  1278. err = request_irq(irq_num, pch_vbus_gpio_irq, 0,
  1279. "vbus_detect", dev);
  1280. if (!err) {
  1281. dev->vbus_gpio.intr = irq_num;
  1282. INIT_WORK(&dev->vbus_gpio.irq_work_rise,
  1283. pch_vbus_gpio_work_rise);
  1284. } else {
  1285. pr_err("%s: can't request irq %d, err: %d\n",
  1286. __func__, irq_num, err);
  1287. }
  1288. }
  1289. return 0;
  1290. }
  1291. /**
  1292. * pch_vbus_gpio_free() - This API frees resources of GPIO port
  1293. * @dev: Reference to the driver structure
  1294. */
  1295. static void pch_vbus_gpio_free(struct pch_udc_dev *dev)
  1296. {
  1297. if (dev->vbus_gpio.intr)
  1298. free_irq(dev->vbus_gpio.intr, dev);
  1299. if (dev->vbus_gpio.port)
  1300. gpio_free(dev->vbus_gpio.port);
  1301. }
  1302. /**
  1303. * complete_req() - This API is invoked from the driver when processing
  1304. * of a request is complete
  1305. * @ep: Reference to the endpoint structure
  1306. * @req: Reference to the request structure
  1307. * @status: Indicates the success/failure of completion
  1308. */
  1309. static void complete_req(struct pch_udc_ep *ep, struct pch_udc_request *req,
  1310. int status)
  1311. {
  1312. struct pch_udc_dev *dev;
  1313. unsigned halted = ep->halted;
  1314. list_del_init(&req->queue);
  1315. /* set new status if pending */
  1316. if (req->req.status == -EINPROGRESS)
  1317. req->req.status = status;
  1318. else
  1319. status = req->req.status;
  1320. dev = ep->dev;
  1321. if (req->dma_mapped) {
  1322. if (req->dma == DMA_ADDR_INVALID) {
  1323. if (ep->in)
  1324. dma_unmap_single(&dev->pdev->dev, req->req.dma,
  1325. req->req.length,
  1326. DMA_TO_DEVICE);
  1327. else
  1328. dma_unmap_single(&dev->pdev->dev, req->req.dma,
  1329. req->req.length,
  1330. DMA_FROM_DEVICE);
  1331. req->req.dma = DMA_ADDR_INVALID;
  1332. } else {
  1333. if (ep->in)
  1334. dma_unmap_single(&dev->pdev->dev, req->dma,
  1335. req->req.length,
  1336. DMA_TO_DEVICE);
  1337. else {
  1338. dma_unmap_single(&dev->pdev->dev, req->dma,
  1339. req->req.length,
  1340. DMA_FROM_DEVICE);
  1341. memcpy(req->req.buf, req->buf, req->req.length);
  1342. }
  1343. kfree(req->buf);
  1344. req->dma = DMA_ADDR_INVALID;
  1345. }
  1346. req->dma_mapped = 0;
  1347. }
  1348. ep->halted = 1;
  1349. spin_unlock(&dev->lock);
  1350. if (!ep->in)
  1351. pch_udc_ep_clear_rrdy(ep);
  1352. req->req.complete(&ep->ep, &req->req);
  1353. spin_lock(&dev->lock);
  1354. ep->halted = halted;
  1355. }
  1356. /**
  1357. * empty_req_queue() - This API empties the request queue of an endpoint
  1358. * @ep: Reference to the endpoint structure
  1359. */
  1360. static void empty_req_queue(struct pch_udc_ep *ep)
  1361. {
  1362. struct pch_udc_request *req;
  1363. ep->halted = 1;
  1364. while (!list_empty(&ep->queue)) {
  1365. req = list_entry(ep->queue.next, struct pch_udc_request, queue);
  1366. complete_req(ep, req, -ESHUTDOWN); /* Remove from list */
  1367. }
  1368. }
  1369. /**
  1370. * pch_udc_free_dma_chain() - This function frees the DMA chain created
  1371. * for the request
  1372. * @dev Reference to the driver structure
  1373. * @req Reference to the request to be freed
  1374. *
  1375. * Return codes:
  1376. * 0: Success
  1377. */
  1378. static void pch_udc_free_dma_chain(struct pch_udc_dev *dev,
  1379. struct pch_udc_request *req)
  1380. {
  1381. struct pch_udc_data_dma_desc *td = req->td_data;
  1382. unsigned i = req->chain_len;
  1383. dma_addr_t addr2;
  1384. dma_addr_t addr = (dma_addr_t)td->next;
  1385. td->next = 0x00;
  1386. for (; i > 1; --i) {
  1387. /* do not free first desc., will be done by free for request */
  1388. td = phys_to_virt(addr);
  1389. addr2 = (dma_addr_t)td->next;
  1390. pci_pool_free(dev->data_requests, td, addr);
  1391. td->next = 0x00;
  1392. addr = addr2;
  1393. }
  1394. req->chain_len = 1;
  1395. }
  1396. /**
  1397. * pch_udc_create_dma_chain() - This function creates or reinitializes
  1398. * a DMA chain
  1399. * @ep: Reference to the endpoint structure
  1400. * @req: Reference to the request
  1401. * @buf_len: The buffer length
  1402. * @gfp_flags: Flags to be used while mapping the data buffer
  1403. *
  1404. * Return codes:
  1405. * 0: success,
  1406. * -ENOMEM: pci_pool_alloc invocation fails
  1407. */
  1408. static int pch_udc_create_dma_chain(struct pch_udc_ep *ep,
  1409. struct pch_udc_request *req,
  1410. unsigned long buf_len,
  1411. gfp_t gfp_flags)
  1412. {
  1413. struct pch_udc_data_dma_desc *td = req->td_data, *last;
  1414. unsigned long bytes = req->req.length, i = 0;
  1415. dma_addr_t dma_addr;
  1416. unsigned len = 1;
  1417. if (req->chain_len > 1)
  1418. pch_udc_free_dma_chain(ep->dev, req);
  1419. if (req->dma == DMA_ADDR_INVALID)
  1420. td->dataptr = req->req.dma;
  1421. else
  1422. td->dataptr = req->dma;
  1423. td->status = PCH_UDC_BS_HST_BSY;
  1424. for (; ; bytes -= buf_len, ++len) {
  1425. td->status = PCH_UDC_BS_HST_BSY | min(buf_len, bytes);
  1426. if (bytes <= buf_len)
  1427. break;
  1428. last = td;
  1429. td = pci_pool_alloc(ep->dev->data_requests, gfp_flags,
  1430. &dma_addr);
  1431. if (!td)
  1432. goto nomem;
  1433. i += buf_len;
  1434. td->dataptr = req->td_data->dataptr + i;
  1435. last->next = dma_addr;
  1436. }
  1437. req->td_data_last = td;
  1438. td->status |= PCH_UDC_DMA_LAST;
  1439. td->next = req->td_data_phys;
  1440. req->chain_len = len;
  1441. return 0;
  1442. nomem:
  1443. if (len > 1) {
  1444. req->chain_len = len;
  1445. pch_udc_free_dma_chain(ep->dev, req);
  1446. }
  1447. req->chain_len = 1;
  1448. return -ENOMEM;
  1449. }
  1450. /**
  1451. * prepare_dma() - This function creates and initializes the DMA chain
  1452. * for the request
  1453. * @ep: Reference to the endpoint structure
  1454. * @req: Reference to the request
  1455. * @gfp: Flag to be used while mapping the data buffer
  1456. *
  1457. * Return codes:
  1458. * 0: Success
  1459. * Other 0: linux error number on failure
  1460. */
  1461. static int prepare_dma(struct pch_udc_ep *ep, struct pch_udc_request *req,
  1462. gfp_t gfp)
  1463. {
  1464. int retval;
  1465. /* Allocate and create a DMA chain */
  1466. retval = pch_udc_create_dma_chain(ep, req, ep->ep.maxpacket, gfp);
  1467. if (retval) {
  1468. pr_err("%s: could not create DMA chain:%d\n", __func__, retval);
  1469. return retval;
  1470. }
  1471. if (ep->in)
  1472. req->td_data->status = (req->td_data->status &
  1473. ~PCH_UDC_BUFF_STS) | PCH_UDC_BS_HST_RDY;
  1474. return 0;
  1475. }
  1476. /**
  1477. * process_zlp() - This function process zero length packets
  1478. * from the gadget driver
  1479. * @ep: Reference to the endpoint structure
  1480. * @req: Reference to the request
  1481. */
  1482. static void process_zlp(struct pch_udc_ep *ep, struct pch_udc_request *req)
  1483. {
  1484. struct pch_udc_dev *dev = ep->dev;
  1485. /* IN zlp's are handled by hardware */
  1486. complete_req(ep, req, 0);
  1487. /* if set_config or set_intf is waiting for ack by zlp
  1488. * then set CSR_DONE
  1489. */
  1490. if (dev->set_cfg_not_acked) {
  1491. pch_udc_set_csr_done(dev);
  1492. dev->set_cfg_not_acked = 0;
  1493. }
  1494. /* setup command is ACK'ed now by zlp */
  1495. if (!dev->stall && dev->waiting_zlp_ack) {
  1496. pch_udc_ep_clear_nak(&(dev->ep[UDC_EP0IN_IDX]));
  1497. dev->waiting_zlp_ack = 0;
  1498. }
  1499. }
  1500. /**
  1501. * pch_udc_start_rxrequest() - This function starts the receive requirement.
  1502. * @ep: Reference to the endpoint structure
  1503. * @req: Reference to the request structure
  1504. */
  1505. static void pch_udc_start_rxrequest(struct pch_udc_ep *ep,
  1506. struct pch_udc_request *req)
  1507. {
  1508. struct pch_udc_data_dma_desc *td_data;
  1509. pch_udc_clear_dma(ep->dev, DMA_DIR_RX);
  1510. td_data = req->td_data;
  1511. /* Set the status bits for all descriptors */
  1512. while (1) {
  1513. td_data->status = (td_data->status & ~PCH_UDC_BUFF_STS) |
  1514. PCH_UDC_BS_HST_RDY;
  1515. if ((td_data->status & PCH_UDC_DMA_LAST) == PCH_UDC_DMA_LAST)
  1516. break;
  1517. td_data = phys_to_virt(td_data->next);
  1518. }
  1519. /* Write the descriptor pointer */
  1520. pch_udc_ep_set_ddptr(ep, req->td_data_phys);
  1521. req->dma_going = 1;
  1522. pch_udc_enable_ep_interrupts(ep->dev, UDC_EPINT_OUT_EP0 << ep->num);
  1523. pch_udc_set_dma(ep->dev, DMA_DIR_RX);
  1524. pch_udc_ep_clear_nak(ep);
  1525. pch_udc_ep_set_rrdy(ep);
  1526. }
  1527. /**
  1528. * pch_udc_pcd_ep_enable() - This API enables the endpoint. It is called
  1529. * from gadget driver
  1530. * @usbep: Reference to the USB endpoint structure
  1531. * @desc: Reference to the USB endpoint descriptor structure
  1532. *
  1533. * Return codes:
  1534. * 0: Success
  1535. * -EINVAL:
  1536. * -ESHUTDOWN:
  1537. */
  1538. static int pch_udc_pcd_ep_enable(struct usb_ep *usbep,
  1539. const struct usb_endpoint_descriptor *desc)
  1540. {
  1541. struct pch_udc_ep *ep;
  1542. struct pch_udc_dev *dev;
  1543. unsigned long iflags;
  1544. if (!usbep || (usbep->name == ep0_string) || !desc ||
  1545. (desc->bDescriptorType != USB_DT_ENDPOINT) || !desc->wMaxPacketSize)
  1546. return -EINVAL;
  1547. ep = container_of(usbep, struct pch_udc_ep, ep);
  1548. dev = ep->dev;
  1549. if (!dev->driver || (dev->gadget.speed == USB_SPEED_UNKNOWN))
  1550. return -ESHUTDOWN;
  1551. spin_lock_irqsave(&dev->lock, iflags);
  1552. ep->ep.desc = desc;
  1553. ep->halted = 0;
  1554. pch_udc_ep_enable(ep, &ep->dev->cfg_data, desc);
  1555. ep->ep.maxpacket = usb_endpoint_maxp(desc);
  1556. pch_udc_enable_ep_interrupts(ep->dev, PCH_UDC_EPINT(ep->in, ep->num));
  1557. spin_unlock_irqrestore(&dev->lock, iflags);
  1558. return 0;
  1559. }
  1560. /**
  1561. * pch_udc_pcd_ep_disable() - This API disables endpoint and is called
  1562. * from gadget driver
  1563. * @usbep Reference to the USB endpoint structure
  1564. *
  1565. * Return codes:
  1566. * 0: Success
  1567. * -EINVAL:
  1568. */
  1569. static int pch_udc_pcd_ep_disable(struct usb_ep *usbep)
  1570. {
  1571. struct pch_udc_ep *ep;
  1572. struct pch_udc_dev *dev;
  1573. unsigned long iflags;
  1574. if (!usbep)
  1575. return -EINVAL;
  1576. ep = container_of(usbep, struct pch_udc_ep, ep);
  1577. dev = ep->dev;
  1578. if ((usbep->name == ep0_string) || !ep->ep.desc)
  1579. return -EINVAL;
  1580. spin_lock_irqsave(&ep->dev->lock, iflags);
  1581. empty_req_queue(ep);
  1582. ep->halted = 1;
  1583. pch_udc_ep_disable(ep);
  1584. pch_udc_disable_ep_interrupts(ep->dev, PCH_UDC_EPINT(ep->in, ep->num));
  1585. ep->ep.desc = NULL;
  1586. INIT_LIST_HEAD(&ep->queue);
  1587. spin_unlock_irqrestore(&ep->dev->lock, iflags);
  1588. return 0;
  1589. }
  1590. /**
  1591. * pch_udc_alloc_request() - This function allocates request structure.
  1592. * It is called by gadget driver
  1593. * @usbep: Reference to the USB endpoint structure
  1594. * @gfp: Flag to be used while allocating memory
  1595. *
  1596. * Return codes:
  1597. * NULL: Failure
  1598. * Allocated address: Success
  1599. */
  1600. static struct usb_request *pch_udc_alloc_request(struct usb_ep *usbep,
  1601. gfp_t gfp)
  1602. {
  1603. struct pch_udc_request *req;
  1604. struct pch_udc_ep *ep;
  1605. struct pch_udc_data_dma_desc *dma_desc;
  1606. struct pch_udc_dev *dev;
  1607. if (!usbep)
  1608. return NULL;
  1609. ep = container_of(usbep, struct pch_udc_ep, ep);
  1610. dev = ep->dev;
  1611. req = kzalloc(sizeof *req, gfp);
  1612. if (!req)
  1613. return NULL;
  1614. req->req.dma = DMA_ADDR_INVALID;
  1615. req->dma = DMA_ADDR_INVALID;
  1616. INIT_LIST_HEAD(&req->queue);
  1617. if (!ep->dev->dma_addr)
  1618. return &req->req;
  1619. /* ep0 in requests are allocated from data pool here */
  1620. dma_desc = pci_pool_alloc(ep->dev->data_requests, gfp,
  1621. &req->td_data_phys);
  1622. if (NULL == dma_desc) {
  1623. kfree(req);
  1624. return NULL;
  1625. }
  1626. /* prevent from using desc. - set HOST BUSY */
  1627. dma_desc->status |= PCH_UDC_BS_HST_BSY;
  1628. dma_desc->dataptr = __constant_cpu_to_le32(DMA_ADDR_INVALID);
  1629. req->td_data = dma_desc;
  1630. req->td_data_last = dma_desc;
  1631. req->chain_len = 1;
  1632. return &req->req;
  1633. }
  1634. /**
  1635. * pch_udc_free_request() - This function frees request structure.
  1636. * It is called by gadget driver
  1637. * @usbep: Reference to the USB endpoint structure
  1638. * @usbreq: Reference to the USB request
  1639. */
  1640. static void pch_udc_free_request(struct usb_ep *usbep,
  1641. struct usb_request *usbreq)
  1642. {
  1643. struct pch_udc_ep *ep;
  1644. struct pch_udc_request *req;
  1645. struct pch_udc_dev *dev;
  1646. if (!usbep || !usbreq)
  1647. return;
  1648. ep = container_of(usbep, struct pch_udc_ep, ep);
  1649. req = container_of(usbreq, struct pch_udc_request, req);
  1650. dev = ep->dev;
  1651. if (!list_empty(&req->queue))
  1652. dev_err(&dev->pdev->dev, "%s: %s req=0x%p queue not empty\n",
  1653. __func__, usbep->name, req);
  1654. if (req->td_data != NULL) {
  1655. if (req->chain_len > 1)
  1656. pch_udc_free_dma_chain(ep->dev, req);
  1657. pci_pool_free(ep->dev->data_requests, req->td_data,
  1658. req->td_data_phys);
  1659. }
  1660. kfree(req);
  1661. }
  1662. /**
  1663. * pch_udc_pcd_queue() - This function queues a request packet. It is called
  1664. * by gadget driver
  1665. * @usbep: Reference to the USB endpoint structure
  1666. * @usbreq: Reference to the USB request
  1667. * @gfp: Flag to be used while mapping the data buffer
  1668. *
  1669. * Return codes:
  1670. * 0: Success
  1671. * linux error number: Failure
  1672. */
  1673. static int pch_udc_pcd_queue(struct usb_ep *usbep, struct usb_request *usbreq,
  1674. gfp_t gfp)
  1675. {
  1676. int retval = 0;
  1677. struct pch_udc_ep *ep;
  1678. struct pch_udc_dev *dev;
  1679. struct pch_udc_request *req;
  1680. unsigned long iflags;
  1681. if (!usbep || !usbreq || !usbreq->complete || !usbreq->buf)
  1682. return -EINVAL;
  1683. ep = container_of(usbep, struct pch_udc_ep, ep);
  1684. dev = ep->dev;
  1685. if (!ep->ep.desc && ep->num)
  1686. return -EINVAL;
  1687. req = container_of(usbreq, struct pch_udc_request, req);
  1688. if (!list_empty(&req->queue))
  1689. return -EINVAL;
  1690. if (!dev->driver || (dev->gadget.speed == USB_SPEED_UNKNOWN))
  1691. return -ESHUTDOWN;
  1692. spin_lock_irqsave(&dev->lock, iflags);
  1693. /* map the buffer for dma */
  1694. if (usbreq->length &&
  1695. ((usbreq->dma == DMA_ADDR_INVALID) || !usbreq->dma)) {
  1696. if (!((unsigned long)(usbreq->buf) & 0x03)) {
  1697. if (ep->in)
  1698. usbreq->dma = dma_map_single(&dev->pdev->dev,
  1699. usbreq->buf,
  1700. usbreq->length,
  1701. DMA_TO_DEVICE);
  1702. else
  1703. usbreq->dma = dma_map_single(&dev->pdev->dev,
  1704. usbreq->buf,
  1705. usbreq->length,
  1706. DMA_FROM_DEVICE);
  1707. } else {
  1708. req->buf = kzalloc(usbreq->length, GFP_ATOMIC);
  1709. if (!req->buf) {
  1710. retval = -ENOMEM;
  1711. goto probe_end;
  1712. }
  1713. if (ep->in) {
  1714. memcpy(req->buf, usbreq->buf, usbreq->length);
  1715. req->dma = dma_map_single(&dev->pdev->dev,
  1716. req->buf,
  1717. usbreq->length,
  1718. DMA_TO_DEVICE);
  1719. } else
  1720. req->dma = dma_map_single(&dev->pdev->dev,
  1721. req->buf,
  1722. usbreq->length,
  1723. DMA_FROM_DEVICE);
  1724. }
  1725. req->dma_mapped = 1;
  1726. }
  1727. if (usbreq->length > 0) {
  1728. retval = prepare_dma(ep, req, GFP_ATOMIC);
  1729. if (retval)
  1730. goto probe_end;
  1731. }
  1732. usbreq->actual = 0;
  1733. usbreq->status = -EINPROGRESS;
  1734. req->dma_done = 0;
  1735. if (list_empty(&ep->queue) && !ep->halted) {
  1736. /* no pending transfer, so start this req */
  1737. if (!usbreq->length) {
  1738. process_zlp(ep, req);
  1739. retval = 0;
  1740. goto probe_end;
  1741. }
  1742. if (!ep->in) {
  1743. pch_udc_start_rxrequest(ep, req);
  1744. } else {
  1745. /*
  1746. * For IN trfr the descriptors will be programmed and
  1747. * P bit will be set when
  1748. * we get an IN token
  1749. */
  1750. pch_udc_wait_ep_stall(ep);
  1751. pch_udc_ep_clear_nak(ep);
  1752. pch_udc_enable_ep_interrupts(ep->dev, (1 << ep->num));
  1753. }
  1754. }
  1755. /* Now add this request to the ep's pending requests */
  1756. if (req != NULL)
  1757. list_add_tail(&req->queue, &ep->queue);
  1758. probe_end:
  1759. spin_unlock_irqrestore(&dev->lock, iflags);
  1760. return retval;
  1761. }
  1762. /**
  1763. * pch_udc_pcd_dequeue() - This function de-queues a request packet.
  1764. * It is called by gadget driver
  1765. * @usbep: Reference to the USB endpoint structure
  1766. * @usbreq: Reference to the USB request
  1767. *
  1768. * Return codes:
  1769. * 0: Success
  1770. * linux error number: Failure
  1771. */
  1772. static int pch_udc_pcd_dequeue(struct usb_ep *usbep,
  1773. struct usb_request *usbreq)
  1774. {
  1775. struct pch_udc_ep *ep;
  1776. struct pch_udc_request *req;
  1777. struct pch_udc_dev *dev;
  1778. unsigned long flags;
  1779. int ret = -EINVAL;
  1780. ep = container_of(usbep, struct pch_udc_ep, ep);
  1781. dev = ep->dev;
  1782. if (!usbep || !usbreq || (!ep->ep.desc && ep->num))
  1783. return ret;
  1784. req = container_of(usbreq, struct pch_udc_request, req);
  1785. spin_lock_irqsave(&ep->dev->lock, flags);
  1786. /* make sure it's still queued on this endpoint */
  1787. list_for_each_entry(req, &ep->queue, queue) {
  1788. if (&req->req == usbreq) {
  1789. pch_udc_ep_set_nak(ep);
  1790. if (!list_empty(&req->queue))
  1791. complete_req(ep, req, -ECONNRESET);
  1792. ret = 0;
  1793. break;
  1794. }
  1795. }
  1796. spin_unlock_irqrestore(&ep->dev->lock, flags);
  1797. return ret;
  1798. }
  1799. /**
  1800. * pch_udc_pcd_set_halt() - This function Sets or clear the endpoint halt
  1801. * feature
  1802. * @usbep: Reference to the USB endpoint structure
  1803. * @halt: Specifies whether to set or clear the feature
  1804. *
  1805. * Return codes:
  1806. * 0: Success
  1807. * linux error number: Failure
  1808. */
  1809. static int pch_udc_pcd_set_halt(struct usb_ep *usbep, int halt)
  1810. {
  1811. struct pch_udc_ep *ep;
  1812. struct pch_udc_dev *dev;
  1813. unsigned long iflags;
  1814. int ret;
  1815. if (!usbep)
  1816. return -EINVAL;
  1817. ep = container_of(usbep, struct pch_udc_ep, ep);
  1818. dev = ep->dev;
  1819. if (!ep->ep.desc && !ep->num)
  1820. return -EINVAL;
  1821. if (!ep->dev->driver || (ep->dev->gadget.speed == USB_SPEED_UNKNOWN))
  1822. return -ESHUTDOWN;
  1823. spin_lock_irqsave(&udc_stall_spinlock, iflags);
  1824. if (list_empty(&ep->queue)) {
  1825. if (halt) {
  1826. if (ep->num == PCH_UDC_EP0)
  1827. ep->dev->stall = 1;
  1828. pch_udc_ep_set_stall(ep);
  1829. pch_udc_enable_ep_interrupts(ep->dev,
  1830. PCH_UDC_EPINT(ep->in,
  1831. ep->num));
  1832. } else {
  1833. pch_udc_ep_clear_stall(ep);
  1834. }
  1835. ret = 0;
  1836. } else {
  1837. ret = -EAGAIN;
  1838. }
  1839. spin_unlock_irqrestore(&udc_stall_spinlock, iflags);
  1840. return ret;
  1841. }
  1842. /**
  1843. * pch_udc_pcd_set_wedge() - This function Sets or clear the endpoint
  1844. * halt feature
  1845. * @usbep: Reference to the USB endpoint structure
  1846. * @halt: Specifies whether to set or clear the feature
  1847. *
  1848. * Return codes:
  1849. * 0: Success
  1850. * linux error number: Failure
  1851. */
  1852. static int pch_udc_pcd_set_wedge(struct usb_ep *usbep)
  1853. {
  1854. struct pch_udc_ep *ep;
  1855. struct pch_udc_dev *dev;
  1856. unsigned long iflags;
  1857. int ret;
  1858. if (!usbep)
  1859. return -EINVAL;
  1860. ep = container_of(usbep, struct pch_udc_ep, ep);
  1861. dev = ep->dev;
  1862. if (!ep->ep.desc && !ep->num)
  1863. return -EINVAL;
  1864. if (!ep->dev->driver || (ep->dev->gadget.speed == USB_SPEED_UNKNOWN))
  1865. return -ESHUTDOWN;
  1866. spin_lock_irqsave(&udc_stall_spinlock, iflags);
  1867. if (!list_empty(&ep->queue)) {
  1868. ret = -EAGAIN;
  1869. } else {
  1870. if (ep->num == PCH_UDC_EP0)
  1871. ep->dev->stall = 1;
  1872. pch_udc_ep_set_stall(ep);
  1873. pch_udc_enable_ep_interrupts(ep->dev,
  1874. PCH_UDC_EPINT(ep->in, ep->num));
  1875. ep->dev->prot_stall = 1;
  1876. ret = 0;
  1877. }
  1878. spin_unlock_irqrestore(&udc_stall_spinlock, iflags);
  1879. return ret;
  1880. }
  1881. /**
  1882. * pch_udc_pcd_fifo_flush() - This function Flush the FIFO of specified endpoint
  1883. * @usbep: Reference to the USB endpoint structure
  1884. */
  1885. static void pch_udc_pcd_fifo_flush(struct usb_ep *usbep)
  1886. {
  1887. struct pch_udc_ep *ep;
  1888. if (!usbep)
  1889. return;
  1890. ep = container_of(usbep, struct pch_udc_ep, ep);
  1891. if (ep->ep.desc || !ep->num)
  1892. pch_udc_ep_fifo_flush(ep, ep->in);
  1893. }
  1894. static const struct usb_ep_ops pch_udc_ep_ops = {
  1895. .enable = pch_udc_pcd_ep_enable,
  1896. .disable = pch_udc_pcd_ep_disable,
  1897. .alloc_request = pch_udc_alloc_request,
  1898. .free_request = pch_udc_free_request,
  1899. .queue = pch_udc_pcd_queue,
  1900. .dequeue = pch_udc_pcd_dequeue,
  1901. .set_halt = pch_udc_pcd_set_halt,
  1902. .set_wedge = pch_udc_pcd_set_wedge,
  1903. .fifo_status = NULL,
  1904. .fifo_flush = pch_udc_pcd_fifo_flush,
  1905. };
  1906. /**
  1907. * pch_udc_init_setup_buff() - This function initializes the SETUP buffer
  1908. * @td_stp: Reference to the SETP buffer structure
  1909. */
  1910. static void pch_udc_init_setup_buff(struct pch_udc_stp_dma_desc *td_stp)
  1911. {
  1912. static u32 pky_marker;
  1913. if (!td_stp)
  1914. return;
  1915. td_stp->reserved = ++pky_marker;
  1916. memset(&td_stp->request, 0xFF, sizeof td_stp->request);
  1917. td_stp->status = PCH_UDC_BS_HST_RDY;
  1918. }
  1919. /**
  1920. * pch_udc_start_next_txrequest() - This function starts
  1921. * the next transmission requirement
  1922. * @ep: Reference to the endpoint structure
  1923. */
  1924. static void pch_udc_start_next_txrequest(struct pch_udc_ep *ep)
  1925. {
  1926. struct pch_udc_request *req;
  1927. struct pch_udc_data_dma_desc *td_data;
  1928. if (pch_udc_read_ep_control(ep) & UDC_EPCTL_P)
  1929. return;
  1930. if (list_empty(&ep->queue))
  1931. return;
  1932. /* next request */
  1933. req = list_entry(ep->queue.next, struct pch_udc_request, queue);
  1934. if (req->dma_going)
  1935. return;
  1936. if (!req->td_data)
  1937. return;
  1938. pch_udc_wait_ep_stall(ep);
  1939. req->dma_going = 1;
  1940. pch_udc_ep_set_ddptr(ep, 0);
  1941. td_data = req->td_data;
  1942. while (1) {
  1943. td_data->status = (td_data->status & ~PCH_UDC_BUFF_STS) |
  1944. PCH_UDC_BS_HST_RDY;
  1945. if ((td_data->status & PCH_UDC_DMA_LAST) == PCH_UDC_DMA_LAST)
  1946. break;
  1947. td_data = phys_to_virt(td_data->next);
  1948. }
  1949. pch_udc_ep_set_ddptr(ep, req->td_data_phys);
  1950. pch_udc_set_dma(ep->dev, DMA_DIR_TX);
  1951. pch_udc_ep_set_pd(ep);
  1952. pch_udc_enable_ep_interrupts(ep->dev, PCH_UDC_EPINT(ep->in, ep->num));
  1953. pch_udc_ep_clear_nak(ep);
  1954. }
  1955. /**
  1956. * pch_udc_complete_transfer() - This function completes a transfer
  1957. * @ep: Reference to the endpoint structure
  1958. */
  1959. static void pch_udc_complete_transfer(struct pch_udc_ep *ep)
  1960. {
  1961. struct pch_udc_request *req;
  1962. struct pch_udc_dev *dev = ep->dev;
  1963. if (list_empty(&ep->queue))
  1964. return;
  1965. req = list_entry(ep->queue.next, struct pch_udc_request, queue);
  1966. if ((req->td_data_last->status & PCH_UDC_BUFF_STS) !=
  1967. PCH_UDC_BS_DMA_DONE)
  1968. return;
  1969. if ((req->td_data_last->status & PCH_UDC_RXTX_STS) !=
  1970. PCH_UDC_RTS_SUCC) {
  1971. dev_err(&dev->pdev->dev, "Invalid RXTX status (0x%08x) "
  1972. "epstatus=0x%08x\n",
  1973. (req->td_data_last->status & PCH_UDC_RXTX_STS),
  1974. (int)(ep->epsts));
  1975. return;
  1976. }
  1977. req->req.actual = req->req.length;
  1978. req->td_data_last->status = PCH_UDC_BS_HST_BSY | PCH_UDC_DMA_LAST;
  1979. req->td_data->status = PCH_UDC_BS_HST_BSY | PCH_UDC_DMA_LAST;
  1980. complete_req(ep, req, 0);
  1981. req->dma_going = 0;
  1982. if (!list_empty(&ep->queue)) {
  1983. pch_udc_wait_ep_stall(ep);
  1984. pch_udc_ep_clear_nak(ep);
  1985. pch_udc_enable_ep_interrupts(ep->dev,
  1986. PCH_UDC_EPINT(ep->in, ep->num));
  1987. } else {
  1988. pch_udc_disable_ep_interrupts(ep->dev,
  1989. PCH_UDC_EPINT(ep->in, ep->num));
  1990. }
  1991. }
  1992. /**
  1993. * pch_udc_complete_receiver() - This function completes a receiver
  1994. * @ep: Reference to the endpoint structure
  1995. */
  1996. static void pch_udc_complete_receiver(struct pch_udc_ep *ep)
  1997. {
  1998. struct pch_udc_request *req;
  1999. struct pch_udc_dev *dev = ep->dev;
  2000. unsigned int count;
  2001. struct pch_udc_data_dma_desc *td;
  2002. dma_addr_t addr;
  2003. if (list_empty(&ep->queue))
  2004. return;
  2005. /* next request */
  2006. req = list_entry(ep->queue.next, struct pch_udc_request, queue);
  2007. pch_udc_clear_dma(ep->dev, DMA_DIR_RX);
  2008. pch_udc_ep_set_ddptr(ep, 0);
  2009. if ((req->td_data_last->status & PCH_UDC_BUFF_STS) ==
  2010. PCH_UDC_BS_DMA_DONE)
  2011. td = req->td_data_last;
  2012. else
  2013. td = req->td_data;
  2014. while (1) {
  2015. if ((td->status & PCH_UDC_RXTX_STS) != PCH_UDC_RTS_SUCC) {
  2016. dev_err(&dev->pdev->dev, "Invalid RXTX status=0x%08x "
  2017. "epstatus=0x%08x\n",
  2018. (req->td_data->status & PCH_UDC_RXTX_STS),
  2019. (int)(ep->epsts));
  2020. return;
  2021. }
  2022. if ((td->status & PCH_UDC_BUFF_STS) == PCH_UDC_BS_DMA_DONE)
  2023. if (td->status & PCH_UDC_DMA_LAST) {
  2024. count = td->status & PCH_UDC_RXTX_BYTES;
  2025. break;
  2026. }
  2027. if (td == req->td_data_last) {
  2028. dev_err(&dev->pdev->dev, "Not complete RX descriptor");
  2029. return;
  2030. }
  2031. addr = (dma_addr_t)td->next;
  2032. td = phys_to_virt(addr);
  2033. }
  2034. /* on 64k packets the RXBYTES field is zero */
  2035. if (!count && (req->req.length == UDC_DMA_MAXPACKET))
  2036. count = UDC_DMA_MAXPACKET;
  2037. req->td_data->status |= PCH_UDC_DMA_LAST;
  2038. td->status |= PCH_UDC_BS_HST_BSY;
  2039. req->dma_going = 0;
  2040. req->req.actual = count;
  2041. complete_req(ep, req, 0);
  2042. /* If there is a new/failed requests try that now */
  2043. if (!list_empty(&ep->queue)) {
  2044. req = list_entry(ep->queue.next, struct pch_udc_request, queue);
  2045. pch_udc_start_rxrequest(ep, req);
  2046. }
  2047. }
  2048. /**
  2049. * pch_udc_svc_data_in() - This function process endpoint interrupts
  2050. * for IN endpoints
  2051. * @dev: Reference to the device structure
  2052. * @ep_num: Endpoint that generated the interrupt
  2053. */
  2054. static void pch_udc_svc_data_in(struct pch_udc_dev *dev, int ep_num)
  2055. {
  2056. u32 epsts;
  2057. struct pch_udc_ep *ep;
  2058. ep = &dev->ep[UDC_EPIN_IDX(ep_num)];
  2059. epsts = ep->epsts;
  2060. ep->epsts = 0;
  2061. if (!(epsts & (UDC_EPSTS_IN | UDC_EPSTS_BNA | UDC_EPSTS_HE |
  2062. UDC_EPSTS_TDC | UDC_EPSTS_RCS | UDC_EPSTS_TXEMPTY |
  2063. UDC_EPSTS_RSS | UDC_EPSTS_XFERDONE)))
  2064. return;
  2065. if ((epsts & UDC_EPSTS_BNA))
  2066. return;
  2067. if (epsts & UDC_EPSTS_HE)
  2068. return;
  2069. if (epsts & UDC_EPSTS_RSS) {
  2070. pch_udc_ep_set_stall(ep);
  2071. pch_udc_enable_ep_interrupts(ep->dev,
  2072. PCH_UDC_EPINT(ep->in, ep->num));
  2073. }
  2074. if (epsts & UDC_EPSTS_RCS) {
  2075. if (!dev->prot_stall) {
  2076. pch_udc_ep_clear_stall(ep);
  2077. } else {
  2078. pch_udc_ep_set_stall(ep);
  2079. pch_udc_enable_ep_interrupts(ep->dev,
  2080. PCH_UDC_EPINT(ep->in, ep->num));
  2081. }
  2082. }
  2083. if (epsts & UDC_EPSTS_TDC)
  2084. pch_udc_complete_transfer(ep);
  2085. /* On IN interrupt, provide data if we have any */
  2086. if ((epsts & UDC_EPSTS_IN) && !(epsts & UDC_EPSTS_RSS) &&
  2087. !(epsts & UDC_EPSTS_TDC) && !(epsts & UDC_EPSTS_TXEMPTY))
  2088. pch_udc_start_next_txrequest(ep);
  2089. }
  2090. /**
  2091. * pch_udc_svc_data_out() - Handles interrupts from OUT endpoint
  2092. * @dev: Reference to the device structure
  2093. * @ep_num: Endpoint that generated the interrupt
  2094. */
  2095. static void pch_udc_svc_data_out(struct pch_udc_dev *dev, int ep_num)
  2096. {
  2097. u32 epsts;
  2098. struct pch_udc_ep *ep;
  2099. struct pch_udc_request *req = NULL;
  2100. ep = &dev->ep[UDC_EPOUT_IDX(ep_num)];
  2101. epsts = ep->epsts;
  2102. ep->epsts = 0;
  2103. if ((epsts & UDC_EPSTS_BNA) && (!list_empty(&ep->queue))) {
  2104. /* next request */
  2105. req = list_entry(ep->queue.next, struct pch_udc_request,
  2106. queue);
  2107. if ((req->td_data_last->status & PCH_UDC_BUFF_STS) !=
  2108. PCH_UDC_BS_DMA_DONE) {
  2109. if (!req->dma_going)
  2110. pch_udc_start_rxrequest(ep, req);
  2111. return;
  2112. }
  2113. }
  2114. if (epsts & UDC_EPSTS_HE)
  2115. return;
  2116. if (epsts & UDC_EPSTS_RSS) {
  2117. pch_udc_ep_set_stall(ep);
  2118. pch_udc_enable_ep_interrupts(ep->dev,
  2119. PCH_UDC_EPINT(ep->in, ep->num));
  2120. }
  2121. if (epsts & UDC_EPSTS_RCS) {
  2122. if (!dev->prot_stall) {
  2123. pch_udc_ep_clear_stall(ep);
  2124. } else {
  2125. pch_udc_ep_set_stall(ep);
  2126. pch_udc_enable_ep_interrupts(ep->dev,
  2127. PCH_UDC_EPINT(ep->in, ep->num));
  2128. }
  2129. }
  2130. if (((epsts & UDC_EPSTS_OUT_MASK) >> UDC_EPSTS_OUT_SHIFT) ==
  2131. UDC_EPSTS_OUT_DATA) {
  2132. if (ep->dev->prot_stall == 1) {
  2133. pch_udc_ep_set_stall(ep);
  2134. pch_udc_enable_ep_interrupts(ep->dev,
  2135. PCH_UDC_EPINT(ep->in, ep->num));
  2136. } else {
  2137. pch_udc_complete_receiver(ep);
  2138. }
  2139. }
  2140. if (list_empty(&ep->queue))
  2141. pch_udc_set_dma(dev, DMA_DIR_RX);
  2142. }
  2143. /**
  2144. * pch_udc_svc_control_in() - Handle Control IN endpoint interrupts
  2145. * @dev: Reference to the device structure
  2146. */
  2147. static void pch_udc_svc_control_in(struct pch_udc_dev *dev)
  2148. {
  2149. u32 epsts;
  2150. struct pch_udc_ep *ep;
  2151. struct pch_udc_ep *ep_out;
  2152. ep = &dev->ep[UDC_EP0IN_IDX];
  2153. ep_out = &dev->ep[UDC_EP0OUT_IDX];
  2154. epsts = ep->epsts;
  2155. ep->epsts = 0;
  2156. if (!(epsts & (UDC_EPSTS_IN | UDC_EPSTS_BNA | UDC_EPSTS_HE |
  2157. UDC_EPSTS_TDC | UDC_EPSTS_RCS | UDC_EPSTS_TXEMPTY |
  2158. UDC_EPSTS_XFERDONE)))
  2159. return;
  2160. if ((epsts & UDC_EPSTS_BNA))
  2161. return;
  2162. if (epsts & UDC_EPSTS_HE)
  2163. return;
  2164. if ((epsts & UDC_EPSTS_TDC) && (!dev->stall)) {
  2165. pch_udc_complete_transfer(ep);
  2166. pch_udc_clear_dma(dev, DMA_DIR_RX);
  2167. ep_out->td_data->status = (ep_out->td_data->status &
  2168. ~PCH_UDC_BUFF_STS) |
  2169. PCH_UDC_BS_HST_RDY;
  2170. pch_udc_ep_clear_nak(ep_out);
  2171. pch_udc_set_dma(dev, DMA_DIR_RX);
  2172. pch_udc_ep_set_rrdy(ep_out);
  2173. }
  2174. /* On IN interrupt, provide data if we have any */
  2175. if ((epsts & UDC_EPSTS_IN) && !(epsts & UDC_EPSTS_TDC) &&
  2176. !(epsts & UDC_EPSTS_TXEMPTY))
  2177. pch_udc_start_next_txrequest(ep);
  2178. }
  2179. /**
  2180. * pch_udc_svc_control_out() - Routine that handle Control
  2181. * OUT endpoint interrupts
  2182. * @dev: Reference to the device structure
  2183. */
  2184. static void pch_udc_svc_control_out(struct pch_udc_dev *dev)
  2185. {
  2186. u32 stat;
  2187. int setup_supported;
  2188. struct pch_udc_ep *ep;
  2189. ep = &dev->ep[UDC_EP0OUT_IDX];
  2190. stat = ep->epsts;
  2191. ep->epsts = 0;
  2192. /* If setup data */
  2193. if (((stat & UDC_EPSTS_OUT_MASK) >> UDC_EPSTS_OUT_SHIFT) ==
  2194. UDC_EPSTS_OUT_SETUP) {
  2195. dev->stall = 0;
  2196. dev->ep[UDC_EP0IN_IDX].halted = 0;
  2197. dev->ep[UDC_EP0OUT_IDX].halted = 0;
  2198. dev->setup_data = ep->td_stp->request;
  2199. pch_udc_init_setup_buff(ep->td_stp);
  2200. pch_udc_clear_dma(dev, DMA_DIR_RX);
  2201. pch_udc_ep_fifo_flush(&(dev->ep[UDC_EP0IN_IDX]),
  2202. dev->ep[UDC_EP0IN_IDX].in);
  2203. if ((dev->setup_data.bRequestType & USB_DIR_IN))
  2204. dev->gadget.ep0 = &dev->ep[UDC_EP0IN_IDX].ep;
  2205. else /* OUT */
  2206. dev->gadget.ep0 = &ep->ep;
  2207. spin_unlock(&dev->lock);
  2208. /* If Mass storage Reset */
  2209. if ((dev->setup_data.bRequestType == 0x21) &&
  2210. (dev->setup_data.bRequest == 0xFF))
  2211. dev->prot_stall = 0;
  2212. /* call gadget with setup data received */
  2213. setup_supported = dev->driver->setup(&dev->gadget,
  2214. &dev->setup_data);
  2215. spin_lock(&dev->lock);
  2216. if (dev->setup_data.bRequestType & USB_DIR_IN) {
  2217. ep->td_data->status = (ep->td_data->status &
  2218. ~PCH_UDC_BUFF_STS) |
  2219. PCH_UDC_BS_HST_RDY;
  2220. pch_udc_ep_set_ddptr(ep, ep->td_data_phys);
  2221. }
  2222. /* ep0 in returns data on IN phase */
  2223. if (setup_supported >= 0 && setup_supported <
  2224. UDC_EP0IN_MAX_PKT_SIZE) {
  2225. pch_udc_ep_clear_nak(&(dev->ep[UDC_EP0IN_IDX]));
  2226. /* Gadget would have queued a request when
  2227. * we called the setup */
  2228. if (!(dev->setup_data.bRequestType & USB_DIR_IN)) {
  2229. pch_udc_set_dma(dev, DMA_DIR_RX);
  2230. pch_udc_ep_clear_nak(ep);
  2231. }
  2232. } else if (setup_supported < 0) {
  2233. /* if unsupported request, then stall */
  2234. pch_udc_ep_set_stall(&(dev->ep[UDC_EP0IN_IDX]));
  2235. pch_udc_enable_ep_interrupts(ep->dev,
  2236. PCH_UDC_EPINT(ep->in, ep->num));
  2237. dev->stall = 0;
  2238. pch_udc_set_dma(dev, DMA_DIR_RX);
  2239. } else {
  2240. dev->waiting_zlp_ack = 1;
  2241. }
  2242. } else if ((((stat & UDC_EPSTS_OUT_MASK) >> UDC_EPSTS_OUT_SHIFT) ==
  2243. UDC_EPSTS_OUT_DATA) && !dev->stall) {
  2244. pch_udc_clear_dma(dev, DMA_DIR_RX);
  2245. pch_udc_ep_set_ddptr(ep, 0);
  2246. if (!list_empty(&ep->queue)) {
  2247. ep->epsts = stat;
  2248. pch_udc_svc_data_out(dev, PCH_UDC_EP0);
  2249. }
  2250. pch_udc_set_dma(dev, DMA_DIR_RX);
  2251. }
  2252. pch_udc_ep_set_rrdy(ep);
  2253. }
  2254. /**
  2255. * pch_udc_postsvc_epinters() - This function enables end point interrupts
  2256. * and clears NAK status
  2257. * @dev: Reference to the device structure
  2258. * @ep_num: End point number
  2259. */
  2260. static void pch_udc_postsvc_epinters(struct pch_udc_dev *dev, int ep_num)
  2261. {
  2262. struct pch_udc_ep *ep;
  2263. struct pch_udc_request *req;
  2264. ep = &dev->ep[UDC_EPIN_IDX(ep_num)];
  2265. if (!list_empty(&ep->queue)) {
  2266. req = list_entry(ep->queue.next, struct pch_udc_request, queue);
  2267. pch_udc_enable_ep_interrupts(ep->dev,
  2268. PCH_UDC_EPINT(ep->in, ep->num));
  2269. pch_udc_ep_clear_nak(ep);
  2270. }
  2271. }
  2272. /**
  2273. * pch_udc_read_all_epstatus() - This function read all endpoint status
  2274. * @dev: Reference to the device structure
  2275. * @ep_intr: Status of endpoint interrupt
  2276. */
  2277. static void pch_udc_read_all_epstatus(struct pch_udc_dev *dev, u32 ep_intr)
  2278. {
  2279. int i;
  2280. struct pch_udc_ep *ep;
  2281. for (i = 0; i < PCH_UDC_USED_EP_NUM; i++) {
  2282. /* IN */
  2283. if (ep_intr & (0x1 << i)) {
  2284. ep = &dev->ep[UDC_EPIN_IDX(i)];
  2285. ep->epsts = pch_udc_read_ep_status(ep);
  2286. pch_udc_clear_ep_status(ep, ep->epsts);
  2287. }
  2288. /* OUT */
  2289. if (ep_intr & (0x10000 << i)) {
  2290. ep = &dev->ep[UDC_EPOUT_IDX(i)];
  2291. ep->epsts = pch_udc_read_ep_status(ep);
  2292. pch_udc_clear_ep_status(ep, ep->epsts);
  2293. }
  2294. }
  2295. }
  2296. /**
  2297. * pch_udc_activate_control_ep() - This function enables the control endpoints
  2298. * for traffic after a reset
  2299. * @dev: Reference to the device structure
  2300. */
  2301. static void pch_udc_activate_control_ep(struct pch_udc_dev *dev)
  2302. {
  2303. struct pch_udc_ep *ep;
  2304. u32 val;
  2305. /* Setup the IN endpoint */
  2306. ep = &dev->ep[UDC_EP0IN_IDX];
  2307. pch_udc_clear_ep_control(ep);
  2308. pch_udc_ep_fifo_flush(ep, ep->in);
  2309. pch_udc_ep_set_bufsz(ep, UDC_EP0IN_BUFF_SIZE, ep->in);
  2310. pch_udc_ep_set_maxpkt(ep, UDC_EP0IN_MAX_PKT_SIZE);
  2311. /* Initialize the IN EP Descriptor */
  2312. ep->td_data = NULL;
  2313. ep->td_stp = NULL;
  2314. ep->td_data_phys = 0;
  2315. ep->td_stp_phys = 0;
  2316. /* Setup the OUT endpoint */
  2317. ep = &dev->ep[UDC_EP0OUT_IDX];
  2318. pch_udc_clear_ep_control(ep);
  2319. pch_udc_ep_fifo_flush(ep, ep->in);
  2320. pch_udc_ep_set_bufsz(ep, UDC_EP0OUT_BUFF_SIZE, ep->in);
  2321. pch_udc_ep_set_maxpkt(ep, UDC_EP0OUT_MAX_PKT_SIZE);
  2322. val = UDC_EP0OUT_MAX_PKT_SIZE << UDC_CSR_NE_MAX_PKT_SHIFT;
  2323. pch_udc_write_csr(ep->dev, val, UDC_EP0OUT_IDX);
  2324. /* Initialize the SETUP buffer */
  2325. pch_udc_init_setup_buff(ep->td_stp);
  2326. /* Write the pointer address of dma descriptor */
  2327. pch_udc_ep_set_subptr(ep, ep->td_stp_phys);
  2328. /* Write the pointer address of Setup descriptor */
  2329. pch_udc_ep_set_ddptr(ep, ep->td_data_phys);
  2330. /* Initialize the dma descriptor */
  2331. ep->td_data->status = PCH_UDC_DMA_LAST;
  2332. ep->td_data->dataptr = dev->dma_addr;
  2333. ep->td_data->next = ep->td_data_phys;
  2334. pch_udc_ep_clear_nak(ep);
  2335. }
  2336. /**
  2337. * pch_udc_svc_ur_interrupt() - This function handles a USB reset interrupt
  2338. * @dev: Reference to driver structure
  2339. */
  2340. static void pch_udc_svc_ur_interrupt(struct pch_udc_dev *dev)
  2341. {
  2342. struct pch_udc_ep *ep;
  2343. int i;
  2344. pch_udc_clear_dma(dev, DMA_DIR_TX);
  2345. pch_udc_clear_dma(dev, DMA_DIR_RX);
  2346. /* Mask all endpoint interrupts */
  2347. pch_udc_disable_ep_interrupts(dev, UDC_EPINT_MSK_DISABLE_ALL);
  2348. /* clear all endpoint interrupts */
  2349. pch_udc_write_ep_interrupts(dev, UDC_EPINT_MSK_DISABLE_ALL);
  2350. for (i = 0; i < PCH_UDC_EP_NUM; i++) {
  2351. ep = &dev->ep[i];
  2352. pch_udc_clear_ep_status(ep, UDC_EPSTS_ALL_CLR_MASK);
  2353. pch_udc_clear_ep_control(ep);
  2354. pch_udc_ep_set_ddptr(ep, 0);
  2355. pch_udc_write_csr(ep->dev, 0x00, i);
  2356. }
  2357. dev->stall = 0;
  2358. dev->prot_stall = 0;
  2359. dev->waiting_zlp_ack = 0;
  2360. dev->set_cfg_not_acked = 0;
  2361. /* disable ep to empty req queue. Skip the control EP's */
  2362. for (i = 0; i < (PCH_UDC_USED_EP_NUM*2); i++) {
  2363. ep = &dev->ep[i];
  2364. pch_udc_ep_set_nak(ep);
  2365. pch_udc_ep_fifo_flush(ep, ep->in);
  2366. /* Complete request queue */
  2367. empty_req_queue(ep);
  2368. }
  2369. if (dev->driver && dev->driver->disconnect) {
  2370. spin_unlock(&dev->lock);
  2371. dev->driver->disconnect(&dev->gadget);
  2372. spin_lock(&dev->lock);
  2373. }
  2374. }
  2375. /**
  2376. * pch_udc_svc_enum_interrupt() - This function handles a USB speed enumeration
  2377. * done interrupt
  2378. * @dev: Reference to driver structure
  2379. */
  2380. static void pch_udc_svc_enum_interrupt(struct pch_udc_dev *dev)
  2381. {
  2382. u32 dev_stat, dev_speed;
  2383. u32 speed = USB_SPEED_FULL;
  2384. dev_stat = pch_udc_read_device_status(dev);
  2385. dev_speed = (dev_stat & UDC_DEVSTS_ENUM_SPEED_MASK) >>
  2386. UDC_DEVSTS_ENUM_SPEED_SHIFT;
  2387. switch (dev_speed) {
  2388. case UDC_DEVSTS_ENUM_SPEED_HIGH:
  2389. speed = USB_SPEED_HIGH;
  2390. break;
  2391. case UDC_DEVSTS_ENUM_SPEED_FULL:
  2392. speed = USB_SPEED_FULL;
  2393. break;
  2394. case UDC_DEVSTS_ENUM_SPEED_LOW:
  2395. speed = USB_SPEED_LOW;
  2396. break;
  2397. default:
  2398. BUG();
  2399. }
  2400. dev->gadget.speed = speed;
  2401. pch_udc_activate_control_ep(dev);
  2402. pch_udc_enable_ep_interrupts(dev, UDC_EPINT_IN_EP0 | UDC_EPINT_OUT_EP0);
  2403. pch_udc_set_dma(dev, DMA_DIR_TX);
  2404. pch_udc_set_dma(dev, DMA_DIR_RX);
  2405. pch_udc_ep_set_rrdy(&(dev->ep[UDC_EP0OUT_IDX]));
  2406. /* enable device interrupts */
  2407. pch_udc_enable_interrupts(dev, UDC_DEVINT_UR | UDC_DEVINT_US |
  2408. UDC_DEVINT_ES | UDC_DEVINT_ENUM |
  2409. UDC_DEVINT_SI | UDC_DEVINT_SC);
  2410. }
  2411. /**
  2412. * pch_udc_svc_intf_interrupt() - This function handles a set interface
  2413. * interrupt
  2414. * @dev: Reference to driver structure
  2415. */
  2416. static void pch_udc_svc_intf_interrupt(struct pch_udc_dev *dev)
  2417. {
  2418. u32 reg, dev_stat = 0;
  2419. int i, ret;
  2420. dev_stat = pch_udc_read_device_status(dev);
  2421. dev->cfg_data.cur_intf = (dev_stat & UDC_DEVSTS_INTF_MASK) >>
  2422. UDC_DEVSTS_INTF_SHIFT;
  2423. dev->cfg_data.cur_alt = (dev_stat & UDC_DEVSTS_ALT_MASK) >>
  2424. UDC_DEVSTS_ALT_SHIFT;
  2425. dev->set_cfg_not_acked = 1;
  2426. /* Construct the usb request for gadget driver and inform it */
  2427. memset(&dev->setup_data, 0 , sizeof dev->setup_data);
  2428. dev->setup_data.bRequest = USB_REQ_SET_INTERFACE;
  2429. dev->setup_data.bRequestType = USB_RECIP_INTERFACE;
  2430. dev->setup_data.wValue = cpu_to_le16(dev->cfg_data.cur_alt);
  2431. dev->setup_data.wIndex = cpu_to_le16(dev->cfg_data.cur_intf);
  2432. /* programm the Endpoint Cfg registers */
  2433. /* Only one end point cfg register */
  2434. reg = pch_udc_read_csr(dev, UDC_EP0OUT_IDX);
  2435. reg = (reg & ~UDC_CSR_NE_INTF_MASK) |
  2436. (dev->cfg_data.cur_intf << UDC_CSR_NE_INTF_SHIFT);
  2437. reg = (reg & ~UDC_CSR_NE_ALT_MASK) |
  2438. (dev->cfg_data.cur_alt << UDC_CSR_NE_ALT_SHIFT);
  2439. pch_udc_write_csr(dev, reg, UDC_EP0OUT_IDX);
  2440. for (i = 0; i < PCH_UDC_USED_EP_NUM * 2; i++) {
  2441. /* clear stall bits */
  2442. pch_udc_ep_clear_stall(&(dev->ep[i]));
  2443. dev->ep[i].halted = 0;
  2444. }
  2445. dev->stall = 0;
  2446. spin_unlock(&dev->lock);
  2447. ret = dev->driver->setup(&dev->gadget, &dev->setup_data);
  2448. spin_lock(&dev->lock);
  2449. }
  2450. /**
  2451. * pch_udc_svc_cfg_interrupt() - This function handles a set configuration
  2452. * interrupt
  2453. * @dev: Reference to driver structure
  2454. */
  2455. static void pch_udc_svc_cfg_interrupt(struct pch_udc_dev *dev)
  2456. {
  2457. int i, ret;
  2458. u32 reg, dev_stat = 0;
  2459. dev_stat = pch_udc_read_device_status(dev);
  2460. dev->set_cfg_not_acked = 1;
  2461. dev->cfg_data.cur_cfg = (dev_stat & UDC_DEVSTS_CFG_MASK) >>
  2462. UDC_DEVSTS_CFG_SHIFT;
  2463. /* make usb request for gadget driver */
  2464. memset(&dev->setup_data, 0 , sizeof dev->setup_data);
  2465. dev->setup_data.bRequest = USB_REQ_SET_CONFIGURATION;
  2466. dev->setup_data.wValue = cpu_to_le16(dev->cfg_data.cur_cfg);
  2467. /* program the NE registers */
  2468. /* Only one end point cfg register */
  2469. reg = pch_udc_read_csr(dev, UDC_EP0OUT_IDX);
  2470. reg = (reg & ~UDC_CSR_NE_CFG_MASK) |
  2471. (dev->cfg_data.cur_cfg << UDC_CSR_NE_CFG_SHIFT);
  2472. pch_udc_write_csr(dev, reg, UDC_EP0OUT_IDX);
  2473. for (i = 0; i < PCH_UDC_USED_EP_NUM * 2; i++) {
  2474. /* clear stall bits */
  2475. pch_udc_ep_clear_stall(&(dev->ep[i]));
  2476. dev->ep[i].halted = 0;
  2477. }
  2478. dev->stall = 0;
  2479. /* call gadget zero with setup data received */
  2480. spin_unlock(&dev->lock);
  2481. ret = dev->driver->setup(&dev->gadget, &dev->setup_data);
  2482. spin_lock(&dev->lock);
  2483. }
  2484. /**
  2485. * pch_udc_dev_isr() - This function services device interrupts
  2486. * by invoking appropriate routines.
  2487. * @dev: Reference to the device structure
  2488. * @dev_intr: The Device interrupt status.
  2489. */
  2490. static void pch_udc_dev_isr(struct pch_udc_dev *dev, u32 dev_intr)
  2491. {
  2492. int vbus;
  2493. /* USB Reset Interrupt */
  2494. if (dev_intr & UDC_DEVINT_UR) {
  2495. pch_udc_svc_ur_interrupt(dev);
  2496. dev_dbg(&dev->pdev->dev, "USB_RESET\n");
  2497. }
  2498. /* Enumeration Done Interrupt */
  2499. if (dev_intr & UDC_DEVINT_ENUM) {
  2500. pch_udc_svc_enum_interrupt(dev);
  2501. dev_dbg(&dev->pdev->dev, "USB_ENUM\n");
  2502. }
  2503. /* Set Interface Interrupt */
  2504. if (dev_intr & UDC_DEVINT_SI)
  2505. pch_udc_svc_intf_interrupt(dev);
  2506. /* Set Config Interrupt */
  2507. if (dev_intr & UDC_DEVINT_SC)
  2508. pch_udc_svc_cfg_interrupt(dev);
  2509. /* USB Suspend interrupt */
  2510. if (dev_intr & UDC_DEVINT_US) {
  2511. if (dev->driver
  2512. && dev->driver->suspend) {
  2513. spin_unlock(&dev->lock);
  2514. dev->driver->suspend(&dev->gadget);
  2515. spin_lock(&dev->lock);
  2516. }
  2517. vbus = pch_vbus_gpio_get_value(dev);
  2518. if ((dev->vbus_session == 0)
  2519. && (vbus != 1)) {
  2520. if (dev->driver && dev->driver->disconnect) {
  2521. spin_unlock(&dev->lock);
  2522. dev->driver->disconnect(&dev->gadget);
  2523. spin_lock(&dev->lock);
  2524. }
  2525. pch_udc_reconnect(dev);
  2526. } else if ((dev->vbus_session == 0)
  2527. && (vbus == 1)
  2528. && !dev->vbus_gpio.intr)
  2529. schedule_work(&dev->vbus_gpio.irq_work_fall);
  2530. dev_dbg(&dev->pdev->dev, "USB_SUSPEND\n");
  2531. }
  2532. /* Clear the SOF interrupt, if enabled */
  2533. if (dev_intr & UDC_DEVINT_SOF)
  2534. dev_dbg(&dev->pdev->dev, "SOF\n");
  2535. /* ES interrupt, IDLE > 3ms on the USB */
  2536. if (dev_intr & UDC_DEVINT_ES)
  2537. dev_dbg(&dev->pdev->dev, "ES\n");
  2538. /* RWKP interrupt */
  2539. if (dev_intr & UDC_DEVINT_RWKP)
  2540. dev_dbg(&dev->pdev->dev, "RWKP\n");
  2541. }
  2542. /**
  2543. * pch_udc_isr() - This function handles interrupts from the PCH USB Device
  2544. * @irq: Interrupt request number
  2545. * @dev: Reference to the device structure
  2546. */
  2547. static irqreturn_t pch_udc_isr(int irq, void *pdev)
  2548. {
  2549. struct pch_udc_dev *dev = (struct pch_udc_dev *) pdev;
  2550. u32 dev_intr, ep_intr;
  2551. int i;
  2552. dev_intr = pch_udc_read_device_interrupts(dev);
  2553. ep_intr = pch_udc_read_ep_interrupts(dev);
  2554. /* For a hot plug, this find that the controller is hung up. */
  2555. if (dev_intr == ep_intr)
  2556. if (dev_intr == pch_udc_readl(dev, UDC_DEVCFG_ADDR)) {
  2557. dev_dbg(&dev->pdev->dev, "UDC: Hung up\n");
  2558. /* The controller is reset */
  2559. pch_udc_writel(dev, UDC_SRST, UDC_SRST_ADDR);
  2560. return IRQ_HANDLED;
  2561. }
  2562. if (dev_intr)
  2563. /* Clear device interrupts */
  2564. pch_udc_write_device_interrupts(dev, dev_intr);
  2565. if (ep_intr)
  2566. /* Clear ep interrupts */
  2567. pch_udc_write_ep_interrupts(dev, ep_intr);
  2568. if (!dev_intr && !ep_intr)
  2569. return IRQ_NONE;
  2570. spin_lock(&dev->lock);
  2571. if (dev_intr)
  2572. pch_udc_dev_isr(dev, dev_intr);
  2573. if (ep_intr) {
  2574. pch_udc_read_all_epstatus(dev, ep_intr);
  2575. /* Process Control In interrupts, if present */
  2576. if (ep_intr & UDC_EPINT_IN_EP0) {
  2577. pch_udc_svc_control_in(dev);
  2578. pch_udc_postsvc_epinters(dev, 0);
  2579. }
  2580. /* Process Control Out interrupts, if present */
  2581. if (ep_intr & UDC_EPINT_OUT_EP0)
  2582. pch_udc_svc_control_out(dev);
  2583. /* Process data in end point interrupts */
  2584. for (i = 1; i < PCH_UDC_USED_EP_NUM; i++) {
  2585. if (ep_intr & (1 << i)) {
  2586. pch_udc_svc_data_in(dev, i);
  2587. pch_udc_postsvc_epinters(dev, i);
  2588. }
  2589. }
  2590. /* Process data out end point interrupts */
  2591. for (i = UDC_EPINT_OUT_SHIFT + 1; i < (UDC_EPINT_OUT_SHIFT +
  2592. PCH_UDC_USED_EP_NUM); i++)
  2593. if (ep_intr & (1 << i))
  2594. pch_udc_svc_data_out(dev, i -
  2595. UDC_EPINT_OUT_SHIFT);
  2596. }
  2597. spin_unlock(&dev->lock);
  2598. return IRQ_HANDLED;
  2599. }
  2600. /**
  2601. * pch_udc_setup_ep0() - This function enables control endpoint for traffic
  2602. * @dev: Reference to the device structure
  2603. */
  2604. static void pch_udc_setup_ep0(struct pch_udc_dev *dev)
  2605. {
  2606. /* enable ep0 interrupts */
  2607. pch_udc_enable_ep_interrupts(dev, UDC_EPINT_IN_EP0 |
  2608. UDC_EPINT_OUT_EP0);
  2609. /* enable device interrupts */
  2610. pch_udc_enable_interrupts(dev, UDC_DEVINT_UR | UDC_DEVINT_US |
  2611. UDC_DEVINT_ES | UDC_DEVINT_ENUM |
  2612. UDC_DEVINT_SI | UDC_DEVINT_SC);
  2613. }
  2614. /**
  2615. * gadget_release() - Free the gadget driver private data
  2616. * @pdev reference to struct pci_dev
  2617. */
  2618. static void gadget_release(struct device *pdev)
  2619. {
  2620. struct pch_udc_dev *dev = dev_get_drvdata(pdev);
  2621. kfree(dev);
  2622. }
  2623. /**
  2624. * pch_udc_pcd_reinit() - This API initializes the endpoint structures
  2625. * @dev: Reference to the driver structure
  2626. */
  2627. static void pch_udc_pcd_reinit(struct pch_udc_dev *dev)
  2628. {
  2629. const char *const ep_string[] = {
  2630. ep0_string, "ep0out", "ep1in", "ep1out", "ep2in", "ep2out",
  2631. "ep3in", "ep3out", "ep4in", "ep4out", "ep5in", "ep5out",
  2632. "ep6in", "ep6out", "ep7in", "ep7out", "ep8in", "ep8out",
  2633. "ep9in", "ep9out", "ep10in", "ep10out", "ep11in", "ep11out",
  2634. "ep12in", "ep12out", "ep13in", "ep13out", "ep14in", "ep14out",
  2635. "ep15in", "ep15out",
  2636. };
  2637. int i;
  2638. dev->gadget.speed = USB_SPEED_UNKNOWN;
  2639. INIT_LIST_HEAD(&dev->gadget.ep_list);
  2640. /* Initialize the endpoints structures */
  2641. memset(dev->ep, 0, sizeof dev->ep);
  2642. for (i = 0; i < PCH_UDC_EP_NUM; i++) {
  2643. struct pch_udc_ep *ep = &dev->ep[i];
  2644. ep->dev = dev;
  2645. ep->halted = 1;
  2646. ep->num = i / 2;
  2647. ep->in = ~i & 1;
  2648. ep->ep.name = ep_string[i];
  2649. ep->ep.ops = &pch_udc_ep_ops;
  2650. if (ep->in)
  2651. ep->offset_addr = ep->num * UDC_EP_REG_SHIFT;
  2652. else
  2653. ep->offset_addr = (UDC_EPINT_OUT_SHIFT + ep->num) *
  2654. UDC_EP_REG_SHIFT;
  2655. /* need to set ep->ep.maxpacket and set Default Configuration?*/
  2656. ep->ep.maxpacket = UDC_BULK_MAX_PKT_SIZE;
  2657. list_add_tail(&ep->ep.ep_list, &dev->gadget.ep_list);
  2658. INIT_LIST_HEAD(&ep->queue);
  2659. }
  2660. dev->ep[UDC_EP0IN_IDX].ep.maxpacket = UDC_EP0IN_MAX_PKT_SIZE;
  2661. dev->ep[UDC_EP0OUT_IDX].ep.maxpacket = UDC_EP0OUT_MAX_PKT_SIZE;
  2662. /* remove ep0 in and out from the list. They have own pointer */
  2663. list_del_init(&dev->ep[UDC_EP0IN_IDX].ep.ep_list);
  2664. list_del_init(&dev->ep[UDC_EP0OUT_IDX].ep.ep_list);
  2665. dev->gadget.ep0 = &dev->ep[UDC_EP0IN_IDX].ep;
  2666. INIT_LIST_HEAD(&dev->gadget.ep0->ep_list);
  2667. }
  2668. /**
  2669. * pch_udc_pcd_init() - This API initializes the driver structure
  2670. * @dev: Reference to the driver structure
  2671. *
  2672. * Return codes:
  2673. * 0: Success
  2674. */
  2675. static int pch_udc_pcd_init(struct pch_udc_dev *dev)
  2676. {
  2677. pch_udc_init(dev);
  2678. pch_udc_pcd_reinit(dev);
  2679. pch_vbus_gpio_init(dev, vbus_gpio_port);
  2680. return 0;
  2681. }
  2682. /**
  2683. * init_dma_pools() - create dma pools during initialization
  2684. * @pdev: reference to struct pci_dev
  2685. */
  2686. static int init_dma_pools(struct pch_udc_dev *dev)
  2687. {
  2688. struct pch_udc_stp_dma_desc *td_stp;
  2689. struct pch_udc_data_dma_desc *td_data;
  2690. /* DMA setup */
  2691. dev->data_requests = pci_pool_create("data_requests", dev->pdev,
  2692. sizeof(struct pch_udc_data_dma_desc), 0, 0);
  2693. if (!dev->data_requests) {
  2694. dev_err(&dev->pdev->dev, "%s: can't get request data pool\n",
  2695. __func__);
  2696. return -ENOMEM;
  2697. }
  2698. /* dma desc for setup data */
  2699. dev->stp_requests = pci_pool_create("setup requests", dev->pdev,
  2700. sizeof(struct pch_udc_stp_dma_desc), 0, 0);
  2701. if (!dev->stp_requests) {
  2702. dev_err(&dev->pdev->dev, "%s: can't get setup request pool\n",
  2703. __func__);
  2704. return -ENOMEM;
  2705. }
  2706. /* setup */
  2707. td_stp = pci_pool_alloc(dev->stp_requests, GFP_KERNEL,
  2708. &dev->ep[UDC_EP0OUT_IDX].td_stp_phys);
  2709. if (!td_stp) {
  2710. dev_err(&dev->pdev->dev,
  2711. "%s: can't allocate setup dma descriptor\n", __func__);
  2712. return -ENOMEM;
  2713. }
  2714. dev->ep[UDC_EP0OUT_IDX].td_stp = td_stp;
  2715. /* data: 0 packets !? */
  2716. td_data = pci_pool_alloc(dev->data_requests, GFP_KERNEL,
  2717. &dev->ep[UDC_EP0OUT_IDX].td_data_phys);
  2718. if (!td_data) {
  2719. dev_err(&dev->pdev->dev,
  2720. "%s: can't allocate data dma descriptor\n", __func__);
  2721. return -ENOMEM;
  2722. }
  2723. dev->ep[UDC_EP0OUT_IDX].td_data = td_data;
  2724. dev->ep[UDC_EP0IN_IDX].td_stp = NULL;
  2725. dev->ep[UDC_EP0IN_IDX].td_stp_phys = 0;
  2726. dev->ep[UDC_EP0IN_IDX].td_data = NULL;
  2727. dev->ep[UDC_EP0IN_IDX].td_data_phys = 0;
  2728. dev->ep0out_buf = kzalloc(UDC_EP0OUT_BUFF_SIZE * 4, GFP_KERNEL);
  2729. if (!dev->ep0out_buf)
  2730. return -ENOMEM;
  2731. dev->dma_addr = dma_map_single(&dev->pdev->dev, dev->ep0out_buf,
  2732. UDC_EP0OUT_BUFF_SIZE * 4,
  2733. DMA_FROM_DEVICE);
  2734. return 0;
  2735. }
  2736. static int pch_udc_start(struct usb_gadget *g,
  2737. struct usb_gadget_driver *driver)
  2738. {
  2739. struct pch_udc_dev *dev = to_pch_udc(g);
  2740. driver->driver.bus = NULL;
  2741. dev->driver = driver;
  2742. dev->gadget.dev.driver = &driver->driver;
  2743. /* get ready for ep0 traffic */
  2744. pch_udc_setup_ep0(dev);
  2745. /* clear SD */
  2746. if ((pch_vbus_gpio_get_value(dev) != 0) || !dev->vbus_gpio.intr)
  2747. pch_udc_clear_disconnect(dev);
  2748. dev->connected = 1;
  2749. return 0;
  2750. }
  2751. static int pch_udc_stop(struct usb_gadget *g,
  2752. struct usb_gadget_driver *driver)
  2753. {
  2754. struct pch_udc_dev *dev = to_pch_udc(g);
  2755. pch_udc_disable_interrupts(dev, UDC_DEVINT_MSK);
  2756. /* Assures that there are no pending requests with this driver */
  2757. dev->gadget.dev.driver = NULL;
  2758. dev->driver = NULL;
  2759. dev->connected = 0;
  2760. /* set SD */
  2761. pch_udc_set_disconnect(dev);
  2762. return 0;
  2763. }
  2764. static void pch_udc_shutdown(struct pci_dev *pdev)
  2765. {
  2766. struct pch_udc_dev *dev = pci_get_drvdata(pdev);
  2767. pch_udc_disable_interrupts(dev, UDC_DEVINT_MSK);
  2768. pch_udc_disable_ep_interrupts(dev, UDC_EPINT_MSK_DISABLE_ALL);
  2769. /* disable the pullup so the host will think we're gone */
  2770. pch_udc_set_disconnect(dev);
  2771. }
  2772. static void pch_udc_remove(struct pci_dev *pdev)
  2773. {
  2774. struct pch_udc_dev *dev = pci_get_drvdata(pdev);
  2775. usb_del_gadget_udc(&dev->gadget);
  2776. /* gadget driver must not be registered */
  2777. if (dev->driver)
  2778. dev_err(&pdev->dev,
  2779. "%s: gadget driver still bound!!!\n", __func__);
  2780. /* dma pool cleanup */
  2781. if (dev->data_requests)
  2782. pci_pool_destroy(dev->data_requests);
  2783. if (dev->stp_requests) {
  2784. /* cleanup DMA desc's for ep0in */
  2785. if (dev->ep[UDC_EP0OUT_IDX].td_stp) {
  2786. pci_pool_free(dev->stp_requests,
  2787. dev->ep[UDC_EP0OUT_IDX].td_stp,
  2788. dev->ep[UDC_EP0OUT_IDX].td_stp_phys);
  2789. }
  2790. if (dev->ep[UDC_EP0OUT_IDX].td_data) {
  2791. pci_pool_free(dev->stp_requests,
  2792. dev->ep[UDC_EP0OUT_IDX].td_data,
  2793. dev->ep[UDC_EP0OUT_IDX].td_data_phys);
  2794. }
  2795. pci_pool_destroy(dev->stp_requests);
  2796. }
  2797. if (dev->dma_addr)
  2798. dma_unmap_single(&dev->pdev->dev, dev->dma_addr,
  2799. UDC_EP0OUT_BUFF_SIZE * 4, DMA_FROM_DEVICE);
  2800. kfree(dev->ep0out_buf);
  2801. pch_vbus_gpio_free(dev);
  2802. pch_udc_exit(dev);
  2803. if (dev->irq_registered)
  2804. free_irq(pdev->irq, dev);
  2805. if (dev->base_addr)
  2806. iounmap(dev->base_addr);
  2807. if (dev->mem_region)
  2808. release_mem_region(dev->phys_addr,
  2809. pci_resource_len(pdev, PCH_UDC_PCI_BAR));
  2810. if (dev->active)
  2811. pci_disable_device(pdev);
  2812. kfree(dev);
  2813. pci_set_drvdata(pdev, NULL);
  2814. }
  2815. #ifdef CONFIG_PM
  2816. static int pch_udc_suspend(struct pci_dev *pdev, pm_message_t state)
  2817. {
  2818. struct pch_udc_dev *dev = pci_get_drvdata(pdev);
  2819. pch_udc_disable_interrupts(dev, UDC_DEVINT_MSK);
  2820. pch_udc_disable_ep_interrupts(dev, UDC_EPINT_MSK_DISABLE_ALL);
  2821. pci_disable_device(pdev);
  2822. pci_enable_wake(pdev, PCI_D3hot, 0);
  2823. if (pci_save_state(pdev)) {
  2824. dev_err(&pdev->dev,
  2825. "%s: could not save PCI config state\n", __func__);
  2826. return -ENOMEM;
  2827. }
  2828. pci_set_power_state(pdev, pci_choose_state(pdev, state));
  2829. return 0;
  2830. }
  2831. static int pch_udc_resume(struct pci_dev *pdev)
  2832. {
  2833. int ret;
  2834. pci_set_power_state(pdev, PCI_D0);
  2835. pci_restore_state(pdev);
  2836. ret = pci_enable_device(pdev);
  2837. if (ret) {
  2838. dev_err(&pdev->dev, "%s: pci_enable_device failed\n", __func__);
  2839. return ret;
  2840. }
  2841. pci_enable_wake(pdev, PCI_D3hot, 0);
  2842. return 0;
  2843. }
  2844. #else
  2845. #define pch_udc_suspend NULL
  2846. #define pch_udc_resume NULL
  2847. #endif /* CONFIG_PM */
  2848. static int pch_udc_probe(struct pci_dev *pdev,
  2849. const struct pci_device_id *id)
  2850. {
  2851. unsigned long resource;
  2852. unsigned long len;
  2853. int retval;
  2854. struct pch_udc_dev *dev;
  2855. /* init */
  2856. dev = kzalloc(sizeof *dev, GFP_KERNEL);
  2857. if (!dev) {
  2858. pr_err("%s: no memory for device structure\n", __func__);
  2859. return -ENOMEM;
  2860. }
  2861. /* pci setup */
  2862. if (pci_enable_device(pdev) < 0) {
  2863. kfree(dev);
  2864. pr_err("%s: pci_enable_device failed\n", __func__);
  2865. return -ENODEV;
  2866. }
  2867. dev->active = 1;
  2868. pci_set_drvdata(pdev, dev);
  2869. /* PCI resource allocation */
  2870. resource = pci_resource_start(pdev, 1);
  2871. len = pci_resource_len(pdev, 1);
  2872. if (!request_mem_region(resource, len, KBUILD_MODNAME)) {
  2873. dev_err(&pdev->dev, "%s: pci device used already\n", __func__);
  2874. retval = -EBUSY;
  2875. goto finished;
  2876. }
  2877. dev->phys_addr = resource;
  2878. dev->mem_region = 1;
  2879. dev->base_addr = ioremap_nocache(resource, len);
  2880. if (!dev->base_addr) {
  2881. pr_err("%s: device memory cannot be mapped\n", __func__);
  2882. retval = -ENOMEM;
  2883. goto finished;
  2884. }
  2885. if (!pdev->irq) {
  2886. dev_err(&pdev->dev, "%s: irq not set\n", __func__);
  2887. retval = -ENODEV;
  2888. goto finished;
  2889. }
  2890. /* initialize the hardware */
  2891. if (pch_udc_pcd_init(dev)) {
  2892. retval = -ENODEV;
  2893. goto finished;
  2894. }
  2895. if (request_irq(pdev->irq, pch_udc_isr, IRQF_SHARED, KBUILD_MODNAME,
  2896. dev)) {
  2897. dev_err(&pdev->dev, "%s: request_irq(%d) fail\n", __func__,
  2898. pdev->irq);
  2899. retval = -ENODEV;
  2900. goto finished;
  2901. }
  2902. dev->irq = pdev->irq;
  2903. dev->irq_registered = 1;
  2904. pci_set_master(pdev);
  2905. pci_try_set_mwi(pdev);
  2906. /* device struct setup */
  2907. spin_lock_init(&dev->lock);
  2908. dev->pdev = pdev;
  2909. dev->gadget.ops = &pch_udc_ops;
  2910. retval = init_dma_pools(dev);
  2911. if (retval)
  2912. goto finished;
  2913. dev->gadget.dev.release = gadget_release;
  2914. dev->gadget.name = KBUILD_MODNAME;
  2915. dev->gadget.max_speed = USB_SPEED_HIGH;
  2916. /* Put the device in disconnected state till a driver is bound */
  2917. pch_udc_set_disconnect(dev);
  2918. retval = usb_add_gadget_udc(&pdev->dev, &dev->gadget);
  2919. if (retval)
  2920. goto finished;
  2921. return 0;
  2922. finished:
  2923. pch_udc_remove(pdev);
  2924. return retval;
  2925. }
  2926. static DEFINE_PCI_DEVICE_TABLE(pch_udc_pcidev_id) = {
  2927. {
  2928. PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_EG20T_UDC),
  2929. .class = (PCI_CLASS_SERIAL_USB << 8) | 0xfe,
  2930. .class_mask = 0xffffffff,
  2931. },
  2932. {
  2933. PCI_DEVICE(PCI_VENDOR_ID_ROHM, PCI_DEVICE_ID_ML7213_IOH_UDC),
  2934. .class = (PCI_CLASS_SERIAL_USB << 8) | 0xfe,
  2935. .class_mask = 0xffffffff,
  2936. },
  2937. {
  2938. PCI_DEVICE(PCI_VENDOR_ID_ROHM, PCI_DEVICE_ID_ML7831_IOH_UDC),
  2939. .class = (PCI_CLASS_SERIAL_USB << 8) | 0xfe,
  2940. .class_mask = 0xffffffff,
  2941. },
  2942. { 0 },
  2943. };
  2944. MODULE_DEVICE_TABLE(pci, pch_udc_pcidev_id);
  2945. static struct pci_driver pch_udc_driver = {
  2946. .name = KBUILD_MODNAME,
  2947. .id_table = pch_udc_pcidev_id,
  2948. .probe = pch_udc_probe,
  2949. .remove = pch_udc_remove,
  2950. .suspend = pch_udc_suspend,
  2951. .resume = pch_udc_resume,
  2952. .shutdown = pch_udc_shutdown,
  2953. };
  2954. module_pci_driver(pch_udc_driver);
  2955. MODULE_DESCRIPTION("Intel EG20T USB Device Controller");
  2956. MODULE_AUTHOR("LAPIS Semiconductor, <tomoya-linux@dsn.lapis-semi.com>");
  2957. MODULE_LICENSE("GPL");