ohci.c 94 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000300130023003300430053006300730083009301030113012301330143015301630173018301930203021302230233024302530263027302830293030303130323033303430353036303730383039304030413042304330443045304630473048304930503051305230533054305530563057305830593060306130623063306430653066306730683069307030713072307330743075307630773078307930803081308230833084308530863087308830893090309130923093309430953096309730983099310031013102310331043105310631073108310931103111311231133114311531163117311831193120312131223123312431253126312731283129313031313132313331343135313631373138313931403141314231433144314531463147314831493150315131523153315431553156315731583159316031613162316331643165316631673168316931703171317231733174317531763177317831793180318131823183318431853186318731883189319031913192319331943195319631973198319932003201320232033204320532063207320832093210321132123213321432153216321732183219322032213222322332243225322632273228322932303231323232333234323532363237323832393240324132423243324432453246324732483249325032513252325332543255325632573258325932603261326232633264326532663267326832693270327132723273327432753276327732783279328032813282328332843285328632873288328932903291329232933294329532963297329832993300330133023303330433053306330733083309331033113312331333143315331633173318331933203321332233233324332533263327332833293330333133323333333433353336333733383339334033413342334333443345334633473348334933503351335233533354335533563357335833593360336133623363336433653366336733683369337033713372337333743375337633773378337933803381338233833384338533863387338833893390339133923393339433953396339733983399340034013402340334043405340634073408340934103411341234133414341534163417341834193420342134223423342434253426342734283429343034313432343334343435343634373438343934403441344234433444344534463447344834493450345134523453345434553456345734583459346034613462346334643465346634673468346934703471347234733474347534763477347834793480
  1. /*
  2. * Driver for OHCI 1394 controllers
  3. *
  4. * Copyright (C) 2003-2006 Kristian Hoegsberg <krh@bitplanet.net>
  5. *
  6. * This program is free software; you can redistribute it and/or modify
  7. * it under the terms of the GNU General Public License as published by
  8. * the Free Software Foundation; either version 2 of the License, or
  9. * (at your option) any later version.
  10. *
  11. * This program is distributed in the hope that it will be useful,
  12. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  14. * GNU General Public License for more details.
  15. *
  16. * You should have received a copy of the GNU General Public License
  17. * along with this program; if not, write to the Free Software Foundation,
  18. * Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
  19. */
  20. #include <linux/bitops.h>
  21. #include <linux/bug.h>
  22. #include <linux/compiler.h>
  23. #include <linux/delay.h>
  24. #include <linux/device.h>
  25. #include <linux/dma-mapping.h>
  26. #include <linux/firewire.h>
  27. #include <linux/firewire-constants.h>
  28. #include <linux/init.h>
  29. #include <linux/interrupt.h>
  30. #include <linux/io.h>
  31. #include <linux/kernel.h>
  32. #include <linux/list.h>
  33. #include <linux/mm.h>
  34. #include <linux/module.h>
  35. #include <linux/moduleparam.h>
  36. #include <linux/mutex.h>
  37. #include <linux/pci.h>
  38. #include <linux/pci_ids.h>
  39. #include <linux/slab.h>
  40. #include <linux/spinlock.h>
  41. #include <linux/string.h>
  42. #include <linux/time.h>
  43. #include <linux/vmalloc.h>
  44. #include <asm/byteorder.h>
  45. #include <asm/page.h>
  46. #include <asm/system.h>
  47. #ifdef CONFIG_PPC_PMAC
  48. #include <asm/pmac_feature.h>
  49. #endif
  50. #include "core.h"
  51. #include "ohci.h"
  52. #define DESCRIPTOR_OUTPUT_MORE 0
  53. #define DESCRIPTOR_OUTPUT_LAST (1 << 12)
  54. #define DESCRIPTOR_INPUT_MORE (2 << 12)
  55. #define DESCRIPTOR_INPUT_LAST (3 << 12)
  56. #define DESCRIPTOR_STATUS (1 << 11)
  57. #define DESCRIPTOR_KEY_IMMEDIATE (2 << 8)
  58. #define DESCRIPTOR_PING (1 << 7)
  59. #define DESCRIPTOR_YY (1 << 6)
  60. #define DESCRIPTOR_NO_IRQ (0 << 4)
  61. #define DESCRIPTOR_IRQ_ERROR (1 << 4)
  62. #define DESCRIPTOR_IRQ_ALWAYS (3 << 4)
  63. #define DESCRIPTOR_BRANCH_ALWAYS (3 << 2)
  64. #define DESCRIPTOR_WAIT (3 << 0)
  65. struct descriptor {
  66. __le16 req_count;
  67. __le16 control;
  68. __le32 data_address;
  69. __le32 branch_address;
  70. __le16 res_count;
  71. __le16 transfer_status;
  72. } __attribute__((aligned(16)));
  73. #define CONTROL_SET(regs) (regs)
  74. #define CONTROL_CLEAR(regs) ((regs) + 4)
  75. #define COMMAND_PTR(regs) ((regs) + 12)
  76. #define CONTEXT_MATCH(regs) ((regs) + 16)
  77. #define AR_BUFFER_SIZE (32*1024)
  78. #define AR_BUFFERS_MIN DIV_ROUND_UP(AR_BUFFER_SIZE, PAGE_SIZE)
  79. /* we need at least two pages for proper list management */
  80. #define AR_BUFFERS (AR_BUFFERS_MIN >= 2 ? AR_BUFFERS_MIN : 2)
  81. #define MAX_ASYNC_PAYLOAD 4096
  82. #define MAX_AR_PACKET_SIZE (16 + MAX_ASYNC_PAYLOAD + 4)
  83. #define AR_WRAPAROUND_PAGES DIV_ROUND_UP(MAX_AR_PACKET_SIZE, PAGE_SIZE)
  84. struct ar_context {
  85. struct fw_ohci *ohci;
  86. struct page *pages[AR_BUFFERS];
  87. void *buffer;
  88. struct descriptor *descriptors;
  89. dma_addr_t descriptors_bus;
  90. void *pointer;
  91. unsigned int last_buffer_index;
  92. u32 regs;
  93. struct tasklet_struct tasklet;
  94. };
  95. struct context;
  96. typedef int (*descriptor_callback_t)(struct context *ctx,
  97. struct descriptor *d,
  98. struct descriptor *last);
  99. /*
  100. * A buffer that contains a block of DMA-able coherent memory used for
  101. * storing a portion of a DMA descriptor program.
  102. */
  103. struct descriptor_buffer {
  104. struct list_head list;
  105. dma_addr_t buffer_bus;
  106. size_t buffer_size;
  107. size_t used;
  108. struct descriptor buffer[0];
  109. };
  110. struct context {
  111. struct fw_ohci *ohci;
  112. u32 regs;
  113. int total_allocation;
  114. bool running;
  115. bool flushing;
  116. /*
  117. * List of page-sized buffers for storing DMA descriptors.
  118. * Head of list contains buffers in use and tail of list contains
  119. * free buffers.
  120. */
  121. struct list_head buffer_list;
  122. /*
  123. * Pointer to a buffer inside buffer_list that contains the tail
  124. * end of the current DMA program.
  125. */
  126. struct descriptor_buffer *buffer_tail;
  127. /*
  128. * The descriptor containing the branch address of the first
  129. * descriptor that has not yet been filled by the device.
  130. */
  131. struct descriptor *last;
  132. /*
  133. * The last descriptor in the DMA program. It contains the branch
  134. * address that must be updated upon appending a new descriptor.
  135. */
  136. struct descriptor *prev;
  137. descriptor_callback_t callback;
  138. struct tasklet_struct tasklet;
  139. };
  140. #define IT_HEADER_SY(v) ((v) << 0)
  141. #define IT_HEADER_TCODE(v) ((v) << 4)
  142. #define IT_HEADER_CHANNEL(v) ((v) << 8)
  143. #define IT_HEADER_TAG(v) ((v) << 14)
  144. #define IT_HEADER_SPEED(v) ((v) << 16)
  145. #define IT_HEADER_DATA_LENGTH(v) ((v) << 16)
  146. struct iso_context {
  147. struct fw_iso_context base;
  148. struct context context;
  149. int excess_bytes;
  150. void *header;
  151. size_t header_length;
  152. u8 sync;
  153. u8 tags;
  154. };
  155. #define CONFIG_ROM_SIZE 1024
  156. struct fw_ohci {
  157. struct fw_card card;
  158. __iomem char *registers;
  159. int node_id;
  160. int generation;
  161. int request_generation; /* for timestamping incoming requests */
  162. unsigned quirks;
  163. unsigned int pri_req_max;
  164. u32 bus_time;
  165. bool is_root;
  166. bool csr_state_setclear_abdicate;
  167. int n_ir;
  168. int n_it;
  169. /*
  170. * Spinlock for accessing fw_ohci data. Never call out of
  171. * this driver with this lock held.
  172. */
  173. spinlock_t lock;
  174. struct mutex phy_reg_mutex;
  175. void *misc_buffer;
  176. dma_addr_t misc_buffer_bus;
  177. struct ar_context ar_request_ctx;
  178. struct ar_context ar_response_ctx;
  179. struct context at_request_ctx;
  180. struct context at_response_ctx;
  181. u32 it_context_support;
  182. u32 it_context_mask; /* unoccupied IT contexts */
  183. struct iso_context *it_context_list;
  184. u64 ir_context_channels; /* unoccupied channels */
  185. u32 ir_context_support;
  186. u32 ir_context_mask; /* unoccupied IR contexts */
  187. struct iso_context *ir_context_list;
  188. u64 mc_channels; /* channels in use by the multichannel IR context */
  189. bool mc_allocated;
  190. __be32 *config_rom;
  191. dma_addr_t config_rom_bus;
  192. __be32 *next_config_rom;
  193. dma_addr_t next_config_rom_bus;
  194. __be32 next_header;
  195. __le32 *self_id_cpu;
  196. dma_addr_t self_id_bus;
  197. struct tasklet_struct bus_reset_tasklet;
  198. u32 self_id_buffer[512];
  199. };
  200. static inline struct fw_ohci *fw_ohci(struct fw_card *card)
  201. {
  202. return container_of(card, struct fw_ohci, card);
  203. }
  204. #define IT_CONTEXT_CYCLE_MATCH_ENABLE 0x80000000
  205. #define IR_CONTEXT_BUFFER_FILL 0x80000000
  206. #define IR_CONTEXT_ISOCH_HEADER 0x40000000
  207. #define IR_CONTEXT_CYCLE_MATCH_ENABLE 0x20000000
  208. #define IR_CONTEXT_MULTI_CHANNEL_MODE 0x10000000
  209. #define IR_CONTEXT_DUAL_BUFFER_MODE 0x08000000
  210. #define CONTEXT_RUN 0x8000
  211. #define CONTEXT_WAKE 0x1000
  212. #define CONTEXT_DEAD 0x0800
  213. #define CONTEXT_ACTIVE 0x0400
  214. #define OHCI1394_MAX_AT_REQ_RETRIES 0xf
  215. #define OHCI1394_MAX_AT_RESP_RETRIES 0x2
  216. #define OHCI1394_MAX_PHYS_RESP_RETRIES 0x8
  217. #define OHCI1394_REGISTER_SIZE 0x800
  218. #define OHCI_LOOP_COUNT 500
  219. #define OHCI1394_PCI_HCI_Control 0x40
  220. #define SELF_ID_BUF_SIZE 0x800
  221. #define OHCI_TCODE_PHY_PACKET 0x0e
  222. #define OHCI_VERSION_1_1 0x010010
  223. static char ohci_driver_name[] = KBUILD_MODNAME;
  224. #define PCI_DEVICE_ID_AGERE_FW643 0x5901
  225. #define PCI_DEVICE_ID_JMICRON_JMB38X_FW 0x2380
  226. #define PCI_DEVICE_ID_TI_TSB12LV22 0x8009
  227. #define QUIRK_CYCLE_TIMER 1
  228. #define QUIRK_RESET_PACKET 2
  229. #define QUIRK_BE_HEADERS 4
  230. #define QUIRK_NO_1394A 8
  231. #define QUIRK_NO_MSI 16
  232. /* In case of multiple matches in ohci_quirks[], only the first one is used. */
  233. static const struct {
  234. unsigned short vendor, device, revision, flags;
  235. } ohci_quirks[] = {
  236. {PCI_VENDOR_ID_AL, PCI_ANY_ID, PCI_ANY_ID,
  237. QUIRK_CYCLE_TIMER},
  238. {PCI_VENDOR_ID_APPLE, PCI_DEVICE_ID_APPLE_UNI_N_FW, PCI_ANY_ID,
  239. QUIRK_BE_HEADERS},
  240. {PCI_VENDOR_ID_ATT, PCI_DEVICE_ID_AGERE_FW643, 6,
  241. QUIRK_NO_MSI},
  242. {PCI_VENDOR_ID_JMICRON, PCI_DEVICE_ID_JMICRON_JMB38X_FW, PCI_ANY_ID,
  243. QUIRK_NO_MSI},
  244. {PCI_VENDOR_ID_NEC, PCI_ANY_ID, PCI_ANY_ID,
  245. QUIRK_CYCLE_TIMER},
  246. {PCI_VENDOR_ID_RICOH, PCI_ANY_ID, PCI_ANY_ID,
  247. QUIRK_CYCLE_TIMER},
  248. {PCI_VENDOR_ID_TI, PCI_DEVICE_ID_TI_TSB12LV22, PCI_ANY_ID,
  249. QUIRK_CYCLE_TIMER | QUIRK_RESET_PACKET | QUIRK_NO_1394A},
  250. {PCI_VENDOR_ID_TI, PCI_ANY_ID, PCI_ANY_ID,
  251. QUIRK_RESET_PACKET},
  252. {PCI_VENDOR_ID_VIA, PCI_ANY_ID, PCI_ANY_ID,
  253. QUIRK_CYCLE_TIMER | QUIRK_NO_MSI},
  254. };
  255. /* This overrides anything that was found in ohci_quirks[]. */
  256. static int param_quirks;
  257. module_param_named(quirks, param_quirks, int, 0644);
  258. MODULE_PARM_DESC(quirks, "Chip quirks (default = 0"
  259. ", nonatomic cycle timer = " __stringify(QUIRK_CYCLE_TIMER)
  260. ", reset packet generation = " __stringify(QUIRK_RESET_PACKET)
  261. ", AR/selfID endianess = " __stringify(QUIRK_BE_HEADERS)
  262. ", no 1394a enhancements = " __stringify(QUIRK_NO_1394A)
  263. ", disable MSI = " __stringify(QUIRK_NO_MSI)
  264. ")");
  265. #define OHCI_PARAM_DEBUG_AT_AR 1
  266. #define OHCI_PARAM_DEBUG_SELFIDS 2
  267. #define OHCI_PARAM_DEBUG_IRQS 4
  268. #define OHCI_PARAM_DEBUG_BUSRESETS 8 /* only effective before chip init */
  269. #ifdef CONFIG_FIREWIRE_OHCI_DEBUG
  270. static int param_debug;
  271. module_param_named(debug, param_debug, int, 0644);
  272. MODULE_PARM_DESC(debug, "Verbose logging (default = 0"
  273. ", AT/AR events = " __stringify(OHCI_PARAM_DEBUG_AT_AR)
  274. ", self-IDs = " __stringify(OHCI_PARAM_DEBUG_SELFIDS)
  275. ", IRQs = " __stringify(OHCI_PARAM_DEBUG_IRQS)
  276. ", busReset events = " __stringify(OHCI_PARAM_DEBUG_BUSRESETS)
  277. ", or a combination, or all = -1)");
  278. static void log_irqs(u32 evt)
  279. {
  280. if (likely(!(param_debug &
  281. (OHCI_PARAM_DEBUG_IRQS | OHCI_PARAM_DEBUG_BUSRESETS))))
  282. return;
  283. if (!(param_debug & OHCI_PARAM_DEBUG_IRQS) &&
  284. !(evt & OHCI1394_busReset))
  285. return;
  286. fw_notify("IRQ %08x%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s\n", evt,
  287. evt & OHCI1394_selfIDComplete ? " selfID" : "",
  288. evt & OHCI1394_RQPkt ? " AR_req" : "",
  289. evt & OHCI1394_RSPkt ? " AR_resp" : "",
  290. evt & OHCI1394_reqTxComplete ? " AT_req" : "",
  291. evt & OHCI1394_respTxComplete ? " AT_resp" : "",
  292. evt & OHCI1394_isochRx ? " IR" : "",
  293. evt & OHCI1394_isochTx ? " IT" : "",
  294. evt & OHCI1394_postedWriteErr ? " postedWriteErr" : "",
  295. evt & OHCI1394_cycleTooLong ? " cycleTooLong" : "",
  296. evt & OHCI1394_cycle64Seconds ? " cycle64Seconds" : "",
  297. evt & OHCI1394_cycleInconsistent ? " cycleInconsistent" : "",
  298. evt & OHCI1394_regAccessFail ? " regAccessFail" : "",
  299. evt & OHCI1394_unrecoverableError ? " unrecoverableError" : "",
  300. evt & OHCI1394_busReset ? " busReset" : "",
  301. evt & ~(OHCI1394_selfIDComplete | OHCI1394_RQPkt |
  302. OHCI1394_RSPkt | OHCI1394_reqTxComplete |
  303. OHCI1394_respTxComplete | OHCI1394_isochRx |
  304. OHCI1394_isochTx | OHCI1394_postedWriteErr |
  305. OHCI1394_cycleTooLong | OHCI1394_cycle64Seconds |
  306. OHCI1394_cycleInconsistent |
  307. OHCI1394_regAccessFail | OHCI1394_busReset)
  308. ? " ?" : "");
  309. }
  310. static const char *speed[] = {
  311. [0] = "S100", [1] = "S200", [2] = "S400", [3] = "beta",
  312. };
  313. static const char *power[] = {
  314. [0] = "+0W", [1] = "+15W", [2] = "+30W", [3] = "+45W",
  315. [4] = "-3W", [5] = " ?W", [6] = "-3..-6W", [7] = "-3..-10W",
  316. };
  317. static const char port[] = { '.', '-', 'p', 'c', };
  318. static char _p(u32 *s, int shift)
  319. {
  320. return port[*s >> shift & 3];
  321. }
  322. static void log_selfids(int node_id, int generation, int self_id_count, u32 *s)
  323. {
  324. if (likely(!(param_debug & OHCI_PARAM_DEBUG_SELFIDS)))
  325. return;
  326. fw_notify("%d selfIDs, generation %d, local node ID %04x\n",
  327. self_id_count, generation, node_id);
  328. for (; self_id_count--; ++s)
  329. if ((*s & 1 << 23) == 0)
  330. fw_notify("selfID 0: %08x, phy %d [%c%c%c] "
  331. "%s gc=%d %s %s%s%s\n",
  332. *s, *s >> 24 & 63, _p(s, 6), _p(s, 4), _p(s, 2),
  333. speed[*s >> 14 & 3], *s >> 16 & 63,
  334. power[*s >> 8 & 7], *s >> 22 & 1 ? "L" : "",
  335. *s >> 11 & 1 ? "c" : "", *s & 2 ? "i" : "");
  336. else
  337. fw_notify("selfID n: %08x, phy %d [%c%c%c%c%c%c%c%c]\n",
  338. *s, *s >> 24 & 63,
  339. _p(s, 16), _p(s, 14), _p(s, 12), _p(s, 10),
  340. _p(s, 8), _p(s, 6), _p(s, 4), _p(s, 2));
  341. }
  342. static const char *evts[] = {
  343. [0x00] = "evt_no_status", [0x01] = "-reserved-",
  344. [0x02] = "evt_long_packet", [0x03] = "evt_missing_ack",
  345. [0x04] = "evt_underrun", [0x05] = "evt_overrun",
  346. [0x06] = "evt_descriptor_read", [0x07] = "evt_data_read",
  347. [0x08] = "evt_data_write", [0x09] = "evt_bus_reset",
  348. [0x0a] = "evt_timeout", [0x0b] = "evt_tcode_err",
  349. [0x0c] = "-reserved-", [0x0d] = "-reserved-",
  350. [0x0e] = "evt_unknown", [0x0f] = "evt_flushed",
  351. [0x10] = "-reserved-", [0x11] = "ack_complete",
  352. [0x12] = "ack_pending ", [0x13] = "-reserved-",
  353. [0x14] = "ack_busy_X", [0x15] = "ack_busy_A",
  354. [0x16] = "ack_busy_B", [0x17] = "-reserved-",
  355. [0x18] = "-reserved-", [0x19] = "-reserved-",
  356. [0x1a] = "-reserved-", [0x1b] = "ack_tardy",
  357. [0x1c] = "-reserved-", [0x1d] = "ack_data_error",
  358. [0x1e] = "ack_type_error", [0x1f] = "-reserved-",
  359. [0x20] = "pending/cancelled",
  360. };
  361. static const char *tcodes[] = {
  362. [0x0] = "QW req", [0x1] = "BW req",
  363. [0x2] = "W resp", [0x3] = "-reserved-",
  364. [0x4] = "QR req", [0x5] = "BR req",
  365. [0x6] = "QR resp", [0x7] = "BR resp",
  366. [0x8] = "cycle start", [0x9] = "Lk req",
  367. [0xa] = "async stream packet", [0xb] = "Lk resp",
  368. [0xc] = "-reserved-", [0xd] = "-reserved-",
  369. [0xe] = "link internal", [0xf] = "-reserved-",
  370. };
  371. static void log_ar_at_event(char dir, int speed, u32 *header, int evt)
  372. {
  373. int tcode = header[0] >> 4 & 0xf;
  374. char specific[12];
  375. if (likely(!(param_debug & OHCI_PARAM_DEBUG_AT_AR)))
  376. return;
  377. if (unlikely(evt >= ARRAY_SIZE(evts)))
  378. evt = 0x1f;
  379. if (evt == OHCI1394_evt_bus_reset) {
  380. fw_notify("A%c evt_bus_reset, generation %d\n",
  381. dir, (header[2] >> 16) & 0xff);
  382. return;
  383. }
  384. switch (tcode) {
  385. case 0x0: case 0x6: case 0x8:
  386. snprintf(specific, sizeof(specific), " = %08x",
  387. be32_to_cpu((__force __be32)header[3]));
  388. break;
  389. case 0x1: case 0x5: case 0x7: case 0x9: case 0xb:
  390. snprintf(specific, sizeof(specific), " %x,%x",
  391. header[3] >> 16, header[3] & 0xffff);
  392. break;
  393. default:
  394. specific[0] = '\0';
  395. }
  396. switch (tcode) {
  397. case 0xa:
  398. fw_notify("A%c %s, %s\n", dir, evts[evt], tcodes[tcode]);
  399. break;
  400. case 0xe:
  401. fw_notify("A%c %s, PHY %08x %08x\n",
  402. dir, evts[evt], header[1], header[2]);
  403. break;
  404. case 0x0: case 0x1: case 0x4: case 0x5: case 0x9:
  405. fw_notify("A%c spd %x tl %02x, "
  406. "%04x -> %04x, %s, "
  407. "%s, %04x%08x%s\n",
  408. dir, speed, header[0] >> 10 & 0x3f,
  409. header[1] >> 16, header[0] >> 16, evts[evt],
  410. tcodes[tcode], header[1] & 0xffff, header[2], specific);
  411. break;
  412. default:
  413. fw_notify("A%c spd %x tl %02x, "
  414. "%04x -> %04x, %s, "
  415. "%s%s\n",
  416. dir, speed, header[0] >> 10 & 0x3f,
  417. header[1] >> 16, header[0] >> 16, evts[evt],
  418. tcodes[tcode], specific);
  419. }
  420. }
  421. #else
  422. #define param_debug 0
  423. static inline void log_irqs(u32 evt) {}
  424. static inline void log_selfids(int node_id, int generation, int self_id_count, u32 *s) {}
  425. static inline void log_ar_at_event(char dir, int speed, u32 *header, int evt) {}
  426. #endif /* CONFIG_FIREWIRE_OHCI_DEBUG */
  427. static inline void reg_write(const struct fw_ohci *ohci, int offset, u32 data)
  428. {
  429. writel(data, ohci->registers + offset);
  430. }
  431. static inline u32 reg_read(const struct fw_ohci *ohci, int offset)
  432. {
  433. return readl(ohci->registers + offset);
  434. }
  435. static inline void flush_writes(const struct fw_ohci *ohci)
  436. {
  437. /* Do a dummy read to flush writes. */
  438. reg_read(ohci, OHCI1394_Version);
  439. }
  440. static int read_phy_reg(struct fw_ohci *ohci, int addr)
  441. {
  442. u32 val;
  443. int i;
  444. reg_write(ohci, OHCI1394_PhyControl, OHCI1394_PhyControl_Read(addr));
  445. for (i = 0; i < 3 + 100; i++) {
  446. val = reg_read(ohci, OHCI1394_PhyControl);
  447. if (val & OHCI1394_PhyControl_ReadDone)
  448. return OHCI1394_PhyControl_ReadData(val);
  449. /*
  450. * Try a few times without waiting. Sleeping is necessary
  451. * only when the link/PHY interface is busy.
  452. */
  453. if (i >= 3)
  454. msleep(1);
  455. }
  456. fw_error("failed to read phy reg\n");
  457. return -EBUSY;
  458. }
  459. static int write_phy_reg(const struct fw_ohci *ohci, int addr, u32 val)
  460. {
  461. int i;
  462. reg_write(ohci, OHCI1394_PhyControl,
  463. OHCI1394_PhyControl_Write(addr, val));
  464. for (i = 0; i < 3 + 100; i++) {
  465. val = reg_read(ohci, OHCI1394_PhyControl);
  466. if (!(val & OHCI1394_PhyControl_WritePending))
  467. return 0;
  468. if (i >= 3)
  469. msleep(1);
  470. }
  471. fw_error("failed to write phy reg\n");
  472. return -EBUSY;
  473. }
  474. static int update_phy_reg(struct fw_ohci *ohci, int addr,
  475. int clear_bits, int set_bits)
  476. {
  477. int ret = read_phy_reg(ohci, addr);
  478. if (ret < 0)
  479. return ret;
  480. /*
  481. * The interrupt status bits are cleared by writing a one bit.
  482. * Avoid clearing them unless explicitly requested in set_bits.
  483. */
  484. if (addr == 5)
  485. clear_bits |= PHY_INT_STATUS_BITS;
  486. return write_phy_reg(ohci, addr, (ret & ~clear_bits) | set_bits);
  487. }
  488. static int read_paged_phy_reg(struct fw_ohci *ohci, int page, int addr)
  489. {
  490. int ret;
  491. ret = update_phy_reg(ohci, 7, PHY_PAGE_SELECT, page << 5);
  492. if (ret < 0)
  493. return ret;
  494. return read_phy_reg(ohci, addr);
  495. }
  496. static int ohci_read_phy_reg(struct fw_card *card, int addr)
  497. {
  498. struct fw_ohci *ohci = fw_ohci(card);
  499. int ret;
  500. mutex_lock(&ohci->phy_reg_mutex);
  501. ret = read_phy_reg(ohci, addr);
  502. mutex_unlock(&ohci->phy_reg_mutex);
  503. return ret;
  504. }
  505. static int ohci_update_phy_reg(struct fw_card *card, int addr,
  506. int clear_bits, int set_bits)
  507. {
  508. struct fw_ohci *ohci = fw_ohci(card);
  509. int ret;
  510. mutex_lock(&ohci->phy_reg_mutex);
  511. ret = update_phy_reg(ohci, addr, clear_bits, set_bits);
  512. mutex_unlock(&ohci->phy_reg_mutex);
  513. return ret;
  514. }
  515. static inline dma_addr_t ar_buffer_bus(struct ar_context *ctx, unsigned int i)
  516. {
  517. return page_private(ctx->pages[i]);
  518. }
  519. static void ar_context_link_page(struct ar_context *ctx, unsigned int index)
  520. {
  521. struct descriptor *d;
  522. d = &ctx->descriptors[index];
  523. d->branch_address &= cpu_to_le32(~0xf);
  524. d->res_count = cpu_to_le16(PAGE_SIZE);
  525. d->transfer_status = 0;
  526. wmb(); /* finish init of new descriptors before branch_address update */
  527. d = &ctx->descriptors[ctx->last_buffer_index];
  528. d->branch_address |= cpu_to_le32(1);
  529. ctx->last_buffer_index = index;
  530. reg_write(ctx->ohci, CONTROL_SET(ctx->regs), CONTEXT_WAKE);
  531. }
  532. static void ar_context_release(struct ar_context *ctx)
  533. {
  534. unsigned int i;
  535. if (ctx->buffer)
  536. vm_unmap_ram(ctx->buffer, AR_BUFFERS + AR_WRAPAROUND_PAGES);
  537. for (i = 0; i < AR_BUFFERS; i++)
  538. if (ctx->pages[i]) {
  539. dma_unmap_page(ctx->ohci->card.device,
  540. ar_buffer_bus(ctx, i),
  541. PAGE_SIZE, DMA_FROM_DEVICE);
  542. __free_page(ctx->pages[i]);
  543. }
  544. }
  545. static void ar_context_abort(struct ar_context *ctx, const char *error_msg)
  546. {
  547. if (reg_read(ctx->ohci, CONTROL_CLEAR(ctx->regs)) & CONTEXT_RUN) {
  548. reg_write(ctx->ohci, CONTROL_CLEAR(ctx->regs), CONTEXT_RUN);
  549. flush_writes(ctx->ohci);
  550. fw_error("AR error: %s; DMA stopped\n", error_msg);
  551. }
  552. /* FIXME: restart? */
  553. }
  554. static inline unsigned int ar_next_buffer_index(unsigned int index)
  555. {
  556. return (index + 1) % AR_BUFFERS;
  557. }
  558. static inline unsigned int ar_prev_buffer_index(unsigned int index)
  559. {
  560. return (index - 1 + AR_BUFFERS) % AR_BUFFERS;
  561. }
  562. static inline unsigned int ar_first_buffer_index(struct ar_context *ctx)
  563. {
  564. return ar_next_buffer_index(ctx->last_buffer_index);
  565. }
  566. /*
  567. * We search for the buffer that contains the last AR packet DMA data written
  568. * by the controller.
  569. */
  570. static unsigned int ar_search_last_active_buffer(struct ar_context *ctx,
  571. unsigned int *buffer_offset)
  572. {
  573. unsigned int i, next_i, last = ctx->last_buffer_index;
  574. __le16 res_count, next_res_count;
  575. i = ar_first_buffer_index(ctx);
  576. res_count = ACCESS_ONCE(ctx->descriptors[i].res_count);
  577. /* A buffer that is not yet completely filled must be the last one. */
  578. while (i != last && res_count == 0) {
  579. /* Peek at the next descriptor. */
  580. next_i = ar_next_buffer_index(i);
  581. rmb(); /* read descriptors in order */
  582. next_res_count = ACCESS_ONCE(
  583. ctx->descriptors[next_i].res_count);
  584. /*
  585. * If the next descriptor is still empty, we must stop at this
  586. * descriptor.
  587. */
  588. if (next_res_count == cpu_to_le16(PAGE_SIZE)) {
  589. /*
  590. * The exception is when the DMA data for one packet is
  591. * split over three buffers; in this case, the middle
  592. * buffer's descriptor might be never updated by the
  593. * controller and look still empty, and we have to peek
  594. * at the third one.
  595. */
  596. if (MAX_AR_PACKET_SIZE > PAGE_SIZE && i != last) {
  597. next_i = ar_next_buffer_index(next_i);
  598. rmb();
  599. next_res_count = ACCESS_ONCE(
  600. ctx->descriptors[next_i].res_count);
  601. if (next_res_count != cpu_to_le16(PAGE_SIZE))
  602. goto next_buffer_is_active;
  603. }
  604. break;
  605. }
  606. next_buffer_is_active:
  607. i = next_i;
  608. res_count = next_res_count;
  609. }
  610. rmb(); /* read res_count before the DMA data */
  611. *buffer_offset = PAGE_SIZE - le16_to_cpu(res_count);
  612. if (*buffer_offset > PAGE_SIZE) {
  613. *buffer_offset = 0;
  614. ar_context_abort(ctx, "corrupted descriptor");
  615. }
  616. return i;
  617. }
  618. static void ar_sync_buffers_for_cpu(struct ar_context *ctx,
  619. unsigned int end_buffer_index,
  620. unsigned int end_buffer_offset)
  621. {
  622. unsigned int i;
  623. i = ar_first_buffer_index(ctx);
  624. while (i != end_buffer_index) {
  625. dma_sync_single_for_cpu(ctx->ohci->card.device,
  626. ar_buffer_bus(ctx, i),
  627. PAGE_SIZE, DMA_FROM_DEVICE);
  628. i = ar_next_buffer_index(i);
  629. }
  630. if (end_buffer_offset > 0)
  631. dma_sync_single_for_cpu(ctx->ohci->card.device,
  632. ar_buffer_bus(ctx, i),
  633. end_buffer_offset, DMA_FROM_DEVICE);
  634. }
  635. #if defined(CONFIG_PPC_PMAC) && defined(CONFIG_PPC32)
  636. #define cond_le32_to_cpu(v) \
  637. (ohci->quirks & QUIRK_BE_HEADERS ? (__force __u32)(v) : le32_to_cpu(v))
  638. #else
  639. #define cond_le32_to_cpu(v) le32_to_cpu(v)
  640. #endif
  641. static __le32 *handle_ar_packet(struct ar_context *ctx, __le32 *buffer)
  642. {
  643. struct fw_ohci *ohci = ctx->ohci;
  644. struct fw_packet p;
  645. u32 status, length, tcode;
  646. int evt;
  647. p.header[0] = cond_le32_to_cpu(buffer[0]);
  648. p.header[1] = cond_le32_to_cpu(buffer[1]);
  649. p.header[2] = cond_le32_to_cpu(buffer[2]);
  650. tcode = (p.header[0] >> 4) & 0x0f;
  651. switch (tcode) {
  652. case TCODE_WRITE_QUADLET_REQUEST:
  653. case TCODE_READ_QUADLET_RESPONSE:
  654. p.header[3] = (__force __u32) buffer[3];
  655. p.header_length = 16;
  656. p.payload_length = 0;
  657. break;
  658. case TCODE_READ_BLOCK_REQUEST :
  659. p.header[3] = cond_le32_to_cpu(buffer[3]);
  660. p.header_length = 16;
  661. p.payload_length = 0;
  662. break;
  663. case TCODE_WRITE_BLOCK_REQUEST:
  664. case TCODE_READ_BLOCK_RESPONSE:
  665. case TCODE_LOCK_REQUEST:
  666. case TCODE_LOCK_RESPONSE:
  667. p.header[3] = cond_le32_to_cpu(buffer[3]);
  668. p.header_length = 16;
  669. p.payload_length = p.header[3] >> 16;
  670. if (p.payload_length > MAX_ASYNC_PAYLOAD) {
  671. ar_context_abort(ctx, "invalid packet length");
  672. return NULL;
  673. }
  674. break;
  675. case TCODE_WRITE_RESPONSE:
  676. case TCODE_READ_QUADLET_REQUEST:
  677. case OHCI_TCODE_PHY_PACKET:
  678. p.header_length = 12;
  679. p.payload_length = 0;
  680. break;
  681. default:
  682. ar_context_abort(ctx, "invalid tcode");
  683. return NULL;
  684. }
  685. p.payload = (void *) buffer + p.header_length;
  686. /* FIXME: What to do about evt_* errors? */
  687. length = (p.header_length + p.payload_length + 3) / 4;
  688. status = cond_le32_to_cpu(buffer[length]);
  689. evt = (status >> 16) & 0x1f;
  690. p.ack = evt - 16;
  691. p.speed = (status >> 21) & 0x7;
  692. p.timestamp = status & 0xffff;
  693. p.generation = ohci->request_generation;
  694. log_ar_at_event('R', p.speed, p.header, evt);
  695. /*
  696. * Several controllers, notably from NEC and VIA, forget to
  697. * write ack_complete status at PHY packet reception.
  698. */
  699. if (evt == OHCI1394_evt_no_status &&
  700. (p.header[0] & 0xff) == (OHCI1394_phy_tcode << 4))
  701. p.ack = ACK_COMPLETE;
  702. /*
  703. * The OHCI bus reset handler synthesizes a PHY packet with
  704. * the new generation number when a bus reset happens (see
  705. * section 8.4.2.3). This helps us determine when a request
  706. * was received and make sure we send the response in the same
  707. * generation. We only need this for requests; for responses
  708. * we use the unique tlabel for finding the matching
  709. * request.
  710. *
  711. * Alas some chips sometimes emit bus reset packets with a
  712. * wrong generation. We set the correct generation for these
  713. * at a slightly incorrect time (in bus_reset_tasklet).
  714. */
  715. if (evt == OHCI1394_evt_bus_reset) {
  716. if (!(ohci->quirks & QUIRK_RESET_PACKET))
  717. ohci->request_generation = (p.header[2] >> 16) & 0xff;
  718. } else if (ctx == &ohci->ar_request_ctx) {
  719. fw_core_handle_request(&ohci->card, &p);
  720. } else {
  721. fw_core_handle_response(&ohci->card, &p);
  722. }
  723. return buffer + length + 1;
  724. }
  725. static void *handle_ar_packets(struct ar_context *ctx, void *p, void *end)
  726. {
  727. void *next;
  728. while (p < end) {
  729. next = handle_ar_packet(ctx, p);
  730. if (!next)
  731. return p;
  732. p = next;
  733. }
  734. return p;
  735. }
  736. static void ar_recycle_buffers(struct ar_context *ctx, unsigned int end_buffer)
  737. {
  738. unsigned int i;
  739. i = ar_first_buffer_index(ctx);
  740. while (i != end_buffer) {
  741. dma_sync_single_for_device(ctx->ohci->card.device,
  742. ar_buffer_bus(ctx, i),
  743. PAGE_SIZE, DMA_FROM_DEVICE);
  744. ar_context_link_page(ctx, i);
  745. i = ar_next_buffer_index(i);
  746. }
  747. }
  748. static void ar_context_tasklet(unsigned long data)
  749. {
  750. struct ar_context *ctx = (struct ar_context *)data;
  751. unsigned int end_buffer_index, end_buffer_offset;
  752. void *p, *end;
  753. p = ctx->pointer;
  754. if (!p)
  755. return;
  756. end_buffer_index = ar_search_last_active_buffer(ctx,
  757. &end_buffer_offset);
  758. ar_sync_buffers_for_cpu(ctx, end_buffer_index, end_buffer_offset);
  759. end = ctx->buffer + end_buffer_index * PAGE_SIZE + end_buffer_offset;
  760. if (end_buffer_index < ar_first_buffer_index(ctx)) {
  761. /*
  762. * The filled part of the overall buffer wraps around; handle
  763. * all packets up to the buffer end here. If the last packet
  764. * wraps around, its tail will be visible after the buffer end
  765. * because the buffer start pages are mapped there again.
  766. */
  767. void *buffer_end = ctx->buffer + AR_BUFFERS * PAGE_SIZE;
  768. p = handle_ar_packets(ctx, p, buffer_end);
  769. if (p < buffer_end)
  770. goto error;
  771. /* adjust p to point back into the actual buffer */
  772. p -= AR_BUFFERS * PAGE_SIZE;
  773. }
  774. p = handle_ar_packets(ctx, p, end);
  775. if (p != end) {
  776. if (p > end)
  777. ar_context_abort(ctx, "inconsistent descriptor");
  778. goto error;
  779. }
  780. ctx->pointer = p;
  781. ar_recycle_buffers(ctx, end_buffer_index);
  782. return;
  783. error:
  784. ctx->pointer = NULL;
  785. }
  786. static int ar_context_init(struct ar_context *ctx, struct fw_ohci *ohci,
  787. unsigned int descriptors_offset, u32 regs)
  788. {
  789. unsigned int i;
  790. dma_addr_t dma_addr;
  791. struct page *pages[AR_BUFFERS + AR_WRAPAROUND_PAGES];
  792. struct descriptor *d;
  793. ctx->regs = regs;
  794. ctx->ohci = ohci;
  795. tasklet_init(&ctx->tasklet, ar_context_tasklet, (unsigned long)ctx);
  796. for (i = 0; i < AR_BUFFERS; i++) {
  797. ctx->pages[i] = alloc_page(GFP_KERNEL | GFP_DMA32);
  798. if (!ctx->pages[i])
  799. goto out_of_memory;
  800. dma_addr = dma_map_page(ohci->card.device, ctx->pages[i],
  801. 0, PAGE_SIZE, DMA_FROM_DEVICE);
  802. if (dma_mapping_error(ohci->card.device, dma_addr)) {
  803. __free_page(ctx->pages[i]);
  804. ctx->pages[i] = NULL;
  805. goto out_of_memory;
  806. }
  807. set_page_private(ctx->pages[i], dma_addr);
  808. }
  809. for (i = 0; i < AR_BUFFERS; i++)
  810. pages[i] = ctx->pages[i];
  811. for (i = 0; i < AR_WRAPAROUND_PAGES; i++)
  812. pages[AR_BUFFERS + i] = ctx->pages[i];
  813. ctx->buffer = vm_map_ram(pages, AR_BUFFERS + AR_WRAPAROUND_PAGES,
  814. -1, PAGE_KERNEL);
  815. if (!ctx->buffer)
  816. goto out_of_memory;
  817. ctx->descriptors = ohci->misc_buffer + descriptors_offset;
  818. ctx->descriptors_bus = ohci->misc_buffer_bus + descriptors_offset;
  819. for (i = 0; i < AR_BUFFERS; i++) {
  820. d = &ctx->descriptors[i];
  821. d->req_count = cpu_to_le16(PAGE_SIZE);
  822. d->control = cpu_to_le16(DESCRIPTOR_INPUT_MORE |
  823. DESCRIPTOR_STATUS |
  824. DESCRIPTOR_BRANCH_ALWAYS);
  825. d->data_address = cpu_to_le32(ar_buffer_bus(ctx, i));
  826. d->branch_address = cpu_to_le32(ctx->descriptors_bus +
  827. ar_next_buffer_index(i) * sizeof(struct descriptor));
  828. }
  829. return 0;
  830. out_of_memory:
  831. ar_context_release(ctx);
  832. return -ENOMEM;
  833. }
  834. static void ar_context_run(struct ar_context *ctx)
  835. {
  836. unsigned int i;
  837. for (i = 0; i < AR_BUFFERS; i++)
  838. ar_context_link_page(ctx, i);
  839. ctx->pointer = ctx->buffer;
  840. reg_write(ctx->ohci, COMMAND_PTR(ctx->regs), ctx->descriptors_bus | 1);
  841. reg_write(ctx->ohci, CONTROL_SET(ctx->regs), CONTEXT_RUN);
  842. }
  843. static struct descriptor *find_branch_descriptor(struct descriptor *d, int z)
  844. {
  845. __le16 branch;
  846. branch = d->control & cpu_to_le16(DESCRIPTOR_BRANCH_ALWAYS);
  847. /* figure out which descriptor the branch address goes in */
  848. if (z == 2 && branch == cpu_to_le16(DESCRIPTOR_BRANCH_ALWAYS))
  849. return d;
  850. else
  851. return d + z - 1;
  852. }
  853. static void context_tasklet(unsigned long data)
  854. {
  855. struct context *ctx = (struct context *) data;
  856. struct descriptor *d, *last;
  857. u32 address;
  858. int z;
  859. struct descriptor_buffer *desc;
  860. desc = list_entry(ctx->buffer_list.next,
  861. struct descriptor_buffer, list);
  862. last = ctx->last;
  863. while (last->branch_address != 0) {
  864. struct descriptor_buffer *old_desc = desc;
  865. address = le32_to_cpu(last->branch_address);
  866. z = address & 0xf;
  867. address &= ~0xf;
  868. /* If the branch address points to a buffer outside of the
  869. * current buffer, advance to the next buffer. */
  870. if (address < desc->buffer_bus ||
  871. address >= desc->buffer_bus + desc->used)
  872. desc = list_entry(desc->list.next,
  873. struct descriptor_buffer, list);
  874. d = desc->buffer + (address - desc->buffer_bus) / sizeof(*d);
  875. last = find_branch_descriptor(d, z);
  876. if (!ctx->callback(ctx, d, last))
  877. break;
  878. if (old_desc != desc) {
  879. /* If we've advanced to the next buffer, move the
  880. * previous buffer to the free list. */
  881. unsigned long flags;
  882. old_desc->used = 0;
  883. spin_lock_irqsave(&ctx->ohci->lock, flags);
  884. list_move_tail(&old_desc->list, &ctx->buffer_list);
  885. spin_unlock_irqrestore(&ctx->ohci->lock, flags);
  886. }
  887. ctx->last = last;
  888. }
  889. }
  890. /*
  891. * Allocate a new buffer and add it to the list of free buffers for this
  892. * context. Must be called with ohci->lock held.
  893. */
  894. static int context_add_buffer(struct context *ctx)
  895. {
  896. struct descriptor_buffer *desc;
  897. dma_addr_t uninitialized_var(bus_addr);
  898. int offset;
  899. /*
  900. * 16MB of descriptors should be far more than enough for any DMA
  901. * program. This will catch run-away userspace or DoS attacks.
  902. */
  903. if (ctx->total_allocation >= 16*1024*1024)
  904. return -ENOMEM;
  905. desc = dma_alloc_coherent(ctx->ohci->card.device, PAGE_SIZE,
  906. &bus_addr, GFP_ATOMIC);
  907. if (!desc)
  908. return -ENOMEM;
  909. offset = (void *)&desc->buffer - (void *)desc;
  910. desc->buffer_size = PAGE_SIZE - offset;
  911. desc->buffer_bus = bus_addr + offset;
  912. desc->used = 0;
  913. list_add_tail(&desc->list, &ctx->buffer_list);
  914. ctx->total_allocation += PAGE_SIZE;
  915. return 0;
  916. }
  917. static int context_init(struct context *ctx, struct fw_ohci *ohci,
  918. u32 regs, descriptor_callback_t callback)
  919. {
  920. ctx->ohci = ohci;
  921. ctx->regs = regs;
  922. ctx->total_allocation = 0;
  923. INIT_LIST_HEAD(&ctx->buffer_list);
  924. if (context_add_buffer(ctx) < 0)
  925. return -ENOMEM;
  926. ctx->buffer_tail = list_entry(ctx->buffer_list.next,
  927. struct descriptor_buffer, list);
  928. tasklet_init(&ctx->tasklet, context_tasklet, (unsigned long)ctx);
  929. ctx->callback = callback;
  930. /*
  931. * We put a dummy descriptor in the buffer that has a NULL
  932. * branch address and looks like it's been sent. That way we
  933. * have a descriptor to append DMA programs to.
  934. */
  935. memset(ctx->buffer_tail->buffer, 0, sizeof(*ctx->buffer_tail->buffer));
  936. ctx->buffer_tail->buffer->control = cpu_to_le16(DESCRIPTOR_OUTPUT_LAST);
  937. ctx->buffer_tail->buffer->transfer_status = cpu_to_le16(0x8011);
  938. ctx->buffer_tail->used += sizeof(*ctx->buffer_tail->buffer);
  939. ctx->last = ctx->buffer_tail->buffer;
  940. ctx->prev = ctx->buffer_tail->buffer;
  941. return 0;
  942. }
  943. static void context_release(struct context *ctx)
  944. {
  945. struct fw_card *card = &ctx->ohci->card;
  946. struct descriptor_buffer *desc, *tmp;
  947. list_for_each_entry_safe(desc, tmp, &ctx->buffer_list, list)
  948. dma_free_coherent(card->device, PAGE_SIZE, desc,
  949. desc->buffer_bus -
  950. ((void *)&desc->buffer - (void *)desc));
  951. }
  952. /* Must be called with ohci->lock held */
  953. static struct descriptor *context_get_descriptors(struct context *ctx,
  954. int z, dma_addr_t *d_bus)
  955. {
  956. struct descriptor *d = NULL;
  957. struct descriptor_buffer *desc = ctx->buffer_tail;
  958. if (z * sizeof(*d) > desc->buffer_size)
  959. return NULL;
  960. if (z * sizeof(*d) > desc->buffer_size - desc->used) {
  961. /* No room for the descriptor in this buffer, so advance to the
  962. * next one. */
  963. if (desc->list.next == &ctx->buffer_list) {
  964. /* If there is no free buffer next in the list,
  965. * allocate one. */
  966. if (context_add_buffer(ctx) < 0)
  967. return NULL;
  968. }
  969. desc = list_entry(desc->list.next,
  970. struct descriptor_buffer, list);
  971. ctx->buffer_tail = desc;
  972. }
  973. d = desc->buffer + desc->used / sizeof(*d);
  974. memset(d, 0, z * sizeof(*d));
  975. *d_bus = desc->buffer_bus + desc->used;
  976. return d;
  977. }
  978. static void context_run(struct context *ctx, u32 extra)
  979. {
  980. struct fw_ohci *ohci = ctx->ohci;
  981. reg_write(ohci, COMMAND_PTR(ctx->regs),
  982. le32_to_cpu(ctx->last->branch_address));
  983. reg_write(ohci, CONTROL_CLEAR(ctx->regs), ~0);
  984. reg_write(ohci, CONTROL_SET(ctx->regs), CONTEXT_RUN | extra);
  985. ctx->running = true;
  986. flush_writes(ohci);
  987. }
  988. static void context_append(struct context *ctx,
  989. struct descriptor *d, int z, int extra)
  990. {
  991. dma_addr_t d_bus;
  992. struct descriptor_buffer *desc = ctx->buffer_tail;
  993. d_bus = desc->buffer_bus + (d - desc->buffer) * sizeof(*d);
  994. desc->used += (z + extra) * sizeof(*d);
  995. wmb(); /* finish init of new descriptors before branch_address update */
  996. ctx->prev->branch_address = cpu_to_le32(d_bus | z);
  997. ctx->prev = find_branch_descriptor(d, z);
  998. }
  999. static void context_stop(struct context *ctx)
  1000. {
  1001. u32 reg;
  1002. int i;
  1003. reg_write(ctx->ohci, CONTROL_CLEAR(ctx->regs), CONTEXT_RUN);
  1004. ctx->running = false;
  1005. for (i = 0; i < 10; i++) {
  1006. reg = reg_read(ctx->ohci, CONTROL_SET(ctx->regs));
  1007. if ((reg & CONTEXT_ACTIVE) == 0)
  1008. return;
  1009. mdelay(1);
  1010. }
  1011. fw_error("Error: DMA context still active (0x%08x)\n", reg);
  1012. }
  1013. struct driver_data {
  1014. u8 inline_data[8];
  1015. struct fw_packet *packet;
  1016. };
  1017. /*
  1018. * This function apppends a packet to the DMA queue for transmission.
  1019. * Must always be called with the ochi->lock held to ensure proper
  1020. * generation handling and locking around packet queue manipulation.
  1021. */
  1022. static int at_context_queue_packet(struct context *ctx,
  1023. struct fw_packet *packet)
  1024. {
  1025. struct fw_ohci *ohci = ctx->ohci;
  1026. dma_addr_t d_bus, uninitialized_var(payload_bus);
  1027. struct driver_data *driver_data;
  1028. struct descriptor *d, *last;
  1029. __le32 *header;
  1030. int z, tcode;
  1031. d = context_get_descriptors(ctx, 4, &d_bus);
  1032. if (d == NULL) {
  1033. packet->ack = RCODE_SEND_ERROR;
  1034. return -1;
  1035. }
  1036. d[0].control = cpu_to_le16(DESCRIPTOR_KEY_IMMEDIATE);
  1037. d[0].res_count = cpu_to_le16(packet->timestamp);
  1038. /*
  1039. * The DMA format for asyncronous link packets is different
  1040. * from the IEEE1394 layout, so shift the fields around
  1041. * accordingly.
  1042. */
  1043. tcode = (packet->header[0] >> 4) & 0x0f;
  1044. header = (__le32 *) &d[1];
  1045. switch (tcode) {
  1046. case TCODE_WRITE_QUADLET_REQUEST:
  1047. case TCODE_WRITE_BLOCK_REQUEST:
  1048. case TCODE_WRITE_RESPONSE:
  1049. case TCODE_READ_QUADLET_REQUEST:
  1050. case TCODE_READ_BLOCK_REQUEST:
  1051. case TCODE_READ_QUADLET_RESPONSE:
  1052. case TCODE_READ_BLOCK_RESPONSE:
  1053. case TCODE_LOCK_REQUEST:
  1054. case TCODE_LOCK_RESPONSE:
  1055. header[0] = cpu_to_le32((packet->header[0] & 0xffff) |
  1056. (packet->speed << 16));
  1057. header[1] = cpu_to_le32((packet->header[1] & 0xffff) |
  1058. (packet->header[0] & 0xffff0000));
  1059. header[2] = cpu_to_le32(packet->header[2]);
  1060. if (TCODE_IS_BLOCK_PACKET(tcode))
  1061. header[3] = cpu_to_le32(packet->header[3]);
  1062. else
  1063. header[3] = (__force __le32) packet->header[3];
  1064. d[0].req_count = cpu_to_le16(packet->header_length);
  1065. break;
  1066. case TCODE_LINK_INTERNAL:
  1067. header[0] = cpu_to_le32((OHCI1394_phy_tcode << 4) |
  1068. (packet->speed << 16));
  1069. header[1] = cpu_to_le32(packet->header[1]);
  1070. header[2] = cpu_to_le32(packet->header[2]);
  1071. d[0].req_count = cpu_to_le16(12);
  1072. if (is_ping_packet(&packet->header[1]))
  1073. d[0].control |= cpu_to_le16(DESCRIPTOR_PING);
  1074. break;
  1075. case TCODE_STREAM_DATA:
  1076. header[0] = cpu_to_le32((packet->header[0] & 0xffff) |
  1077. (packet->speed << 16));
  1078. header[1] = cpu_to_le32(packet->header[0] & 0xffff0000);
  1079. d[0].req_count = cpu_to_le16(8);
  1080. break;
  1081. default:
  1082. /* BUG(); */
  1083. packet->ack = RCODE_SEND_ERROR;
  1084. return -1;
  1085. }
  1086. BUILD_BUG_ON(sizeof(struct driver_data) > sizeof(struct descriptor));
  1087. driver_data = (struct driver_data *) &d[3];
  1088. driver_data->packet = packet;
  1089. packet->driver_data = driver_data;
  1090. if (packet->payload_length > 0) {
  1091. if (packet->payload_length > sizeof(driver_data->inline_data)) {
  1092. payload_bus = dma_map_single(ohci->card.device,
  1093. packet->payload,
  1094. packet->payload_length,
  1095. DMA_TO_DEVICE);
  1096. if (dma_mapping_error(ohci->card.device, payload_bus)) {
  1097. packet->ack = RCODE_SEND_ERROR;
  1098. return -1;
  1099. }
  1100. packet->payload_bus = payload_bus;
  1101. packet->payload_mapped = true;
  1102. } else {
  1103. memcpy(driver_data->inline_data, packet->payload,
  1104. packet->payload_length);
  1105. payload_bus = d_bus + 3 * sizeof(*d);
  1106. }
  1107. d[2].req_count = cpu_to_le16(packet->payload_length);
  1108. d[2].data_address = cpu_to_le32(payload_bus);
  1109. last = &d[2];
  1110. z = 3;
  1111. } else {
  1112. last = &d[0];
  1113. z = 2;
  1114. }
  1115. last->control |= cpu_to_le16(DESCRIPTOR_OUTPUT_LAST |
  1116. DESCRIPTOR_IRQ_ALWAYS |
  1117. DESCRIPTOR_BRANCH_ALWAYS);
  1118. /* FIXME: Document how the locking works. */
  1119. if (ohci->generation != packet->generation) {
  1120. if (packet->payload_mapped)
  1121. dma_unmap_single(ohci->card.device, payload_bus,
  1122. packet->payload_length, DMA_TO_DEVICE);
  1123. packet->ack = RCODE_GENERATION;
  1124. return -1;
  1125. }
  1126. context_append(ctx, d, z, 4 - z);
  1127. if (ctx->running)
  1128. reg_write(ohci, CONTROL_SET(ctx->regs), CONTEXT_WAKE);
  1129. else
  1130. context_run(ctx, 0);
  1131. return 0;
  1132. }
  1133. static void at_context_flush(struct context *ctx)
  1134. {
  1135. tasklet_disable(&ctx->tasklet);
  1136. ctx->flushing = true;
  1137. context_tasklet((unsigned long)ctx);
  1138. ctx->flushing = false;
  1139. tasklet_enable(&ctx->tasklet);
  1140. }
  1141. static int handle_at_packet(struct context *context,
  1142. struct descriptor *d,
  1143. struct descriptor *last)
  1144. {
  1145. struct driver_data *driver_data;
  1146. struct fw_packet *packet;
  1147. struct fw_ohci *ohci = context->ohci;
  1148. int evt;
  1149. if (last->transfer_status == 0 && !context->flushing)
  1150. /* This descriptor isn't done yet, stop iteration. */
  1151. return 0;
  1152. driver_data = (struct driver_data *) &d[3];
  1153. packet = driver_data->packet;
  1154. if (packet == NULL)
  1155. /* This packet was cancelled, just continue. */
  1156. return 1;
  1157. if (packet->payload_mapped)
  1158. dma_unmap_single(ohci->card.device, packet->payload_bus,
  1159. packet->payload_length, DMA_TO_DEVICE);
  1160. evt = le16_to_cpu(last->transfer_status) & 0x1f;
  1161. packet->timestamp = le16_to_cpu(last->res_count);
  1162. log_ar_at_event('T', packet->speed, packet->header, evt);
  1163. switch (evt) {
  1164. case OHCI1394_evt_timeout:
  1165. /* Async response transmit timed out. */
  1166. packet->ack = RCODE_CANCELLED;
  1167. break;
  1168. case OHCI1394_evt_flushed:
  1169. /*
  1170. * The packet was flushed should give same error as
  1171. * when we try to use a stale generation count.
  1172. */
  1173. packet->ack = RCODE_GENERATION;
  1174. break;
  1175. case OHCI1394_evt_missing_ack:
  1176. if (context->flushing)
  1177. packet->ack = RCODE_GENERATION;
  1178. else {
  1179. /*
  1180. * Using a valid (current) generation count, but the
  1181. * node is not on the bus or not sending acks.
  1182. */
  1183. packet->ack = RCODE_NO_ACK;
  1184. }
  1185. break;
  1186. case ACK_COMPLETE + 0x10:
  1187. case ACK_PENDING + 0x10:
  1188. case ACK_BUSY_X + 0x10:
  1189. case ACK_BUSY_A + 0x10:
  1190. case ACK_BUSY_B + 0x10:
  1191. case ACK_DATA_ERROR + 0x10:
  1192. case ACK_TYPE_ERROR + 0x10:
  1193. packet->ack = evt - 0x10;
  1194. break;
  1195. case OHCI1394_evt_no_status:
  1196. if (context->flushing) {
  1197. packet->ack = RCODE_GENERATION;
  1198. break;
  1199. }
  1200. /* fall through */
  1201. default:
  1202. packet->ack = RCODE_SEND_ERROR;
  1203. break;
  1204. }
  1205. packet->callback(packet, &ohci->card, packet->ack);
  1206. return 1;
  1207. }
  1208. #define HEADER_GET_DESTINATION(q) (((q) >> 16) & 0xffff)
  1209. #define HEADER_GET_TCODE(q) (((q) >> 4) & 0x0f)
  1210. #define HEADER_GET_OFFSET_HIGH(q) (((q) >> 0) & 0xffff)
  1211. #define HEADER_GET_DATA_LENGTH(q) (((q) >> 16) & 0xffff)
  1212. #define HEADER_GET_EXTENDED_TCODE(q) (((q) >> 0) & 0xffff)
  1213. static void handle_local_rom(struct fw_ohci *ohci,
  1214. struct fw_packet *packet, u32 csr)
  1215. {
  1216. struct fw_packet response;
  1217. int tcode, length, i;
  1218. tcode = HEADER_GET_TCODE(packet->header[0]);
  1219. if (TCODE_IS_BLOCK_PACKET(tcode))
  1220. length = HEADER_GET_DATA_LENGTH(packet->header[3]);
  1221. else
  1222. length = 4;
  1223. i = csr - CSR_CONFIG_ROM;
  1224. if (i + length > CONFIG_ROM_SIZE) {
  1225. fw_fill_response(&response, packet->header,
  1226. RCODE_ADDRESS_ERROR, NULL, 0);
  1227. } else if (!TCODE_IS_READ_REQUEST(tcode)) {
  1228. fw_fill_response(&response, packet->header,
  1229. RCODE_TYPE_ERROR, NULL, 0);
  1230. } else {
  1231. fw_fill_response(&response, packet->header, RCODE_COMPLETE,
  1232. (void *) ohci->config_rom + i, length);
  1233. }
  1234. fw_core_handle_response(&ohci->card, &response);
  1235. }
  1236. static void handle_local_lock(struct fw_ohci *ohci,
  1237. struct fw_packet *packet, u32 csr)
  1238. {
  1239. struct fw_packet response;
  1240. int tcode, length, ext_tcode, sel, try;
  1241. __be32 *payload, lock_old;
  1242. u32 lock_arg, lock_data;
  1243. tcode = HEADER_GET_TCODE(packet->header[0]);
  1244. length = HEADER_GET_DATA_LENGTH(packet->header[3]);
  1245. payload = packet->payload;
  1246. ext_tcode = HEADER_GET_EXTENDED_TCODE(packet->header[3]);
  1247. if (tcode == TCODE_LOCK_REQUEST &&
  1248. ext_tcode == EXTCODE_COMPARE_SWAP && length == 8) {
  1249. lock_arg = be32_to_cpu(payload[0]);
  1250. lock_data = be32_to_cpu(payload[1]);
  1251. } else if (tcode == TCODE_READ_QUADLET_REQUEST) {
  1252. lock_arg = 0;
  1253. lock_data = 0;
  1254. } else {
  1255. fw_fill_response(&response, packet->header,
  1256. RCODE_TYPE_ERROR, NULL, 0);
  1257. goto out;
  1258. }
  1259. sel = (csr - CSR_BUS_MANAGER_ID) / 4;
  1260. reg_write(ohci, OHCI1394_CSRData, lock_data);
  1261. reg_write(ohci, OHCI1394_CSRCompareData, lock_arg);
  1262. reg_write(ohci, OHCI1394_CSRControl, sel);
  1263. for (try = 0; try < 20; try++)
  1264. if (reg_read(ohci, OHCI1394_CSRControl) & 0x80000000) {
  1265. lock_old = cpu_to_be32(reg_read(ohci,
  1266. OHCI1394_CSRData));
  1267. fw_fill_response(&response, packet->header,
  1268. RCODE_COMPLETE,
  1269. &lock_old, sizeof(lock_old));
  1270. goto out;
  1271. }
  1272. fw_error("swap not done (CSR lock timeout)\n");
  1273. fw_fill_response(&response, packet->header, RCODE_BUSY, NULL, 0);
  1274. out:
  1275. fw_core_handle_response(&ohci->card, &response);
  1276. }
  1277. static void handle_local_request(struct context *ctx, struct fw_packet *packet)
  1278. {
  1279. u64 offset, csr;
  1280. if (ctx == &ctx->ohci->at_request_ctx) {
  1281. packet->ack = ACK_PENDING;
  1282. packet->callback(packet, &ctx->ohci->card, packet->ack);
  1283. }
  1284. offset =
  1285. ((unsigned long long)
  1286. HEADER_GET_OFFSET_HIGH(packet->header[1]) << 32) |
  1287. packet->header[2];
  1288. csr = offset - CSR_REGISTER_BASE;
  1289. /* Handle config rom reads. */
  1290. if (csr >= CSR_CONFIG_ROM && csr < CSR_CONFIG_ROM_END)
  1291. handle_local_rom(ctx->ohci, packet, csr);
  1292. else switch (csr) {
  1293. case CSR_BUS_MANAGER_ID:
  1294. case CSR_BANDWIDTH_AVAILABLE:
  1295. case CSR_CHANNELS_AVAILABLE_HI:
  1296. case CSR_CHANNELS_AVAILABLE_LO:
  1297. handle_local_lock(ctx->ohci, packet, csr);
  1298. break;
  1299. default:
  1300. if (ctx == &ctx->ohci->at_request_ctx)
  1301. fw_core_handle_request(&ctx->ohci->card, packet);
  1302. else
  1303. fw_core_handle_response(&ctx->ohci->card, packet);
  1304. break;
  1305. }
  1306. if (ctx == &ctx->ohci->at_response_ctx) {
  1307. packet->ack = ACK_COMPLETE;
  1308. packet->callback(packet, &ctx->ohci->card, packet->ack);
  1309. }
  1310. }
  1311. static void at_context_transmit(struct context *ctx, struct fw_packet *packet)
  1312. {
  1313. unsigned long flags;
  1314. int ret;
  1315. spin_lock_irqsave(&ctx->ohci->lock, flags);
  1316. if (HEADER_GET_DESTINATION(packet->header[0]) == ctx->ohci->node_id &&
  1317. ctx->ohci->generation == packet->generation) {
  1318. spin_unlock_irqrestore(&ctx->ohci->lock, flags);
  1319. handle_local_request(ctx, packet);
  1320. return;
  1321. }
  1322. ret = at_context_queue_packet(ctx, packet);
  1323. spin_unlock_irqrestore(&ctx->ohci->lock, flags);
  1324. if (ret < 0)
  1325. packet->callback(packet, &ctx->ohci->card, packet->ack);
  1326. }
  1327. static void detect_dead_context(struct fw_ohci *ohci,
  1328. const char *name, unsigned int regs)
  1329. {
  1330. u32 ctl;
  1331. ctl = reg_read(ohci, CONTROL_SET(regs));
  1332. if (ctl & CONTEXT_DEAD) {
  1333. #ifdef CONFIG_FIREWIRE_OHCI_DEBUG
  1334. fw_error("DMA context %s has stopped, error code: %s\n",
  1335. name, evts[ctl & 0x1f]);
  1336. #else
  1337. fw_error("DMA context %s has stopped, error code: %#x\n",
  1338. name, ctl & 0x1f);
  1339. #endif
  1340. }
  1341. }
  1342. static void handle_dead_contexts(struct fw_ohci *ohci)
  1343. {
  1344. unsigned int i;
  1345. char name[8];
  1346. detect_dead_context(ohci, "ATReq", OHCI1394_AsReqTrContextBase);
  1347. detect_dead_context(ohci, "ATRsp", OHCI1394_AsRspTrContextBase);
  1348. detect_dead_context(ohci, "ARReq", OHCI1394_AsReqRcvContextBase);
  1349. detect_dead_context(ohci, "ARRsp", OHCI1394_AsRspRcvContextBase);
  1350. for (i = 0; i < 32; ++i) {
  1351. if (!(ohci->it_context_support & (1 << i)))
  1352. continue;
  1353. sprintf(name, "IT%u", i);
  1354. detect_dead_context(ohci, name, OHCI1394_IsoXmitContextBase(i));
  1355. }
  1356. for (i = 0; i < 32; ++i) {
  1357. if (!(ohci->ir_context_support & (1 << i)))
  1358. continue;
  1359. sprintf(name, "IR%u", i);
  1360. detect_dead_context(ohci, name, OHCI1394_IsoRcvContextBase(i));
  1361. }
  1362. /* TODO: maybe try to flush and restart the dead contexts */
  1363. }
  1364. static u32 cycle_timer_ticks(u32 cycle_timer)
  1365. {
  1366. u32 ticks;
  1367. ticks = cycle_timer & 0xfff;
  1368. ticks += 3072 * ((cycle_timer >> 12) & 0x1fff);
  1369. ticks += (3072 * 8000) * (cycle_timer >> 25);
  1370. return ticks;
  1371. }
  1372. /*
  1373. * Some controllers exhibit one or more of the following bugs when updating the
  1374. * iso cycle timer register:
  1375. * - When the lowest six bits are wrapping around to zero, a read that happens
  1376. * at the same time will return garbage in the lowest ten bits.
  1377. * - When the cycleOffset field wraps around to zero, the cycleCount field is
  1378. * not incremented for about 60 ns.
  1379. * - Occasionally, the entire register reads zero.
  1380. *
  1381. * To catch these, we read the register three times and ensure that the
  1382. * difference between each two consecutive reads is approximately the same, i.e.
  1383. * less than twice the other. Furthermore, any negative difference indicates an
  1384. * error. (A PCI read should take at least 20 ticks of the 24.576 MHz timer to
  1385. * execute, so we have enough precision to compute the ratio of the differences.)
  1386. */
  1387. static u32 get_cycle_time(struct fw_ohci *ohci)
  1388. {
  1389. u32 c0, c1, c2;
  1390. u32 t0, t1, t2;
  1391. s32 diff01, diff12;
  1392. int i;
  1393. c2 = reg_read(ohci, OHCI1394_IsochronousCycleTimer);
  1394. if (ohci->quirks & QUIRK_CYCLE_TIMER) {
  1395. i = 0;
  1396. c1 = c2;
  1397. c2 = reg_read(ohci, OHCI1394_IsochronousCycleTimer);
  1398. do {
  1399. c0 = c1;
  1400. c1 = c2;
  1401. c2 = reg_read(ohci, OHCI1394_IsochronousCycleTimer);
  1402. t0 = cycle_timer_ticks(c0);
  1403. t1 = cycle_timer_ticks(c1);
  1404. t2 = cycle_timer_ticks(c2);
  1405. diff01 = t1 - t0;
  1406. diff12 = t2 - t1;
  1407. } while ((diff01 <= 0 || diff12 <= 0 ||
  1408. diff01 / diff12 >= 2 || diff12 / diff01 >= 2)
  1409. && i++ < 20);
  1410. }
  1411. return c2;
  1412. }
  1413. /*
  1414. * This function has to be called at least every 64 seconds. The bus_time
  1415. * field stores not only the upper 25 bits of the BUS_TIME register but also
  1416. * the most significant bit of the cycle timer in bit 6 so that we can detect
  1417. * changes in this bit.
  1418. */
  1419. static u32 update_bus_time(struct fw_ohci *ohci)
  1420. {
  1421. u32 cycle_time_seconds = get_cycle_time(ohci) >> 25;
  1422. if ((ohci->bus_time & 0x40) != (cycle_time_seconds & 0x40))
  1423. ohci->bus_time += 0x40;
  1424. return ohci->bus_time | cycle_time_seconds;
  1425. }
  1426. static void bus_reset_tasklet(unsigned long data)
  1427. {
  1428. struct fw_ohci *ohci = (struct fw_ohci *)data;
  1429. int self_id_count, i, j, reg;
  1430. int generation, new_generation;
  1431. unsigned long flags;
  1432. void *free_rom = NULL;
  1433. dma_addr_t free_rom_bus = 0;
  1434. bool is_new_root;
  1435. reg = reg_read(ohci, OHCI1394_NodeID);
  1436. if (!(reg & OHCI1394_NodeID_idValid)) {
  1437. fw_notify("node ID not valid, new bus reset in progress\n");
  1438. return;
  1439. }
  1440. if ((reg & OHCI1394_NodeID_nodeNumber) == 63) {
  1441. fw_notify("malconfigured bus\n");
  1442. return;
  1443. }
  1444. ohci->node_id = reg & (OHCI1394_NodeID_busNumber |
  1445. OHCI1394_NodeID_nodeNumber);
  1446. is_new_root = (reg & OHCI1394_NodeID_root) != 0;
  1447. if (!(ohci->is_root && is_new_root))
  1448. reg_write(ohci, OHCI1394_LinkControlSet,
  1449. OHCI1394_LinkControl_cycleMaster);
  1450. ohci->is_root = is_new_root;
  1451. reg = reg_read(ohci, OHCI1394_SelfIDCount);
  1452. if (reg & OHCI1394_SelfIDCount_selfIDError) {
  1453. fw_notify("inconsistent self IDs\n");
  1454. return;
  1455. }
  1456. /*
  1457. * The count in the SelfIDCount register is the number of
  1458. * bytes in the self ID receive buffer. Since we also receive
  1459. * the inverted quadlets and a header quadlet, we shift one
  1460. * bit extra to get the actual number of self IDs.
  1461. */
  1462. self_id_count = (reg >> 3) & 0xff;
  1463. if (self_id_count == 0 || self_id_count > 252) {
  1464. fw_notify("inconsistent self IDs\n");
  1465. return;
  1466. }
  1467. generation = (cond_le32_to_cpu(ohci->self_id_cpu[0]) >> 16) & 0xff;
  1468. rmb();
  1469. for (i = 1, j = 0; j < self_id_count; i += 2, j++) {
  1470. if (ohci->self_id_cpu[i] != ~ohci->self_id_cpu[i + 1]) {
  1471. fw_notify("inconsistent self IDs\n");
  1472. return;
  1473. }
  1474. ohci->self_id_buffer[j] =
  1475. cond_le32_to_cpu(ohci->self_id_cpu[i]);
  1476. }
  1477. rmb();
  1478. /*
  1479. * Check the consistency of the self IDs we just read. The
  1480. * problem we face is that a new bus reset can start while we
  1481. * read out the self IDs from the DMA buffer. If this happens,
  1482. * the DMA buffer will be overwritten with new self IDs and we
  1483. * will read out inconsistent data. The OHCI specification
  1484. * (section 11.2) recommends a technique similar to
  1485. * linux/seqlock.h, where we remember the generation of the
  1486. * self IDs in the buffer before reading them out and compare
  1487. * it to the current generation after reading them out. If
  1488. * the two generations match we know we have a consistent set
  1489. * of self IDs.
  1490. */
  1491. new_generation = (reg_read(ohci, OHCI1394_SelfIDCount) >> 16) & 0xff;
  1492. if (new_generation != generation) {
  1493. fw_notify("recursive bus reset detected, "
  1494. "discarding self ids\n");
  1495. return;
  1496. }
  1497. /* FIXME: Document how the locking works. */
  1498. spin_lock_irqsave(&ohci->lock, flags);
  1499. ohci->generation = -1; /* prevent AT packet queueing */
  1500. context_stop(&ohci->at_request_ctx);
  1501. context_stop(&ohci->at_response_ctx);
  1502. spin_unlock_irqrestore(&ohci->lock, flags);
  1503. /*
  1504. * Per OHCI 1.2 draft, clause 7.2.3.3, hardware may leave unsent
  1505. * packets in the AT queues and software needs to drain them.
  1506. * Some OHCI 1.1 controllers (JMicron) apparently require this too.
  1507. */
  1508. at_context_flush(&ohci->at_request_ctx);
  1509. at_context_flush(&ohci->at_response_ctx);
  1510. spin_lock_irqsave(&ohci->lock, flags);
  1511. ohci->generation = generation;
  1512. reg_write(ohci, OHCI1394_IntEventClear, OHCI1394_busReset);
  1513. if (ohci->quirks & QUIRK_RESET_PACKET)
  1514. ohci->request_generation = generation;
  1515. /*
  1516. * This next bit is unrelated to the AT context stuff but we
  1517. * have to do it under the spinlock also. If a new config rom
  1518. * was set up before this reset, the old one is now no longer
  1519. * in use and we can free it. Update the config rom pointers
  1520. * to point to the current config rom and clear the
  1521. * next_config_rom pointer so a new update can take place.
  1522. */
  1523. if (ohci->next_config_rom != NULL) {
  1524. if (ohci->next_config_rom != ohci->config_rom) {
  1525. free_rom = ohci->config_rom;
  1526. free_rom_bus = ohci->config_rom_bus;
  1527. }
  1528. ohci->config_rom = ohci->next_config_rom;
  1529. ohci->config_rom_bus = ohci->next_config_rom_bus;
  1530. ohci->next_config_rom = NULL;
  1531. /*
  1532. * Restore config_rom image and manually update
  1533. * config_rom registers. Writing the header quadlet
  1534. * will indicate that the config rom is ready, so we
  1535. * do that last.
  1536. */
  1537. reg_write(ohci, OHCI1394_BusOptions,
  1538. be32_to_cpu(ohci->config_rom[2]));
  1539. ohci->config_rom[0] = ohci->next_header;
  1540. reg_write(ohci, OHCI1394_ConfigROMhdr,
  1541. be32_to_cpu(ohci->next_header));
  1542. }
  1543. #ifdef CONFIG_FIREWIRE_OHCI_REMOTE_DMA
  1544. reg_write(ohci, OHCI1394_PhyReqFilterHiSet, ~0);
  1545. reg_write(ohci, OHCI1394_PhyReqFilterLoSet, ~0);
  1546. #endif
  1547. spin_unlock_irqrestore(&ohci->lock, flags);
  1548. if (free_rom)
  1549. dma_free_coherent(ohci->card.device, CONFIG_ROM_SIZE,
  1550. free_rom, free_rom_bus);
  1551. log_selfids(ohci->node_id, generation,
  1552. self_id_count, ohci->self_id_buffer);
  1553. fw_core_handle_bus_reset(&ohci->card, ohci->node_id, generation,
  1554. self_id_count, ohci->self_id_buffer,
  1555. ohci->csr_state_setclear_abdicate);
  1556. ohci->csr_state_setclear_abdicate = false;
  1557. }
  1558. static irqreturn_t irq_handler(int irq, void *data)
  1559. {
  1560. struct fw_ohci *ohci = data;
  1561. u32 event, iso_event;
  1562. int i;
  1563. event = reg_read(ohci, OHCI1394_IntEventClear);
  1564. if (!event || !~event)
  1565. return IRQ_NONE;
  1566. /*
  1567. * busReset and postedWriteErr must not be cleared yet
  1568. * (OHCI 1.1 clauses 7.2.3.2 and 13.2.8.1)
  1569. */
  1570. reg_write(ohci, OHCI1394_IntEventClear,
  1571. event & ~(OHCI1394_busReset | OHCI1394_postedWriteErr));
  1572. log_irqs(event);
  1573. if (event & OHCI1394_selfIDComplete)
  1574. tasklet_schedule(&ohci->bus_reset_tasklet);
  1575. if (event & OHCI1394_RQPkt)
  1576. tasklet_schedule(&ohci->ar_request_ctx.tasklet);
  1577. if (event & OHCI1394_RSPkt)
  1578. tasklet_schedule(&ohci->ar_response_ctx.tasklet);
  1579. if (event & OHCI1394_reqTxComplete)
  1580. tasklet_schedule(&ohci->at_request_ctx.tasklet);
  1581. if (event & OHCI1394_respTxComplete)
  1582. tasklet_schedule(&ohci->at_response_ctx.tasklet);
  1583. if (event & OHCI1394_isochRx) {
  1584. iso_event = reg_read(ohci, OHCI1394_IsoRecvIntEventClear);
  1585. reg_write(ohci, OHCI1394_IsoRecvIntEventClear, iso_event);
  1586. while (iso_event) {
  1587. i = ffs(iso_event) - 1;
  1588. tasklet_schedule(
  1589. &ohci->ir_context_list[i].context.tasklet);
  1590. iso_event &= ~(1 << i);
  1591. }
  1592. }
  1593. if (event & OHCI1394_isochTx) {
  1594. iso_event = reg_read(ohci, OHCI1394_IsoXmitIntEventClear);
  1595. reg_write(ohci, OHCI1394_IsoXmitIntEventClear, iso_event);
  1596. while (iso_event) {
  1597. i = ffs(iso_event) - 1;
  1598. tasklet_schedule(
  1599. &ohci->it_context_list[i].context.tasklet);
  1600. iso_event &= ~(1 << i);
  1601. }
  1602. }
  1603. if (unlikely(event & OHCI1394_regAccessFail))
  1604. fw_error("Register access failure - "
  1605. "please notify linux1394-devel@lists.sf.net\n");
  1606. if (unlikely(event & OHCI1394_postedWriteErr)) {
  1607. reg_read(ohci, OHCI1394_PostedWriteAddressHi);
  1608. reg_read(ohci, OHCI1394_PostedWriteAddressLo);
  1609. reg_write(ohci, OHCI1394_IntEventClear,
  1610. OHCI1394_postedWriteErr);
  1611. fw_error("PCI posted write error\n");
  1612. }
  1613. if (unlikely(event & OHCI1394_cycleTooLong)) {
  1614. if (printk_ratelimit())
  1615. fw_notify("isochronous cycle too long\n");
  1616. reg_write(ohci, OHCI1394_LinkControlSet,
  1617. OHCI1394_LinkControl_cycleMaster);
  1618. }
  1619. if (unlikely(event & OHCI1394_cycleInconsistent)) {
  1620. /*
  1621. * We need to clear this event bit in order to make
  1622. * cycleMatch isochronous I/O work. In theory we should
  1623. * stop active cycleMatch iso contexts now and restart
  1624. * them at least two cycles later. (FIXME?)
  1625. */
  1626. if (printk_ratelimit())
  1627. fw_notify("isochronous cycle inconsistent\n");
  1628. }
  1629. if (unlikely(event & OHCI1394_unrecoverableError))
  1630. handle_dead_contexts(ohci);
  1631. if (event & OHCI1394_cycle64Seconds) {
  1632. spin_lock(&ohci->lock);
  1633. update_bus_time(ohci);
  1634. spin_unlock(&ohci->lock);
  1635. } else
  1636. flush_writes(ohci);
  1637. return IRQ_HANDLED;
  1638. }
  1639. static int software_reset(struct fw_ohci *ohci)
  1640. {
  1641. int i;
  1642. reg_write(ohci, OHCI1394_HCControlSet, OHCI1394_HCControl_softReset);
  1643. for (i = 0; i < OHCI_LOOP_COUNT; i++) {
  1644. if ((reg_read(ohci, OHCI1394_HCControlSet) &
  1645. OHCI1394_HCControl_softReset) == 0)
  1646. return 0;
  1647. msleep(1);
  1648. }
  1649. return -EBUSY;
  1650. }
  1651. static void copy_config_rom(__be32 *dest, const __be32 *src, size_t length)
  1652. {
  1653. size_t size = length * 4;
  1654. memcpy(dest, src, size);
  1655. if (size < CONFIG_ROM_SIZE)
  1656. memset(&dest[length], 0, CONFIG_ROM_SIZE - size);
  1657. }
  1658. static int configure_1394a_enhancements(struct fw_ohci *ohci)
  1659. {
  1660. bool enable_1394a;
  1661. int ret, clear, set, offset;
  1662. /* Check if the driver should configure link and PHY. */
  1663. if (!(reg_read(ohci, OHCI1394_HCControlSet) &
  1664. OHCI1394_HCControl_programPhyEnable))
  1665. return 0;
  1666. /* Paranoia: check whether the PHY supports 1394a, too. */
  1667. enable_1394a = false;
  1668. ret = read_phy_reg(ohci, 2);
  1669. if (ret < 0)
  1670. return ret;
  1671. if ((ret & PHY_EXTENDED_REGISTERS) == PHY_EXTENDED_REGISTERS) {
  1672. ret = read_paged_phy_reg(ohci, 1, 8);
  1673. if (ret < 0)
  1674. return ret;
  1675. if (ret >= 1)
  1676. enable_1394a = true;
  1677. }
  1678. if (ohci->quirks & QUIRK_NO_1394A)
  1679. enable_1394a = false;
  1680. /* Configure PHY and link consistently. */
  1681. if (enable_1394a) {
  1682. clear = 0;
  1683. set = PHY_ENABLE_ACCEL | PHY_ENABLE_MULTI;
  1684. } else {
  1685. clear = PHY_ENABLE_ACCEL | PHY_ENABLE_MULTI;
  1686. set = 0;
  1687. }
  1688. ret = update_phy_reg(ohci, 5, clear, set);
  1689. if (ret < 0)
  1690. return ret;
  1691. if (enable_1394a)
  1692. offset = OHCI1394_HCControlSet;
  1693. else
  1694. offset = OHCI1394_HCControlClear;
  1695. reg_write(ohci, offset, OHCI1394_HCControl_aPhyEnhanceEnable);
  1696. /* Clean up: configuration has been taken care of. */
  1697. reg_write(ohci, OHCI1394_HCControlClear,
  1698. OHCI1394_HCControl_programPhyEnable);
  1699. return 0;
  1700. }
  1701. static int ohci_enable(struct fw_card *card,
  1702. const __be32 *config_rom, size_t length)
  1703. {
  1704. struct fw_ohci *ohci = fw_ohci(card);
  1705. struct pci_dev *dev = to_pci_dev(card->device);
  1706. u32 lps, seconds, version, irqs;
  1707. int i, ret;
  1708. if (software_reset(ohci)) {
  1709. fw_error("Failed to reset ohci card.\n");
  1710. return -EBUSY;
  1711. }
  1712. /*
  1713. * Now enable LPS, which we need in order to start accessing
  1714. * most of the registers. In fact, on some cards (ALI M5251),
  1715. * accessing registers in the SClk domain without LPS enabled
  1716. * will lock up the machine. Wait 50msec to make sure we have
  1717. * full link enabled. However, with some cards (well, at least
  1718. * a JMicron PCIe card), we have to try again sometimes.
  1719. */
  1720. reg_write(ohci, OHCI1394_HCControlSet,
  1721. OHCI1394_HCControl_LPS |
  1722. OHCI1394_HCControl_postedWriteEnable);
  1723. flush_writes(ohci);
  1724. for (lps = 0, i = 0; !lps && i < 3; i++) {
  1725. msleep(50);
  1726. lps = reg_read(ohci, OHCI1394_HCControlSet) &
  1727. OHCI1394_HCControl_LPS;
  1728. }
  1729. if (!lps) {
  1730. fw_error("Failed to set Link Power Status\n");
  1731. return -EIO;
  1732. }
  1733. reg_write(ohci, OHCI1394_HCControlClear,
  1734. OHCI1394_HCControl_noByteSwapData);
  1735. reg_write(ohci, OHCI1394_SelfIDBuffer, ohci->self_id_bus);
  1736. reg_write(ohci, OHCI1394_LinkControlSet,
  1737. OHCI1394_LinkControl_cycleTimerEnable |
  1738. OHCI1394_LinkControl_cycleMaster);
  1739. reg_write(ohci, OHCI1394_ATRetries,
  1740. OHCI1394_MAX_AT_REQ_RETRIES |
  1741. (OHCI1394_MAX_AT_RESP_RETRIES << 4) |
  1742. (OHCI1394_MAX_PHYS_RESP_RETRIES << 8) |
  1743. (200 << 16));
  1744. seconds = lower_32_bits(get_seconds());
  1745. reg_write(ohci, OHCI1394_IsochronousCycleTimer, seconds << 25);
  1746. ohci->bus_time = seconds & ~0x3f;
  1747. version = reg_read(ohci, OHCI1394_Version) & 0x00ff00ff;
  1748. if (version >= OHCI_VERSION_1_1) {
  1749. reg_write(ohci, OHCI1394_InitialChannelsAvailableHi,
  1750. 0xfffffffe);
  1751. card->broadcast_channel_auto_allocated = true;
  1752. }
  1753. /* Get implemented bits of the priority arbitration request counter. */
  1754. reg_write(ohci, OHCI1394_FairnessControl, 0x3f);
  1755. ohci->pri_req_max = reg_read(ohci, OHCI1394_FairnessControl) & 0x3f;
  1756. reg_write(ohci, OHCI1394_FairnessControl, 0);
  1757. card->priority_budget_implemented = ohci->pri_req_max != 0;
  1758. reg_write(ohci, OHCI1394_PhyUpperBound, 0x00010000);
  1759. reg_write(ohci, OHCI1394_IntEventClear, ~0);
  1760. reg_write(ohci, OHCI1394_IntMaskClear, ~0);
  1761. ret = configure_1394a_enhancements(ohci);
  1762. if (ret < 0)
  1763. return ret;
  1764. /* Activate link_on bit and contender bit in our self ID packets.*/
  1765. ret = ohci_update_phy_reg(card, 4, 0, PHY_LINK_ACTIVE | PHY_CONTENDER);
  1766. if (ret < 0)
  1767. return ret;
  1768. /*
  1769. * When the link is not yet enabled, the atomic config rom
  1770. * update mechanism described below in ohci_set_config_rom()
  1771. * is not active. We have to update ConfigRomHeader and
  1772. * BusOptions manually, and the write to ConfigROMmap takes
  1773. * effect immediately. We tie this to the enabling of the
  1774. * link, so we have a valid config rom before enabling - the
  1775. * OHCI requires that ConfigROMhdr and BusOptions have valid
  1776. * values before enabling.
  1777. *
  1778. * However, when the ConfigROMmap is written, some controllers
  1779. * always read back quadlets 0 and 2 from the config rom to
  1780. * the ConfigRomHeader and BusOptions registers on bus reset.
  1781. * They shouldn't do that in this initial case where the link
  1782. * isn't enabled. This means we have to use the same
  1783. * workaround here, setting the bus header to 0 and then write
  1784. * the right values in the bus reset tasklet.
  1785. */
  1786. if (config_rom) {
  1787. ohci->next_config_rom =
  1788. dma_alloc_coherent(ohci->card.device, CONFIG_ROM_SIZE,
  1789. &ohci->next_config_rom_bus,
  1790. GFP_KERNEL);
  1791. if (ohci->next_config_rom == NULL)
  1792. return -ENOMEM;
  1793. copy_config_rom(ohci->next_config_rom, config_rom, length);
  1794. } else {
  1795. /*
  1796. * In the suspend case, config_rom is NULL, which
  1797. * means that we just reuse the old config rom.
  1798. */
  1799. ohci->next_config_rom = ohci->config_rom;
  1800. ohci->next_config_rom_bus = ohci->config_rom_bus;
  1801. }
  1802. ohci->next_header = ohci->next_config_rom[0];
  1803. ohci->next_config_rom[0] = 0;
  1804. reg_write(ohci, OHCI1394_ConfigROMhdr, 0);
  1805. reg_write(ohci, OHCI1394_BusOptions,
  1806. be32_to_cpu(ohci->next_config_rom[2]));
  1807. reg_write(ohci, OHCI1394_ConfigROMmap, ohci->next_config_rom_bus);
  1808. reg_write(ohci, OHCI1394_AsReqFilterHiSet, 0x80000000);
  1809. if (!(ohci->quirks & QUIRK_NO_MSI))
  1810. pci_enable_msi(dev);
  1811. if (request_irq(dev->irq, irq_handler,
  1812. pci_dev_msi_enabled(dev) ? 0 : IRQF_SHARED,
  1813. ohci_driver_name, ohci)) {
  1814. fw_error("Failed to allocate interrupt %d.\n", dev->irq);
  1815. pci_disable_msi(dev);
  1816. dma_free_coherent(ohci->card.device, CONFIG_ROM_SIZE,
  1817. ohci->config_rom, ohci->config_rom_bus);
  1818. return -EIO;
  1819. }
  1820. irqs = OHCI1394_reqTxComplete | OHCI1394_respTxComplete |
  1821. OHCI1394_RQPkt | OHCI1394_RSPkt |
  1822. OHCI1394_isochTx | OHCI1394_isochRx |
  1823. OHCI1394_postedWriteErr |
  1824. OHCI1394_selfIDComplete |
  1825. OHCI1394_regAccessFail |
  1826. OHCI1394_cycle64Seconds |
  1827. OHCI1394_cycleInconsistent |
  1828. OHCI1394_unrecoverableError |
  1829. OHCI1394_cycleTooLong |
  1830. OHCI1394_masterIntEnable;
  1831. if (param_debug & OHCI_PARAM_DEBUG_BUSRESETS)
  1832. irqs |= OHCI1394_busReset;
  1833. reg_write(ohci, OHCI1394_IntMaskSet, irqs);
  1834. reg_write(ohci, OHCI1394_HCControlSet,
  1835. OHCI1394_HCControl_linkEnable |
  1836. OHCI1394_HCControl_BIBimageValid);
  1837. reg_write(ohci, OHCI1394_LinkControlSet,
  1838. OHCI1394_LinkControl_rcvSelfID |
  1839. OHCI1394_LinkControl_rcvPhyPkt);
  1840. ar_context_run(&ohci->ar_request_ctx);
  1841. ar_context_run(&ohci->ar_response_ctx);
  1842. flush_writes(ohci);
  1843. /* We are ready to go, reset bus to finish initialization. */
  1844. fw_schedule_bus_reset(&ohci->card, false, true);
  1845. return 0;
  1846. }
  1847. static int ohci_set_config_rom(struct fw_card *card,
  1848. const __be32 *config_rom, size_t length)
  1849. {
  1850. struct fw_ohci *ohci;
  1851. unsigned long flags;
  1852. __be32 *next_config_rom;
  1853. dma_addr_t uninitialized_var(next_config_rom_bus);
  1854. ohci = fw_ohci(card);
  1855. /*
  1856. * When the OHCI controller is enabled, the config rom update
  1857. * mechanism is a bit tricky, but easy enough to use. See
  1858. * section 5.5.6 in the OHCI specification.
  1859. *
  1860. * The OHCI controller caches the new config rom address in a
  1861. * shadow register (ConfigROMmapNext) and needs a bus reset
  1862. * for the changes to take place. When the bus reset is
  1863. * detected, the controller loads the new values for the
  1864. * ConfigRomHeader and BusOptions registers from the specified
  1865. * config rom and loads ConfigROMmap from the ConfigROMmapNext
  1866. * shadow register. All automatically and atomically.
  1867. *
  1868. * Now, there's a twist to this story. The automatic load of
  1869. * ConfigRomHeader and BusOptions doesn't honor the
  1870. * noByteSwapData bit, so with a be32 config rom, the
  1871. * controller will load be32 values in to these registers
  1872. * during the atomic update, even on litte endian
  1873. * architectures. The workaround we use is to put a 0 in the
  1874. * header quadlet; 0 is endian agnostic and means that the
  1875. * config rom isn't ready yet. In the bus reset tasklet we
  1876. * then set up the real values for the two registers.
  1877. *
  1878. * We use ohci->lock to avoid racing with the code that sets
  1879. * ohci->next_config_rom to NULL (see bus_reset_tasklet).
  1880. */
  1881. next_config_rom =
  1882. dma_alloc_coherent(ohci->card.device, CONFIG_ROM_SIZE,
  1883. &next_config_rom_bus, GFP_KERNEL);
  1884. if (next_config_rom == NULL)
  1885. return -ENOMEM;
  1886. spin_lock_irqsave(&ohci->lock, flags);
  1887. /*
  1888. * If there is not an already pending config_rom update,
  1889. * push our new allocation into the ohci->next_config_rom
  1890. * and then mark the local variable as null so that we
  1891. * won't deallocate the new buffer.
  1892. *
  1893. * OTOH, if there is a pending config_rom update, just
  1894. * use that buffer with the new config_rom data, and
  1895. * let this routine free the unused DMA allocation.
  1896. */
  1897. if (ohci->next_config_rom == NULL) {
  1898. ohci->next_config_rom = next_config_rom;
  1899. ohci->next_config_rom_bus = next_config_rom_bus;
  1900. next_config_rom = NULL;
  1901. }
  1902. copy_config_rom(ohci->next_config_rom, config_rom, length);
  1903. ohci->next_header = config_rom[0];
  1904. ohci->next_config_rom[0] = 0;
  1905. reg_write(ohci, OHCI1394_ConfigROMmap, ohci->next_config_rom_bus);
  1906. spin_unlock_irqrestore(&ohci->lock, flags);
  1907. /* If we didn't use the DMA allocation, delete it. */
  1908. if (next_config_rom != NULL)
  1909. dma_free_coherent(ohci->card.device, CONFIG_ROM_SIZE,
  1910. next_config_rom, next_config_rom_bus);
  1911. /*
  1912. * Now initiate a bus reset to have the changes take
  1913. * effect. We clean up the old config rom memory and DMA
  1914. * mappings in the bus reset tasklet, since the OHCI
  1915. * controller could need to access it before the bus reset
  1916. * takes effect.
  1917. */
  1918. fw_schedule_bus_reset(&ohci->card, true, true);
  1919. return 0;
  1920. }
  1921. static void ohci_send_request(struct fw_card *card, struct fw_packet *packet)
  1922. {
  1923. struct fw_ohci *ohci = fw_ohci(card);
  1924. at_context_transmit(&ohci->at_request_ctx, packet);
  1925. }
  1926. static void ohci_send_response(struct fw_card *card, struct fw_packet *packet)
  1927. {
  1928. struct fw_ohci *ohci = fw_ohci(card);
  1929. at_context_transmit(&ohci->at_response_ctx, packet);
  1930. }
  1931. static int ohci_cancel_packet(struct fw_card *card, struct fw_packet *packet)
  1932. {
  1933. struct fw_ohci *ohci = fw_ohci(card);
  1934. struct context *ctx = &ohci->at_request_ctx;
  1935. struct driver_data *driver_data = packet->driver_data;
  1936. int ret = -ENOENT;
  1937. tasklet_disable(&ctx->tasklet);
  1938. if (packet->ack != 0)
  1939. goto out;
  1940. if (packet->payload_mapped)
  1941. dma_unmap_single(ohci->card.device, packet->payload_bus,
  1942. packet->payload_length, DMA_TO_DEVICE);
  1943. log_ar_at_event('T', packet->speed, packet->header, 0x20);
  1944. driver_data->packet = NULL;
  1945. packet->ack = RCODE_CANCELLED;
  1946. packet->callback(packet, &ohci->card, packet->ack);
  1947. ret = 0;
  1948. out:
  1949. tasklet_enable(&ctx->tasklet);
  1950. return ret;
  1951. }
  1952. static int ohci_enable_phys_dma(struct fw_card *card,
  1953. int node_id, int generation)
  1954. {
  1955. #ifdef CONFIG_FIREWIRE_OHCI_REMOTE_DMA
  1956. return 0;
  1957. #else
  1958. struct fw_ohci *ohci = fw_ohci(card);
  1959. unsigned long flags;
  1960. int n, ret = 0;
  1961. /*
  1962. * FIXME: Make sure this bitmask is cleared when we clear the busReset
  1963. * interrupt bit. Clear physReqResourceAllBuses on bus reset.
  1964. */
  1965. spin_lock_irqsave(&ohci->lock, flags);
  1966. if (ohci->generation != generation) {
  1967. ret = -ESTALE;
  1968. goto out;
  1969. }
  1970. /*
  1971. * Note, if the node ID contains a non-local bus ID, physical DMA is
  1972. * enabled for _all_ nodes on remote buses.
  1973. */
  1974. n = (node_id & 0xffc0) == LOCAL_BUS ? node_id & 0x3f : 63;
  1975. if (n < 32)
  1976. reg_write(ohci, OHCI1394_PhyReqFilterLoSet, 1 << n);
  1977. else
  1978. reg_write(ohci, OHCI1394_PhyReqFilterHiSet, 1 << (n - 32));
  1979. flush_writes(ohci);
  1980. out:
  1981. spin_unlock_irqrestore(&ohci->lock, flags);
  1982. return ret;
  1983. #endif /* CONFIG_FIREWIRE_OHCI_REMOTE_DMA */
  1984. }
  1985. static u32 ohci_read_csr(struct fw_card *card, int csr_offset)
  1986. {
  1987. struct fw_ohci *ohci = fw_ohci(card);
  1988. unsigned long flags;
  1989. u32 value;
  1990. switch (csr_offset) {
  1991. case CSR_STATE_CLEAR:
  1992. case CSR_STATE_SET:
  1993. if (ohci->is_root &&
  1994. (reg_read(ohci, OHCI1394_LinkControlSet) &
  1995. OHCI1394_LinkControl_cycleMaster))
  1996. value = CSR_STATE_BIT_CMSTR;
  1997. else
  1998. value = 0;
  1999. if (ohci->csr_state_setclear_abdicate)
  2000. value |= CSR_STATE_BIT_ABDICATE;
  2001. return value;
  2002. case CSR_NODE_IDS:
  2003. return reg_read(ohci, OHCI1394_NodeID) << 16;
  2004. case CSR_CYCLE_TIME:
  2005. return get_cycle_time(ohci);
  2006. case CSR_BUS_TIME:
  2007. /*
  2008. * We might be called just after the cycle timer has wrapped
  2009. * around but just before the cycle64Seconds handler, so we
  2010. * better check here, too, if the bus time needs to be updated.
  2011. */
  2012. spin_lock_irqsave(&ohci->lock, flags);
  2013. value = update_bus_time(ohci);
  2014. spin_unlock_irqrestore(&ohci->lock, flags);
  2015. return value;
  2016. case CSR_BUSY_TIMEOUT:
  2017. value = reg_read(ohci, OHCI1394_ATRetries);
  2018. return (value >> 4) & 0x0ffff00f;
  2019. case CSR_PRIORITY_BUDGET:
  2020. return (reg_read(ohci, OHCI1394_FairnessControl) & 0x3f) |
  2021. (ohci->pri_req_max << 8);
  2022. default:
  2023. WARN_ON(1);
  2024. return 0;
  2025. }
  2026. }
  2027. static void ohci_write_csr(struct fw_card *card, int csr_offset, u32 value)
  2028. {
  2029. struct fw_ohci *ohci = fw_ohci(card);
  2030. unsigned long flags;
  2031. switch (csr_offset) {
  2032. case CSR_STATE_CLEAR:
  2033. if ((value & CSR_STATE_BIT_CMSTR) && ohci->is_root) {
  2034. reg_write(ohci, OHCI1394_LinkControlClear,
  2035. OHCI1394_LinkControl_cycleMaster);
  2036. flush_writes(ohci);
  2037. }
  2038. if (value & CSR_STATE_BIT_ABDICATE)
  2039. ohci->csr_state_setclear_abdicate = false;
  2040. break;
  2041. case CSR_STATE_SET:
  2042. if ((value & CSR_STATE_BIT_CMSTR) && ohci->is_root) {
  2043. reg_write(ohci, OHCI1394_LinkControlSet,
  2044. OHCI1394_LinkControl_cycleMaster);
  2045. flush_writes(ohci);
  2046. }
  2047. if (value & CSR_STATE_BIT_ABDICATE)
  2048. ohci->csr_state_setclear_abdicate = true;
  2049. break;
  2050. case CSR_NODE_IDS:
  2051. reg_write(ohci, OHCI1394_NodeID, value >> 16);
  2052. flush_writes(ohci);
  2053. break;
  2054. case CSR_CYCLE_TIME:
  2055. reg_write(ohci, OHCI1394_IsochronousCycleTimer, value);
  2056. reg_write(ohci, OHCI1394_IntEventSet,
  2057. OHCI1394_cycleInconsistent);
  2058. flush_writes(ohci);
  2059. break;
  2060. case CSR_BUS_TIME:
  2061. spin_lock_irqsave(&ohci->lock, flags);
  2062. ohci->bus_time = (ohci->bus_time & 0x7f) | (value & ~0x7f);
  2063. spin_unlock_irqrestore(&ohci->lock, flags);
  2064. break;
  2065. case CSR_BUSY_TIMEOUT:
  2066. value = (value & 0xf) | ((value & 0xf) << 4) |
  2067. ((value & 0xf) << 8) | ((value & 0x0ffff000) << 4);
  2068. reg_write(ohci, OHCI1394_ATRetries, value);
  2069. flush_writes(ohci);
  2070. break;
  2071. case CSR_PRIORITY_BUDGET:
  2072. reg_write(ohci, OHCI1394_FairnessControl, value & 0x3f);
  2073. flush_writes(ohci);
  2074. break;
  2075. default:
  2076. WARN_ON(1);
  2077. break;
  2078. }
  2079. }
  2080. static void copy_iso_headers(struct iso_context *ctx, void *p)
  2081. {
  2082. int i = ctx->header_length;
  2083. if (i + ctx->base.header_size > PAGE_SIZE)
  2084. return;
  2085. /*
  2086. * The iso header is byteswapped to little endian by
  2087. * the controller, but the remaining header quadlets
  2088. * are big endian. We want to present all the headers
  2089. * as big endian, so we have to swap the first quadlet.
  2090. */
  2091. if (ctx->base.header_size > 0)
  2092. *(u32 *) (ctx->header + i) = __swab32(*(u32 *) (p + 4));
  2093. if (ctx->base.header_size > 4)
  2094. *(u32 *) (ctx->header + i + 4) = __swab32(*(u32 *) p);
  2095. if (ctx->base.header_size > 8)
  2096. memcpy(ctx->header + i + 8, p + 8, ctx->base.header_size - 8);
  2097. ctx->header_length += ctx->base.header_size;
  2098. }
  2099. static int handle_ir_packet_per_buffer(struct context *context,
  2100. struct descriptor *d,
  2101. struct descriptor *last)
  2102. {
  2103. struct iso_context *ctx =
  2104. container_of(context, struct iso_context, context);
  2105. struct descriptor *pd;
  2106. __le32 *ir_header;
  2107. void *p;
  2108. for (pd = d; pd <= last; pd++)
  2109. if (pd->transfer_status)
  2110. break;
  2111. if (pd > last)
  2112. /* Descriptor(s) not done yet, stop iteration */
  2113. return 0;
  2114. p = last + 1;
  2115. copy_iso_headers(ctx, p);
  2116. if (le16_to_cpu(last->control) & DESCRIPTOR_IRQ_ALWAYS) {
  2117. ir_header = (__le32 *) p;
  2118. ctx->base.callback.sc(&ctx->base,
  2119. le32_to_cpu(ir_header[0]) & 0xffff,
  2120. ctx->header_length, ctx->header,
  2121. ctx->base.callback_data);
  2122. ctx->header_length = 0;
  2123. }
  2124. return 1;
  2125. }
  2126. /* d == last because each descriptor block is only a single descriptor. */
  2127. static int handle_ir_buffer_fill(struct context *context,
  2128. struct descriptor *d,
  2129. struct descriptor *last)
  2130. {
  2131. struct iso_context *ctx =
  2132. container_of(context, struct iso_context, context);
  2133. if (!last->transfer_status)
  2134. /* Descriptor(s) not done yet, stop iteration */
  2135. return 0;
  2136. if (le16_to_cpu(last->control) & DESCRIPTOR_IRQ_ALWAYS)
  2137. ctx->base.callback.mc(&ctx->base,
  2138. le32_to_cpu(last->data_address) +
  2139. le16_to_cpu(last->req_count) -
  2140. le16_to_cpu(last->res_count),
  2141. ctx->base.callback_data);
  2142. return 1;
  2143. }
  2144. static int handle_it_packet(struct context *context,
  2145. struct descriptor *d,
  2146. struct descriptor *last)
  2147. {
  2148. struct iso_context *ctx =
  2149. container_of(context, struct iso_context, context);
  2150. int i;
  2151. struct descriptor *pd;
  2152. for (pd = d; pd <= last; pd++)
  2153. if (pd->transfer_status)
  2154. break;
  2155. if (pd > last)
  2156. /* Descriptor(s) not done yet, stop iteration */
  2157. return 0;
  2158. i = ctx->header_length;
  2159. if (i + 4 < PAGE_SIZE) {
  2160. /* Present this value as big-endian to match the receive code */
  2161. *(__be32 *)(ctx->header + i) = cpu_to_be32(
  2162. ((u32)le16_to_cpu(pd->transfer_status) << 16) |
  2163. le16_to_cpu(pd->res_count));
  2164. ctx->header_length += 4;
  2165. }
  2166. if (le16_to_cpu(last->control) & DESCRIPTOR_IRQ_ALWAYS) {
  2167. ctx->base.callback.sc(&ctx->base, le16_to_cpu(last->res_count),
  2168. ctx->header_length, ctx->header,
  2169. ctx->base.callback_data);
  2170. ctx->header_length = 0;
  2171. }
  2172. return 1;
  2173. }
  2174. static void set_multichannel_mask(struct fw_ohci *ohci, u64 channels)
  2175. {
  2176. u32 hi = channels >> 32, lo = channels;
  2177. reg_write(ohci, OHCI1394_IRMultiChanMaskHiClear, ~hi);
  2178. reg_write(ohci, OHCI1394_IRMultiChanMaskLoClear, ~lo);
  2179. reg_write(ohci, OHCI1394_IRMultiChanMaskHiSet, hi);
  2180. reg_write(ohci, OHCI1394_IRMultiChanMaskLoSet, lo);
  2181. mmiowb();
  2182. ohci->mc_channels = channels;
  2183. }
  2184. static struct fw_iso_context *ohci_allocate_iso_context(struct fw_card *card,
  2185. int type, int channel, size_t header_size)
  2186. {
  2187. struct fw_ohci *ohci = fw_ohci(card);
  2188. struct iso_context *uninitialized_var(ctx);
  2189. descriptor_callback_t uninitialized_var(callback);
  2190. u64 *uninitialized_var(channels);
  2191. u32 *uninitialized_var(mask), uninitialized_var(regs);
  2192. unsigned long flags;
  2193. int index, ret = -EBUSY;
  2194. spin_lock_irqsave(&ohci->lock, flags);
  2195. switch (type) {
  2196. case FW_ISO_CONTEXT_TRANSMIT:
  2197. mask = &ohci->it_context_mask;
  2198. callback = handle_it_packet;
  2199. index = ffs(*mask) - 1;
  2200. if (index >= 0) {
  2201. *mask &= ~(1 << index);
  2202. regs = OHCI1394_IsoXmitContextBase(index);
  2203. ctx = &ohci->it_context_list[index];
  2204. }
  2205. break;
  2206. case FW_ISO_CONTEXT_RECEIVE:
  2207. channels = &ohci->ir_context_channels;
  2208. mask = &ohci->ir_context_mask;
  2209. callback = handle_ir_packet_per_buffer;
  2210. index = *channels & 1ULL << channel ? ffs(*mask) - 1 : -1;
  2211. if (index >= 0) {
  2212. *channels &= ~(1ULL << channel);
  2213. *mask &= ~(1 << index);
  2214. regs = OHCI1394_IsoRcvContextBase(index);
  2215. ctx = &ohci->ir_context_list[index];
  2216. }
  2217. break;
  2218. case FW_ISO_CONTEXT_RECEIVE_MULTICHANNEL:
  2219. mask = &ohci->ir_context_mask;
  2220. callback = handle_ir_buffer_fill;
  2221. index = !ohci->mc_allocated ? ffs(*mask) - 1 : -1;
  2222. if (index >= 0) {
  2223. ohci->mc_allocated = true;
  2224. *mask &= ~(1 << index);
  2225. regs = OHCI1394_IsoRcvContextBase(index);
  2226. ctx = &ohci->ir_context_list[index];
  2227. }
  2228. break;
  2229. default:
  2230. index = -1;
  2231. ret = -ENOSYS;
  2232. }
  2233. spin_unlock_irqrestore(&ohci->lock, flags);
  2234. if (index < 0)
  2235. return ERR_PTR(ret);
  2236. memset(ctx, 0, sizeof(*ctx));
  2237. ctx->header_length = 0;
  2238. ctx->header = (void *) __get_free_page(GFP_KERNEL);
  2239. if (ctx->header == NULL) {
  2240. ret = -ENOMEM;
  2241. goto out;
  2242. }
  2243. ret = context_init(&ctx->context, ohci, regs, callback);
  2244. if (ret < 0)
  2245. goto out_with_header;
  2246. if (type == FW_ISO_CONTEXT_RECEIVE_MULTICHANNEL)
  2247. set_multichannel_mask(ohci, 0);
  2248. return &ctx->base;
  2249. out_with_header:
  2250. free_page((unsigned long)ctx->header);
  2251. out:
  2252. spin_lock_irqsave(&ohci->lock, flags);
  2253. switch (type) {
  2254. case FW_ISO_CONTEXT_RECEIVE:
  2255. *channels |= 1ULL << channel;
  2256. break;
  2257. case FW_ISO_CONTEXT_RECEIVE_MULTICHANNEL:
  2258. ohci->mc_allocated = false;
  2259. break;
  2260. }
  2261. *mask |= 1 << index;
  2262. spin_unlock_irqrestore(&ohci->lock, flags);
  2263. return ERR_PTR(ret);
  2264. }
  2265. static int ohci_start_iso(struct fw_iso_context *base,
  2266. s32 cycle, u32 sync, u32 tags)
  2267. {
  2268. struct iso_context *ctx = container_of(base, struct iso_context, base);
  2269. struct fw_ohci *ohci = ctx->context.ohci;
  2270. u32 control = IR_CONTEXT_ISOCH_HEADER, match;
  2271. int index;
  2272. /* the controller cannot start without any queued packets */
  2273. if (ctx->context.last->branch_address == 0)
  2274. return -ENODATA;
  2275. switch (ctx->base.type) {
  2276. case FW_ISO_CONTEXT_TRANSMIT:
  2277. index = ctx - ohci->it_context_list;
  2278. match = 0;
  2279. if (cycle >= 0)
  2280. match = IT_CONTEXT_CYCLE_MATCH_ENABLE |
  2281. (cycle & 0x7fff) << 16;
  2282. reg_write(ohci, OHCI1394_IsoXmitIntEventClear, 1 << index);
  2283. reg_write(ohci, OHCI1394_IsoXmitIntMaskSet, 1 << index);
  2284. context_run(&ctx->context, match);
  2285. break;
  2286. case FW_ISO_CONTEXT_RECEIVE_MULTICHANNEL:
  2287. control |= IR_CONTEXT_BUFFER_FILL|IR_CONTEXT_MULTI_CHANNEL_MODE;
  2288. /* fall through */
  2289. case FW_ISO_CONTEXT_RECEIVE:
  2290. index = ctx - ohci->ir_context_list;
  2291. match = (tags << 28) | (sync << 8) | ctx->base.channel;
  2292. if (cycle >= 0) {
  2293. match |= (cycle & 0x07fff) << 12;
  2294. control |= IR_CONTEXT_CYCLE_MATCH_ENABLE;
  2295. }
  2296. reg_write(ohci, OHCI1394_IsoRecvIntEventClear, 1 << index);
  2297. reg_write(ohci, OHCI1394_IsoRecvIntMaskSet, 1 << index);
  2298. reg_write(ohci, CONTEXT_MATCH(ctx->context.regs), match);
  2299. context_run(&ctx->context, control);
  2300. ctx->sync = sync;
  2301. ctx->tags = tags;
  2302. break;
  2303. }
  2304. return 0;
  2305. }
  2306. static int ohci_stop_iso(struct fw_iso_context *base)
  2307. {
  2308. struct fw_ohci *ohci = fw_ohci(base->card);
  2309. struct iso_context *ctx = container_of(base, struct iso_context, base);
  2310. int index;
  2311. switch (ctx->base.type) {
  2312. case FW_ISO_CONTEXT_TRANSMIT:
  2313. index = ctx - ohci->it_context_list;
  2314. reg_write(ohci, OHCI1394_IsoXmitIntMaskClear, 1 << index);
  2315. break;
  2316. case FW_ISO_CONTEXT_RECEIVE:
  2317. case FW_ISO_CONTEXT_RECEIVE_MULTICHANNEL:
  2318. index = ctx - ohci->ir_context_list;
  2319. reg_write(ohci, OHCI1394_IsoRecvIntMaskClear, 1 << index);
  2320. break;
  2321. }
  2322. flush_writes(ohci);
  2323. context_stop(&ctx->context);
  2324. tasklet_kill(&ctx->context.tasklet);
  2325. return 0;
  2326. }
  2327. static void ohci_free_iso_context(struct fw_iso_context *base)
  2328. {
  2329. struct fw_ohci *ohci = fw_ohci(base->card);
  2330. struct iso_context *ctx = container_of(base, struct iso_context, base);
  2331. unsigned long flags;
  2332. int index;
  2333. ohci_stop_iso(base);
  2334. context_release(&ctx->context);
  2335. free_page((unsigned long)ctx->header);
  2336. spin_lock_irqsave(&ohci->lock, flags);
  2337. switch (base->type) {
  2338. case FW_ISO_CONTEXT_TRANSMIT:
  2339. index = ctx - ohci->it_context_list;
  2340. ohci->it_context_mask |= 1 << index;
  2341. break;
  2342. case FW_ISO_CONTEXT_RECEIVE:
  2343. index = ctx - ohci->ir_context_list;
  2344. ohci->ir_context_mask |= 1 << index;
  2345. ohci->ir_context_channels |= 1ULL << base->channel;
  2346. break;
  2347. case FW_ISO_CONTEXT_RECEIVE_MULTICHANNEL:
  2348. index = ctx - ohci->ir_context_list;
  2349. ohci->ir_context_mask |= 1 << index;
  2350. ohci->ir_context_channels |= ohci->mc_channels;
  2351. ohci->mc_channels = 0;
  2352. ohci->mc_allocated = false;
  2353. break;
  2354. }
  2355. spin_unlock_irqrestore(&ohci->lock, flags);
  2356. }
  2357. static int ohci_set_iso_channels(struct fw_iso_context *base, u64 *channels)
  2358. {
  2359. struct fw_ohci *ohci = fw_ohci(base->card);
  2360. unsigned long flags;
  2361. int ret;
  2362. switch (base->type) {
  2363. case FW_ISO_CONTEXT_RECEIVE_MULTICHANNEL:
  2364. spin_lock_irqsave(&ohci->lock, flags);
  2365. /* Don't allow multichannel to grab other contexts' channels. */
  2366. if (~ohci->ir_context_channels & ~ohci->mc_channels & *channels) {
  2367. *channels = ohci->ir_context_channels;
  2368. ret = -EBUSY;
  2369. } else {
  2370. set_multichannel_mask(ohci, *channels);
  2371. ret = 0;
  2372. }
  2373. spin_unlock_irqrestore(&ohci->lock, flags);
  2374. break;
  2375. default:
  2376. ret = -EINVAL;
  2377. }
  2378. return ret;
  2379. }
  2380. #ifdef CONFIG_PM
  2381. static void ohci_resume_iso_dma(struct fw_ohci *ohci)
  2382. {
  2383. int i;
  2384. struct iso_context *ctx;
  2385. for (i = 0 ; i < ohci->n_ir ; i++) {
  2386. ctx = &ohci->ir_context_list[i];
  2387. if (ctx->context.running)
  2388. ohci_start_iso(&ctx->base, 0, ctx->sync, ctx->tags);
  2389. }
  2390. for (i = 0 ; i < ohci->n_it ; i++) {
  2391. ctx = &ohci->it_context_list[i];
  2392. if (ctx->context.running)
  2393. ohci_start_iso(&ctx->base, 0, ctx->sync, ctx->tags);
  2394. }
  2395. }
  2396. #endif
  2397. static int queue_iso_transmit(struct iso_context *ctx,
  2398. struct fw_iso_packet *packet,
  2399. struct fw_iso_buffer *buffer,
  2400. unsigned long payload)
  2401. {
  2402. struct descriptor *d, *last, *pd;
  2403. struct fw_iso_packet *p;
  2404. __le32 *header;
  2405. dma_addr_t d_bus, page_bus;
  2406. u32 z, header_z, payload_z, irq;
  2407. u32 payload_index, payload_end_index, next_page_index;
  2408. int page, end_page, i, length, offset;
  2409. p = packet;
  2410. payload_index = payload;
  2411. if (p->skip)
  2412. z = 1;
  2413. else
  2414. z = 2;
  2415. if (p->header_length > 0)
  2416. z++;
  2417. /* Determine the first page the payload isn't contained in. */
  2418. end_page = PAGE_ALIGN(payload_index + p->payload_length) >> PAGE_SHIFT;
  2419. if (p->payload_length > 0)
  2420. payload_z = end_page - (payload_index >> PAGE_SHIFT);
  2421. else
  2422. payload_z = 0;
  2423. z += payload_z;
  2424. /* Get header size in number of descriptors. */
  2425. header_z = DIV_ROUND_UP(p->header_length, sizeof(*d));
  2426. d = context_get_descriptors(&ctx->context, z + header_z, &d_bus);
  2427. if (d == NULL)
  2428. return -ENOMEM;
  2429. if (!p->skip) {
  2430. d[0].control = cpu_to_le16(DESCRIPTOR_KEY_IMMEDIATE);
  2431. d[0].req_count = cpu_to_le16(8);
  2432. /*
  2433. * Link the skip address to this descriptor itself. This causes
  2434. * a context to skip a cycle whenever lost cycles or FIFO
  2435. * overruns occur, without dropping the data. The application
  2436. * should then decide whether this is an error condition or not.
  2437. * FIXME: Make the context's cycle-lost behaviour configurable?
  2438. */
  2439. d[0].branch_address = cpu_to_le32(d_bus | z);
  2440. header = (__le32 *) &d[1];
  2441. header[0] = cpu_to_le32(IT_HEADER_SY(p->sy) |
  2442. IT_HEADER_TAG(p->tag) |
  2443. IT_HEADER_TCODE(TCODE_STREAM_DATA) |
  2444. IT_HEADER_CHANNEL(ctx->base.channel) |
  2445. IT_HEADER_SPEED(ctx->base.speed));
  2446. header[1] =
  2447. cpu_to_le32(IT_HEADER_DATA_LENGTH(p->header_length +
  2448. p->payload_length));
  2449. }
  2450. if (p->header_length > 0) {
  2451. d[2].req_count = cpu_to_le16(p->header_length);
  2452. d[2].data_address = cpu_to_le32(d_bus + z * sizeof(*d));
  2453. memcpy(&d[z], p->header, p->header_length);
  2454. }
  2455. pd = d + z - payload_z;
  2456. payload_end_index = payload_index + p->payload_length;
  2457. for (i = 0; i < payload_z; i++) {
  2458. page = payload_index >> PAGE_SHIFT;
  2459. offset = payload_index & ~PAGE_MASK;
  2460. next_page_index = (page + 1) << PAGE_SHIFT;
  2461. length =
  2462. min(next_page_index, payload_end_index) - payload_index;
  2463. pd[i].req_count = cpu_to_le16(length);
  2464. page_bus = page_private(buffer->pages[page]);
  2465. pd[i].data_address = cpu_to_le32(page_bus + offset);
  2466. payload_index += length;
  2467. }
  2468. if (p->interrupt)
  2469. irq = DESCRIPTOR_IRQ_ALWAYS;
  2470. else
  2471. irq = DESCRIPTOR_NO_IRQ;
  2472. last = z == 2 ? d : d + z - 1;
  2473. last->control |= cpu_to_le16(DESCRIPTOR_OUTPUT_LAST |
  2474. DESCRIPTOR_STATUS |
  2475. DESCRIPTOR_BRANCH_ALWAYS |
  2476. irq);
  2477. context_append(&ctx->context, d, z, header_z);
  2478. return 0;
  2479. }
  2480. static int queue_iso_packet_per_buffer(struct iso_context *ctx,
  2481. struct fw_iso_packet *packet,
  2482. struct fw_iso_buffer *buffer,
  2483. unsigned long payload)
  2484. {
  2485. struct descriptor *d, *pd;
  2486. dma_addr_t d_bus, page_bus;
  2487. u32 z, header_z, rest;
  2488. int i, j, length;
  2489. int page, offset, packet_count, header_size, payload_per_buffer;
  2490. /*
  2491. * The OHCI controller puts the isochronous header and trailer in the
  2492. * buffer, so we need at least 8 bytes.
  2493. */
  2494. packet_count = packet->header_length / ctx->base.header_size;
  2495. header_size = max(ctx->base.header_size, (size_t)8);
  2496. /* Get header size in number of descriptors. */
  2497. header_z = DIV_ROUND_UP(header_size, sizeof(*d));
  2498. page = payload >> PAGE_SHIFT;
  2499. offset = payload & ~PAGE_MASK;
  2500. payload_per_buffer = packet->payload_length / packet_count;
  2501. for (i = 0; i < packet_count; i++) {
  2502. /* d points to the header descriptor */
  2503. z = DIV_ROUND_UP(payload_per_buffer + offset, PAGE_SIZE) + 1;
  2504. d = context_get_descriptors(&ctx->context,
  2505. z + header_z, &d_bus);
  2506. if (d == NULL)
  2507. return -ENOMEM;
  2508. d->control = cpu_to_le16(DESCRIPTOR_STATUS |
  2509. DESCRIPTOR_INPUT_MORE);
  2510. if (packet->skip && i == 0)
  2511. d->control |= cpu_to_le16(DESCRIPTOR_WAIT);
  2512. d->req_count = cpu_to_le16(header_size);
  2513. d->res_count = d->req_count;
  2514. d->transfer_status = 0;
  2515. d->data_address = cpu_to_le32(d_bus + (z * sizeof(*d)));
  2516. rest = payload_per_buffer;
  2517. pd = d;
  2518. for (j = 1; j < z; j++) {
  2519. pd++;
  2520. pd->control = cpu_to_le16(DESCRIPTOR_STATUS |
  2521. DESCRIPTOR_INPUT_MORE);
  2522. if (offset + rest < PAGE_SIZE)
  2523. length = rest;
  2524. else
  2525. length = PAGE_SIZE - offset;
  2526. pd->req_count = cpu_to_le16(length);
  2527. pd->res_count = pd->req_count;
  2528. pd->transfer_status = 0;
  2529. page_bus = page_private(buffer->pages[page]);
  2530. pd->data_address = cpu_to_le32(page_bus + offset);
  2531. offset = (offset + length) & ~PAGE_MASK;
  2532. rest -= length;
  2533. if (offset == 0)
  2534. page++;
  2535. }
  2536. pd->control = cpu_to_le16(DESCRIPTOR_STATUS |
  2537. DESCRIPTOR_INPUT_LAST |
  2538. DESCRIPTOR_BRANCH_ALWAYS);
  2539. if (packet->interrupt && i == packet_count - 1)
  2540. pd->control |= cpu_to_le16(DESCRIPTOR_IRQ_ALWAYS);
  2541. context_append(&ctx->context, d, z, header_z);
  2542. }
  2543. return 0;
  2544. }
  2545. static int queue_iso_buffer_fill(struct iso_context *ctx,
  2546. struct fw_iso_packet *packet,
  2547. struct fw_iso_buffer *buffer,
  2548. unsigned long payload)
  2549. {
  2550. struct descriptor *d;
  2551. dma_addr_t d_bus, page_bus;
  2552. int page, offset, rest, z, i, length;
  2553. page = payload >> PAGE_SHIFT;
  2554. offset = payload & ~PAGE_MASK;
  2555. rest = packet->payload_length;
  2556. /* We need one descriptor for each page in the buffer. */
  2557. z = DIV_ROUND_UP(offset + rest, PAGE_SIZE);
  2558. if (WARN_ON(offset & 3 || rest & 3 || page + z > buffer->page_count))
  2559. return -EFAULT;
  2560. for (i = 0; i < z; i++) {
  2561. d = context_get_descriptors(&ctx->context, 1, &d_bus);
  2562. if (d == NULL)
  2563. return -ENOMEM;
  2564. d->control = cpu_to_le16(DESCRIPTOR_INPUT_MORE |
  2565. DESCRIPTOR_BRANCH_ALWAYS);
  2566. if (packet->skip && i == 0)
  2567. d->control |= cpu_to_le16(DESCRIPTOR_WAIT);
  2568. if (packet->interrupt && i == z - 1)
  2569. d->control |= cpu_to_le16(DESCRIPTOR_IRQ_ALWAYS);
  2570. if (offset + rest < PAGE_SIZE)
  2571. length = rest;
  2572. else
  2573. length = PAGE_SIZE - offset;
  2574. d->req_count = cpu_to_le16(length);
  2575. d->res_count = d->req_count;
  2576. d->transfer_status = 0;
  2577. page_bus = page_private(buffer->pages[page]);
  2578. d->data_address = cpu_to_le32(page_bus + offset);
  2579. rest -= length;
  2580. offset = 0;
  2581. page++;
  2582. context_append(&ctx->context, d, 1, 0);
  2583. }
  2584. return 0;
  2585. }
  2586. static int ohci_queue_iso(struct fw_iso_context *base,
  2587. struct fw_iso_packet *packet,
  2588. struct fw_iso_buffer *buffer,
  2589. unsigned long payload)
  2590. {
  2591. struct iso_context *ctx = container_of(base, struct iso_context, base);
  2592. unsigned long flags;
  2593. int ret = -ENOSYS;
  2594. spin_lock_irqsave(&ctx->context.ohci->lock, flags);
  2595. switch (base->type) {
  2596. case FW_ISO_CONTEXT_TRANSMIT:
  2597. ret = queue_iso_transmit(ctx, packet, buffer, payload);
  2598. break;
  2599. case FW_ISO_CONTEXT_RECEIVE:
  2600. ret = queue_iso_packet_per_buffer(ctx, packet, buffer, payload);
  2601. break;
  2602. case FW_ISO_CONTEXT_RECEIVE_MULTICHANNEL:
  2603. ret = queue_iso_buffer_fill(ctx, packet, buffer, payload);
  2604. break;
  2605. }
  2606. spin_unlock_irqrestore(&ctx->context.ohci->lock, flags);
  2607. return ret;
  2608. }
  2609. static void ohci_flush_queue_iso(struct fw_iso_context *base)
  2610. {
  2611. struct context *ctx =
  2612. &container_of(base, struct iso_context, base)->context;
  2613. reg_write(ctx->ohci, CONTROL_SET(ctx->regs), CONTEXT_WAKE);
  2614. }
  2615. static const struct fw_card_driver ohci_driver = {
  2616. .enable = ohci_enable,
  2617. .read_phy_reg = ohci_read_phy_reg,
  2618. .update_phy_reg = ohci_update_phy_reg,
  2619. .set_config_rom = ohci_set_config_rom,
  2620. .send_request = ohci_send_request,
  2621. .send_response = ohci_send_response,
  2622. .cancel_packet = ohci_cancel_packet,
  2623. .enable_phys_dma = ohci_enable_phys_dma,
  2624. .read_csr = ohci_read_csr,
  2625. .write_csr = ohci_write_csr,
  2626. .allocate_iso_context = ohci_allocate_iso_context,
  2627. .free_iso_context = ohci_free_iso_context,
  2628. .set_iso_channels = ohci_set_iso_channels,
  2629. .queue_iso = ohci_queue_iso,
  2630. .flush_queue_iso = ohci_flush_queue_iso,
  2631. .start_iso = ohci_start_iso,
  2632. .stop_iso = ohci_stop_iso,
  2633. };
  2634. #ifdef CONFIG_PPC_PMAC
  2635. static void pmac_ohci_on(struct pci_dev *dev)
  2636. {
  2637. if (machine_is(powermac)) {
  2638. struct device_node *ofn = pci_device_to_OF_node(dev);
  2639. if (ofn) {
  2640. pmac_call_feature(PMAC_FTR_1394_CABLE_POWER, ofn, 0, 1);
  2641. pmac_call_feature(PMAC_FTR_1394_ENABLE, ofn, 0, 1);
  2642. }
  2643. }
  2644. }
  2645. static void pmac_ohci_off(struct pci_dev *dev)
  2646. {
  2647. if (machine_is(powermac)) {
  2648. struct device_node *ofn = pci_device_to_OF_node(dev);
  2649. if (ofn) {
  2650. pmac_call_feature(PMAC_FTR_1394_ENABLE, ofn, 0, 0);
  2651. pmac_call_feature(PMAC_FTR_1394_CABLE_POWER, ofn, 0, 0);
  2652. }
  2653. }
  2654. }
  2655. #else
  2656. static inline void pmac_ohci_on(struct pci_dev *dev) {}
  2657. static inline void pmac_ohci_off(struct pci_dev *dev) {}
  2658. #endif /* CONFIG_PPC_PMAC */
  2659. static int __devinit pci_probe(struct pci_dev *dev,
  2660. const struct pci_device_id *ent)
  2661. {
  2662. struct fw_ohci *ohci;
  2663. u32 bus_options, max_receive, link_speed, version;
  2664. u64 guid;
  2665. int i, err;
  2666. size_t size;
  2667. ohci = kzalloc(sizeof(*ohci), GFP_KERNEL);
  2668. if (ohci == NULL) {
  2669. err = -ENOMEM;
  2670. goto fail;
  2671. }
  2672. fw_card_initialize(&ohci->card, &ohci_driver, &dev->dev);
  2673. pmac_ohci_on(dev);
  2674. err = pci_enable_device(dev);
  2675. if (err) {
  2676. fw_error("Failed to enable OHCI hardware\n");
  2677. goto fail_free;
  2678. }
  2679. pci_set_master(dev);
  2680. pci_write_config_dword(dev, OHCI1394_PCI_HCI_Control, 0);
  2681. pci_set_drvdata(dev, ohci);
  2682. spin_lock_init(&ohci->lock);
  2683. mutex_init(&ohci->phy_reg_mutex);
  2684. tasklet_init(&ohci->bus_reset_tasklet,
  2685. bus_reset_tasklet, (unsigned long)ohci);
  2686. err = pci_request_region(dev, 0, ohci_driver_name);
  2687. if (err) {
  2688. fw_error("MMIO resource unavailable\n");
  2689. goto fail_disable;
  2690. }
  2691. ohci->registers = pci_iomap(dev, 0, OHCI1394_REGISTER_SIZE);
  2692. if (ohci->registers == NULL) {
  2693. fw_error("Failed to remap registers\n");
  2694. err = -ENXIO;
  2695. goto fail_iomem;
  2696. }
  2697. for (i = 0; i < ARRAY_SIZE(ohci_quirks); i++)
  2698. if ((ohci_quirks[i].vendor == dev->vendor) &&
  2699. (ohci_quirks[i].device == (unsigned short)PCI_ANY_ID ||
  2700. ohci_quirks[i].device == dev->device) &&
  2701. (ohci_quirks[i].revision == (unsigned short)PCI_ANY_ID ||
  2702. ohci_quirks[i].revision >= dev->revision)) {
  2703. ohci->quirks = ohci_quirks[i].flags;
  2704. break;
  2705. }
  2706. if (param_quirks)
  2707. ohci->quirks = param_quirks;
  2708. /*
  2709. * Because dma_alloc_coherent() allocates at least one page,
  2710. * we save space by using a common buffer for the AR request/
  2711. * response descriptors and the self IDs buffer.
  2712. */
  2713. BUILD_BUG_ON(AR_BUFFERS * sizeof(struct descriptor) > PAGE_SIZE/4);
  2714. BUILD_BUG_ON(SELF_ID_BUF_SIZE > PAGE_SIZE/2);
  2715. ohci->misc_buffer = dma_alloc_coherent(ohci->card.device,
  2716. PAGE_SIZE,
  2717. &ohci->misc_buffer_bus,
  2718. GFP_KERNEL);
  2719. if (!ohci->misc_buffer) {
  2720. err = -ENOMEM;
  2721. goto fail_iounmap;
  2722. }
  2723. err = ar_context_init(&ohci->ar_request_ctx, ohci, 0,
  2724. OHCI1394_AsReqRcvContextControlSet);
  2725. if (err < 0)
  2726. goto fail_misc_buf;
  2727. err = ar_context_init(&ohci->ar_response_ctx, ohci, PAGE_SIZE/4,
  2728. OHCI1394_AsRspRcvContextControlSet);
  2729. if (err < 0)
  2730. goto fail_arreq_ctx;
  2731. err = context_init(&ohci->at_request_ctx, ohci,
  2732. OHCI1394_AsReqTrContextControlSet, handle_at_packet);
  2733. if (err < 0)
  2734. goto fail_arrsp_ctx;
  2735. err = context_init(&ohci->at_response_ctx, ohci,
  2736. OHCI1394_AsRspTrContextControlSet, handle_at_packet);
  2737. if (err < 0)
  2738. goto fail_atreq_ctx;
  2739. reg_write(ohci, OHCI1394_IsoRecvIntMaskSet, ~0);
  2740. ohci->ir_context_channels = ~0ULL;
  2741. ohci->ir_context_support = reg_read(ohci, OHCI1394_IsoRecvIntMaskSet);
  2742. reg_write(ohci, OHCI1394_IsoRecvIntMaskClear, ~0);
  2743. ohci->ir_context_mask = ohci->ir_context_support;
  2744. ohci->n_ir = hweight32(ohci->ir_context_mask);
  2745. size = sizeof(struct iso_context) * ohci->n_ir;
  2746. ohci->ir_context_list = kzalloc(size, GFP_KERNEL);
  2747. reg_write(ohci, OHCI1394_IsoXmitIntMaskSet, ~0);
  2748. ohci->it_context_support = reg_read(ohci, OHCI1394_IsoXmitIntMaskSet);
  2749. reg_write(ohci, OHCI1394_IsoXmitIntMaskClear, ~0);
  2750. ohci->it_context_mask = ohci->it_context_support;
  2751. ohci->n_it = hweight32(ohci->it_context_mask);
  2752. size = sizeof(struct iso_context) * ohci->n_it;
  2753. ohci->it_context_list = kzalloc(size, GFP_KERNEL);
  2754. if (ohci->it_context_list == NULL || ohci->ir_context_list == NULL) {
  2755. err = -ENOMEM;
  2756. goto fail_contexts;
  2757. }
  2758. ohci->self_id_cpu = ohci->misc_buffer + PAGE_SIZE/2;
  2759. ohci->self_id_bus = ohci->misc_buffer_bus + PAGE_SIZE/2;
  2760. bus_options = reg_read(ohci, OHCI1394_BusOptions);
  2761. max_receive = (bus_options >> 12) & 0xf;
  2762. link_speed = bus_options & 0x7;
  2763. guid = ((u64) reg_read(ohci, OHCI1394_GUIDHi) << 32) |
  2764. reg_read(ohci, OHCI1394_GUIDLo);
  2765. err = fw_card_add(&ohci->card, max_receive, link_speed, guid);
  2766. if (err)
  2767. goto fail_contexts;
  2768. version = reg_read(ohci, OHCI1394_Version) & 0x00ff00ff;
  2769. fw_notify("Added fw-ohci device %s, OHCI v%x.%x, "
  2770. "%d IR + %d IT contexts, quirks 0x%x\n",
  2771. dev_name(&dev->dev), version >> 16, version & 0xff,
  2772. ohci->n_ir, ohci->n_it, ohci->quirks);
  2773. return 0;
  2774. fail_contexts:
  2775. kfree(ohci->ir_context_list);
  2776. kfree(ohci->it_context_list);
  2777. context_release(&ohci->at_response_ctx);
  2778. fail_atreq_ctx:
  2779. context_release(&ohci->at_request_ctx);
  2780. fail_arrsp_ctx:
  2781. ar_context_release(&ohci->ar_response_ctx);
  2782. fail_arreq_ctx:
  2783. ar_context_release(&ohci->ar_request_ctx);
  2784. fail_misc_buf:
  2785. dma_free_coherent(ohci->card.device, PAGE_SIZE,
  2786. ohci->misc_buffer, ohci->misc_buffer_bus);
  2787. fail_iounmap:
  2788. pci_iounmap(dev, ohci->registers);
  2789. fail_iomem:
  2790. pci_release_region(dev, 0);
  2791. fail_disable:
  2792. pci_disable_device(dev);
  2793. fail_free:
  2794. kfree(ohci);
  2795. pmac_ohci_off(dev);
  2796. fail:
  2797. if (err == -ENOMEM)
  2798. fw_error("Out of memory\n");
  2799. return err;
  2800. }
  2801. static void pci_remove(struct pci_dev *dev)
  2802. {
  2803. struct fw_ohci *ohci;
  2804. ohci = pci_get_drvdata(dev);
  2805. reg_write(ohci, OHCI1394_IntMaskClear, ~0);
  2806. flush_writes(ohci);
  2807. fw_core_remove_card(&ohci->card);
  2808. /*
  2809. * FIXME: Fail all pending packets here, now that the upper
  2810. * layers can't queue any more.
  2811. */
  2812. software_reset(ohci);
  2813. free_irq(dev->irq, ohci);
  2814. if (ohci->next_config_rom && ohci->next_config_rom != ohci->config_rom)
  2815. dma_free_coherent(ohci->card.device, CONFIG_ROM_SIZE,
  2816. ohci->next_config_rom, ohci->next_config_rom_bus);
  2817. if (ohci->config_rom)
  2818. dma_free_coherent(ohci->card.device, CONFIG_ROM_SIZE,
  2819. ohci->config_rom, ohci->config_rom_bus);
  2820. ar_context_release(&ohci->ar_request_ctx);
  2821. ar_context_release(&ohci->ar_response_ctx);
  2822. dma_free_coherent(ohci->card.device, PAGE_SIZE,
  2823. ohci->misc_buffer, ohci->misc_buffer_bus);
  2824. context_release(&ohci->at_request_ctx);
  2825. context_release(&ohci->at_response_ctx);
  2826. kfree(ohci->it_context_list);
  2827. kfree(ohci->ir_context_list);
  2828. pci_disable_msi(dev);
  2829. pci_iounmap(dev, ohci->registers);
  2830. pci_release_region(dev, 0);
  2831. pci_disable_device(dev);
  2832. kfree(ohci);
  2833. pmac_ohci_off(dev);
  2834. fw_notify("Removed fw-ohci device.\n");
  2835. }
  2836. #ifdef CONFIG_PM
  2837. static int pci_suspend(struct pci_dev *dev, pm_message_t state)
  2838. {
  2839. struct fw_ohci *ohci = pci_get_drvdata(dev);
  2840. int err;
  2841. software_reset(ohci);
  2842. free_irq(dev->irq, ohci);
  2843. pci_disable_msi(dev);
  2844. err = pci_save_state(dev);
  2845. if (err) {
  2846. fw_error("pci_save_state failed\n");
  2847. return err;
  2848. }
  2849. err = pci_set_power_state(dev, pci_choose_state(dev, state));
  2850. if (err)
  2851. fw_error("pci_set_power_state failed with %d\n", err);
  2852. pmac_ohci_off(dev);
  2853. return 0;
  2854. }
  2855. static int pci_resume(struct pci_dev *dev)
  2856. {
  2857. struct fw_ohci *ohci = pci_get_drvdata(dev);
  2858. int err;
  2859. pmac_ohci_on(dev);
  2860. pci_set_power_state(dev, PCI_D0);
  2861. pci_restore_state(dev);
  2862. err = pci_enable_device(dev);
  2863. if (err) {
  2864. fw_error("pci_enable_device failed\n");
  2865. return err;
  2866. }
  2867. /* Some systems don't setup GUID register on resume from ram */
  2868. if (!reg_read(ohci, OHCI1394_GUIDLo) &&
  2869. !reg_read(ohci, OHCI1394_GUIDHi)) {
  2870. reg_write(ohci, OHCI1394_GUIDLo, (u32)ohci->card.guid);
  2871. reg_write(ohci, OHCI1394_GUIDHi, (u32)(ohci->card.guid >> 32));
  2872. }
  2873. err = ohci_enable(&ohci->card, NULL, 0);
  2874. if (err)
  2875. return err;
  2876. ohci_resume_iso_dma(ohci);
  2877. return 0;
  2878. }
  2879. #endif
  2880. static const struct pci_device_id pci_table[] = {
  2881. { PCI_DEVICE_CLASS(PCI_CLASS_SERIAL_FIREWIRE_OHCI, ~0) },
  2882. { }
  2883. };
  2884. MODULE_DEVICE_TABLE(pci, pci_table);
  2885. static struct pci_driver fw_ohci_pci_driver = {
  2886. .name = ohci_driver_name,
  2887. .id_table = pci_table,
  2888. .probe = pci_probe,
  2889. .remove = pci_remove,
  2890. #ifdef CONFIG_PM
  2891. .resume = pci_resume,
  2892. .suspend = pci_suspend,
  2893. #endif
  2894. };
  2895. MODULE_AUTHOR("Kristian Hoegsberg <krh@bitplanet.net>");
  2896. MODULE_DESCRIPTION("Driver for PCI OHCI IEEE1394 controllers");
  2897. MODULE_LICENSE("GPL");
  2898. /* Provide a module alias so root-on-sbp2 initrds don't break. */
  2899. #ifndef CONFIG_IEEE1394_OHCI1394_MODULE
  2900. MODULE_ALIAS("ohci1394");
  2901. #endif
  2902. static int __init fw_ohci_init(void)
  2903. {
  2904. return pci_register_driver(&fw_ohci_pci_driver);
  2905. }
  2906. static void __exit fw_ohci_cleanup(void)
  2907. {
  2908. pci_unregister_driver(&fw_ohci_pci_driver);
  2909. }
  2910. module_init(fw_ohci_init);
  2911. module_exit(fw_ohci_cleanup);