net2280.c 98 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000300130023003300430053006300730083009301030113012301330143015301630173018301930203021302230233024302530263027302830293030303130323033303430353036303730383039304030413042304330443045304630473048304930503051305230533054305530563057305830593060306130623063306430653066306730683069307030713072307330743075307630773078307930803081308230833084308530863087308830893090309130923093309430953096309730983099310031013102310331043105310631073108310931103111311231133114311531163117311831193120312131223123312431253126312731283129313031313132313331343135313631373138313931403141314231433144314531463147314831493150315131523153315431553156315731583159316031613162316331643165316631673168316931703171317231733174317531763177317831793180318131823183318431853186318731883189319031913192319331943195319631973198319932003201320232033204320532063207320832093210321132123213321432153216321732183219322032213222322332243225322632273228322932303231323232333234323532363237323832393240324132423243324432453246324732483249325032513252325332543255325632573258325932603261326232633264326532663267326832693270327132723273327432753276327732783279328032813282328332843285328632873288328932903291329232933294329532963297329832993300330133023303330433053306330733083309331033113312331333143315331633173318331933203321332233233324332533263327332833293330333133323333333433353336333733383339334033413342334333443345334633473348334933503351335233533354335533563357335833593360336133623363336433653366336733683369337033713372337333743375337633773378337933803381338233833384338533863387338833893390339133923393339433953396339733983399340034013402340334043405340634073408340934103411341234133414341534163417341834193420342134223423342434253426342734283429343034313432343334343435343634373438343934403441344234433444344534463447344834493450345134523453345434553456345734583459346034613462346334643465346634673468346934703471347234733474347534763477347834793480348134823483348434853486348734883489349034913492349334943495349634973498349935003501350235033504350535063507350835093510351135123513351435153516351735183519352035213522352335243525352635273528352935303531353235333534353535363537353835393540354135423543354435453546354735483549355035513552355335543555355635573558355935603561356235633564356535663567356835693570357135723573357435753576357735783579358035813582358335843585358635873588358935903591359235933594359535963597359835993600360136023603360436053606360736083609361036113612361336143615361636173618361936203621362236233624362536263627362836293630363136323633363436353636363736383639364036413642364336443645364636473648364936503651365236533654365536563657365836593660366136623663366436653666366736683669367036713672367336743675367636773678367936803681368236833684368536863687368836893690369136923693369436953696369736983699370037013702370337043705370637073708370937103711371237133714371537163717371837193720372137223723372437253726372737283729373037313732373337343735373637373738373937403741374237433744374537463747374837493750375137523753375437553756375737583759376037613762376337643765376637673768376937703771377237733774377537763777377837793780378137823783378437853786378737883789379037913792
  1. /*
  2. * Driver for the PLX NET2280 USB device controller.
  3. * Specs and errata are available from <http://www.plxtech.com>.
  4. *
  5. * PLX Technology Inc. (formerly NetChip Technology) supported the
  6. * development of this driver.
  7. *
  8. *
  9. * CODE STATUS HIGHLIGHTS
  10. *
  11. * This driver should work well with most "gadget" drivers, including
  12. * the Mass Storage, Serial, and Ethernet/RNDIS gadget drivers
  13. * as well as Gadget Zero and Gadgetfs.
  14. *
  15. * DMA is enabled by default.
  16. *
  17. * MSI is enabled by default. The legacy IRQ is used if MSI couldn't
  18. * be enabled.
  19. *
  20. * Note that almost all the errata workarounds here are only needed for
  21. * rev1 chips. Rev1a silicon (0110) fixes almost all of them.
  22. */
  23. /*
  24. * Copyright (C) 2003 David Brownell
  25. * Copyright (C) 2003-2005 PLX Technology, Inc.
  26. * Copyright (C) 2014 Ricardo Ribalda - Qtechnology/AS
  27. *
  28. * Modified Seth Levy 2005 PLX Technology, Inc. to provide compatibility
  29. * with 2282 chip
  30. *
  31. * Modified Ricardo Ribalda Qtechnology AS to provide compatibility
  32. * with usb 338x chip. Based on PLX driver
  33. *
  34. * This program is free software; you can redistribute it and/or modify
  35. * it under the terms of the GNU General Public License as published by
  36. * the Free Software Foundation; either version 2 of the License, or
  37. * (at your option) any later version.
  38. */
  39. #include <linux/module.h>
  40. #include <linux/pci.h>
  41. #include <linux/dma-mapping.h>
  42. #include <linux/kernel.h>
  43. #include <linux/delay.h>
  44. #include <linux/ioport.h>
  45. #include <linux/slab.h>
  46. #include <linux/errno.h>
  47. #include <linux/init.h>
  48. #include <linux/timer.h>
  49. #include <linux/list.h>
  50. #include <linux/interrupt.h>
  51. #include <linux/moduleparam.h>
  52. #include <linux/device.h>
  53. #include <linux/usb/ch9.h>
  54. #include <linux/usb/gadget.h>
  55. #include <linux/prefetch.h>
  56. #include <linux/io.h>
  57. #include <asm/byteorder.h>
  58. #include <asm/irq.h>
  59. #include <asm/unaligned.h>
  60. #define DRIVER_DESC "PLX NET228x/USB338x USB Peripheral Controller"
  61. #define DRIVER_VERSION "2005 Sept 27/v3.0"
  62. #define EP_DONTUSE 13 /* nonzero */
  63. #define USE_RDK_LEDS /* GPIO pins control three LEDs */
  64. static const char driver_name[] = "net2280";
  65. static const char driver_desc[] = DRIVER_DESC;
  66. static const u32 ep_bit[9] = { 0, 17, 2, 19, 4, 1, 18, 3, 20 };
  67. static const char ep0name[] = "ep0";
  68. #define EP_INFO(_name, _caps) \
  69. { \
  70. .name = _name, \
  71. .caps = _caps, \
  72. }
  73. static const struct {
  74. const char *name;
  75. const struct usb_ep_caps caps;
  76. } ep_info_dft[] = { /* Default endpoint configuration */
  77. EP_INFO(ep0name,
  78. USB_EP_CAPS(USB_EP_CAPS_TYPE_CONTROL, USB_EP_CAPS_DIR_ALL)),
  79. EP_INFO("ep-a",
  80. USB_EP_CAPS(USB_EP_CAPS_TYPE_ALL, USB_EP_CAPS_DIR_ALL)),
  81. EP_INFO("ep-b",
  82. USB_EP_CAPS(USB_EP_CAPS_TYPE_ALL, USB_EP_CAPS_DIR_ALL)),
  83. EP_INFO("ep-c",
  84. USB_EP_CAPS(USB_EP_CAPS_TYPE_ALL, USB_EP_CAPS_DIR_ALL)),
  85. EP_INFO("ep-d",
  86. USB_EP_CAPS(USB_EP_CAPS_TYPE_ALL, USB_EP_CAPS_DIR_ALL)),
  87. EP_INFO("ep-e",
  88. USB_EP_CAPS(USB_EP_CAPS_TYPE_ALL, USB_EP_CAPS_DIR_ALL)),
  89. EP_INFO("ep-f",
  90. USB_EP_CAPS(USB_EP_CAPS_TYPE_ALL, USB_EP_CAPS_DIR_ALL)),
  91. EP_INFO("ep-g",
  92. USB_EP_CAPS(USB_EP_CAPS_TYPE_ALL, USB_EP_CAPS_DIR_ALL)),
  93. EP_INFO("ep-h",
  94. USB_EP_CAPS(USB_EP_CAPS_TYPE_ALL, USB_EP_CAPS_DIR_ALL)),
  95. }, ep_info_adv[] = { /* Endpoints for usb3380 advance mode */
  96. EP_INFO(ep0name,
  97. USB_EP_CAPS(USB_EP_CAPS_TYPE_CONTROL, USB_EP_CAPS_DIR_ALL)),
  98. EP_INFO("ep1in",
  99. USB_EP_CAPS(USB_EP_CAPS_TYPE_ALL, USB_EP_CAPS_DIR_IN)),
  100. EP_INFO("ep2out",
  101. USB_EP_CAPS(USB_EP_CAPS_TYPE_ALL, USB_EP_CAPS_DIR_OUT)),
  102. EP_INFO("ep3in",
  103. USB_EP_CAPS(USB_EP_CAPS_TYPE_ALL, USB_EP_CAPS_DIR_IN)),
  104. EP_INFO("ep4out",
  105. USB_EP_CAPS(USB_EP_CAPS_TYPE_ALL, USB_EP_CAPS_DIR_OUT)),
  106. EP_INFO("ep1out",
  107. USB_EP_CAPS(USB_EP_CAPS_TYPE_ALL, USB_EP_CAPS_DIR_OUT)),
  108. EP_INFO("ep2in",
  109. USB_EP_CAPS(USB_EP_CAPS_TYPE_ALL, USB_EP_CAPS_DIR_IN)),
  110. EP_INFO("ep3out",
  111. USB_EP_CAPS(USB_EP_CAPS_TYPE_ALL, USB_EP_CAPS_DIR_OUT)),
  112. EP_INFO("ep4in",
  113. USB_EP_CAPS(USB_EP_CAPS_TYPE_ALL, USB_EP_CAPS_DIR_IN)),
  114. };
  115. #undef EP_INFO
  116. /* mode 0 == ep-{a,b,c,d} 1K fifo each
  117. * mode 1 == ep-{a,b} 2K fifo each, ep-{c,d} unavailable
  118. * mode 2 == ep-a 2K fifo, ep-{b,c} 1K each, ep-d unavailable
  119. */
  120. static ushort fifo_mode;
  121. /* "modprobe net2280 fifo_mode=1" etc */
  122. module_param(fifo_mode, ushort, 0644);
  123. /* enable_suspend -- When enabled, the driver will respond to
  124. * USB suspend requests by powering down the NET2280. Otherwise,
  125. * USB suspend requests will be ignored. This is acceptable for
  126. * self-powered devices
  127. */
  128. static bool enable_suspend;
  129. /* "modprobe net2280 enable_suspend=1" etc */
  130. module_param(enable_suspend, bool, 0444);
  131. #define DIR_STRING(bAddress) (((bAddress) & USB_DIR_IN) ? "in" : "out")
  132. static char *type_string(u8 bmAttributes)
  133. {
  134. switch ((bmAttributes) & USB_ENDPOINT_XFERTYPE_MASK) {
  135. case USB_ENDPOINT_XFER_BULK: return "bulk";
  136. case USB_ENDPOINT_XFER_ISOC: return "iso";
  137. case USB_ENDPOINT_XFER_INT: return "intr";
  138. }
  139. return "control";
  140. }
  141. #include "net2280.h"
  142. #define valid_bit cpu_to_le32(BIT(VALID_BIT))
  143. #define dma_done_ie cpu_to_le32(BIT(DMA_DONE_INTERRUPT_ENABLE))
  144. static void ep_clear_seqnum(struct net2280_ep *ep);
  145. static void stop_activity(struct net2280 *dev,
  146. struct usb_gadget_driver *driver);
  147. static void ep0_start(struct net2280 *dev);
  148. /*-------------------------------------------------------------------------*/
  149. static inline void enable_pciirqenb(struct net2280_ep *ep)
  150. {
  151. u32 tmp = readl(&ep->dev->regs->pciirqenb0);
  152. if (ep->dev->quirks & PLX_LEGACY)
  153. tmp |= BIT(ep->num);
  154. else
  155. tmp |= BIT(ep_bit[ep->num]);
  156. writel(tmp, &ep->dev->regs->pciirqenb0);
  157. return;
  158. }
  159. static int
  160. net2280_enable(struct usb_ep *_ep, const struct usb_endpoint_descriptor *desc)
  161. {
  162. struct net2280 *dev;
  163. struct net2280_ep *ep;
  164. u32 max;
  165. u32 tmp = 0;
  166. u32 type;
  167. unsigned long flags;
  168. static const u32 ep_key[9] = { 1, 0, 1, 0, 1, 1, 0, 1, 0 };
  169. int ret = 0;
  170. ep = container_of(_ep, struct net2280_ep, ep);
  171. if (!_ep || !desc || ep->desc || _ep->name == ep0name ||
  172. desc->bDescriptorType != USB_DT_ENDPOINT) {
  173. pr_err("%s: failed at line=%d\n", __func__, __LINE__);
  174. return -EINVAL;
  175. }
  176. dev = ep->dev;
  177. if (!dev->driver || dev->gadget.speed == USB_SPEED_UNKNOWN) {
  178. ret = -ESHUTDOWN;
  179. goto print_err;
  180. }
  181. /* erratum 0119 workaround ties up an endpoint number */
  182. if ((desc->bEndpointAddress & 0x0f) == EP_DONTUSE) {
  183. ret = -EDOM;
  184. goto print_err;
  185. }
  186. if (dev->quirks & PLX_SUPERSPEED) {
  187. if ((desc->bEndpointAddress & 0x0f) >= 0x0c) {
  188. ret = -EDOM;
  189. goto print_err;
  190. }
  191. ep->is_in = !!usb_endpoint_dir_in(desc);
  192. if (dev->enhanced_mode && ep->is_in && ep_key[ep->num]) {
  193. ret = -EINVAL;
  194. goto print_err;
  195. }
  196. }
  197. /* sanity check ep-e/ep-f since their fifos are small */
  198. max = usb_endpoint_maxp(desc) & 0x1fff;
  199. if (ep->num > 4 && max > 64 && (dev->quirks & PLX_LEGACY)) {
  200. ret = -ERANGE;
  201. goto print_err;
  202. }
  203. spin_lock_irqsave(&dev->lock, flags);
  204. _ep->maxpacket = max & 0x7ff;
  205. ep->desc = desc;
  206. /* ep_reset() has already been called */
  207. ep->stopped = 0;
  208. ep->wedged = 0;
  209. ep->out_overflow = 0;
  210. /* set speed-dependent max packet; may kick in high bandwidth */
  211. set_max_speed(ep, max);
  212. /* set type, direction, address; reset fifo counters */
  213. writel(BIT(FIFO_FLUSH), &ep->regs->ep_stat);
  214. if ((dev->quirks & PLX_SUPERSPEED) && dev->enhanced_mode) {
  215. tmp = readl(&ep->cfg->ep_cfg);
  216. /* If USB ep number doesn't match hardware ep number */
  217. if ((tmp & 0xf) != usb_endpoint_num(desc)) {
  218. ret = -EINVAL;
  219. spin_unlock_irqrestore(&dev->lock, flags);
  220. goto print_err;
  221. }
  222. if (ep->is_in)
  223. tmp &= ~USB3380_EP_CFG_MASK_IN;
  224. else
  225. tmp &= ~USB3380_EP_CFG_MASK_OUT;
  226. }
  227. type = (desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK);
  228. if (type == USB_ENDPOINT_XFER_INT) {
  229. /* erratum 0105 workaround prevents hs NYET */
  230. if (dev->chiprev == 0100 &&
  231. dev->gadget.speed == USB_SPEED_HIGH &&
  232. !(desc->bEndpointAddress & USB_DIR_IN))
  233. writel(BIT(CLEAR_NAK_OUT_PACKETS_MODE),
  234. &ep->regs->ep_rsp);
  235. } else if (type == USB_ENDPOINT_XFER_BULK) {
  236. /* catch some particularly blatant driver bugs */
  237. if ((dev->gadget.speed == USB_SPEED_SUPER && max != 1024) ||
  238. (dev->gadget.speed == USB_SPEED_HIGH && max != 512) ||
  239. (dev->gadget.speed == USB_SPEED_FULL && max > 64)) {
  240. spin_unlock_irqrestore(&dev->lock, flags);
  241. ret = -ERANGE;
  242. goto print_err;
  243. }
  244. }
  245. ep->is_iso = (type == USB_ENDPOINT_XFER_ISOC);
  246. /* Enable this endpoint */
  247. if (dev->quirks & PLX_LEGACY) {
  248. tmp |= type << ENDPOINT_TYPE;
  249. tmp |= desc->bEndpointAddress;
  250. /* default full fifo lines */
  251. tmp |= (4 << ENDPOINT_BYTE_COUNT);
  252. tmp |= BIT(ENDPOINT_ENABLE);
  253. ep->is_in = (tmp & USB_DIR_IN) != 0;
  254. } else {
  255. /* In Legacy mode, only OUT endpoints are used */
  256. if (dev->enhanced_mode && ep->is_in) {
  257. tmp |= type << IN_ENDPOINT_TYPE;
  258. tmp |= BIT(IN_ENDPOINT_ENABLE);
  259. } else {
  260. tmp |= type << OUT_ENDPOINT_TYPE;
  261. tmp |= BIT(OUT_ENDPOINT_ENABLE);
  262. tmp |= (ep->is_in << ENDPOINT_DIRECTION);
  263. }
  264. tmp |= (4 << ENDPOINT_BYTE_COUNT);
  265. if (!dev->enhanced_mode)
  266. tmp |= usb_endpoint_num(desc);
  267. tmp |= (ep->ep.maxburst << MAX_BURST_SIZE);
  268. }
  269. /* Make sure all the registers are written before ep_rsp*/
  270. wmb();
  271. /* for OUT transfers, block the rx fifo until a read is posted */
  272. if (!ep->is_in)
  273. writel(BIT(SET_NAK_OUT_PACKETS), &ep->regs->ep_rsp);
  274. else if (!(dev->quirks & PLX_2280)) {
  275. /* Added for 2282, Don't use nak packets on an in endpoint,
  276. * this was ignored on 2280
  277. */
  278. writel(BIT(CLEAR_NAK_OUT_PACKETS) |
  279. BIT(CLEAR_NAK_OUT_PACKETS_MODE), &ep->regs->ep_rsp);
  280. }
  281. if (dev->quirks & PLX_SUPERSPEED)
  282. ep_clear_seqnum(ep);
  283. writel(tmp, &ep->cfg->ep_cfg);
  284. /* enable irqs */
  285. if (!ep->dma) { /* pio, per-packet */
  286. enable_pciirqenb(ep);
  287. tmp = BIT(DATA_PACKET_RECEIVED_INTERRUPT_ENABLE) |
  288. BIT(DATA_PACKET_TRANSMITTED_INTERRUPT_ENABLE);
  289. if (dev->quirks & PLX_2280)
  290. tmp |= readl(&ep->regs->ep_irqenb);
  291. writel(tmp, &ep->regs->ep_irqenb);
  292. } else { /* dma, per-request */
  293. tmp = BIT((8 + ep->num)); /* completion */
  294. tmp |= readl(&dev->regs->pciirqenb1);
  295. writel(tmp, &dev->regs->pciirqenb1);
  296. /* for short OUT transfers, dma completions can't
  297. * advance the queue; do it pio-style, by hand.
  298. * NOTE erratum 0112 workaround #2
  299. */
  300. if ((desc->bEndpointAddress & USB_DIR_IN) == 0) {
  301. tmp = BIT(SHORT_PACKET_TRANSFERRED_INTERRUPT_ENABLE);
  302. writel(tmp, &ep->regs->ep_irqenb);
  303. enable_pciirqenb(ep);
  304. }
  305. }
  306. tmp = desc->bEndpointAddress;
  307. ep_dbg(dev, "enabled %s (ep%d%s-%s) %s max %04x\n",
  308. _ep->name, tmp & 0x0f, DIR_STRING(tmp),
  309. type_string(desc->bmAttributes),
  310. ep->dma ? "dma" : "pio", max);
  311. /* pci writes may still be posted */
  312. spin_unlock_irqrestore(&dev->lock, flags);
  313. return ret;
  314. print_err:
  315. dev_err(&ep->dev->pdev->dev, "%s: error=%d\n", __func__, ret);
  316. return ret;
  317. }
  318. static int handshake(u32 __iomem *ptr, u32 mask, u32 done, int usec)
  319. {
  320. u32 result;
  321. do {
  322. result = readl(ptr);
  323. if (result == ~(u32)0) /* "device unplugged" */
  324. return -ENODEV;
  325. result &= mask;
  326. if (result == done)
  327. return 0;
  328. udelay(1);
  329. usec--;
  330. } while (usec > 0);
  331. return -ETIMEDOUT;
  332. }
  333. static const struct usb_ep_ops net2280_ep_ops;
  334. static void ep_reset_228x(struct net2280_regs __iomem *regs,
  335. struct net2280_ep *ep)
  336. {
  337. u32 tmp;
  338. ep->desc = NULL;
  339. INIT_LIST_HEAD(&ep->queue);
  340. usb_ep_set_maxpacket_limit(&ep->ep, ~0);
  341. ep->ep.ops = &net2280_ep_ops;
  342. /* disable the dma, irqs, endpoint... */
  343. if (ep->dma) {
  344. writel(0, &ep->dma->dmactl);
  345. writel(BIT(DMA_SCATTER_GATHER_DONE_INTERRUPT) |
  346. BIT(DMA_TRANSACTION_DONE_INTERRUPT) |
  347. BIT(DMA_ABORT),
  348. &ep->dma->dmastat);
  349. tmp = readl(&regs->pciirqenb0);
  350. tmp &= ~BIT(ep->num);
  351. writel(tmp, &regs->pciirqenb0);
  352. } else {
  353. tmp = readl(&regs->pciirqenb1);
  354. tmp &= ~BIT((8 + ep->num)); /* completion */
  355. writel(tmp, &regs->pciirqenb1);
  356. }
  357. writel(0, &ep->regs->ep_irqenb);
  358. /* init to our chosen defaults, notably so that we NAK OUT
  359. * packets until the driver queues a read (+note erratum 0112)
  360. */
  361. if (!ep->is_in || (ep->dev->quirks & PLX_2280)) {
  362. tmp = BIT(SET_NAK_OUT_PACKETS_MODE) |
  363. BIT(SET_NAK_OUT_PACKETS) |
  364. BIT(CLEAR_EP_HIDE_STATUS_PHASE) |
  365. BIT(CLEAR_INTERRUPT_MODE);
  366. } else {
  367. /* added for 2282 */
  368. tmp = BIT(CLEAR_NAK_OUT_PACKETS_MODE) |
  369. BIT(CLEAR_NAK_OUT_PACKETS) |
  370. BIT(CLEAR_EP_HIDE_STATUS_PHASE) |
  371. BIT(CLEAR_INTERRUPT_MODE);
  372. }
  373. if (ep->num != 0) {
  374. tmp |= BIT(CLEAR_ENDPOINT_TOGGLE) |
  375. BIT(CLEAR_ENDPOINT_HALT);
  376. }
  377. writel(tmp, &ep->regs->ep_rsp);
  378. /* scrub most status bits, and flush any fifo state */
  379. if (ep->dev->quirks & PLX_2280)
  380. tmp = BIT(FIFO_OVERFLOW) |
  381. BIT(FIFO_UNDERFLOW);
  382. else
  383. tmp = 0;
  384. writel(tmp | BIT(TIMEOUT) |
  385. BIT(USB_STALL_SENT) |
  386. BIT(USB_IN_NAK_SENT) |
  387. BIT(USB_IN_ACK_RCVD) |
  388. BIT(USB_OUT_PING_NAK_SENT) |
  389. BIT(USB_OUT_ACK_SENT) |
  390. BIT(FIFO_FLUSH) |
  391. BIT(SHORT_PACKET_OUT_DONE_INTERRUPT) |
  392. BIT(SHORT_PACKET_TRANSFERRED_INTERRUPT) |
  393. BIT(DATA_PACKET_RECEIVED_INTERRUPT) |
  394. BIT(DATA_PACKET_TRANSMITTED_INTERRUPT) |
  395. BIT(DATA_OUT_PING_TOKEN_INTERRUPT) |
  396. BIT(DATA_IN_TOKEN_INTERRUPT),
  397. &ep->regs->ep_stat);
  398. /* fifo size is handled separately */
  399. }
  400. static void ep_reset_338x(struct net2280_regs __iomem *regs,
  401. struct net2280_ep *ep)
  402. {
  403. u32 tmp, dmastat;
  404. ep->desc = NULL;
  405. INIT_LIST_HEAD(&ep->queue);
  406. usb_ep_set_maxpacket_limit(&ep->ep, ~0);
  407. ep->ep.ops = &net2280_ep_ops;
  408. /* disable the dma, irqs, endpoint... */
  409. if (ep->dma) {
  410. writel(0, &ep->dma->dmactl);
  411. writel(BIT(DMA_ABORT_DONE_INTERRUPT) |
  412. BIT(DMA_PAUSE_DONE_INTERRUPT) |
  413. BIT(DMA_SCATTER_GATHER_DONE_INTERRUPT) |
  414. BIT(DMA_TRANSACTION_DONE_INTERRUPT),
  415. /* | BIT(DMA_ABORT), */
  416. &ep->dma->dmastat);
  417. dmastat = readl(&ep->dma->dmastat);
  418. if (dmastat == 0x5002) {
  419. ep_warn(ep->dev, "The dmastat return = %x!!\n",
  420. dmastat);
  421. writel(0x5a, &ep->dma->dmastat);
  422. }
  423. tmp = readl(&regs->pciirqenb0);
  424. tmp &= ~BIT(ep_bit[ep->num]);
  425. writel(tmp, &regs->pciirqenb0);
  426. } else {
  427. if (ep->num < 5) {
  428. tmp = readl(&regs->pciirqenb1);
  429. tmp &= ~BIT((8 + ep->num)); /* completion */
  430. writel(tmp, &regs->pciirqenb1);
  431. }
  432. }
  433. writel(0, &ep->regs->ep_irqenb);
  434. writel(BIT(SHORT_PACKET_OUT_DONE_INTERRUPT) |
  435. BIT(SHORT_PACKET_TRANSFERRED_INTERRUPT) |
  436. BIT(FIFO_OVERFLOW) |
  437. BIT(DATA_PACKET_RECEIVED_INTERRUPT) |
  438. BIT(DATA_PACKET_TRANSMITTED_INTERRUPT) |
  439. BIT(DATA_OUT_PING_TOKEN_INTERRUPT) |
  440. BIT(DATA_IN_TOKEN_INTERRUPT), &ep->regs->ep_stat);
  441. tmp = readl(&ep->cfg->ep_cfg);
  442. if (ep->is_in)
  443. tmp &= ~USB3380_EP_CFG_MASK_IN;
  444. else
  445. tmp &= ~USB3380_EP_CFG_MASK_OUT;
  446. writel(tmp, &ep->cfg->ep_cfg);
  447. }
  448. static void nuke(struct net2280_ep *);
  449. static int net2280_disable(struct usb_ep *_ep)
  450. {
  451. struct net2280_ep *ep;
  452. unsigned long flags;
  453. ep = container_of(_ep, struct net2280_ep, ep);
  454. if (!_ep || !ep->desc || _ep->name == ep0name) {
  455. pr_err("%s: Invalid ep=%p or ep->desc\n", __func__, _ep);
  456. return -EINVAL;
  457. }
  458. spin_lock_irqsave(&ep->dev->lock, flags);
  459. nuke(ep);
  460. if (ep->dev->quirks & PLX_SUPERSPEED)
  461. ep_reset_338x(ep->dev->regs, ep);
  462. else
  463. ep_reset_228x(ep->dev->regs, ep);
  464. ep_vdbg(ep->dev, "disabled %s %s\n",
  465. ep->dma ? "dma" : "pio", _ep->name);
  466. /* synch memory views with the device */
  467. (void)readl(&ep->cfg->ep_cfg);
  468. if (!ep->dma && ep->num >= 1 && ep->num <= 4)
  469. ep->dma = &ep->dev->dma[ep->num - 1];
  470. spin_unlock_irqrestore(&ep->dev->lock, flags);
  471. return 0;
  472. }
  473. /*-------------------------------------------------------------------------*/
  474. static struct usb_request
  475. *net2280_alloc_request(struct usb_ep *_ep, gfp_t gfp_flags)
  476. {
  477. struct net2280_ep *ep;
  478. struct net2280_request *req;
  479. if (!_ep) {
  480. pr_err("%s: Invalid ep\n", __func__);
  481. return NULL;
  482. }
  483. ep = container_of(_ep, struct net2280_ep, ep);
  484. req = kzalloc(sizeof(*req), gfp_flags);
  485. if (!req)
  486. return NULL;
  487. INIT_LIST_HEAD(&req->queue);
  488. /* this dma descriptor may be swapped with the previous dummy */
  489. if (ep->dma) {
  490. struct net2280_dma *td;
  491. td = pci_pool_alloc(ep->dev->requests, gfp_flags,
  492. &req->td_dma);
  493. if (!td) {
  494. kfree(req);
  495. return NULL;
  496. }
  497. td->dmacount = 0; /* not VALID */
  498. td->dmadesc = td->dmaaddr;
  499. req->td = td;
  500. }
  501. return &req->req;
  502. }
  503. static void net2280_free_request(struct usb_ep *_ep, struct usb_request *_req)
  504. {
  505. struct net2280_ep *ep;
  506. struct net2280_request *req;
  507. ep = container_of(_ep, struct net2280_ep, ep);
  508. if (!_ep || !_req) {
  509. dev_err(&ep->dev->pdev->dev, "%s: Inavlid ep=%p or req=%p\n",
  510. __func__, _ep, _req);
  511. return;
  512. }
  513. req = container_of(_req, struct net2280_request, req);
  514. WARN_ON(!list_empty(&req->queue));
  515. if (req->td)
  516. pci_pool_free(ep->dev->requests, req->td, req->td_dma);
  517. kfree(req);
  518. }
  519. /*-------------------------------------------------------------------------*/
  520. /* load a packet into the fifo we use for usb IN transfers.
  521. * works for all endpoints.
  522. *
  523. * NOTE: pio with ep-a..ep-d could stuff multiple packets into the fifo
  524. * at a time, but this code is simpler because it knows it only writes
  525. * one packet. ep-a..ep-d should use dma instead.
  526. */
  527. static void write_fifo(struct net2280_ep *ep, struct usb_request *req)
  528. {
  529. struct net2280_ep_regs __iomem *regs = ep->regs;
  530. u8 *buf;
  531. u32 tmp;
  532. unsigned count, total;
  533. /* INVARIANT: fifo is currently empty. (testable) */
  534. if (req) {
  535. buf = req->buf + req->actual;
  536. prefetch(buf);
  537. total = req->length - req->actual;
  538. } else {
  539. total = 0;
  540. buf = NULL;
  541. }
  542. /* write just one packet at a time */
  543. count = ep->ep.maxpacket;
  544. if (count > total) /* min() cannot be used on a bitfield */
  545. count = total;
  546. ep_vdbg(ep->dev, "write %s fifo (IN) %d bytes%s req %p\n",
  547. ep->ep.name, count,
  548. (count != ep->ep.maxpacket) ? " (short)" : "",
  549. req);
  550. while (count >= 4) {
  551. /* NOTE be careful if you try to align these. fifo lines
  552. * should normally be full (4 bytes) and successive partial
  553. * lines are ok only in certain cases.
  554. */
  555. tmp = get_unaligned((u32 *)buf);
  556. cpu_to_le32s(&tmp);
  557. writel(tmp, &regs->ep_data);
  558. buf += 4;
  559. count -= 4;
  560. }
  561. /* last fifo entry is "short" unless we wrote a full packet.
  562. * also explicitly validate last word in (periodic) transfers
  563. * when maxpacket is not a multiple of 4 bytes.
  564. */
  565. if (count || total < ep->ep.maxpacket) {
  566. tmp = count ? get_unaligned((u32 *)buf) : count;
  567. cpu_to_le32s(&tmp);
  568. set_fifo_bytecount(ep, count & 0x03);
  569. writel(tmp, &regs->ep_data);
  570. }
  571. /* pci writes may still be posted */
  572. }
  573. /* work around erratum 0106: PCI and USB race over the OUT fifo.
  574. * caller guarantees chiprev 0100, out endpoint is NAKing, and
  575. * there's no real data in the fifo.
  576. *
  577. * NOTE: also used in cases where that erratum doesn't apply:
  578. * where the host wrote "too much" data to us.
  579. */
  580. static void out_flush(struct net2280_ep *ep)
  581. {
  582. u32 __iomem *statp;
  583. u32 tmp;
  584. statp = &ep->regs->ep_stat;
  585. tmp = readl(statp);
  586. if (tmp & BIT(NAK_OUT_PACKETS)) {
  587. ep_dbg(ep->dev, "%s %s %08x !NAK\n",
  588. ep->ep.name, __func__, tmp);
  589. writel(BIT(SET_NAK_OUT_PACKETS), &ep->regs->ep_rsp);
  590. }
  591. writel(BIT(DATA_OUT_PING_TOKEN_INTERRUPT) |
  592. BIT(DATA_PACKET_RECEIVED_INTERRUPT),
  593. statp);
  594. writel(BIT(FIFO_FLUSH), statp);
  595. /* Make sure that stap is written */
  596. mb();
  597. tmp = readl(statp);
  598. if (tmp & BIT(DATA_OUT_PING_TOKEN_INTERRUPT) &&
  599. /* high speed did bulk NYET; fifo isn't filling */
  600. ep->dev->gadget.speed == USB_SPEED_FULL) {
  601. unsigned usec;
  602. usec = 50; /* 64 byte bulk/interrupt */
  603. handshake(statp, BIT(USB_OUT_PING_NAK_SENT),
  604. BIT(USB_OUT_PING_NAK_SENT), usec);
  605. /* NAK done; now CLEAR_NAK_OUT_PACKETS is safe */
  606. }
  607. }
  608. /* unload packet(s) from the fifo we use for usb OUT transfers.
  609. * returns true iff the request completed, because of short packet
  610. * or the request buffer having filled with full packets.
  611. *
  612. * for ep-a..ep-d this will read multiple packets out when they
  613. * have been accepted.
  614. */
  615. static int read_fifo(struct net2280_ep *ep, struct net2280_request *req)
  616. {
  617. struct net2280_ep_regs __iomem *regs = ep->regs;
  618. u8 *buf = req->req.buf + req->req.actual;
  619. unsigned count, tmp, is_short;
  620. unsigned cleanup = 0, prevent = 0;
  621. /* erratum 0106 ... packets coming in during fifo reads might
  622. * be incompletely rejected. not all cases have workarounds.
  623. */
  624. if (ep->dev->chiprev == 0x0100 &&
  625. ep->dev->gadget.speed == USB_SPEED_FULL) {
  626. udelay(1);
  627. tmp = readl(&ep->regs->ep_stat);
  628. if ((tmp & BIT(NAK_OUT_PACKETS)))
  629. cleanup = 1;
  630. else if ((tmp & BIT(FIFO_FULL))) {
  631. start_out_naking(ep);
  632. prevent = 1;
  633. }
  634. /* else: hope we don't see the problem */
  635. }
  636. /* never overflow the rx buffer. the fifo reads packets until
  637. * it sees a short one; we might not be ready for them all.
  638. */
  639. prefetchw(buf);
  640. count = readl(&regs->ep_avail);
  641. if (unlikely(count == 0)) {
  642. udelay(1);
  643. tmp = readl(&ep->regs->ep_stat);
  644. count = readl(&regs->ep_avail);
  645. /* handled that data already? */
  646. if (count == 0 && (tmp & BIT(NAK_OUT_PACKETS)) == 0)
  647. return 0;
  648. }
  649. tmp = req->req.length - req->req.actual;
  650. if (count > tmp) {
  651. /* as with DMA, data overflow gets flushed */
  652. if ((tmp % ep->ep.maxpacket) != 0) {
  653. ep_err(ep->dev,
  654. "%s out fifo %d bytes, expected %d\n",
  655. ep->ep.name, count, tmp);
  656. req->req.status = -EOVERFLOW;
  657. cleanup = 1;
  658. /* NAK_OUT_PACKETS will be set, so flushing is safe;
  659. * the next read will start with the next packet
  660. */
  661. } /* else it's a ZLP, no worries */
  662. count = tmp;
  663. }
  664. req->req.actual += count;
  665. is_short = (count == 0) || ((count % ep->ep.maxpacket) != 0);
  666. ep_vdbg(ep->dev, "read %s fifo (OUT) %d bytes%s%s%s req %p %d/%d\n",
  667. ep->ep.name, count, is_short ? " (short)" : "",
  668. cleanup ? " flush" : "", prevent ? " nak" : "",
  669. req, req->req.actual, req->req.length);
  670. while (count >= 4) {
  671. tmp = readl(&regs->ep_data);
  672. cpu_to_le32s(&tmp);
  673. put_unaligned(tmp, (u32 *)buf);
  674. buf += 4;
  675. count -= 4;
  676. }
  677. if (count) {
  678. tmp = readl(&regs->ep_data);
  679. /* LE conversion is implicit here: */
  680. do {
  681. *buf++ = (u8) tmp;
  682. tmp >>= 8;
  683. } while (--count);
  684. }
  685. if (cleanup)
  686. out_flush(ep);
  687. if (prevent) {
  688. writel(BIT(CLEAR_NAK_OUT_PACKETS), &ep->regs->ep_rsp);
  689. (void) readl(&ep->regs->ep_rsp);
  690. }
  691. return is_short || ((req->req.actual == req->req.length) &&
  692. !req->req.zero);
  693. }
  694. /* fill out dma descriptor to match a given request */
  695. static void fill_dma_desc(struct net2280_ep *ep,
  696. struct net2280_request *req, int valid)
  697. {
  698. struct net2280_dma *td = req->td;
  699. u32 dmacount = req->req.length;
  700. /* don't let DMA continue after a short OUT packet,
  701. * so overruns can't affect the next transfer.
  702. * in case of overruns on max-size packets, we can't
  703. * stop the fifo from filling but we can flush it.
  704. */
  705. if (ep->is_in)
  706. dmacount |= BIT(DMA_DIRECTION);
  707. if ((!ep->is_in && (dmacount % ep->ep.maxpacket) != 0) ||
  708. !(ep->dev->quirks & PLX_2280))
  709. dmacount |= BIT(END_OF_CHAIN);
  710. req->valid = valid;
  711. if (valid)
  712. dmacount |= BIT(VALID_BIT);
  713. dmacount |= BIT(DMA_DONE_INTERRUPT_ENABLE);
  714. /* td->dmadesc = previously set by caller */
  715. td->dmaaddr = cpu_to_le32 (req->req.dma);
  716. /* 2280 may be polling VALID_BIT through ep->dma->dmadesc */
  717. wmb();
  718. td->dmacount = cpu_to_le32(dmacount);
  719. }
  720. static const u32 dmactl_default =
  721. BIT(DMA_SCATTER_GATHER_DONE_INTERRUPT) |
  722. BIT(DMA_CLEAR_COUNT_ENABLE) |
  723. /* erratum 0116 workaround part 1 (use POLLING) */
  724. (POLL_100_USEC << DESCRIPTOR_POLLING_RATE) |
  725. BIT(DMA_VALID_BIT_POLLING_ENABLE) |
  726. BIT(DMA_VALID_BIT_ENABLE) |
  727. BIT(DMA_SCATTER_GATHER_ENABLE) |
  728. /* erratum 0116 workaround part 2 (no AUTOSTART) */
  729. BIT(DMA_ENABLE);
  730. static inline void spin_stop_dma(struct net2280_dma_regs __iomem *dma)
  731. {
  732. handshake(&dma->dmactl, BIT(DMA_ENABLE), 0, 50);
  733. }
  734. static inline void stop_dma(struct net2280_dma_regs __iomem *dma)
  735. {
  736. writel(readl(&dma->dmactl) & ~BIT(DMA_ENABLE), &dma->dmactl);
  737. spin_stop_dma(dma);
  738. }
  739. static void start_queue(struct net2280_ep *ep, u32 dmactl, u32 td_dma)
  740. {
  741. struct net2280_dma_regs __iomem *dma = ep->dma;
  742. unsigned int tmp = BIT(VALID_BIT) | (ep->is_in << DMA_DIRECTION);
  743. if (!(ep->dev->quirks & PLX_2280))
  744. tmp |= BIT(END_OF_CHAIN);
  745. writel(tmp, &dma->dmacount);
  746. writel(readl(&dma->dmastat), &dma->dmastat);
  747. writel(td_dma, &dma->dmadesc);
  748. if (ep->dev->quirks & PLX_SUPERSPEED)
  749. dmactl |= BIT(DMA_REQUEST_OUTSTANDING);
  750. writel(dmactl, &dma->dmactl);
  751. /* erratum 0116 workaround part 3: pci arbiter away from net2280 */
  752. (void) readl(&ep->dev->pci->pcimstctl);
  753. writel(BIT(DMA_START), &dma->dmastat);
  754. if (!ep->is_in)
  755. stop_out_naking(ep);
  756. }
  757. static void start_dma(struct net2280_ep *ep, struct net2280_request *req)
  758. {
  759. u32 tmp;
  760. struct net2280_dma_regs __iomem *dma = ep->dma;
  761. /* FIXME can't use DMA for ZLPs */
  762. /* on this path we "know" there's no dma active (yet) */
  763. WARN_ON(readl(&dma->dmactl) & BIT(DMA_ENABLE));
  764. writel(0, &ep->dma->dmactl);
  765. /* previous OUT packet might have been short */
  766. if (!ep->is_in && (readl(&ep->regs->ep_stat) &
  767. BIT(NAK_OUT_PACKETS))) {
  768. writel(BIT(SHORT_PACKET_TRANSFERRED_INTERRUPT),
  769. &ep->regs->ep_stat);
  770. tmp = readl(&ep->regs->ep_avail);
  771. if (tmp) {
  772. writel(readl(&dma->dmastat), &dma->dmastat);
  773. /* transfer all/some fifo data */
  774. writel(req->req.dma, &dma->dmaaddr);
  775. tmp = min(tmp, req->req.length);
  776. /* dma irq, faking scatterlist status */
  777. req->td->dmacount = cpu_to_le32(req->req.length - tmp);
  778. writel(BIT(DMA_DONE_INTERRUPT_ENABLE) | tmp,
  779. &dma->dmacount);
  780. req->td->dmadesc = 0;
  781. req->valid = 1;
  782. writel(BIT(DMA_ENABLE), &dma->dmactl);
  783. writel(BIT(DMA_START), &dma->dmastat);
  784. return;
  785. }
  786. }
  787. tmp = dmactl_default;
  788. /* force packet boundaries between dma requests, but prevent the
  789. * controller from automagically writing a last "short" packet
  790. * (zero length) unless the driver explicitly said to do that.
  791. */
  792. if (ep->is_in) {
  793. if (likely((req->req.length % ep->ep.maxpacket) ||
  794. req->req.zero)){
  795. tmp |= BIT(DMA_FIFO_VALIDATE);
  796. ep->in_fifo_validate = 1;
  797. } else
  798. ep->in_fifo_validate = 0;
  799. }
  800. /* init req->td, pointing to the current dummy */
  801. req->td->dmadesc = cpu_to_le32 (ep->td_dma);
  802. fill_dma_desc(ep, req, 1);
  803. req->td->dmacount |= cpu_to_le32(BIT(END_OF_CHAIN));
  804. start_queue(ep, tmp, req->td_dma);
  805. }
  806. static inline void
  807. queue_dma(struct net2280_ep *ep, struct net2280_request *req, int valid)
  808. {
  809. struct net2280_dma *end;
  810. dma_addr_t tmp;
  811. /* swap new dummy for old, link; fill and maybe activate */
  812. end = ep->dummy;
  813. ep->dummy = req->td;
  814. req->td = end;
  815. tmp = ep->td_dma;
  816. ep->td_dma = req->td_dma;
  817. req->td_dma = tmp;
  818. end->dmadesc = cpu_to_le32 (ep->td_dma);
  819. fill_dma_desc(ep, req, valid);
  820. }
  821. static void
  822. done(struct net2280_ep *ep, struct net2280_request *req, int status)
  823. {
  824. struct net2280 *dev;
  825. unsigned stopped = ep->stopped;
  826. list_del_init(&req->queue);
  827. if (req->req.status == -EINPROGRESS)
  828. req->req.status = status;
  829. else
  830. status = req->req.status;
  831. dev = ep->dev;
  832. if (ep->dma)
  833. usb_gadget_unmap_request(&dev->gadget, &req->req, ep->is_in);
  834. if (status && status != -ESHUTDOWN)
  835. ep_vdbg(dev, "complete %s req %p stat %d len %u/%u\n",
  836. ep->ep.name, &req->req, status,
  837. req->req.actual, req->req.length);
  838. /* don't modify queue heads during completion callback */
  839. ep->stopped = 1;
  840. spin_unlock(&dev->lock);
  841. usb_gadget_giveback_request(&ep->ep, &req->req);
  842. spin_lock(&dev->lock);
  843. ep->stopped = stopped;
  844. }
  845. /*-------------------------------------------------------------------------*/
  846. static int
  847. net2280_queue(struct usb_ep *_ep, struct usb_request *_req, gfp_t gfp_flags)
  848. {
  849. struct net2280_request *req;
  850. struct net2280_ep *ep;
  851. struct net2280 *dev;
  852. unsigned long flags;
  853. int ret = 0;
  854. /* we always require a cpu-view buffer, so that we can
  855. * always use pio (as fallback or whatever).
  856. */
  857. ep = container_of(_ep, struct net2280_ep, ep);
  858. if (!_ep || (!ep->desc && ep->num != 0)) {
  859. pr_err("%s: Invalid ep=%p or ep->desc\n", __func__, _ep);
  860. return -EINVAL;
  861. }
  862. req = container_of(_req, struct net2280_request, req);
  863. if (!_req || !_req->complete || !_req->buf ||
  864. !list_empty(&req->queue)) {
  865. ret = -EINVAL;
  866. goto print_err;
  867. }
  868. if (_req->length > (~0 & DMA_BYTE_COUNT_MASK)) {
  869. ret = -EDOM;
  870. goto print_err;
  871. }
  872. dev = ep->dev;
  873. if (!dev->driver || dev->gadget.speed == USB_SPEED_UNKNOWN) {
  874. ret = -ESHUTDOWN;
  875. goto print_err;
  876. }
  877. /* FIXME implement PIO fallback for ZLPs with DMA */
  878. if (ep->dma && _req->length == 0) {
  879. ret = -EOPNOTSUPP;
  880. goto print_err;
  881. }
  882. /* set up dma mapping in case the caller didn't */
  883. if (ep->dma) {
  884. ret = usb_gadget_map_request(&dev->gadget, _req,
  885. ep->is_in);
  886. if (ret)
  887. goto print_err;
  888. }
  889. ep_vdbg(dev, "%s queue req %p, len %d buf %p\n",
  890. _ep->name, _req, _req->length, _req->buf);
  891. spin_lock_irqsave(&dev->lock, flags);
  892. _req->status = -EINPROGRESS;
  893. _req->actual = 0;
  894. /* kickstart this i/o queue? */
  895. if (list_empty(&ep->queue) && !ep->stopped &&
  896. !((dev->quirks & PLX_SUPERSPEED) && ep->dma &&
  897. (readl(&ep->regs->ep_rsp) & BIT(CLEAR_ENDPOINT_HALT)))) {
  898. /* use DMA if the endpoint supports it, else pio */
  899. if (ep->dma)
  900. start_dma(ep, req);
  901. else {
  902. /* maybe there's no control data, just status ack */
  903. if (ep->num == 0 && _req->length == 0) {
  904. allow_status(ep);
  905. done(ep, req, 0);
  906. ep_vdbg(dev, "%s status ack\n", ep->ep.name);
  907. goto done;
  908. }
  909. /* PIO ... stuff the fifo, or unblock it. */
  910. if (ep->is_in)
  911. write_fifo(ep, _req);
  912. else if (list_empty(&ep->queue)) {
  913. u32 s;
  914. /* OUT FIFO might have packet(s) buffered */
  915. s = readl(&ep->regs->ep_stat);
  916. if ((s & BIT(FIFO_EMPTY)) == 0) {
  917. /* note: _req->short_not_ok is
  918. * ignored here since PIO _always_
  919. * stops queue advance here, and
  920. * _req->status doesn't change for
  921. * short reads (only _req->actual)
  922. */
  923. if (read_fifo(ep, req) &&
  924. ep->num == 0) {
  925. done(ep, req, 0);
  926. allow_status(ep);
  927. /* don't queue it */
  928. req = NULL;
  929. } else if (read_fifo(ep, req) &&
  930. ep->num != 0) {
  931. done(ep, req, 0);
  932. req = NULL;
  933. } else
  934. s = readl(&ep->regs->ep_stat);
  935. }
  936. /* don't NAK, let the fifo fill */
  937. if (req && (s & BIT(NAK_OUT_PACKETS)))
  938. writel(BIT(CLEAR_NAK_OUT_PACKETS),
  939. &ep->regs->ep_rsp);
  940. }
  941. }
  942. } else if (ep->dma) {
  943. int valid = 1;
  944. if (ep->is_in) {
  945. int expect;
  946. /* preventing magic zlps is per-engine state, not
  947. * per-transfer; irq logic must recover hiccups.
  948. */
  949. expect = likely(req->req.zero ||
  950. (req->req.length % ep->ep.maxpacket));
  951. if (expect != ep->in_fifo_validate)
  952. valid = 0;
  953. }
  954. queue_dma(ep, req, valid);
  955. } /* else the irq handler advances the queue. */
  956. ep->responded = 1;
  957. if (req)
  958. list_add_tail(&req->queue, &ep->queue);
  959. done:
  960. spin_unlock_irqrestore(&dev->lock, flags);
  961. /* pci writes may still be posted */
  962. return ret;
  963. print_err:
  964. dev_err(&ep->dev->pdev->dev, "%s: error=%d\n", __func__, ret);
  965. return ret;
  966. }
  967. static inline void
  968. dma_done(struct net2280_ep *ep, struct net2280_request *req, u32 dmacount,
  969. int status)
  970. {
  971. req->req.actual = req->req.length - (DMA_BYTE_COUNT_MASK & dmacount);
  972. done(ep, req, status);
  973. }
  974. static void scan_dma_completions(struct net2280_ep *ep)
  975. {
  976. /* only look at descriptors that were "naturally" retired,
  977. * so fifo and list head state won't matter
  978. */
  979. while (!list_empty(&ep->queue)) {
  980. struct net2280_request *req;
  981. u32 tmp;
  982. req = list_entry(ep->queue.next,
  983. struct net2280_request, queue);
  984. if (!req->valid)
  985. break;
  986. rmb();
  987. tmp = le32_to_cpup(&req->td->dmacount);
  988. if ((tmp & BIT(VALID_BIT)) != 0)
  989. break;
  990. /* SHORT_PACKET_TRANSFERRED_INTERRUPT handles "usb-short"
  991. * cases where DMA must be aborted; this code handles
  992. * all non-abort DMA completions.
  993. */
  994. if (unlikely(req->td->dmadesc == 0)) {
  995. /* paranoia */
  996. tmp = readl(&ep->dma->dmacount);
  997. if (tmp & DMA_BYTE_COUNT_MASK)
  998. break;
  999. /* single transfer mode */
  1000. dma_done(ep, req, tmp, 0);
  1001. break;
  1002. } else if (!ep->is_in &&
  1003. (req->req.length % ep->ep.maxpacket) &&
  1004. !(ep->dev->quirks & PLX_SUPERSPEED)) {
  1005. tmp = readl(&ep->regs->ep_stat);
  1006. /* AVOID TROUBLE HERE by not issuing short reads from
  1007. * your gadget driver. That helps avoids errata 0121,
  1008. * 0122, and 0124; not all cases trigger the warning.
  1009. */
  1010. if ((tmp & BIT(NAK_OUT_PACKETS)) == 0) {
  1011. ep_warn(ep->dev, "%s lost packet sync!\n",
  1012. ep->ep.name);
  1013. req->req.status = -EOVERFLOW;
  1014. } else {
  1015. tmp = readl(&ep->regs->ep_avail);
  1016. if (tmp) {
  1017. /* fifo gets flushed later */
  1018. ep->out_overflow = 1;
  1019. ep_dbg(ep->dev,
  1020. "%s dma, discard %d len %d\n",
  1021. ep->ep.name, tmp,
  1022. req->req.length);
  1023. req->req.status = -EOVERFLOW;
  1024. }
  1025. }
  1026. }
  1027. dma_done(ep, req, tmp, 0);
  1028. }
  1029. }
  1030. static void restart_dma(struct net2280_ep *ep)
  1031. {
  1032. struct net2280_request *req;
  1033. if (ep->stopped)
  1034. return;
  1035. req = list_entry(ep->queue.next, struct net2280_request, queue);
  1036. start_dma(ep, req);
  1037. }
  1038. static void abort_dma(struct net2280_ep *ep)
  1039. {
  1040. /* abort the current transfer */
  1041. if (likely(!list_empty(&ep->queue))) {
  1042. /* FIXME work around errata 0121, 0122, 0124 */
  1043. writel(BIT(DMA_ABORT), &ep->dma->dmastat);
  1044. spin_stop_dma(ep->dma);
  1045. } else
  1046. stop_dma(ep->dma);
  1047. scan_dma_completions(ep);
  1048. }
  1049. /* dequeue ALL requests */
  1050. static void nuke(struct net2280_ep *ep)
  1051. {
  1052. struct net2280_request *req;
  1053. /* called with spinlock held */
  1054. ep->stopped = 1;
  1055. if (ep->dma)
  1056. abort_dma(ep);
  1057. while (!list_empty(&ep->queue)) {
  1058. req = list_entry(ep->queue.next,
  1059. struct net2280_request,
  1060. queue);
  1061. done(ep, req, -ESHUTDOWN);
  1062. }
  1063. }
  1064. /* dequeue JUST ONE request */
  1065. static int net2280_dequeue(struct usb_ep *_ep, struct usb_request *_req)
  1066. {
  1067. struct net2280_ep *ep;
  1068. struct net2280_request *req;
  1069. unsigned long flags;
  1070. u32 dmactl;
  1071. int stopped;
  1072. ep = container_of(_ep, struct net2280_ep, ep);
  1073. if (!_ep || (!ep->desc && ep->num != 0) || !_req) {
  1074. pr_err("%s: Invalid ep=%p or ep->desc or req=%p\n",
  1075. __func__, _ep, _req);
  1076. return -EINVAL;
  1077. }
  1078. spin_lock_irqsave(&ep->dev->lock, flags);
  1079. stopped = ep->stopped;
  1080. /* quiesce dma while we patch the queue */
  1081. dmactl = 0;
  1082. ep->stopped = 1;
  1083. if (ep->dma) {
  1084. dmactl = readl(&ep->dma->dmactl);
  1085. /* WARNING erratum 0127 may kick in ... */
  1086. stop_dma(ep->dma);
  1087. scan_dma_completions(ep);
  1088. }
  1089. /* make sure it's still queued on this endpoint */
  1090. list_for_each_entry(req, &ep->queue, queue) {
  1091. if (&req->req == _req)
  1092. break;
  1093. }
  1094. if (&req->req != _req) {
  1095. spin_unlock_irqrestore(&ep->dev->lock, flags);
  1096. dev_err(&ep->dev->pdev->dev, "%s: Request mismatch\n",
  1097. __func__);
  1098. return -EINVAL;
  1099. }
  1100. /* queue head may be partially complete. */
  1101. if (ep->queue.next == &req->queue) {
  1102. if (ep->dma) {
  1103. ep_dbg(ep->dev, "unlink (%s) dma\n", _ep->name);
  1104. _req->status = -ECONNRESET;
  1105. abort_dma(ep);
  1106. if (likely(ep->queue.next == &req->queue)) {
  1107. /* NOTE: misreports single-transfer mode*/
  1108. req->td->dmacount = 0; /* invalidate */
  1109. dma_done(ep, req,
  1110. readl(&ep->dma->dmacount),
  1111. -ECONNRESET);
  1112. }
  1113. } else {
  1114. ep_dbg(ep->dev, "unlink (%s) pio\n", _ep->name);
  1115. done(ep, req, -ECONNRESET);
  1116. }
  1117. req = NULL;
  1118. }
  1119. if (req)
  1120. done(ep, req, -ECONNRESET);
  1121. ep->stopped = stopped;
  1122. if (ep->dma) {
  1123. /* turn off dma on inactive queues */
  1124. if (list_empty(&ep->queue))
  1125. stop_dma(ep->dma);
  1126. else if (!ep->stopped) {
  1127. /* resume current request, or start new one */
  1128. if (req)
  1129. writel(dmactl, &ep->dma->dmactl);
  1130. else
  1131. start_dma(ep, list_entry(ep->queue.next,
  1132. struct net2280_request, queue));
  1133. }
  1134. }
  1135. spin_unlock_irqrestore(&ep->dev->lock, flags);
  1136. return 0;
  1137. }
  1138. /*-------------------------------------------------------------------------*/
  1139. static int net2280_fifo_status(struct usb_ep *_ep);
  1140. static int
  1141. net2280_set_halt_and_wedge(struct usb_ep *_ep, int value, int wedged)
  1142. {
  1143. struct net2280_ep *ep;
  1144. unsigned long flags;
  1145. int retval = 0;
  1146. ep = container_of(_ep, struct net2280_ep, ep);
  1147. if (!_ep || (!ep->desc && ep->num != 0)) {
  1148. pr_err("%s: Invalid ep=%p or ep->desc\n", __func__, _ep);
  1149. return -EINVAL;
  1150. }
  1151. if (!ep->dev->driver || ep->dev->gadget.speed == USB_SPEED_UNKNOWN) {
  1152. retval = -ESHUTDOWN;
  1153. goto print_err;
  1154. }
  1155. if (ep->desc /* not ep0 */ && (ep->desc->bmAttributes & 0x03)
  1156. == USB_ENDPOINT_XFER_ISOC) {
  1157. retval = -EINVAL;
  1158. goto print_err;
  1159. }
  1160. spin_lock_irqsave(&ep->dev->lock, flags);
  1161. if (!list_empty(&ep->queue)) {
  1162. retval = -EAGAIN;
  1163. goto print_unlock;
  1164. } else if (ep->is_in && value && net2280_fifo_status(_ep) != 0) {
  1165. retval = -EAGAIN;
  1166. goto print_unlock;
  1167. } else {
  1168. ep_vdbg(ep->dev, "%s %s %s\n", _ep->name,
  1169. value ? "set" : "clear",
  1170. wedged ? "wedge" : "halt");
  1171. /* set/clear, then synch memory views with the device */
  1172. if (value) {
  1173. if (ep->num == 0)
  1174. ep->dev->protocol_stall = 1;
  1175. else
  1176. set_halt(ep);
  1177. if (wedged)
  1178. ep->wedged = 1;
  1179. } else {
  1180. clear_halt(ep);
  1181. if (ep->dev->quirks & PLX_SUPERSPEED &&
  1182. !list_empty(&ep->queue) && ep->td_dma)
  1183. restart_dma(ep);
  1184. ep->wedged = 0;
  1185. }
  1186. (void) readl(&ep->regs->ep_rsp);
  1187. }
  1188. spin_unlock_irqrestore(&ep->dev->lock, flags);
  1189. return retval;
  1190. print_unlock:
  1191. spin_unlock_irqrestore(&ep->dev->lock, flags);
  1192. print_err:
  1193. dev_err(&ep->dev->pdev->dev, "%s: error=%d\n", __func__, retval);
  1194. return retval;
  1195. }
  1196. static int net2280_set_halt(struct usb_ep *_ep, int value)
  1197. {
  1198. return net2280_set_halt_and_wedge(_ep, value, 0);
  1199. }
  1200. static int net2280_set_wedge(struct usb_ep *_ep)
  1201. {
  1202. if (!_ep || _ep->name == ep0name) {
  1203. pr_err("%s: Invalid ep=%p or ep0\n", __func__, _ep);
  1204. return -EINVAL;
  1205. }
  1206. return net2280_set_halt_and_wedge(_ep, 1, 1);
  1207. }
  1208. static int net2280_fifo_status(struct usb_ep *_ep)
  1209. {
  1210. struct net2280_ep *ep;
  1211. u32 avail;
  1212. ep = container_of(_ep, struct net2280_ep, ep);
  1213. if (!_ep || (!ep->desc && ep->num != 0)) {
  1214. pr_err("%s: Invalid ep=%p or ep->desc\n", __func__, _ep);
  1215. return -ENODEV;
  1216. }
  1217. if (!ep->dev->driver || ep->dev->gadget.speed == USB_SPEED_UNKNOWN) {
  1218. dev_err(&ep->dev->pdev->dev,
  1219. "%s: Invalid driver=%p or speed=%d\n",
  1220. __func__, ep->dev->driver, ep->dev->gadget.speed);
  1221. return -ESHUTDOWN;
  1222. }
  1223. avail = readl(&ep->regs->ep_avail) & (BIT(12) - 1);
  1224. if (avail > ep->fifo_size) {
  1225. dev_err(&ep->dev->pdev->dev, "%s: Fifo overflow\n", __func__);
  1226. return -EOVERFLOW;
  1227. }
  1228. if (ep->is_in)
  1229. avail = ep->fifo_size - avail;
  1230. return avail;
  1231. }
  1232. static void net2280_fifo_flush(struct usb_ep *_ep)
  1233. {
  1234. struct net2280_ep *ep;
  1235. ep = container_of(_ep, struct net2280_ep, ep);
  1236. if (!_ep || (!ep->desc && ep->num != 0)) {
  1237. pr_err("%s: Invalid ep=%p or ep->desc\n", __func__, _ep);
  1238. return;
  1239. }
  1240. if (!ep->dev->driver || ep->dev->gadget.speed == USB_SPEED_UNKNOWN) {
  1241. dev_err(&ep->dev->pdev->dev,
  1242. "%s: Invalid driver=%p or speed=%d\n",
  1243. __func__, ep->dev->driver, ep->dev->gadget.speed);
  1244. return;
  1245. }
  1246. writel(BIT(FIFO_FLUSH), &ep->regs->ep_stat);
  1247. (void) readl(&ep->regs->ep_rsp);
  1248. }
  1249. static const struct usb_ep_ops net2280_ep_ops = {
  1250. .enable = net2280_enable,
  1251. .disable = net2280_disable,
  1252. .alloc_request = net2280_alloc_request,
  1253. .free_request = net2280_free_request,
  1254. .queue = net2280_queue,
  1255. .dequeue = net2280_dequeue,
  1256. .set_halt = net2280_set_halt,
  1257. .set_wedge = net2280_set_wedge,
  1258. .fifo_status = net2280_fifo_status,
  1259. .fifo_flush = net2280_fifo_flush,
  1260. };
  1261. /*-------------------------------------------------------------------------*/
  1262. static int net2280_get_frame(struct usb_gadget *_gadget)
  1263. {
  1264. struct net2280 *dev;
  1265. unsigned long flags;
  1266. u16 retval;
  1267. if (!_gadget)
  1268. return -ENODEV;
  1269. dev = container_of(_gadget, struct net2280, gadget);
  1270. spin_lock_irqsave(&dev->lock, flags);
  1271. retval = get_idx_reg(dev->regs, REG_FRAME) & 0x03ff;
  1272. spin_unlock_irqrestore(&dev->lock, flags);
  1273. return retval;
  1274. }
  1275. static int net2280_wakeup(struct usb_gadget *_gadget)
  1276. {
  1277. struct net2280 *dev;
  1278. u32 tmp;
  1279. unsigned long flags;
  1280. if (!_gadget)
  1281. return 0;
  1282. dev = container_of(_gadget, struct net2280, gadget);
  1283. spin_lock_irqsave(&dev->lock, flags);
  1284. tmp = readl(&dev->usb->usbctl);
  1285. if (tmp & BIT(DEVICE_REMOTE_WAKEUP_ENABLE))
  1286. writel(BIT(GENERATE_RESUME), &dev->usb->usbstat);
  1287. spin_unlock_irqrestore(&dev->lock, flags);
  1288. /* pci writes may still be posted */
  1289. return 0;
  1290. }
  1291. static int net2280_set_selfpowered(struct usb_gadget *_gadget, int value)
  1292. {
  1293. struct net2280 *dev;
  1294. u32 tmp;
  1295. unsigned long flags;
  1296. if (!_gadget)
  1297. return 0;
  1298. dev = container_of(_gadget, struct net2280, gadget);
  1299. spin_lock_irqsave(&dev->lock, flags);
  1300. tmp = readl(&dev->usb->usbctl);
  1301. if (value) {
  1302. tmp |= BIT(SELF_POWERED_STATUS);
  1303. _gadget->is_selfpowered = 1;
  1304. } else {
  1305. tmp &= ~BIT(SELF_POWERED_STATUS);
  1306. _gadget->is_selfpowered = 0;
  1307. }
  1308. writel(tmp, &dev->usb->usbctl);
  1309. spin_unlock_irqrestore(&dev->lock, flags);
  1310. return 0;
  1311. }
  1312. static int net2280_pullup(struct usb_gadget *_gadget, int is_on)
  1313. {
  1314. struct net2280 *dev;
  1315. u32 tmp;
  1316. unsigned long flags;
  1317. if (!_gadget)
  1318. return -ENODEV;
  1319. dev = container_of(_gadget, struct net2280, gadget);
  1320. spin_lock_irqsave(&dev->lock, flags);
  1321. tmp = readl(&dev->usb->usbctl);
  1322. dev->softconnect = (is_on != 0);
  1323. if (is_on) {
  1324. ep0_start(dev);
  1325. writel(tmp | BIT(USB_DETECT_ENABLE), &dev->usb->usbctl);
  1326. } else {
  1327. writel(tmp & ~BIT(USB_DETECT_ENABLE), &dev->usb->usbctl);
  1328. stop_activity(dev, dev->driver);
  1329. }
  1330. spin_unlock_irqrestore(&dev->lock, flags);
  1331. return 0;
  1332. }
  1333. static struct usb_ep *net2280_match_ep(struct usb_gadget *_gadget,
  1334. struct usb_endpoint_descriptor *desc,
  1335. struct usb_ss_ep_comp_descriptor *ep_comp)
  1336. {
  1337. char name[8];
  1338. struct usb_ep *ep;
  1339. if (usb_endpoint_type(desc) == USB_ENDPOINT_XFER_INT) {
  1340. /* ep-e, ep-f are PIO with only 64 byte fifos */
  1341. ep = gadget_find_ep_by_name(_gadget, "ep-e");
  1342. if (ep && usb_gadget_ep_match_desc(_gadget, ep, desc, ep_comp))
  1343. return ep;
  1344. ep = gadget_find_ep_by_name(_gadget, "ep-f");
  1345. if (ep && usb_gadget_ep_match_desc(_gadget, ep, desc, ep_comp))
  1346. return ep;
  1347. }
  1348. /* USB3380: use same address for usb and hardware endpoints */
  1349. snprintf(name, sizeof(name), "ep%d%s", usb_endpoint_num(desc),
  1350. usb_endpoint_dir_in(desc) ? "in" : "out");
  1351. ep = gadget_find_ep_by_name(_gadget, name);
  1352. if (ep && usb_gadget_ep_match_desc(_gadget, ep, desc, ep_comp))
  1353. return ep;
  1354. return NULL;
  1355. }
  1356. static int net2280_start(struct usb_gadget *_gadget,
  1357. struct usb_gadget_driver *driver);
  1358. static int net2280_stop(struct usb_gadget *_gadget);
  1359. static const struct usb_gadget_ops net2280_ops = {
  1360. .get_frame = net2280_get_frame,
  1361. .wakeup = net2280_wakeup,
  1362. .set_selfpowered = net2280_set_selfpowered,
  1363. .pullup = net2280_pullup,
  1364. .udc_start = net2280_start,
  1365. .udc_stop = net2280_stop,
  1366. .match_ep = net2280_match_ep,
  1367. };
  1368. /*-------------------------------------------------------------------------*/
  1369. #ifdef CONFIG_USB_GADGET_DEBUG_FILES
  1370. /* FIXME move these into procfs, and use seq_file.
  1371. * Sysfs _still_ doesn't behave for arbitrarily sized files,
  1372. * and also doesn't help products using this with 2.4 kernels.
  1373. */
  1374. /* "function" sysfs attribute */
  1375. static ssize_t function_show(struct device *_dev, struct device_attribute *attr,
  1376. char *buf)
  1377. {
  1378. struct net2280 *dev = dev_get_drvdata(_dev);
  1379. if (!dev->driver || !dev->driver->function ||
  1380. strlen(dev->driver->function) > PAGE_SIZE)
  1381. return 0;
  1382. return scnprintf(buf, PAGE_SIZE, "%s\n", dev->driver->function);
  1383. }
  1384. static DEVICE_ATTR_RO(function);
  1385. static ssize_t registers_show(struct device *_dev,
  1386. struct device_attribute *attr, char *buf)
  1387. {
  1388. struct net2280 *dev;
  1389. char *next;
  1390. unsigned size, t;
  1391. unsigned long flags;
  1392. int i;
  1393. u32 t1, t2;
  1394. const char *s;
  1395. dev = dev_get_drvdata(_dev);
  1396. next = buf;
  1397. size = PAGE_SIZE;
  1398. spin_lock_irqsave(&dev->lock, flags);
  1399. if (dev->driver)
  1400. s = dev->driver->driver.name;
  1401. else
  1402. s = "(none)";
  1403. /* Main Control Registers */
  1404. t = scnprintf(next, size, "%s version " DRIVER_VERSION
  1405. ", chiprev %04x\n\n"
  1406. "devinit %03x fifoctl %08x gadget '%s'\n"
  1407. "pci irqenb0 %02x irqenb1 %08x "
  1408. "irqstat0 %04x irqstat1 %08x\n",
  1409. driver_name, dev->chiprev,
  1410. readl(&dev->regs->devinit),
  1411. readl(&dev->regs->fifoctl),
  1412. s,
  1413. readl(&dev->regs->pciirqenb0),
  1414. readl(&dev->regs->pciirqenb1),
  1415. readl(&dev->regs->irqstat0),
  1416. readl(&dev->regs->irqstat1));
  1417. size -= t;
  1418. next += t;
  1419. /* USB Control Registers */
  1420. t1 = readl(&dev->usb->usbctl);
  1421. t2 = readl(&dev->usb->usbstat);
  1422. if (t1 & BIT(VBUS_PIN)) {
  1423. if (t2 & BIT(HIGH_SPEED))
  1424. s = "high speed";
  1425. else if (dev->gadget.speed == USB_SPEED_UNKNOWN)
  1426. s = "powered";
  1427. else
  1428. s = "full speed";
  1429. /* full speed bit (6) not working?? */
  1430. } else
  1431. s = "not attached";
  1432. t = scnprintf(next, size,
  1433. "stdrsp %08x usbctl %08x usbstat %08x "
  1434. "addr 0x%02x (%s)\n",
  1435. readl(&dev->usb->stdrsp), t1, t2,
  1436. readl(&dev->usb->ouraddr), s);
  1437. size -= t;
  1438. next += t;
  1439. /* PCI Master Control Registers */
  1440. /* DMA Control Registers */
  1441. /* Configurable EP Control Registers */
  1442. for (i = 0; i < dev->n_ep; i++) {
  1443. struct net2280_ep *ep;
  1444. ep = &dev->ep[i];
  1445. if (i && !ep->desc)
  1446. continue;
  1447. t1 = readl(&ep->cfg->ep_cfg);
  1448. t2 = readl(&ep->regs->ep_rsp) & 0xff;
  1449. t = scnprintf(next, size,
  1450. "\n%s\tcfg %05x rsp (%02x) %s%s%s%s%s%s%s%s"
  1451. "irqenb %02x\n",
  1452. ep->ep.name, t1, t2,
  1453. (t2 & BIT(CLEAR_NAK_OUT_PACKETS))
  1454. ? "NAK " : "",
  1455. (t2 & BIT(CLEAR_EP_HIDE_STATUS_PHASE))
  1456. ? "hide " : "",
  1457. (t2 & BIT(CLEAR_EP_FORCE_CRC_ERROR))
  1458. ? "CRC " : "",
  1459. (t2 & BIT(CLEAR_INTERRUPT_MODE))
  1460. ? "interrupt " : "",
  1461. (t2 & BIT(CLEAR_CONTROL_STATUS_PHASE_HANDSHAKE))
  1462. ? "status " : "",
  1463. (t2 & BIT(CLEAR_NAK_OUT_PACKETS_MODE))
  1464. ? "NAKmode " : "",
  1465. (t2 & BIT(CLEAR_ENDPOINT_TOGGLE))
  1466. ? "DATA1 " : "DATA0 ",
  1467. (t2 & BIT(CLEAR_ENDPOINT_HALT))
  1468. ? "HALT " : "",
  1469. readl(&ep->regs->ep_irqenb));
  1470. size -= t;
  1471. next += t;
  1472. t = scnprintf(next, size,
  1473. "\tstat %08x avail %04x "
  1474. "(ep%d%s-%s)%s\n",
  1475. readl(&ep->regs->ep_stat),
  1476. readl(&ep->regs->ep_avail),
  1477. t1 & 0x0f, DIR_STRING(t1),
  1478. type_string(t1 >> 8),
  1479. ep->stopped ? "*" : "");
  1480. size -= t;
  1481. next += t;
  1482. if (!ep->dma)
  1483. continue;
  1484. t = scnprintf(next, size,
  1485. " dma\tctl %08x stat %08x count %08x\n"
  1486. "\taddr %08x desc %08x\n",
  1487. readl(&ep->dma->dmactl),
  1488. readl(&ep->dma->dmastat),
  1489. readl(&ep->dma->dmacount),
  1490. readl(&ep->dma->dmaaddr),
  1491. readl(&ep->dma->dmadesc));
  1492. size -= t;
  1493. next += t;
  1494. }
  1495. /* Indexed Registers (none yet) */
  1496. /* Statistics */
  1497. t = scnprintf(next, size, "\nirqs: ");
  1498. size -= t;
  1499. next += t;
  1500. for (i = 0; i < dev->n_ep; i++) {
  1501. struct net2280_ep *ep;
  1502. ep = &dev->ep[i];
  1503. if (i && !ep->irqs)
  1504. continue;
  1505. t = scnprintf(next, size, " %s/%lu", ep->ep.name, ep->irqs);
  1506. size -= t;
  1507. next += t;
  1508. }
  1509. t = scnprintf(next, size, "\n");
  1510. size -= t;
  1511. next += t;
  1512. spin_unlock_irqrestore(&dev->lock, flags);
  1513. return PAGE_SIZE - size;
  1514. }
  1515. static DEVICE_ATTR_RO(registers);
  1516. static ssize_t queues_show(struct device *_dev, struct device_attribute *attr,
  1517. char *buf)
  1518. {
  1519. struct net2280 *dev;
  1520. char *next;
  1521. unsigned size;
  1522. unsigned long flags;
  1523. int i;
  1524. dev = dev_get_drvdata(_dev);
  1525. next = buf;
  1526. size = PAGE_SIZE;
  1527. spin_lock_irqsave(&dev->lock, flags);
  1528. for (i = 0; i < dev->n_ep; i++) {
  1529. struct net2280_ep *ep = &dev->ep[i];
  1530. struct net2280_request *req;
  1531. int t;
  1532. if (i != 0) {
  1533. const struct usb_endpoint_descriptor *d;
  1534. d = ep->desc;
  1535. if (!d)
  1536. continue;
  1537. t = d->bEndpointAddress;
  1538. t = scnprintf(next, size,
  1539. "\n%s (ep%d%s-%s) max %04x %s fifo %d\n",
  1540. ep->ep.name, t & USB_ENDPOINT_NUMBER_MASK,
  1541. (t & USB_DIR_IN) ? "in" : "out",
  1542. type_string(d->bmAttributes),
  1543. usb_endpoint_maxp(d) & 0x1fff,
  1544. ep->dma ? "dma" : "pio", ep->fifo_size
  1545. );
  1546. } else /* ep0 should only have one transfer queued */
  1547. t = scnprintf(next, size, "ep0 max 64 pio %s\n",
  1548. ep->is_in ? "in" : "out");
  1549. if (t <= 0 || t > size)
  1550. goto done;
  1551. size -= t;
  1552. next += t;
  1553. if (list_empty(&ep->queue)) {
  1554. t = scnprintf(next, size, "\t(nothing queued)\n");
  1555. if (t <= 0 || t > size)
  1556. goto done;
  1557. size -= t;
  1558. next += t;
  1559. continue;
  1560. }
  1561. list_for_each_entry(req, &ep->queue, queue) {
  1562. if (ep->dma && req->td_dma == readl(&ep->dma->dmadesc))
  1563. t = scnprintf(next, size,
  1564. "\treq %p len %d/%d "
  1565. "buf %p (dmacount %08x)\n",
  1566. &req->req, req->req.actual,
  1567. req->req.length, req->req.buf,
  1568. readl(&ep->dma->dmacount));
  1569. else
  1570. t = scnprintf(next, size,
  1571. "\treq %p len %d/%d buf %p\n",
  1572. &req->req, req->req.actual,
  1573. req->req.length, req->req.buf);
  1574. if (t <= 0 || t > size)
  1575. goto done;
  1576. size -= t;
  1577. next += t;
  1578. if (ep->dma) {
  1579. struct net2280_dma *td;
  1580. td = req->td;
  1581. t = scnprintf(next, size, "\t td %08x "
  1582. " count %08x buf %08x desc %08x\n",
  1583. (u32) req->td_dma,
  1584. le32_to_cpu(td->dmacount),
  1585. le32_to_cpu(td->dmaaddr),
  1586. le32_to_cpu(td->dmadesc));
  1587. if (t <= 0 || t > size)
  1588. goto done;
  1589. size -= t;
  1590. next += t;
  1591. }
  1592. }
  1593. }
  1594. done:
  1595. spin_unlock_irqrestore(&dev->lock, flags);
  1596. return PAGE_SIZE - size;
  1597. }
  1598. static DEVICE_ATTR_RO(queues);
  1599. #else
  1600. #define device_create_file(a, b) (0)
  1601. #define device_remove_file(a, b) do { } while (0)
  1602. #endif
  1603. /*-------------------------------------------------------------------------*/
  1604. /* another driver-specific mode might be a request type doing dma
  1605. * to/from another device fifo instead of to/from memory.
  1606. */
  1607. static void set_fifo_mode(struct net2280 *dev, int mode)
  1608. {
  1609. /* keeping high bits preserves BAR2 */
  1610. writel((0xffff << PCI_BASE2_RANGE) | mode, &dev->regs->fifoctl);
  1611. /* always ep-{a,b,e,f} ... maybe not ep-c or ep-d */
  1612. INIT_LIST_HEAD(&dev->gadget.ep_list);
  1613. list_add_tail(&dev->ep[1].ep.ep_list, &dev->gadget.ep_list);
  1614. list_add_tail(&dev->ep[2].ep.ep_list, &dev->gadget.ep_list);
  1615. switch (mode) {
  1616. case 0:
  1617. list_add_tail(&dev->ep[3].ep.ep_list, &dev->gadget.ep_list);
  1618. list_add_tail(&dev->ep[4].ep.ep_list, &dev->gadget.ep_list);
  1619. dev->ep[1].fifo_size = dev->ep[2].fifo_size = 1024;
  1620. break;
  1621. case 1:
  1622. dev->ep[1].fifo_size = dev->ep[2].fifo_size = 2048;
  1623. break;
  1624. case 2:
  1625. list_add_tail(&dev->ep[3].ep.ep_list, &dev->gadget.ep_list);
  1626. dev->ep[1].fifo_size = 2048;
  1627. dev->ep[2].fifo_size = 1024;
  1628. break;
  1629. }
  1630. /* fifo sizes for ep0, ep-c, ep-d, ep-e, and ep-f never change */
  1631. list_add_tail(&dev->ep[5].ep.ep_list, &dev->gadget.ep_list);
  1632. list_add_tail(&dev->ep[6].ep.ep_list, &dev->gadget.ep_list);
  1633. }
  1634. static void defect7374_disable_data_eps(struct net2280 *dev)
  1635. {
  1636. /*
  1637. * For Defect 7374, disable data EPs (and more):
  1638. * - This phase undoes the earlier phase of the Defect 7374 workaround,
  1639. * returing ep regs back to normal.
  1640. */
  1641. struct net2280_ep *ep;
  1642. int i;
  1643. unsigned char ep_sel;
  1644. u32 tmp_reg;
  1645. for (i = 1; i < 5; i++) {
  1646. ep = &dev->ep[i];
  1647. writel(0, &ep->cfg->ep_cfg);
  1648. }
  1649. /* CSROUT, CSRIN, PCIOUT, PCIIN, STATIN, RCIN */
  1650. for (i = 0; i < 6; i++)
  1651. writel(0, &dev->dep[i].dep_cfg);
  1652. for (ep_sel = 0; ep_sel <= 21; ep_sel++) {
  1653. /* Select an endpoint for subsequent operations: */
  1654. tmp_reg = readl(&dev->plregs->pl_ep_ctrl);
  1655. writel(((tmp_reg & ~0x1f) | ep_sel), &dev->plregs->pl_ep_ctrl);
  1656. if (ep_sel < 2 || (ep_sel > 9 && ep_sel < 14) ||
  1657. ep_sel == 18 || ep_sel == 20)
  1658. continue;
  1659. /* Change settings on some selected endpoints */
  1660. tmp_reg = readl(&dev->plregs->pl_ep_cfg_4);
  1661. tmp_reg &= ~BIT(NON_CTRL_IN_TOLERATE_BAD_DIR);
  1662. writel(tmp_reg, &dev->plregs->pl_ep_cfg_4);
  1663. tmp_reg = readl(&dev->plregs->pl_ep_ctrl);
  1664. tmp_reg |= BIT(EP_INITIALIZED);
  1665. writel(tmp_reg, &dev->plregs->pl_ep_ctrl);
  1666. }
  1667. }
  1668. static void defect7374_enable_data_eps_zero(struct net2280 *dev)
  1669. {
  1670. u32 tmp = 0, tmp_reg;
  1671. u32 scratch;
  1672. int i;
  1673. unsigned char ep_sel;
  1674. scratch = get_idx_reg(dev->regs, SCRATCH);
  1675. WARN_ON((scratch & (0xf << DEFECT7374_FSM_FIELD))
  1676. == DEFECT7374_FSM_SS_CONTROL_READ);
  1677. scratch &= ~(0xf << DEFECT7374_FSM_FIELD);
  1678. ep_warn(dev, "Operate Defect 7374 workaround soft this time");
  1679. ep_warn(dev, "It will operate on cold-reboot and SS connect");
  1680. /*GPEPs:*/
  1681. tmp = ((0 << ENDPOINT_NUMBER) | BIT(ENDPOINT_DIRECTION) |
  1682. (2 << OUT_ENDPOINT_TYPE) | (2 << IN_ENDPOINT_TYPE) |
  1683. ((dev->enhanced_mode) ?
  1684. BIT(OUT_ENDPOINT_ENABLE) | BIT(IN_ENDPOINT_ENABLE) :
  1685. BIT(ENDPOINT_ENABLE)));
  1686. for (i = 1; i < 5; i++)
  1687. writel(tmp, &dev->ep[i].cfg->ep_cfg);
  1688. /* CSRIN, PCIIN, STATIN, RCIN*/
  1689. tmp = ((0 << ENDPOINT_NUMBER) | BIT(ENDPOINT_ENABLE));
  1690. writel(tmp, &dev->dep[1].dep_cfg);
  1691. writel(tmp, &dev->dep[3].dep_cfg);
  1692. writel(tmp, &dev->dep[4].dep_cfg);
  1693. writel(tmp, &dev->dep[5].dep_cfg);
  1694. /*Implemented for development and debug.
  1695. * Can be refined/tuned later.*/
  1696. for (ep_sel = 0; ep_sel <= 21; ep_sel++) {
  1697. /* Select an endpoint for subsequent operations: */
  1698. tmp_reg = readl(&dev->plregs->pl_ep_ctrl);
  1699. writel(((tmp_reg & ~0x1f) | ep_sel),
  1700. &dev->plregs->pl_ep_ctrl);
  1701. if (ep_sel == 1) {
  1702. tmp =
  1703. (readl(&dev->plregs->pl_ep_ctrl) |
  1704. BIT(CLEAR_ACK_ERROR_CODE) | 0);
  1705. writel(tmp, &dev->plregs->pl_ep_ctrl);
  1706. continue;
  1707. }
  1708. if (ep_sel == 0 || (ep_sel > 9 && ep_sel < 14) ||
  1709. ep_sel == 18 || ep_sel == 20)
  1710. continue;
  1711. tmp = (readl(&dev->plregs->pl_ep_cfg_4) |
  1712. BIT(NON_CTRL_IN_TOLERATE_BAD_DIR) | 0);
  1713. writel(tmp, &dev->plregs->pl_ep_cfg_4);
  1714. tmp = readl(&dev->plregs->pl_ep_ctrl) &
  1715. ~BIT(EP_INITIALIZED);
  1716. writel(tmp, &dev->plregs->pl_ep_ctrl);
  1717. }
  1718. /* Set FSM to focus on the first Control Read:
  1719. * - Tip: Connection speed is known upon the first
  1720. * setup request.*/
  1721. scratch |= DEFECT7374_FSM_WAITING_FOR_CONTROL_READ;
  1722. set_idx_reg(dev->regs, SCRATCH, scratch);
  1723. }
  1724. /* keeping it simple:
  1725. * - one bus driver, initted first;
  1726. * - one function driver, initted second
  1727. *
  1728. * most of the work to support multiple net2280 controllers would
  1729. * be to associate this gadget driver (yes?) with all of them, or
  1730. * perhaps to bind specific drivers to specific devices.
  1731. */
  1732. static void usb_reset_228x(struct net2280 *dev)
  1733. {
  1734. u32 tmp;
  1735. dev->gadget.speed = USB_SPEED_UNKNOWN;
  1736. (void) readl(&dev->usb->usbctl);
  1737. net2280_led_init(dev);
  1738. /* disable automatic responses, and irqs */
  1739. writel(0, &dev->usb->stdrsp);
  1740. writel(0, &dev->regs->pciirqenb0);
  1741. writel(0, &dev->regs->pciirqenb1);
  1742. /* clear old dma and irq state */
  1743. for (tmp = 0; tmp < 4; tmp++) {
  1744. struct net2280_ep *ep = &dev->ep[tmp + 1];
  1745. if (ep->dma)
  1746. abort_dma(ep);
  1747. }
  1748. writel(~0, &dev->regs->irqstat0),
  1749. writel(~(u32)BIT(SUSPEND_REQUEST_INTERRUPT), &dev->regs->irqstat1),
  1750. /* reset, and enable pci */
  1751. tmp = readl(&dev->regs->devinit) |
  1752. BIT(PCI_ENABLE) |
  1753. BIT(FIFO_SOFT_RESET) |
  1754. BIT(USB_SOFT_RESET) |
  1755. BIT(M8051_RESET);
  1756. writel(tmp, &dev->regs->devinit);
  1757. /* standard fifo and endpoint allocations */
  1758. set_fifo_mode(dev, (fifo_mode <= 2) ? fifo_mode : 0);
  1759. }
  1760. static void usb_reset_338x(struct net2280 *dev)
  1761. {
  1762. u32 tmp;
  1763. dev->gadget.speed = USB_SPEED_UNKNOWN;
  1764. (void)readl(&dev->usb->usbctl);
  1765. net2280_led_init(dev);
  1766. if (dev->bug7734_patched) {
  1767. /* disable automatic responses, and irqs */
  1768. writel(0, &dev->usb->stdrsp);
  1769. writel(0, &dev->regs->pciirqenb0);
  1770. writel(0, &dev->regs->pciirqenb1);
  1771. }
  1772. /* clear old dma and irq state */
  1773. for (tmp = 0; tmp < 4; tmp++) {
  1774. struct net2280_ep *ep = &dev->ep[tmp + 1];
  1775. struct net2280_dma_regs __iomem *dma;
  1776. if (ep->dma) {
  1777. abort_dma(ep);
  1778. } else {
  1779. dma = &dev->dma[tmp];
  1780. writel(BIT(DMA_ABORT), &dma->dmastat);
  1781. writel(0, &dma->dmactl);
  1782. }
  1783. }
  1784. writel(~0, &dev->regs->irqstat0), writel(~0, &dev->regs->irqstat1);
  1785. if (dev->bug7734_patched) {
  1786. /* reset, and enable pci */
  1787. tmp = readl(&dev->regs->devinit) |
  1788. BIT(PCI_ENABLE) |
  1789. BIT(FIFO_SOFT_RESET) |
  1790. BIT(USB_SOFT_RESET) |
  1791. BIT(M8051_RESET);
  1792. writel(tmp, &dev->regs->devinit);
  1793. }
  1794. /* always ep-{1,2,3,4} ... maybe not ep-3 or ep-4 */
  1795. INIT_LIST_HEAD(&dev->gadget.ep_list);
  1796. for (tmp = 1; tmp < dev->n_ep; tmp++)
  1797. list_add_tail(&dev->ep[tmp].ep.ep_list, &dev->gadget.ep_list);
  1798. }
  1799. static void usb_reset(struct net2280 *dev)
  1800. {
  1801. if (dev->quirks & PLX_LEGACY)
  1802. return usb_reset_228x(dev);
  1803. return usb_reset_338x(dev);
  1804. }
  1805. static void usb_reinit_228x(struct net2280 *dev)
  1806. {
  1807. u32 tmp;
  1808. /* basic endpoint init */
  1809. for (tmp = 0; tmp < 7; tmp++) {
  1810. struct net2280_ep *ep = &dev->ep[tmp];
  1811. ep->ep.name = ep_info_dft[tmp].name;
  1812. ep->ep.caps = ep_info_dft[tmp].caps;
  1813. ep->dev = dev;
  1814. ep->num = tmp;
  1815. if (tmp > 0 && tmp <= 4) {
  1816. ep->fifo_size = 1024;
  1817. ep->dma = &dev->dma[tmp - 1];
  1818. } else
  1819. ep->fifo_size = 64;
  1820. ep->regs = &dev->epregs[tmp];
  1821. ep->cfg = &dev->epregs[tmp];
  1822. ep_reset_228x(dev->regs, ep);
  1823. }
  1824. usb_ep_set_maxpacket_limit(&dev->ep[0].ep, 64);
  1825. usb_ep_set_maxpacket_limit(&dev->ep[5].ep, 64);
  1826. usb_ep_set_maxpacket_limit(&dev->ep[6].ep, 64);
  1827. dev->gadget.ep0 = &dev->ep[0].ep;
  1828. dev->ep[0].stopped = 0;
  1829. INIT_LIST_HEAD(&dev->gadget.ep0->ep_list);
  1830. /* we want to prevent lowlevel/insecure access from the USB host,
  1831. * but erratum 0119 means this enable bit is ignored
  1832. */
  1833. for (tmp = 0; tmp < 5; tmp++)
  1834. writel(EP_DONTUSE, &dev->dep[tmp].dep_cfg);
  1835. }
  1836. static void usb_reinit_338x(struct net2280 *dev)
  1837. {
  1838. int i;
  1839. u32 tmp, val;
  1840. static const u32 ne[9] = { 0, 1, 2, 3, 4, 1, 2, 3, 4 };
  1841. static const u32 ep_reg_addr[9] = { 0x00, 0xC0, 0x00, 0xC0, 0x00,
  1842. 0x00, 0xC0, 0x00, 0xC0 };
  1843. /* basic endpoint init */
  1844. for (i = 0; i < dev->n_ep; i++) {
  1845. struct net2280_ep *ep = &dev->ep[i];
  1846. ep->ep.name = dev->enhanced_mode ? ep_info_adv[i].name :
  1847. ep_info_dft[i].name;
  1848. ep->ep.caps = dev->enhanced_mode ? ep_info_adv[i].caps :
  1849. ep_info_dft[i].caps;
  1850. ep->dev = dev;
  1851. ep->num = i;
  1852. if (i > 0 && i <= 4)
  1853. ep->dma = &dev->dma[i - 1];
  1854. if (dev->enhanced_mode) {
  1855. ep->cfg = &dev->epregs[ne[i]];
  1856. /*
  1857. * Set USB endpoint number, hardware allows same number
  1858. * in both directions.
  1859. */
  1860. if (i > 0 && i < 5)
  1861. writel(ne[i], &ep->cfg->ep_cfg);
  1862. ep->regs = (struct net2280_ep_regs __iomem *)
  1863. (((void __iomem *)&dev->epregs[ne[i]]) +
  1864. ep_reg_addr[i]);
  1865. } else {
  1866. ep->cfg = &dev->epregs[i];
  1867. ep->regs = &dev->epregs[i];
  1868. }
  1869. ep->fifo_size = (i != 0) ? 2048 : 512;
  1870. ep_reset_338x(dev->regs, ep);
  1871. }
  1872. usb_ep_set_maxpacket_limit(&dev->ep[0].ep, 512);
  1873. dev->gadget.ep0 = &dev->ep[0].ep;
  1874. dev->ep[0].stopped = 0;
  1875. /* Link layer set up */
  1876. if (dev->bug7734_patched) {
  1877. tmp = readl(&dev->usb_ext->usbctl2) &
  1878. ~(BIT(U1_ENABLE) | BIT(U2_ENABLE) | BIT(LTM_ENABLE));
  1879. writel(tmp, &dev->usb_ext->usbctl2);
  1880. }
  1881. /* Hardware Defect and Workaround */
  1882. val = readl(&dev->ll_lfps_regs->ll_lfps_5);
  1883. val &= ~(0xf << TIMER_LFPS_6US);
  1884. val |= 0x5 << TIMER_LFPS_6US;
  1885. writel(val, &dev->ll_lfps_regs->ll_lfps_5);
  1886. val = readl(&dev->ll_lfps_regs->ll_lfps_6);
  1887. val &= ~(0xffff << TIMER_LFPS_80US);
  1888. val |= 0x0100 << TIMER_LFPS_80US;
  1889. writel(val, &dev->ll_lfps_regs->ll_lfps_6);
  1890. /*
  1891. * AA_AB Errata. Issue 4. Workaround for SuperSpeed USB
  1892. * Hot Reset Exit Handshake may Fail in Specific Case using
  1893. * Default Register Settings. Workaround for Enumeration test.
  1894. */
  1895. val = readl(&dev->ll_tsn_regs->ll_tsn_counters_2);
  1896. val &= ~(0x1f << HOT_TX_NORESET_TS2);
  1897. val |= 0x10 << HOT_TX_NORESET_TS2;
  1898. writel(val, &dev->ll_tsn_regs->ll_tsn_counters_2);
  1899. val = readl(&dev->ll_tsn_regs->ll_tsn_counters_3);
  1900. val &= ~(0x1f << HOT_RX_RESET_TS2);
  1901. val |= 0x3 << HOT_RX_RESET_TS2;
  1902. writel(val, &dev->ll_tsn_regs->ll_tsn_counters_3);
  1903. /*
  1904. * Set Recovery Idle to Recover bit:
  1905. * - On SS connections, setting Recovery Idle to Recover Fmw improves
  1906. * link robustness with various hosts and hubs.
  1907. * - It is safe to set for all connection speeds; all chip revisions.
  1908. * - R-M-W to leave other bits undisturbed.
  1909. * - Reference PLX TT-7372
  1910. */
  1911. val = readl(&dev->ll_chicken_reg->ll_tsn_chicken_bit);
  1912. val |= BIT(RECOVERY_IDLE_TO_RECOVER_FMW);
  1913. writel(val, &dev->ll_chicken_reg->ll_tsn_chicken_bit);
  1914. INIT_LIST_HEAD(&dev->gadget.ep0->ep_list);
  1915. /* disable dedicated endpoints */
  1916. writel(0x0D, &dev->dep[0].dep_cfg);
  1917. writel(0x0D, &dev->dep[1].dep_cfg);
  1918. writel(0x0E, &dev->dep[2].dep_cfg);
  1919. writel(0x0E, &dev->dep[3].dep_cfg);
  1920. writel(0x0F, &dev->dep[4].dep_cfg);
  1921. writel(0x0C, &dev->dep[5].dep_cfg);
  1922. }
  1923. static void usb_reinit(struct net2280 *dev)
  1924. {
  1925. if (dev->quirks & PLX_LEGACY)
  1926. return usb_reinit_228x(dev);
  1927. return usb_reinit_338x(dev);
  1928. }
  1929. static void ep0_start_228x(struct net2280 *dev)
  1930. {
  1931. writel(BIT(CLEAR_EP_HIDE_STATUS_PHASE) |
  1932. BIT(CLEAR_NAK_OUT_PACKETS) |
  1933. BIT(CLEAR_CONTROL_STATUS_PHASE_HANDSHAKE),
  1934. &dev->epregs[0].ep_rsp);
  1935. /*
  1936. * hardware optionally handles a bunch of standard requests
  1937. * that the API hides from drivers anyway. have it do so.
  1938. * endpoint status/features are handled in software, to
  1939. * help pass tests for some dubious behavior.
  1940. */
  1941. writel(BIT(SET_TEST_MODE) |
  1942. BIT(SET_ADDRESS) |
  1943. BIT(DEVICE_SET_CLEAR_DEVICE_REMOTE_WAKEUP) |
  1944. BIT(GET_DEVICE_STATUS) |
  1945. BIT(GET_INTERFACE_STATUS),
  1946. &dev->usb->stdrsp);
  1947. writel(BIT(USB_ROOT_PORT_WAKEUP_ENABLE) |
  1948. BIT(SELF_POWERED_USB_DEVICE) |
  1949. BIT(REMOTE_WAKEUP_SUPPORT) |
  1950. (dev->softconnect << USB_DETECT_ENABLE) |
  1951. BIT(SELF_POWERED_STATUS),
  1952. &dev->usb->usbctl);
  1953. /* enable irqs so we can see ep0 and general operation */
  1954. writel(BIT(SETUP_PACKET_INTERRUPT_ENABLE) |
  1955. BIT(ENDPOINT_0_INTERRUPT_ENABLE),
  1956. &dev->regs->pciirqenb0);
  1957. writel(BIT(PCI_INTERRUPT_ENABLE) |
  1958. BIT(PCI_MASTER_ABORT_RECEIVED_INTERRUPT_ENABLE) |
  1959. BIT(PCI_TARGET_ABORT_RECEIVED_INTERRUPT_ENABLE) |
  1960. BIT(PCI_RETRY_ABORT_INTERRUPT_ENABLE) |
  1961. BIT(VBUS_INTERRUPT_ENABLE) |
  1962. BIT(ROOT_PORT_RESET_INTERRUPT_ENABLE) |
  1963. BIT(SUSPEND_REQUEST_CHANGE_INTERRUPT_ENABLE),
  1964. &dev->regs->pciirqenb1);
  1965. /* don't leave any writes posted */
  1966. (void) readl(&dev->usb->usbctl);
  1967. }
  1968. static void ep0_start_338x(struct net2280 *dev)
  1969. {
  1970. if (dev->bug7734_patched)
  1971. writel(BIT(CLEAR_NAK_OUT_PACKETS_MODE) |
  1972. BIT(SET_EP_HIDE_STATUS_PHASE),
  1973. &dev->epregs[0].ep_rsp);
  1974. /*
  1975. * hardware optionally handles a bunch of standard requests
  1976. * that the API hides from drivers anyway. have it do so.
  1977. * endpoint status/features are handled in software, to
  1978. * help pass tests for some dubious behavior.
  1979. */
  1980. writel(BIT(SET_ISOCHRONOUS_DELAY) |
  1981. BIT(SET_SEL) |
  1982. BIT(SET_TEST_MODE) |
  1983. BIT(SET_ADDRESS) |
  1984. BIT(GET_INTERFACE_STATUS) |
  1985. BIT(GET_DEVICE_STATUS),
  1986. &dev->usb->stdrsp);
  1987. dev->wakeup_enable = 1;
  1988. writel(BIT(USB_ROOT_PORT_WAKEUP_ENABLE) |
  1989. (dev->softconnect << USB_DETECT_ENABLE) |
  1990. BIT(DEVICE_REMOTE_WAKEUP_ENABLE),
  1991. &dev->usb->usbctl);
  1992. /* enable irqs so we can see ep0 and general operation */
  1993. writel(BIT(SETUP_PACKET_INTERRUPT_ENABLE) |
  1994. BIT(ENDPOINT_0_INTERRUPT_ENABLE),
  1995. &dev->regs->pciirqenb0);
  1996. writel(BIT(PCI_INTERRUPT_ENABLE) |
  1997. BIT(ROOT_PORT_RESET_INTERRUPT_ENABLE) |
  1998. BIT(SUSPEND_REQUEST_CHANGE_INTERRUPT_ENABLE) |
  1999. BIT(VBUS_INTERRUPT_ENABLE),
  2000. &dev->regs->pciirqenb1);
  2001. /* don't leave any writes posted */
  2002. (void)readl(&dev->usb->usbctl);
  2003. }
  2004. static void ep0_start(struct net2280 *dev)
  2005. {
  2006. if (dev->quirks & PLX_LEGACY)
  2007. return ep0_start_228x(dev);
  2008. return ep0_start_338x(dev);
  2009. }
  2010. /* when a driver is successfully registered, it will receive
  2011. * control requests including set_configuration(), which enables
  2012. * non-control requests. then usb traffic follows until a
  2013. * disconnect is reported. then a host may connect again, or
  2014. * the driver might get unbound.
  2015. */
  2016. static int net2280_start(struct usb_gadget *_gadget,
  2017. struct usb_gadget_driver *driver)
  2018. {
  2019. struct net2280 *dev;
  2020. int retval;
  2021. unsigned i;
  2022. /* insist on high speed support from the driver, since
  2023. * (dev->usb->xcvrdiag & FORCE_FULL_SPEED_MODE)
  2024. * "must not be used in normal operation"
  2025. */
  2026. if (!driver || driver->max_speed < USB_SPEED_HIGH ||
  2027. !driver->setup)
  2028. return -EINVAL;
  2029. dev = container_of(_gadget, struct net2280, gadget);
  2030. for (i = 0; i < dev->n_ep; i++)
  2031. dev->ep[i].irqs = 0;
  2032. /* hook up the driver ... */
  2033. driver->driver.bus = NULL;
  2034. dev->driver = driver;
  2035. retval = device_create_file(&dev->pdev->dev, &dev_attr_function);
  2036. if (retval)
  2037. goto err_unbind;
  2038. retval = device_create_file(&dev->pdev->dev, &dev_attr_queues);
  2039. if (retval)
  2040. goto err_func;
  2041. /* enable host detection and ep0; and we're ready
  2042. * for set_configuration as well as eventual disconnect.
  2043. */
  2044. net2280_led_active(dev, 1);
  2045. if ((dev->quirks & PLX_SUPERSPEED) && !dev->bug7734_patched)
  2046. defect7374_enable_data_eps_zero(dev);
  2047. ep0_start(dev);
  2048. /* pci writes may still be posted */
  2049. return 0;
  2050. err_func:
  2051. device_remove_file(&dev->pdev->dev, &dev_attr_function);
  2052. err_unbind:
  2053. dev->driver = NULL;
  2054. return retval;
  2055. }
  2056. static void stop_activity(struct net2280 *dev, struct usb_gadget_driver *driver)
  2057. {
  2058. int i;
  2059. /* don't disconnect if it's not connected */
  2060. if (dev->gadget.speed == USB_SPEED_UNKNOWN)
  2061. driver = NULL;
  2062. /* stop hardware; prevent new request submissions;
  2063. * and kill any outstanding requests.
  2064. */
  2065. usb_reset(dev);
  2066. for (i = 0; i < dev->n_ep; i++)
  2067. nuke(&dev->ep[i]);
  2068. /* report disconnect; the driver is already quiesced */
  2069. if (driver) {
  2070. spin_unlock(&dev->lock);
  2071. driver->disconnect(&dev->gadget);
  2072. spin_lock(&dev->lock);
  2073. }
  2074. usb_reinit(dev);
  2075. }
  2076. static int net2280_stop(struct usb_gadget *_gadget)
  2077. {
  2078. struct net2280 *dev;
  2079. unsigned long flags;
  2080. dev = container_of(_gadget, struct net2280, gadget);
  2081. spin_lock_irqsave(&dev->lock, flags);
  2082. stop_activity(dev, NULL);
  2083. spin_unlock_irqrestore(&dev->lock, flags);
  2084. net2280_led_active(dev, 0);
  2085. device_remove_file(&dev->pdev->dev, &dev_attr_function);
  2086. device_remove_file(&dev->pdev->dev, &dev_attr_queues);
  2087. dev->driver = NULL;
  2088. return 0;
  2089. }
  2090. /*-------------------------------------------------------------------------*/
  2091. /* handle ep0, ep-e, ep-f with 64 byte packets: packet per irq.
  2092. * also works for dma-capable endpoints, in pio mode or just
  2093. * to manually advance the queue after short OUT transfers.
  2094. */
  2095. static void handle_ep_small(struct net2280_ep *ep)
  2096. {
  2097. struct net2280_request *req;
  2098. u32 t;
  2099. /* 0 error, 1 mid-data, 2 done */
  2100. int mode = 1;
  2101. if (!list_empty(&ep->queue))
  2102. req = list_entry(ep->queue.next,
  2103. struct net2280_request, queue);
  2104. else
  2105. req = NULL;
  2106. /* ack all, and handle what we care about */
  2107. t = readl(&ep->regs->ep_stat);
  2108. ep->irqs++;
  2109. ep_vdbg(ep->dev, "%s ack ep_stat %08x, req %p\n",
  2110. ep->ep.name, t, req ? &req->req : NULL);
  2111. if (!ep->is_in || (ep->dev->quirks & PLX_2280))
  2112. writel(t & ~BIT(NAK_OUT_PACKETS), &ep->regs->ep_stat);
  2113. else
  2114. /* Added for 2282 */
  2115. writel(t, &ep->regs->ep_stat);
  2116. /* for ep0, monitor token irqs to catch data stage length errors
  2117. * and to synchronize on status.
  2118. *
  2119. * also, to defer reporting of protocol stalls ... here's where
  2120. * data or status first appears, handling stalls here should never
  2121. * cause trouble on the host side..
  2122. *
  2123. * control requests could be slightly faster without token synch for
  2124. * status, but status can jam up that way.
  2125. */
  2126. if (unlikely(ep->num == 0)) {
  2127. if (ep->is_in) {
  2128. /* status; stop NAKing */
  2129. if (t & BIT(DATA_OUT_PING_TOKEN_INTERRUPT)) {
  2130. if (ep->dev->protocol_stall) {
  2131. ep->stopped = 1;
  2132. set_halt(ep);
  2133. }
  2134. if (!req)
  2135. allow_status(ep);
  2136. mode = 2;
  2137. /* reply to extra IN data tokens with a zlp */
  2138. } else if (t & BIT(DATA_IN_TOKEN_INTERRUPT)) {
  2139. if (ep->dev->protocol_stall) {
  2140. ep->stopped = 1;
  2141. set_halt(ep);
  2142. mode = 2;
  2143. } else if (ep->responded &&
  2144. !req && !ep->stopped)
  2145. write_fifo(ep, NULL);
  2146. }
  2147. } else {
  2148. /* status; stop NAKing */
  2149. if (t & BIT(DATA_IN_TOKEN_INTERRUPT)) {
  2150. if (ep->dev->protocol_stall) {
  2151. ep->stopped = 1;
  2152. set_halt(ep);
  2153. }
  2154. mode = 2;
  2155. /* an extra OUT token is an error */
  2156. } else if (((t & BIT(DATA_OUT_PING_TOKEN_INTERRUPT)) &&
  2157. req &&
  2158. req->req.actual == req->req.length) ||
  2159. (ep->responded && !req)) {
  2160. ep->dev->protocol_stall = 1;
  2161. set_halt(ep);
  2162. ep->stopped = 1;
  2163. if (req)
  2164. done(ep, req, -EOVERFLOW);
  2165. req = NULL;
  2166. }
  2167. }
  2168. }
  2169. if (unlikely(!req))
  2170. return;
  2171. /* manual DMA queue advance after short OUT */
  2172. if (likely(ep->dma)) {
  2173. if (t & BIT(SHORT_PACKET_TRANSFERRED_INTERRUPT)) {
  2174. u32 count;
  2175. int stopped = ep->stopped;
  2176. /* TRANSFERRED works around OUT_DONE erratum 0112.
  2177. * we expect (N <= maxpacket) bytes; host wrote M.
  2178. * iff (M < N) we won't ever see a DMA interrupt.
  2179. */
  2180. ep->stopped = 1;
  2181. for (count = 0; ; t = readl(&ep->regs->ep_stat)) {
  2182. /* any preceding dma transfers must finish.
  2183. * dma handles (M >= N), may empty the queue
  2184. */
  2185. scan_dma_completions(ep);
  2186. if (unlikely(list_empty(&ep->queue) ||
  2187. ep->out_overflow)) {
  2188. req = NULL;
  2189. break;
  2190. }
  2191. req = list_entry(ep->queue.next,
  2192. struct net2280_request, queue);
  2193. /* here either (M < N), a "real" short rx;
  2194. * or (M == N) and the queue didn't empty
  2195. */
  2196. if (likely(t & BIT(FIFO_EMPTY))) {
  2197. count = readl(&ep->dma->dmacount);
  2198. count &= DMA_BYTE_COUNT_MASK;
  2199. if (readl(&ep->dma->dmadesc)
  2200. != req->td_dma)
  2201. req = NULL;
  2202. break;
  2203. }
  2204. udelay(1);
  2205. }
  2206. /* stop DMA, leave ep NAKing */
  2207. writel(BIT(DMA_ABORT), &ep->dma->dmastat);
  2208. spin_stop_dma(ep->dma);
  2209. if (likely(req)) {
  2210. req->td->dmacount = 0;
  2211. t = readl(&ep->regs->ep_avail);
  2212. dma_done(ep, req, count,
  2213. (ep->out_overflow || t)
  2214. ? -EOVERFLOW : 0);
  2215. }
  2216. /* also flush to prevent erratum 0106 trouble */
  2217. if (unlikely(ep->out_overflow ||
  2218. (ep->dev->chiprev == 0x0100 &&
  2219. ep->dev->gadget.speed
  2220. == USB_SPEED_FULL))) {
  2221. out_flush(ep);
  2222. ep->out_overflow = 0;
  2223. }
  2224. /* (re)start dma if needed, stop NAKing */
  2225. ep->stopped = stopped;
  2226. if (!list_empty(&ep->queue))
  2227. restart_dma(ep);
  2228. } else
  2229. ep_dbg(ep->dev, "%s dma ep_stat %08x ??\n",
  2230. ep->ep.name, t);
  2231. return;
  2232. /* data packet(s) received (in the fifo, OUT) */
  2233. } else if (t & BIT(DATA_PACKET_RECEIVED_INTERRUPT)) {
  2234. if (read_fifo(ep, req) && ep->num != 0)
  2235. mode = 2;
  2236. /* data packet(s) transmitted (IN) */
  2237. } else if (t & BIT(DATA_PACKET_TRANSMITTED_INTERRUPT)) {
  2238. unsigned len;
  2239. len = req->req.length - req->req.actual;
  2240. if (len > ep->ep.maxpacket)
  2241. len = ep->ep.maxpacket;
  2242. req->req.actual += len;
  2243. /* if we wrote it all, we're usually done */
  2244. /* send zlps until the status stage */
  2245. if ((req->req.actual == req->req.length) &&
  2246. (!req->req.zero || len != ep->ep.maxpacket) && ep->num)
  2247. mode = 2;
  2248. /* there was nothing to do ... */
  2249. } else if (mode == 1)
  2250. return;
  2251. /* done */
  2252. if (mode == 2) {
  2253. /* stream endpoints often resubmit/unlink in completion */
  2254. done(ep, req, 0);
  2255. /* maybe advance queue to next request */
  2256. if (ep->num == 0) {
  2257. /* NOTE: net2280 could let gadget driver start the
  2258. * status stage later. since not all controllers let
  2259. * them control that, the api doesn't (yet) allow it.
  2260. */
  2261. if (!ep->stopped)
  2262. allow_status(ep);
  2263. req = NULL;
  2264. } else {
  2265. if (!list_empty(&ep->queue) && !ep->stopped)
  2266. req = list_entry(ep->queue.next,
  2267. struct net2280_request, queue);
  2268. else
  2269. req = NULL;
  2270. if (req && !ep->is_in)
  2271. stop_out_naking(ep);
  2272. }
  2273. }
  2274. /* is there a buffer for the next packet?
  2275. * for best streaming performance, make sure there is one.
  2276. */
  2277. if (req && !ep->stopped) {
  2278. /* load IN fifo with next packet (may be zlp) */
  2279. if (t & BIT(DATA_PACKET_TRANSMITTED_INTERRUPT))
  2280. write_fifo(ep, &req->req);
  2281. }
  2282. }
  2283. static struct net2280_ep *get_ep_by_addr(struct net2280 *dev, u16 wIndex)
  2284. {
  2285. struct net2280_ep *ep;
  2286. if ((wIndex & USB_ENDPOINT_NUMBER_MASK) == 0)
  2287. return &dev->ep[0];
  2288. list_for_each_entry(ep, &dev->gadget.ep_list, ep.ep_list) {
  2289. u8 bEndpointAddress;
  2290. if (!ep->desc)
  2291. continue;
  2292. bEndpointAddress = ep->desc->bEndpointAddress;
  2293. if ((wIndex ^ bEndpointAddress) & USB_DIR_IN)
  2294. continue;
  2295. if ((wIndex & 0x0f) == (bEndpointAddress & 0x0f))
  2296. return ep;
  2297. }
  2298. return NULL;
  2299. }
  2300. static void defect7374_workaround(struct net2280 *dev, struct usb_ctrlrequest r)
  2301. {
  2302. u32 scratch, fsmvalue;
  2303. u32 ack_wait_timeout, state;
  2304. /* Workaround for Defect 7374 (U1/U2 erroneously rejected): */
  2305. scratch = get_idx_reg(dev->regs, SCRATCH);
  2306. fsmvalue = scratch & (0xf << DEFECT7374_FSM_FIELD);
  2307. scratch &= ~(0xf << DEFECT7374_FSM_FIELD);
  2308. if (!((fsmvalue == DEFECT7374_FSM_WAITING_FOR_CONTROL_READ) &&
  2309. (r.bRequestType & USB_DIR_IN)))
  2310. return;
  2311. /* This is the first Control Read for this connection: */
  2312. if (!(readl(&dev->usb->usbstat) & BIT(SUPER_SPEED_MODE))) {
  2313. /*
  2314. * Connection is NOT SS:
  2315. * - Connection must be FS or HS.
  2316. * - This FSM state should allow workaround software to
  2317. * run after the next USB connection.
  2318. */
  2319. scratch |= DEFECT7374_FSM_NON_SS_CONTROL_READ;
  2320. dev->bug7734_patched = 1;
  2321. goto restore_data_eps;
  2322. }
  2323. /* Connection is SS: */
  2324. for (ack_wait_timeout = 0;
  2325. ack_wait_timeout < DEFECT_7374_NUMBEROF_MAX_WAIT_LOOPS;
  2326. ack_wait_timeout++) {
  2327. state = readl(&dev->plregs->pl_ep_status_1)
  2328. & (0xff << STATE);
  2329. if ((state >= (ACK_GOOD_NORMAL << STATE)) &&
  2330. (state <= (ACK_GOOD_MORE_ACKS_TO_COME << STATE))) {
  2331. scratch |= DEFECT7374_FSM_SS_CONTROL_READ;
  2332. dev->bug7734_patched = 1;
  2333. break;
  2334. }
  2335. /*
  2336. * We have not yet received host's Data Phase ACK
  2337. * - Wait and try again.
  2338. */
  2339. udelay(DEFECT_7374_PROCESSOR_WAIT_TIME);
  2340. continue;
  2341. }
  2342. if (ack_wait_timeout >= DEFECT_7374_NUMBEROF_MAX_WAIT_LOOPS) {
  2343. ep_err(dev, "FAIL: Defect 7374 workaround waited but failed "
  2344. "to detect SS host's data phase ACK.");
  2345. ep_err(dev, "PL_EP_STATUS_1(23:16):.Expected from 0x11 to 0x16"
  2346. "got 0x%2.2x.\n", state >> STATE);
  2347. } else {
  2348. ep_warn(dev, "INFO: Defect 7374 workaround waited about\n"
  2349. "%duSec for Control Read Data Phase ACK\n",
  2350. DEFECT_7374_PROCESSOR_WAIT_TIME * ack_wait_timeout);
  2351. }
  2352. restore_data_eps:
  2353. /*
  2354. * Restore data EPs to their pre-workaround settings (disabled,
  2355. * initialized, and other details).
  2356. */
  2357. defect7374_disable_data_eps(dev);
  2358. set_idx_reg(dev->regs, SCRATCH, scratch);
  2359. return;
  2360. }
  2361. static void ep_clear_seqnum(struct net2280_ep *ep)
  2362. {
  2363. struct net2280 *dev = ep->dev;
  2364. u32 val;
  2365. static const u32 ep_pl[9] = { 0, 3, 4, 7, 8, 2, 5, 6, 9 };
  2366. val = readl(&dev->plregs->pl_ep_ctrl) & ~0x1f;
  2367. val |= ep_pl[ep->num];
  2368. writel(val, &dev->plregs->pl_ep_ctrl);
  2369. val |= BIT(SEQUENCE_NUMBER_RESET);
  2370. writel(val, &dev->plregs->pl_ep_ctrl);
  2371. return;
  2372. }
  2373. static void handle_stat0_irqs_superspeed(struct net2280 *dev,
  2374. struct net2280_ep *ep, struct usb_ctrlrequest r)
  2375. {
  2376. int tmp = 0;
  2377. #define w_value le16_to_cpu(r.wValue)
  2378. #define w_index le16_to_cpu(r.wIndex)
  2379. #define w_length le16_to_cpu(r.wLength)
  2380. switch (r.bRequest) {
  2381. struct net2280_ep *e;
  2382. u16 status;
  2383. case USB_REQ_SET_CONFIGURATION:
  2384. dev->addressed_state = !w_value;
  2385. goto usb3_delegate;
  2386. case USB_REQ_GET_STATUS:
  2387. switch (r.bRequestType) {
  2388. case (USB_DIR_IN | USB_TYPE_STANDARD | USB_RECIP_DEVICE):
  2389. status = dev->wakeup_enable ? 0x02 : 0x00;
  2390. if (dev->gadget.is_selfpowered)
  2391. status |= BIT(0);
  2392. status |= (dev->u1_enable << 2 | dev->u2_enable << 3 |
  2393. dev->ltm_enable << 4);
  2394. writel(0, &dev->epregs[0].ep_irqenb);
  2395. set_fifo_bytecount(ep, sizeof(status));
  2396. writel((__force u32) status, &dev->epregs[0].ep_data);
  2397. allow_status_338x(ep);
  2398. break;
  2399. case (USB_DIR_IN | USB_TYPE_STANDARD | USB_RECIP_ENDPOINT):
  2400. e = get_ep_by_addr(dev, w_index);
  2401. if (!e)
  2402. goto do_stall3;
  2403. status = readl(&e->regs->ep_rsp) &
  2404. BIT(CLEAR_ENDPOINT_HALT);
  2405. writel(0, &dev->epregs[0].ep_irqenb);
  2406. set_fifo_bytecount(ep, sizeof(status));
  2407. writel((__force u32) status, &dev->epregs[0].ep_data);
  2408. allow_status_338x(ep);
  2409. break;
  2410. default:
  2411. goto usb3_delegate;
  2412. }
  2413. break;
  2414. case USB_REQ_CLEAR_FEATURE:
  2415. switch (r.bRequestType) {
  2416. case (USB_DIR_OUT | USB_TYPE_STANDARD | USB_RECIP_DEVICE):
  2417. if (!dev->addressed_state) {
  2418. switch (w_value) {
  2419. case USB_DEVICE_U1_ENABLE:
  2420. dev->u1_enable = 0;
  2421. writel(readl(&dev->usb_ext->usbctl2) &
  2422. ~BIT(U1_ENABLE),
  2423. &dev->usb_ext->usbctl2);
  2424. allow_status_338x(ep);
  2425. goto next_endpoints3;
  2426. case USB_DEVICE_U2_ENABLE:
  2427. dev->u2_enable = 0;
  2428. writel(readl(&dev->usb_ext->usbctl2) &
  2429. ~BIT(U2_ENABLE),
  2430. &dev->usb_ext->usbctl2);
  2431. allow_status_338x(ep);
  2432. goto next_endpoints3;
  2433. case USB_DEVICE_LTM_ENABLE:
  2434. dev->ltm_enable = 0;
  2435. writel(readl(&dev->usb_ext->usbctl2) &
  2436. ~BIT(LTM_ENABLE),
  2437. &dev->usb_ext->usbctl2);
  2438. allow_status_338x(ep);
  2439. goto next_endpoints3;
  2440. default:
  2441. break;
  2442. }
  2443. }
  2444. if (w_value == USB_DEVICE_REMOTE_WAKEUP) {
  2445. dev->wakeup_enable = 0;
  2446. writel(readl(&dev->usb->usbctl) &
  2447. ~BIT(DEVICE_REMOTE_WAKEUP_ENABLE),
  2448. &dev->usb->usbctl);
  2449. allow_status_338x(ep);
  2450. break;
  2451. }
  2452. goto usb3_delegate;
  2453. case (USB_DIR_OUT | USB_TYPE_STANDARD | USB_RECIP_ENDPOINT):
  2454. e = get_ep_by_addr(dev, w_index);
  2455. if (!e)
  2456. goto do_stall3;
  2457. if (w_value != USB_ENDPOINT_HALT)
  2458. goto do_stall3;
  2459. ep_vdbg(dev, "%s clear halt\n", e->ep.name);
  2460. /*
  2461. * Workaround for SS SeqNum not cleared via
  2462. * Endpoint Halt (Clear) bit. select endpoint
  2463. */
  2464. ep_clear_seqnum(e);
  2465. clear_halt(e);
  2466. if (!list_empty(&e->queue) && e->td_dma)
  2467. restart_dma(e);
  2468. allow_status(ep);
  2469. ep->stopped = 1;
  2470. break;
  2471. default:
  2472. goto usb3_delegate;
  2473. }
  2474. break;
  2475. case USB_REQ_SET_FEATURE:
  2476. switch (r.bRequestType) {
  2477. case (USB_DIR_OUT | USB_TYPE_STANDARD | USB_RECIP_DEVICE):
  2478. if (!dev->addressed_state) {
  2479. switch (w_value) {
  2480. case USB_DEVICE_U1_ENABLE:
  2481. dev->u1_enable = 1;
  2482. writel(readl(&dev->usb_ext->usbctl2) |
  2483. BIT(U1_ENABLE),
  2484. &dev->usb_ext->usbctl2);
  2485. allow_status_338x(ep);
  2486. goto next_endpoints3;
  2487. case USB_DEVICE_U2_ENABLE:
  2488. dev->u2_enable = 1;
  2489. writel(readl(&dev->usb_ext->usbctl2) |
  2490. BIT(U2_ENABLE),
  2491. &dev->usb_ext->usbctl2);
  2492. allow_status_338x(ep);
  2493. goto next_endpoints3;
  2494. case USB_DEVICE_LTM_ENABLE:
  2495. dev->ltm_enable = 1;
  2496. writel(readl(&dev->usb_ext->usbctl2) |
  2497. BIT(LTM_ENABLE),
  2498. &dev->usb_ext->usbctl2);
  2499. allow_status_338x(ep);
  2500. goto next_endpoints3;
  2501. default:
  2502. break;
  2503. }
  2504. }
  2505. if (w_value == USB_DEVICE_REMOTE_WAKEUP) {
  2506. dev->wakeup_enable = 1;
  2507. writel(readl(&dev->usb->usbctl) |
  2508. BIT(DEVICE_REMOTE_WAKEUP_ENABLE),
  2509. &dev->usb->usbctl);
  2510. allow_status_338x(ep);
  2511. break;
  2512. }
  2513. goto usb3_delegate;
  2514. case (USB_DIR_OUT | USB_TYPE_STANDARD | USB_RECIP_ENDPOINT):
  2515. e = get_ep_by_addr(dev, w_index);
  2516. if (!e || (w_value != USB_ENDPOINT_HALT))
  2517. goto do_stall3;
  2518. ep->stopped = 1;
  2519. if (ep->num == 0)
  2520. ep->dev->protocol_stall = 1;
  2521. else {
  2522. if (ep->dma)
  2523. abort_dma(ep);
  2524. set_halt(ep);
  2525. }
  2526. allow_status_338x(ep);
  2527. break;
  2528. default:
  2529. goto usb3_delegate;
  2530. }
  2531. break;
  2532. default:
  2533. usb3_delegate:
  2534. ep_vdbg(dev, "setup %02x.%02x v%04x i%04x l%04x ep_cfg %08x\n",
  2535. r.bRequestType, r.bRequest,
  2536. w_value, w_index, w_length,
  2537. readl(&ep->cfg->ep_cfg));
  2538. ep->responded = 0;
  2539. spin_unlock(&dev->lock);
  2540. tmp = dev->driver->setup(&dev->gadget, &r);
  2541. spin_lock(&dev->lock);
  2542. }
  2543. do_stall3:
  2544. if (tmp < 0) {
  2545. ep_vdbg(dev, "req %02x.%02x protocol STALL; stat %d\n",
  2546. r.bRequestType, r.bRequest, tmp);
  2547. dev->protocol_stall = 1;
  2548. /* TD 9.9 Halt Endpoint test. TD 9.22 Set feature test */
  2549. set_halt(ep);
  2550. }
  2551. next_endpoints3:
  2552. #undef w_value
  2553. #undef w_index
  2554. #undef w_length
  2555. return;
  2556. }
  2557. static void usb338x_handle_ep_intr(struct net2280 *dev, u32 stat0)
  2558. {
  2559. u32 index;
  2560. u32 bit;
  2561. for (index = 0; index < ARRAY_SIZE(ep_bit); index++) {
  2562. bit = BIT(ep_bit[index]);
  2563. if (!stat0)
  2564. break;
  2565. if (!(stat0 & bit))
  2566. continue;
  2567. stat0 &= ~bit;
  2568. handle_ep_small(&dev->ep[index]);
  2569. }
  2570. }
  2571. static void handle_stat0_irqs(struct net2280 *dev, u32 stat)
  2572. {
  2573. struct net2280_ep *ep;
  2574. u32 num, scratch;
  2575. /* most of these don't need individual acks */
  2576. stat &= ~BIT(INTA_ASSERTED);
  2577. if (!stat)
  2578. return;
  2579. /* ep_dbg(dev, "irqstat0 %04x\n", stat); */
  2580. /* starting a control request? */
  2581. if (unlikely(stat & BIT(SETUP_PACKET_INTERRUPT))) {
  2582. union {
  2583. u32 raw[2];
  2584. struct usb_ctrlrequest r;
  2585. } u;
  2586. int tmp;
  2587. struct net2280_request *req;
  2588. if (dev->gadget.speed == USB_SPEED_UNKNOWN) {
  2589. u32 val = readl(&dev->usb->usbstat);
  2590. if (val & BIT(SUPER_SPEED)) {
  2591. dev->gadget.speed = USB_SPEED_SUPER;
  2592. usb_ep_set_maxpacket_limit(&dev->ep[0].ep,
  2593. EP0_SS_MAX_PACKET_SIZE);
  2594. } else if (val & BIT(HIGH_SPEED)) {
  2595. dev->gadget.speed = USB_SPEED_HIGH;
  2596. usb_ep_set_maxpacket_limit(&dev->ep[0].ep,
  2597. EP0_HS_MAX_PACKET_SIZE);
  2598. } else {
  2599. dev->gadget.speed = USB_SPEED_FULL;
  2600. usb_ep_set_maxpacket_limit(&dev->ep[0].ep,
  2601. EP0_HS_MAX_PACKET_SIZE);
  2602. }
  2603. net2280_led_speed(dev, dev->gadget.speed);
  2604. ep_dbg(dev, "%s\n",
  2605. usb_speed_string(dev->gadget.speed));
  2606. }
  2607. ep = &dev->ep[0];
  2608. ep->irqs++;
  2609. /* make sure any leftover request state is cleared */
  2610. stat &= ~BIT(ENDPOINT_0_INTERRUPT);
  2611. while (!list_empty(&ep->queue)) {
  2612. req = list_entry(ep->queue.next,
  2613. struct net2280_request, queue);
  2614. done(ep, req, (req->req.actual == req->req.length)
  2615. ? 0 : -EPROTO);
  2616. }
  2617. ep->stopped = 0;
  2618. dev->protocol_stall = 0;
  2619. if (!(dev->quirks & PLX_SUPERSPEED)) {
  2620. if (ep->dev->quirks & PLX_2280)
  2621. tmp = BIT(FIFO_OVERFLOW) |
  2622. BIT(FIFO_UNDERFLOW);
  2623. else
  2624. tmp = 0;
  2625. writel(tmp | BIT(TIMEOUT) |
  2626. BIT(USB_STALL_SENT) |
  2627. BIT(USB_IN_NAK_SENT) |
  2628. BIT(USB_IN_ACK_RCVD) |
  2629. BIT(USB_OUT_PING_NAK_SENT) |
  2630. BIT(USB_OUT_ACK_SENT) |
  2631. BIT(SHORT_PACKET_OUT_DONE_INTERRUPT) |
  2632. BIT(SHORT_PACKET_TRANSFERRED_INTERRUPT) |
  2633. BIT(DATA_PACKET_RECEIVED_INTERRUPT) |
  2634. BIT(DATA_PACKET_TRANSMITTED_INTERRUPT) |
  2635. BIT(DATA_OUT_PING_TOKEN_INTERRUPT) |
  2636. BIT(DATA_IN_TOKEN_INTERRUPT),
  2637. &ep->regs->ep_stat);
  2638. }
  2639. u.raw[0] = readl(&dev->usb->setup0123);
  2640. u.raw[1] = readl(&dev->usb->setup4567);
  2641. cpu_to_le32s(&u.raw[0]);
  2642. cpu_to_le32s(&u.raw[1]);
  2643. if ((dev->quirks & PLX_SUPERSPEED) && !dev->bug7734_patched)
  2644. defect7374_workaround(dev, u.r);
  2645. tmp = 0;
  2646. #define w_value le16_to_cpu(u.r.wValue)
  2647. #define w_index le16_to_cpu(u.r.wIndex)
  2648. #define w_length le16_to_cpu(u.r.wLength)
  2649. /* ack the irq */
  2650. writel(BIT(SETUP_PACKET_INTERRUPT), &dev->regs->irqstat0);
  2651. stat ^= BIT(SETUP_PACKET_INTERRUPT);
  2652. /* watch control traffic at the token level, and force
  2653. * synchronization before letting the status stage happen.
  2654. * FIXME ignore tokens we'll NAK, until driver responds.
  2655. * that'll mean a lot less irqs for some drivers.
  2656. */
  2657. ep->is_in = (u.r.bRequestType & USB_DIR_IN) != 0;
  2658. if (ep->is_in) {
  2659. scratch = BIT(DATA_PACKET_TRANSMITTED_INTERRUPT) |
  2660. BIT(DATA_OUT_PING_TOKEN_INTERRUPT) |
  2661. BIT(DATA_IN_TOKEN_INTERRUPT);
  2662. stop_out_naking(ep);
  2663. } else
  2664. scratch = BIT(DATA_PACKET_RECEIVED_INTERRUPT) |
  2665. BIT(DATA_OUT_PING_TOKEN_INTERRUPT) |
  2666. BIT(DATA_IN_TOKEN_INTERRUPT);
  2667. writel(scratch, &dev->epregs[0].ep_irqenb);
  2668. /* we made the hardware handle most lowlevel requests;
  2669. * everything else goes uplevel to the gadget code.
  2670. */
  2671. ep->responded = 1;
  2672. if (dev->gadget.speed == USB_SPEED_SUPER) {
  2673. handle_stat0_irqs_superspeed(dev, ep, u.r);
  2674. goto next_endpoints;
  2675. }
  2676. switch (u.r.bRequest) {
  2677. case USB_REQ_GET_STATUS: {
  2678. struct net2280_ep *e;
  2679. __le32 status;
  2680. /* hw handles device and interface status */
  2681. if (u.r.bRequestType != (USB_DIR_IN|USB_RECIP_ENDPOINT))
  2682. goto delegate;
  2683. e = get_ep_by_addr(dev, w_index);
  2684. if (!e || w_length > 2)
  2685. goto do_stall;
  2686. if (readl(&e->regs->ep_rsp) & BIT(SET_ENDPOINT_HALT))
  2687. status = cpu_to_le32(1);
  2688. else
  2689. status = cpu_to_le32(0);
  2690. /* don't bother with a request object! */
  2691. writel(0, &dev->epregs[0].ep_irqenb);
  2692. set_fifo_bytecount(ep, w_length);
  2693. writel((__force u32)status, &dev->epregs[0].ep_data);
  2694. allow_status(ep);
  2695. ep_vdbg(dev, "%s stat %02x\n", ep->ep.name, status);
  2696. goto next_endpoints;
  2697. }
  2698. break;
  2699. case USB_REQ_CLEAR_FEATURE: {
  2700. struct net2280_ep *e;
  2701. /* hw handles device features */
  2702. if (u.r.bRequestType != USB_RECIP_ENDPOINT)
  2703. goto delegate;
  2704. if (w_value != USB_ENDPOINT_HALT || w_length != 0)
  2705. goto do_stall;
  2706. e = get_ep_by_addr(dev, w_index);
  2707. if (!e)
  2708. goto do_stall;
  2709. if (e->wedged) {
  2710. ep_vdbg(dev, "%s wedged, halt not cleared\n",
  2711. ep->ep.name);
  2712. } else {
  2713. ep_vdbg(dev, "%s clear halt\n", e->ep.name);
  2714. clear_halt(e);
  2715. if ((ep->dev->quirks & PLX_SUPERSPEED) &&
  2716. !list_empty(&e->queue) && e->td_dma)
  2717. restart_dma(e);
  2718. }
  2719. allow_status(ep);
  2720. goto next_endpoints;
  2721. }
  2722. break;
  2723. case USB_REQ_SET_FEATURE: {
  2724. struct net2280_ep *e;
  2725. /* hw handles device features */
  2726. if (u.r.bRequestType != USB_RECIP_ENDPOINT)
  2727. goto delegate;
  2728. if (w_value != USB_ENDPOINT_HALT || w_length != 0)
  2729. goto do_stall;
  2730. e = get_ep_by_addr(dev, w_index);
  2731. if (!e)
  2732. goto do_stall;
  2733. if (e->ep.name == ep0name)
  2734. goto do_stall;
  2735. set_halt(e);
  2736. if ((dev->quirks & PLX_SUPERSPEED) && e->dma)
  2737. abort_dma(e);
  2738. allow_status(ep);
  2739. ep_vdbg(dev, "%s set halt\n", ep->ep.name);
  2740. goto next_endpoints;
  2741. }
  2742. break;
  2743. default:
  2744. delegate:
  2745. ep_vdbg(dev, "setup %02x.%02x v%04x i%04x l%04x "
  2746. "ep_cfg %08x\n",
  2747. u.r.bRequestType, u.r.bRequest,
  2748. w_value, w_index, w_length,
  2749. readl(&ep->cfg->ep_cfg));
  2750. ep->responded = 0;
  2751. spin_unlock(&dev->lock);
  2752. tmp = dev->driver->setup(&dev->gadget, &u.r);
  2753. spin_lock(&dev->lock);
  2754. }
  2755. /* stall ep0 on error */
  2756. if (tmp < 0) {
  2757. do_stall:
  2758. ep_vdbg(dev, "req %02x.%02x protocol STALL; stat %d\n",
  2759. u.r.bRequestType, u.r.bRequest, tmp);
  2760. dev->protocol_stall = 1;
  2761. }
  2762. /* some in/out token irq should follow; maybe stall then.
  2763. * driver must queue a request (even zlp) or halt ep0
  2764. * before the host times out.
  2765. */
  2766. }
  2767. #undef w_value
  2768. #undef w_index
  2769. #undef w_length
  2770. next_endpoints:
  2771. if ((dev->quirks & PLX_SUPERSPEED) && dev->enhanced_mode) {
  2772. u32 mask = (BIT(ENDPOINT_0_INTERRUPT) |
  2773. USB3380_IRQSTAT0_EP_INTR_MASK_IN |
  2774. USB3380_IRQSTAT0_EP_INTR_MASK_OUT);
  2775. if (stat & mask) {
  2776. usb338x_handle_ep_intr(dev, stat & mask);
  2777. stat &= ~mask;
  2778. }
  2779. } else {
  2780. /* endpoint data irq ? */
  2781. scratch = stat & 0x7f;
  2782. stat &= ~0x7f;
  2783. for (num = 0; scratch; num++) {
  2784. u32 t;
  2785. /* do this endpoint's FIFO and queue need tending? */
  2786. t = BIT(num);
  2787. if ((scratch & t) == 0)
  2788. continue;
  2789. scratch ^= t;
  2790. ep = &dev->ep[num];
  2791. handle_ep_small(ep);
  2792. }
  2793. }
  2794. if (stat)
  2795. ep_dbg(dev, "unhandled irqstat0 %08x\n", stat);
  2796. }
  2797. #define DMA_INTERRUPTS (BIT(DMA_D_INTERRUPT) | \
  2798. BIT(DMA_C_INTERRUPT) | \
  2799. BIT(DMA_B_INTERRUPT) | \
  2800. BIT(DMA_A_INTERRUPT))
  2801. #define PCI_ERROR_INTERRUPTS ( \
  2802. BIT(PCI_MASTER_ABORT_RECEIVED_INTERRUPT) | \
  2803. BIT(PCI_TARGET_ABORT_RECEIVED_INTERRUPT) | \
  2804. BIT(PCI_RETRY_ABORT_INTERRUPT))
  2805. static void handle_stat1_irqs(struct net2280 *dev, u32 stat)
  2806. __releases(dev->lock)
  2807. __acquires(dev->lock)
  2808. {
  2809. struct net2280_ep *ep;
  2810. u32 tmp, num, mask, scratch;
  2811. /* after disconnect there's nothing else to do! */
  2812. tmp = BIT(VBUS_INTERRUPT) | BIT(ROOT_PORT_RESET_INTERRUPT);
  2813. mask = BIT(SUPER_SPEED) | BIT(HIGH_SPEED) | BIT(FULL_SPEED);
  2814. /* VBUS disconnect is indicated by VBUS_PIN and VBUS_INTERRUPT set.
  2815. * Root Port Reset is indicated by ROOT_PORT_RESET_INTERRUPT set and
  2816. * both HIGH_SPEED and FULL_SPEED clear (as ROOT_PORT_RESET_INTERRUPT
  2817. * only indicates a change in the reset state).
  2818. */
  2819. if (stat & tmp) {
  2820. bool reset = false;
  2821. bool disconnect = false;
  2822. /*
  2823. * Ignore disconnects and resets if the speed hasn't been set.
  2824. * VBUS can bounce and there's always an initial reset.
  2825. */
  2826. writel(tmp, &dev->regs->irqstat1);
  2827. if (dev->gadget.speed != USB_SPEED_UNKNOWN) {
  2828. if ((stat & BIT(VBUS_INTERRUPT)) &&
  2829. (readl(&dev->usb->usbctl) &
  2830. BIT(VBUS_PIN)) == 0) {
  2831. disconnect = true;
  2832. ep_dbg(dev, "disconnect %s\n",
  2833. dev->driver->driver.name);
  2834. } else if ((stat & BIT(ROOT_PORT_RESET_INTERRUPT)) &&
  2835. (readl(&dev->usb->usbstat) & mask)
  2836. == 0) {
  2837. reset = true;
  2838. ep_dbg(dev, "reset %s\n",
  2839. dev->driver->driver.name);
  2840. }
  2841. if (disconnect || reset) {
  2842. stop_activity(dev, dev->driver);
  2843. ep0_start(dev);
  2844. spin_unlock(&dev->lock);
  2845. if (reset)
  2846. usb_gadget_udc_reset
  2847. (&dev->gadget, dev->driver);
  2848. else
  2849. (dev->driver->disconnect)
  2850. (&dev->gadget);
  2851. spin_lock(&dev->lock);
  2852. return;
  2853. }
  2854. }
  2855. stat &= ~tmp;
  2856. /* vBUS can bounce ... one of many reasons to ignore the
  2857. * notion of hotplug events on bus connect/disconnect!
  2858. */
  2859. if (!stat)
  2860. return;
  2861. }
  2862. /* NOTE: chip stays in PCI D0 state for now, but it could
  2863. * enter D1 to save more power
  2864. */
  2865. tmp = BIT(SUSPEND_REQUEST_CHANGE_INTERRUPT);
  2866. if (stat & tmp) {
  2867. writel(tmp, &dev->regs->irqstat1);
  2868. if (stat & BIT(SUSPEND_REQUEST_INTERRUPT)) {
  2869. if (dev->driver->suspend)
  2870. dev->driver->suspend(&dev->gadget);
  2871. if (!enable_suspend)
  2872. stat &= ~BIT(SUSPEND_REQUEST_INTERRUPT);
  2873. } else {
  2874. if (dev->driver->resume)
  2875. dev->driver->resume(&dev->gadget);
  2876. /* at high speed, note erratum 0133 */
  2877. }
  2878. stat &= ~tmp;
  2879. }
  2880. /* clear any other status/irqs */
  2881. if (stat)
  2882. writel(stat, &dev->regs->irqstat1);
  2883. /* some status we can just ignore */
  2884. if (dev->quirks & PLX_2280)
  2885. stat &= ~(BIT(CONTROL_STATUS_INTERRUPT) |
  2886. BIT(SUSPEND_REQUEST_INTERRUPT) |
  2887. BIT(RESUME_INTERRUPT) |
  2888. BIT(SOF_INTERRUPT));
  2889. else
  2890. stat &= ~(BIT(CONTROL_STATUS_INTERRUPT) |
  2891. BIT(RESUME_INTERRUPT) |
  2892. BIT(SOF_DOWN_INTERRUPT) |
  2893. BIT(SOF_INTERRUPT));
  2894. if (!stat)
  2895. return;
  2896. /* ep_dbg(dev, "irqstat1 %08x\n", stat);*/
  2897. /* DMA status, for ep-{a,b,c,d} */
  2898. scratch = stat & DMA_INTERRUPTS;
  2899. stat &= ~DMA_INTERRUPTS;
  2900. scratch >>= 9;
  2901. for (num = 0; scratch; num++) {
  2902. struct net2280_dma_regs __iomem *dma;
  2903. tmp = BIT(num);
  2904. if ((tmp & scratch) == 0)
  2905. continue;
  2906. scratch ^= tmp;
  2907. ep = &dev->ep[num + 1];
  2908. dma = ep->dma;
  2909. if (!dma)
  2910. continue;
  2911. /* clear ep's dma status */
  2912. tmp = readl(&dma->dmastat);
  2913. writel(tmp, &dma->dmastat);
  2914. /* dma sync*/
  2915. if (dev->quirks & PLX_SUPERSPEED) {
  2916. u32 r_dmacount = readl(&dma->dmacount);
  2917. if (!ep->is_in && (r_dmacount & 0x00FFFFFF) &&
  2918. (tmp & BIT(DMA_TRANSACTION_DONE_INTERRUPT)))
  2919. continue;
  2920. }
  2921. if (!(tmp & BIT(DMA_TRANSACTION_DONE_INTERRUPT))) {
  2922. ep_dbg(ep->dev, "%s no xact done? %08x\n",
  2923. ep->ep.name, tmp);
  2924. continue;
  2925. }
  2926. stop_dma(ep->dma);
  2927. /* OUT transfers terminate when the data from the
  2928. * host is in our memory. Process whatever's done.
  2929. * On this path, we know transfer's last packet wasn't
  2930. * less than req->length. NAK_OUT_PACKETS may be set,
  2931. * or the FIFO may already be holding new packets.
  2932. *
  2933. * IN transfers can linger in the FIFO for a very
  2934. * long time ... we ignore that for now, accounting
  2935. * precisely (like PIO does) needs per-packet irqs
  2936. */
  2937. scan_dma_completions(ep);
  2938. /* disable dma on inactive queues; else maybe restart */
  2939. if (!list_empty(&ep->queue)) {
  2940. tmp = readl(&dma->dmactl);
  2941. restart_dma(ep);
  2942. }
  2943. ep->irqs++;
  2944. }
  2945. /* NOTE: there are other PCI errors we might usefully notice.
  2946. * if they appear very often, here's where to try recovering.
  2947. */
  2948. if (stat & PCI_ERROR_INTERRUPTS) {
  2949. ep_err(dev, "pci dma error; stat %08x\n", stat);
  2950. stat &= ~PCI_ERROR_INTERRUPTS;
  2951. /* these are fatal errors, but "maybe" they won't
  2952. * happen again ...
  2953. */
  2954. stop_activity(dev, dev->driver);
  2955. ep0_start(dev);
  2956. stat = 0;
  2957. }
  2958. if (stat)
  2959. ep_dbg(dev, "unhandled irqstat1 %08x\n", stat);
  2960. }
  2961. static irqreturn_t net2280_irq(int irq, void *_dev)
  2962. {
  2963. struct net2280 *dev = _dev;
  2964. /* shared interrupt, not ours */
  2965. if ((dev->quirks & PLX_LEGACY) &&
  2966. (!(readl(&dev->regs->irqstat0) & BIT(INTA_ASSERTED))))
  2967. return IRQ_NONE;
  2968. spin_lock(&dev->lock);
  2969. /* handle disconnect, dma, and more */
  2970. handle_stat1_irqs(dev, readl(&dev->regs->irqstat1));
  2971. /* control requests and PIO */
  2972. handle_stat0_irqs(dev, readl(&dev->regs->irqstat0));
  2973. if (dev->quirks & PLX_SUPERSPEED) {
  2974. /* re-enable interrupt to trigger any possible new interrupt */
  2975. u32 pciirqenb1 = readl(&dev->regs->pciirqenb1);
  2976. writel(pciirqenb1 & 0x7FFFFFFF, &dev->regs->pciirqenb1);
  2977. writel(pciirqenb1, &dev->regs->pciirqenb1);
  2978. }
  2979. spin_unlock(&dev->lock);
  2980. return IRQ_HANDLED;
  2981. }
  2982. /*-------------------------------------------------------------------------*/
  2983. static void gadget_release(struct device *_dev)
  2984. {
  2985. struct net2280 *dev = dev_get_drvdata(_dev);
  2986. kfree(dev);
  2987. }
  2988. /* tear down the binding between this driver and the pci device */
  2989. static void net2280_remove(struct pci_dev *pdev)
  2990. {
  2991. struct net2280 *dev = pci_get_drvdata(pdev);
  2992. usb_del_gadget_udc(&dev->gadget);
  2993. BUG_ON(dev->driver);
  2994. /* then clean up the resources we allocated during probe() */
  2995. net2280_led_shutdown(dev);
  2996. if (dev->requests) {
  2997. int i;
  2998. for (i = 1; i < 5; i++) {
  2999. if (!dev->ep[i].dummy)
  3000. continue;
  3001. pci_pool_free(dev->requests, dev->ep[i].dummy,
  3002. dev->ep[i].td_dma);
  3003. }
  3004. pci_pool_destroy(dev->requests);
  3005. }
  3006. if (dev->got_irq)
  3007. free_irq(pdev->irq, dev);
  3008. if (dev->quirks & PLX_SUPERSPEED)
  3009. pci_disable_msi(pdev);
  3010. if (dev->regs)
  3011. iounmap(dev->regs);
  3012. if (dev->region)
  3013. release_mem_region(pci_resource_start(pdev, 0),
  3014. pci_resource_len(pdev, 0));
  3015. if (dev->enabled)
  3016. pci_disable_device(pdev);
  3017. device_remove_file(&pdev->dev, &dev_attr_registers);
  3018. ep_info(dev, "unbind\n");
  3019. }
  3020. /* wrap this driver around the specified device, but
  3021. * don't respond over USB until a gadget driver binds to us.
  3022. */
  3023. static int net2280_probe(struct pci_dev *pdev, const struct pci_device_id *id)
  3024. {
  3025. struct net2280 *dev;
  3026. unsigned long resource, len;
  3027. void __iomem *base = NULL;
  3028. int retval, i;
  3029. /* alloc, and start init */
  3030. dev = kzalloc(sizeof(*dev), GFP_KERNEL);
  3031. if (dev == NULL) {
  3032. retval = -ENOMEM;
  3033. goto done;
  3034. }
  3035. pci_set_drvdata(pdev, dev);
  3036. spin_lock_init(&dev->lock);
  3037. dev->quirks = id->driver_data;
  3038. dev->pdev = pdev;
  3039. dev->gadget.ops = &net2280_ops;
  3040. dev->gadget.max_speed = (dev->quirks & PLX_SUPERSPEED) ?
  3041. USB_SPEED_SUPER : USB_SPEED_HIGH;
  3042. /* the "gadget" abstracts/virtualizes the controller */
  3043. dev->gadget.name = driver_name;
  3044. /* now all the pci goodies ... */
  3045. if (pci_enable_device(pdev) < 0) {
  3046. retval = -ENODEV;
  3047. goto done;
  3048. }
  3049. dev->enabled = 1;
  3050. /* BAR 0 holds all the registers
  3051. * BAR 1 is 8051 memory; unused here (note erratum 0103)
  3052. * BAR 2 is fifo memory; unused here
  3053. */
  3054. resource = pci_resource_start(pdev, 0);
  3055. len = pci_resource_len(pdev, 0);
  3056. if (!request_mem_region(resource, len, driver_name)) {
  3057. ep_dbg(dev, "controller already in use\n");
  3058. retval = -EBUSY;
  3059. goto done;
  3060. }
  3061. dev->region = 1;
  3062. /* FIXME provide firmware download interface to put
  3063. * 8051 code into the chip, e.g. to turn on PCI PM.
  3064. */
  3065. base = ioremap_nocache(resource, len);
  3066. if (base == NULL) {
  3067. ep_dbg(dev, "can't map memory\n");
  3068. retval = -EFAULT;
  3069. goto done;
  3070. }
  3071. dev->regs = (struct net2280_regs __iomem *) base;
  3072. dev->usb = (struct net2280_usb_regs __iomem *) (base + 0x0080);
  3073. dev->pci = (struct net2280_pci_regs __iomem *) (base + 0x0100);
  3074. dev->dma = (struct net2280_dma_regs __iomem *) (base + 0x0180);
  3075. dev->dep = (struct net2280_dep_regs __iomem *) (base + 0x0200);
  3076. dev->epregs = (struct net2280_ep_regs __iomem *) (base + 0x0300);
  3077. if (dev->quirks & PLX_SUPERSPEED) {
  3078. u32 fsmvalue;
  3079. u32 usbstat;
  3080. dev->usb_ext = (struct usb338x_usb_ext_regs __iomem *)
  3081. (base + 0x00b4);
  3082. dev->llregs = (struct usb338x_ll_regs __iomem *)
  3083. (base + 0x0700);
  3084. dev->ll_lfps_regs = (struct usb338x_ll_lfps_regs __iomem *)
  3085. (base + 0x0748);
  3086. dev->ll_tsn_regs = (struct usb338x_ll_tsn_regs __iomem *)
  3087. (base + 0x077c);
  3088. dev->ll_chicken_reg = (struct usb338x_ll_chi_regs __iomem *)
  3089. (base + 0x079c);
  3090. dev->plregs = (struct usb338x_pl_regs __iomem *)
  3091. (base + 0x0800);
  3092. usbstat = readl(&dev->usb->usbstat);
  3093. dev->enhanced_mode = !!(usbstat & BIT(11));
  3094. dev->n_ep = (dev->enhanced_mode) ? 9 : 5;
  3095. /* put into initial config, link up all endpoints */
  3096. fsmvalue = get_idx_reg(dev->regs, SCRATCH) &
  3097. (0xf << DEFECT7374_FSM_FIELD);
  3098. /* See if firmware needs to set up for workaround: */
  3099. if (fsmvalue == DEFECT7374_FSM_SS_CONTROL_READ) {
  3100. dev->bug7734_patched = 1;
  3101. writel(0, &dev->usb->usbctl);
  3102. } else
  3103. dev->bug7734_patched = 0;
  3104. } else {
  3105. dev->enhanced_mode = 0;
  3106. dev->n_ep = 7;
  3107. /* put into initial config, link up all endpoints */
  3108. writel(0, &dev->usb->usbctl);
  3109. }
  3110. usb_reset(dev);
  3111. usb_reinit(dev);
  3112. /* irq setup after old hardware is cleaned up */
  3113. if (!pdev->irq) {
  3114. ep_err(dev, "No IRQ. Check PCI setup!\n");
  3115. retval = -ENODEV;
  3116. goto done;
  3117. }
  3118. if (dev->quirks & PLX_SUPERSPEED)
  3119. if (pci_enable_msi(pdev))
  3120. ep_err(dev, "Failed to enable MSI mode\n");
  3121. if (request_irq(pdev->irq, net2280_irq, IRQF_SHARED,
  3122. driver_name, dev)) {
  3123. ep_err(dev, "request interrupt %d failed\n", pdev->irq);
  3124. retval = -EBUSY;
  3125. goto done;
  3126. }
  3127. dev->got_irq = 1;
  3128. /* DMA setup */
  3129. /* NOTE: we know only the 32 LSBs of dma addresses may be nonzero */
  3130. dev->requests = pci_pool_create("requests", pdev,
  3131. sizeof(struct net2280_dma),
  3132. 0 /* no alignment requirements */,
  3133. 0 /* or page-crossing issues */);
  3134. if (!dev->requests) {
  3135. ep_dbg(dev, "can't get request pool\n");
  3136. retval = -ENOMEM;
  3137. goto done;
  3138. }
  3139. for (i = 1; i < 5; i++) {
  3140. struct net2280_dma *td;
  3141. td = pci_pool_alloc(dev->requests, GFP_KERNEL,
  3142. &dev->ep[i].td_dma);
  3143. if (!td) {
  3144. ep_dbg(dev, "can't get dummy %d\n", i);
  3145. retval = -ENOMEM;
  3146. goto done;
  3147. }
  3148. td->dmacount = 0; /* not VALID */
  3149. td->dmadesc = td->dmaaddr;
  3150. dev->ep[i].dummy = td;
  3151. }
  3152. /* enable lower-overhead pci memory bursts during DMA */
  3153. if (dev->quirks & PLX_LEGACY)
  3154. writel(BIT(DMA_MEMORY_WRITE_AND_INVALIDATE_ENABLE) |
  3155. /*
  3156. * 256 write retries may not be enough...
  3157. BIT(PCI_RETRY_ABORT_ENABLE) |
  3158. */
  3159. BIT(DMA_READ_MULTIPLE_ENABLE) |
  3160. BIT(DMA_READ_LINE_ENABLE),
  3161. &dev->pci->pcimstctl);
  3162. /* erratum 0115 shouldn't appear: Linux inits PCI_LATENCY_TIMER */
  3163. pci_set_master(pdev);
  3164. pci_try_set_mwi(pdev);
  3165. /* ... also flushes any posted pci writes */
  3166. dev->chiprev = get_idx_reg(dev->regs, REG_CHIPREV) & 0xffff;
  3167. /* done */
  3168. ep_info(dev, "%s\n", driver_desc);
  3169. ep_info(dev, "irq %d, pci mem %p, chip rev %04x\n",
  3170. pdev->irq, base, dev->chiprev);
  3171. ep_info(dev, "version: " DRIVER_VERSION "; %s\n",
  3172. dev->enhanced_mode ? "enhanced mode" : "legacy mode");
  3173. retval = device_create_file(&pdev->dev, &dev_attr_registers);
  3174. if (retval)
  3175. goto done;
  3176. retval = usb_add_gadget_udc_release(&pdev->dev, &dev->gadget,
  3177. gadget_release);
  3178. if (retval)
  3179. goto done;
  3180. return 0;
  3181. done:
  3182. if (dev)
  3183. net2280_remove(pdev);
  3184. return retval;
  3185. }
  3186. /* make sure the board is quiescent; otherwise it will continue
  3187. * generating IRQs across the upcoming reboot.
  3188. */
  3189. static void net2280_shutdown(struct pci_dev *pdev)
  3190. {
  3191. struct net2280 *dev = pci_get_drvdata(pdev);
  3192. /* disable IRQs */
  3193. writel(0, &dev->regs->pciirqenb0);
  3194. writel(0, &dev->regs->pciirqenb1);
  3195. /* disable the pullup so the host will think we're gone */
  3196. writel(0, &dev->usb->usbctl);
  3197. }
  3198. /*-------------------------------------------------------------------------*/
  3199. static const struct pci_device_id pci_ids[] = { {
  3200. .class = ((PCI_CLASS_SERIAL_USB << 8) | 0xfe),
  3201. .class_mask = ~0,
  3202. .vendor = PCI_VENDOR_ID_PLX_LEGACY,
  3203. .device = 0x2280,
  3204. .subvendor = PCI_ANY_ID,
  3205. .subdevice = PCI_ANY_ID,
  3206. .driver_data = PLX_LEGACY | PLX_2280,
  3207. }, {
  3208. .class = ((PCI_CLASS_SERIAL_USB << 8) | 0xfe),
  3209. .class_mask = ~0,
  3210. .vendor = PCI_VENDOR_ID_PLX_LEGACY,
  3211. .device = 0x2282,
  3212. .subvendor = PCI_ANY_ID,
  3213. .subdevice = PCI_ANY_ID,
  3214. .driver_data = PLX_LEGACY,
  3215. },
  3216. {
  3217. .class = ((PCI_CLASS_SERIAL_USB << 8) | 0xfe),
  3218. .class_mask = ~0,
  3219. .vendor = PCI_VENDOR_ID_PLX,
  3220. .device = 0x3380,
  3221. .subvendor = PCI_ANY_ID,
  3222. .subdevice = PCI_ANY_ID,
  3223. .driver_data = PLX_SUPERSPEED,
  3224. },
  3225. {
  3226. .class = ((PCI_CLASS_SERIAL_USB << 8) | 0xfe),
  3227. .class_mask = ~0,
  3228. .vendor = PCI_VENDOR_ID_PLX,
  3229. .device = 0x3382,
  3230. .subvendor = PCI_ANY_ID,
  3231. .subdevice = PCI_ANY_ID,
  3232. .driver_data = PLX_SUPERSPEED,
  3233. },
  3234. { /* end: all zeroes */ }
  3235. };
  3236. MODULE_DEVICE_TABLE(pci, pci_ids);
  3237. /* pci driver glue; this is a "new style" PCI driver module */
  3238. static struct pci_driver net2280_pci_driver = {
  3239. .name = (char *) driver_name,
  3240. .id_table = pci_ids,
  3241. .probe = net2280_probe,
  3242. .remove = net2280_remove,
  3243. .shutdown = net2280_shutdown,
  3244. /* FIXME add power management support */
  3245. };
  3246. module_pci_driver(net2280_pci_driver);
  3247. MODULE_DESCRIPTION(DRIVER_DESC);
  3248. MODULE_AUTHOR("David Brownell");
  3249. MODULE_LICENSE("GPL");