io_apic.c 97 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000300130023003300430053006300730083009301030113012301330143015301630173018301930203021302230233024302530263027302830293030303130323033303430353036303730383039304030413042304330443045304630473048304930503051305230533054305530563057305830593060306130623063306430653066306730683069307030713072307330743075307630773078307930803081308230833084308530863087308830893090309130923093309430953096309730983099310031013102310331043105310631073108310931103111311231133114311531163117311831193120312131223123312431253126312731283129313031313132313331343135313631373138313931403141314231433144314531463147314831493150315131523153315431553156315731583159316031613162316331643165316631673168316931703171317231733174317531763177317831793180318131823183318431853186318731883189319031913192319331943195319631973198319932003201320232033204320532063207320832093210321132123213321432153216321732183219322032213222322332243225322632273228322932303231323232333234323532363237323832393240324132423243324432453246324732483249325032513252325332543255325632573258325932603261326232633264326532663267326832693270327132723273327432753276327732783279328032813282328332843285328632873288328932903291329232933294329532963297329832993300330133023303330433053306330733083309331033113312331333143315331633173318331933203321332233233324332533263327332833293330333133323333333433353336333733383339334033413342334333443345334633473348334933503351335233533354335533563357335833593360336133623363336433653366336733683369337033713372337333743375337633773378337933803381338233833384338533863387338833893390339133923393339433953396339733983399340034013402340334043405340634073408340934103411341234133414341534163417341834193420342134223423342434253426342734283429343034313432343334343435343634373438343934403441344234433444344534463447344834493450345134523453345434553456345734583459346034613462346334643465346634673468346934703471347234733474347534763477347834793480348134823483348434853486348734883489349034913492349334943495349634973498349935003501350235033504350535063507350835093510351135123513351435153516351735183519352035213522352335243525352635273528352935303531353235333534353535363537353835393540354135423543354435453546354735483549355035513552355335543555355635573558355935603561356235633564356535663567356835693570357135723573357435753576357735783579358035813582358335843585358635873588358935903591359235933594359535963597359835993600360136023603360436053606360736083609361036113612361336143615361636173618361936203621362236233624362536263627362836293630363136323633363436353636363736383639364036413642364336443645364636473648364936503651365236533654365536563657365836593660366136623663366436653666366736683669367036713672367336743675367636773678367936803681368236833684368536863687368836893690369136923693369436953696369736983699370037013702370337043705370637073708370937103711371237133714371537163717371837193720372137223723372437253726372737283729373037313732373337343735373637373738373937403741374237433744374537463747374837493750375137523753375437553756375737583759376037613762376337643765376637673768376937703771377237733774377537763777377837793780378137823783378437853786378737883789379037913792379337943795379637973798379938003801380238033804380538063807380838093810381138123813381438153816381738183819382038213822382338243825382638273828382938303831383238333834383538363837383838393840384138423843384438453846384738483849385038513852385338543855385638573858385938603861386238633864386538663867386838693870387138723873387438753876387738783879388038813882388338843885388638873888388938903891389238933894389538963897389838993900390139023903390439053906390739083909391039113912391339143915391639173918391939203921392239233924392539263927392839293930393139323933393439353936393739383939394039413942394339443945394639473948394939503951395239533954395539563957395839593960396139623963396439653966396739683969397039713972397339743975397639773978397939803981398239833984398539863987398839893990399139923993399439953996399739983999400040014002400340044005
  1. /*
  2. * Intel IO-APIC support for multi-Pentium hosts.
  3. *
  4. * Copyright (C) 1997, 1998, 1999, 2000, 2009 Ingo Molnar, Hajnalka Szabo
  5. *
  6. * Many thanks to Stig Venaas for trying out countless experimental
  7. * patches and reporting/debugging problems patiently!
  8. *
  9. * (c) 1999, Multiple IO-APIC support, developed by
  10. * Ken-ichi Yaku <yaku@css1.kbnes.nec.co.jp> and
  11. * Hidemi Kishimoto <kisimoto@css1.kbnes.nec.co.jp>,
  12. * further tested and cleaned up by Zach Brown <zab@redhat.com>
  13. * and Ingo Molnar <mingo@redhat.com>
  14. *
  15. * Fixes
  16. * Maciej W. Rozycki : Bits for genuine 82489DX APICs;
  17. * thanks to Eric Gilmore
  18. * and Rolf G. Tews
  19. * for testing these extensively
  20. * Paul Diefenbaugh : Added full ACPI support
  21. */
  22. #include <linux/mm.h>
  23. #include <linux/interrupt.h>
  24. #include <linux/init.h>
  25. #include <linux/delay.h>
  26. #include <linux/sched.h>
  27. #include <linux/pci.h>
  28. #include <linux/mc146818rtc.h>
  29. #include <linux/compiler.h>
  30. #include <linux/acpi.h>
  31. #include <linux/module.h>
  32. #include <linux/syscore_ops.h>
  33. #include <linux/msi.h>
  34. #include <linux/htirq.h>
  35. #include <linux/freezer.h>
  36. #include <linux/kthread.h>
  37. #include <linux/jiffies.h> /* time_after() */
  38. #include <linux/slab.h>
  39. #ifdef CONFIG_ACPI
  40. #include <acpi/acpi_bus.h>
  41. #endif
  42. #include <linux/bootmem.h>
  43. #include <linux/dmar.h>
  44. #include <linux/hpet.h>
  45. #include <asm/idle.h>
  46. #include <asm/io.h>
  47. #include <asm/smp.h>
  48. #include <asm/cpu.h>
  49. #include <asm/desc.h>
  50. #include <asm/proto.h>
  51. #include <asm/acpi.h>
  52. #include <asm/dma.h>
  53. #include <asm/timer.h>
  54. #include <asm/i8259.h>
  55. #include <asm/msidef.h>
  56. #include <asm/hypertransport.h>
  57. #include <asm/setup.h>
  58. #include <asm/irq_remapping.h>
  59. #include <asm/hpet.h>
  60. #include <asm/hw_irq.h>
  61. #include <asm/apic.h>
  62. #define __apicdebuginit(type) static type __init
  63. #define for_each_irq_pin(entry, head) \
  64. for (entry = head; entry; entry = entry->next)
  65. /*
  66. * Is the SiS APIC rmw bug present ?
  67. * -1 = don't know, 0 = no, 1 = yes
  68. */
  69. int sis_apic_bug = -1;
  70. static DEFINE_RAW_SPINLOCK(ioapic_lock);
  71. static DEFINE_RAW_SPINLOCK(vector_lock);
  72. /*
  73. * # of IRQ routing registers
  74. */
  75. int nr_ioapic_registers[MAX_IO_APICS];
  76. /* I/O APIC entries */
  77. struct mpc_ioapic mp_ioapics[MAX_IO_APICS];
  78. int nr_ioapics;
  79. /* IO APIC gsi routing info */
  80. struct mp_ioapic_gsi mp_gsi_routing[MAX_IO_APICS];
  81. /* The one past the highest gsi number used */
  82. u32 gsi_top;
  83. /* MP IRQ source entries */
  84. struct mpc_intsrc mp_irqs[MAX_IRQ_SOURCES];
  85. /* # of MP IRQ source entries */
  86. int mp_irq_entries;
  87. /* GSI interrupts */
  88. static int nr_irqs_gsi = NR_IRQS_LEGACY;
  89. /*
  90. * Saved I/O APIC state during suspend/resume, or while enabling intr-remap.
  91. */
  92. static struct IO_APIC_route_entry *ioapic_saved_data[MAX_IO_APICS];
  93. #if defined (CONFIG_MCA) || defined (CONFIG_EISA)
  94. int mp_bus_id_to_type[MAX_MP_BUSSES];
  95. #endif
  96. DECLARE_BITMAP(mp_bus_not_pci, MAX_MP_BUSSES);
  97. int skip_ioapic_setup;
  98. /**
  99. * disable_ioapic_support() - disables ioapic support at runtime
  100. */
  101. void disable_ioapic_support(void)
  102. {
  103. #ifdef CONFIG_PCI
  104. noioapicquirk = 1;
  105. noioapicreroute = -1;
  106. #endif
  107. skip_ioapic_setup = 1;
  108. }
  109. static int __init parse_noapic(char *str)
  110. {
  111. /* disable IO-APIC */
  112. disable_ioapic_support();
  113. return 0;
  114. }
  115. early_param("noapic", parse_noapic);
  116. static int io_apic_setup_irq_pin(unsigned int irq, int node,
  117. struct io_apic_irq_attr *attr);
  118. /* Will be called in mpparse/acpi/sfi codes for saving IRQ info */
  119. void mp_save_irq(struct mpc_intsrc *m)
  120. {
  121. int i;
  122. apic_printk(APIC_VERBOSE, "Int: type %d, pol %d, trig %d, bus %02x,"
  123. " IRQ %02x, APIC ID %x, APIC INT %02x\n",
  124. m->irqtype, m->irqflag & 3, (m->irqflag >> 2) & 3, m->srcbus,
  125. m->srcbusirq, m->dstapic, m->dstirq);
  126. for (i = 0; i < mp_irq_entries; i++) {
  127. if (!memcmp(&mp_irqs[i], m, sizeof(*m)))
  128. return;
  129. }
  130. memcpy(&mp_irqs[mp_irq_entries], m, sizeof(*m));
  131. if (++mp_irq_entries == MAX_IRQ_SOURCES)
  132. panic("Max # of irq sources exceeded!!\n");
  133. }
  134. struct irq_pin_list {
  135. int apic, pin;
  136. struct irq_pin_list *next;
  137. };
  138. static struct irq_pin_list *alloc_irq_pin_list(int node)
  139. {
  140. return kzalloc_node(sizeof(struct irq_pin_list), GFP_KERNEL, node);
  141. }
  142. /* irq_cfg is indexed by the sum of all RTEs in all I/O APICs. */
  143. #ifdef CONFIG_SPARSE_IRQ
  144. static struct irq_cfg irq_cfgx[NR_IRQS_LEGACY];
  145. #else
  146. static struct irq_cfg irq_cfgx[NR_IRQS];
  147. #endif
  148. int __init arch_early_irq_init(void)
  149. {
  150. struct irq_cfg *cfg;
  151. int count, node, i;
  152. if (!legacy_pic->nr_legacy_irqs) {
  153. nr_irqs_gsi = 0;
  154. io_apic_irqs = ~0UL;
  155. }
  156. for (i = 0; i < nr_ioapics; i++) {
  157. ioapic_saved_data[i] =
  158. kzalloc(sizeof(struct IO_APIC_route_entry) *
  159. nr_ioapic_registers[i], GFP_KERNEL);
  160. if (!ioapic_saved_data[i])
  161. pr_err("IOAPIC %d: suspend/resume impossible!\n", i);
  162. }
  163. cfg = irq_cfgx;
  164. count = ARRAY_SIZE(irq_cfgx);
  165. node = cpu_to_node(0);
  166. /* Make sure the legacy interrupts are marked in the bitmap */
  167. irq_reserve_irqs(0, legacy_pic->nr_legacy_irqs);
  168. for (i = 0; i < count; i++) {
  169. irq_set_chip_data(i, &cfg[i]);
  170. zalloc_cpumask_var_node(&cfg[i].domain, GFP_KERNEL, node);
  171. zalloc_cpumask_var_node(&cfg[i].old_domain, GFP_KERNEL, node);
  172. /*
  173. * For legacy IRQ's, start with assigning irq0 to irq15 to
  174. * IRQ0_VECTOR to IRQ15_VECTOR on cpu 0.
  175. */
  176. if (i < legacy_pic->nr_legacy_irqs) {
  177. cfg[i].vector = IRQ0_VECTOR + i;
  178. cpumask_set_cpu(0, cfg[i].domain);
  179. }
  180. }
  181. return 0;
  182. }
  183. #ifdef CONFIG_SPARSE_IRQ
  184. static struct irq_cfg *irq_cfg(unsigned int irq)
  185. {
  186. return irq_get_chip_data(irq);
  187. }
  188. static struct irq_cfg *alloc_irq_cfg(unsigned int irq, int node)
  189. {
  190. struct irq_cfg *cfg;
  191. cfg = kzalloc_node(sizeof(*cfg), GFP_KERNEL, node);
  192. if (!cfg)
  193. return NULL;
  194. if (!zalloc_cpumask_var_node(&cfg->domain, GFP_KERNEL, node))
  195. goto out_cfg;
  196. if (!zalloc_cpumask_var_node(&cfg->old_domain, GFP_KERNEL, node))
  197. goto out_domain;
  198. return cfg;
  199. out_domain:
  200. free_cpumask_var(cfg->domain);
  201. out_cfg:
  202. kfree(cfg);
  203. return NULL;
  204. }
  205. static void free_irq_cfg(unsigned int at, struct irq_cfg *cfg)
  206. {
  207. if (!cfg)
  208. return;
  209. irq_set_chip_data(at, NULL);
  210. free_cpumask_var(cfg->domain);
  211. free_cpumask_var(cfg->old_domain);
  212. kfree(cfg);
  213. }
  214. #else
  215. struct irq_cfg *irq_cfg(unsigned int irq)
  216. {
  217. return irq < nr_irqs ? irq_cfgx + irq : NULL;
  218. }
  219. static struct irq_cfg *alloc_irq_cfg(unsigned int irq, int node)
  220. {
  221. return irq_cfgx + irq;
  222. }
  223. static inline void free_irq_cfg(unsigned int at, struct irq_cfg *cfg) { }
  224. #endif
  225. static struct irq_cfg *alloc_irq_and_cfg_at(unsigned int at, int node)
  226. {
  227. int res = irq_alloc_desc_at(at, node);
  228. struct irq_cfg *cfg;
  229. if (res < 0) {
  230. if (res != -EEXIST)
  231. return NULL;
  232. cfg = irq_get_chip_data(at);
  233. if (cfg)
  234. return cfg;
  235. }
  236. cfg = alloc_irq_cfg(at, node);
  237. if (cfg)
  238. irq_set_chip_data(at, cfg);
  239. else
  240. irq_free_desc(at);
  241. return cfg;
  242. }
  243. static int alloc_irq_from(unsigned int from, int node)
  244. {
  245. return irq_alloc_desc_from(from, node);
  246. }
  247. static void free_irq_at(unsigned int at, struct irq_cfg *cfg)
  248. {
  249. free_irq_cfg(at, cfg);
  250. irq_free_desc(at);
  251. }
  252. struct io_apic {
  253. unsigned int index;
  254. unsigned int unused[3];
  255. unsigned int data;
  256. unsigned int unused2[11];
  257. unsigned int eoi;
  258. };
  259. static __attribute_const__ struct io_apic __iomem *io_apic_base(int idx)
  260. {
  261. return (void __iomem *) __fix_to_virt(FIX_IO_APIC_BASE_0 + idx)
  262. + (mp_ioapics[idx].apicaddr & ~PAGE_MASK);
  263. }
  264. static inline void io_apic_eoi(unsigned int apic, unsigned int vector)
  265. {
  266. struct io_apic __iomem *io_apic = io_apic_base(apic);
  267. writel(vector, &io_apic->eoi);
  268. }
  269. static inline unsigned int io_apic_read(unsigned int apic, unsigned int reg)
  270. {
  271. struct io_apic __iomem *io_apic = io_apic_base(apic);
  272. writel(reg, &io_apic->index);
  273. return readl(&io_apic->data);
  274. }
  275. static inline void io_apic_write(unsigned int apic, unsigned int reg, unsigned int value)
  276. {
  277. struct io_apic __iomem *io_apic = io_apic_base(apic);
  278. writel(reg, &io_apic->index);
  279. writel(value, &io_apic->data);
  280. }
  281. /*
  282. * Re-write a value: to be used for read-modify-write
  283. * cycles where the read already set up the index register.
  284. *
  285. * Older SiS APIC requires we rewrite the index register
  286. */
  287. static inline void io_apic_modify(unsigned int apic, unsigned int reg, unsigned int value)
  288. {
  289. struct io_apic __iomem *io_apic = io_apic_base(apic);
  290. if (sis_apic_bug)
  291. writel(reg, &io_apic->index);
  292. writel(value, &io_apic->data);
  293. }
  294. static bool io_apic_level_ack_pending(struct irq_cfg *cfg)
  295. {
  296. struct irq_pin_list *entry;
  297. unsigned long flags;
  298. raw_spin_lock_irqsave(&ioapic_lock, flags);
  299. for_each_irq_pin(entry, cfg->irq_2_pin) {
  300. unsigned int reg;
  301. int pin;
  302. pin = entry->pin;
  303. reg = io_apic_read(entry->apic, 0x10 + pin*2);
  304. /* Is the remote IRR bit set? */
  305. if (reg & IO_APIC_REDIR_REMOTE_IRR) {
  306. raw_spin_unlock_irqrestore(&ioapic_lock, flags);
  307. return true;
  308. }
  309. }
  310. raw_spin_unlock_irqrestore(&ioapic_lock, flags);
  311. return false;
  312. }
  313. union entry_union {
  314. struct { u32 w1, w2; };
  315. struct IO_APIC_route_entry entry;
  316. };
  317. static struct IO_APIC_route_entry ioapic_read_entry(int apic, int pin)
  318. {
  319. union entry_union eu;
  320. unsigned long flags;
  321. raw_spin_lock_irqsave(&ioapic_lock, flags);
  322. eu.w1 = io_apic_read(apic, 0x10 + 2 * pin);
  323. eu.w2 = io_apic_read(apic, 0x11 + 2 * pin);
  324. raw_spin_unlock_irqrestore(&ioapic_lock, flags);
  325. return eu.entry;
  326. }
  327. /*
  328. * When we write a new IO APIC routing entry, we need to write the high
  329. * word first! If the mask bit in the low word is clear, we will enable
  330. * the interrupt, and we need to make sure the entry is fully populated
  331. * before that happens.
  332. */
  333. static void
  334. __ioapic_write_entry(int apic, int pin, struct IO_APIC_route_entry e)
  335. {
  336. union entry_union eu = {{0, 0}};
  337. eu.entry = e;
  338. io_apic_write(apic, 0x11 + 2*pin, eu.w2);
  339. io_apic_write(apic, 0x10 + 2*pin, eu.w1);
  340. }
  341. static void ioapic_write_entry(int apic, int pin, struct IO_APIC_route_entry e)
  342. {
  343. unsigned long flags;
  344. raw_spin_lock_irqsave(&ioapic_lock, flags);
  345. __ioapic_write_entry(apic, pin, e);
  346. raw_spin_unlock_irqrestore(&ioapic_lock, flags);
  347. }
  348. /*
  349. * When we mask an IO APIC routing entry, we need to write the low
  350. * word first, in order to set the mask bit before we change the
  351. * high bits!
  352. */
  353. static void ioapic_mask_entry(int apic, int pin)
  354. {
  355. unsigned long flags;
  356. union entry_union eu = { .entry.mask = 1 };
  357. raw_spin_lock_irqsave(&ioapic_lock, flags);
  358. io_apic_write(apic, 0x10 + 2*pin, eu.w1);
  359. io_apic_write(apic, 0x11 + 2*pin, eu.w2);
  360. raw_spin_unlock_irqrestore(&ioapic_lock, flags);
  361. }
  362. /*
  363. * The common case is 1:1 IRQ<->pin mappings. Sometimes there are
  364. * shared ISA-space IRQs, so we have to support them. We are super
  365. * fast in the common case, and fast for shared ISA-space IRQs.
  366. */
  367. static int
  368. __add_pin_to_irq_node(struct irq_cfg *cfg, int node, int apic, int pin)
  369. {
  370. struct irq_pin_list **last, *entry;
  371. /* don't allow duplicates */
  372. last = &cfg->irq_2_pin;
  373. for_each_irq_pin(entry, cfg->irq_2_pin) {
  374. if (entry->apic == apic && entry->pin == pin)
  375. return 0;
  376. last = &entry->next;
  377. }
  378. entry = alloc_irq_pin_list(node);
  379. if (!entry) {
  380. printk(KERN_ERR "can not alloc irq_pin_list (%d,%d,%d)\n",
  381. node, apic, pin);
  382. return -ENOMEM;
  383. }
  384. entry->apic = apic;
  385. entry->pin = pin;
  386. *last = entry;
  387. return 0;
  388. }
  389. static void add_pin_to_irq_node(struct irq_cfg *cfg, int node, int apic, int pin)
  390. {
  391. if (__add_pin_to_irq_node(cfg, node, apic, pin))
  392. panic("IO-APIC: failed to add irq-pin. Can not proceed\n");
  393. }
  394. /*
  395. * Reroute an IRQ to a different pin.
  396. */
  397. static void __init replace_pin_at_irq_node(struct irq_cfg *cfg, int node,
  398. int oldapic, int oldpin,
  399. int newapic, int newpin)
  400. {
  401. struct irq_pin_list *entry;
  402. for_each_irq_pin(entry, cfg->irq_2_pin) {
  403. if (entry->apic == oldapic && entry->pin == oldpin) {
  404. entry->apic = newapic;
  405. entry->pin = newpin;
  406. /* every one is different, right? */
  407. return;
  408. }
  409. }
  410. /* old apic/pin didn't exist, so just add new ones */
  411. add_pin_to_irq_node(cfg, node, newapic, newpin);
  412. }
  413. static void __io_apic_modify_irq(struct irq_pin_list *entry,
  414. int mask_and, int mask_or,
  415. void (*final)(struct irq_pin_list *entry))
  416. {
  417. unsigned int reg, pin;
  418. pin = entry->pin;
  419. reg = io_apic_read(entry->apic, 0x10 + pin * 2);
  420. reg &= mask_and;
  421. reg |= mask_or;
  422. io_apic_modify(entry->apic, 0x10 + pin * 2, reg);
  423. if (final)
  424. final(entry);
  425. }
  426. static void io_apic_modify_irq(struct irq_cfg *cfg,
  427. int mask_and, int mask_or,
  428. void (*final)(struct irq_pin_list *entry))
  429. {
  430. struct irq_pin_list *entry;
  431. for_each_irq_pin(entry, cfg->irq_2_pin)
  432. __io_apic_modify_irq(entry, mask_and, mask_or, final);
  433. }
  434. static void __mask_and_edge_IO_APIC_irq(struct irq_pin_list *entry)
  435. {
  436. __io_apic_modify_irq(entry, ~IO_APIC_REDIR_LEVEL_TRIGGER,
  437. IO_APIC_REDIR_MASKED, NULL);
  438. }
  439. static void __unmask_and_level_IO_APIC_irq(struct irq_pin_list *entry)
  440. {
  441. __io_apic_modify_irq(entry, ~IO_APIC_REDIR_MASKED,
  442. IO_APIC_REDIR_LEVEL_TRIGGER, NULL);
  443. }
  444. static void io_apic_sync(struct irq_pin_list *entry)
  445. {
  446. /*
  447. * Synchronize the IO-APIC and the CPU by doing
  448. * a dummy read from the IO-APIC
  449. */
  450. struct io_apic __iomem *io_apic;
  451. io_apic = io_apic_base(entry->apic);
  452. readl(&io_apic->data);
  453. }
  454. static void mask_ioapic(struct irq_cfg *cfg)
  455. {
  456. unsigned long flags;
  457. raw_spin_lock_irqsave(&ioapic_lock, flags);
  458. io_apic_modify_irq(cfg, ~0, IO_APIC_REDIR_MASKED, &io_apic_sync);
  459. raw_spin_unlock_irqrestore(&ioapic_lock, flags);
  460. }
  461. static void mask_ioapic_irq(struct irq_data *data)
  462. {
  463. mask_ioapic(data->chip_data);
  464. }
  465. static void __unmask_ioapic(struct irq_cfg *cfg)
  466. {
  467. io_apic_modify_irq(cfg, ~IO_APIC_REDIR_MASKED, 0, NULL);
  468. }
  469. static void unmask_ioapic(struct irq_cfg *cfg)
  470. {
  471. unsigned long flags;
  472. raw_spin_lock_irqsave(&ioapic_lock, flags);
  473. __unmask_ioapic(cfg);
  474. raw_spin_unlock_irqrestore(&ioapic_lock, flags);
  475. }
  476. static void unmask_ioapic_irq(struct irq_data *data)
  477. {
  478. unmask_ioapic(data->chip_data);
  479. }
  480. static void clear_IO_APIC_pin(unsigned int apic, unsigned int pin)
  481. {
  482. struct IO_APIC_route_entry entry;
  483. /* Check delivery_mode to be sure we're not clearing an SMI pin */
  484. entry = ioapic_read_entry(apic, pin);
  485. if (entry.delivery_mode == dest_SMI)
  486. return;
  487. /*
  488. * Disable it in the IO-APIC irq-routing table:
  489. */
  490. ioapic_mask_entry(apic, pin);
  491. }
  492. static void clear_IO_APIC (void)
  493. {
  494. int apic, pin;
  495. for (apic = 0; apic < nr_ioapics; apic++)
  496. for (pin = 0; pin < nr_ioapic_registers[apic]; pin++)
  497. clear_IO_APIC_pin(apic, pin);
  498. }
  499. #ifdef CONFIG_X86_32
  500. /*
  501. * support for broken MP BIOSs, enables hand-redirection of PIRQ0-7 to
  502. * specific CPU-side IRQs.
  503. */
  504. #define MAX_PIRQS 8
  505. static int pirq_entries[MAX_PIRQS] = {
  506. [0 ... MAX_PIRQS - 1] = -1
  507. };
  508. static int __init ioapic_pirq_setup(char *str)
  509. {
  510. int i, max;
  511. int ints[MAX_PIRQS+1];
  512. get_options(str, ARRAY_SIZE(ints), ints);
  513. apic_printk(APIC_VERBOSE, KERN_INFO
  514. "PIRQ redirection, working around broken MP-BIOS.\n");
  515. max = MAX_PIRQS;
  516. if (ints[0] < MAX_PIRQS)
  517. max = ints[0];
  518. for (i = 0; i < max; i++) {
  519. apic_printk(APIC_VERBOSE, KERN_DEBUG
  520. "... PIRQ%d -> IRQ %d\n", i, ints[i+1]);
  521. /*
  522. * PIRQs are mapped upside down, usually.
  523. */
  524. pirq_entries[MAX_PIRQS-i-1] = ints[i+1];
  525. }
  526. return 1;
  527. }
  528. __setup("pirq=", ioapic_pirq_setup);
  529. #endif /* CONFIG_X86_32 */
  530. /*
  531. * Saves all the IO-APIC RTE's
  532. */
  533. int save_ioapic_entries(void)
  534. {
  535. int apic, pin;
  536. int err = 0;
  537. for (apic = 0; apic < nr_ioapics; apic++) {
  538. if (!ioapic_saved_data[apic]) {
  539. err = -ENOMEM;
  540. continue;
  541. }
  542. for (pin = 0; pin < nr_ioapic_registers[apic]; pin++)
  543. ioapic_saved_data[apic][pin] =
  544. ioapic_read_entry(apic, pin);
  545. }
  546. return err;
  547. }
  548. /*
  549. * Mask all IO APIC entries.
  550. */
  551. void mask_ioapic_entries(void)
  552. {
  553. int apic, pin;
  554. for (apic = 0; apic < nr_ioapics; apic++) {
  555. if (!ioapic_saved_data[apic])
  556. continue;
  557. for (pin = 0; pin < nr_ioapic_registers[apic]; pin++) {
  558. struct IO_APIC_route_entry entry;
  559. entry = ioapic_saved_data[apic][pin];
  560. if (!entry.mask) {
  561. entry.mask = 1;
  562. ioapic_write_entry(apic, pin, entry);
  563. }
  564. }
  565. }
  566. }
  567. /*
  568. * Restore IO APIC entries which was saved in ioapic_saved_data
  569. */
  570. int restore_ioapic_entries(void)
  571. {
  572. int apic, pin;
  573. for (apic = 0; apic < nr_ioapics; apic++) {
  574. if (!ioapic_saved_data[apic])
  575. continue;
  576. for (pin = 0; pin < nr_ioapic_registers[apic]; pin++)
  577. ioapic_write_entry(apic, pin,
  578. ioapic_saved_data[apic][pin]);
  579. }
  580. return 0;
  581. }
  582. /*
  583. * Find the IRQ entry number of a certain pin.
  584. */
  585. static int find_irq_entry(int apic, int pin, int type)
  586. {
  587. int i;
  588. for (i = 0; i < mp_irq_entries; i++)
  589. if (mp_irqs[i].irqtype == type &&
  590. (mp_irqs[i].dstapic == mp_ioapics[apic].apicid ||
  591. mp_irqs[i].dstapic == MP_APIC_ALL) &&
  592. mp_irqs[i].dstirq == pin)
  593. return i;
  594. return -1;
  595. }
  596. /*
  597. * Find the pin to which IRQ[irq] (ISA) is connected
  598. */
  599. static int __init find_isa_irq_pin(int irq, int type)
  600. {
  601. int i;
  602. for (i = 0; i < mp_irq_entries; i++) {
  603. int lbus = mp_irqs[i].srcbus;
  604. if (test_bit(lbus, mp_bus_not_pci) &&
  605. (mp_irqs[i].irqtype == type) &&
  606. (mp_irqs[i].srcbusirq == irq))
  607. return mp_irqs[i].dstirq;
  608. }
  609. return -1;
  610. }
  611. static int __init find_isa_irq_apic(int irq, int type)
  612. {
  613. int i;
  614. for (i = 0; i < mp_irq_entries; i++) {
  615. int lbus = mp_irqs[i].srcbus;
  616. if (test_bit(lbus, mp_bus_not_pci) &&
  617. (mp_irqs[i].irqtype == type) &&
  618. (mp_irqs[i].srcbusirq == irq))
  619. break;
  620. }
  621. if (i < mp_irq_entries) {
  622. int apic;
  623. for(apic = 0; apic < nr_ioapics; apic++) {
  624. if (mp_ioapics[apic].apicid == mp_irqs[i].dstapic)
  625. return apic;
  626. }
  627. }
  628. return -1;
  629. }
  630. #if defined(CONFIG_EISA) || defined(CONFIG_MCA)
  631. /*
  632. * EISA Edge/Level control register, ELCR
  633. */
  634. static int EISA_ELCR(unsigned int irq)
  635. {
  636. if (irq < legacy_pic->nr_legacy_irqs) {
  637. unsigned int port = 0x4d0 + (irq >> 3);
  638. return (inb(port) >> (irq & 7)) & 1;
  639. }
  640. apic_printk(APIC_VERBOSE, KERN_INFO
  641. "Broken MPtable reports ISA irq %d\n", irq);
  642. return 0;
  643. }
  644. #endif
  645. /* ISA interrupts are always polarity zero edge triggered,
  646. * when listed as conforming in the MP table. */
  647. #define default_ISA_trigger(idx) (0)
  648. #define default_ISA_polarity(idx) (0)
  649. /* EISA interrupts are always polarity zero and can be edge or level
  650. * trigger depending on the ELCR value. If an interrupt is listed as
  651. * EISA conforming in the MP table, that means its trigger type must
  652. * be read in from the ELCR */
  653. #define default_EISA_trigger(idx) (EISA_ELCR(mp_irqs[idx].srcbusirq))
  654. #define default_EISA_polarity(idx) default_ISA_polarity(idx)
  655. /* PCI interrupts are always polarity one level triggered,
  656. * when listed as conforming in the MP table. */
  657. #define default_PCI_trigger(idx) (1)
  658. #define default_PCI_polarity(idx) (1)
  659. /* MCA interrupts are always polarity zero level triggered,
  660. * when listed as conforming in the MP table. */
  661. #define default_MCA_trigger(idx) (1)
  662. #define default_MCA_polarity(idx) default_ISA_polarity(idx)
  663. static int irq_polarity(int idx)
  664. {
  665. int bus = mp_irqs[idx].srcbus;
  666. int polarity;
  667. /*
  668. * Determine IRQ line polarity (high active or low active):
  669. */
  670. switch (mp_irqs[idx].irqflag & 3)
  671. {
  672. case 0: /* conforms, ie. bus-type dependent polarity */
  673. if (test_bit(bus, mp_bus_not_pci))
  674. polarity = default_ISA_polarity(idx);
  675. else
  676. polarity = default_PCI_polarity(idx);
  677. break;
  678. case 1: /* high active */
  679. {
  680. polarity = 0;
  681. break;
  682. }
  683. case 2: /* reserved */
  684. {
  685. printk(KERN_WARNING "broken BIOS!!\n");
  686. polarity = 1;
  687. break;
  688. }
  689. case 3: /* low active */
  690. {
  691. polarity = 1;
  692. break;
  693. }
  694. default: /* invalid */
  695. {
  696. printk(KERN_WARNING "broken BIOS!!\n");
  697. polarity = 1;
  698. break;
  699. }
  700. }
  701. return polarity;
  702. }
  703. static int irq_trigger(int idx)
  704. {
  705. int bus = mp_irqs[idx].srcbus;
  706. int trigger;
  707. /*
  708. * Determine IRQ trigger mode (edge or level sensitive):
  709. */
  710. switch ((mp_irqs[idx].irqflag>>2) & 3)
  711. {
  712. case 0: /* conforms, ie. bus-type dependent */
  713. if (test_bit(bus, mp_bus_not_pci))
  714. trigger = default_ISA_trigger(idx);
  715. else
  716. trigger = default_PCI_trigger(idx);
  717. #if defined(CONFIG_EISA) || defined(CONFIG_MCA)
  718. switch (mp_bus_id_to_type[bus]) {
  719. case MP_BUS_ISA: /* ISA pin */
  720. {
  721. /* set before the switch */
  722. break;
  723. }
  724. case MP_BUS_EISA: /* EISA pin */
  725. {
  726. trigger = default_EISA_trigger(idx);
  727. break;
  728. }
  729. case MP_BUS_PCI: /* PCI pin */
  730. {
  731. /* set before the switch */
  732. break;
  733. }
  734. case MP_BUS_MCA: /* MCA pin */
  735. {
  736. trigger = default_MCA_trigger(idx);
  737. break;
  738. }
  739. default:
  740. {
  741. printk(KERN_WARNING "broken BIOS!!\n");
  742. trigger = 1;
  743. break;
  744. }
  745. }
  746. #endif
  747. break;
  748. case 1: /* edge */
  749. {
  750. trigger = 0;
  751. break;
  752. }
  753. case 2: /* reserved */
  754. {
  755. printk(KERN_WARNING "broken BIOS!!\n");
  756. trigger = 1;
  757. break;
  758. }
  759. case 3: /* level */
  760. {
  761. trigger = 1;
  762. break;
  763. }
  764. default: /* invalid */
  765. {
  766. printk(KERN_WARNING "broken BIOS!!\n");
  767. trigger = 0;
  768. break;
  769. }
  770. }
  771. return trigger;
  772. }
  773. static int pin_2_irq(int idx, int apic, int pin)
  774. {
  775. int irq;
  776. int bus = mp_irqs[idx].srcbus;
  777. /*
  778. * Debugging check, we are in big trouble if this message pops up!
  779. */
  780. if (mp_irqs[idx].dstirq != pin)
  781. printk(KERN_ERR "broken BIOS or MPTABLE parser, ayiee!!\n");
  782. if (test_bit(bus, mp_bus_not_pci)) {
  783. irq = mp_irqs[idx].srcbusirq;
  784. } else {
  785. u32 gsi = mp_gsi_routing[apic].gsi_base + pin;
  786. if (gsi >= NR_IRQS_LEGACY)
  787. irq = gsi;
  788. else
  789. irq = gsi_top + gsi;
  790. }
  791. #ifdef CONFIG_X86_32
  792. /*
  793. * PCI IRQ command line redirection. Yes, limits are hardcoded.
  794. */
  795. if ((pin >= 16) && (pin <= 23)) {
  796. if (pirq_entries[pin-16] != -1) {
  797. if (!pirq_entries[pin-16]) {
  798. apic_printk(APIC_VERBOSE, KERN_DEBUG
  799. "disabling PIRQ%d\n", pin-16);
  800. } else {
  801. irq = pirq_entries[pin-16];
  802. apic_printk(APIC_VERBOSE, KERN_DEBUG
  803. "using PIRQ%d -> IRQ %d\n",
  804. pin-16, irq);
  805. }
  806. }
  807. }
  808. #endif
  809. return irq;
  810. }
  811. /*
  812. * Find a specific PCI IRQ entry.
  813. * Not an __init, possibly needed by modules
  814. */
  815. int IO_APIC_get_PCI_irq_vector(int bus, int slot, int pin,
  816. struct io_apic_irq_attr *irq_attr)
  817. {
  818. int apic, i, best_guess = -1;
  819. apic_printk(APIC_DEBUG,
  820. "querying PCI -> IRQ mapping bus:%d, slot:%d, pin:%d.\n",
  821. bus, slot, pin);
  822. if (test_bit(bus, mp_bus_not_pci)) {
  823. apic_printk(APIC_VERBOSE,
  824. "PCI BIOS passed nonexistent PCI bus %d!\n", bus);
  825. return -1;
  826. }
  827. for (i = 0; i < mp_irq_entries; i++) {
  828. int lbus = mp_irqs[i].srcbus;
  829. for (apic = 0; apic < nr_ioapics; apic++)
  830. if (mp_ioapics[apic].apicid == mp_irqs[i].dstapic ||
  831. mp_irqs[i].dstapic == MP_APIC_ALL)
  832. break;
  833. if (!test_bit(lbus, mp_bus_not_pci) &&
  834. !mp_irqs[i].irqtype &&
  835. (bus == lbus) &&
  836. (slot == ((mp_irqs[i].srcbusirq >> 2) & 0x1f))) {
  837. int irq = pin_2_irq(i, apic, mp_irqs[i].dstirq);
  838. if (!(apic || IO_APIC_IRQ(irq)))
  839. continue;
  840. if (pin == (mp_irqs[i].srcbusirq & 3)) {
  841. set_io_apic_irq_attr(irq_attr, apic,
  842. mp_irqs[i].dstirq,
  843. irq_trigger(i),
  844. irq_polarity(i));
  845. return irq;
  846. }
  847. /*
  848. * Use the first all-but-pin matching entry as a
  849. * best-guess fuzzy result for broken mptables.
  850. */
  851. if (best_guess < 0) {
  852. set_io_apic_irq_attr(irq_attr, apic,
  853. mp_irqs[i].dstirq,
  854. irq_trigger(i),
  855. irq_polarity(i));
  856. best_guess = irq;
  857. }
  858. }
  859. }
  860. return best_guess;
  861. }
  862. EXPORT_SYMBOL(IO_APIC_get_PCI_irq_vector);
  863. void lock_vector_lock(void)
  864. {
  865. /* Used to the online set of cpus does not change
  866. * during assign_irq_vector.
  867. */
  868. raw_spin_lock(&vector_lock);
  869. }
  870. void unlock_vector_lock(void)
  871. {
  872. raw_spin_unlock(&vector_lock);
  873. }
  874. static int
  875. __assign_irq_vector(int irq, struct irq_cfg *cfg, const struct cpumask *mask)
  876. {
  877. /*
  878. * NOTE! The local APIC isn't very good at handling
  879. * multiple interrupts at the same interrupt level.
  880. * As the interrupt level is determined by taking the
  881. * vector number and shifting that right by 4, we
  882. * want to spread these out a bit so that they don't
  883. * all fall in the same interrupt level.
  884. *
  885. * Also, we've got to be careful not to trash gate
  886. * 0x80, because int 0x80 is hm, kind of importantish. ;)
  887. */
  888. static int current_vector = FIRST_EXTERNAL_VECTOR + VECTOR_OFFSET_START;
  889. static int current_offset = VECTOR_OFFSET_START % 8;
  890. unsigned int old_vector;
  891. int cpu, err;
  892. cpumask_var_t tmp_mask;
  893. if (cfg->move_in_progress)
  894. return -EBUSY;
  895. if (!alloc_cpumask_var(&tmp_mask, GFP_ATOMIC))
  896. return -ENOMEM;
  897. old_vector = cfg->vector;
  898. if (old_vector) {
  899. cpumask_and(tmp_mask, mask, cpu_online_mask);
  900. cpumask_and(tmp_mask, cfg->domain, tmp_mask);
  901. if (!cpumask_empty(tmp_mask)) {
  902. free_cpumask_var(tmp_mask);
  903. return 0;
  904. }
  905. }
  906. /* Only try and allocate irqs on cpus that are present */
  907. err = -ENOSPC;
  908. for_each_cpu_and(cpu, mask, cpu_online_mask) {
  909. int new_cpu;
  910. int vector, offset;
  911. apic->vector_allocation_domain(cpu, tmp_mask);
  912. vector = current_vector;
  913. offset = current_offset;
  914. next:
  915. vector += 8;
  916. if (vector >= first_system_vector) {
  917. /* If out of vectors on large boxen, must share them. */
  918. offset = (offset + 1) % 8;
  919. vector = FIRST_EXTERNAL_VECTOR + offset;
  920. }
  921. if (unlikely(current_vector == vector))
  922. continue;
  923. if (test_bit(vector, used_vectors))
  924. goto next;
  925. for_each_cpu_and(new_cpu, tmp_mask, cpu_online_mask)
  926. if (per_cpu(vector_irq, new_cpu)[vector] != -1)
  927. goto next;
  928. /* Found one! */
  929. current_vector = vector;
  930. current_offset = offset;
  931. if (old_vector) {
  932. cfg->move_in_progress = 1;
  933. cpumask_copy(cfg->old_domain, cfg->domain);
  934. }
  935. for_each_cpu_and(new_cpu, tmp_mask, cpu_online_mask)
  936. per_cpu(vector_irq, new_cpu)[vector] = irq;
  937. cfg->vector = vector;
  938. cpumask_copy(cfg->domain, tmp_mask);
  939. err = 0;
  940. break;
  941. }
  942. free_cpumask_var(tmp_mask);
  943. return err;
  944. }
  945. int assign_irq_vector(int irq, struct irq_cfg *cfg, const struct cpumask *mask)
  946. {
  947. int err;
  948. unsigned long flags;
  949. raw_spin_lock_irqsave(&vector_lock, flags);
  950. err = __assign_irq_vector(irq, cfg, mask);
  951. raw_spin_unlock_irqrestore(&vector_lock, flags);
  952. return err;
  953. }
  954. static void __clear_irq_vector(int irq, struct irq_cfg *cfg)
  955. {
  956. int cpu, vector;
  957. BUG_ON(!cfg->vector);
  958. vector = cfg->vector;
  959. for_each_cpu_and(cpu, cfg->domain, cpu_online_mask)
  960. per_cpu(vector_irq, cpu)[vector] = -1;
  961. cfg->vector = 0;
  962. cpumask_clear(cfg->domain);
  963. if (likely(!cfg->move_in_progress))
  964. return;
  965. for_each_cpu_and(cpu, cfg->old_domain, cpu_online_mask) {
  966. for (vector = FIRST_EXTERNAL_VECTOR; vector < NR_VECTORS;
  967. vector++) {
  968. if (per_cpu(vector_irq, cpu)[vector] != irq)
  969. continue;
  970. per_cpu(vector_irq, cpu)[vector] = -1;
  971. break;
  972. }
  973. }
  974. cfg->move_in_progress = 0;
  975. }
  976. void __setup_vector_irq(int cpu)
  977. {
  978. /* Initialize vector_irq on a new cpu */
  979. int irq, vector;
  980. struct irq_cfg *cfg;
  981. /*
  982. * vector_lock will make sure that we don't run into irq vector
  983. * assignments that might be happening on another cpu in parallel,
  984. * while we setup our initial vector to irq mappings.
  985. */
  986. raw_spin_lock(&vector_lock);
  987. /* Mark the inuse vectors */
  988. for_each_active_irq(irq) {
  989. cfg = irq_get_chip_data(irq);
  990. if (!cfg)
  991. continue;
  992. /*
  993. * If it is a legacy IRQ handled by the legacy PIC, this cpu
  994. * will be part of the irq_cfg's domain.
  995. */
  996. if (irq < legacy_pic->nr_legacy_irqs && !IO_APIC_IRQ(irq))
  997. cpumask_set_cpu(cpu, cfg->domain);
  998. if (!cpumask_test_cpu(cpu, cfg->domain))
  999. continue;
  1000. vector = cfg->vector;
  1001. per_cpu(vector_irq, cpu)[vector] = irq;
  1002. }
  1003. /* Mark the free vectors */
  1004. for (vector = 0; vector < NR_VECTORS; ++vector) {
  1005. irq = per_cpu(vector_irq, cpu)[vector];
  1006. if (irq < 0)
  1007. continue;
  1008. cfg = irq_cfg(irq);
  1009. if (!cpumask_test_cpu(cpu, cfg->domain))
  1010. per_cpu(vector_irq, cpu)[vector] = -1;
  1011. }
  1012. raw_spin_unlock(&vector_lock);
  1013. }
  1014. static struct irq_chip ioapic_chip;
  1015. static struct irq_chip ir_ioapic_chip;
  1016. #ifdef CONFIG_X86_32
  1017. static inline int IO_APIC_irq_trigger(int irq)
  1018. {
  1019. int apic, idx, pin;
  1020. for (apic = 0; apic < nr_ioapics; apic++) {
  1021. for (pin = 0; pin < nr_ioapic_registers[apic]; pin++) {
  1022. idx = find_irq_entry(apic, pin, mp_INT);
  1023. if ((idx != -1) && (irq == pin_2_irq(idx, apic, pin)))
  1024. return irq_trigger(idx);
  1025. }
  1026. }
  1027. /*
  1028. * nonexistent IRQs are edge default
  1029. */
  1030. return 0;
  1031. }
  1032. #else
  1033. static inline int IO_APIC_irq_trigger(int irq)
  1034. {
  1035. return 1;
  1036. }
  1037. #endif
  1038. static void ioapic_register_intr(unsigned int irq, struct irq_cfg *cfg,
  1039. unsigned long trigger)
  1040. {
  1041. struct irq_chip *chip = &ioapic_chip;
  1042. irq_flow_handler_t hdl;
  1043. bool fasteoi;
  1044. if ((trigger == IOAPIC_AUTO && IO_APIC_irq_trigger(irq)) ||
  1045. trigger == IOAPIC_LEVEL) {
  1046. irq_set_status_flags(irq, IRQ_LEVEL);
  1047. fasteoi = true;
  1048. } else {
  1049. irq_clear_status_flags(irq, IRQ_LEVEL);
  1050. fasteoi = false;
  1051. }
  1052. if (irq_remapped(cfg)) {
  1053. irq_set_status_flags(irq, IRQ_MOVE_PCNTXT);
  1054. chip = &ir_ioapic_chip;
  1055. fasteoi = trigger != 0;
  1056. }
  1057. hdl = fasteoi ? handle_fasteoi_irq : handle_edge_irq;
  1058. irq_set_chip_and_handler_name(irq, chip, hdl,
  1059. fasteoi ? "fasteoi" : "edge");
  1060. }
  1061. static int setup_ioapic_entry(int apic_id, int irq,
  1062. struct IO_APIC_route_entry *entry,
  1063. unsigned int destination, int trigger,
  1064. int polarity, int vector, int pin)
  1065. {
  1066. /*
  1067. * add it to the IO-APIC irq-routing table:
  1068. */
  1069. memset(entry,0,sizeof(*entry));
  1070. if (intr_remapping_enabled) {
  1071. struct intel_iommu *iommu = map_ioapic_to_ir(apic_id);
  1072. struct irte irte;
  1073. struct IR_IO_APIC_route_entry *ir_entry =
  1074. (struct IR_IO_APIC_route_entry *) entry;
  1075. int index;
  1076. if (!iommu)
  1077. panic("No mapping iommu for ioapic %d\n", apic_id);
  1078. index = alloc_irte(iommu, irq, 1);
  1079. if (index < 0)
  1080. panic("Failed to allocate IRTE for ioapic %d\n", apic_id);
  1081. prepare_irte(&irte, vector, destination);
  1082. /* Set source-id of interrupt request */
  1083. set_ioapic_sid(&irte, apic_id);
  1084. modify_irte(irq, &irte);
  1085. ir_entry->index2 = (index >> 15) & 0x1;
  1086. ir_entry->zero = 0;
  1087. ir_entry->format = 1;
  1088. ir_entry->index = (index & 0x7fff);
  1089. /*
  1090. * IO-APIC RTE will be configured with virtual vector.
  1091. * irq handler will do the explicit EOI to the io-apic.
  1092. */
  1093. ir_entry->vector = pin;
  1094. } else {
  1095. entry->delivery_mode = apic->irq_delivery_mode;
  1096. entry->dest_mode = apic->irq_dest_mode;
  1097. entry->dest = destination;
  1098. entry->vector = vector;
  1099. }
  1100. entry->mask = 0; /* enable IRQ */
  1101. entry->trigger = trigger;
  1102. entry->polarity = polarity;
  1103. /* Mask level triggered irqs.
  1104. * Use IRQ_DELAYED_DISABLE for edge triggered irqs.
  1105. */
  1106. if (trigger)
  1107. entry->mask = 1;
  1108. return 0;
  1109. }
  1110. static void setup_ioapic_irq(int apic_id, int pin, unsigned int irq,
  1111. struct irq_cfg *cfg, int trigger, int polarity)
  1112. {
  1113. struct IO_APIC_route_entry entry;
  1114. unsigned int dest;
  1115. if (!IO_APIC_IRQ(irq))
  1116. return;
  1117. /*
  1118. * For legacy irqs, cfg->domain starts with cpu 0 for legacy
  1119. * controllers like 8259. Now that IO-APIC can handle this irq, update
  1120. * the cfg->domain.
  1121. */
  1122. if (irq < legacy_pic->nr_legacy_irqs && cpumask_test_cpu(0, cfg->domain))
  1123. apic->vector_allocation_domain(0, cfg->domain);
  1124. if (assign_irq_vector(irq, cfg, apic->target_cpus()))
  1125. return;
  1126. dest = apic->cpu_mask_to_apicid_and(cfg->domain, apic->target_cpus());
  1127. apic_printk(APIC_VERBOSE,KERN_DEBUG
  1128. "IOAPIC[%d]: Set routing entry (%d-%d -> 0x%x -> "
  1129. "IRQ %d Mode:%i Active:%i)\n",
  1130. apic_id, mp_ioapics[apic_id].apicid, pin, cfg->vector,
  1131. irq, trigger, polarity);
  1132. if (setup_ioapic_entry(mp_ioapics[apic_id].apicid, irq, &entry,
  1133. dest, trigger, polarity, cfg->vector, pin)) {
  1134. printk("Failed to setup ioapic entry for ioapic %d, pin %d\n",
  1135. mp_ioapics[apic_id].apicid, pin);
  1136. __clear_irq_vector(irq, cfg);
  1137. return;
  1138. }
  1139. ioapic_register_intr(irq, cfg, trigger);
  1140. if (irq < legacy_pic->nr_legacy_irqs)
  1141. legacy_pic->mask(irq);
  1142. ioapic_write_entry(apic_id, pin, entry);
  1143. }
  1144. static struct {
  1145. DECLARE_BITMAP(pin_programmed, MP_MAX_IOAPIC_PIN + 1);
  1146. } mp_ioapic_routing[MAX_IO_APICS];
  1147. static bool __init io_apic_pin_not_connected(int idx, int apic_id, int pin)
  1148. {
  1149. if (idx != -1)
  1150. return false;
  1151. apic_printk(APIC_VERBOSE, KERN_DEBUG " apic %d pin %d not connected\n",
  1152. mp_ioapics[apic_id].apicid, pin);
  1153. return true;
  1154. }
  1155. static void __init __io_apic_setup_irqs(unsigned int apic_id)
  1156. {
  1157. int idx, node = cpu_to_node(0);
  1158. struct io_apic_irq_attr attr;
  1159. unsigned int pin, irq;
  1160. for (pin = 0; pin < nr_ioapic_registers[apic_id]; pin++) {
  1161. idx = find_irq_entry(apic_id, pin, mp_INT);
  1162. if (io_apic_pin_not_connected(idx, apic_id, pin))
  1163. continue;
  1164. irq = pin_2_irq(idx, apic_id, pin);
  1165. if ((apic_id > 0) && (irq > 16))
  1166. continue;
  1167. /*
  1168. * Skip the timer IRQ if there's a quirk handler
  1169. * installed and if it returns 1:
  1170. */
  1171. if (apic->multi_timer_check &&
  1172. apic->multi_timer_check(apic_id, irq))
  1173. continue;
  1174. set_io_apic_irq_attr(&attr, apic_id, pin, irq_trigger(idx),
  1175. irq_polarity(idx));
  1176. io_apic_setup_irq_pin(irq, node, &attr);
  1177. }
  1178. }
  1179. static void __init setup_IO_APIC_irqs(void)
  1180. {
  1181. unsigned int apic_id;
  1182. apic_printk(APIC_VERBOSE, KERN_DEBUG "init IO_APIC IRQs\n");
  1183. for (apic_id = 0; apic_id < nr_ioapics; apic_id++)
  1184. __io_apic_setup_irqs(apic_id);
  1185. }
  1186. /*
  1187. * for the gsit that is not in first ioapic
  1188. * but could not use acpi_register_gsi()
  1189. * like some special sci in IBM x3330
  1190. */
  1191. void setup_IO_APIC_irq_extra(u32 gsi)
  1192. {
  1193. int apic_id = 0, pin, idx, irq, node = cpu_to_node(0);
  1194. struct io_apic_irq_attr attr;
  1195. /*
  1196. * Convert 'gsi' to 'ioapic.pin'.
  1197. */
  1198. apic_id = mp_find_ioapic(gsi);
  1199. if (apic_id < 0)
  1200. return;
  1201. pin = mp_find_ioapic_pin(apic_id, gsi);
  1202. idx = find_irq_entry(apic_id, pin, mp_INT);
  1203. if (idx == -1)
  1204. return;
  1205. irq = pin_2_irq(idx, apic_id, pin);
  1206. /* Only handle the non legacy irqs on secondary ioapics */
  1207. if (apic_id == 0 || irq < NR_IRQS_LEGACY)
  1208. return;
  1209. set_io_apic_irq_attr(&attr, apic_id, pin, irq_trigger(idx),
  1210. irq_polarity(idx));
  1211. io_apic_setup_irq_pin_once(irq, node, &attr);
  1212. }
  1213. /*
  1214. * Set up the timer pin, possibly with the 8259A-master behind.
  1215. */
  1216. static void __init setup_timer_IRQ0_pin(unsigned int apic_id, unsigned int pin,
  1217. int vector)
  1218. {
  1219. struct IO_APIC_route_entry entry;
  1220. if (intr_remapping_enabled)
  1221. return;
  1222. memset(&entry, 0, sizeof(entry));
  1223. /*
  1224. * We use logical delivery to get the timer IRQ
  1225. * to the first CPU.
  1226. */
  1227. entry.dest_mode = apic->irq_dest_mode;
  1228. entry.mask = 0; /* don't mask IRQ for edge */
  1229. entry.dest = apic->cpu_mask_to_apicid(apic->target_cpus());
  1230. entry.delivery_mode = apic->irq_delivery_mode;
  1231. entry.polarity = 0;
  1232. entry.trigger = 0;
  1233. entry.vector = vector;
  1234. /*
  1235. * The timer IRQ doesn't have to know that behind the
  1236. * scene we may have a 8259A-master in AEOI mode ...
  1237. */
  1238. irq_set_chip_and_handler_name(0, &ioapic_chip, handle_edge_irq,
  1239. "edge");
  1240. /*
  1241. * Add it to the IO-APIC irq-routing table:
  1242. */
  1243. ioapic_write_entry(apic_id, pin, entry);
  1244. }
  1245. __apicdebuginit(void) print_IO_APIC(void)
  1246. {
  1247. int apic, i;
  1248. union IO_APIC_reg_00 reg_00;
  1249. union IO_APIC_reg_01 reg_01;
  1250. union IO_APIC_reg_02 reg_02;
  1251. union IO_APIC_reg_03 reg_03;
  1252. unsigned long flags;
  1253. struct irq_cfg *cfg;
  1254. unsigned int irq;
  1255. printk(KERN_DEBUG "number of MP IRQ sources: %d.\n", mp_irq_entries);
  1256. for (i = 0; i < nr_ioapics; i++)
  1257. printk(KERN_DEBUG "number of IO-APIC #%d registers: %d.\n",
  1258. mp_ioapics[i].apicid, nr_ioapic_registers[i]);
  1259. /*
  1260. * We are a bit conservative about what we expect. We have to
  1261. * know about every hardware change ASAP.
  1262. */
  1263. printk(KERN_INFO "testing the IO APIC.......................\n");
  1264. for (apic = 0; apic < nr_ioapics; apic++) {
  1265. raw_spin_lock_irqsave(&ioapic_lock, flags);
  1266. reg_00.raw = io_apic_read(apic, 0);
  1267. reg_01.raw = io_apic_read(apic, 1);
  1268. if (reg_01.bits.version >= 0x10)
  1269. reg_02.raw = io_apic_read(apic, 2);
  1270. if (reg_01.bits.version >= 0x20)
  1271. reg_03.raw = io_apic_read(apic, 3);
  1272. raw_spin_unlock_irqrestore(&ioapic_lock, flags);
  1273. printk("\n");
  1274. printk(KERN_DEBUG "IO APIC #%d......\n", mp_ioapics[apic].apicid);
  1275. printk(KERN_DEBUG ".... register #00: %08X\n", reg_00.raw);
  1276. printk(KERN_DEBUG "....... : physical APIC id: %02X\n", reg_00.bits.ID);
  1277. printk(KERN_DEBUG "....... : Delivery Type: %X\n", reg_00.bits.delivery_type);
  1278. printk(KERN_DEBUG "....... : LTS : %X\n", reg_00.bits.LTS);
  1279. printk(KERN_DEBUG ".... register #01: %08X\n", *(int *)&reg_01);
  1280. printk(KERN_DEBUG "....... : max redirection entries: %04X\n", reg_01.bits.entries);
  1281. printk(KERN_DEBUG "....... : PRQ implemented: %X\n", reg_01.bits.PRQ);
  1282. printk(KERN_DEBUG "....... : IO APIC version: %04X\n", reg_01.bits.version);
  1283. /*
  1284. * Some Intel chipsets with IO APIC VERSION of 0x1? don't have reg_02,
  1285. * but the value of reg_02 is read as the previous read register
  1286. * value, so ignore it if reg_02 == reg_01.
  1287. */
  1288. if (reg_01.bits.version >= 0x10 && reg_02.raw != reg_01.raw) {
  1289. printk(KERN_DEBUG ".... register #02: %08X\n", reg_02.raw);
  1290. printk(KERN_DEBUG "....... : arbitration: %02X\n", reg_02.bits.arbitration);
  1291. }
  1292. /*
  1293. * Some Intel chipsets with IO APIC VERSION of 0x2? don't have reg_02
  1294. * or reg_03, but the value of reg_0[23] is read as the previous read
  1295. * register value, so ignore it if reg_03 == reg_0[12].
  1296. */
  1297. if (reg_01.bits.version >= 0x20 && reg_03.raw != reg_02.raw &&
  1298. reg_03.raw != reg_01.raw) {
  1299. printk(KERN_DEBUG ".... register #03: %08X\n", reg_03.raw);
  1300. printk(KERN_DEBUG "....... : Boot DT : %X\n", reg_03.bits.boot_DT);
  1301. }
  1302. printk(KERN_DEBUG ".... IRQ redirection table:\n");
  1303. printk(KERN_DEBUG " NR Dst Mask Trig IRR Pol"
  1304. " Stat Dmod Deli Vect:\n");
  1305. for (i = 0; i <= reg_01.bits.entries; i++) {
  1306. struct IO_APIC_route_entry entry;
  1307. entry = ioapic_read_entry(apic, i);
  1308. printk(KERN_DEBUG " %02x %03X ",
  1309. i,
  1310. entry.dest
  1311. );
  1312. printk("%1d %1d %1d %1d %1d %1d %1d %02X\n",
  1313. entry.mask,
  1314. entry.trigger,
  1315. entry.irr,
  1316. entry.polarity,
  1317. entry.delivery_status,
  1318. entry.dest_mode,
  1319. entry.delivery_mode,
  1320. entry.vector
  1321. );
  1322. }
  1323. }
  1324. printk(KERN_DEBUG "IRQ to pin mappings:\n");
  1325. for_each_active_irq(irq) {
  1326. struct irq_pin_list *entry;
  1327. cfg = irq_get_chip_data(irq);
  1328. if (!cfg)
  1329. continue;
  1330. entry = cfg->irq_2_pin;
  1331. if (!entry)
  1332. continue;
  1333. printk(KERN_DEBUG "IRQ%d ", irq);
  1334. for_each_irq_pin(entry, cfg->irq_2_pin)
  1335. printk("-> %d:%d", entry->apic, entry->pin);
  1336. printk("\n");
  1337. }
  1338. printk(KERN_INFO ".................................... done.\n");
  1339. return;
  1340. }
  1341. __apicdebuginit(void) print_APIC_field(int base)
  1342. {
  1343. int i;
  1344. printk(KERN_DEBUG);
  1345. for (i = 0; i < 8; i++)
  1346. printk(KERN_CONT "%08x", apic_read(base + i*0x10));
  1347. printk(KERN_CONT "\n");
  1348. }
  1349. __apicdebuginit(void) print_local_APIC(void *dummy)
  1350. {
  1351. unsigned int i, v, ver, maxlvt;
  1352. u64 icr;
  1353. printk(KERN_DEBUG "printing local APIC contents on CPU#%d/%d:\n",
  1354. smp_processor_id(), hard_smp_processor_id());
  1355. v = apic_read(APIC_ID);
  1356. printk(KERN_INFO "... APIC ID: %08x (%01x)\n", v, read_apic_id());
  1357. v = apic_read(APIC_LVR);
  1358. printk(KERN_INFO "... APIC VERSION: %08x\n", v);
  1359. ver = GET_APIC_VERSION(v);
  1360. maxlvt = lapic_get_maxlvt();
  1361. v = apic_read(APIC_TASKPRI);
  1362. printk(KERN_DEBUG "... APIC TASKPRI: %08x (%02x)\n", v, v & APIC_TPRI_MASK);
  1363. if (APIC_INTEGRATED(ver)) { /* !82489DX */
  1364. if (!APIC_XAPIC(ver)) {
  1365. v = apic_read(APIC_ARBPRI);
  1366. printk(KERN_DEBUG "... APIC ARBPRI: %08x (%02x)\n", v,
  1367. v & APIC_ARBPRI_MASK);
  1368. }
  1369. v = apic_read(APIC_PROCPRI);
  1370. printk(KERN_DEBUG "... APIC PROCPRI: %08x\n", v);
  1371. }
  1372. /*
  1373. * Remote read supported only in the 82489DX and local APIC for
  1374. * Pentium processors.
  1375. */
  1376. if (!APIC_INTEGRATED(ver) || maxlvt == 3) {
  1377. v = apic_read(APIC_RRR);
  1378. printk(KERN_DEBUG "... APIC RRR: %08x\n", v);
  1379. }
  1380. v = apic_read(APIC_LDR);
  1381. printk(KERN_DEBUG "... APIC LDR: %08x\n", v);
  1382. if (!x2apic_enabled()) {
  1383. v = apic_read(APIC_DFR);
  1384. printk(KERN_DEBUG "... APIC DFR: %08x\n", v);
  1385. }
  1386. v = apic_read(APIC_SPIV);
  1387. printk(KERN_DEBUG "... APIC SPIV: %08x\n", v);
  1388. printk(KERN_DEBUG "... APIC ISR field:\n");
  1389. print_APIC_field(APIC_ISR);
  1390. printk(KERN_DEBUG "... APIC TMR field:\n");
  1391. print_APIC_field(APIC_TMR);
  1392. printk(KERN_DEBUG "... APIC IRR field:\n");
  1393. print_APIC_field(APIC_IRR);
  1394. if (APIC_INTEGRATED(ver)) { /* !82489DX */
  1395. if (maxlvt > 3) /* Due to the Pentium erratum 3AP. */
  1396. apic_write(APIC_ESR, 0);
  1397. v = apic_read(APIC_ESR);
  1398. printk(KERN_DEBUG "... APIC ESR: %08x\n", v);
  1399. }
  1400. icr = apic_icr_read();
  1401. printk(KERN_DEBUG "... APIC ICR: %08x\n", (u32)icr);
  1402. printk(KERN_DEBUG "... APIC ICR2: %08x\n", (u32)(icr >> 32));
  1403. v = apic_read(APIC_LVTT);
  1404. printk(KERN_DEBUG "... APIC LVTT: %08x\n", v);
  1405. if (maxlvt > 3) { /* PC is LVT#4. */
  1406. v = apic_read(APIC_LVTPC);
  1407. printk(KERN_DEBUG "... APIC LVTPC: %08x\n", v);
  1408. }
  1409. v = apic_read(APIC_LVT0);
  1410. printk(KERN_DEBUG "... APIC LVT0: %08x\n", v);
  1411. v = apic_read(APIC_LVT1);
  1412. printk(KERN_DEBUG "... APIC LVT1: %08x\n", v);
  1413. if (maxlvt > 2) { /* ERR is LVT#3. */
  1414. v = apic_read(APIC_LVTERR);
  1415. printk(KERN_DEBUG "... APIC LVTERR: %08x\n", v);
  1416. }
  1417. v = apic_read(APIC_TMICT);
  1418. printk(KERN_DEBUG "... APIC TMICT: %08x\n", v);
  1419. v = apic_read(APIC_TMCCT);
  1420. printk(KERN_DEBUG "... APIC TMCCT: %08x\n", v);
  1421. v = apic_read(APIC_TDCR);
  1422. printk(KERN_DEBUG "... APIC TDCR: %08x\n", v);
  1423. if (boot_cpu_has(X86_FEATURE_EXTAPIC)) {
  1424. v = apic_read(APIC_EFEAT);
  1425. maxlvt = (v >> 16) & 0xff;
  1426. printk(KERN_DEBUG "... APIC EFEAT: %08x\n", v);
  1427. v = apic_read(APIC_ECTRL);
  1428. printk(KERN_DEBUG "... APIC ECTRL: %08x\n", v);
  1429. for (i = 0; i < maxlvt; i++) {
  1430. v = apic_read(APIC_EILVTn(i));
  1431. printk(KERN_DEBUG "... APIC EILVT%d: %08x\n", i, v);
  1432. }
  1433. }
  1434. printk("\n");
  1435. }
  1436. __apicdebuginit(void) print_local_APICs(int maxcpu)
  1437. {
  1438. int cpu;
  1439. if (!maxcpu)
  1440. return;
  1441. preempt_disable();
  1442. for_each_online_cpu(cpu) {
  1443. if (cpu >= maxcpu)
  1444. break;
  1445. smp_call_function_single(cpu, print_local_APIC, NULL, 1);
  1446. }
  1447. preempt_enable();
  1448. }
  1449. __apicdebuginit(void) print_PIC(void)
  1450. {
  1451. unsigned int v;
  1452. unsigned long flags;
  1453. if (!legacy_pic->nr_legacy_irqs)
  1454. return;
  1455. printk(KERN_DEBUG "\nprinting PIC contents\n");
  1456. raw_spin_lock_irqsave(&i8259A_lock, flags);
  1457. v = inb(0xa1) << 8 | inb(0x21);
  1458. printk(KERN_DEBUG "... PIC IMR: %04x\n", v);
  1459. v = inb(0xa0) << 8 | inb(0x20);
  1460. printk(KERN_DEBUG "... PIC IRR: %04x\n", v);
  1461. outb(0x0b,0xa0);
  1462. outb(0x0b,0x20);
  1463. v = inb(0xa0) << 8 | inb(0x20);
  1464. outb(0x0a,0xa0);
  1465. outb(0x0a,0x20);
  1466. raw_spin_unlock_irqrestore(&i8259A_lock, flags);
  1467. printk(KERN_DEBUG "... PIC ISR: %04x\n", v);
  1468. v = inb(0x4d1) << 8 | inb(0x4d0);
  1469. printk(KERN_DEBUG "... PIC ELCR: %04x\n", v);
  1470. }
  1471. static int __initdata show_lapic = 1;
  1472. static __init int setup_show_lapic(char *arg)
  1473. {
  1474. int num = -1;
  1475. if (strcmp(arg, "all") == 0) {
  1476. show_lapic = CONFIG_NR_CPUS;
  1477. } else {
  1478. get_option(&arg, &num);
  1479. if (num >= 0)
  1480. show_lapic = num;
  1481. }
  1482. return 1;
  1483. }
  1484. __setup("show_lapic=", setup_show_lapic);
  1485. __apicdebuginit(int) print_ICs(void)
  1486. {
  1487. if (apic_verbosity == APIC_QUIET)
  1488. return 0;
  1489. print_PIC();
  1490. /* don't print out if apic is not there */
  1491. if (!cpu_has_apic && !apic_from_smp_config())
  1492. return 0;
  1493. print_local_APICs(show_lapic);
  1494. print_IO_APIC();
  1495. return 0;
  1496. }
  1497. fs_initcall(print_ICs);
  1498. /* Where if anywhere is the i8259 connect in external int mode */
  1499. static struct { int pin, apic; } ioapic_i8259 = { -1, -1 };
  1500. void __init enable_IO_APIC(void)
  1501. {
  1502. int i8259_apic, i8259_pin;
  1503. int apic;
  1504. if (!legacy_pic->nr_legacy_irqs)
  1505. return;
  1506. for(apic = 0; apic < nr_ioapics; apic++) {
  1507. int pin;
  1508. /* See if any of the pins is in ExtINT mode */
  1509. for (pin = 0; pin < nr_ioapic_registers[apic]; pin++) {
  1510. struct IO_APIC_route_entry entry;
  1511. entry = ioapic_read_entry(apic, pin);
  1512. /* If the interrupt line is enabled and in ExtInt mode
  1513. * I have found the pin where the i8259 is connected.
  1514. */
  1515. if ((entry.mask == 0) && (entry.delivery_mode == dest_ExtINT)) {
  1516. ioapic_i8259.apic = apic;
  1517. ioapic_i8259.pin = pin;
  1518. goto found_i8259;
  1519. }
  1520. }
  1521. }
  1522. found_i8259:
  1523. /* Look to see what if the MP table has reported the ExtINT */
  1524. /* If we could not find the appropriate pin by looking at the ioapic
  1525. * the i8259 probably is not connected the ioapic but give the
  1526. * mptable a chance anyway.
  1527. */
  1528. i8259_pin = find_isa_irq_pin(0, mp_ExtINT);
  1529. i8259_apic = find_isa_irq_apic(0, mp_ExtINT);
  1530. /* Trust the MP table if nothing is setup in the hardware */
  1531. if ((ioapic_i8259.pin == -1) && (i8259_pin >= 0)) {
  1532. printk(KERN_WARNING "ExtINT not setup in hardware but reported by MP table\n");
  1533. ioapic_i8259.pin = i8259_pin;
  1534. ioapic_i8259.apic = i8259_apic;
  1535. }
  1536. /* Complain if the MP table and the hardware disagree */
  1537. if (((ioapic_i8259.apic != i8259_apic) || (ioapic_i8259.pin != i8259_pin)) &&
  1538. (i8259_pin >= 0) && (ioapic_i8259.pin >= 0))
  1539. {
  1540. printk(KERN_WARNING "ExtINT in hardware and MP table differ\n");
  1541. }
  1542. /*
  1543. * Do not trust the IO-APIC being empty at bootup
  1544. */
  1545. clear_IO_APIC();
  1546. }
  1547. /*
  1548. * Not an __init, needed by the reboot code
  1549. */
  1550. void disable_IO_APIC(void)
  1551. {
  1552. /*
  1553. * Clear the IO-APIC before rebooting:
  1554. */
  1555. clear_IO_APIC();
  1556. if (!legacy_pic->nr_legacy_irqs)
  1557. return;
  1558. /*
  1559. * If the i8259 is routed through an IOAPIC
  1560. * Put that IOAPIC in virtual wire mode
  1561. * so legacy interrupts can be delivered.
  1562. *
  1563. * With interrupt-remapping, for now we will use virtual wire A mode,
  1564. * as virtual wire B is little complex (need to configure both
  1565. * IOAPIC RTE as well as interrupt-remapping table entry).
  1566. * As this gets called during crash dump, keep this simple for now.
  1567. */
  1568. if (ioapic_i8259.pin != -1 && !intr_remapping_enabled) {
  1569. struct IO_APIC_route_entry entry;
  1570. memset(&entry, 0, sizeof(entry));
  1571. entry.mask = 0; /* Enabled */
  1572. entry.trigger = 0; /* Edge */
  1573. entry.irr = 0;
  1574. entry.polarity = 0; /* High */
  1575. entry.delivery_status = 0;
  1576. entry.dest_mode = 0; /* Physical */
  1577. entry.delivery_mode = dest_ExtINT; /* ExtInt */
  1578. entry.vector = 0;
  1579. entry.dest = read_apic_id();
  1580. /*
  1581. * Add it to the IO-APIC irq-routing table:
  1582. */
  1583. ioapic_write_entry(ioapic_i8259.apic, ioapic_i8259.pin, entry);
  1584. }
  1585. /*
  1586. * Use virtual wire A mode when interrupt remapping is enabled.
  1587. */
  1588. if (cpu_has_apic || apic_from_smp_config())
  1589. disconnect_bsp_APIC(!intr_remapping_enabled &&
  1590. ioapic_i8259.pin != -1);
  1591. }
  1592. #ifdef CONFIG_X86_32
  1593. /*
  1594. * function to set the IO-APIC physical IDs based on the
  1595. * values stored in the MPC table.
  1596. *
  1597. * by Matt Domsch <Matt_Domsch@dell.com> Tue Dec 21 12:25:05 CST 1999
  1598. */
  1599. void __init setup_ioapic_ids_from_mpc_nocheck(void)
  1600. {
  1601. union IO_APIC_reg_00 reg_00;
  1602. physid_mask_t phys_id_present_map;
  1603. int apic_id;
  1604. int i;
  1605. unsigned char old_id;
  1606. unsigned long flags;
  1607. /*
  1608. * This is broken; anything with a real cpu count has to
  1609. * circumvent this idiocy regardless.
  1610. */
  1611. apic->ioapic_phys_id_map(&phys_cpu_present_map, &phys_id_present_map);
  1612. /*
  1613. * Set the IOAPIC ID to the value stored in the MPC table.
  1614. */
  1615. for (apic_id = 0; apic_id < nr_ioapics; apic_id++) {
  1616. /* Read the register 0 value */
  1617. raw_spin_lock_irqsave(&ioapic_lock, flags);
  1618. reg_00.raw = io_apic_read(apic_id, 0);
  1619. raw_spin_unlock_irqrestore(&ioapic_lock, flags);
  1620. old_id = mp_ioapics[apic_id].apicid;
  1621. if (mp_ioapics[apic_id].apicid >= get_physical_broadcast()) {
  1622. printk(KERN_ERR "BIOS bug, IO-APIC#%d ID is %d in the MPC table!...\n",
  1623. apic_id, mp_ioapics[apic_id].apicid);
  1624. printk(KERN_ERR "... fixing up to %d. (tell your hw vendor)\n",
  1625. reg_00.bits.ID);
  1626. mp_ioapics[apic_id].apicid = reg_00.bits.ID;
  1627. }
  1628. /*
  1629. * Sanity check, is the ID really free? Every APIC in a
  1630. * system must have a unique ID or we get lots of nice
  1631. * 'stuck on smp_invalidate_needed IPI wait' messages.
  1632. */
  1633. if (apic->check_apicid_used(&phys_id_present_map,
  1634. mp_ioapics[apic_id].apicid)) {
  1635. printk(KERN_ERR "BIOS bug, IO-APIC#%d ID %d is already used!...\n",
  1636. apic_id, mp_ioapics[apic_id].apicid);
  1637. for (i = 0; i < get_physical_broadcast(); i++)
  1638. if (!physid_isset(i, phys_id_present_map))
  1639. break;
  1640. if (i >= get_physical_broadcast())
  1641. panic("Max APIC ID exceeded!\n");
  1642. printk(KERN_ERR "... fixing up to %d. (tell your hw vendor)\n",
  1643. i);
  1644. physid_set(i, phys_id_present_map);
  1645. mp_ioapics[apic_id].apicid = i;
  1646. } else {
  1647. physid_mask_t tmp;
  1648. apic->apicid_to_cpu_present(mp_ioapics[apic_id].apicid, &tmp);
  1649. apic_printk(APIC_VERBOSE, "Setting %d in the "
  1650. "phys_id_present_map\n",
  1651. mp_ioapics[apic_id].apicid);
  1652. physids_or(phys_id_present_map, phys_id_present_map, tmp);
  1653. }
  1654. /*
  1655. * We need to adjust the IRQ routing table
  1656. * if the ID changed.
  1657. */
  1658. if (old_id != mp_ioapics[apic_id].apicid)
  1659. for (i = 0; i < mp_irq_entries; i++)
  1660. if (mp_irqs[i].dstapic == old_id)
  1661. mp_irqs[i].dstapic
  1662. = mp_ioapics[apic_id].apicid;
  1663. /*
  1664. * Update the ID register according to the right value
  1665. * from the MPC table if they are different.
  1666. */
  1667. if (mp_ioapics[apic_id].apicid == reg_00.bits.ID)
  1668. continue;
  1669. apic_printk(APIC_VERBOSE, KERN_INFO
  1670. "...changing IO-APIC physical APIC ID to %d ...",
  1671. mp_ioapics[apic_id].apicid);
  1672. reg_00.bits.ID = mp_ioapics[apic_id].apicid;
  1673. raw_spin_lock_irqsave(&ioapic_lock, flags);
  1674. io_apic_write(apic_id, 0, reg_00.raw);
  1675. raw_spin_unlock_irqrestore(&ioapic_lock, flags);
  1676. /*
  1677. * Sanity check
  1678. */
  1679. raw_spin_lock_irqsave(&ioapic_lock, flags);
  1680. reg_00.raw = io_apic_read(apic_id, 0);
  1681. raw_spin_unlock_irqrestore(&ioapic_lock, flags);
  1682. if (reg_00.bits.ID != mp_ioapics[apic_id].apicid)
  1683. printk("could not set ID!\n");
  1684. else
  1685. apic_printk(APIC_VERBOSE, " ok.\n");
  1686. }
  1687. }
  1688. void __init setup_ioapic_ids_from_mpc(void)
  1689. {
  1690. if (acpi_ioapic)
  1691. return;
  1692. /*
  1693. * Don't check I/O APIC IDs for xAPIC systems. They have
  1694. * no meaning without the serial APIC bus.
  1695. */
  1696. if (!(boot_cpu_data.x86_vendor == X86_VENDOR_INTEL)
  1697. || APIC_XAPIC(apic_version[boot_cpu_physical_apicid]))
  1698. return;
  1699. setup_ioapic_ids_from_mpc_nocheck();
  1700. }
  1701. #endif
  1702. int no_timer_check __initdata;
  1703. static int __init notimercheck(char *s)
  1704. {
  1705. no_timer_check = 1;
  1706. return 1;
  1707. }
  1708. __setup("no_timer_check", notimercheck);
  1709. /*
  1710. * There is a nasty bug in some older SMP boards, their mptable lies
  1711. * about the timer IRQ. We do the following to work around the situation:
  1712. *
  1713. * - timer IRQ defaults to IO-APIC IRQ
  1714. * - if this function detects that timer IRQs are defunct, then we fall
  1715. * back to ISA timer IRQs
  1716. */
  1717. static int __init timer_irq_works(void)
  1718. {
  1719. unsigned long t1 = jiffies;
  1720. unsigned long flags;
  1721. if (no_timer_check)
  1722. return 1;
  1723. local_save_flags(flags);
  1724. local_irq_enable();
  1725. /* Let ten ticks pass... */
  1726. mdelay((10 * 1000) / HZ);
  1727. local_irq_restore(flags);
  1728. /*
  1729. * Expect a few ticks at least, to be sure some possible
  1730. * glue logic does not lock up after one or two first
  1731. * ticks in a non-ExtINT mode. Also the local APIC
  1732. * might have cached one ExtINT interrupt. Finally, at
  1733. * least one tick may be lost due to delays.
  1734. */
  1735. /* jiffies wrap? */
  1736. if (time_after(jiffies, t1 + 4))
  1737. return 1;
  1738. return 0;
  1739. }
  1740. /*
  1741. * In the SMP+IOAPIC case it might happen that there are an unspecified
  1742. * number of pending IRQ events unhandled. These cases are very rare,
  1743. * so we 'resend' these IRQs via IPIs, to the same CPU. It's much
  1744. * better to do it this way as thus we do not have to be aware of
  1745. * 'pending' interrupts in the IRQ path, except at this point.
  1746. */
  1747. /*
  1748. * Edge triggered needs to resend any interrupt
  1749. * that was delayed but this is now handled in the device
  1750. * independent code.
  1751. */
  1752. /*
  1753. * Starting up a edge-triggered IO-APIC interrupt is
  1754. * nasty - we need to make sure that we get the edge.
  1755. * If it is already asserted for some reason, we need
  1756. * return 1 to indicate that is was pending.
  1757. *
  1758. * This is not complete - we should be able to fake
  1759. * an edge even if it isn't on the 8259A...
  1760. */
  1761. static unsigned int startup_ioapic_irq(struct irq_data *data)
  1762. {
  1763. int was_pending = 0, irq = data->irq;
  1764. unsigned long flags;
  1765. raw_spin_lock_irqsave(&ioapic_lock, flags);
  1766. if (irq < legacy_pic->nr_legacy_irqs) {
  1767. legacy_pic->mask(irq);
  1768. if (legacy_pic->irq_pending(irq))
  1769. was_pending = 1;
  1770. }
  1771. __unmask_ioapic(data->chip_data);
  1772. raw_spin_unlock_irqrestore(&ioapic_lock, flags);
  1773. return was_pending;
  1774. }
  1775. static int ioapic_retrigger_irq(struct irq_data *data)
  1776. {
  1777. struct irq_cfg *cfg = data->chip_data;
  1778. unsigned long flags;
  1779. raw_spin_lock_irqsave(&vector_lock, flags);
  1780. apic->send_IPI_mask(cpumask_of(cpumask_first(cfg->domain)), cfg->vector);
  1781. raw_spin_unlock_irqrestore(&vector_lock, flags);
  1782. return 1;
  1783. }
  1784. /*
  1785. * Level and edge triggered IO-APIC interrupts need different handling,
  1786. * so we use two separate IRQ descriptors. Edge triggered IRQs can be
  1787. * handled with the level-triggered descriptor, but that one has slightly
  1788. * more overhead. Level-triggered interrupts cannot be handled with the
  1789. * edge-triggered handler, without risking IRQ storms and other ugly
  1790. * races.
  1791. */
  1792. #ifdef CONFIG_SMP
  1793. void send_cleanup_vector(struct irq_cfg *cfg)
  1794. {
  1795. cpumask_var_t cleanup_mask;
  1796. if (unlikely(!alloc_cpumask_var(&cleanup_mask, GFP_ATOMIC))) {
  1797. unsigned int i;
  1798. for_each_cpu_and(i, cfg->old_domain, cpu_online_mask)
  1799. apic->send_IPI_mask(cpumask_of(i), IRQ_MOVE_CLEANUP_VECTOR);
  1800. } else {
  1801. cpumask_and(cleanup_mask, cfg->old_domain, cpu_online_mask);
  1802. apic->send_IPI_mask(cleanup_mask, IRQ_MOVE_CLEANUP_VECTOR);
  1803. free_cpumask_var(cleanup_mask);
  1804. }
  1805. cfg->move_in_progress = 0;
  1806. }
  1807. static void __target_IO_APIC_irq(unsigned int irq, unsigned int dest, struct irq_cfg *cfg)
  1808. {
  1809. int apic, pin;
  1810. struct irq_pin_list *entry;
  1811. u8 vector = cfg->vector;
  1812. for_each_irq_pin(entry, cfg->irq_2_pin) {
  1813. unsigned int reg;
  1814. apic = entry->apic;
  1815. pin = entry->pin;
  1816. /*
  1817. * With interrupt-remapping, destination information comes
  1818. * from interrupt-remapping table entry.
  1819. */
  1820. if (!irq_remapped(cfg))
  1821. io_apic_write(apic, 0x11 + pin*2, dest);
  1822. reg = io_apic_read(apic, 0x10 + pin*2);
  1823. reg &= ~IO_APIC_REDIR_VECTOR_MASK;
  1824. reg |= vector;
  1825. io_apic_modify(apic, 0x10 + pin*2, reg);
  1826. }
  1827. }
  1828. /*
  1829. * Either sets data->affinity to a valid value, and returns
  1830. * ->cpu_mask_to_apicid of that in dest_id, or returns -1 and
  1831. * leaves data->affinity untouched.
  1832. */
  1833. int __ioapic_set_affinity(struct irq_data *data, const struct cpumask *mask,
  1834. unsigned int *dest_id)
  1835. {
  1836. struct irq_cfg *cfg = data->chip_data;
  1837. if (!cpumask_intersects(mask, cpu_online_mask))
  1838. return -1;
  1839. if (assign_irq_vector(data->irq, data->chip_data, mask))
  1840. return -1;
  1841. cpumask_copy(data->affinity, mask);
  1842. *dest_id = apic->cpu_mask_to_apicid_and(mask, cfg->domain);
  1843. return 0;
  1844. }
  1845. static int
  1846. ioapic_set_affinity(struct irq_data *data, const struct cpumask *mask,
  1847. bool force)
  1848. {
  1849. unsigned int dest, irq = data->irq;
  1850. unsigned long flags;
  1851. int ret;
  1852. raw_spin_lock_irqsave(&ioapic_lock, flags);
  1853. ret = __ioapic_set_affinity(data, mask, &dest);
  1854. if (!ret) {
  1855. /* Only the high 8 bits are valid. */
  1856. dest = SET_APIC_LOGICAL_ID(dest);
  1857. __target_IO_APIC_irq(irq, dest, data->chip_data);
  1858. }
  1859. raw_spin_unlock_irqrestore(&ioapic_lock, flags);
  1860. return ret;
  1861. }
  1862. #ifdef CONFIG_INTR_REMAP
  1863. /*
  1864. * Migrate the IO-APIC irq in the presence of intr-remapping.
  1865. *
  1866. * For both level and edge triggered, irq migration is a simple atomic
  1867. * update(of vector and cpu destination) of IRTE and flush the hardware cache.
  1868. *
  1869. * For level triggered, we eliminate the io-apic RTE modification (with the
  1870. * updated vector information), by using a virtual vector (io-apic pin number).
  1871. * Real vector that is used for interrupting cpu will be coming from
  1872. * the interrupt-remapping table entry.
  1873. */
  1874. static int
  1875. ir_ioapic_set_affinity(struct irq_data *data, const struct cpumask *mask,
  1876. bool force)
  1877. {
  1878. struct irq_cfg *cfg = data->chip_data;
  1879. unsigned int dest, irq = data->irq;
  1880. struct irte irte;
  1881. if (!cpumask_intersects(mask, cpu_online_mask))
  1882. return -EINVAL;
  1883. if (get_irte(irq, &irte))
  1884. return -EBUSY;
  1885. if (assign_irq_vector(irq, cfg, mask))
  1886. return -EBUSY;
  1887. dest = apic->cpu_mask_to_apicid_and(cfg->domain, mask);
  1888. irte.vector = cfg->vector;
  1889. irte.dest_id = IRTE_DEST(dest);
  1890. /*
  1891. * Modified the IRTE and flushes the Interrupt entry cache.
  1892. */
  1893. modify_irte(irq, &irte);
  1894. if (cfg->move_in_progress)
  1895. send_cleanup_vector(cfg);
  1896. cpumask_copy(data->affinity, mask);
  1897. return 0;
  1898. }
  1899. #else
  1900. static inline int
  1901. ir_ioapic_set_affinity(struct irq_data *data, const struct cpumask *mask,
  1902. bool force)
  1903. {
  1904. return 0;
  1905. }
  1906. #endif
  1907. asmlinkage void smp_irq_move_cleanup_interrupt(void)
  1908. {
  1909. unsigned vector, me;
  1910. ack_APIC_irq();
  1911. exit_idle();
  1912. irq_enter();
  1913. me = smp_processor_id();
  1914. for (vector = FIRST_EXTERNAL_VECTOR; vector < NR_VECTORS; vector++) {
  1915. unsigned int irq;
  1916. unsigned int irr;
  1917. struct irq_desc *desc;
  1918. struct irq_cfg *cfg;
  1919. irq = __this_cpu_read(vector_irq[vector]);
  1920. if (irq == -1)
  1921. continue;
  1922. desc = irq_to_desc(irq);
  1923. if (!desc)
  1924. continue;
  1925. cfg = irq_cfg(irq);
  1926. raw_spin_lock(&desc->lock);
  1927. /*
  1928. * Check if the irq migration is in progress. If so, we
  1929. * haven't received the cleanup request yet for this irq.
  1930. */
  1931. if (cfg->move_in_progress)
  1932. goto unlock;
  1933. if (vector == cfg->vector && cpumask_test_cpu(me, cfg->domain))
  1934. goto unlock;
  1935. irr = apic_read(APIC_IRR + (vector / 32 * 0x10));
  1936. /*
  1937. * Check if the vector that needs to be cleanedup is
  1938. * registered at the cpu's IRR. If so, then this is not
  1939. * the best time to clean it up. Lets clean it up in the
  1940. * next attempt by sending another IRQ_MOVE_CLEANUP_VECTOR
  1941. * to myself.
  1942. */
  1943. if (irr & (1 << (vector % 32))) {
  1944. apic->send_IPI_self(IRQ_MOVE_CLEANUP_VECTOR);
  1945. goto unlock;
  1946. }
  1947. __this_cpu_write(vector_irq[vector], -1);
  1948. unlock:
  1949. raw_spin_unlock(&desc->lock);
  1950. }
  1951. irq_exit();
  1952. }
  1953. static void __irq_complete_move(struct irq_cfg *cfg, unsigned vector)
  1954. {
  1955. unsigned me;
  1956. if (likely(!cfg->move_in_progress))
  1957. return;
  1958. me = smp_processor_id();
  1959. if (vector == cfg->vector && cpumask_test_cpu(me, cfg->domain))
  1960. send_cleanup_vector(cfg);
  1961. }
  1962. static void irq_complete_move(struct irq_cfg *cfg)
  1963. {
  1964. __irq_complete_move(cfg, ~get_irq_regs()->orig_ax);
  1965. }
  1966. void irq_force_complete_move(int irq)
  1967. {
  1968. struct irq_cfg *cfg = irq_get_chip_data(irq);
  1969. if (!cfg)
  1970. return;
  1971. __irq_complete_move(cfg, cfg->vector);
  1972. }
  1973. #else
  1974. static inline void irq_complete_move(struct irq_cfg *cfg) { }
  1975. #endif
  1976. static void ack_apic_edge(struct irq_data *data)
  1977. {
  1978. irq_complete_move(data->chip_data);
  1979. irq_move_irq(data);
  1980. ack_APIC_irq();
  1981. }
  1982. atomic_t irq_mis_count;
  1983. /*
  1984. * IO-APIC versions below 0x20 don't support EOI register.
  1985. * For the record, here is the information about various versions:
  1986. * 0Xh 82489DX
  1987. * 1Xh I/OAPIC or I/O(x)APIC which are not PCI 2.2 Compliant
  1988. * 2Xh I/O(x)APIC which is PCI 2.2 Compliant
  1989. * 30h-FFh Reserved
  1990. *
  1991. * Some of the Intel ICH Specs (ICH2 to ICH5) documents the io-apic
  1992. * version as 0x2. This is an error with documentation and these ICH chips
  1993. * use io-apic's of version 0x20.
  1994. *
  1995. * For IO-APIC's with EOI register, we use that to do an explicit EOI.
  1996. * Otherwise, we simulate the EOI message manually by changing the trigger
  1997. * mode to edge and then back to level, with RTE being masked during this.
  1998. */
  1999. static void eoi_ioapic_irq(unsigned int irq, struct irq_cfg *cfg)
  2000. {
  2001. struct irq_pin_list *entry;
  2002. unsigned long flags;
  2003. raw_spin_lock_irqsave(&ioapic_lock, flags);
  2004. for_each_irq_pin(entry, cfg->irq_2_pin) {
  2005. if (mp_ioapics[entry->apic].apicver >= 0x20) {
  2006. /*
  2007. * Intr-remapping uses pin number as the virtual vector
  2008. * in the RTE. Actual vector is programmed in
  2009. * intr-remapping table entry. Hence for the io-apic
  2010. * EOI we use the pin number.
  2011. */
  2012. if (irq_remapped(cfg))
  2013. io_apic_eoi(entry->apic, entry->pin);
  2014. else
  2015. io_apic_eoi(entry->apic, cfg->vector);
  2016. } else {
  2017. __mask_and_edge_IO_APIC_irq(entry);
  2018. __unmask_and_level_IO_APIC_irq(entry);
  2019. }
  2020. }
  2021. raw_spin_unlock_irqrestore(&ioapic_lock, flags);
  2022. }
  2023. static void ack_apic_level(struct irq_data *data)
  2024. {
  2025. struct irq_cfg *cfg = data->chip_data;
  2026. int i, do_unmask_irq = 0, irq = data->irq;
  2027. unsigned long v;
  2028. irq_complete_move(cfg);
  2029. #ifdef CONFIG_GENERIC_PENDING_IRQ
  2030. /* If we are moving the irq we need to mask it */
  2031. if (unlikely(irqd_is_setaffinity_pending(data))) {
  2032. do_unmask_irq = 1;
  2033. mask_ioapic(cfg);
  2034. }
  2035. #endif
  2036. /*
  2037. * It appears there is an erratum which affects at least version 0x11
  2038. * of I/O APIC (that's the 82093AA and cores integrated into various
  2039. * chipsets). Under certain conditions a level-triggered interrupt is
  2040. * erroneously delivered as edge-triggered one but the respective IRR
  2041. * bit gets set nevertheless. As a result the I/O unit expects an EOI
  2042. * message but it will never arrive and further interrupts are blocked
  2043. * from the source. The exact reason is so far unknown, but the
  2044. * phenomenon was observed when two consecutive interrupt requests
  2045. * from a given source get delivered to the same CPU and the source is
  2046. * temporarily disabled in between.
  2047. *
  2048. * A workaround is to simulate an EOI message manually. We achieve it
  2049. * by setting the trigger mode to edge and then to level when the edge
  2050. * trigger mode gets detected in the TMR of a local APIC for a
  2051. * level-triggered interrupt. We mask the source for the time of the
  2052. * operation to prevent an edge-triggered interrupt escaping meanwhile.
  2053. * The idea is from Manfred Spraul. --macro
  2054. *
  2055. * Also in the case when cpu goes offline, fixup_irqs() will forward
  2056. * any unhandled interrupt on the offlined cpu to the new cpu
  2057. * destination that is handling the corresponding interrupt. This
  2058. * interrupt forwarding is done via IPI's. Hence, in this case also
  2059. * level-triggered io-apic interrupt will be seen as an edge
  2060. * interrupt in the IRR. And we can't rely on the cpu's EOI
  2061. * to be broadcasted to the IO-APIC's which will clear the remoteIRR
  2062. * corresponding to the level-triggered interrupt. Hence on IO-APIC's
  2063. * supporting EOI register, we do an explicit EOI to clear the
  2064. * remote IRR and on IO-APIC's which don't have an EOI register,
  2065. * we use the above logic (mask+edge followed by unmask+level) from
  2066. * Manfred Spraul to clear the remote IRR.
  2067. */
  2068. i = cfg->vector;
  2069. v = apic_read(APIC_TMR + ((i & ~0x1f) >> 1));
  2070. /*
  2071. * We must acknowledge the irq before we move it or the acknowledge will
  2072. * not propagate properly.
  2073. */
  2074. ack_APIC_irq();
  2075. /*
  2076. * Tail end of clearing remote IRR bit (either by delivering the EOI
  2077. * message via io-apic EOI register write or simulating it using
  2078. * mask+edge followed by unnask+level logic) manually when the
  2079. * level triggered interrupt is seen as the edge triggered interrupt
  2080. * at the cpu.
  2081. */
  2082. if (!(v & (1 << (i & 0x1f)))) {
  2083. atomic_inc(&irq_mis_count);
  2084. eoi_ioapic_irq(irq, cfg);
  2085. }
  2086. /* Now we can move and renable the irq */
  2087. if (unlikely(do_unmask_irq)) {
  2088. /* Only migrate the irq if the ack has been received.
  2089. *
  2090. * On rare occasions the broadcast level triggered ack gets
  2091. * delayed going to ioapics, and if we reprogram the
  2092. * vector while Remote IRR is still set the irq will never
  2093. * fire again.
  2094. *
  2095. * To prevent this scenario we read the Remote IRR bit
  2096. * of the ioapic. This has two effects.
  2097. * - On any sane system the read of the ioapic will
  2098. * flush writes (and acks) going to the ioapic from
  2099. * this cpu.
  2100. * - We get to see if the ACK has actually been delivered.
  2101. *
  2102. * Based on failed experiments of reprogramming the
  2103. * ioapic entry from outside of irq context starting
  2104. * with masking the ioapic entry and then polling until
  2105. * Remote IRR was clear before reprogramming the
  2106. * ioapic I don't trust the Remote IRR bit to be
  2107. * completey accurate.
  2108. *
  2109. * However there appears to be no other way to plug
  2110. * this race, so if the Remote IRR bit is not
  2111. * accurate and is causing problems then it is a hardware bug
  2112. * and you can go talk to the chipset vendor about it.
  2113. */
  2114. if (!io_apic_level_ack_pending(cfg))
  2115. irq_move_masked_irq(data);
  2116. unmask_ioapic(cfg);
  2117. }
  2118. }
  2119. #ifdef CONFIG_INTR_REMAP
  2120. static void ir_ack_apic_edge(struct irq_data *data)
  2121. {
  2122. ack_APIC_irq();
  2123. }
  2124. static void ir_ack_apic_level(struct irq_data *data)
  2125. {
  2126. ack_APIC_irq();
  2127. eoi_ioapic_irq(data->irq, data->chip_data);
  2128. }
  2129. #endif /* CONFIG_INTR_REMAP */
  2130. static struct irq_chip ioapic_chip __read_mostly = {
  2131. .name = "IO-APIC",
  2132. .irq_startup = startup_ioapic_irq,
  2133. .irq_mask = mask_ioapic_irq,
  2134. .irq_unmask = unmask_ioapic_irq,
  2135. .irq_ack = ack_apic_edge,
  2136. .irq_eoi = ack_apic_level,
  2137. #ifdef CONFIG_SMP
  2138. .irq_set_affinity = ioapic_set_affinity,
  2139. #endif
  2140. .irq_retrigger = ioapic_retrigger_irq,
  2141. };
  2142. static struct irq_chip ir_ioapic_chip __read_mostly = {
  2143. .name = "IR-IO-APIC",
  2144. .irq_startup = startup_ioapic_irq,
  2145. .irq_mask = mask_ioapic_irq,
  2146. .irq_unmask = unmask_ioapic_irq,
  2147. #ifdef CONFIG_INTR_REMAP
  2148. .irq_ack = ir_ack_apic_edge,
  2149. .irq_eoi = ir_ack_apic_level,
  2150. #ifdef CONFIG_SMP
  2151. .irq_set_affinity = ir_ioapic_set_affinity,
  2152. #endif
  2153. #endif
  2154. .irq_retrigger = ioapic_retrigger_irq,
  2155. };
  2156. static inline void init_IO_APIC_traps(void)
  2157. {
  2158. struct irq_cfg *cfg;
  2159. unsigned int irq;
  2160. /*
  2161. * NOTE! The local APIC isn't very good at handling
  2162. * multiple interrupts at the same interrupt level.
  2163. * As the interrupt level is determined by taking the
  2164. * vector number and shifting that right by 4, we
  2165. * want to spread these out a bit so that they don't
  2166. * all fall in the same interrupt level.
  2167. *
  2168. * Also, we've got to be careful not to trash gate
  2169. * 0x80, because int 0x80 is hm, kind of importantish. ;)
  2170. */
  2171. for_each_active_irq(irq) {
  2172. cfg = irq_get_chip_data(irq);
  2173. if (IO_APIC_IRQ(irq) && cfg && !cfg->vector) {
  2174. /*
  2175. * Hmm.. We don't have an entry for this,
  2176. * so default to an old-fashioned 8259
  2177. * interrupt if we can..
  2178. */
  2179. if (irq < legacy_pic->nr_legacy_irqs)
  2180. legacy_pic->make_irq(irq);
  2181. else
  2182. /* Strange. Oh, well.. */
  2183. irq_set_chip(irq, &no_irq_chip);
  2184. }
  2185. }
  2186. }
  2187. /*
  2188. * The local APIC irq-chip implementation:
  2189. */
  2190. static void mask_lapic_irq(struct irq_data *data)
  2191. {
  2192. unsigned long v;
  2193. v = apic_read(APIC_LVT0);
  2194. apic_write(APIC_LVT0, v | APIC_LVT_MASKED);
  2195. }
  2196. static void unmask_lapic_irq(struct irq_data *data)
  2197. {
  2198. unsigned long v;
  2199. v = apic_read(APIC_LVT0);
  2200. apic_write(APIC_LVT0, v & ~APIC_LVT_MASKED);
  2201. }
  2202. static void ack_lapic_irq(struct irq_data *data)
  2203. {
  2204. ack_APIC_irq();
  2205. }
  2206. static struct irq_chip lapic_chip __read_mostly = {
  2207. .name = "local-APIC",
  2208. .irq_mask = mask_lapic_irq,
  2209. .irq_unmask = unmask_lapic_irq,
  2210. .irq_ack = ack_lapic_irq,
  2211. };
  2212. static void lapic_register_intr(int irq)
  2213. {
  2214. irq_clear_status_flags(irq, IRQ_LEVEL);
  2215. irq_set_chip_and_handler_name(irq, &lapic_chip, handle_edge_irq,
  2216. "edge");
  2217. }
  2218. /*
  2219. * This looks a bit hackish but it's about the only one way of sending
  2220. * a few INTA cycles to 8259As and any associated glue logic. ICR does
  2221. * not support the ExtINT mode, unfortunately. We need to send these
  2222. * cycles as some i82489DX-based boards have glue logic that keeps the
  2223. * 8259A interrupt line asserted until INTA. --macro
  2224. */
  2225. static inline void __init unlock_ExtINT_logic(void)
  2226. {
  2227. int apic, pin, i;
  2228. struct IO_APIC_route_entry entry0, entry1;
  2229. unsigned char save_control, save_freq_select;
  2230. pin = find_isa_irq_pin(8, mp_INT);
  2231. if (pin == -1) {
  2232. WARN_ON_ONCE(1);
  2233. return;
  2234. }
  2235. apic = find_isa_irq_apic(8, mp_INT);
  2236. if (apic == -1) {
  2237. WARN_ON_ONCE(1);
  2238. return;
  2239. }
  2240. entry0 = ioapic_read_entry(apic, pin);
  2241. clear_IO_APIC_pin(apic, pin);
  2242. memset(&entry1, 0, sizeof(entry1));
  2243. entry1.dest_mode = 0; /* physical delivery */
  2244. entry1.mask = 0; /* unmask IRQ now */
  2245. entry1.dest = hard_smp_processor_id();
  2246. entry1.delivery_mode = dest_ExtINT;
  2247. entry1.polarity = entry0.polarity;
  2248. entry1.trigger = 0;
  2249. entry1.vector = 0;
  2250. ioapic_write_entry(apic, pin, entry1);
  2251. save_control = CMOS_READ(RTC_CONTROL);
  2252. save_freq_select = CMOS_READ(RTC_FREQ_SELECT);
  2253. CMOS_WRITE((save_freq_select & ~RTC_RATE_SELECT) | 0x6,
  2254. RTC_FREQ_SELECT);
  2255. CMOS_WRITE(save_control | RTC_PIE, RTC_CONTROL);
  2256. i = 100;
  2257. while (i-- > 0) {
  2258. mdelay(10);
  2259. if ((CMOS_READ(RTC_INTR_FLAGS) & RTC_PF) == RTC_PF)
  2260. i -= 10;
  2261. }
  2262. CMOS_WRITE(save_control, RTC_CONTROL);
  2263. CMOS_WRITE(save_freq_select, RTC_FREQ_SELECT);
  2264. clear_IO_APIC_pin(apic, pin);
  2265. ioapic_write_entry(apic, pin, entry0);
  2266. }
  2267. static int disable_timer_pin_1 __initdata;
  2268. /* Actually the next is obsolete, but keep it for paranoid reasons -AK */
  2269. static int __init disable_timer_pin_setup(char *arg)
  2270. {
  2271. disable_timer_pin_1 = 1;
  2272. return 0;
  2273. }
  2274. early_param("disable_timer_pin_1", disable_timer_pin_setup);
  2275. int timer_through_8259 __initdata;
  2276. /*
  2277. * This code may look a bit paranoid, but it's supposed to cooperate with
  2278. * a wide range of boards and BIOS bugs. Fortunately only the timer IRQ
  2279. * is so screwy. Thanks to Brian Perkins for testing/hacking this beast
  2280. * fanatically on his truly buggy board.
  2281. *
  2282. * FIXME: really need to revamp this for all platforms.
  2283. */
  2284. static inline void __init check_timer(void)
  2285. {
  2286. struct irq_cfg *cfg = irq_get_chip_data(0);
  2287. int node = cpu_to_node(0);
  2288. int apic1, pin1, apic2, pin2;
  2289. unsigned long flags;
  2290. int no_pin1 = 0;
  2291. local_irq_save(flags);
  2292. /*
  2293. * get/set the timer IRQ vector:
  2294. */
  2295. legacy_pic->mask(0);
  2296. assign_irq_vector(0, cfg, apic->target_cpus());
  2297. /*
  2298. * As IRQ0 is to be enabled in the 8259A, the virtual
  2299. * wire has to be disabled in the local APIC. Also
  2300. * timer interrupts need to be acknowledged manually in
  2301. * the 8259A for the i82489DX when using the NMI
  2302. * watchdog as that APIC treats NMIs as level-triggered.
  2303. * The AEOI mode will finish them in the 8259A
  2304. * automatically.
  2305. */
  2306. apic_write(APIC_LVT0, APIC_LVT_MASKED | APIC_DM_EXTINT);
  2307. legacy_pic->init(1);
  2308. pin1 = find_isa_irq_pin(0, mp_INT);
  2309. apic1 = find_isa_irq_apic(0, mp_INT);
  2310. pin2 = ioapic_i8259.pin;
  2311. apic2 = ioapic_i8259.apic;
  2312. apic_printk(APIC_QUIET, KERN_INFO "..TIMER: vector=0x%02X "
  2313. "apic1=%d pin1=%d apic2=%d pin2=%d\n",
  2314. cfg->vector, apic1, pin1, apic2, pin2);
  2315. /*
  2316. * Some BIOS writers are clueless and report the ExtINTA
  2317. * I/O APIC input from the cascaded 8259A as the timer
  2318. * interrupt input. So just in case, if only one pin
  2319. * was found above, try it both directly and through the
  2320. * 8259A.
  2321. */
  2322. if (pin1 == -1) {
  2323. if (intr_remapping_enabled)
  2324. panic("BIOS bug: timer not connected to IO-APIC");
  2325. pin1 = pin2;
  2326. apic1 = apic2;
  2327. no_pin1 = 1;
  2328. } else if (pin2 == -1) {
  2329. pin2 = pin1;
  2330. apic2 = apic1;
  2331. }
  2332. if (pin1 != -1) {
  2333. /*
  2334. * Ok, does IRQ0 through the IOAPIC work?
  2335. */
  2336. if (no_pin1) {
  2337. add_pin_to_irq_node(cfg, node, apic1, pin1);
  2338. setup_timer_IRQ0_pin(apic1, pin1, cfg->vector);
  2339. } else {
  2340. /* for edge trigger, setup_ioapic_irq already
  2341. * leave it unmasked.
  2342. * so only need to unmask if it is level-trigger
  2343. * do we really have level trigger timer?
  2344. */
  2345. int idx;
  2346. idx = find_irq_entry(apic1, pin1, mp_INT);
  2347. if (idx != -1 && irq_trigger(idx))
  2348. unmask_ioapic(cfg);
  2349. }
  2350. if (timer_irq_works()) {
  2351. if (disable_timer_pin_1 > 0)
  2352. clear_IO_APIC_pin(0, pin1);
  2353. goto out;
  2354. }
  2355. if (intr_remapping_enabled)
  2356. panic("timer doesn't work through Interrupt-remapped IO-APIC");
  2357. local_irq_disable();
  2358. clear_IO_APIC_pin(apic1, pin1);
  2359. if (!no_pin1)
  2360. apic_printk(APIC_QUIET, KERN_ERR "..MP-BIOS bug: "
  2361. "8254 timer not connected to IO-APIC\n");
  2362. apic_printk(APIC_QUIET, KERN_INFO "...trying to set up timer "
  2363. "(IRQ0) through the 8259A ...\n");
  2364. apic_printk(APIC_QUIET, KERN_INFO
  2365. "..... (found apic %d pin %d) ...\n", apic2, pin2);
  2366. /*
  2367. * legacy devices should be connected to IO APIC #0
  2368. */
  2369. replace_pin_at_irq_node(cfg, node, apic1, pin1, apic2, pin2);
  2370. setup_timer_IRQ0_pin(apic2, pin2, cfg->vector);
  2371. legacy_pic->unmask(0);
  2372. if (timer_irq_works()) {
  2373. apic_printk(APIC_QUIET, KERN_INFO "....... works.\n");
  2374. timer_through_8259 = 1;
  2375. goto out;
  2376. }
  2377. /*
  2378. * Cleanup, just in case ...
  2379. */
  2380. local_irq_disable();
  2381. legacy_pic->mask(0);
  2382. clear_IO_APIC_pin(apic2, pin2);
  2383. apic_printk(APIC_QUIET, KERN_INFO "....... failed.\n");
  2384. }
  2385. apic_printk(APIC_QUIET, KERN_INFO
  2386. "...trying to set up timer as Virtual Wire IRQ...\n");
  2387. lapic_register_intr(0);
  2388. apic_write(APIC_LVT0, APIC_DM_FIXED | cfg->vector); /* Fixed mode */
  2389. legacy_pic->unmask(0);
  2390. if (timer_irq_works()) {
  2391. apic_printk(APIC_QUIET, KERN_INFO "..... works.\n");
  2392. goto out;
  2393. }
  2394. local_irq_disable();
  2395. legacy_pic->mask(0);
  2396. apic_write(APIC_LVT0, APIC_LVT_MASKED | APIC_DM_FIXED | cfg->vector);
  2397. apic_printk(APIC_QUIET, KERN_INFO "..... failed.\n");
  2398. apic_printk(APIC_QUIET, KERN_INFO
  2399. "...trying to set up timer as ExtINT IRQ...\n");
  2400. legacy_pic->init(0);
  2401. legacy_pic->make_irq(0);
  2402. apic_write(APIC_LVT0, APIC_DM_EXTINT);
  2403. unlock_ExtINT_logic();
  2404. if (timer_irq_works()) {
  2405. apic_printk(APIC_QUIET, KERN_INFO "..... works.\n");
  2406. goto out;
  2407. }
  2408. local_irq_disable();
  2409. apic_printk(APIC_QUIET, KERN_INFO "..... failed :(.\n");
  2410. panic("IO-APIC + timer doesn't work! Boot with apic=debug and send a "
  2411. "report. Then try booting with the 'noapic' option.\n");
  2412. out:
  2413. local_irq_restore(flags);
  2414. }
  2415. /*
  2416. * Traditionally ISA IRQ2 is the cascade IRQ, and is not available
  2417. * to devices. However there may be an I/O APIC pin available for
  2418. * this interrupt regardless. The pin may be left unconnected, but
  2419. * typically it will be reused as an ExtINT cascade interrupt for
  2420. * the master 8259A. In the MPS case such a pin will normally be
  2421. * reported as an ExtINT interrupt in the MP table. With ACPI
  2422. * there is no provision for ExtINT interrupts, and in the absence
  2423. * of an override it would be treated as an ordinary ISA I/O APIC
  2424. * interrupt, that is edge-triggered and unmasked by default. We
  2425. * used to do this, but it caused problems on some systems because
  2426. * of the NMI watchdog and sometimes IRQ0 of the 8254 timer using
  2427. * the same ExtINT cascade interrupt to drive the local APIC of the
  2428. * bootstrap processor. Therefore we refrain from routing IRQ2 to
  2429. * the I/O APIC in all cases now. No actual device should request
  2430. * it anyway. --macro
  2431. */
  2432. #define PIC_IRQS (1UL << PIC_CASCADE_IR)
  2433. void __init setup_IO_APIC(void)
  2434. {
  2435. /*
  2436. * calling enable_IO_APIC() is moved to setup_local_APIC for BP
  2437. */
  2438. io_apic_irqs = legacy_pic->nr_legacy_irqs ? ~PIC_IRQS : ~0UL;
  2439. apic_printk(APIC_VERBOSE, "ENABLING IO-APIC IRQs\n");
  2440. /*
  2441. * Set up IO-APIC IRQ routing.
  2442. */
  2443. x86_init.mpparse.setup_ioapic_ids();
  2444. sync_Arb_IDs();
  2445. setup_IO_APIC_irqs();
  2446. init_IO_APIC_traps();
  2447. if (legacy_pic->nr_legacy_irqs)
  2448. check_timer();
  2449. }
  2450. /*
  2451. * Called after all the initialization is done. If we didn't find any
  2452. * APIC bugs then we can allow the modify fast path
  2453. */
  2454. static int __init io_apic_bug_finalize(void)
  2455. {
  2456. if (sis_apic_bug == -1)
  2457. sis_apic_bug = 0;
  2458. return 0;
  2459. }
  2460. late_initcall(io_apic_bug_finalize);
  2461. static void suspend_ioapic(int ioapic_id)
  2462. {
  2463. struct IO_APIC_route_entry *saved_data = ioapic_saved_data[ioapic_id];
  2464. int i;
  2465. if (!saved_data)
  2466. return;
  2467. for (i = 0; i < nr_ioapic_registers[ioapic_id]; i++)
  2468. saved_data[i] = ioapic_read_entry(ioapic_id, i);
  2469. }
  2470. static int ioapic_suspend(void)
  2471. {
  2472. int ioapic_id;
  2473. for (ioapic_id = 0; ioapic_id < nr_ioapics; ioapic_id++)
  2474. suspend_ioapic(ioapic_id);
  2475. return 0;
  2476. }
  2477. static void resume_ioapic(int ioapic_id)
  2478. {
  2479. struct IO_APIC_route_entry *saved_data = ioapic_saved_data[ioapic_id];
  2480. unsigned long flags;
  2481. union IO_APIC_reg_00 reg_00;
  2482. int i;
  2483. if (!saved_data)
  2484. return;
  2485. raw_spin_lock_irqsave(&ioapic_lock, flags);
  2486. reg_00.raw = io_apic_read(ioapic_id, 0);
  2487. if (reg_00.bits.ID != mp_ioapics[ioapic_id].apicid) {
  2488. reg_00.bits.ID = mp_ioapics[ioapic_id].apicid;
  2489. io_apic_write(ioapic_id, 0, reg_00.raw);
  2490. }
  2491. raw_spin_unlock_irqrestore(&ioapic_lock, flags);
  2492. for (i = 0; i < nr_ioapic_registers[ioapic_id]; i++)
  2493. ioapic_write_entry(ioapic_id, i, saved_data[i]);
  2494. }
  2495. static void ioapic_resume(void)
  2496. {
  2497. int ioapic_id;
  2498. for (ioapic_id = nr_ioapics - 1; ioapic_id >= 0; ioapic_id--)
  2499. resume_ioapic(ioapic_id);
  2500. }
  2501. static struct syscore_ops ioapic_syscore_ops = {
  2502. .suspend = ioapic_suspend,
  2503. .resume = ioapic_resume,
  2504. };
  2505. static int __init ioapic_init_ops(void)
  2506. {
  2507. register_syscore_ops(&ioapic_syscore_ops);
  2508. return 0;
  2509. }
  2510. device_initcall(ioapic_init_ops);
  2511. /*
  2512. * Dynamic irq allocate and deallocation
  2513. */
  2514. unsigned int create_irq_nr(unsigned int from, int node)
  2515. {
  2516. struct irq_cfg *cfg;
  2517. unsigned long flags;
  2518. unsigned int ret = 0;
  2519. int irq;
  2520. if (from < nr_irqs_gsi)
  2521. from = nr_irqs_gsi;
  2522. irq = alloc_irq_from(from, node);
  2523. if (irq < 0)
  2524. return 0;
  2525. cfg = alloc_irq_cfg(irq, node);
  2526. if (!cfg) {
  2527. free_irq_at(irq, NULL);
  2528. return 0;
  2529. }
  2530. raw_spin_lock_irqsave(&vector_lock, flags);
  2531. if (!__assign_irq_vector(irq, cfg, apic->target_cpus()))
  2532. ret = irq;
  2533. raw_spin_unlock_irqrestore(&vector_lock, flags);
  2534. if (ret) {
  2535. irq_set_chip_data(irq, cfg);
  2536. irq_clear_status_flags(irq, IRQ_NOREQUEST);
  2537. } else {
  2538. free_irq_at(irq, cfg);
  2539. }
  2540. return ret;
  2541. }
  2542. int create_irq(void)
  2543. {
  2544. int node = cpu_to_node(0);
  2545. unsigned int irq_want;
  2546. int irq;
  2547. irq_want = nr_irqs_gsi;
  2548. irq = create_irq_nr(irq_want, node);
  2549. if (irq == 0)
  2550. irq = -1;
  2551. return irq;
  2552. }
  2553. void destroy_irq(unsigned int irq)
  2554. {
  2555. struct irq_cfg *cfg = irq_get_chip_data(irq);
  2556. unsigned long flags;
  2557. irq_set_status_flags(irq, IRQ_NOREQUEST|IRQ_NOPROBE);
  2558. if (irq_remapped(cfg))
  2559. free_irte(irq);
  2560. raw_spin_lock_irqsave(&vector_lock, flags);
  2561. __clear_irq_vector(irq, cfg);
  2562. raw_spin_unlock_irqrestore(&vector_lock, flags);
  2563. free_irq_at(irq, cfg);
  2564. }
  2565. /*
  2566. * MSI message composition
  2567. */
  2568. #ifdef CONFIG_PCI_MSI
  2569. static int msi_compose_msg(struct pci_dev *pdev, unsigned int irq,
  2570. struct msi_msg *msg, u8 hpet_id)
  2571. {
  2572. struct irq_cfg *cfg;
  2573. int err;
  2574. unsigned dest;
  2575. if (disable_apic)
  2576. return -ENXIO;
  2577. cfg = irq_cfg(irq);
  2578. err = assign_irq_vector(irq, cfg, apic->target_cpus());
  2579. if (err)
  2580. return err;
  2581. dest = apic->cpu_mask_to_apicid_and(cfg->domain, apic->target_cpus());
  2582. if (irq_remapped(cfg)) {
  2583. struct irte irte;
  2584. int ir_index;
  2585. u16 sub_handle;
  2586. ir_index = map_irq_to_irte_handle(irq, &sub_handle);
  2587. BUG_ON(ir_index == -1);
  2588. prepare_irte(&irte, cfg->vector, dest);
  2589. /* Set source-id of interrupt request */
  2590. if (pdev)
  2591. set_msi_sid(&irte, pdev);
  2592. else
  2593. set_hpet_sid(&irte, hpet_id);
  2594. modify_irte(irq, &irte);
  2595. msg->address_hi = MSI_ADDR_BASE_HI;
  2596. msg->data = sub_handle;
  2597. msg->address_lo = MSI_ADDR_BASE_LO | MSI_ADDR_IR_EXT_INT |
  2598. MSI_ADDR_IR_SHV |
  2599. MSI_ADDR_IR_INDEX1(ir_index) |
  2600. MSI_ADDR_IR_INDEX2(ir_index);
  2601. } else {
  2602. if (x2apic_enabled())
  2603. msg->address_hi = MSI_ADDR_BASE_HI |
  2604. MSI_ADDR_EXT_DEST_ID(dest);
  2605. else
  2606. msg->address_hi = MSI_ADDR_BASE_HI;
  2607. msg->address_lo =
  2608. MSI_ADDR_BASE_LO |
  2609. ((apic->irq_dest_mode == 0) ?
  2610. MSI_ADDR_DEST_MODE_PHYSICAL:
  2611. MSI_ADDR_DEST_MODE_LOGICAL) |
  2612. ((apic->irq_delivery_mode != dest_LowestPrio) ?
  2613. MSI_ADDR_REDIRECTION_CPU:
  2614. MSI_ADDR_REDIRECTION_LOWPRI) |
  2615. MSI_ADDR_DEST_ID(dest);
  2616. msg->data =
  2617. MSI_DATA_TRIGGER_EDGE |
  2618. MSI_DATA_LEVEL_ASSERT |
  2619. ((apic->irq_delivery_mode != dest_LowestPrio) ?
  2620. MSI_DATA_DELIVERY_FIXED:
  2621. MSI_DATA_DELIVERY_LOWPRI) |
  2622. MSI_DATA_VECTOR(cfg->vector);
  2623. }
  2624. return err;
  2625. }
  2626. #ifdef CONFIG_SMP
  2627. static int
  2628. msi_set_affinity(struct irq_data *data, const struct cpumask *mask, bool force)
  2629. {
  2630. struct irq_cfg *cfg = data->chip_data;
  2631. struct msi_msg msg;
  2632. unsigned int dest;
  2633. if (__ioapic_set_affinity(data, mask, &dest))
  2634. return -1;
  2635. __get_cached_msi_msg(data->msi_desc, &msg);
  2636. msg.data &= ~MSI_DATA_VECTOR_MASK;
  2637. msg.data |= MSI_DATA_VECTOR(cfg->vector);
  2638. msg.address_lo &= ~MSI_ADDR_DEST_ID_MASK;
  2639. msg.address_lo |= MSI_ADDR_DEST_ID(dest);
  2640. __write_msi_msg(data->msi_desc, &msg);
  2641. return 0;
  2642. }
  2643. #ifdef CONFIG_INTR_REMAP
  2644. /*
  2645. * Migrate the MSI irq to another cpumask. This migration is
  2646. * done in the process context using interrupt-remapping hardware.
  2647. */
  2648. static int
  2649. ir_msi_set_affinity(struct irq_data *data, const struct cpumask *mask,
  2650. bool force)
  2651. {
  2652. struct irq_cfg *cfg = data->chip_data;
  2653. unsigned int dest, irq = data->irq;
  2654. struct irte irte;
  2655. if (get_irte(irq, &irte))
  2656. return -1;
  2657. if (__ioapic_set_affinity(data, mask, &dest))
  2658. return -1;
  2659. irte.vector = cfg->vector;
  2660. irte.dest_id = IRTE_DEST(dest);
  2661. /*
  2662. * atomically update the IRTE with the new destination and vector.
  2663. */
  2664. modify_irte(irq, &irte);
  2665. /*
  2666. * After this point, all the interrupts will start arriving
  2667. * at the new destination. So, time to cleanup the previous
  2668. * vector allocation.
  2669. */
  2670. if (cfg->move_in_progress)
  2671. send_cleanup_vector(cfg);
  2672. return 0;
  2673. }
  2674. #endif
  2675. #endif /* CONFIG_SMP */
  2676. /*
  2677. * IRQ Chip for MSI PCI/PCI-X/PCI-Express Devices,
  2678. * which implement the MSI or MSI-X Capability Structure.
  2679. */
  2680. static struct irq_chip msi_chip = {
  2681. .name = "PCI-MSI",
  2682. .irq_unmask = unmask_msi_irq,
  2683. .irq_mask = mask_msi_irq,
  2684. .irq_ack = ack_apic_edge,
  2685. #ifdef CONFIG_SMP
  2686. .irq_set_affinity = msi_set_affinity,
  2687. #endif
  2688. .irq_retrigger = ioapic_retrigger_irq,
  2689. };
  2690. static struct irq_chip msi_ir_chip = {
  2691. .name = "IR-PCI-MSI",
  2692. .irq_unmask = unmask_msi_irq,
  2693. .irq_mask = mask_msi_irq,
  2694. #ifdef CONFIG_INTR_REMAP
  2695. .irq_ack = ir_ack_apic_edge,
  2696. #ifdef CONFIG_SMP
  2697. .irq_set_affinity = ir_msi_set_affinity,
  2698. #endif
  2699. #endif
  2700. .irq_retrigger = ioapic_retrigger_irq,
  2701. };
  2702. /*
  2703. * Map the PCI dev to the corresponding remapping hardware unit
  2704. * and allocate 'nvec' consecutive interrupt-remapping table entries
  2705. * in it.
  2706. */
  2707. static int msi_alloc_irte(struct pci_dev *dev, int irq, int nvec)
  2708. {
  2709. struct intel_iommu *iommu;
  2710. int index;
  2711. iommu = map_dev_to_ir(dev);
  2712. if (!iommu) {
  2713. printk(KERN_ERR
  2714. "Unable to map PCI %s to iommu\n", pci_name(dev));
  2715. return -ENOENT;
  2716. }
  2717. index = alloc_irte(iommu, irq, nvec);
  2718. if (index < 0) {
  2719. printk(KERN_ERR
  2720. "Unable to allocate %d IRTE for PCI %s\n", nvec,
  2721. pci_name(dev));
  2722. return -ENOSPC;
  2723. }
  2724. return index;
  2725. }
  2726. static int setup_msi_irq(struct pci_dev *dev, struct msi_desc *msidesc, int irq)
  2727. {
  2728. struct irq_chip *chip = &msi_chip;
  2729. struct msi_msg msg;
  2730. int ret;
  2731. ret = msi_compose_msg(dev, irq, &msg, -1);
  2732. if (ret < 0)
  2733. return ret;
  2734. irq_set_msi_desc(irq, msidesc);
  2735. write_msi_msg(irq, &msg);
  2736. if (irq_remapped(irq_get_chip_data(irq))) {
  2737. irq_set_status_flags(irq, IRQ_MOVE_PCNTXT);
  2738. chip = &msi_ir_chip;
  2739. }
  2740. irq_set_chip_and_handler_name(irq, chip, handle_edge_irq, "edge");
  2741. dev_printk(KERN_DEBUG, &dev->dev, "irq %d for MSI/MSI-X\n", irq);
  2742. return 0;
  2743. }
  2744. int native_setup_msi_irqs(struct pci_dev *dev, int nvec, int type)
  2745. {
  2746. int node, ret, sub_handle, index = 0;
  2747. unsigned int irq, irq_want;
  2748. struct msi_desc *msidesc;
  2749. struct intel_iommu *iommu = NULL;
  2750. /* x86 doesn't support multiple MSI yet */
  2751. if (type == PCI_CAP_ID_MSI && nvec > 1)
  2752. return 1;
  2753. node = dev_to_node(&dev->dev);
  2754. irq_want = nr_irqs_gsi;
  2755. sub_handle = 0;
  2756. list_for_each_entry(msidesc, &dev->msi_list, list) {
  2757. irq = create_irq_nr(irq_want, node);
  2758. if (irq == 0)
  2759. return -1;
  2760. irq_want = irq + 1;
  2761. if (!intr_remapping_enabled)
  2762. goto no_ir;
  2763. if (!sub_handle) {
  2764. /*
  2765. * allocate the consecutive block of IRTE's
  2766. * for 'nvec'
  2767. */
  2768. index = msi_alloc_irte(dev, irq, nvec);
  2769. if (index < 0) {
  2770. ret = index;
  2771. goto error;
  2772. }
  2773. } else {
  2774. iommu = map_dev_to_ir(dev);
  2775. if (!iommu) {
  2776. ret = -ENOENT;
  2777. goto error;
  2778. }
  2779. /*
  2780. * setup the mapping between the irq and the IRTE
  2781. * base index, the sub_handle pointing to the
  2782. * appropriate interrupt remap table entry.
  2783. */
  2784. set_irte_irq(irq, iommu, index, sub_handle);
  2785. }
  2786. no_ir:
  2787. ret = setup_msi_irq(dev, msidesc, irq);
  2788. if (ret < 0)
  2789. goto error;
  2790. sub_handle++;
  2791. }
  2792. return 0;
  2793. error:
  2794. destroy_irq(irq);
  2795. return ret;
  2796. }
  2797. void native_teardown_msi_irq(unsigned int irq)
  2798. {
  2799. destroy_irq(irq);
  2800. }
  2801. #if defined (CONFIG_DMAR) || defined (CONFIG_INTR_REMAP)
  2802. #ifdef CONFIG_SMP
  2803. static int
  2804. dmar_msi_set_affinity(struct irq_data *data, const struct cpumask *mask,
  2805. bool force)
  2806. {
  2807. struct irq_cfg *cfg = data->chip_data;
  2808. unsigned int dest, irq = data->irq;
  2809. struct msi_msg msg;
  2810. if (__ioapic_set_affinity(data, mask, &dest))
  2811. return -1;
  2812. dmar_msi_read(irq, &msg);
  2813. msg.data &= ~MSI_DATA_VECTOR_MASK;
  2814. msg.data |= MSI_DATA_VECTOR(cfg->vector);
  2815. msg.address_lo &= ~MSI_ADDR_DEST_ID_MASK;
  2816. msg.address_lo |= MSI_ADDR_DEST_ID(dest);
  2817. msg.address_hi = MSI_ADDR_BASE_HI | MSI_ADDR_EXT_DEST_ID(dest);
  2818. dmar_msi_write(irq, &msg);
  2819. return 0;
  2820. }
  2821. #endif /* CONFIG_SMP */
  2822. static struct irq_chip dmar_msi_type = {
  2823. .name = "DMAR_MSI",
  2824. .irq_unmask = dmar_msi_unmask,
  2825. .irq_mask = dmar_msi_mask,
  2826. .irq_ack = ack_apic_edge,
  2827. #ifdef CONFIG_SMP
  2828. .irq_set_affinity = dmar_msi_set_affinity,
  2829. #endif
  2830. .irq_retrigger = ioapic_retrigger_irq,
  2831. };
  2832. int arch_setup_dmar_msi(unsigned int irq)
  2833. {
  2834. int ret;
  2835. struct msi_msg msg;
  2836. ret = msi_compose_msg(NULL, irq, &msg, -1);
  2837. if (ret < 0)
  2838. return ret;
  2839. dmar_msi_write(irq, &msg);
  2840. irq_set_chip_and_handler_name(irq, &dmar_msi_type, handle_edge_irq,
  2841. "edge");
  2842. return 0;
  2843. }
  2844. #endif
  2845. #ifdef CONFIG_HPET_TIMER
  2846. #ifdef CONFIG_SMP
  2847. static int hpet_msi_set_affinity(struct irq_data *data,
  2848. const struct cpumask *mask, bool force)
  2849. {
  2850. struct irq_cfg *cfg = data->chip_data;
  2851. struct msi_msg msg;
  2852. unsigned int dest;
  2853. if (__ioapic_set_affinity(data, mask, &dest))
  2854. return -1;
  2855. hpet_msi_read(data->handler_data, &msg);
  2856. msg.data &= ~MSI_DATA_VECTOR_MASK;
  2857. msg.data |= MSI_DATA_VECTOR(cfg->vector);
  2858. msg.address_lo &= ~MSI_ADDR_DEST_ID_MASK;
  2859. msg.address_lo |= MSI_ADDR_DEST_ID(dest);
  2860. hpet_msi_write(data->handler_data, &msg);
  2861. return 0;
  2862. }
  2863. #endif /* CONFIG_SMP */
  2864. static struct irq_chip ir_hpet_msi_type = {
  2865. .name = "IR-HPET_MSI",
  2866. .irq_unmask = hpet_msi_unmask,
  2867. .irq_mask = hpet_msi_mask,
  2868. #ifdef CONFIG_INTR_REMAP
  2869. .irq_ack = ir_ack_apic_edge,
  2870. #ifdef CONFIG_SMP
  2871. .irq_set_affinity = ir_msi_set_affinity,
  2872. #endif
  2873. #endif
  2874. .irq_retrigger = ioapic_retrigger_irq,
  2875. };
  2876. static struct irq_chip hpet_msi_type = {
  2877. .name = "HPET_MSI",
  2878. .irq_unmask = hpet_msi_unmask,
  2879. .irq_mask = hpet_msi_mask,
  2880. .irq_ack = ack_apic_edge,
  2881. #ifdef CONFIG_SMP
  2882. .irq_set_affinity = hpet_msi_set_affinity,
  2883. #endif
  2884. .irq_retrigger = ioapic_retrigger_irq,
  2885. };
  2886. int arch_setup_hpet_msi(unsigned int irq, unsigned int id)
  2887. {
  2888. struct irq_chip *chip = &hpet_msi_type;
  2889. struct msi_msg msg;
  2890. int ret;
  2891. if (intr_remapping_enabled) {
  2892. struct intel_iommu *iommu = map_hpet_to_ir(id);
  2893. int index;
  2894. if (!iommu)
  2895. return -1;
  2896. index = alloc_irte(iommu, irq, 1);
  2897. if (index < 0)
  2898. return -1;
  2899. }
  2900. ret = msi_compose_msg(NULL, irq, &msg, id);
  2901. if (ret < 0)
  2902. return ret;
  2903. hpet_msi_write(irq_get_handler_data(irq), &msg);
  2904. irq_set_status_flags(irq, IRQ_MOVE_PCNTXT);
  2905. if (irq_remapped(irq_get_chip_data(irq)))
  2906. chip = &ir_hpet_msi_type;
  2907. irq_set_chip_and_handler_name(irq, chip, handle_edge_irq, "edge");
  2908. return 0;
  2909. }
  2910. #endif
  2911. #endif /* CONFIG_PCI_MSI */
  2912. /*
  2913. * Hypertransport interrupt support
  2914. */
  2915. #ifdef CONFIG_HT_IRQ
  2916. #ifdef CONFIG_SMP
  2917. static void target_ht_irq(unsigned int irq, unsigned int dest, u8 vector)
  2918. {
  2919. struct ht_irq_msg msg;
  2920. fetch_ht_irq_msg(irq, &msg);
  2921. msg.address_lo &= ~(HT_IRQ_LOW_VECTOR_MASK | HT_IRQ_LOW_DEST_ID_MASK);
  2922. msg.address_hi &= ~(HT_IRQ_HIGH_DEST_ID_MASK);
  2923. msg.address_lo |= HT_IRQ_LOW_VECTOR(vector) | HT_IRQ_LOW_DEST_ID(dest);
  2924. msg.address_hi |= HT_IRQ_HIGH_DEST_ID(dest);
  2925. write_ht_irq_msg(irq, &msg);
  2926. }
  2927. static int
  2928. ht_set_affinity(struct irq_data *data, const struct cpumask *mask, bool force)
  2929. {
  2930. struct irq_cfg *cfg = data->chip_data;
  2931. unsigned int dest;
  2932. if (__ioapic_set_affinity(data, mask, &dest))
  2933. return -1;
  2934. target_ht_irq(data->irq, dest, cfg->vector);
  2935. return 0;
  2936. }
  2937. #endif
  2938. static struct irq_chip ht_irq_chip = {
  2939. .name = "PCI-HT",
  2940. .irq_mask = mask_ht_irq,
  2941. .irq_unmask = unmask_ht_irq,
  2942. .irq_ack = ack_apic_edge,
  2943. #ifdef CONFIG_SMP
  2944. .irq_set_affinity = ht_set_affinity,
  2945. #endif
  2946. .irq_retrigger = ioapic_retrigger_irq,
  2947. };
  2948. int arch_setup_ht_irq(unsigned int irq, struct pci_dev *dev)
  2949. {
  2950. struct irq_cfg *cfg;
  2951. int err;
  2952. if (disable_apic)
  2953. return -ENXIO;
  2954. cfg = irq_cfg(irq);
  2955. err = assign_irq_vector(irq, cfg, apic->target_cpus());
  2956. if (!err) {
  2957. struct ht_irq_msg msg;
  2958. unsigned dest;
  2959. dest = apic->cpu_mask_to_apicid_and(cfg->domain,
  2960. apic->target_cpus());
  2961. msg.address_hi = HT_IRQ_HIGH_DEST_ID(dest);
  2962. msg.address_lo =
  2963. HT_IRQ_LOW_BASE |
  2964. HT_IRQ_LOW_DEST_ID(dest) |
  2965. HT_IRQ_LOW_VECTOR(cfg->vector) |
  2966. ((apic->irq_dest_mode == 0) ?
  2967. HT_IRQ_LOW_DM_PHYSICAL :
  2968. HT_IRQ_LOW_DM_LOGICAL) |
  2969. HT_IRQ_LOW_RQEOI_EDGE |
  2970. ((apic->irq_delivery_mode != dest_LowestPrio) ?
  2971. HT_IRQ_LOW_MT_FIXED :
  2972. HT_IRQ_LOW_MT_ARBITRATED) |
  2973. HT_IRQ_LOW_IRQ_MASKED;
  2974. write_ht_irq_msg(irq, &msg);
  2975. irq_set_chip_and_handler_name(irq, &ht_irq_chip,
  2976. handle_edge_irq, "edge");
  2977. dev_printk(KERN_DEBUG, &dev->dev, "irq %d for HT\n", irq);
  2978. }
  2979. return err;
  2980. }
  2981. #endif /* CONFIG_HT_IRQ */
  2982. static int
  2983. io_apic_setup_irq_pin(unsigned int irq, int node, struct io_apic_irq_attr *attr)
  2984. {
  2985. struct irq_cfg *cfg = alloc_irq_and_cfg_at(irq, node);
  2986. int ret;
  2987. if (!cfg)
  2988. return -EINVAL;
  2989. ret = __add_pin_to_irq_node(cfg, node, attr->ioapic, attr->ioapic_pin);
  2990. if (!ret)
  2991. setup_ioapic_irq(attr->ioapic, attr->ioapic_pin, irq, cfg,
  2992. attr->trigger, attr->polarity);
  2993. return ret;
  2994. }
  2995. int io_apic_setup_irq_pin_once(unsigned int irq, int node,
  2996. struct io_apic_irq_attr *attr)
  2997. {
  2998. unsigned int id = attr->ioapic, pin = attr->ioapic_pin;
  2999. int ret;
  3000. /* Avoid redundant programming */
  3001. if (test_bit(pin, mp_ioapic_routing[id].pin_programmed)) {
  3002. pr_debug("Pin %d-%d already programmed\n",
  3003. mp_ioapics[id].apicid, pin);
  3004. return 0;
  3005. }
  3006. ret = io_apic_setup_irq_pin(irq, node, attr);
  3007. if (!ret)
  3008. set_bit(pin, mp_ioapic_routing[id].pin_programmed);
  3009. return ret;
  3010. }
  3011. static int __init io_apic_get_redir_entries(int ioapic)
  3012. {
  3013. union IO_APIC_reg_01 reg_01;
  3014. unsigned long flags;
  3015. raw_spin_lock_irqsave(&ioapic_lock, flags);
  3016. reg_01.raw = io_apic_read(ioapic, 1);
  3017. raw_spin_unlock_irqrestore(&ioapic_lock, flags);
  3018. /* The register returns the maximum index redir index
  3019. * supported, which is one less than the total number of redir
  3020. * entries.
  3021. */
  3022. return reg_01.bits.entries + 1;
  3023. }
  3024. static void __init probe_nr_irqs_gsi(void)
  3025. {
  3026. int nr;
  3027. nr = gsi_top + NR_IRQS_LEGACY;
  3028. if (nr > nr_irqs_gsi)
  3029. nr_irqs_gsi = nr;
  3030. printk(KERN_DEBUG "nr_irqs_gsi: %d\n", nr_irqs_gsi);
  3031. }
  3032. int get_nr_irqs_gsi(void)
  3033. {
  3034. return nr_irqs_gsi;
  3035. }
  3036. #ifdef CONFIG_SPARSE_IRQ
  3037. int __init arch_probe_nr_irqs(void)
  3038. {
  3039. int nr;
  3040. if (nr_irqs > (NR_VECTORS * nr_cpu_ids))
  3041. nr_irqs = NR_VECTORS * nr_cpu_ids;
  3042. nr = nr_irqs_gsi + 8 * nr_cpu_ids;
  3043. #if defined(CONFIG_PCI_MSI) || defined(CONFIG_HT_IRQ)
  3044. /*
  3045. * for MSI and HT dyn irq
  3046. */
  3047. nr += nr_irqs_gsi * 16;
  3048. #endif
  3049. if (nr < nr_irqs)
  3050. nr_irqs = nr;
  3051. return NR_IRQS_LEGACY;
  3052. }
  3053. #endif
  3054. int io_apic_set_pci_routing(struct device *dev, int irq,
  3055. struct io_apic_irq_attr *irq_attr)
  3056. {
  3057. int node;
  3058. if (!IO_APIC_IRQ(irq)) {
  3059. apic_printk(APIC_QUIET,KERN_ERR "IOAPIC[%d]: Invalid reference to IRQ 0\n",
  3060. irq_attr->ioapic);
  3061. return -EINVAL;
  3062. }
  3063. node = dev ? dev_to_node(dev) : cpu_to_node(0);
  3064. return io_apic_setup_irq_pin_once(irq, node, irq_attr);
  3065. }
  3066. #ifdef CONFIG_X86_32
  3067. static int __init io_apic_get_unique_id(int ioapic, int apic_id)
  3068. {
  3069. union IO_APIC_reg_00 reg_00;
  3070. static physid_mask_t apic_id_map = PHYSID_MASK_NONE;
  3071. physid_mask_t tmp;
  3072. unsigned long flags;
  3073. int i = 0;
  3074. /*
  3075. * The P4 platform supports up to 256 APIC IDs on two separate APIC
  3076. * buses (one for LAPICs, one for IOAPICs), where predecessors only
  3077. * supports up to 16 on one shared APIC bus.
  3078. *
  3079. * TBD: Expand LAPIC/IOAPIC support on P4-class systems to take full
  3080. * advantage of new APIC bus architecture.
  3081. */
  3082. if (physids_empty(apic_id_map))
  3083. apic->ioapic_phys_id_map(&phys_cpu_present_map, &apic_id_map);
  3084. raw_spin_lock_irqsave(&ioapic_lock, flags);
  3085. reg_00.raw = io_apic_read(ioapic, 0);
  3086. raw_spin_unlock_irqrestore(&ioapic_lock, flags);
  3087. if (apic_id >= get_physical_broadcast()) {
  3088. printk(KERN_WARNING "IOAPIC[%d]: Invalid apic_id %d, trying "
  3089. "%d\n", ioapic, apic_id, reg_00.bits.ID);
  3090. apic_id = reg_00.bits.ID;
  3091. }
  3092. /*
  3093. * Every APIC in a system must have a unique ID or we get lots of nice
  3094. * 'stuck on smp_invalidate_needed IPI wait' messages.
  3095. */
  3096. if (apic->check_apicid_used(&apic_id_map, apic_id)) {
  3097. for (i = 0; i < get_physical_broadcast(); i++) {
  3098. if (!apic->check_apicid_used(&apic_id_map, i))
  3099. break;
  3100. }
  3101. if (i == get_physical_broadcast())
  3102. panic("Max apic_id exceeded!\n");
  3103. printk(KERN_WARNING "IOAPIC[%d]: apic_id %d already used, "
  3104. "trying %d\n", ioapic, apic_id, i);
  3105. apic_id = i;
  3106. }
  3107. apic->apicid_to_cpu_present(apic_id, &tmp);
  3108. physids_or(apic_id_map, apic_id_map, tmp);
  3109. if (reg_00.bits.ID != apic_id) {
  3110. reg_00.bits.ID = apic_id;
  3111. raw_spin_lock_irqsave(&ioapic_lock, flags);
  3112. io_apic_write(ioapic, 0, reg_00.raw);
  3113. reg_00.raw = io_apic_read(ioapic, 0);
  3114. raw_spin_unlock_irqrestore(&ioapic_lock, flags);
  3115. /* Sanity check */
  3116. if (reg_00.bits.ID != apic_id) {
  3117. printk("IOAPIC[%d]: Unable to change apic_id!\n", ioapic);
  3118. return -1;
  3119. }
  3120. }
  3121. apic_printk(APIC_VERBOSE, KERN_INFO
  3122. "IOAPIC[%d]: Assigned apic_id %d\n", ioapic, apic_id);
  3123. return apic_id;
  3124. }
  3125. static u8 __init io_apic_unique_id(u8 id)
  3126. {
  3127. if ((boot_cpu_data.x86_vendor == X86_VENDOR_INTEL) &&
  3128. !APIC_XAPIC(apic_version[boot_cpu_physical_apicid]))
  3129. return io_apic_get_unique_id(nr_ioapics, id);
  3130. else
  3131. return id;
  3132. }
  3133. #else
  3134. static u8 __init io_apic_unique_id(u8 id)
  3135. {
  3136. int i;
  3137. DECLARE_BITMAP(used, 256);
  3138. bitmap_zero(used, 256);
  3139. for (i = 0; i < nr_ioapics; i++) {
  3140. struct mpc_ioapic *ia = &mp_ioapics[i];
  3141. __set_bit(ia->apicid, used);
  3142. }
  3143. if (!test_bit(id, used))
  3144. return id;
  3145. return find_first_zero_bit(used, 256);
  3146. }
  3147. #endif
  3148. static int __init io_apic_get_version(int ioapic)
  3149. {
  3150. union IO_APIC_reg_01 reg_01;
  3151. unsigned long flags;
  3152. raw_spin_lock_irqsave(&ioapic_lock, flags);
  3153. reg_01.raw = io_apic_read(ioapic, 1);
  3154. raw_spin_unlock_irqrestore(&ioapic_lock, flags);
  3155. return reg_01.bits.version;
  3156. }
  3157. int acpi_get_override_irq(u32 gsi, int *trigger, int *polarity)
  3158. {
  3159. int ioapic, pin, idx;
  3160. if (skip_ioapic_setup)
  3161. return -1;
  3162. ioapic = mp_find_ioapic(gsi);
  3163. if (ioapic < 0)
  3164. return -1;
  3165. pin = mp_find_ioapic_pin(ioapic, gsi);
  3166. if (pin < 0)
  3167. return -1;
  3168. idx = find_irq_entry(ioapic, pin, mp_INT);
  3169. if (idx < 0)
  3170. return -1;
  3171. *trigger = irq_trigger(idx);
  3172. *polarity = irq_polarity(idx);
  3173. return 0;
  3174. }
  3175. /*
  3176. * This function currently is only a helper for the i386 smp boot process where
  3177. * we need to reprogram the ioredtbls to cater for the cpus which have come online
  3178. * so mask in all cases should simply be apic->target_cpus()
  3179. */
  3180. #ifdef CONFIG_SMP
  3181. void __init setup_ioapic_dest(void)
  3182. {
  3183. int pin, ioapic, irq, irq_entry;
  3184. const struct cpumask *mask;
  3185. struct irq_data *idata;
  3186. if (skip_ioapic_setup == 1)
  3187. return;
  3188. for (ioapic = 0; ioapic < nr_ioapics; ioapic++)
  3189. for (pin = 0; pin < nr_ioapic_registers[ioapic]; pin++) {
  3190. irq_entry = find_irq_entry(ioapic, pin, mp_INT);
  3191. if (irq_entry == -1)
  3192. continue;
  3193. irq = pin_2_irq(irq_entry, ioapic, pin);
  3194. if ((ioapic > 0) && (irq > 16))
  3195. continue;
  3196. idata = irq_get_irq_data(irq);
  3197. /*
  3198. * Honour affinities which have been set in early boot
  3199. */
  3200. if (!irqd_can_balance(idata) || irqd_affinity_was_set(idata))
  3201. mask = idata->affinity;
  3202. else
  3203. mask = apic->target_cpus();
  3204. if (intr_remapping_enabled)
  3205. ir_ioapic_set_affinity(idata, mask, false);
  3206. else
  3207. ioapic_set_affinity(idata, mask, false);
  3208. }
  3209. }
  3210. #endif
  3211. #define IOAPIC_RESOURCE_NAME_SIZE 11
  3212. static struct resource *ioapic_resources;
  3213. static struct resource * __init ioapic_setup_resources(int nr_ioapics)
  3214. {
  3215. unsigned long n;
  3216. struct resource *res;
  3217. char *mem;
  3218. int i;
  3219. if (nr_ioapics <= 0)
  3220. return NULL;
  3221. n = IOAPIC_RESOURCE_NAME_SIZE + sizeof(struct resource);
  3222. n *= nr_ioapics;
  3223. mem = alloc_bootmem(n);
  3224. res = (void *)mem;
  3225. mem += sizeof(struct resource) * nr_ioapics;
  3226. for (i = 0; i < nr_ioapics; i++) {
  3227. res[i].name = mem;
  3228. res[i].flags = IORESOURCE_MEM | IORESOURCE_BUSY;
  3229. snprintf(mem, IOAPIC_RESOURCE_NAME_SIZE, "IOAPIC %u", i);
  3230. mem += IOAPIC_RESOURCE_NAME_SIZE;
  3231. }
  3232. ioapic_resources = res;
  3233. return res;
  3234. }
  3235. void __init ioapic_and_gsi_init(void)
  3236. {
  3237. unsigned long ioapic_phys, idx = FIX_IO_APIC_BASE_0;
  3238. struct resource *ioapic_res;
  3239. int i;
  3240. ioapic_res = ioapic_setup_resources(nr_ioapics);
  3241. for (i = 0; i < nr_ioapics; i++) {
  3242. if (smp_found_config) {
  3243. ioapic_phys = mp_ioapics[i].apicaddr;
  3244. #ifdef CONFIG_X86_32
  3245. if (!ioapic_phys) {
  3246. printk(KERN_ERR
  3247. "WARNING: bogus zero IO-APIC "
  3248. "address found in MPTABLE, "
  3249. "disabling IO/APIC support!\n");
  3250. smp_found_config = 0;
  3251. skip_ioapic_setup = 1;
  3252. goto fake_ioapic_page;
  3253. }
  3254. #endif
  3255. } else {
  3256. #ifdef CONFIG_X86_32
  3257. fake_ioapic_page:
  3258. #endif
  3259. ioapic_phys = (unsigned long)alloc_bootmem_pages(PAGE_SIZE);
  3260. ioapic_phys = __pa(ioapic_phys);
  3261. }
  3262. set_fixmap_nocache(idx, ioapic_phys);
  3263. apic_printk(APIC_VERBOSE, "mapped IOAPIC to %08lx (%08lx)\n",
  3264. __fix_to_virt(idx) + (ioapic_phys & ~PAGE_MASK),
  3265. ioapic_phys);
  3266. idx++;
  3267. ioapic_res->start = ioapic_phys;
  3268. ioapic_res->end = ioapic_phys + IO_APIC_SLOT_SIZE - 1;
  3269. ioapic_res++;
  3270. }
  3271. probe_nr_irqs_gsi();
  3272. }
  3273. void __init ioapic_insert_resources(void)
  3274. {
  3275. int i;
  3276. struct resource *r = ioapic_resources;
  3277. if (!r) {
  3278. if (nr_ioapics > 0)
  3279. printk(KERN_ERR
  3280. "IO APIC resources couldn't be allocated.\n");
  3281. return;
  3282. }
  3283. for (i = 0; i < nr_ioapics; i++) {
  3284. insert_resource(&iomem_resource, r);
  3285. r++;
  3286. }
  3287. }
  3288. int mp_find_ioapic(u32 gsi)
  3289. {
  3290. int i = 0;
  3291. if (nr_ioapics == 0)
  3292. return -1;
  3293. /* Find the IOAPIC that manages this GSI. */
  3294. for (i = 0; i < nr_ioapics; i++) {
  3295. if ((gsi >= mp_gsi_routing[i].gsi_base)
  3296. && (gsi <= mp_gsi_routing[i].gsi_end))
  3297. return i;
  3298. }
  3299. printk(KERN_ERR "ERROR: Unable to locate IOAPIC for GSI %d\n", gsi);
  3300. return -1;
  3301. }
  3302. int mp_find_ioapic_pin(int ioapic, u32 gsi)
  3303. {
  3304. if (WARN_ON(ioapic == -1))
  3305. return -1;
  3306. if (WARN_ON(gsi > mp_gsi_routing[ioapic].gsi_end))
  3307. return -1;
  3308. return gsi - mp_gsi_routing[ioapic].gsi_base;
  3309. }
  3310. static __init int bad_ioapic(unsigned long address)
  3311. {
  3312. if (nr_ioapics >= MAX_IO_APICS) {
  3313. printk(KERN_WARNING "WARNING: Max # of I/O APICs (%d) exceeded "
  3314. "(found %d), skipping\n", MAX_IO_APICS, nr_ioapics);
  3315. return 1;
  3316. }
  3317. if (!address) {
  3318. printk(KERN_WARNING "WARNING: Bogus (zero) I/O APIC address"
  3319. " found in table, skipping!\n");
  3320. return 1;
  3321. }
  3322. return 0;
  3323. }
  3324. void __init mp_register_ioapic(int id, u32 address, u32 gsi_base)
  3325. {
  3326. int idx = 0;
  3327. int entries;
  3328. if (bad_ioapic(address))
  3329. return;
  3330. idx = nr_ioapics;
  3331. mp_ioapics[idx].type = MP_IOAPIC;
  3332. mp_ioapics[idx].flags = MPC_APIC_USABLE;
  3333. mp_ioapics[idx].apicaddr = address;
  3334. set_fixmap_nocache(FIX_IO_APIC_BASE_0 + idx, address);
  3335. mp_ioapics[idx].apicid = io_apic_unique_id(id);
  3336. mp_ioapics[idx].apicver = io_apic_get_version(idx);
  3337. /*
  3338. * Build basic GSI lookup table to facilitate gsi->io_apic lookups
  3339. * and to prevent reprogramming of IOAPIC pins (PCI GSIs).
  3340. */
  3341. entries = io_apic_get_redir_entries(idx);
  3342. mp_gsi_routing[idx].gsi_base = gsi_base;
  3343. mp_gsi_routing[idx].gsi_end = gsi_base + entries - 1;
  3344. /*
  3345. * The number of IO-APIC IRQ registers (== #pins):
  3346. */
  3347. nr_ioapic_registers[idx] = entries;
  3348. if (mp_gsi_routing[idx].gsi_end >= gsi_top)
  3349. gsi_top = mp_gsi_routing[idx].gsi_end + 1;
  3350. printk(KERN_INFO "IOAPIC[%d]: apic_id %d, version %d, address 0x%x, "
  3351. "GSI %d-%d\n", idx, mp_ioapics[idx].apicid,
  3352. mp_ioapics[idx].apicver, mp_ioapics[idx].apicaddr,
  3353. mp_gsi_routing[idx].gsi_base, mp_gsi_routing[idx].gsi_end);
  3354. nr_ioapics++;
  3355. }
  3356. /* Enable IOAPIC early just for system timer */
  3357. void __init pre_init_apic_IRQ0(void)
  3358. {
  3359. struct io_apic_irq_attr attr = { 0, 0, 0, 0 };
  3360. printk(KERN_INFO "Early APIC setup for system timer0\n");
  3361. #ifndef CONFIG_SMP
  3362. physid_set_mask_of_physid(boot_cpu_physical_apicid,
  3363. &phys_cpu_present_map);
  3364. #endif
  3365. setup_local_APIC();
  3366. io_apic_setup_irq_pin(0, 0, &attr);
  3367. irq_set_chip_and_handler_name(0, &ioapic_chip, handle_edge_irq,
  3368. "edge");
  3369. }