pci.c 77 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000300130023003300430053006300730083009301030113012301330143015301630173018
  1. /*
  2. * PCI Bus Services, see include/linux/pci.h for further explanation.
  3. *
  4. * Copyright 1993 -- 1997 Drew Eckhardt, Frederic Potter,
  5. * David Mosberger-Tang
  6. *
  7. * Copyright 1997 -- 2000 Martin Mares <mj@ucw.cz>
  8. */
  9. #include <linux/kernel.h>
  10. #include <linux/delay.h>
  11. #include <linux/init.h>
  12. #include <linux/pci.h>
  13. #include <linux/pm.h>
  14. #include <linux/module.h>
  15. #include <linux/spinlock.h>
  16. #include <linux/string.h>
  17. #include <linux/log2.h>
  18. #include <linux/pci-aspm.h>
  19. #include <linux/pm_wakeup.h>
  20. #include <linux/interrupt.h>
  21. #include <linux/device.h>
  22. #include <linux/pm_runtime.h>
  23. #include <asm/setup.h>
  24. #include "pci.h"
  25. const char *pci_power_names[] = {
  26. "error", "D0", "D1", "D2", "D3hot", "D3cold", "unknown",
  27. };
  28. EXPORT_SYMBOL_GPL(pci_power_names);
  29. int isa_dma_bridge_buggy;
  30. EXPORT_SYMBOL(isa_dma_bridge_buggy);
  31. int pci_pci_problems;
  32. EXPORT_SYMBOL(pci_pci_problems);
  33. unsigned int pci_pm_d3_delay;
  34. static void pci_dev_d3_sleep(struct pci_dev *dev)
  35. {
  36. unsigned int delay = dev->d3_delay;
  37. if (delay < pci_pm_d3_delay)
  38. delay = pci_pm_d3_delay;
  39. msleep(delay);
  40. }
  41. #ifdef CONFIG_PCI_DOMAINS
  42. int pci_domains_supported = 1;
  43. #endif
  44. #define DEFAULT_CARDBUS_IO_SIZE (256)
  45. #define DEFAULT_CARDBUS_MEM_SIZE (64*1024*1024)
  46. /* pci=cbmemsize=nnM,cbiosize=nn can override this */
  47. unsigned long pci_cardbus_io_size = DEFAULT_CARDBUS_IO_SIZE;
  48. unsigned long pci_cardbus_mem_size = DEFAULT_CARDBUS_MEM_SIZE;
  49. #define DEFAULT_HOTPLUG_IO_SIZE (256)
  50. #define DEFAULT_HOTPLUG_MEM_SIZE (2*1024*1024)
  51. /* pci=hpmemsize=nnM,hpiosize=nn can override this */
  52. unsigned long pci_hotplug_io_size = DEFAULT_HOTPLUG_IO_SIZE;
  53. unsigned long pci_hotplug_mem_size = DEFAULT_HOTPLUG_MEM_SIZE;
  54. /*
  55. * The default CLS is used if arch didn't set CLS explicitly and not
  56. * all pci devices agree on the same value. Arch can override either
  57. * the dfl or actual value as it sees fit. Don't forget this is
  58. * measured in 32-bit words, not bytes.
  59. */
  60. u8 pci_dfl_cache_line_size __devinitdata = L1_CACHE_BYTES >> 2;
  61. u8 pci_cache_line_size;
  62. /**
  63. * pci_bus_max_busnr - returns maximum PCI bus number of given bus' children
  64. * @bus: pointer to PCI bus structure to search
  65. *
  66. * Given a PCI bus, returns the highest PCI bus number present in the set
  67. * including the given PCI bus and its list of child PCI buses.
  68. */
  69. unsigned char pci_bus_max_busnr(struct pci_bus* bus)
  70. {
  71. struct list_head *tmp;
  72. unsigned char max, n;
  73. max = bus->subordinate;
  74. list_for_each(tmp, &bus->children) {
  75. n = pci_bus_max_busnr(pci_bus_b(tmp));
  76. if(n > max)
  77. max = n;
  78. }
  79. return max;
  80. }
  81. EXPORT_SYMBOL_GPL(pci_bus_max_busnr);
  82. #ifdef CONFIG_HAS_IOMEM
  83. void __iomem *pci_ioremap_bar(struct pci_dev *pdev, int bar)
  84. {
  85. /*
  86. * Make sure the BAR is actually a memory resource, not an IO resource
  87. */
  88. if (!(pci_resource_flags(pdev, bar) & IORESOURCE_MEM)) {
  89. WARN_ON(1);
  90. return NULL;
  91. }
  92. return ioremap_nocache(pci_resource_start(pdev, bar),
  93. pci_resource_len(pdev, bar));
  94. }
  95. EXPORT_SYMBOL_GPL(pci_ioremap_bar);
  96. #endif
  97. #if 0
  98. /**
  99. * pci_max_busnr - returns maximum PCI bus number
  100. *
  101. * Returns the highest PCI bus number present in the system global list of
  102. * PCI buses.
  103. */
  104. unsigned char __devinit
  105. pci_max_busnr(void)
  106. {
  107. struct pci_bus *bus = NULL;
  108. unsigned char max, n;
  109. max = 0;
  110. while ((bus = pci_find_next_bus(bus)) != NULL) {
  111. n = pci_bus_max_busnr(bus);
  112. if(n > max)
  113. max = n;
  114. }
  115. return max;
  116. }
  117. #endif /* 0 */
  118. #define PCI_FIND_CAP_TTL 48
  119. static int __pci_find_next_cap_ttl(struct pci_bus *bus, unsigned int devfn,
  120. u8 pos, int cap, int *ttl)
  121. {
  122. u8 id;
  123. while ((*ttl)--) {
  124. pci_bus_read_config_byte(bus, devfn, pos, &pos);
  125. if (pos < 0x40)
  126. break;
  127. pos &= ~3;
  128. pci_bus_read_config_byte(bus, devfn, pos + PCI_CAP_LIST_ID,
  129. &id);
  130. if (id == 0xff)
  131. break;
  132. if (id == cap)
  133. return pos;
  134. pos += PCI_CAP_LIST_NEXT;
  135. }
  136. return 0;
  137. }
  138. static int __pci_find_next_cap(struct pci_bus *bus, unsigned int devfn,
  139. u8 pos, int cap)
  140. {
  141. int ttl = PCI_FIND_CAP_TTL;
  142. return __pci_find_next_cap_ttl(bus, devfn, pos, cap, &ttl);
  143. }
  144. int pci_find_next_capability(struct pci_dev *dev, u8 pos, int cap)
  145. {
  146. return __pci_find_next_cap(dev->bus, dev->devfn,
  147. pos + PCI_CAP_LIST_NEXT, cap);
  148. }
  149. EXPORT_SYMBOL_GPL(pci_find_next_capability);
  150. static int __pci_bus_find_cap_start(struct pci_bus *bus,
  151. unsigned int devfn, u8 hdr_type)
  152. {
  153. u16 status;
  154. pci_bus_read_config_word(bus, devfn, PCI_STATUS, &status);
  155. if (!(status & PCI_STATUS_CAP_LIST))
  156. return 0;
  157. switch (hdr_type) {
  158. case PCI_HEADER_TYPE_NORMAL:
  159. case PCI_HEADER_TYPE_BRIDGE:
  160. return PCI_CAPABILITY_LIST;
  161. case PCI_HEADER_TYPE_CARDBUS:
  162. return PCI_CB_CAPABILITY_LIST;
  163. default:
  164. return 0;
  165. }
  166. return 0;
  167. }
  168. /**
  169. * pci_find_capability - query for devices' capabilities
  170. * @dev: PCI device to query
  171. * @cap: capability code
  172. *
  173. * Tell if a device supports a given PCI capability.
  174. * Returns the address of the requested capability structure within the
  175. * device's PCI configuration space or 0 in case the device does not
  176. * support it. Possible values for @cap:
  177. *
  178. * %PCI_CAP_ID_PM Power Management
  179. * %PCI_CAP_ID_AGP Accelerated Graphics Port
  180. * %PCI_CAP_ID_VPD Vital Product Data
  181. * %PCI_CAP_ID_SLOTID Slot Identification
  182. * %PCI_CAP_ID_MSI Message Signalled Interrupts
  183. * %PCI_CAP_ID_CHSWP CompactPCI HotSwap
  184. * %PCI_CAP_ID_PCIX PCI-X
  185. * %PCI_CAP_ID_EXP PCI Express
  186. */
  187. int pci_find_capability(struct pci_dev *dev, int cap)
  188. {
  189. int pos;
  190. pos = __pci_bus_find_cap_start(dev->bus, dev->devfn, dev->hdr_type);
  191. if (pos)
  192. pos = __pci_find_next_cap(dev->bus, dev->devfn, pos, cap);
  193. return pos;
  194. }
  195. /**
  196. * pci_bus_find_capability - query for devices' capabilities
  197. * @bus: the PCI bus to query
  198. * @devfn: PCI device to query
  199. * @cap: capability code
  200. *
  201. * Like pci_find_capability() but works for pci devices that do not have a
  202. * pci_dev structure set up yet.
  203. *
  204. * Returns the address of the requested capability structure within the
  205. * device's PCI configuration space or 0 in case the device does not
  206. * support it.
  207. */
  208. int pci_bus_find_capability(struct pci_bus *bus, unsigned int devfn, int cap)
  209. {
  210. int pos;
  211. u8 hdr_type;
  212. pci_bus_read_config_byte(bus, devfn, PCI_HEADER_TYPE, &hdr_type);
  213. pos = __pci_bus_find_cap_start(bus, devfn, hdr_type & 0x7f);
  214. if (pos)
  215. pos = __pci_find_next_cap(bus, devfn, pos, cap);
  216. return pos;
  217. }
  218. /**
  219. * pci_find_ext_capability - Find an extended capability
  220. * @dev: PCI device to query
  221. * @cap: capability code
  222. *
  223. * Returns the address of the requested extended capability structure
  224. * within the device's PCI configuration space or 0 if the device does
  225. * not support it. Possible values for @cap:
  226. *
  227. * %PCI_EXT_CAP_ID_ERR Advanced Error Reporting
  228. * %PCI_EXT_CAP_ID_VC Virtual Channel
  229. * %PCI_EXT_CAP_ID_DSN Device Serial Number
  230. * %PCI_EXT_CAP_ID_PWR Power Budgeting
  231. */
  232. int pci_find_ext_capability(struct pci_dev *dev, int cap)
  233. {
  234. u32 header;
  235. int ttl;
  236. int pos = PCI_CFG_SPACE_SIZE;
  237. /* minimum 8 bytes per capability */
  238. ttl = (PCI_CFG_SPACE_EXP_SIZE - PCI_CFG_SPACE_SIZE) / 8;
  239. if (dev->cfg_size <= PCI_CFG_SPACE_SIZE)
  240. return 0;
  241. if (pci_read_config_dword(dev, pos, &header) != PCIBIOS_SUCCESSFUL)
  242. return 0;
  243. /*
  244. * If we have no capabilities, this is indicated by cap ID,
  245. * cap version and next pointer all being 0.
  246. */
  247. if (header == 0)
  248. return 0;
  249. while (ttl-- > 0) {
  250. if (PCI_EXT_CAP_ID(header) == cap)
  251. return pos;
  252. pos = PCI_EXT_CAP_NEXT(header);
  253. if (pos < PCI_CFG_SPACE_SIZE)
  254. break;
  255. if (pci_read_config_dword(dev, pos, &header) != PCIBIOS_SUCCESSFUL)
  256. break;
  257. }
  258. return 0;
  259. }
  260. EXPORT_SYMBOL_GPL(pci_find_ext_capability);
  261. static int __pci_find_next_ht_cap(struct pci_dev *dev, int pos, int ht_cap)
  262. {
  263. int rc, ttl = PCI_FIND_CAP_TTL;
  264. u8 cap, mask;
  265. if (ht_cap == HT_CAPTYPE_SLAVE || ht_cap == HT_CAPTYPE_HOST)
  266. mask = HT_3BIT_CAP_MASK;
  267. else
  268. mask = HT_5BIT_CAP_MASK;
  269. pos = __pci_find_next_cap_ttl(dev->bus, dev->devfn, pos,
  270. PCI_CAP_ID_HT, &ttl);
  271. while (pos) {
  272. rc = pci_read_config_byte(dev, pos + 3, &cap);
  273. if (rc != PCIBIOS_SUCCESSFUL)
  274. return 0;
  275. if ((cap & mask) == ht_cap)
  276. return pos;
  277. pos = __pci_find_next_cap_ttl(dev->bus, dev->devfn,
  278. pos + PCI_CAP_LIST_NEXT,
  279. PCI_CAP_ID_HT, &ttl);
  280. }
  281. return 0;
  282. }
  283. /**
  284. * pci_find_next_ht_capability - query a device's Hypertransport capabilities
  285. * @dev: PCI device to query
  286. * @pos: Position from which to continue searching
  287. * @ht_cap: Hypertransport capability code
  288. *
  289. * To be used in conjunction with pci_find_ht_capability() to search for
  290. * all capabilities matching @ht_cap. @pos should always be a value returned
  291. * from pci_find_ht_capability().
  292. *
  293. * NB. To be 100% safe against broken PCI devices, the caller should take
  294. * steps to avoid an infinite loop.
  295. */
  296. int pci_find_next_ht_capability(struct pci_dev *dev, int pos, int ht_cap)
  297. {
  298. return __pci_find_next_ht_cap(dev, pos + PCI_CAP_LIST_NEXT, ht_cap);
  299. }
  300. EXPORT_SYMBOL_GPL(pci_find_next_ht_capability);
  301. /**
  302. * pci_find_ht_capability - query a device's Hypertransport capabilities
  303. * @dev: PCI device to query
  304. * @ht_cap: Hypertransport capability code
  305. *
  306. * Tell if a device supports a given Hypertransport capability.
  307. * Returns an address within the device's PCI configuration space
  308. * or 0 in case the device does not support the request capability.
  309. * The address points to the PCI capability, of type PCI_CAP_ID_HT,
  310. * which has a Hypertransport capability matching @ht_cap.
  311. */
  312. int pci_find_ht_capability(struct pci_dev *dev, int ht_cap)
  313. {
  314. int pos;
  315. pos = __pci_bus_find_cap_start(dev->bus, dev->devfn, dev->hdr_type);
  316. if (pos)
  317. pos = __pci_find_next_ht_cap(dev, pos, ht_cap);
  318. return pos;
  319. }
  320. EXPORT_SYMBOL_GPL(pci_find_ht_capability);
  321. /**
  322. * pci_find_parent_resource - return resource region of parent bus of given region
  323. * @dev: PCI device structure contains resources to be searched
  324. * @res: child resource record for which parent is sought
  325. *
  326. * For given resource region of given device, return the resource
  327. * region of parent bus the given region is contained in or where
  328. * it should be allocated from.
  329. */
  330. struct resource *
  331. pci_find_parent_resource(const struct pci_dev *dev, struct resource *res)
  332. {
  333. const struct pci_bus *bus = dev->bus;
  334. int i;
  335. struct resource *best = NULL;
  336. for(i = 0; i < PCI_BUS_NUM_RESOURCES; i++) {
  337. struct resource *r = bus->resource[i];
  338. if (!r)
  339. continue;
  340. if (res->start && !(res->start >= r->start && res->end <= r->end))
  341. continue; /* Not contained */
  342. if ((res->flags ^ r->flags) & (IORESOURCE_IO | IORESOURCE_MEM))
  343. continue; /* Wrong type */
  344. if (!((res->flags ^ r->flags) & IORESOURCE_PREFETCH))
  345. return r; /* Exact match */
  346. /* We can't insert a non-prefetch resource inside a prefetchable parent .. */
  347. if (r->flags & IORESOURCE_PREFETCH)
  348. continue;
  349. /* .. but we can put a prefetchable resource inside a non-prefetchable one */
  350. if (!best)
  351. best = r;
  352. }
  353. return best;
  354. }
  355. /**
  356. * pci_restore_bars - restore a devices BAR values (e.g. after wake-up)
  357. * @dev: PCI device to have its BARs restored
  358. *
  359. * Restore the BAR values for a given device, so as to make it
  360. * accessible by its driver.
  361. */
  362. static void
  363. pci_restore_bars(struct pci_dev *dev)
  364. {
  365. int i;
  366. for (i = 0; i < PCI_BRIDGE_RESOURCES; i++)
  367. pci_update_resource(dev, i);
  368. }
  369. static struct pci_platform_pm_ops *pci_platform_pm;
  370. int pci_set_platform_pm(struct pci_platform_pm_ops *ops)
  371. {
  372. if (!ops->is_manageable || !ops->set_state || !ops->choose_state
  373. || !ops->sleep_wake || !ops->can_wakeup)
  374. return -EINVAL;
  375. pci_platform_pm = ops;
  376. return 0;
  377. }
  378. static inline bool platform_pci_power_manageable(struct pci_dev *dev)
  379. {
  380. return pci_platform_pm ? pci_platform_pm->is_manageable(dev) : false;
  381. }
  382. static inline int platform_pci_set_power_state(struct pci_dev *dev,
  383. pci_power_t t)
  384. {
  385. return pci_platform_pm ? pci_platform_pm->set_state(dev, t) : -ENOSYS;
  386. }
  387. static inline pci_power_t platform_pci_choose_state(struct pci_dev *dev)
  388. {
  389. return pci_platform_pm ?
  390. pci_platform_pm->choose_state(dev) : PCI_POWER_ERROR;
  391. }
  392. static inline bool platform_pci_can_wakeup(struct pci_dev *dev)
  393. {
  394. return pci_platform_pm ? pci_platform_pm->can_wakeup(dev) : false;
  395. }
  396. static inline int platform_pci_sleep_wake(struct pci_dev *dev, bool enable)
  397. {
  398. return pci_platform_pm ?
  399. pci_platform_pm->sleep_wake(dev, enable) : -ENODEV;
  400. }
  401. static inline int platform_pci_run_wake(struct pci_dev *dev, bool enable)
  402. {
  403. return pci_platform_pm ?
  404. pci_platform_pm->run_wake(dev, enable) : -ENODEV;
  405. }
  406. /**
  407. * pci_raw_set_power_state - Use PCI PM registers to set the power state of
  408. * given PCI device
  409. * @dev: PCI device to handle.
  410. * @state: PCI power state (D0, D1, D2, D3hot) to put the device into.
  411. *
  412. * RETURN VALUE:
  413. * -EINVAL if the requested state is invalid.
  414. * -EIO if device does not support PCI PM or its PM capabilities register has a
  415. * wrong version, or device doesn't support the requested state.
  416. * 0 if device already is in the requested state.
  417. * 0 if device's power state has been successfully changed.
  418. */
  419. static int pci_raw_set_power_state(struct pci_dev *dev, pci_power_t state)
  420. {
  421. u16 pmcsr;
  422. bool need_restore = false;
  423. /* Check if we're already there */
  424. if (dev->current_state == state)
  425. return 0;
  426. if (!dev->pm_cap)
  427. return -EIO;
  428. if (state < PCI_D0 || state > PCI_D3hot)
  429. return -EINVAL;
  430. /* Validate current state:
  431. * Can enter D0 from any state, but if we can only go deeper
  432. * to sleep if we're already in a low power state
  433. */
  434. if (state != PCI_D0 && dev->current_state <= PCI_D3cold
  435. && dev->current_state > state) {
  436. dev_err(&dev->dev, "invalid power transition "
  437. "(from state %d to %d)\n", dev->current_state, state);
  438. return -EINVAL;
  439. }
  440. /* check if this device supports the desired state */
  441. if ((state == PCI_D1 && !dev->d1_support)
  442. || (state == PCI_D2 && !dev->d2_support))
  443. return -EIO;
  444. pci_read_config_word(dev, dev->pm_cap + PCI_PM_CTRL, &pmcsr);
  445. /* If we're (effectively) in D3, force entire word to 0.
  446. * This doesn't affect PME_Status, disables PME_En, and
  447. * sets PowerState to 0.
  448. */
  449. switch (dev->current_state) {
  450. case PCI_D0:
  451. case PCI_D1:
  452. case PCI_D2:
  453. pmcsr &= ~PCI_PM_CTRL_STATE_MASK;
  454. pmcsr |= state;
  455. break;
  456. case PCI_D3hot:
  457. case PCI_D3cold:
  458. case PCI_UNKNOWN: /* Boot-up */
  459. if ((pmcsr & PCI_PM_CTRL_STATE_MASK) == PCI_D3hot
  460. && !(pmcsr & PCI_PM_CTRL_NO_SOFT_RESET))
  461. need_restore = true;
  462. /* Fall-through: force to D0 */
  463. default:
  464. pmcsr = 0;
  465. break;
  466. }
  467. /* enter specified state */
  468. pci_write_config_word(dev, dev->pm_cap + PCI_PM_CTRL, pmcsr);
  469. /* Mandatory power management transition delays */
  470. /* see PCI PM 1.1 5.6.1 table 18 */
  471. if (state == PCI_D3hot || dev->current_state == PCI_D3hot)
  472. pci_dev_d3_sleep(dev);
  473. else if (state == PCI_D2 || dev->current_state == PCI_D2)
  474. udelay(PCI_PM_D2_DELAY);
  475. pci_read_config_word(dev, dev->pm_cap + PCI_PM_CTRL, &pmcsr);
  476. dev->current_state = (pmcsr & PCI_PM_CTRL_STATE_MASK);
  477. if (dev->current_state != state && printk_ratelimit())
  478. dev_info(&dev->dev, "Refused to change power state, "
  479. "currently in D%d\n", dev->current_state);
  480. /* According to section 5.4.1 of the "PCI BUS POWER MANAGEMENT
  481. * INTERFACE SPECIFICATION, REV. 1.2", a device transitioning
  482. * from D3hot to D0 _may_ perform an internal reset, thereby
  483. * going to "D0 Uninitialized" rather than "D0 Initialized".
  484. * For example, at least some versions of the 3c905B and the
  485. * 3c556B exhibit this behaviour.
  486. *
  487. * At least some laptop BIOSen (e.g. the Thinkpad T21) leave
  488. * devices in a D3hot state at boot. Consequently, we need to
  489. * restore at least the BARs so that the device will be
  490. * accessible to its driver.
  491. */
  492. if (need_restore)
  493. pci_restore_bars(dev);
  494. if (dev->bus->self)
  495. pcie_aspm_pm_state_change(dev->bus->self);
  496. return 0;
  497. }
  498. /**
  499. * pci_update_current_state - Read PCI power state of given device from its
  500. * PCI PM registers and cache it
  501. * @dev: PCI device to handle.
  502. * @state: State to cache in case the device doesn't have the PM capability
  503. */
  504. void pci_update_current_state(struct pci_dev *dev, pci_power_t state)
  505. {
  506. if (dev->pm_cap) {
  507. u16 pmcsr;
  508. pci_read_config_word(dev, dev->pm_cap + PCI_PM_CTRL, &pmcsr);
  509. dev->current_state = (pmcsr & PCI_PM_CTRL_STATE_MASK);
  510. } else {
  511. dev->current_state = state;
  512. }
  513. }
  514. /**
  515. * pci_platform_power_transition - Use platform to change device power state
  516. * @dev: PCI device to handle.
  517. * @state: State to put the device into.
  518. */
  519. static int pci_platform_power_transition(struct pci_dev *dev, pci_power_t state)
  520. {
  521. int error;
  522. if (platform_pci_power_manageable(dev)) {
  523. error = platform_pci_set_power_state(dev, state);
  524. if (!error)
  525. pci_update_current_state(dev, state);
  526. } else {
  527. error = -ENODEV;
  528. /* Fall back to PCI_D0 if native PM is not supported */
  529. if (!dev->pm_cap)
  530. dev->current_state = PCI_D0;
  531. }
  532. return error;
  533. }
  534. /**
  535. * __pci_start_power_transition - Start power transition of a PCI device
  536. * @dev: PCI device to handle.
  537. * @state: State to put the device into.
  538. */
  539. static void __pci_start_power_transition(struct pci_dev *dev, pci_power_t state)
  540. {
  541. if (state == PCI_D0)
  542. pci_platform_power_transition(dev, PCI_D0);
  543. }
  544. /**
  545. * __pci_complete_power_transition - Complete power transition of a PCI device
  546. * @dev: PCI device to handle.
  547. * @state: State to put the device into.
  548. *
  549. * This function should not be called directly by device drivers.
  550. */
  551. int __pci_complete_power_transition(struct pci_dev *dev, pci_power_t state)
  552. {
  553. return state > PCI_D0 ?
  554. pci_platform_power_transition(dev, state) : -EINVAL;
  555. }
  556. EXPORT_SYMBOL_GPL(__pci_complete_power_transition);
  557. /**
  558. * pci_set_power_state - Set the power state of a PCI device
  559. * @dev: PCI device to handle.
  560. * @state: PCI power state (D0, D1, D2, D3hot) to put the device into.
  561. *
  562. * Transition a device to a new power state, using the platform firmware and/or
  563. * the device's PCI PM registers.
  564. *
  565. * RETURN VALUE:
  566. * -EINVAL if the requested state is invalid.
  567. * -EIO if device does not support PCI PM or its PM capabilities register has a
  568. * wrong version, or device doesn't support the requested state.
  569. * 0 if device already is in the requested state.
  570. * 0 if device's power state has been successfully changed.
  571. */
  572. int pci_set_power_state(struct pci_dev *dev, pci_power_t state)
  573. {
  574. int error;
  575. /* bound the state we're entering */
  576. if (state > PCI_D3hot)
  577. state = PCI_D3hot;
  578. else if (state < PCI_D0)
  579. state = PCI_D0;
  580. else if ((state == PCI_D1 || state == PCI_D2) && pci_no_d1d2(dev))
  581. /*
  582. * If the device or the parent bridge do not support PCI PM,
  583. * ignore the request if we're doing anything other than putting
  584. * it into D0 (which would only happen on boot).
  585. */
  586. return 0;
  587. /* Check if we're already there */
  588. if (dev->current_state == state)
  589. return 0;
  590. __pci_start_power_transition(dev, state);
  591. /* This device is quirked not to be put into D3, so
  592. don't put it in D3 */
  593. if (state == PCI_D3hot && (dev->dev_flags & PCI_DEV_FLAGS_NO_D3))
  594. return 0;
  595. error = pci_raw_set_power_state(dev, state);
  596. if (!__pci_complete_power_transition(dev, state))
  597. error = 0;
  598. return error;
  599. }
  600. /**
  601. * pci_choose_state - Choose the power state of a PCI device
  602. * @dev: PCI device to be suspended
  603. * @state: target sleep state for the whole system. This is the value
  604. * that is passed to suspend() function.
  605. *
  606. * Returns PCI power state suitable for given device and given system
  607. * message.
  608. */
  609. pci_power_t pci_choose_state(struct pci_dev *dev, pm_message_t state)
  610. {
  611. pci_power_t ret;
  612. if (!pci_find_capability(dev, PCI_CAP_ID_PM))
  613. return PCI_D0;
  614. ret = platform_pci_choose_state(dev);
  615. if (ret != PCI_POWER_ERROR)
  616. return ret;
  617. switch (state.event) {
  618. case PM_EVENT_ON:
  619. return PCI_D0;
  620. case PM_EVENT_FREEZE:
  621. case PM_EVENT_PRETHAW:
  622. /* REVISIT both freeze and pre-thaw "should" use D0 */
  623. case PM_EVENT_SUSPEND:
  624. case PM_EVENT_HIBERNATE:
  625. return PCI_D3hot;
  626. default:
  627. dev_info(&dev->dev, "unrecognized suspend event %d\n",
  628. state.event);
  629. BUG();
  630. }
  631. return PCI_D0;
  632. }
  633. EXPORT_SYMBOL(pci_choose_state);
  634. #define PCI_EXP_SAVE_REGS 7
  635. #define pcie_cap_has_devctl(type, flags) 1
  636. #define pcie_cap_has_lnkctl(type, flags) \
  637. ((flags & PCI_EXP_FLAGS_VERS) > 1 || \
  638. (type == PCI_EXP_TYPE_ROOT_PORT || \
  639. type == PCI_EXP_TYPE_ENDPOINT || \
  640. type == PCI_EXP_TYPE_LEG_END))
  641. #define pcie_cap_has_sltctl(type, flags) \
  642. ((flags & PCI_EXP_FLAGS_VERS) > 1 || \
  643. ((type == PCI_EXP_TYPE_ROOT_PORT) || \
  644. (type == PCI_EXP_TYPE_DOWNSTREAM && \
  645. (flags & PCI_EXP_FLAGS_SLOT))))
  646. #define pcie_cap_has_rtctl(type, flags) \
  647. ((flags & PCI_EXP_FLAGS_VERS) > 1 || \
  648. (type == PCI_EXP_TYPE_ROOT_PORT || \
  649. type == PCI_EXP_TYPE_RC_EC))
  650. #define pcie_cap_has_devctl2(type, flags) \
  651. ((flags & PCI_EXP_FLAGS_VERS) > 1)
  652. #define pcie_cap_has_lnkctl2(type, flags) \
  653. ((flags & PCI_EXP_FLAGS_VERS) > 1)
  654. #define pcie_cap_has_sltctl2(type, flags) \
  655. ((flags & PCI_EXP_FLAGS_VERS) > 1)
  656. static int pci_save_pcie_state(struct pci_dev *dev)
  657. {
  658. int pos, i = 0;
  659. struct pci_cap_saved_state *save_state;
  660. u16 *cap;
  661. u16 flags;
  662. pos = pci_pcie_cap(dev);
  663. if (!pos)
  664. return 0;
  665. save_state = pci_find_saved_cap(dev, PCI_CAP_ID_EXP);
  666. if (!save_state) {
  667. dev_err(&dev->dev, "buffer not found in %s\n", __func__);
  668. return -ENOMEM;
  669. }
  670. cap = (u16 *)&save_state->data[0];
  671. pci_read_config_word(dev, pos + PCI_EXP_FLAGS, &flags);
  672. if (pcie_cap_has_devctl(dev->pcie_type, flags))
  673. pci_read_config_word(dev, pos + PCI_EXP_DEVCTL, &cap[i++]);
  674. if (pcie_cap_has_lnkctl(dev->pcie_type, flags))
  675. pci_read_config_word(dev, pos + PCI_EXP_LNKCTL, &cap[i++]);
  676. if (pcie_cap_has_sltctl(dev->pcie_type, flags))
  677. pci_read_config_word(dev, pos + PCI_EXP_SLTCTL, &cap[i++]);
  678. if (pcie_cap_has_rtctl(dev->pcie_type, flags))
  679. pci_read_config_word(dev, pos + PCI_EXP_RTCTL, &cap[i++]);
  680. if (pcie_cap_has_devctl2(dev->pcie_type, flags))
  681. pci_read_config_word(dev, pos + PCI_EXP_DEVCTL2, &cap[i++]);
  682. if (pcie_cap_has_lnkctl2(dev->pcie_type, flags))
  683. pci_read_config_word(dev, pos + PCI_EXP_LNKCTL2, &cap[i++]);
  684. if (pcie_cap_has_sltctl2(dev->pcie_type, flags))
  685. pci_read_config_word(dev, pos + PCI_EXP_SLTCTL2, &cap[i++]);
  686. return 0;
  687. }
  688. static void pci_restore_pcie_state(struct pci_dev *dev)
  689. {
  690. int i = 0, pos;
  691. struct pci_cap_saved_state *save_state;
  692. u16 *cap;
  693. u16 flags;
  694. save_state = pci_find_saved_cap(dev, PCI_CAP_ID_EXP);
  695. pos = pci_find_capability(dev, PCI_CAP_ID_EXP);
  696. if (!save_state || pos <= 0)
  697. return;
  698. cap = (u16 *)&save_state->data[0];
  699. pci_read_config_word(dev, pos + PCI_EXP_FLAGS, &flags);
  700. if (pcie_cap_has_devctl(dev->pcie_type, flags))
  701. pci_write_config_word(dev, pos + PCI_EXP_DEVCTL, cap[i++]);
  702. if (pcie_cap_has_lnkctl(dev->pcie_type, flags))
  703. pci_write_config_word(dev, pos + PCI_EXP_LNKCTL, cap[i++]);
  704. if (pcie_cap_has_sltctl(dev->pcie_type, flags))
  705. pci_write_config_word(dev, pos + PCI_EXP_SLTCTL, cap[i++]);
  706. if (pcie_cap_has_rtctl(dev->pcie_type, flags))
  707. pci_write_config_word(dev, pos + PCI_EXP_RTCTL, cap[i++]);
  708. if (pcie_cap_has_devctl2(dev->pcie_type, flags))
  709. pci_write_config_word(dev, pos + PCI_EXP_DEVCTL2, cap[i++]);
  710. if (pcie_cap_has_lnkctl2(dev->pcie_type, flags))
  711. pci_write_config_word(dev, pos + PCI_EXP_LNKCTL2, cap[i++]);
  712. if (pcie_cap_has_sltctl2(dev->pcie_type, flags))
  713. pci_write_config_word(dev, pos + PCI_EXP_SLTCTL2, cap[i++]);
  714. }
  715. static int pci_save_pcix_state(struct pci_dev *dev)
  716. {
  717. int pos;
  718. struct pci_cap_saved_state *save_state;
  719. pos = pci_find_capability(dev, PCI_CAP_ID_PCIX);
  720. if (pos <= 0)
  721. return 0;
  722. save_state = pci_find_saved_cap(dev, PCI_CAP_ID_PCIX);
  723. if (!save_state) {
  724. dev_err(&dev->dev, "buffer not found in %s\n", __func__);
  725. return -ENOMEM;
  726. }
  727. pci_read_config_word(dev, pos + PCI_X_CMD, (u16 *)save_state->data);
  728. return 0;
  729. }
  730. static void pci_restore_pcix_state(struct pci_dev *dev)
  731. {
  732. int i = 0, pos;
  733. struct pci_cap_saved_state *save_state;
  734. u16 *cap;
  735. save_state = pci_find_saved_cap(dev, PCI_CAP_ID_PCIX);
  736. pos = pci_find_capability(dev, PCI_CAP_ID_PCIX);
  737. if (!save_state || pos <= 0)
  738. return;
  739. cap = (u16 *)&save_state->data[0];
  740. pci_write_config_word(dev, pos + PCI_X_CMD, cap[i++]);
  741. }
  742. /**
  743. * pci_save_state - save the PCI configuration space of a device before suspending
  744. * @dev: - PCI device that we're dealing with
  745. */
  746. int
  747. pci_save_state(struct pci_dev *dev)
  748. {
  749. int i;
  750. /* XXX: 100% dword access ok here? */
  751. for (i = 0; i < 16; i++)
  752. pci_read_config_dword(dev, i * 4, &dev->saved_config_space[i]);
  753. dev->state_saved = true;
  754. if ((i = pci_save_pcie_state(dev)) != 0)
  755. return i;
  756. if ((i = pci_save_pcix_state(dev)) != 0)
  757. return i;
  758. return 0;
  759. }
  760. /**
  761. * pci_restore_state - Restore the saved state of a PCI device
  762. * @dev: - PCI device that we're dealing with
  763. */
  764. int
  765. pci_restore_state(struct pci_dev *dev)
  766. {
  767. int i;
  768. u32 val;
  769. if (!dev->state_saved)
  770. return 0;
  771. /* PCI Express register must be restored first */
  772. pci_restore_pcie_state(dev);
  773. /*
  774. * The Base Address register should be programmed before the command
  775. * register(s)
  776. */
  777. for (i = 15; i >= 0; i--) {
  778. pci_read_config_dword(dev, i * 4, &val);
  779. if (val != dev->saved_config_space[i]) {
  780. dev_printk(KERN_DEBUG, &dev->dev, "restoring config "
  781. "space at offset %#x (was %#x, writing %#x)\n",
  782. i, val, (int)dev->saved_config_space[i]);
  783. pci_write_config_dword(dev,i * 4,
  784. dev->saved_config_space[i]);
  785. }
  786. }
  787. pci_restore_pcix_state(dev);
  788. pci_restore_msi_state(dev);
  789. pci_restore_iov_state(dev);
  790. dev->state_saved = false;
  791. return 0;
  792. }
  793. static int do_pci_enable_device(struct pci_dev *dev, int bars)
  794. {
  795. int err;
  796. err = pci_set_power_state(dev, PCI_D0);
  797. if (err < 0 && err != -EIO)
  798. return err;
  799. err = pcibios_enable_device(dev, bars);
  800. if (err < 0)
  801. return err;
  802. pci_fixup_device(pci_fixup_enable, dev);
  803. return 0;
  804. }
  805. /**
  806. * pci_reenable_device - Resume abandoned device
  807. * @dev: PCI device to be resumed
  808. *
  809. * Note this function is a backend of pci_default_resume and is not supposed
  810. * to be called by normal code, write proper resume handler and use it instead.
  811. */
  812. int pci_reenable_device(struct pci_dev *dev)
  813. {
  814. if (pci_is_enabled(dev))
  815. return do_pci_enable_device(dev, (1 << PCI_NUM_RESOURCES) - 1);
  816. return 0;
  817. }
  818. static int __pci_enable_device_flags(struct pci_dev *dev,
  819. resource_size_t flags)
  820. {
  821. int err;
  822. int i, bars = 0;
  823. if (atomic_add_return(1, &dev->enable_cnt) > 1)
  824. return 0; /* already enabled */
  825. for (i = 0; i < DEVICE_COUNT_RESOURCE; i++)
  826. if (dev->resource[i].flags & flags)
  827. bars |= (1 << i);
  828. err = do_pci_enable_device(dev, bars);
  829. if (err < 0)
  830. atomic_dec(&dev->enable_cnt);
  831. return err;
  832. }
  833. /**
  834. * pci_enable_device_io - Initialize a device for use with IO space
  835. * @dev: PCI device to be initialized
  836. *
  837. * Initialize device before it's used by a driver. Ask low-level code
  838. * to enable I/O resources. Wake up the device if it was suspended.
  839. * Beware, this function can fail.
  840. */
  841. int pci_enable_device_io(struct pci_dev *dev)
  842. {
  843. return __pci_enable_device_flags(dev, IORESOURCE_IO);
  844. }
  845. /**
  846. * pci_enable_device_mem - Initialize a device for use with Memory space
  847. * @dev: PCI device to be initialized
  848. *
  849. * Initialize device before it's used by a driver. Ask low-level code
  850. * to enable Memory resources. Wake up the device if it was suspended.
  851. * Beware, this function can fail.
  852. */
  853. int pci_enable_device_mem(struct pci_dev *dev)
  854. {
  855. return __pci_enable_device_flags(dev, IORESOURCE_MEM);
  856. }
  857. /**
  858. * pci_enable_device - Initialize device before it's used by a driver.
  859. * @dev: PCI device to be initialized
  860. *
  861. * Initialize device before it's used by a driver. Ask low-level code
  862. * to enable I/O and memory. Wake up the device if it was suspended.
  863. * Beware, this function can fail.
  864. *
  865. * Note we don't actually enable the device many times if we call
  866. * this function repeatedly (we just increment the count).
  867. */
  868. int pci_enable_device(struct pci_dev *dev)
  869. {
  870. return __pci_enable_device_flags(dev, IORESOURCE_MEM | IORESOURCE_IO);
  871. }
  872. /*
  873. * Managed PCI resources. This manages device on/off, intx/msi/msix
  874. * on/off and BAR regions. pci_dev itself records msi/msix status, so
  875. * there's no need to track it separately. pci_devres is initialized
  876. * when a device is enabled using managed PCI device enable interface.
  877. */
  878. struct pci_devres {
  879. unsigned int enabled:1;
  880. unsigned int pinned:1;
  881. unsigned int orig_intx:1;
  882. unsigned int restore_intx:1;
  883. u32 region_mask;
  884. };
  885. static void pcim_release(struct device *gendev, void *res)
  886. {
  887. struct pci_dev *dev = container_of(gendev, struct pci_dev, dev);
  888. struct pci_devres *this = res;
  889. int i;
  890. if (dev->msi_enabled)
  891. pci_disable_msi(dev);
  892. if (dev->msix_enabled)
  893. pci_disable_msix(dev);
  894. for (i = 0; i < DEVICE_COUNT_RESOURCE; i++)
  895. if (this->region_mask & (1 << i))
  896. pci_release_region(dev, i);
  897. if (this->restore_intx)
  898. pci_intx(dev, this->orig_intx);
  899. if (this->enabled && !this->pinned)
  900. pci_disable_device(dev);
  901. }
  902. static struct pci_devres * get_pci_dr(struct pci_dev *pdev)
  903. {
  904. struct pci_devres *dr, *new_dr;
  905. dr = devres_find(&pdev->dev, pcim_release, NULL, NULL);
  906. if (dr)
  907. return dr;
  908. new_dr = devres_alloc(pcim_release, sizeof(*new_dr), GFP_KERNEL);
  909. if (!new_dr)
  910. return NULL;
  911. return devres_get(&pdev->dev, new_dr, NULL, NULL);
  912. }
  913. static struct pci_devres * find_pci_dr(struct pci_dev *pdev)
  914. {
  915. if (pci_is_managed(pdev))
  916. return devres_find(&pdev->dev, pcim_release, NULL, NULL);
  917. return NULL;
  918. }
  919. /**
  920. * pcim_enable_device - Managed pci_enable_device()
  921. * @pdev: PCI device to be initialized
  922. *
  923. * Managed pci_enable_device().
  924. */
  925. int pcim_enable_device(struct pci_dev *pdev)
  926. {
  927. struct pci_devres *dr;
  928. int rc;
  929. dr = get_pci_dr(pdev);
  930. if (unlikely(!dr))
  931. return -ENOMEM;
  932. if (dr->enabled)
  933. return 0;
  934. rc = pci_enable_device(pdev);
  935. if (!rc) {
  936. pdev->is_managed = 1;
  937. dr->enabled = 1;
  938. }
  939. return rc;
  940. }
  941. /**
  942. * pcim_pin_device - Pin managed PCI device
  943. * @pdev: PCI device to pin
  944. *
  945. * Pin managed PCI device @pdev. Pinned device won't be disabled on
  946. * driver detach. @pdev must have been enabled with
  947. * pcim_enable_device().
  948. */
  949. void pcim_pin_device(struct pci_dev *pdev)
  950. {
  951. struct pci_devres *dr;
  952. dr = find_pci_dr(pdev);
  953. WARN_ON(!dr || !dr->enabled);
  954. if (dr)
  955. dr->pinned = 1;
  956. }
  957. /**
  958. * pcibios_disable_device - disable arch specific PCI resources for device dev
  959. * @dev: the PCI device to disable
  960. *
  961. * Disables architecture specific PCI resources for the device. This
  962. * is the default implementation. Architecture implementations can
  963. * override this.
  964. */
  965. void __attribute__ ((weak)) pcibios_disable_device (struct pci_dev *dev) {}
  966. static void do_pci_disable_device(struct pci_dev *dev)
  967. {
  968. u16 pci_command;
  969. pci_read_config_word(dev, PCI_COMMAND, &pci_command);
  970. if (pci_command & PCI_COMMAND_MASTER) {
  971. pci_command &= ~PCI_COMMAND_MASTER;
  972. pci_write_config_word(dev, PCI_COMMAND, pci_command);
  973. }
  974. pcibios_disable_device(dev);
  975. }
  976. /**
  977. * pci_disable_enabled_device - Disable device without updating enable_cnt
  978. * @dev: PCI device to disable
  979. *
  980. * NOTE: This function is a backend of PCI power management routines and is
  981. * not supposed to be called drivers.
  982. */
  983. void pci_disable_enabled_device(struct pci_dev *dev)
  984. {
  985. if (pci_is_enabled(dev))
  986. do_pci_disable_device(dev);
  987. }
  988. /**
  989. * pci_disable_device - Disable PCI device after use
  990. * @dev: PCI device to be disabled
  991. *
  992. * Signal to the system that the PCI device is not in use by the system
  993. * anymore. This only involves disabling PCI bus-mastering, if active.
  994. *
  995. * Note we don't actually disable the device until all callers of
  996. * pci_device_enable() have called pci_device_disable().
  997. */
  998. void
  999. pci_disable_device(struct pci_dev *dev)
  1000. {
  1001. struct pci_devres *dr;
  1002. dr = find_pci_dr(dev);
  1003. if (dr)
  1004. dr->enabled = 0;
  1005. if (atomic_sub_return(1, &dev->enable_cnt) != 0)
  1006. return;
  1007. do_pci_disable_device(dev);
  1008. dev->is_busmaster = 0;
  1009. }
  1010. /**
  1011. * pcibios_set_pcie_reset_state - set reset state for device dev
  1012. * @dev: the PCIe device reset
  1013. * @state: Reset state to enter into
  1014. *
  1015. *
  1016. * Sets the PCIe reset state for the device. This is the default
  1017. * implementation. Architecture implementations can override this.
  1018. */
  1019. int __attribute__ ((weak)) pcibios_set_pcie_reset_state(struct pci_dev *dev,
  1020. enum pcie_reset_state state)
  1021. {
  1022. return -EINVAL;
  1023. }
  1024. /**
  1025. * pci_set_pcie_reset_state - set reset state for device dev
  1026. * @dev: the PCIe device reset
  1027. * @state: Reset state to enter into
  1028. *
  1029. *
  1030. * Sets the PCI reset state for the device.
  1031. */
  1032. int pci_set_pcie_reset_state(struct pci_dev *dev, enum pcie_reset_state state)
  1033. {
  1034. return pcibios_set_pcie_reset_state(dev, state);
  1035. }
  1036. /**
  1037. * pci_check_pme_status - Check if given device has generated PME.
  1038. * @dev: Device to check.
  1039. *
  1040. * Check the PME status of the device and if set, clear it and clear PME enable
  1041. * (if set). Return 'true' if PME status and PME enable were both set or
  1042. * 'false' otherwise.
  1043. */
  1044. bool pci_check_pme_status(struct pci_dev *dev)
  1045. {
  1046. int pmcsr_pos;
  1047. u16 pmcsr;
  1048. bool ret = false;
  1049. if (!dev->pm_cap)
  1050. return false;
  1051. pmcsr_pos = dev->pm_cap + PCI_PM_CTRL;
  1052. pci_read_config_word(dev, pmcsr_pos, &pmcsr);
  1053. if (!(pmcsr & PCI_PM_CTRL_PME_STATUS))
  1054. return false;
  1055. /* Clear PME status. */
  1056. pmcsr |= PCI_PM_CTRL_PME_STATUS;
  1057. if (pmcsr & PCI_PM_CTRL_PME_ENABLE) {
  1058. /* Disable PME to avoid interrupt flood. */
  1059. pmcsr &= ~PCI_PM_CTRL_PME_ENABLE;
  1060. ret = true;
  1061. }
  1062. pci_write_config_word(dev, pmcsr_pos, pmcsr);
  1063. return ret;
  1064. }
  1065. /**
  1066. * pci_pme_wakeup - Wake up a PCI device if its PME Status bit is set.
  1067. * @dev: Device to handle.
  1068. * @ign: Ignored.
  1069. *
  1070. * Check if @dev has generated PME and queue a resume request for it in that
  1071. * case.
  1072. */
  1073. static int pci_pme_wakeup(struct pci_dev *dev, void *ign)
  1074. {
  1075. if (pci_check_pme_status(dev))
  1076. pm_request_resume(&dev->dev);
  1077. return 0;
  1078. }
  1079. /**
  1080. * pci_pme_wakeup_bus - Walk given bus and wake up devices on it, if necessary.
  1081. * @bus: Top bus of the subtree to walk.
  1082. */
  1083. void pci_pme_wakeup_bus(struct pci_bus *bus)
  1084. {
  1085. if (bus)
  1086. pci_walk_bus(bus, pci_pme_wakeup, NULL);
  1087. }
  1088. /**
  1089. * pci_pme_capable - check the capability of PCI device to generate PME#
  1090. * @dev: PCI device to handle.
  1091. * @state: PCI state from which device will issue PME#.
  1092. */
  1093. bool pci_pme_capable(struct pci_dev *dev, pci_power_t state)
  1094. {
  1095. if (!dev->pm_cap)
  1096. return false;
  1097. return !!(dev->pme_support & (1 << state));
  1098. }
  1099. /**
  1100. * pci_pme_active - enable or disable PCI device's PME# function
  1101. * @dev: PCI device to handle.
  1102. * @enable: 'true' to enable PME# generation; 'false' to disable it.
  1103. *
  1104. * The caller must verify that the device is capable of generating PME# before
  1105. * calling this function with @enable equal to 'true'.
  1106. */
  1107. void pci_pme_active(struct pci_dev *dev, bool enable)
  1108. {
  1109. u16 pmcsr;
  1110. if (!dev->pm_cap)
  1111. return;
  1112. pci_read_config_word(dev, dev->pm_cap + PCI_PM_CTRL, &pmcsr);
  1113. /* Clear PME_Status by writing 1 to it and enable PME# */
  1114. pmcsr |= PCI_PM_CTRL_PME_STATUS | PCI_PM_CTRL_PME_ENABLE;
  1115. if (!enable)
  1116. pmcsr &= ~PCI_PM_CTRL_PME_ENABLE;
  1117. pci_write_config_word(dev, dev->pm_cap + PCI_PM_CTRL, pmcsr);
  1118. dev_printk(KERN_DEBUG, &dev->dev, "PME# %s\n",
  1119. enable ? "enabled" : "disabled");
  1120. }
  1121. /**
  1122. * __pci_enable_wake - enable PCI device as wakeup event source
  1123. * @dev: PCI device affected
  1124. * @state: PCI state from which device will issue wakeup events
  1125. * @runtime: True if the events are to be generated at run time
  1126. * @enable: True to enable event generation; false to disable
  1127. *
  1128. * This enables the device as a wakeup event source, or disables it.
  1129. * When such events involves platform-specific hooks, those hooks are
  1130. * called automatically by this routine.
  1131. *
  1132. * Devices with legacy power management (no standard PCI PM capabilities)
  1133. * always require such platform hooks.
  1134. *
  1135. * RETURN VALUE:
  1136. * 0 is returned on success
  1137. * -EINVAL is returned if device is not supposed to wake up the system
  1138. * Error code depending on the platform is returned if both the platform and
  1139. * the native mechanism fail to enable the generation of wake-up events
  1140. */
  1141. int __pci_enable_wake(struct pci_dev *dev, pci_power_t state,
  1142. bool runtime, bool enable)
  1143. {
  1144. int ret = 0;
  1145. if (enable && !runtime && !device_may_wakeup(&dev->dev))
  1146. return -EINVAL;
  1147. /* Don't do the same thing twice in a row for one device. */
  1148. if (!!enable == !!dev->wakeup_prepared)
  1149. return 0;
  1150. /*
  1151. * According to "PCI System Architecture" 4th ed. by Tom Shanley & Don
  1152. * Anderson we should be doing PME# wake enable followed by ACPI wake
  1153. * enable. To disable wake-up we call the platform first, for symmetry.
  1154. */
  1155. if (enable) {
  1156. int error;
  1157. if (pci_pme_capable(dev, state))
  1158. pci_pme_active(dev, true);
  1159. else
  1160. ret = 1;
  1161. error = runtime ? platform_pci_run_wake(dev, true) :
  1162. platform_pci_sleep_wake(dev, true);
  1163. if (ret)
  1164. ret = error;
  1165. if (!ret)
  1166. dev->wakeup_prepared = true;
  1167. } else {
  1168. if (runtime)
  1169. platform_pci_run_wake(dev, false);
  1170. else
  1171. platform_pci_sleep_wake(dev, false);
  1172. pci_pme_active(dev, false);
  1173. dev->wakeup_prepared = false;
  1174. }
  1175. return ret;
  1176. }
  1177. EXPORT_SYMBOL(__pci_enable_wake);
  1178. /**
  1179. * pci_wake_from_d3 - enable/disable device to wake up from D3_hot or D3_cold
  1180. * @dev: PCI device to prepare
  1181. * @enable: True to enable wake-up event generation; false to disable
  1182. *
  1183. * Many drivers want the device to wake up the system from D3_hot or D3_cold
  1184. * and this function allows them to set that up cleanly - pci_enable_wake()
  1185. * should not be called twice in a row to enable wake-up due to PCI PM vs ACPI
  1186. * ordering constraints.
  1187. *
  1188. * This function only returns error code if the device is not capable of
  1189. * generating PME# from both D3_hot and D3_cold, and the platform is unable to
  1190. * enable wake-up power for it.
  1191. */
  1192. int pci_wake_from_d3(struct pci_dev *dev, bool enable)
  1193. {
  1194. return pci_pme_capable(dev, PCI_D3cold) ?
  1195. pci_enable_wake(dev, PCI_D3cold, enable) :
  1196. pci_enable_wake(dev, PCI_D3hot, enable);
  1197. }
  1198. /**
  1199. * pci_target_state - find an appropriate low power state for a given PCI dev
  1200. * @dev: PCI device
  1201. *
  1202. * Use underlying platform code to find a supported low power state for @dev.
  1203. * If the platform can't manage @dev, return the deepest state from which it
  1204. * can generate wake events, based on any available PME info.
  1205. */
  1206. pci_power_t pci_target_state(struct pci_dev *dev)
  1207. {
  1208. pci_power_t target_state = PCI_D3hot;
  1209. if (platform_pci_power_manageable(dev)) {
  1210. /*
  1211. * Call the platform to choose the target state of the device
  1212. * and enable wake-up from this state if supported.
  1213. */
  1214. pci_power_t state = platform_pci_choose_state(dev);
  1215. switch (state) {
  1216. case PCI_POWER_ERROR:
  1217. case PCI_UNKNOWN:
  1218. break;
  1219. case PCI_D1:
  1220. case PCI_D2:
  1221. if (pci_no_d1d2(dev))
  1222. break;
  1223. default:
  1224. target_state = state;
  1225. }
  1226. } else if (!dev->pm_cap) {
  1227. target_state = PCI_D0;
  1228. } else if (device_may_wakeup(&dev->dev)) {
  1229. /*
  1230. * Find the deepest state from which the device can generate
  1231. * wake-up events, make it the target state and enable device
  1232. * to generate PME#.
  1233. */
  1234. if (dev->pme_support) {
  1235. while (target_state
  1236. && !(dev->pme_support & (1 << target_state)))
  1237. target_state--;
  1238. }
  1239. }
  1240. return target_state;
  1241. }
  1242. /**
  1243. * pci_prepare_to_sleep - prepare PCI device for system-wide transition into a sleep state
  1244. * @dev: Device to handle.
  1245. *
  1246. * Choose the power state appropriate for the device depending on whether
  1247. * it can wake up the system and/or is power manageable by the platform
  1248. * (PCI_D3hot is the default) and put the device into that state.
  1249. */
  1250. int pci_prepare_to_sleep(struct pci_dev *dev)
  1251. {
  1252. pci_power_t target_state = pci_target_state(dev);
  1253. int error;
  1254. if (target_state == PCI_POWER_ERROR)
  1255. return -EIO;
  1256. pci_enable_wake(dev, target_state, device_may_wakeup(&dev->dev));
  1257. error = pci_set_power_state(dev, target_state);
  1258. if (error)
  1259. pci_enable_wake(dev, target_state, false);
  1260. return error;
  1261. }
  1262. /**
  1263. * pci_back_from_sleep - turn PCI device on during system-wide transition into working state
  1264. * @dev: Device to handle.
  1265. *
  1266. * Disable device's sytem wake-up capability and put it into D0.
  1267. */
  1268. int pci_back_from_sleep(struct pci_dev *dev)
  1269. {
  1270. pci_enable_wake(dev, PCI_D0, false);
  1271. return pci_set_power_state(dev, PCI_D0);
  1272. }
  1273. /**
  1274. * pci_finish_runtime_suspend - Carry out PCI-specific part of runtime suspend.
  1275. * @dev: PCI device being suspended.
  1276. *
  1277. * Prepare @dev to generate wake-up events at run time and put it into a low
  1278. * power state.
  1279. */
  1280. int pci_finish_runtime_suspend(struct pci_dev *dev)
  1281. {
  1282. pci_power_t target_state = pci_target_state(dev);
  1283. int error;
  1284. if (target_state == PCI_POWER_ERROR)
  1285. return -EIO;
  1286. __pci_enable_wake(dev, target_state, true, pci_dev_run_wake(dev));
  1287. error = pci_set_power_state(dev, target_state);
  1288. if (error)
  1289. __pci_enable_wake(dev, target_state, true, false);
  1290. return error;
  1291. }
  1292. /**
  1293. * pci_dev_run_wake - Check if device can generate run-time wake-up events.
  1294. * @dev: Device to check.
  1295. *
  1296. * Return true if the device itself is cabable of generating wake-up events
  1297. * (through the platform or using the native PCIe PME) or if the device supports
  1298. * PME and one of its upstream bridges can generate wake-up events.
  1299. */
  1300. bool pci_dev_run_wake(struct pci_dev *dev)
  1301. {
  1302. struct pci_bus *bus = dev->bus;
  1303. if (device_run_wake(&dev->dev))
  1304. return true;
  1305. if (!dev->pme_support)
  1306. return false;
  1307. while (bus->parent) {
  1308. struct pci_dev *bridge = bus->self;
  1309. if (device_run_wake(&bridge->dev))
  1310. return true;
  1311. bus = bus->parent;
  1312. }
  1313. /* We have reached the root bus. */
  1314. if (bus->bridge)
  1315. return device_run_wake(bus->bridge);
  1316. return false;
  1317. }
  1318. EXPORT_SYMBOL_GPL(pci_dev_run_wake);
  1319. /**
  1320. * pci_pm_init - Initialize PM functions of given PCI device
  1321. * @dev: PCI device to handle.
  1322. */
  1323. void pci_pm_init(struct pci_dev *dev)
  1324. {
  1325. int pm;
  1326. u16 pmc;
  1327. dev->wakeup_prepared = false;
  1328. dev->pm_cap = 0;
  1329. /* find PCI PM capability in list */
  1330. pm = pci_find_capability(dev, PCI_CAP_ID_PM);
  1331. if (!pm)
  1332. return;
  1333. /* Check device's ability to generate PME# */
  1334. pci_read_config_word(dev, pm + PCI_PM_PMC, &pmc);
  1335. if ((pmc & PCI_PM_CAP_VER_MASK) > 3) {
  1336. dev_err(&dev->dev, "unsupported PM cap regs version (%u)\n",
  1337. pmc & PCI_PM_CAP_VER_MASK);
  1338. return;
  1339. }
  1340. dev->pm_cap = pm;
  1341. dev->d3_delay = PCI_PM_D3_WAIT;
  1342. dev->d1_support = false;
  1343. dev->d2_support = false;
  1344. if (!pci_no_d1d2(dev)) {
  1345. if (pmc & PCI_PM_CAP_D1)
  1346. dev->d1_support = true;
  1347. if (pmc & PCI_PM_CAP_D2)
  1348. dev->d2_support = true;
  1349. if (dev->d1_support || dev->d2_support)
  1350. dev_printk(KERN_DEBUG, &dev->dev, "supports%s%s\n",
  1351. dev->d1_support ? " D1" : "",
  1352. dev->d2_support ? " D2" : "");
  1353. }
  1354. pmc &= PCI_PM_CAP_PME_MASK;
  1355. if (pmc) {
  1356. dev_printk(KERN_DEBUG, &dev->dev,
  1357. "PME# supported from%s%s%s%s%s\n",
  1358. (pmc & PCI_PM_CAP_PME_D0) ? " D0" : "",
  1359. (pmc & PCI_PM_CAP_PME_D1) ? " D1" : "",
  1360. (pmc & PCI_PM_CAP_PME_D2) ? " D2" : "",
  1361. (pmc & PCI_PM_CAP_PME_D3) ? " D3hot" : "",
  1362. (pmc & PCI_PM_CAP_PME_D3cold) ? " D3cold" : "");
  1363. dev->pme_support = pmc >> PCI_PM_CAP_PME_SHIFT;
  1364. /*
  1365. * Make device's PM flags reflect the wake-up capability, but
  1366. * let the user space enable it to wake up the system as needed.
  1367. */
  1368. device_set_wakeup_capable(&dev->dev, true);
  1369. device_set_wakeup_enable(&dev->dev, false);
  1370. /* Disable the PME# generation functionality */
  1371. pci_pme_active(dev, false);
  1372. } else {
  1373. dev->pme_support = 0;
  1374. }
  1375. }
  1376. /**
  1377. * platform_pci_wakeup_init - init platform wakeup if present
  1378. * @dev: PCI device
  1379. *
  1380. * Some devices don't have PCI PM caps but can still generate wakeup
  1381. * events through platform methods (like ACPI events). If @dev supports
  1382. * platform wakeup events, set the device flag to indicate as much. This
  1383. * may be redundant if the device also supports PCI PM caps, but double
  1384. * initialization should be safe in that case.
  1385. */
  1386. void platform_pci_wakeup_init(struct pci_dev *dev)
  1387. {
  1388. if (!platform_pci_can_wakeup(dev))
  1389. return;
  1390. device_set_wakeup_capable(&dev->dev, true);
  1391. device_set_wakeup_enable(&dev->dev, false);
  1392. platform_pci_sleep_wake(dev, false);
  1393. }
  1394. /**
  1395. * pci_add_save_buffer - allocate buffer for saving given capability registers
  1396. * @dev: the PCI device
  1397. * @cap: the capability to allocate the buffer for
  1398. * @size: requested size of the buffer
  1399. */
  1400. static int pci_add_cap_save_buffer(
  1401. struct pci_dev *dev, char cap, unsigned int size)
  1402. {
  1403. int pos;
  1404. struct pci_cap_saved_state *save_state;
  1405. pos = pci_find_capability(dev, cap);
  1406. if (pos <= 0)
  1407. return 0;
  1408. save_state = kzalloc(sizeof(*save_state) + size, GFP_KERNEL);
  1409. if (!save_state)
  1410. return -ENOMEM;
  1411. save_state->cap_nr = cap;
  1412. pci_add_saved_cap(dev, save_state);
  1413. return 0;
  1414. }
  1415. /**
  1416. * pci_allocate_cap_save_buffers - allocate buffers for saving capabilities
  1417. * @dev: the PCI device
  1418. */
  1419. void pci_allocate_cap_save_buffers(struct pci_dev *dev)
  1420. {
  1421. int error;
  1422. error = pci_add_cap_save_buffer(dev, PCI_CAP_ID_EXP,
  1423. PCI_EXP_SAVE_REGS * sizeof(u16));
  1424. if (error)
  1425. dev_err(&dev->dev,
  1426. "unable to preallocate PCI Express save buffer\n");
  1427. error = pci_add_cap_save_buffer(dev, PCI_CAP_ID_PCIX, sizeof(u16));
  1428. if (error)
  1429. dev_err(&dev->dev,
  1430. "unable to preallocate PCI-X save buffer\n");
  1431. }
  1432. /**
  1433. * pci_enable_ari - enable ARI forwarding if hardware support it
  1434. * @dev: the PCI device
  1435. */
  1436. void pci_enable_ari(struct pci_dev *dev)
  1437. {
  1438. int pos;
  1439. u32 cap;
  1440. u16 ctrl;
  1441. struct pci_dev *bridge;
  1442. if (!pci_is_pcie(dev) || dev->devfn)
  1443. return;
  1444. pos = pci_find_ext_capability(dev, PCI_EXT_CAP_ID_ARI);
  1445. if (!pos)
  1446. return;
  1447. bridge = dev->bus->self;
  1448. if (!bridge || !pci_is_pcie(bridge))
  1449. return;
  1450. pos = pci_pcie_cap(bridge);
  1451. if (!pos)
  1452. return;
  1453. pci_read_config_dword(bridge, pos + PCI_EXP_DEVCAP2, &cap);
  1454. if (!(cap & PCI_EXP_DEVCAP2_ARI))
  1455. return;
  1456. pci_read_config_word(bridge, pos + PCI_EXP_DEVCTL2, &ctrl);
  1457. ctrl |= PCI_EXP_DEVCTL2_ARI;
  1458. pci_write_config_word(bridge, pos + PCI_EXP_DEVCTL2, ctrl);
  1459. bridge->ari_enabled = 1;
  1460. }
  1461. static int pci_acs_enable;
  1462. /**
  1463. * pci_request_acs - ask for ACS to be enabled if supported
  1464. */
  1465. void pci_request_acs(void)
  1466. {
  1467. pci_acs_enable = 1;
  1468. }
  1469. /**
  1470. * pci_enable_acs - enable ACS if hardware support it
  1471. * @dev: the PCI device
  1472. */
  1473. void pci_enable_acs(struct pci_dev *dev)
  1474. {
  1475. int pos;
  1476. u16 cap;
  1477. u16 ctrl;
  1478. if (!pci_acs_enable)
  1479. return;
  1480. if (!pci_is_pcie(dev))
  1481. return;
  1482. pos = pci_find_ext_capability(dev, PCI_EXT_CAP_ID_ACS);
  1483. if (!pos)
  1484. return;
  1485. pci_read_config_word(dev, pos + PCI_ACS_CAP, &cap);
  1486. pci_read_config_word(dev, pos + PCI_ACS_CTRL, &ctrl);
  1487. /* Source Validation */
  1488. ctrl |= (cap & PCI_ACS_SV);
  1489. /* P2P Request Redirect */
  1490. ctrl |= (cap & PCI_ACS_RR);
  1491. /* P2P Completion Redirect */
  1492. ctrl |= (cap & PCI_ACS_CR);
  1493. /* Upstream Forwarding */
  1494. ctrl |= (cap & PCI_ACS_UF);
  1495. pci_write_config_word(dev, pos + PCI_ACS_CTRL, ctrl);
  1496. }
  1497. /**
  1498. * pci_swizzle_interrupt_pin - swizzle INTx for device behind bridge
  1499. * @dev: the PCI device
  1500. * @pin: the INTx pin (1=INTA, 2=INTB, 3=INTD, 4=INTD)
  1501. *
  1502. * Perform INTx swizzling for a device behind one level of bridge. This is
  1503. * required by section 9.1 of the PCI-to-PCI bridge specification for devices
  1504. * behind bridges on add-in cards. For devices with ARI enabled, the slot
  1505. * number is always 0 (see the Implementation Note in section 2.2.8.1 of
  1506. * the PCI Express Base Specification, Revision 2.1)
  1507. */
  1508. u8 pci_swizzle_interrupt_pin(struct pci_dev *dev, u8 pin)
  1509. {
  1510. int slot;
  1511. if (pci_ari_enabled(dev->bus))
  1512. slot = 0;
  1513. else
  1514. slot = PCI_SLOT(dev->devfn);
  1515. return (((pin - 1) + slot) % 4) + 1;
  1516. }
  1517. int
  1518. pci_get_interrupt_pin(struct pci_dev *dev, struct pci_dev **bridge)
  1519. {
  1520. u8 pin;
  1521. pin = dev->pin;
  1522. if (!pin)
  1523. return -1;
  1524. while (!pci_is_root_bus(dev->bus)) {
  1525. pin = pci_swizzle_interrupt_pin(dev, pin);
  1526. dev = dev->bus->self;
  1527. }
  1528. *bridge = dev;
  1529. return pin;
  1530. }
  1531. /**
  1532. * pci_common_swizzle - swizzle INTx all the way to root bridge
  1533. * @dev: the PCI device
  1534. * @pinp: pointer to the INTx pin value (1=INTA, 2=INTB, 3=INTD, 4=INTD)
  1535. *
  1536. * Perform INTx swizzling for a device. This traverses through all PCI-to-PCI
  1537. * bridges all the way up to a PCI root bus.
  1538. */
  1539. u8 pci_common_swizzle(struct pci_dev *dev, u8 *pinp)
  1540. {
  1541. u8 pin = *pinp;
  1542. while (!pci_is_root_bus(dev->bus)) {
  1543. pin = pci_swizzle_interrupt_pin(dev, pin);
  1544. dev = dev->bus->self;
  1545. }
  1546. *pinp = pin;
  1547. return PCI_SLOT(dev->devfn);
  1548. }
  1549. /**
  1550. * pci_release_region - Release a PCI bar
  1551. * @pdev: PCI device whose resources were previously reserved by pci_request_region
  1552. * @bar: BAR to release
  1553. *
  1554. * Releases the PCI I/O and memory resources previously reserved by a
  1555. * successful call to pci_request_region. Call this function only
  1556. * after all use of the PCI regions has ceased.
  1557. */
  1558. void pci_release_region(struct pci_dev *pdev, int bar)
  1559. {
  1560. struct pci_devres *dr;
  1561. if (pci_resource_len(pdev, bar) == 0)
  1562. return;
  1563. if (pci_resource_flags(pdev, bar) & IORESOURCE_IO)
  1564. release_region(pci_resource_start(pdev, bar),
  1565. pci_resource_len(pdev, bar));
  1566. else if (pci_resource_flags(pdev, bar) & IORESOURCE_MEM)
  1567. release_mem_region(pci_resource_start(pdev, bar),
  1568. pci_resource_len(pdev, bar));
  1569. dr = find_pci_dr(pdev);
  1570. if (dr)
  1571. dr->region_mask &= ~(1 << bar);
  1572. }
  1573. /**
  1574. * __pci_request_region - Reserved PCI I/O and memory resource
  1575. * @pdev: PCI device whose resources are to be reserved
  1576. * @bar: BAR to be reserved
  1577. * @res_name: Name to be associated with resource.
  1578. * @exclusive: whether the region access is exclusive or not
  1579. *
  1580. * Mark the PCI region associated with PCI device @pdev BR @bar as
  1581. * being reserved by owner @res_name. Do not access any
  1582. * address inside the PCI regions unless this call returns
  1583. * successfully.
  1584. *
  1585. * If @exclusive is set, then the region is marked so that userspace
  1586. * is explicitly not allowed to map the resource via /dev/mem or
  1587. * sysfs MMIO access.
  1588. *
  1589. * Returns 0 on success, or %EBUSY on error. A warning
  1590. * message is also printed on failure.
  1591. */
  1592. static int __pci_request_region(struct pci_dev *pdev, int bar, const char *res_name,
  1593. int exclusive)
  1594. {
  1595. struct pci_devres *dr;
  1596. if (pci_resource_len(pdev, bar) == 0)
  1597. return 0;
  1598. if (pci_resource_flags(pdev, bar) & IORESOURCE_IO) {
  1599. if (!request_region(pci_resource_start(pdev, bar),
  1600. pci_resource_len(pdev, bar), res_name))
  1601. goto err_out;
  1602. }
  1603. else if (pci_resource_flags(pdev, bar) & IORESOURCE_MEM) {
  1604. if (!__request_mem_region(pci_resource_start(pdev, bar),
  1605. pci_resource_len(pdev, bar), res_name,
  1606. exclusive))
  1607. goto err_out;
  1608. }
  1609. dr = find_pci_dr(pdev);
  1610. if (dr)
  1611. dr->region_mask |= 1 << bar;
  1612. return 0;
  1613. err_out:
  1614. dev_warn(&pdev->dev, "BAR %d: can't reserve %pR\n", bar,
  1615. &pdev->resource[bar]);
  1616. return -EBUSY;
  1617. }
  1618. /**
  1619. * pci_request_region - Reserve PCI I/O and memory resource
  1620. * @pdev: PCI device whose resources are to be reserved
  1621. * @bar: BAR to be reserved
  1622. * @res_name: Name to be associated with resource
  1623. *
  1624. * Mark the PCI region associated with PCI device @pdev BAR @bar as
  1625. * being reserved by owner @res_name. Do not access any
  1626. * address inside the PCI regions unless this call returns
  1627. * successfully.
  1628. *
  1629. * Returns 0 on success, or %EBUSY on error. A warning
  1630. * message is also printed on failure.
  1631. */
  1632. int pci_request_region(struct pci_dev *pdev, int bar, const char *res_name)
  1633. {
  1634. return __pci_request_region(pdev, bar, res_name, 0);
  1635. }
  1636. /**
  1637. * pci_request_region_exclusive - Reserved PCI I/O and memory resource
  1638. * @pdev: PCI device whose resources are to be reserved
  1639. * @bar: BAR to be reserved
  1640. * @res_name: Name to be associated with resource.
  1641. *
  1642. * Mark the PCI region associated with PCI device @pdev BR @bar as
  1643. * being reserved by owner @res_name. Do not access any
  1644. * address inside the PCI regions unless this call returns
  1645. * successfully.
  1646. *
  1647. * Returns 0 on success, or %EBUSY on error. A warning
  1648. * message is also printed on failure.
  1649. *
  1650. * The key difference that _exclusive makes it that userspace is
  1651. * explicitly not allowed to map the resource via /dev/mem or
  1652. * sysfs.
  1653. */
  1654. int pci_request_region_exclusive(struct pci_dev *pdev, int bar, const char *res_name)
  1655. {
  1656. return __pci_request_region(pdev, bar, res_name, IORESOURCE_EXCLUSIVE);
  1657. }
  1658. /**
  1659. * pci_release_selected_regions - Release selected PCI I/O and memory resources
  1660. * @pdev: PCI device whose resources were previously reserved
  1661. * @bars: Bitmask of BARs to be released
  1662. *
  1663. * Release selected PCI I/O and memory resources previously reserved.
  1664. * Call this function only after all use of the PCI regions has ceased.
  1665. */
  1666. void pci_release_selected_regions(struct pci_dev *pdev, int bars)
  1667. {
  1668. int i;
  1669. for (i = 0; i < 6; i++)
  1670. if (bars & (1 << i))
  1671. pci_release_region(pdev, i);
  1672. }
  1673. int __pci_request_selected_regions(struct pci_dev *pdev, int bars,
  1674. const char *res_name, int excl)
  1675. {
  1676. int i;
  1677. for (i = 0; i < 6; i++)
  1678. if (bars & (1 << i))
  1679. if (__pci_request_region(pdev, i, res_name, excl))
  1680. goto err_out;
  1681. return 0;
  1682. err_out:
  1683. while(--i >= 0)
  1684. if (bars & (1 << i))
  1685. pci_release_region(pdev, i);
  1686. return -EBUSY;
  1687. }
  1688. /**
  1689. * pci_request_selected_regions - Reserve selected PCI I/O and memory resources
  1690. * @pdev: PCI device whose resources are to be reserved
  1691. * @bars: Bitmask of BARs to be requested
  1692. * @res_name: Name to be associated with resource
  1693. */
  1694. int pci_request_selected_regions(struct pci_dev *pdev, int bars,
  1695. const char *res_name)
  1696. {
  1697. return __pci_request_selected_regions(pdev, bars, res_name, 0);
  1698. }
  1699. int pci_request_selected_regions_exclusive(struct pci_dev *pdev,
  1700. int bars, const char *res_name)
  1701. {
  1702. return __pci_request_selected_regions(pdev, bars, res_name,
  1703. IORESOURCE_EXCLUSIVE);
  1704. }
  1705. /**
  1706. * pci_release_regions - Release reserved PCI I/O and memory resources
  1707. * @pdev: PCI device whose resources were previously reserved by pci_request_regions
  1708. *
  1709. * Releases all PCI I/O and memory resources previously reserved by a
  1710. * successful call to pci_request_regions. Call this function only
  1711. * after all use of the PCI regions has ceased.
  1712. */
  1713. void pci_release_regions(struct pci_dev *pdev)
  1714. {
  1715. pci_release_selected_regions(pdev, (1 << 6) - 1);
  1716. }
  1717. /**
  1718. * pci_request_regions - Reserved PCI I/O and memory resources
  1719. * @pdev: PCI device whose resources are to be reserved
  1720. * @res_name: Name to be associated with resource.
  1721. *
  1722. * Mark all PCI regions associated with PCI device @pdev as
  1723. * being reserved by owner @res_name. Do not access any
  1724. * address inside the PCI regions unless this call returns
  1725. * successfully.
  1726. *
  1727. * Returns 0 on success, or %EBUSY on error. A warning
  1728. * message is also printed on failure.
  1729. */
  1730. int pci_request_regions(struct pci_dev *pdev, const char *res_name)
  1731. {
  1732. return pci_request_selected_regions(pdev, ((1 << 6) - 1), res_name);
  1733. }
  1734. /**
  1735. * pci_request_regions_exclusive - Reserved PCI I/O and memory resources
  1736. * @pdev: PCI device whose resources are to be reserved
  1737. * @res_name: Name to be associated with resource.
  1738. *
  1739. * Mark all PCI regions associated with PCI device @pdev as
  1740. * being reserved by owner @res_name. Do not access any
  1741. * address inside the PCI regions unless this call returns
  1742. * successfully.
  1743. *
  1744. * pci_request_regions_exclusive() will mark the region so that
  1745. * /dev/mem and the sysfs MMIO access will not be allowed.
  1746. *
  1747. * Returns 0 on success, or %EBUSY on error. A warning
  1748. * message is also printed on failure.
  1749. */
  1750. int pci_request_regions_exclusive(struct pci_dev *pdev, const char *res_name)
  1751. {
  1752. return pci_request_selected_regions_exclusive(pdev,
  1753. ((1 << 6) - 1), res_name);
  1754. }
  1755. static void __pci_set_master(struct pci_dev *dev, bool enable)
  1756. {
  1757. u16 old_cmd, cmd;
  1758. pci_read_config_word(dev, PCI_COMMAND, &old_cmd);
  1759. if (enable)
  1760. cmd = old_cmd | PCI_COMMAND_MASTER;
  1761. else
  1762. cmd = old_cmd & ~PCI_COMMAND_MASTER;
  1763. if (cmd != old_cmd) {
  1764. dev_dbg(&dev->dev, "%s bus mastering\n",
  1765. enable ? "enabling" : "disabling");
  1766. pci_write_config_word(dev, PCI_COMMAND, cmd);
  1767. }
  1768. dev->is_busmaster = enable;
  1769. }
  1770. /**
  1771. * pci_set_master - enables bus-mastering for device dev
  1772. * @dev: the PCI device to enable
  1773. *
  1774. * Enables bus-mastering on the device and calls pcibios_set_master()
  1775. * to do the needed arch specific settings.
  1776. */
  1777. void pci_set_master(struct pci_dev *dev)
  1778. {
  1779. __pci_set_master(dev, true);
  1780. pcibios_set_master(dev);
  1781. }
  1782. /**
  1783. * pci_clear_master - disables bus-mastering for device dev
  1784. * @dev: the PCI device to disable
  1785. */
  1786. void pci_clear_master(struct pci_dev *dev)
  1787. {
  1788. __pci_set_master(dev, false);
  1789. }
  1790. /**
  1791. * pci_set_cacheline_size - ensure the CACHE_LINE_SIZE register is programmed
  1792. * @dev: the PCI device for which MWI is to be enabled
  1793. *
  1794. * Helper function for pci_set_mwi.
  1795. * Originally copied from drivers/net/acenic.c.
  1796. * Copyright 1998-2001 by Jes Sorensen, <jes@trained-monkey.org>.
  1797. *
  1798. * RETURNS: An appropriate -ERRNO error value on error, or zero for success.
  1799. */
  1800. int pci_set_cacheline_size(struct pci_dev *dev)
  1801. {
  1802. u8 cacheline_size;
  1803. if (!pci_cache_line_size)
  1804. return -EINVAL;
  1805. /* Validate current setting: the PCI_CACHE_LINE_SIZE must be
  1806. equal to or multiple of the right value. */
  1807. pci_read_config_byte(dev, PCI_CACHE_LINE_SIZE, &cacheline_size);
  1808. if (cacheline_size >= pci_cache_line_size &&
  1809. (cacheline_size % pci_cache_line_size) == 0)
  1810. return 0;
  1811. /* Write the correct value. */
  1812. pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE, pci_cache_line_size);
  1813. /* Read it back. */
  1814. pci_read_config_byte(dev, PCI_CACHE_LINE_SIZE, &cacheline_size);
  1815. if (cacheline_size == pci_cache_line_size)
  1816. return 0;
  1817. dev_printk(KERN_DEBUG, &dev->dev, "cache line size of %d is not "
  1818. "supported\n", pci_cache_line_size << 2);
  1819. return -EINVAL;
  1820. }
  1821. EXPORT_SYMBOL_GPL(pci_set_cacheline_size);
  1822. #ifdef PCI_DISABLE_MWI
  1823. int pci_set_mwi(struct pci_dev *dev)
  1824. {
  1825. return 0;
  1826. }
  1827. int pci_try_set_mwi(struct pci_dev *dev)
  1828. {
  1829. return 0;
  1830. }
  1831. void pci_clear_mwi(struct pci_dev *dev)
  1832. {
  1833. }
  1834. #else
  1835. /**
  1836. * pci_set_mwi - enables memory-write-invalidate PCI transaction
  1837. * @dev: the PCI device for which MWI is enabled
  1838. *
  1839. * Enables the Memory-Write-Invalidate transaction in %PCI_COMMAND.
  1840. *
  1841. * RETURNS: An appropriate -ERRNO error value on error, or zero for success.
  1842. */
  1843. int
  1844. pci_set_mwi(struct pci_dev *dev)
  1845. {
  1846. int rc;
  1847. u16 cmd;
  1848. rc = pci_set_cacheline_size(dev);
  1849. if (rc)
  1850. return rc;
  1851. pci_read_config_word(dev, PCI_COMMAND, &cmd);
  1852. if (! (cmd & PCI_COMMAND_INVALIDATE)) {
  1853. dev_dbg(&dev->dev, "enabling Mem-Wr-Inval\n");
  1854. cmd |= PCI_COMMAND_INVALIDATE;
  1855. pci_write_config_word(dev, PCI_COMMAND, cmd);
  1856. }
  1857. return 0;
  1858. }
  1859. /**
  1860. * pci_try_set_mwi - enables memory-write-invalidate PCI transaction
  1861. * @dev: the PCI device for which MWI is enabled
  1862. *
  1863. * Enables the Memory-Write-Invalidate transaction in %PCI_COMMAND.
  1864. * Callers are not required to check the return value.
  1865. *
  1866. * RETURNS: An appropriate -ERRNO error value on error, or zero for success.
  1867. */
  1868. int pci_try_set_mwi(struct pci_dev *dev)
  1869. {
  1870. int rc = pci_set_mwi(dev);
  1871. return rc;
  1872. }
  1873. /**
  1874. * pci_clear_mwi - disables Memory-Write-Invalidate for device dev
  1875. * @dev: the PCI device to disable
  1876. *
  1877. * Disables PCI Memory-Write-Invalidate transaction on the device
  1878. */
  1879. void
  1880. pci_clear_mwi(struct pci_dev *dev)
  1881. {
  1882. u16 cmd;
  1883. pci_read_config_word(dev, PCI_COMMAND, &cmd);
  1884. if (cmd & PCI_COMMAND_INVALIDATE) {
  1885. cmd &= ~PCI_COMMAND_INVALIDATE;
  1886. pci_write_config_word(dev, PCI_COMMAND, cmd);
  1887. }
  1888. }
  1889. #endif /* ! PCI_DISABLE_MWI */
  1890. /**
  1891. * pci_intx - enables/disables PCI INTx for device dev
  1892. * @pdev: the PCI device to operate on
  1893. * @enable: boolean: whether to enable or disable PCI INTx
  1894. *
  1895. * Enables/disables PCI INTx for device dev
  1896. */
  1897. void
  1898. pci_intx(struct pci_dev *pdev, int enable)
  1899. {
  1900. u16 pci_command, new;
  1901. pci_read_config_word(pdev, PCI_COMMAND, &pci_command);
  1902. if (enable) {
  1903. new = pci_command & ~PCI_COMMAND_INTX_DISABLE;
  1904. } else {
  1905. new = pci_command | PCI_COMMAND_INTX_DISABLE;
  1906. }
  1907. if (new != pci_command) {
  1908. struct pci_devres *dr;
  1909. pci_write_config_word(pdev, PCI_COMMAND, new);
  1910. dr = find_pci_dr(pdev);
  1911. if (dr && !dr->restore_intx) {
  1912. dr->restore_intx = 1;
  1913. dr->orig_intx = !enable;
  1914. }
  1915. }
  1916. }
  1917. /**
  1918. * pci_msi_off - disables any msi or msix capabilities
  1919. * @dev: the PCI device to operate on
  1920. *
  1921. * If you want to use msi see pci_enable_msi and friends.
  1922. * This is a lower level primitive that allows us to disable
  1923. * msi operation at the device level.
  1924. */
  1925. void pci_msi_off(struct pci_dev *dev)
  1926. {
  1927. int pos;
  1928. u16 control;
  1929. pos = pci_find_capability(dev, PCI_CAP_ID_MSI);
  1930. if (pos) {
  1931. pci_read_config_word(dev, pos + PCI_MSI_FLAGS, &control);
  1932. control &= ~PCI_MSI_FLAGS_ENABLE;
  1933. pci_write_config_word(dev, pos + PCI_MSI_FLAGS, control);
  1934. }
  1935. pos = pci_find_capability(dev, PCI_CAP_ID_MSIX);
  1936. if (pos) {
  1937. pci_read_config_word(dev, pos + PCI_MSIX_FLAGS, &control);
  1938. control &= ~PCI_MSIX_FLAGS_ENABLE;
  1939. pci_write_config_word(dev, pos + PCI_MSIX_FLAGS, control);
  1940. }
  1941. }
  1942. #ifndef HAVE_ARCH_PCI_SET_DMA_MASK
  1943. /*
  1944. * These can be overridden by arch-specific implementations
  1945. */
  1946. int
  1947. pci_set_dma_mask(struct pci_dev *dev, u64 mask)
  1948. {
  1949. if (!pci_dma_supported(dev, mask))
  1950. return -EIO;
  1951. dev->dma_mask = mask;
  1952. dev_dbg(&dev->dev, "using %dbit DMA mask\n", fls64(mask));
  1953. return 0;
  1954. }
  1955. int
  1956. pci_set_consistent_dma_mask(struct pci_dev *dev, u64 mask)
  1957. {
  1958. if (!pci_dma_supported(dev, mask))
  1959. return -EIO;
  1960. dev->dev.coherent_dma_mask = mask;
  1961. dev_dbg(&dev->dev, "using %dbit consistent DMA mask\n", fls64(mask));
  1962. return 0;
  1963. }
  1964. #endif
  1965. #ifndef HAVE_ARCH_PCI_SET_DMA_MAX_SEGMENT_SIZE
  1966. int pci_set_dma_max_seg_size(struct pci_dev *dev, unsigned int size)
  1967. {
  1968. return dma_set_max_seg_size(&dev->dev, size);
  1969. }
  1970. EXPORT_SYMBOL(pci_set_dma_max_seg_size);
  1971. #endif
  1972. #ifndef HAVE_ARCH_PCI_SET_DMA_SEGMENT_BOUNDARY
  1973. int pci_set_dma_seg_boundary(struct pci_dev *dev, unsigned long mask)
  1974. {
  1975. return dma_set_seg_boundary(&dev->dev, mask);
  1976. }
  1977. EXPORT_SYMBOL(pci_set_dma_seg_boundary);
  1978. #endif
  1979. static int pcie_flr(struct pci_dev *dev, int probe)
  1980. {
  1981. int i;
  1982. int pos;
  1983. u32 cap;
  1984. u16 status, control;
  1985. pos = pci_pcie_cap(dev);
  1986. if (!pos)
  1987. return -ENOTTY;
  1988. pci_read_config_dword(dev, pos + PCI_EXP_DEVCAP, &cap);
  1989. if (!(cap & PCI_EXP_DEVCAP_FLR))
  1990. return -ENOTTY;
  1991. if (probe)
  1992. return 0;
  1993. /* Wait for Transaction Pending bit clean */
  1994. for (i = 0; i < 4; i++) {
  1995. if (i)
  1996. msleep((1 << (i - 1)) * 100);
  1997. pci_read_config_word(dev, pos + PCI_EXP_DEVSTA, &status);
  1998. if (!(status & PCI_EXP_DEVSTA_TRPND))
  1999. goto clear;
  2000. }
  2001. dev_err(&dev->dev, "transaction is not cleared; "
  2002. "proceeding with reset anyway\n");
  2003. clear:
  2004. pci_read_config_word(dev, pos + PCI_EXP_DEVCTL, &control);
  2005. control |= PCI_EXP_DEVCTL_BCR_FLR;
  2006. pci_write_config_word(dev, pos + PCI_EXP_DEVCTL, control);
  2007. msleep(100);
  2008. return 0;
  2009. }
  2010. static int pci_af_flr(struct pci_dev *dev, int probe)
  2011. {
  2012. int i;
  2013. int pos;
  2014. u8 cap;
  2015. u8 status;
  2016. pos = pci_find_capability(dev, PCI_CAP_ID_AF);
  2017. if (!pos)
  2018. return -ENOTTY;
  2019. pci_read_config_byte(dev, pos + PCI_AF_CAP, &cap);
  2020. if (!(cap & PCI_AF_CAP_TP) || !(cap & PCI_AF_CAP_FLR))
  2021. return -ENOTTY;
  2022. if (probe)
  2023. return 0;
  2024. /* Wait for Transaction Pending bit clean */
  2025. for (i = 0; i < 4; i++) {
  2026. if (i)
  2027. msleep((1 << (i - 1)) * 100);
  2028. pci_read_config_byte(dev, pos + PCI_AF_STATUS, &status);
  2029. if (!(status & PCI_AF_STATUS_TP))
  2030. goto clear;
  2031. }
  2032. dev_err(&dev->dev, "transaction is not cleared; "
  2033. "proceeding with reset anyway\n");
  2034. clear:
  2035. pci_write_config_byte(dev, pos + PCI_AF_CTRL, PCI_AF_CTRL_FLR);
  2036. msleep(100);
  2037. return 0;
  2038. }
  2039. static int pci_pm_reset(struct pci_dev *dev, int probe)
  2040. {
  2041. u16 csr;
  2042. if (!dev->pm_cap)
  2043. return -ENOTTY;
  2044. pci_read_config_word(dev, dev->pm_cap + PCI_PM_CTRL, &csr);
  2045. if (csr & PCI_PM_CTRL_NO_SOFT_RESET)
  2046. return -ENOTTY;
  2047. if (probe)
  2048. return 0;
  2049. if (dev->current_state != PCI_D0)
  2050. return -EINVAL;
  2051. csr &= ~PCI_PM_CTRL_STATE_MASK;
  2052. csr |= PCI_D3hot;
  2053. pci_write_config_word(dev, dev->pm_cap + PCI_PM_CTRL, csr);
  2054. pci_dev_d3_sleep(dev);
  2055. csr &= ~PCI_PM_CTRL_STATE_MASK;
  2056. csr |= PCI_D0;
  2057. pci_write_config_word(dev, dev->pm_cap + PCI_PM_CTRL, csr);
  2058. pci_dev_d3_sleep(dev);
  2059. return 0;
  2060. }
  2061. static int pci_parent_bus_reset(struct pci_dev *dev, int probe)
  2062. {
  2063. u16 ctrl;
  2064. struct pci_dev *pdev;
  2065. if (pci_is_root_bus(dev->bus) || dev->subordinate || !dev->bus->self)
  2066. return -ENOTTY;
  2067. list_for_each_entry(pdev, &dev->bus->devices, bus_list)
  2068. if (pdev != dev)
  2069. return -ENOTTY;
  2070. if (probe)
  2071. return 0;
  2072. pci_read_config_word(dev->bus->self, PCI_BRIDGE_CONTROL, &ctrl);
  2073. ctrl |= PCI_BRIDGE_CTL_BUS_RESET;
  2074. pci_write_config_word(dev->bus->self, PCI_BRIDGE_CONTROL, ctrl);
  2075. msleep(100);
  2076. ctrl &= ~PCI_BRIDGE_CTL_BUS_RESET;
  2077. pci_write_config_word(dev->bus->self, PCI_BRIDGE_CONTROL, ctrl);
  2078. msleep(100);
  2079. return 0;
  2080. }
  2081. static int pci_dev_reset(struct pci_dev *dev, int probe)
  2082. {
  2083. int rc;
  2084. might_sleep();
  2085. if (!probe) {
  2086. pci_block_user_cfg_access(dev);
  2087. /* block PM suspend, driver probe, etc. */
  2088. down(&dev->dev.sem);
  2089. }
  2090. rc = pci_dev_specific_reset(dev, probe);
  2091. if (rc != -ENOTTY)
  2092. goto done;
  2093. rc = pcie_flr(dev, probe);
  2094. if (rc != -ENOTTY)
  2095. goto done;
  2096. rc = pci_af_flr(dev, probe);
  2097. if (rc != -ENOTTY)
  2098. goto done;
  2099. rc = pci_pm_reset(dev, probe);
  2100. if (rc != -ENOTTY)
  2101. goto done;
  2102. rc = pci_parent_bus_reset(dev, probe);
  2103. done:
  2104. if (!probe) {
  2105. up(&dev->dev.sem);
  2106. pci_unblock_user_cfg_access(dev);
  2107. }
  2108. return rc;
  2109. }
  2110. /**
  2111. * __pci_reset_function - reset a PCI device function
  2112. * @dev: PCI device to reset
  2113. *
  2114. * Some devices allow an individual function to be reset without affecting
  2115. * other functions in the same device. The PCI device must be responsive
  2116. * to PCI config space in order to use this function.
  2117. *
  2118. * The device function is presumed to be unused when this function is called.
  2119. * Resetting the device will make the contents of PCI configuration space
  2120. * random, so any caller of this must be prepared to reinitialise the
  2121. * device including MSI, bus mastering, BARs, decoding IO and memory spaces,
  2122. * etc.
  2123. *
  2124. * Returns 0 if the device function was successfully reset or negative if the
  2125. * device doesn't support resetting a single function.
  2126. */
  2127. int __pci_reset_function(struct pci_dev *dev)
  2128. {
  2129. return pci_dev_reset(dev, 0);
  2130. }
  2131. EXPORT_SYMBOL_GPL(__pci_reset_function);
  2132. /**
  2133. * pci_probe_reset_function - check whether the device can be safely reset
  2134. * @dev: PCI device to reset
  2135. *
  2136. * Some devices allow an individual function to be reset without affecting
  2137. * other functions in the same device. The PCI device must be responsive
  2138. * to PCI config space in order to use this function.
  2139. *
  2140. * Returns 0 if the device function can be reset or negative if the
  2141. * device doesn't support resetting a single function.
  2142. */
  2143. int pci_probe_reset_function(struct pci_dev *dev)
  2144. {
  2145. return pci_dev_reset(dev, 1);
  2146. }
  2147. /**
  2148. * pci_reset_function - quiesce and reset a PCI device function
  2149. * @dev: PCI device to reset
  2150. *
  2151. * Some devices allow an individual function to be reset without affecting
  2152. * other functions in the same device. The PCI device must be responsive
  2153. * to PCI config space in order to use this function.
  2154. *
  2155. * This function does not just reset the PCI portion of a device, but
  2156. * clears all the state associated with the device. This function differs
  2157. * from __pci_reset_function in that it saves and restores device state
  2158. * over the reset.
  2159. *
  2160. * Returns 0 if the device function was successfully reset or negative if the
  2161. * device doesn't support resetting a single function.
  2162. */
  2163. int pci_reset_function(struct pci_dev *dev)
  2164. {
  2165. int rc;
  2166. rc = pci_dev_reset(dev, 1);
  2167. if (rc)
  2168. return rc;
  2169. pci_save_state(dev);
  2170. /*
  2171. * both INTx and MSI are disabled after the Interrupt Disable bit
  2172. * is set and the Bus Master bit is cleared.
  2173. */
  2174. pci_write_config_word(dev, PCI_COMMAND, PCI_COMMAND_INTX_DISABLE);
  2175. rc = pci_dev_reset(dev, 0);
  2176. pci_restore_state(dev);
  2177. return rc;
  2178. }
  2179. EXPORT_SYMBOL_GPL(pci_reset_function);
  2180. /**
  2181. * pcix_get_max_mmrbc - get PCI-X maximum designed memory read byte count
  2182. * @dev: PCI device to query
  2183. *
  2184. * Returns mmrbc: maximum designed memory read count in bytes
  2185. * or appropriate error value.
  2186. */
  2187. int pcix_get_max_mmrbc(struct pci_dev *dev)
  2188. {
  2189. int err, cap;
  2190. u32 stat;
  2191. cap = pci_find_capability(dev, PCI_CAP_ID_PCIX);
  2192. if (!cap)
  2193. return -EINVAL;
  2194. err = pci_read_config_dword(dev, cap + PCI_X_STATUS, &stat);
  2195. if (err)
  2196. return -EINVAL;
  2197. return (stat & PCI_X_STATUS_MAX_READ) >> 12;
  2198. }
  2199. EXPORT_SYMBOL(pcix_get_max_mmrbc);
  2200. /**
  2201. * pcix_get_mmrbc - get PCI-X maximum memory read byte count
  2202. * @dev: PCI device to query
  2203. *
  2204. * Returns mmrbc: maximum memory read count in bytes
  2205. * or appropriate error value.
  2206. */
  2207. int pcix_get_mmrbc(struct pci_dev *dev)
  2208. {
  2209. int ret, cap;
  2210. u32 cmd;
  2211. cap = pci_find_capability(dev, PCI_CAP_ID_PCIX);
  2212. if (!cap)
  2213. return -EINVAL;
  2214. ret = pci_read_config_dword(dev, cap + PCI_X_CMD, &cmd);
  2215. if (!ret)
  2216. ret = 512 << ((cmd & PCI_X_CMD_MAX_READ) >> 2);
  2217. return ret;
  2218. }
  2219. EXPORT_SYMBOL(pcix_get_mmrbc);
  2220. /**
  2221. * pcix_set_mmrbc - set PCI-X maximum memory read byte count
  2222. * @dev: PCI device to query
  2223. * @mmrbc: maximum memory read count in bytes
  2224. * valid values are 512, 1024, 2048, 4096
  2225. *
  2226. * If possible sets maximum memory read byte count, some bridges have erratas
  2227. * that prevent this.
  2228. */
  2229. int pcix_set_mmrbc(struct pci_dev *dev, int mmrbc)
  2230. {
  2231. int cap, err = -EINVAL;
  2232. u32 stat, cmd, v, o;
  2233. if (mmrbc < 512 || mmrbc > 4096 || !is_power_of_2(mmrbc))
  2234. goto out;
  2235. v = ffs(mmrbc) - 10;
  2236. cap = pci_find_capability(dev, PCI_CAP_ID_PCIX);
  2237. if (!cap)
  2238. goto out;
  2239. err = pci_read_config_dword(dev, cap + PCI_X_STATUS, &stat);
  2240. if (err)
  2241. goto out;
  2242. if (v > (stat & PCI_X_STATUS_MAX_READ) >> 21)
  2243. return -E2BIG;
  2244. err = pci_read_config_dword(dev, cap + PCI_X_CMD, &cmd);
  2245. if (err)
  2246. goto out;
  2247. o = (cmd & PCI_X_CMD_MAX_READ) >> 2;
  2248. if (o != v) {
  2249. if (v > o && dev->bus &&
  2250. (dev->bus->bus_flags & PCI_BUS_FLAGS_NO_MMRBC))
  2251. return -EIO;
  2252. cmd &= ~PCI_X_CMD_MAX_READ;
  2253. cmd |= v << 2;
  2254. err = pci_write_config_dword(dev, cap + PCI_X_CMD, cmd);
  2255. }
  2256. out:
  2257. return err;
  2258. }
  2259. EXPORT_SYMBOL(pcix_set_mmrbc);
  2260. /**
  2261. * pcie_get_readrq - get PCI Express read request size
  2262. * @dev: PCI device to query
  2263. *
  2264. * Returns maximum memory read request in bytes
  2265. * or appropriate error value.
  2266. */
  2267. int pcie_get_readrq(struct pci_dev *dev)
  2268. {
  2269. int ret, cap;
  2270. u16 ctl;
  2271. cap = pci_pcie_cap(dev);
  2272. if (!cap)
  2273. return -EINVAL;
  2274. ret = pci_read_config_word(dev, cap + PCI_EXP_DEVCTL, &ctl);
  2275. if (!ret)
  2276. ret = 128 << ((ctl & PCI_EXP_DEVCTL_READRQ) >> 12);
  2277. return ret;
  2278. }
  2279. EXPORT_SYMBOL(pcie_get_readrq);
  2280. /**
  2281. * pcie_set_readrq - set PCI Express maximum memory read request
  2282. * @dev: PCI device to query
  2283. * @rq: maximum memory read count in bytes
  2284. * valid values are 128, 256, 512, 1024, 2048, 4096
  2285. *
  2286. * If possible sets maximum read byte count
  2287. */
  2288. int pcie_set_readrq(struct pci_dev *dev, int rq)
  2289. {
  2290. int cap, err = -EINVAL;
  2291. u16 ctl, v;
  2292. if (rq < 128 || rq > 4096 || !is_power_of_2(rq))
  2293. goto out;
  2294. v = (ffs(rq) - 8) << 12;
  2295. cap = pci_pcie_cap(dev);
  2296. if (!cap)
  2297. goto out;
  2298. err = pci_read_config_word(dev, cap + PCI_EXP_DEVCTL, &ctl);
  2299. if (err)
  2300. goto out;
  2301. if ((ctl & PCI_EXP_DEVCTL_READRQ) != v) {
  2302. ctl &= ~PCI_EXP_DEVCTL_READRQ;
  2303. ctl |= v;
  2304. err = pci_write_config_dword(dev, cap + PCI_EXP_DEVCTL, ctl);
  2305. }
  2306. out:
  2307. return err;
  2308. }
  2309. EXPORT_SYMBOL(pcie_set_readrq);
  2310. /**
  2311. * pci_select_bars - Make BAR mask from the type of resource
  2312. * @dev: the PCI device for which BAR mask is made
  2313. * @flags: resource type mask to be selected
  2314. *
  2315. * This helper routine makes bar mask from the type of resource.
  2316. */
  2317. int pci_select_bars(struct pci_dev *dev, unsigned long flags)
  2318. {
  2319. int i, bars = 0;
  2320. for (i = 0; i < PCI_NUM_RESOURCES; i++)
  2321. if (pci_resource_flags(dev, i) & flags)
  2322. bars |= (1 << i);
  2323. return bars;
  2324. }
  2325. /**
  2326. * pci_resource_bar - get position of the BAR associated with a resource
  2327. * @dev: the PCI device
  2328. * @resno: the resource number
  2329. * @type: the BAR type to be filled in
  2330. *
  2331. * Returns BAR position in config space, or 0 if the BAR is invalid.
  2332. */
  2333. int pci_resource_bar(struct pci_dev *dev, int resno, enum pci_bar_type *type)
  2334. {
  2335. int reg;
  2336. if (resno < PCI_ROM_RESOURCE) {
  2337. *type = pci_bar_unknown;
  2338. return PCI_BASE_ADDRESS_0 + 4 * resno;
  2339. } else if (resno == PCI_ROM_RESOURCE) {
  2340. *type = pci_bar_mem32;
  2341. return dev->rom_base_reg;
  2342. } else if (resno < PCI_BRIDGE_RESOURCES) {
  2343. /* device specific resource */
  2344. reg = pci_iov_resource_bar(dev, resno, type);
  2345. if (reg)
  2346. return reg;
  2347. }
  2348. dev_err(&dev->dev, "BAR %d: invalid resource\n", resno);
  2349. return 0;
  2350. }
  2351. /**
  2352. * pci_set_vga_state - set VGA decode state on device and parents if requested
  2353. * @dev: the PCI device
  2354. * @decode: true = enable decoding, false = disable decoding
  2355. * @command_bits: PCI_COMMAND_IO and/or PCI_COMMAND_MEMORY
  2356. * @change_bridge: traverse ancestors and change bridges
  2357. */
  2358. int pci_set_vga_state(struct pci_dev *dev, bool decode,
  2359. unsigned int command_bits, bool change_bridge)
  2360. {
  2361. struct pci_bus *bus;
  2362. struct pci_dev *bridge;
  2363. u16 cmd;
  2364. WARN_ON(command_bits & ~(PCI_COMMAND_IO|PCI_COMMAND_MEMORY));
  2365. pci_read_config_word(dev, PCI_COMMAND, &cmd);
  2366. if (decode == true)
  2367. cmd |= command_bits;
  2368. else
  2369. cmd &= ~command_bits;
  2370. pci_write_config_word(dev, PCI_COMMAND, cmd);
  2371. if (change_bridge == false)
  2372. return 0;
  2373. bus = dev->bus;
  2374. while (bus) {
  2375. bridge = bus->self;
  2376. if (bridge) {
  2377. pci_read_config_word(bridge, PCI_BRIDGE_CONTROL,
  2378. &cmd);
  2379. if (decode == true)
  2380. cmd |= PCI_BRIDGE_CTL_VGA;
  2381. else
  2382. cmd &= ~PCI_BRIDGE_CTL_VGA;
  2383. pci_write_config_word(bridge, PCI_BRIDGE_CONTROL,
  2384. cmd);
  2385. }
  2386. bus = bus->parent;
  2387. }
  2388. return 0;
  2389. }
  2390. #define RESOURCE_ALIGNMENT_PARAM_SIZE COMMAND_LINE_SIZE
  2391. static char resource_alignment_param[RESOURCE_ALIGNMENT_PARAM_SIZE] = {0};
  2392. static DEFINE_SPINLOCK(resource_alignment_lock);
  2393. /**
  2394. * pci_specified_resource_alignment - get resource alignment specified by user.
  2395. * @dev: the PCI device to get
  2396. *
  2397. * RETURNS: Resource alignment if it is specified.
  2398. * Zero if it is not specified.
  2399. */
  2400. resource_size_t pci_specified_resource_alignment(struct pci_dev *dev)
  2401. {
  2402. int seg, bus, slot, func, align_order, count;
  2403. resource_size_t align = 0;
  2404. char *p;
  2405. spin_lock(&resource_alignment_lock);
  2406. p = resource_alignment_param;
  2407. while (*p) {
  2408. count = 0;
  2409. if (sscanf(p, "%d%n", &align_order, &count) == 1 &&
  2410. p[count] == '@') {
  2411. p += count + 1;
  2412. } else {
  2413. align_order = -1;
  2414. }
  2415. if (sscanf(p, "%x:%x:%x.%x%n",
  2416. &seg, &bus, &slot, &func, &count) != 4) {
  2417. seg = 0;
  2418. if (sscanf(p, "%x:%x.%x%n",
  2419. &bus, &slot, &func, &count) != 3) {
  2420. /* Invalid format */
  2421. printk(KERN_ERR "PCI: Can't parse resource_alignment parameter: %s\n",
  2422. p);
  2423. break;
  2424. }
  2425. }
  2426. p += count;
  2427. if (seg == pci_domain_nr(dev->bus) &&
  2428. bus == dev->bus->number &&
  2429. slot == PCI_SLOT(dev->devfn) &&
  2430. func == PCI_FUNC(dev->devfn)) {
  2431. if (align_order == -1) {
  2432. align = PAGE_SIZE;
  2433. } else {
  2434. align = 1 << align_order;
  2435. }
  2436. /* Found */
  2437. break;
  2438. }
  2439. if (*p != ';' && *p != ',') {
  2440. /* End of param or invalid format */
  2441. break;
  2442. }
  2443. p++;
  2444. }
  2445. spin_unlock(&resource_alignment_lock);
  2446. return align;
  2447. }
  2448. /**
  2449. * pci_is_reassigndev - check if specified PCI is target device to reassign
  2450. * @dev: the PCI device to check
  2451. *
  2452. * RETURNS: non-zero for PCI device is a target device to reassign,
  2453. * or zero is not.
  2454. */
  2455. int pci_is_reassigndev(struct pci_dev *dev)
  2456. {
  2457. return (pci_specified_resource_alignment(dev) != 0);
  2458. }
  2459. ssize_t pci_set_resource_alignment_param(const char *buf, size_t count)
  2460. {
  2461. if (count > RESOURCE_ALIGNMENT_PARAM_SIZE - 1)
  2462. count = RESOURCE_ALIGNMENT_PARAM_SIZE - 1;
  2463. spin_lock(&resource_alignment_lock);
  2464. strncpy(resource_alignment_param, buf, count);
  2465. resource_alignment_param[count] = '\0';
  2466. spin_unlock(&resource_alignment_lock);
  2467. return count;
  2468. }
  2469. ssize_t pci_get_resource_alignment_param(char *buf, size_t size)
  2470. {
  2471. size_t count;
  2472. spin_lock(&resource_alignment_lock);
  2473. count = snprintf(buf, size, "%s", resource_alignment_param);
  2474. spin_unlock(&resource_alignment_lock);
  2475. return count;
  2476. }
  2477. static ssize_t pci_resource_alignment_show(struct bus_type *bus, char *buf)
  2478. {
  2479. return pci_get_resource_alignment_param(buf, PAGE_SIZE);
  2480. }
  2481. static ssize_t pci_resource_alignment_store(struct bus_type *bus,
  2482. const char *buf, size_t count)
  2483. {
  2484. return pci_set_resource_alignment_param(buf, count);
  2485. }
  2486. BUS_ATTR(resource_alignment, 0644, pci_resource_alignment_show,
  2487. pci_resource_alignment_store);
  2488. static int __init pci_resource_alignment_sysfs_init(void)
  2489. {
  2490. return bus_create_file(&pci_bus_type,
  2491. &bus_attr_resource_alignment);
  2492. }
  2493. late_initcall(pci_resource_alignment_sysfs_init);
  2494. static void __devinit pci_no_domains(void)
  2495. {
  2496. #ifdef CONFIG_PCI_DOMAINS
  2497. pci_domains_supported = 0;
  2498. #endif
  2499. }
  2500. /**
  2501. * pci_ext_cfg_enabled - can we access extended PCI config space?
  2502. * @dev: The PCI device of the root bridge.
  2503. *
  2504. * Returns 1 if we can access PCI extended config space (offsets
  2505. * greater than 0xff). This is the default implementation. Architecture
  2506. * implementations can override this.
  2507. */
  2508. int __attribute__ ((weak)) pci_ext_cfg_avail(struct pci_dev *dev)
  2509. {
  2510. return 1;
  2511. }
  2512. void __weak pci_fixup_cardbus(struct pci_bus *bus)
  2513. {
  2514. }
  2515. EXPORT_SYMBOL(pci_fixup_cardbus);
  2516. static int __init pci_setup(char *str)
  2517. {
  2518. while (str) {
  2519. char *k = strchr(str, ',');
  2520. if (k)
  2521. *k++ = 0;
  2522. if (*str && (str = pcibios_setup(str)) && *str) {
  2523. if (!strcmp(str, "nomsi")) {
  2524. pci_no_msi();
  2525. } else if (!strcmp(str, "noaer")) {
  2526. pci_no_aer();
  2527. } else if (!strcmp(str, "nodomains")) {
  2528. pci_no_domains();
  2529. } else if (!strncmp(str, "cbiosize=", 9)) {
  2530. pci_cardbus_io_size = memparse(str + 9, &str);
  2531. } else if (!strncmp(str, "cbmemsize=", 10)) {
  2532. pci_cardbus_mem_size = memparse(str + 10, &str);
  2533. } else if (!strncmp(str, "resource_alignment=", 19)) {
  2534. pci_set_resource_alignment_param(str + 19,
  2535. strlen(str + 19));
  2536. } else if (!strncmp(str, "ecrc=", 5)) {
  2537. pcie_ecrc_get_policy(str + 5);
  2538. } else if (!strncmp(str, "hpiosize=", 9)) {
  2539. pci_hotplug_io_size = memparse(str + 9, &str);
  2540. } else if (!strncmp(str, "hpmemsize=", 10)) {
  2541. pci_hotplug_mem_size = memparse(str + 10, &str);
  2542. } else {
  2543. printk(KERN_ERR "PCI: Unknown option `%s'\n",
  2544. str);
  2545. }
  2546. }
  2547. str = k;
  2548. }
  2549. return 0;
  2550. }
  2551. early_param("pci", pci_setup);
  2552. EXPORT_SYMBOL(pci_reenable_device);
  2553. EXPORT_SYMBOL(pci_enable_device_io);
  2554. EXPORT_SYMBOL(pci_enable_device_mem);
  2555. EXPORT_SYMBOL(pci_enable_device);
  2556. EXPORT_SYMBOL(pcim_enable_device);
  2557. EXPORT_SYMBOL(pcim_pin_device);
  2558. EXPORT_SYMBOL(pci_disable_device);
  2559. EXPORT_SYMBOL(pci_find_capability);
  2560. EXPORT_SYMBOL(pci_bus_find_capability);
  2561. EXPORT_SYMBOL(pci_release_regions);
  2562. EXPORT_SYMBOL(pci_request_regions);
  2563. EXPORT_SYMBOL(pci_request_regions_exclusive);
  2564. EXPORT_SYMBOL(pci_release_region);
  2565. EXPORT_SYMBOL(pci_request_region);
  2566. EXPORT_SYMBOL(pci_request_region_exclusive);
  2567. EXPORT_SYMBOL(pci_release_selected_regions);
  2568. EXPORT_SYMBOL(pci_request_selected_regions);
  2569. EXPORT_SYMBOL(pci_request_selected_regions_exclusive);
  2570. EXPORT_SYMBOL(pci_set_master);
  2571. EXPORT_SYMBOL(pci_clear_master);
  2572. EXPORT_SYMBOL(pci_set_mwi);
  2573. EXPORT_SYMBOL(pci_try_set_mwi);
  2574. EXPORT_SYMBOL(pci_clear_mwi);
  2575. EXPORT_SYMBOL_GPL(pci_intx);
  2576. EXPORT_SYMBOL(pci_set_dma_mask);
  2577. EXPORT_SYMBOL(pci_set_consistent_dma_mask);
  2578. EXPORT_SYMBOL(pci_assign_resource);
  2579. EXPORT_SYMBOL(pci_find_parent_resource);
  2580. EXPORT_SYMBOL(pci_select_bars);
  2581. EXPORT_SYMBOL(pci_set_power_state);
  2582. EXPORT_SYMBOL(pci_save_state);
  2583. EXPORT_SYMBOL(pci_restore_state);
  2584. EXPORT_SYMBOL(pci_pme_capable);
  2585. EXPORT_SYMBOL(pci_pme_active);
  2586. EXPORT_SYMBOL(pci_wake_from_d3);
  2587. EXPORT_SYMBOL(pci_target_state);
  2588. EXPORT_SYMBOL(pci_prepare_to_sleep);
  2589. EXPORT_SYMBOL(pci_back_from_sleep);
  2590. EXPORT_SYMBOL_GPL(pci_set_pcie_reset_state);