igb_core.c 123 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950295129522953295429552956295729582959296029612962296329642965296629672968296929702971297229732974297529762977297829792980298129822983298429852986298729882989299029912992299329942995299629972998299930003001300230033004300530063007300830093010301130123013301430153016301730183019302030213022302330243025302630273028302930303031303230333034303530363037303830393040304130423043304430453046304730483049305030513052305330543055305630573058305930603061306230633064306530663067306830693070307130723073307430753076307730783079308030813082308330843085308630873088308930903091309230933094309530963097309830993100310131023103310431053106310731083109311031113112311331143115311631173118311931203121312231233124312531263127312831293130313131323133313431353136313731383139314031413142314331443145314631473148314931503151315231533154315531563157315831593160316131623163316431653166316731683169317031713172317331743175317631773178317931803181318231833184318531863187318831893190319131923193319431953196319731983199320032013202320332043205320632073208320932103211321232133214321532163217321832193220322132223223322432253226322732283229323032313232323332343235323632373238323932403241324232433244324532463247324832493250325132523253325432553256325732583259326032613262326332643265326632673268326932703271327232733274327532763277327832793280328132823283328432853286328732883289329032913292329332943295329632973298329933003301330233033304330533063307330833093310331133123313331433153316331733183319332033213322332333243325332633273328332933303331333233333334333533363337333833393340334133423343334433453346334733483349335033513352335333543355335633573358335933603361336233633364336533663367336833693370337133723373337433753376337733783379338033813382338333843385338633873388338933903391339233933394339533963397339833993400340134023403340434053406340734083409341034113412341334143415341634173418341934203421342234233424342534263427342834293430343134323433343434353436343734383439344034413442344334443445344634473448344934503451345234533454345534563457345834593460346134623463346434653466346734683469347034713472347334743475347634773478347934803481348234833484348534863487348834893490349134923493349434953496349734983499350035013502350335043505350635073508350935103511351235133514351535163517351835193520352135223523352435253526352735283529353035313532353335343535353635373538353935403541354235433544354535463547354835493550355135523553355435553556355735583559356035613562356335643565356635673568356935703571357235733574357535763577357835793580358135823583358435853586358735883589359035913592359335943595359635973598359936003601360236033604360536063607360836093610361136123613361436153616361736183619362036213622362336243625362636273628362936303631363236333634363536363637363836393640364136423643364436453646364736483649365036513652365336543655365636573658365936603661366236633664366536663667366836693670367136723673367436753676367736783679368036813682368336843685368636873688368936903691369236933694369536963697369836993700370137023703370437053706370737083709371037113712371337143715371637173718371937203721372237233724372537263727372837293730373137323733373437353736373737383739374037413742374337443745374637473748374937503751375237533754375537563757375837593760376137623763376437653766376737683769377037713772377337743775377637773778377937803781378237833784378537863787378837893790379137923793379437953796379737983799380038013802380338043805380638073808380938103811381238133814381538163817381838193820382138223823382438253826382738283829383038313832383338343835383638373838383938403841384238433844384538463847384838493850385138523853385438553856385738583859386038613862386338643865386638673868386938703871387238733874387538763877387838793880388138823883388438853886388738883889389038913892389338943895389638973898389939003901390239033904390539063907390839093910391139123913391439153916391739183919392039213922392339243925392639273928392939303931393239333934393539363937393839393940394139423943394439453946394739483949395039513952395339543955395639573958395939603961396239633964396539663967396839693970397139723973397439753976397739783979398039813982398339843985398639873988398939903991399239933994399539963997399839994000400140024003400440054006400740084009401040114012401340144015401640174018401940204021402240234024402540264027402840294030403140324033403440354036403740384039404040414042404340444045404640474048404940504051405240534054405540564057405840594060406140624063406440654066406740684069407040714072407340744075407640774078407940804081408240834084408540864087408840894090409140924093409440954096409740984099410041014102410341044105410641074108410941104111411241134114411541164117411841194120412141224123412441254126412741284129413041314132413341344135413641374138413941404141414241434144414541464147414841494150415141524153415441554156415741584159416041614162416341644165416641674168416941704171417241734174417541764177417841794180418141824183418441854186418741884189419041914192419341944195419641974198419942004201420242034204420542064207420842094210421142124213421442154216421742184219422042214222422342244225422642274228422942304231423242334234423542364237423842394240424142424243424442454246424742484249425042514252425342544255425642574258425942604261426242634264
  1. /*
  2. * Core code for QEMU igb emulation
  3. *
  4. * Datasheet:
  5. * https://www.intel.com/content/dam/www/public/us/en/documents/datasheets/82576eg-gbe-datasheet.pdf
  6. *
  7. * Copyright (c) 2020-2023 Red Hat, Inc.
  8. * Copyright (c) 2015 Ravello Systems LTD (http://ravellosystems.com)
  9. * Developed by Daynix Computing LTD (http://www.daynix.com)
  10. *
  11. * Authors:
  12. * Akihiko Odaki <akihiko.odaki@daynix.com>
  13. * Gal Hammmer <gal.hammer@sap.com>
  14. * Marcel Apfelbaum <marcel.apfelbaum@gmail.com>
  15. * Dmitry Fleytman <dmitry@daynix.com>
  16. * Leonid Bloch <leonid@daynix.com>
  17. * Yan Vugenfirer <yan@daynix.com>
  18. *
  19. * Based on work done by:
  20. * Nir Peleg, Tutis Systems Ltd. for Qumranet Inc.
  21. * Copyright (c) 2008 Qumranet
  22. * Based on work done by:
  23. * Copyright (c) 2007 Dan Aloni
  24. * Copyright (c) 2004 Antony T Curtis
  25. *
  26. * This library is free software; you can redistribute it and/or
  27. * modify it under the terms of the GNU Lesser General Public
  28. * License as published by the Free Software Foundation; either
  29. * version 2.1 of the License, or (at your option) any later version.
  30. *
  31. * This library is distributed in the hope that it will be useful,
  32. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  33. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  34. * Lesser General Public License for more details.
  35. *
  36. * You should have received a copy of the GNU Lesser General Public
  37. * License along with this library; if not, see <http://www.gnu.org/licenses/>.
  38. */
  39. #include "qemu/osdep.h"
  40. #include "qemu/log.h"
  41. #include "net/net.h"
  42. #include "net/tap.h"
  43. #include "hw/net/mii.h"
  44. #include "hw/pci/msi.h"
  45. #include "hw/pci/msix.h"
  46. #include "sysemu/runstate.h"
  47. #include "net_tx_pkt.h"
  48. #include "net_rx_pkt.h"
  49. #include "igb_common.h"
  50. #include "e1000x_common.h"
  51. #include "igb_core.h"
  52. #include "trace.h"
  53. #define E1000E_MAX_TX_FRAGS (64)
  54. union e1000_rx_desc_union {
  55. struct e1000_rx_desc legacy;
  56. union e1000_adv_rx_desc adv;
  57. };
  58. typedef struct IGBTxPktVmdqCallbackContext {
  59. IGBCore *core;
  60. NetClientState *nc;
  61. } IGBTxPktVmdqCallbackContext;
  62. typedef struct L2Header {
  63. struct eth_header eth;
  64. struct vlan_header vlan[2];
  65. } L2Header;
  66. typedef struct PTP2 {
  67. uint8_t message_id_transport_specific;
  68. uint8_t version_ptp;
  69. uint16_t message_length;
  70. uint8_t subdomain_number;
  71. uint8_t reserved0;
  72. uint16_t flags;
  73. uint64_t correction;
  74. uint8_t reserved1[5];
  75. uint8_t source_communication_technology;
  76. uint32_t source_uuid_lo;
  77. uint16_t source_uuid_hi;
  78. uint16_t source_port_id;
  79. uint16_t sequence_id;
  80. uint8_t control;
  81. uint8_t log_message_period;
  82. } PTP2;
  83. static ssize_t
  84. igb_receive_internal(IGBCore *core, const struct iovec *iov, int iovcnt,
  85. bool has_vnet, bool *external_tx);
  86. static void igb_raise_interrupts(IGBCore *core, size_t index, uint32_t causes);
  87. static void igb_reset(IGBCore *core, bool sw);
  88. static inline void
  89. igb_raise_legacy_irq(IGBCore *core)
  90. {
  91. trace_e1000e_irq_legacy_notify(true);
  92. e1000x_inc_reg_if_not_full(core->mac, IAC);
  93. pci_set_irq(core->owner, 1);
  94. }
  95. static inline void
  96. igb_lower_legacy_irq(IGBCore *core)
  97. {
  98. trace_e1000e_irq_legacy_notify(false);
  99. pci_set_irq(core->owner, 0);
  100. }
  101. static void igb_msix_notify(IGBCore *core, unsigned int cause)
  102. {
  103. PCIDevice *dev = core->owner;
  104. uint16_t vfn;
  105. uint32_t effective_eiac;
  106. unsigned int vector;
  107. vfn = 8 - (cause + 2) / IGBVF_MSIX_VEC_NUM;
  108. if (vfn < pcie_sriov_num_vfs(core->owner)) {
  109. dev = pcie_sriov_get_vf_at_index(core->owner, vfn);
  110. assert(dev);
  111. vector = (cause + 2) % IGBVF_MSIX_VEC_NUM;
  112. } else if (cause >= IGB_MSIX_VEC_NUM) {
  113. qemu_log_mask(LOG_GUEST_ERROR,
  114. "igb: Tried to use vector unavailable for PF");
  115. return;
  116. } else {
  117. vector = cause;
  118. }
  119. msix_notify(dev, vector);
  120. trace_e1000e_irq_icr_clear_eiac(core->mac[EICR], core->mac[EIAC]);
  121. effective_eiac = core->mac[EIAC] & BIT(cause);
  122. core->mac[EICR] &= ~effective_eiac;
  123. }
  124. static inline void
  125. igb_intrmgr_rearm_timer(IGBIntrDelayTimer *timer)
  126. {
  127. int64_t delay_ns = (int64_t) timer->core->mac[timer->delay_reg] *
  128. timer->delay_resolution_ns;
  129. trace_e1000e_irq_rearm_timer(timer->delay_reg << 2, delay_ns);
  130. timer_mod(timer->timer, qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + delay_ns);
  131. timer->running = true;
  132. }
  133. static void
  134. igb_intmgr_timer_resume(IGBIntrDelayTimer *timer)
  135. {
  136. if (timer->running) {
  137. igb_intrmgr_rearm_timer(timer);
  138. }
  139. }
  140. static void
  141. igb_intmgr_timer_pause(IGBIntrDelayTimer *timer)
  142. {
  143. if (timer->running) {
  144. timer_del(timer->timer);
  145. }
  146. }
  147. static void
  148. igb_intrmgr_on_msix_throttling_timer(void *opaque)
  149. {
  150. IGBIntrDelayTimer *timer = opaque;
  151. int idx = timer - &timer->core->eitr[0];
  152. timer->running = false;
  153. trace_e1000e_irq_msix_notify_postponed_vec(idx);
  154. igb_msix_notify(timer->core, idx);
  155. }
  156. static void
  157. igb_intrmgr_initialize_all_timers(IGBCore *core, bool create)
  158. {
  159. int i;
  160. for (i = 0; i < IGB_INTR_NUM; i++) {
  161. core->eitr[i].core = core;
  162. core->eitr[i].delay_reg = EITR0 + i;
  163. core->eitr[i].delay_resolution_ns = E1000_INTR_DELAY_NS_RES;
  164. }
  165. if (!create) {
  166. return;
  167. }
  168. for (i = 0; i < IGB_INTR_NUM; i++) {
  169. core->eitr[i].timer = timer_new_ns(QEMU_CLOCK_VIRTUAL,
  170. igb_intrmgr_on_msix_throttling_timer,
  171. &core->eitr[i]);
  172. }
  173. }
  174. static void
  175. igb_intrmgr_resume(IGBCore *core)
  176. {
  177. int i;
  178. for (i = 0; i < IGB_INTR_NUM; i++) {
  179. igb_intmgr_timer_resume(&core->eitr[i]);
  180. }
  181. }
  182. static void
  183. igb_intrmgr_pause(IGBCore *core)
  184. {
  185. int i;
  186. for (i = 0; i < IGB_INTR_NUM; i++) {
  187. igb_intmgr_timer_pause(&core->eitr[i]);
  188. }
  189. }
  190. static void
  191. igb_intrmgr_reset(IGBCore *core)
  192. {
  193. int i;
  194. for (i = 0; i < IGB_INTR_NUM; i++) {
  195. if (core->eitr[i].running) {
  196. timer_del(core->eitr[i].timer);
  197. igb_intrmgr_on_msix_throttling_timer(&core->eitr[i]);
  198. }
  199. }
  200. }
  201. static void
  202. igb_intrmgr_pci_unint(IGBCore *core)
  203. {
  204. int i;
  205. for (i = 0; i < IGB_INTR_NUM; i++) {
  206. timer_free(core->eitr[i].timer);
  207. }
  208. }
  209. static void
  210. igb_intrmgr_pci_realize(IGBCore *core)
  211. {
  212. igb_intrmgr_initialize_all_timers(core, true);
  213. }
  214. static inline bool
  215. igb_rx_csum_enabled(IGBCore *core)
  216. {
  217. return (core->mac[RXCSUM] & E1000_RXCSUM_PCSD) ? false : true;
  218. }
  219. static inline bool
  220. igb_rx_use_legacy_descriptor(IGBCore *core)
  221. {
  222. /*
  223. * TODO: If SRRCTL[n],DESCTYPE = 000b, the 82576 uses the legacy Rx
  224. * descriptor.
  225. */
  226. return false;
  227. }
  228. static inline bool
  229. igb_rss_enabled(IGBCore *core)
  230. {
  231. return (core->mac[MRQC] & 3) == E1000_MRQC_ENABLE_RSS_MQ &&
  232. !igb_rx_csum_enabled(core) &&
  233. !igb_rx_use_legacy_descriptor(core);
  234. }
  235. typedef struct E1000E_RSSInfo_st {
  236. bool enabled;
  237. uint32_t hash;
  238. uint32_t queue;
  239. uint32_t type;
  240. } E1000E_RSSInfo;
  241. static uint32_t
  242. igb_rss_get_hash_type(IGBCore *core, struct NetRxPkt *pkt)
  243. {
  244. bool hasip4, hasip6;
  245. EthL4HdrProto l4hdr_proto;
  246. assert(igb_rss_enabled(core));
  247. net_rx_pkt_get_protocols(pkt, &hasip4, &hasip6, &l4hdr_proto);
  248. if (hasip4) {
  249. trace_e1000e_rx_rss_ip4(l4hdr_proto, core->mac[MRQC],
  250. E1000_MRQC_EN_TCPIPV4(core->mac[MRQC]),
  251. E1000_MRQC_EN_IPV4(core->mac[MRQC]));
  252. if (l4hdr_proto == ETH_L4_HDR_PROTO_TCP &&
  253. E1000_MRQC_EN_TCPIPV4(core->mac[MRQC])) {
  254. return E1000_MRQ_RSS_TYPE_IPV4TCP;
  255. }
  256. if (l4hdr_proto == ETH_L4_HDR_PROTO_UDP &&
  257. (core->mac[MRQC] & E1000_MRQC_RSS_FIELD_IPV4_UDP)) {
  258. return E1000_MRQ_RSS_TYPE_IPV4UDP;
  259. }
  260. if (E1000_MRQC_EN_IPV4(core->mac[MRQC])) {
  261. return E1000_MRQ_RSS_TYPE_IPV4;
  262. }
  263. } else if (hasip6) {
  264. eth_ip6_hdr_info *ip6info = net_rx_pkt_get_ip6_info(pkt);
  265. bool ex_dis = core->mac[RFCTL] & E1000_RFCTL_IPV6_EX_DIS;
  266. bool new_ex_dis = core->mac[RFCTL] & E1000_RFCTL_NEW_IPV6_EXT_DIS;
  267. /*
  268. * Following two traces must not be combined because resulting
  269. * event will have 11 arguments totally and some trace backends
  270. * (at least "ust") have limitation of maximum 10 arguments per
  271. * event. Events with more arguments fail to compile for
  272. * backends like these.
  273. */
  274. trace_e1000e_rx_rss_ip6_rfctl(core->mac[RFCTL]);
  275. trace_e1000e_rx_rss_ip6(ex_dis, new_ex_dis, l4hdr_proto,
  276. ip6info->has_ext_hdrs,
  277. ip6info->rss_ex_dst_valid,
  278. ip6info->rss_ex_src_valid,
  279. core->mac[MRQC],
  280. E1000_MRQC_EN_TCPIPV6EX(core->mac[MRQC]),
  281. E1000_MRQC_EN_IPV6EX(core->mac[MRQC]),
  282. E1000_MRQC_EN_IPV6(core->mac[MRQC]));
  283. if ((!ex_dis || !ip6info->has_ext_hdrs) &&
  284. (!new_ex_dis || !(ip6info->rss_ex_dst_valid ||
  285. ip6info->rss_ex_src_valid))) {
  286. if (l4hdr_proto == ETH_L4_HDR_PROTO_TCP &&
  287. E1000_MRQC_EN_TCPIPV6EX(core->mac[MRQC])) {
  288. return E1000_MRQ_RSS_TYPE_IPV6TCPEX;
  289. }
  290. if (l4hdr_proto == ETH_L4_HDR_PROTO_UDP &&
  291. (core->mac[MRQC] & E1000_MRQC_RSS_FIELD_IPV6_UDP)) {
  292. return E1000_MRQ_RSS_TYPE_IPV6UDP;
  293. }
  294. if (E1000_MRQC_EN_IPV6EX(core->mac[MRQC])) {
  295. return E1000_MRQ_RSS_TYPE_IPV6EX;
  296. }
  297. }
  298. if (E1000_MRQC_EN_IPV6(core->mac[MRQC])) {
  299. return E1000_MRQ_RSS_TYPE_IPV6;
  300. }
  301. }
  302. return E1000_MRQ_RSS_TYPE_NONE;
  303. }
  304. static uint32_t
  305. igb_rss_calc_hash(IGBCore *core, struct NetRxPkt *pkt, E1000E_RSSInfo *info)
  306. {
  307. NetRxPktRssType type;
  308. assert(igb_rss_enabled(core));
  309. switch (info->type) {
  310. case E1000_MRQ_RSS_TYPE_IPV4:
  311. type = NetPktRssIpV4;
  312. break;
  313. case E1000_MRQ_RSS_TYPE_IPV4TCP:
  314. type = NetPktRssIpV4Tcp;
  315. break;
  316. case E1000_MRQ_RSS_TYPE_IPV6TCPEX:
  317. type = NetPktRssIpV6TcpEx;
  318. break;
  319. case E1000_MRQ_RSS_TYPE_IPV6:
  320. type = NetPktRssIpV6;
  321. break;
  322. case E1000_MRQ_RSS_TYPE_IPV6EX:
  323. type = NetPktRssIpV6Ex;
  324. break;
  325. case E1000_MRQ_RSS_TYPE_IPV4UDP:
  326. type = NetPktRssIpV4Udp;
  327. break;
  328. case E1000_MRQ_RSS_TYPE_IPV6UDP:
  329. type = NetPktRssIpV6Udp;
  330. break;
  331. default:
  332. assert(false);
  333. return 0;
  334. }
  335. return net_rx_pkt_calc_rss_hash(pkt, type, (uint8_t *) &core->mac[RSSRK]);
  336. }
  337. static void
  338. igb_rss_parse_packet(IGBCore *core, struct NetRxPkt *pkt, bool tx,
  339. E1000E_RSSInfo *info)
  340. {
  341. trace_e1000e_rx_rss_started();
  342. if (tx || !igb_rss_enabled(core)) {
  343. info->enabled = false;
  344. info->hash = 0;
  345. info->queue = 0;
  346. info->type = 0;
  347. trace_e1000e_rx_rss_disabled();
  348. return;
  349. }
  350. info->enabled = true;
  351. info->type = igb_rss_get_hash_type(core, pkt);
  352. trace_e1000e_rx_rss_type(info->type);
  353. if (info->type == E1000_MRQ_RSS_TYPE_NONE) {
  354. info->hash = 0;
  355. info->queue = 0;
  356. return;
  357. }
  358. info->hash = igb_rss_calc_hash(core, pkt, info);
  359. info->queue = E1000_RSS_QUEUE(&core->mac[RETA], info->hash);
  360. }
  361. static void
  362. igb_tx_insert_vlan(IGBCore *core, uint16_t qn, struct igb_tx *tx,
  363. uint16_t vlan, bool insert_vlan)
  364. {
  365. if (core->mac[MRQC] & 1) {
  366. uint16_t pool = qn % IGB_NUM_VM_POOLS;
  367. if (core->mac[VMVIR0 + pool] & E1000_VMVIR_VLANA_DEFAULT) {
  368. /* always insert default VLAN */
  369. insert_vlan = true;
  370. vlan = core->mac[VMVIR0 + pool] & 0xffff;
  371. } else if (core->mac[VMVIR0 + pool] & E1000_VMVIR_VLANA_NEVER) {
  372. insert_vlan = false;
  373. }
  374. }
  375. if (insert_vlan) {
  376. net_tx_pkt_setup_vlan_header_ex(tx->tx_pkt, vlan,
  377. core->mac[VET] & 0xffff);
  378. }
  379. }
  380. static bool
  381. igb_setup_tx_offloads(IGBCore *core, struct igb_tx *tx)
  382. {
  383. uint32_t idx = (tx->first_olinfo_status >> 4) & 1;
  384. if (tx->first_cmd_type_len & E1000_ADVTXD_DCMD_TSE) {
  385. uint32_t mss = tx->ctx[idx].mss_l4len_idx >> E1000_ADVTXD_MSS_SHIFT;
  386. if (!net_tx_pkt_build_vheader(tx->tx_pkt, true, true, mss)) {
  387. return false;
  388. }
  389. net_tx_pkt_update_ip_checksums(tx->tx_pkt);
  390. e1000x_inc_reg_if_not_full(core->mac, TSCTC);
  391. return true;
  392. }
  393. if ((tx->first_olinfo_status & E1000_ADVTXD_POTS_TXSM) &&
  394. !((tx->ctx[idx].type_tucmd_mlhl & E1000_ADVTXD_TUCMD_L4T_SCTP) ?
  395. net_tx_pkt_update_sctp_checksum(tx->tx_pkt) :
  396. net_tx_pkt_build_vheader(tx->tx_pkt, false, true, 0))) {
  397. return false;
  398. }
  399. if (tx->first_olinfo_status & E1000_ADVTXD_POTS_IXSM) {
  400. net_tx_pkt_update_ip_hdr_checksum(tx->tx_pkt);
  401. }
  402. return true;
  403. }
  404. static void igb_tx_pkt_mac_callback(void *core,
  405. const struct iovec *iov,
  406. int iovcnt,
  407. const struct iovec *virt_iov,
  408. int virt_iovcnt)
  409. {
  410. igb_receive_internal(core, virt_iov, virt_iovcnt, true, NULL);
  411. }
  412. static void igb_tx_pkt_vmdq_callback(void *opaque,
  413. const struct iovec *iov,
  414. int iovcnt,
  415. const struct iovec *virt_iov,
  416. int virt_iovcnt)
  417. {
  418. IGBTxPktVmdqCallbackContext *context = opaque;
  419. bool external_tx;
  420. igb_receive_internal(context->core, virt_iov, virt_iovcnt, true,
  421. &external_tx);
  422. if (external_tx) {
  423. if (context->core->has_vnet) {
  424. qemu_sendv_packet(context->nc, virt_iov, virt_iovcnt);
  425. } else {
  426. qemu_sendv_packet(context->nc, iov, iovcnt);
  427. }
  428. }
  429. }
  430. /* TX Packets Switching (7.10.3.6) */
  431. static bool igb_tx_pkt_switch(IGBCore *core, struct igb_tx *tx,
  432. NetClientState *nc)
  433. {
  434. IGBTxPktVmdqCallbackContext context;
  435. /* TX switching is only used to serve VM to VM traffic. */
  436. if (!(core->mac[MRQC] & 1)) {
  437. goto send_out;
  438. }
  439. /* TX switching requires DTXSWC.Loopback_en bit enabled. */
  440. if (!(core->mac[DTXSWC] & E1000_DTXSWC_VMDQ_LOOPBACK_EN)) {
  441. goto send_out;
  442. }
  443. context.core = core;
  444. context.nc = nc;
  445. return net_tx_pkt_send_custom(tx->tx_pkt, false,
  446. igb_tx_pkt_vmdq_callback, &context);
  447. send_out:
  448. return net_tx_pkt_send(tx->tx_pkt, nc);
  449. }
  450. static bool
  451. igb_tx_pkt_send(IGBCore *core, struct igb_tx *tx, int queue_index)
  452. {
  453. int target_queue = MIN(core->max_queue_num, queue_index);
  454. NetClientState *queue = qemu_get_subqueue(core->owner_nic, target_queue);
  455. if (!igb_setup_tx_offloads(core, tx)) {
  456. return false;
  457. }
  458. net_tx_pkt_dump(tx->tx_pkt);
  459. if ((core->phy[MII_BMCR] & MII_BMCR_LOOPBACK) ||
  460. ((core->mac[RCTL] & E1000_RCTL_LBM_MAC) == E1000_RCTL_LBM_MAC)) {
  461. return net_tx_pkt_send_custom(tx->tx_pkt, false,
  462. igb_tx_pkt_mac_callback, core);
  463. } else {
  464. return igb_tx_pkt_switch(core, tx, queue);
  465. }
  466. }
  467. static void
  468. igb_on_tx_done_update_stats(IGBCore *core, struct NetTxPkt *tx_pkt, int qn)
  469. {
  470. static const int PTCregs[6] = { PTC64, PTC127, PTC255, PTC511,
  471. PTC1023, PTC1522 };
  472. size_t tot_len = net_tx_pkt_get_total_len(tx_pkt) + 4;
  473. e1000x_increase_size_stats(core->mac, PTCregs, tot_len);
  474. e1000x_inc_reg_if_not_full(core->mac, TPT);
  475. e1000x_grow_8reg_if_not_full(core->mac, TOTL, tot_len);
  476. switch (net_tx_pkt_get_packet_type(tx_pkt)) {
  477. case ETH_PKT_BCAST:
  478. e1000x_inc_reg_if_not_full(core->mac, BPTC);
  479. break;
  480. case ETH_PKT_MCAST:
  481. e1000x_inc_reg_if_not_full(core->mac, MPTC);
  482. break;
  483. case ETH_PKT_UCAST:
  484. break;
  485. default:
  486. g_assert_not_reached();
  487. }
  488. e1000x_inc_reg_if_not_full(core->mac, GPTC);
  489. e1000x_grow_8reg_if_not_full(core->mac, GOTCL, tot_len);
  490. if (core->mac[MRQC] & 1) {
  491. uint16_t pool = qn % IGB_NUM_VM_POOLS;
  492. core->mac[PVFGOTC0 + (pool * 64)] += tot_len;
  493. core->mac[PVFGPTC0 + (pool * 64)]++;
  494. }
  495. }
  496. static void
  497. igb_process_tx_desc(IGBCore *core,
  498. PCIDevice *dev,
  499. struct igb_tx *tx,
  500. union e1000_adv_tx_desc *tx_desc,
  501. int queue_index)
  502. {
  503. struct e1000_adv_tx_context_desc *tx_ctx_desc;
  504. uint32_t cmd_type_len;
  505. uint32_t idx;
  506. uint64_t buffer_addr;
  507. uint16_t length;
  508. cmd_type_len = le32_to_cpu(tx_desc->read.cmd_type_len);
  509. if (cmd_type_len & E1000_ADVTXD_DCMD_DEXT) {
  510. if ((cmd_type_len & E1000_ADVTXD_DTYP_DATA) ==
  511. E1000_ADVTXD_DTYP_DATA) {
  512. /* advanced transmit data descriptor */
  513. if (tx->first) {
  514. tx->first_cmd_type_len = cmd_type_len;
  515. tx->first_olinfo_status = le32_to_cpu(tx_desc->read.olinfo_status);
  516. tx->first = false;
  517. }
  518. } else if ((cmd_type_len & E1000_ADVTXD_DTYP_CTXT) ==
  519. E1000_ADVTXD_DTYP_CTXT) {
  520. /* advanced transmit context descriptor */
  521. tx_ctx_desc = (struct e1000_adv_tx_context_desc *)tx_desc;
  522. idx = (le32_to_cpu(tx_ctx_desc->mss_l4len_idx) >> 4) & 1;
  523. tx->ctx[idx].vlan_macip_lens = le32_to_cpu(tx_ctx_desc->vlan_macip_lens);
  524. tx->ctx[idx].seqnum_seed = le32_to_cpu(tx_ctx_desc->seqnum_seed);
  525. tx->ctx[idx].type_tucmd_mlhl = le32_to_cpu(tx_ctx_desc->type_tucmd_mlhl);
  526. tx->ctx[idx].mss_l4len_idx = le32_to_cpu(tx_ctx_desc->mss_l4len_idx);
  527. return;
  528. } else {
  529. /* unknown descriptor type */
  530. return;
  531. }
  532. } else {
  533. /* legacy descriptor */
  534. /* TODO: Implement a support for legacy descriptors (7.2.2.1). */
  535. }
  536. buffer_addr = le64_to_cpu(tx_desc->read.buffer_addr);
  537. length = cmd_type_len & 0xFFFF;
  538. if (!tx->skip_cp) {
  539. if (!net_tx_pkt_add_raw_fragment_pci(tx->tx_pkt, dev,
  540. buffer_addr, length)) {
  541. tx->skip_cp = true;
  542. }
  543. }
  544. if (cmd_type_len & E1000_TXD_CMD_EOP) {
  545. if (!tx->skip_cp && net_tx_pkt_parse(tx->tx_pkt)) {
  546. idx = (tx->first_olinfo_status >> 4) & 1;
  547. igb_tx_insert_vlan(core, queue_index, tx,
  548. tx->ctx[idx].vlan_macip_lens >> IGB_TX_FLAGS_VLAN_SHIFT,
  549. !!(tx->first_cmd_type_len & E1000_TXD_CMD_VLE));
  550. if ((tx->first_cmd_type_len & E1000_ADVTXD_MAC_TSTAMP) &&
  551. (core->mac[TSYNCTXCTL] & E1000_TSYNCTXCTL_ENABLED) &&
  552. !(core->mac[TSYNCTXCTL] & E1000_TSYNCTXCTL_VALID)) {
  553. core->mac[TSYNCTXCTL] |= E1000_TSYNCTXCTL_VALID;
  554. e1000x_timestamp(core->mac, core->timadj, TXSTMPL, TXSTMPH);
  555. }
  556. if (igb_tx_pkt_send(core, tx, queue_index)) {
  557. igb_on_tx_done_update_stats(core, tx->tx_pkt, queue_index);
  558. }
  559. }
  560. tx->first = true;
  561. tx->skip_cp = false;
  562. net_tx_pkt_reset(tx->tx_pkt, net_tx_pkt_unmap_frag_pci, dev);
  563. }
  564. }
  565. static uint32_t igb_tx_wb_eic(IGBCore *core, int queue_idx)
  566. {
  567. uint32_t n, ent = 0;
  568. n = igb_ivar_entry_tx(queue_idx);
  569. ent = (core->mac[IVAR0 + n / 4] >> (8 * (n % 4))) & 0xff;
  570. return (ent & E1000_IVAR_VALID) ? BIT(ent & 0x1f) : 0;
  571. }
  572. static uint32_t igb_rx_wb_eic(IGBCore *core, int queue_idx)
  573. {
  574. uint32_t n, ent = 0;
  575. n = igb_ivar_entry_rx(queue_idx);
  576. ent = (core->mac[IVAR0 + n / 4] >> (8 * (n % 4))) & 0xff;
  577. return (ent & E1000_IVAR_VALID) ? BIT(ent & 0x1f) : 0;
  578. }
  579. typedef struct E1000E_RingInfo_st {
  580. int dbah;
  581. int dbal;
  582. int dlen;
  583. int dh;
  584. int dt;
  585. int idx;
  586. } E1000E_RingInfo;
  587. static inline bool
  588. igb_ring_empty(IGBCore *core, const E1000E_RingInfo *r)
  589. {
  590. return core->mac[r->dh] == core->mac[r->dt] ||
  591. core->mac[r->dt] >= core->mac[r->dlen] / E1000_RING_DESC_LEN;
  592. }
  593. static inline uint64_t
  594. igb_ring_base(IGBCore *core, const E1000E_RingInfo *r)
  595. {
  596. uint64_t bah = core->mac[r->dbah];
  597. uint64_t bal = core->mac[r->dbal];
  598. return (bah << 32) + bal;
  599. }
  600. static inline uint64_t
  601. igb_ring_head_descr(IGBCore *core, const E1000E_RingInfo *r)
  602. {
  603. return igb_ring_base(core, r) + E1000_RING_DESC_LEN * core->mac[r->dh];
  604. }
  605. static inline void
  606. igb_ring_advance(IGBCore *core, const E1000E_RingInfo *r, uint32_t count)
  607. {
  608. core->mac[r->dh] += count;
  609. if (core->mac[r->dh] * E1000_RING_DESC_LEN >= core->mac[r->dlen]) {
  610. core->mac[r->dh] = 0;
  611. }
  612. }
  613. static inline uint32_t
  614. igb_ring_free_descr_num(IGBCore *core, const E1000E_RingInfo *r)
  615. {
  616. trace_e1000e_ring_free_space(r->idx, core->mac[r->dlen],
  617. core->mac[r->dh], core->mac[r->dt]);
  618. if (core->mac[r->dh] <= core->mac[r->dt]) {
  619. return core->mac[r->dt] - core->mac[r->dh];
  620. }
  621. if (core->mac[r->dh] > core->mac[r->dt]) {
  622. return core->mac[r->dlen] / E1000_RING_DESC_LEN +
  623. core->mac[r->dt] - core->mac[r->dh];
  624. }
  625. g_assert_not_reached();
  626. return 0;
  627. }
  628. static inline bool
  629. igb_ring_enabled(IGBCore *core, const E1000E_RingInfo *r)
  630. {
  631. return core->mac[r->dlen] > 0;
  632. }
  633. typedef struct IGB_TxRing_st {
  634. const E1000E_RingInfo *i;
  635. struct igb_tx *tx;
  636. } IGB_TxRing;
  637. static inline int
  638. igb_mq_queue_idx(int base_reg_idx, int reg_idx)
  639. {
  640. return (reg_idx - base_reg_idx) / 16;
  641. }
  642. static inline void
  643. igb_tx_ring_init(IGBCore *core, IGB_TxRing *txr, int idx)
  644. {
  645. static const E1000E_RingInfo i[IGB_NUM_QUEUES] = {
  646. { TDBAH0, TDBAL0, TDLEN0, TDH0, TDT0, 0 },
  647. { TDBAH1, TDBAL1, TDLEN1, TDH1, TDT1, 1 },
  648. { TDBAH2, TDBAL2, TDLEN2, TDH2, TDT2, 2 },
  649. { TDBAH3, TDBAL3, TDLEN3, TDH3, TDT3, 3 },
  650. { TDBAH4, TDBAL4, TDLEN4, TDH4, TDT4, 4 },
  651. { TDBAH5, TDBAL5, TDLEN5, TDH5, TDT5, 5 },
  652. { TDBAH6, TDBAL6, TDLEN6, TDH6, TDT6, 6 },
  653. { TDBAH7, TDBAL7, TDLEN7, TDH7, TDT7, 7 },
  654. { TDBAH8, TDBAL8, TDLEN8, TDH8, TDT8, 8 },
  655. { TDBAH9, TDBAL9, TDLEN9, TDH9, TDT9, 9 },
  656. { TDBAH10, TDBAL10, TDLEN10, TDH10, TDT10, 10 },
  657. { TDBAH11, TDBAL11, TDLEN11, TDH11, TDT11, 11 },
  658. { TDBAH12, TDBAL12, TDLEN12, TDH12, TDT12, 12 },
  659. { TDBAH13, TDBAL13, TDLEN13, TDH13, TDT13, 13 },
  660. { TDBAH14, TDBAL14, TDLEN14, TDH14, TDT14, 14 },
  661. { TDBAH15, TDBAL15, TDLEN15, TDH15, TDT15, 15 }
  662. };
  663. assert(idx < ARRAY_SIZE(i));
  664. txr->i = &i[idx];
  665. txr->tx = &core->tx[idx];
  666. }
  667. typedef struct E1000E_RxRing_st {
  668. const E1000E_RingInfo *i;
  669. } E1000E_RxRing;
  670. static inline void
  671. igb_rx_ring_init(IGBCore *core, E1000E_RxRing *rxr, int idx)
  672. {
  673. static const E1000E_RingInfo i[IGB_NUM_QUEUES] = {
  674. { RDBAH0, RDBAL0, RDLEN0, RDH0, RDT0, 0 },
  675. { RDBAH1, RDBAL1, RDLEN1, RDH1, RDT1, 1 },
  676. { RDBAH2, RDBAL2, RDLEN2, RDH2, RDT2, 2 },
  677. { RDBAH3, RDBAL3, RDLEN3, RDH3, RDT3, 3 },
  678. { RDBAH4, RDBAL4, RDLEN4, RDH4, RDT4, 4 },
  679. { RDBAH5, RDBAL5, RDLEN5, RDH5, RDT5, 5 },
  680. { RDBAH6, RDBAL6, RDLEN6, RDH6, RDT6, 6 },
  681. { RDBAH7, RDBAL7, RDLEN7, RDH7, RDT7, 7 },
  682. { RDBAH8, RDBAL8, RDLEN8, RDH8, RDT8, 8 },
  683. { RDBAH9, RDBAL9, RDLEN9, RDH9, RDT9, 9 },
  684. { RDBAH10, RDBAL10, RDLEN10, RDH10, RDT10, 10 },
  685. { RDBAH11, RDBAL11, RDLEN11, RDH11, RDT11, 11 },
  686. { RDBAH12, RDBAL12, RDLEN12, RDH12, RDT12, 12 },
  687. { RDBAH13, RDBAL13, RDLEN13, RDH13, RDT13, 13 },
  688. { RDBAH14, RDBAL14, RDLEN14, RDH14, RDT14, 14 },
  689. { RDBAH15, RDBAL15, RDLEN15, RDH15, RDT15, 15 }
  690. };
  691. assert(idx < ARRAY_SIZE(i));
  692. rxr->i = &i[idx];
  693. }
  694. static uint32_t
  695. igb_txdesc_writeback(IGBCore *core, dma_addr_t base,
  696. union e1000_adv_tx_desc *tx_desc,
  697. const E1000E_RingInfo *txi)
  698. {
  699. PCIDevice *d;
  700. uint32_t cmd_type_len = le32_to_cpu(tx_desc->read.cmd_type_len);
  701. uint64_t tdwba;
  702. tdwba = core->mac[E1000_TDWBAL(txi->idx) >> 2];
  703. tdwba |= (uint64_t)core->mac[E1000_TDWBAH(txi->idx) >> 2] << 32;
  704. if (!(cmd_type_len & E1000_TXD_CMD_RS)) {
  705. return 0;
  706. }
  707. d = pcie_sriov_get_vf_at_index(core->owner, txi->idx % 8);
  708. if (!d) {
  709. d = core->owner;
  710. }
  711. if (tdwba & 1) {
  712. uint32_t buffer = cpu_to_le32(core->mac[txi->dh]);
  713. pci_dma_write(d, tdwba & ~3, &buffer, sizeof(buffer));
  714. } else {
  715. uint32_t status = le32_to_cpu(tx_desc->wb.status) | E1000_TXD_STAT_DD;
  716. tx_desc->wb.status = cpu_to_le32(status);
  717. pci_dma_write(d, base + offsetof(union e1000_adv_tx_desc, wb),
  718. &tx_desc->wb, sizeof(tx_desc->wb));
  719. }
  720. return igb_tx_wb_eic(core, txi->idx);
  721. }
  722. static inline bool
  723. igb_tx_enabled(IGBCore *core, const E1000E_RingInfo *txi)
  724. {
  725. bool vmdq = core->mac[MRQC] & 1;
  726. uint16_t qn = txi->idx;
  727. uint16_t pool = qn % IGB_NUM_VM_POOLS;
  728. return (core->mac[TCTL] & E1000_TCTL_EN) &&
  729. (!vmdq || core->mac[VFTE] & BIT(pool)) &&
  730. (core->mac[TXDCTL0 + (qn * 16)] & E1000_TXDCTL_QUEUE_ENABLE);
  731. }
  732. static void
  733. igb_start_xmit(IGBCore *core, const IGB_TxRing *txr)
  734. {
  735. PCIDevice *d;
  736. dma_addr_t base;
  737. union e1000_adv_tx_desc desc;
  738. const E1000E_RingInfo *txi = txr->i;
  739. uint32_t eic = 0;
  740. if (!igb_tx_enabled(core, txi)) {
  741. trace_e1000e_tx_disabled();
  742. return;
  743. }
  744. d = pcie_sriov_get_vf_at_index(core->owner, txi->idx % 8);
  745. if (!d) {
  746. d = core->owner;
  747. }
  748. while (!igb_ring_empty(core, txi)) {
  749. base = igb_ring_head_descr(core, txi);
  750. pci_dma_read(d, base, &desc, sizeof(desc));
  751. trace_e1000e_tx_descr((void *)(intptr_t)desc.read.buffer_addr,
  752. desc.read.cmd_type_len, desc.wb.status);
  753. igb_process_tx_desc(core, d, txr->tx, &desc, txi->idx);
  754. igb_ring_advance(core, txi, 1);
  755. eic |= igb_txdesc_writeback(core, base, &desc, txi);
  756. }
  757. if (eic) {
  758. igb_raise_interrupts(core, EICR, eic);
  759. igb_raise_interrupts(core, ICR, E1000_ICR_TXDW);
  760. }
  761. net_tx_pkt_reset(txr->tx->tx_pkt, net_tx_pkt_unmap_frag_pci, d);
  762. }
  763. static uint32_t
  764. igb_rxbufsize(IGBCore *core, const E1000E_RingInfo *r)
  765. {
  766. uint32_t srrctl = core->mac[E1000_SRRCTL(r->idx) >> 2];
  767. uint32_t bsizepkt = srrctl & E1000_SRRCTL_BSIZEPKT_MASK;
  768. if (bsizepkt) {
  769. return bsizepkt << E1000_SRRCTL_BSIZEPKT_SHIFT;
  770. }
  771. return e1000x_rxbufsize(core->mac[RCTL]);
  772. }
  773. static bool
  774. igb_has_rxbufs(IGBCore *core, const E1000E_RingInfo *r, size_t total_size)
  775. {
  776. uint32_t bufs = igb_ring_free_descr_num(core, r);
  777. uint32_t bufsize = igb_rxbufsize(core, r);
  778. trace_e1000e_rx_has_buffers(r->idx, bufs, total_size, bufsize);
  779. return total_size <= bufs / (core->rx_desc_len / E1000_MIN_RX_DESC_LEN) *
  780. bufsize;
  781. }
  782. void
  783. igb_start_recv(IGBCore *core)
  784. {
  785. int i;
  786. trace_e1000e_rx_start_recv();
  787. for (i = 0; i <= core->max_queue_num; i++) {
  788. qemu_flush_queued_packets(qemu_get_subqueue(core->owner_nic, i));
  789. }
  790. }
  791. bool
  792. igb_can_receive(IGBCore *core)
  793. {
  794. int i;
  795. if (!e1000x_rx_ready(core->owner, core->mac)) {
  796. return false;
  797. }
  798. for (i = 0; i < IGB_NUM_QUEUES; i++) {
  799. E1000E_RxRing rxr;
  800. if (!(core->mac[RXDCTL0 + (i * 16)] & E1000_RXDCTL_QUEUE_ENABLE)) {
  801. continue;
  802. }
  803. igb_rx_ring_init(core, &rxr, i);
  804. if (igb_ring_enabled(core, rxr.i) && igb_has_rxbufs(core, rxr.i, 1)) {
  805. trace_e1000e_rx_can_recv();
  806. return true;
  807. }
  808. }
  809. trace_e1000e_rx_can_recv_rings_full();
  810. return false;
  811. }
  812. ssize_t
  813. igb_receive(IGBCore *core, const uint8_t *buf, size_t size)
  814. {
  815. const struct iovec iov = {
  816. .iov_base = (uint8_t *)buf,
  817. .iov_len = size
  818. };
  819. return igb_receive_iov(core, &iov, 1);
  820. }
  821. static inline bool
  822. igb_rx_l3_cso_enabled(IGBCore *core)
  823. {
  824. return !!(core->mac[RXCSUM] & E1000_RXCSUM_IPOFLD);
  825. }
  826. static inline bool
  827. igb_rx_l4_cso_enabled(IGBCore *core)
  828. {
  829. return !!(core->mac[RXCSUM] & E1000_RXCSUM_TUOFLD);
  830. }
  831. static bool igb_rx_is_oversized(IGBCore *core, const struct eth_header *ehdr,
  832. size_t size, size_t vlan_num,
  833. bool lpe, uint16_t rlpml)
  834. {
  835. size_t vlan_header_size = sizeof(struct vlan_header) * vlan_num;
  836. size_t header_size = sizeof(struct eth_header) + vlan_header_size;
  837. return lpe ? size + ETH_FCS_LEN > rlpml : size > header_size + ETH_MTU;
  838. }
  839. static uint16_t igb_receive_assign(IGBCore *core, const struct iovec *iov,
  840. size_t iovcnt, size_t iov_ofs,
  841. const L2Header *l2_header, size_t size,
  842. E1000E_RSSInfo *rss_info,
  843. uint16_t *etqf, bool *ts, bool *external_tx)
  844. {
  845. static const int ta_shift[] = { 4, 3, 2, 0 };
  846. const struct eth_header *ehdr = &l2_header->eth;
  847. uint32_t f, ra[2], *macp, rctl = core->mac[RCTL];
  848. uint16_t queues = 0;
  849. uint16_t oversized = 0;
  850. size_t vlan_num = 0;
  851. PTP2 ptp2;
  852. bool lpe;
  853. uint16_t rlpml;
  854. int i;
  855. memset(rss_info, 0, sizeof(E1000E_RSSInfo));
  856. *ts = false;
  857. if (external_tx) {
  858. *external_tx = true;
  859. }
  860. if (core->mac[CTRL_EXT] & BIT(26)) {
  861. if (be16_to_cpu(ehdr->h_proto) == core->mac[VET] >> 16 &&
  862. be16_to_cpu(l2_header->vlan[0].h_proto) == (core->mac[VET] & 0xffff)) {
  863. vlan_num = 2;
  864. }
  865. } else {
  866. if (be16_to_cpu(ehdr->h_proto) == (core->mac[VET] & 0xffff)) {
  867. vlan_num = 1;
  868. }
  869. }
  870. lpe = !!(core->mac[RCTL] & E1000_RCTL_LPE);
  871. rlpml = core->mac[RLPML];
  872. if (!(core->mac[RCTL] & E1000_RCTL_SBP) &&
  873. igb_rx_is_oversized(core, ehdr, size, vlan_num, lpe, rlpml)) {
  874. trace_e1000x_rx_oversized(size);
  875. return queues;
  876. }
  877. for (*etqf = 0; *etqf < 8; (*etqf)++) {
  878. if ((core->mac[ETQF0 + *etqf] & E1000_ETQF_FILTER_ENABLE) &&
  879. be16_to_cpu(ehdr->h_proto) == (core->mac[ETQF0 + *etqf] & E1000_ETQF_ETYPE_MASK)) {
  880. if ((core->mac[ETQF0 + *etqf] & E1000_ETQF_1588) &&
  881. (core->mac[TSYNCRXCTL] & E1000_TSYNCRXCTL_ENABLED) &&
  882. !(core->mac[TSYNCRXCTL] & E1000_TSYNCRXCTL_VALID) &&
  883. iov_to_buf(iov, iovcnt, iov_ofs + ETH_HLEN, &ptp2, sizeof(ptp2)) >= sizeof(ptp2) &&
  884. (ptp2.version_ptp & 15) == 2 &&
  885. ptp2.message_id_transport_specific == ((core->mac[TSYNCRXCFG] >> 8) & 255)) {
  886. e1000x_timestamp(core->mac, core->timadj, RXSTMPL, RXSTMPH);
  887. *ts = true;
  888. core->mac[TSYNCRXCTL] |= E1000_TSYNCRXCTL_VALID;
  889. core->mac[RXSATRL] = le32_to_cpu(ptp2.source_uuid_lo);
  890. core->mac[RXSATRH] = le16_to_cpu(ptp2.source_uuid_hi) |
  891. (le16_to_cpu(ptp2.sequence_id) << 16);
  892. }
  893. break;
  894. }
  895. }
  896. if (vlan_num &&
  897. !e1000x_rx_vlan_filter(core->mac, l2_header->vlan + vlan_num - 1)) {
  898. return queues;
  899. }
  900. if (core->mac[MRQC] & 1) {
  901. if (is_broadcast_ether_addr(ehdr->h_dest)) {
  902. for (i = 0; i < IGB_NUM_VM_POOLS; i++) {
  903. if (core->mac[VMOLR0 + i] & E1000_VMOLR_BAM) {
  904. queues |= BIT(i);
  905. }
  906. }
  907. } else {
  908. for (macp = core->mac + RA; macp < core->mac + RA + 32; macp += 2) {
  909. if (!(macp[1] & E1000_RAH_AV)) {
  910. continue;
  911. }
  912. ra[0] = cpu_to_le32(macp[0]);
  913. ra[1] = cpu_to_le32(macp[1]);
  914. if (!memcmp(ehdr->h_dest, (uint8_t *)ra, ETH_ALEN)) {
  915. queues |= (macp[1] & E1000_RAH_POOL_MASK) / E1000_RAH_POOL_1;
  916. }
  917. }
  918. for (macp = core->mac + RA2; macp < core->mac + RA2 + 16; macp += 2) {
  919. if (!(macp[1] & E1000_RAH_AV)) {
  920. continue;
  921. }
  922. ra[0] = cpu_to_le32(macp[0]);
  923. ra[1] = cpu_to_le32(macp[1]);
  924. if (!memcmp(ehdr->h_dest, (uint8_t *)ra, ETH_ALEN)) {
  925. queues |= (macp[1] & E1000_RAH_POOL_MASK) / E1000_RAH_POOL_1;
  926. }
  927. }
  928. if (!queues) {
  929. macp = core->mac + (is_multicast_ether_addr(ehdr->h_dest) ? MTA : UTA);
  930. f = ta_shift[(rctl >> E1000_RCTL_MO_SHIFT) & 3];
  931. f = (((ehdr->h_dest[5] << 8) | ehdr->h_dest[4]) >> f) & 0xfff;
  932. if (macp[f >> 5] & (1 << (f & 0x1f))) {
  933. for (i = 0; i < IGB_NUM_VM_POOLS; i++) {
  934. if (core->mac[VMOLR0 + i] & E1000_VMOLR_ROMPE) {
  935. queues |= BIT(i);
  936. }
  937. }
  938. }
  939. } else if (is_unicast_ether_addr(ehdr->h_dest) && external_tx) {
  940. *external_tx = false;
  941. }
  942. }
  943. if (e1000x_vlan_rx_filter_enabled(core->mac)) {
  944. uint16_t mask = 0;
  945. if (vlan_num) {
  946. uint16_t vid = be16_to_cpu(l2_header->vlan[vlan_num - 1].h_tci) & VLAN_VID_MASK;
  947. for (i = 0; i < E1000_VLVF_ARRAY_SIZE; i++) {
  948. if ((core->mac[VLVF0 + i] & E1000_VLVF_VLANID_MASK) == vid &&
  949. (core->mac[VLVF0 + i] & E1000_VLVF_VLANID_ENABLE)) {
  950. uint32_t poolsel = core->mac[VLVF0 + i] & E1000_VLVF_POOLSEL_MASK;
  951. mask |= poolsel >> E1000_VLVF_POOLSEL_SHIFT;
  952. }
  953. }
  954. } else {
  955. for (i = 0; i < IGB_NUM_VM_POOLS; i++) {
  956. if (core->mac[VMOLR0 + i] & E1000_VMOLR_AUPE) {
  957. mask |= BIT(i);
  958. }
  959. }
  960. }
  961. queues &= mask;
  962. }
  963. if (is_unicast_ether_addr(ehdr->h_dest) && !queues && !external_tx &&
  964. !(core->mac[VT_CTL] & E1000_VT_CTL_DISABLE_DEF_POOL)) {
  965. uint32_t def_pl = core->mac[VT_CTL] & E1000_VT_CTL_DEFAULT_POOL_MASK;
  966. queues = BIT(def_pl >> E1000_VT_CTL_DEFAULT_POOL_SHIFT);
  967. }
  968. queues &= core->mac[VFRE];
  969. if (queues) {
  970. for (i = 0; i < IGB_NUM_VM_POOLS; i++) {
  971. lpe = !!(core->mac[VMOLR0 + i] & E1000_VMOLR_LPE);
  972. rlpml = core->mac[VMOLR0 + i] & E1000_VMOLR_RLPML_MASK;
  973. if ((queues & BIT(i)) &&
  974. igb_rx_is_oversized(core, ehdr, size, vlan_num,
  975. lpe, rlpml)) {
  976. oversized |= BIT(i);
  977. }
  978. }
  979. /* 8.19.37 increment ROC if packet is oversized for all queues */
  980. if (oversized == queues) {
  981. trace_e1000x_rx_oversized(size);
  982. e1000x_inc_reg_if_not_full(core->mac, ROC);
  983. }
  984. queues &= ~oversized;
  985. }
  986. if (queues) {
  987. igb_rss_parse_packet(core, core->rx_pkt,
  988. external_tx != NULL, rss_info);
  989. /* Sec 8.26.1: PQn = VFn + VQn*8 */
  990. if (rss_info->queue & 1) {
  991. for (i = 0; i < IGB_NUM_VM_POOLS; i++) {
  992. if ((queues & BIT(i)) &&
  993. (core->mac[VMOLR0 + i] & E1000_VMOLR_RSSE)) {
  994. queues |= BIT(i + IGB_NUM_VM_POOLS);
  995. queues &= ~BIT(i);
  996. }
  997. }
  998. }
  999. }
  1000. } else {
  1001. bool accepted = e1000x_rx_group_filter(core->mac, ehdr);
  1002. if (!accepted) {
  1003. for (macp = core->mac + RA2; macp < core->mac + RA2 + 16; macp += 2) {
  1004. if (!(macp[1] & E1000_RAH_AV)) {
  1005. continue;
  1006. }
  1007. ra[0] = cpu_to_le32(macp[0]);
  1008. ra[1] = cpu_to_le32(macp[1]);
  1009. if (!memcmp(ehdr->h_dest, (uint8_t *)ra, ETH_ALEN)) {
  1010. trace_e1000x_rx_flt_ucast_match((int)(macp - core->mac - RA2) / 2,
  1011. MAC_ARG(ehdr->h_dest));
  1012. accepted = true;
  1013. break;
  1014. }
  1015. }
  1016. }
  1017. if (accepted) {
  1018. igb_rss_parse_packet(core, core->rx_pkt, false, rss_info);
  1019. queues = BIT(rss_info->queue);
  1020. }
  1021. }
  1022. return queues;
  1023. }
  1024. static inline void
  1025. igb_read_lgcy_rx_descr(IGBCore *core, struct e1000_rx_desc *desc,
  1026. hwaddr *buff_addr)
  1027. {
  1028. *buff_addr = le64_to_cpu(desc->buffer_addr);
  1029. }
  1030. static inline void
  1031. igb_read_adv_rx_descr(IGBCore *core, union e1000_adv_rx_desc *desc,
  1032. hwaddr *buff_addr)
  1033. {
  1034. *buff_addr = le64_to_cpu(desc->read.pkt_addr);
  1035. }
  1036. static inline void
  1037. igb_read_rx_descr(IGBCore *core, union e1000_rx_desc_union *desc,
  1038. hwaddr *buff_addr)
  1039. {
  1040. if (igb_rx_use_legacy_descriptor(core)) {
  1041. igb_read_lgcy_rx_descr(core, &desc->legacy, buff_addr);
  1042. } else {
  1043. igb_read_adv_rx_descr(core, &desc->adv, buff_addr);
  1044. }
  1045. }
  1046. static void
  1047. igb_verify_csum_in_sw(IGBCore *core,
  1048. struct NetRxPkt *pkt,
  1049. uint32_t *status_flags,
  1050. EthL4HdrProto l4hdr_proto)
  1051. {
  1052. bool csum_valid;
  1053. uint32_t csum_error;
  1054. if (igb_rx_l3_cso_enabled(core)) {
  1055. if (!net_rx_pkt_validate_l3_csum(pkt, &csum_valid)) {
  1056. trace_e1000e_rx_metadata_l3_csum_validation_failed();
  1057. } else {
  1058. csum_error = csum_valid ? 0 : E1000_RXDEXT_STATERR_IPE;
  1059. *status_flags |= E1000_RXD_STAT_IPCS | csum_error;
  1060. }
  1061. } else {
  1062. trace_e1000e_rx_metadata_l3_cso_disabled();
  1063. }
  1064. if (!igb_rx_l4_cso_enabled(core)) {
  1065. trace_e1000e_rx_metadata_l4_cso_disabled();
  1066. return;
  1067. }
  1068. if (!net_rx_pkt_validate_l4_csum(pkt, &csum_valid)) {
  1069. trace_e1000e_rx_metadata_l4_csum_validation_failed();
  1070. return;
  1071. }
  1072. csum_error = csum_valid ? 0 : E1000_RXDEXT_STATERR_TCPE;
  1073. *status_flags |= E1000_RXD_STAT_TCPCS | csum_error;
  1074. if (l4hdr_proto == ETH_L4_HDR_PROTO_UDP) {
  1075. *status_flags |= E1000_RXD_STAT_UDPCS;
  1076. }
  1077. }
  1078. static void
  1079. igb_build_rx_metadata(IGBCore *core,
  1080. struct NetRxPkt *pkt,
  1081. bool is_eop,
  1082. const E1000E_RSSInfo *rss_info, uint16_t etqf, bool ts,
  1083. uint16_t *pkt_info, uint16_t *hdr_info,
  1084. uint32_t *rss,
  1085. uint32_t *status_flags,
  1086. uint16_t *ip_id,
  1087. uint16_t *vlan_tag)
  1088. {
  1089. struct virtio_net_hdr *vhdr;
  1090. bool hasip4, hasip6, csum_valid;
  1091. EthL4HdrProto l4hdr_proto;
  1092. *status_flags = E1000_RXD_STAT_DD;
  1093. /* No additional metadata needed for non-EOP descriptors */
  1094. /* TODO: EOP apply only to status so don't skip whole function. */
  1095. if (!is_eop) {
  1096. goto func_exit;
  1097. }
  1098. *status_flags |= E1000_RXD_STAT_EOP;
  1099. net_rx_pkt_get_protocols(pkt, &hasip4, &hasip6, &l4hdr_proto);
  1100. trace_e1000e_rx_metadata_protocols(hasip4, hasip6, l4hdr_proto);
  1101. /* VLAN state */
  1102. if (net_rx_pkt_is_vlan_stripped(pkt)) {
  1103. *status_flags |= E1000_RXD_STAT_VP;
  1104. *vlan_tag = cpu_to_le16(net_rx_pkt_get_vlan_tag(pkt));
  1105. trace_e1000e_rx_metadata_vlan(*vlan_tag);
  1106. }
  1107. /* Packet parsing results */
  1108. if ((core->mac[RXCSUM] & E1000_RXCSUM_PCSD) != 0) {
  1109. if (rss_info->enabled) {
  1110. *rss = cpu_to_le32(rss_info->hash);
  1111. trace_igb_rx_metadata_rss(*rss);
  1112. }
  1113. } else if (hasip4) {
  1114. *status_flags |= E1000_RXD_STAT_IPIDV;
  1115. *ip_id = cpu_to_le16(net_rx_pkt_get_ip_id(pkt));
  1116. trace_e1000e_rx_metadata_ip_id(*ip_id);
  1117. }
  1118. if (l4hdr_proto == ETH_L4_HDR_PROTO_TCP && net_rx_pkt_is_tcp_ack(pkt)) {
  1119. *status_flags |= E1000_RXD_STAT_ACK;
  1120. trace_e1000e_rx_metadata_ack();
  1121. }
  1122. if (pkt_info) {
  1123. *pkt_info = rss_info->enabled ? rss_info->type : 0;
  1124. if (etqf < 8) {
  1125. *pkt_info |= (BIT(11) | etqf) << 4;
  1126. } else {
  1127. if (hasip4) {
  1128. *pkt_info |= E1000_ADVRXD_PKT_IP4;
  1129. }
  1130. if (hasip6) {
  1131. *pkt_info |= E1000_ADVRXD_PKT_IP6;
  1132. }
  1133. switch (l4hdr_proto) {
  1134. case ETH_L4_HDR_PROTO_TCP:
  1135. *pkt_info |= E1000_ADVRXD_PKT_TCP;
  1136. break;
  1137. case ETH_L4_HDR_PROTO_UDP:
  1138. *pkt_info |= E1000_ADVRXD_PKT_UDP;
  1139. break;
  1140. case ETH_L4_HDR_PROTO_SCTP:
  1141. *pkt_info |= E1000_ADVRXD_PKT_SCTP;
  1142. break;
  1143. default:
  1144. break;
  1145. }
  1146. }
  1147. }
  1148. if (hdr_info) {
  1149. *hdr_info = 0;
  1150. }
  1151. if (ts) {
  1152. *status_flags |= BIT(16);
  1153. }
  1154. /* RX CSO information */
  1155. if (hasip6 && (core->mac[RFCTL] & E1000_RFCTL_IPV6_XSUM_DIS)) {
  1156. trace_e1000e_rx_metadata_ipv6_sum_disabled();
  1157. goto func_exit;
  1158. }
  1159. vhdr = net_rx_pkt_get_vhdr(pkt);
  1160. if (!(vhdr->flags & VIRTIO_NET_HDR_F_DATA_VALID) &&
  1161. !(vhdr->flags & VIRTIO_NET_HDR_F_NEEDS_CSUM)) {
  1162. trace_e1000e_rx_metadata_virthdr_no_csum_info();
  1163. igb_verify_csum_in_sw(core, pkt, status_flags, l4hdr_proto);
  1164. goto func_exit;
  1165. }
  1166. if (igb_rx_l3_cso_enabled(core)) {
  1167. *status_flags |= hasip4 ? E1000_RXD_STAT_IPCS : 0;
  1168. } else {
  1169. trace_e1000e_rx_metadata_l3_cso_disabled();
  1170. }
  1171. if (igb_rx_l4_cso_enabled(core)) {
  1172. switch (l4hdr_proto) {
  1173. case ETH_L4_HDR_PROTO_SCTP:
  1174. if (!net_rx_pkt_validate_l4_csum(pkt, &csum_valid)) {
  1175. trace_e1000e_rx_metadata_l4_csum_validation_failed();
  1176. goto func_exit;
  1177. }
  1178. if (!csum_valid) {
  1179. *status_flags |= E1000_RXDEXT_STATERR_TCPE;
  1180. }
  1181. /* fall through */
  1182. case ETH_L4_HDR_PROTO_TCP:
  1183. *status_flags |= E1000_RXD_STAT_TCPCS;
  1184. break;
  1185. case ETH_L4_HDR_PROTO_UDP:
  1186. *status_flags |= E1000_RXD_STAT_TCPCS | E1000_RXD_STAT_UDPCS;
  1187. break;
  1188. default:
  1189. break;
  1190. }
  1191. } else {
  1192. trace_e1000e_rx_metadata_l4_cso_disabled();
  1193. }
  1194. func_exit:
  1195. trace_e1000e_rx_metadata_status_flags(*status_flags);
  1196. *status_flags = cpu_to_le32(*status_flags);
  1197. }
  1198. static inline void
  1199. igb_write_lgcy_rx_descr(IGBCore *core, struct e1000_rx_desc *desc,
  1200. struct NetRxPkt *pkt,
  1201. const E1000E_RSSInfo *rss_info, uint16_t etqf, bool ts,
  1202. uint16_t length)
  1203. {
  1204. uint32_t status_flags, rss;
  1205. uint16_t ip_id;
  1206. assert(!rss_info->enabled);
  1207. desc->length = cpu_to_le16(length);
  1208. desc->csum = 0;
  1209. igb_build_rx_metadata(core, pkt, pkt != NULL,
  1210. rss_info, etqf, ts,
  1211. NULL, NULL, &rss,
  1212. &status_flags, &ip_id,
  1213. &desc->special);
  1214. desc->errors = (uint8_t) (le32_to_cpu(status_flags) >> 24);
  1215. desc->status = (uint8_t) le32_to_cpu(status_flags);
  1216. }
  1217. static inline void
  1218. igb_write_adv_rx_descr(IGBCore *core, union e1000_adv_rx_desc *desc,
  1219. struct NetRxPkt *pkt,
  1220. const E1000E_RSSInfo *rss_info, uint16_t etqf, bool ts,
  1221. uint16_t length)
  1222. {
  1223. memset(&desc->wb, 0, sizeof(desc->wb));
  1224. desc->wb.upper.length = cpu_to_le16(length);
  1225. igb_build_rx_metadata(core, pkt, pkt != NULL,
  1226. rss_info, etqf, ts,
  1227. &desc->wb.lower.lo_dword.pkt_info,
  1228. &desc->wb.lower.lo_dword.hdr_info,
  1229. &desc->wb.lower.hi_dword.rss,
  1230. &desc->wb.upper.status_error,
  1231. &desc->wb.lower.hi_dword.csum_ip.ip_id,
  1232. &desc->wb.upper.vlan);
  1233. }
  1234. static inline void
  1235. igb_write_rx_descr(IGBCore *core, union e1000_rx_desc_union *desc,
  1236. struct NetRxPkt *pkt, const E1000E_RSSInfo *rss_info,
  1237. uint16_t etqf, bool ts, uint16_t length)
  1238. {
  1239. if (igb_rx_use_legacy_descriptor(core)) {
  1240. igb_write_lgcy_rx_descr(core, &desc->legacy, pkt, rss_info,
  1241. etqf, ts, length);
  1242. } else {
  1243. igb_write_adv_rx_descr(core, &desc->adv, pkt, rss_info,
  1244. etqf, ts, length);
  1245. }
  1246. }
  1247. static inline void
  1248. igb_pci_dma_write_rx_desc(IGBCore *core, PCIDevice *dev, dma_addr_t addr,
  1249. union e1000_rx_desc_union *desc, dma_addr_t len)
  1250. {
  1251. if (igb_rx_use_legacy_descriptor(core)) {
  1252. struct e1000_rx_desc *d = &desc->legacy;
  1253. size_t offset = offsetof(struct e1000_rx_desc, status);
  1254. uint8_t status = d->status;
  1255. d->status &= ~E1000_RXD_STAT_DD;
  1256. pci_dma_write(dev, addr, desc, len);
  1257. if (status & E1000_RXD_STAT_DD) {
  1258. d->status = status;
  1259. pci_dma_write(dev, addr + offset, &status, sizeof(status));
  1260. }
  1261. } else {
  1262. union e1000_adv_rx_desc *d = &desc->adv;
  1263. size_t offset =
  1264. offsetof(union e1000_adv_rx_desc, wb.upper.status_error);
  1265. uint32_t status = d->wb.upper.status_error;
  1266. d->wb.upper.status_error &= ~E1000_RXD_STAT_DD;
  1267. pci_dma_write(dev, addr, desc, len);
  1268. if (status & E1000_RXD_STAT_DD) {
  1269. d->wb.upper.status_error = status;
  1270. pci_dma_write(dev, addr + offset, &status, sizeof(status));
  1271. }
  1272. }
  1273. }
  1274. static void
  1275. igb_write_to_rx_buffers(IGBCore *core,
  1276. PCIDevice *d,
  1277. hwaddr ba,
  1278. uint16_t *written,
  1279. const char *data,
  1280. dma_addr_t data_len)
  1281. {
  1282. trace_igb_rx_desc_buff_write(ba, *written, data, data_len);
  1283. pci_dma_write(d, ba + *written, data, data_len);
  1284. *written += data_len;
  1285. }
  1286. static void
  1287. igb_update_rx_stats(IGBCore *core, const E1000E_RingInfo *rxi,
  1288. size_t pkt_size, size_t pkt_fcs_size)
  1289. {
  1290. eth_pkt_types_e pkt_type = net_rx_pkt_get_packet_type(core->rx_pkt);
  1291. e1000x_update_rx_total_stats(core->mac, pkt_type, pkt_size, pkt_fcs_size);
  1292. if (core->mac[MRQC] & 1) {
  1293. uint16_t pool = rxi->idx % IGB_NUM_VM_POOLS;
  1294. core->mac[PVFGORC0 + (pool * 64)] += pkt_size + 4;
  1295. core->mac[PVFGPRC0 + (pool * 64)]++;
  1296. if (pkt_type == ETH_PKT_MCAST) {
  1297. core->mac[PVFMPRC0 + (pool * 64)]++;
  1298. }
  1299. }
  1300. }
  1301. static inline bool
  1302. igb_rx_descr_threshold_hit(IGBCore *core, const E1000E_RingInfo *rxi)
  1303. {
  1304. return igb_ring_free_descr_num(core, rxi) ==
  1305. ((core->mac[E1000_SRRCTL(rxi->idx) >> 2] >> 20) & 31) * 16;
  1306. }
  1307. static void
  1308. igb_write_packet_to_guest(IGBCore *core, struct NetRxPkt *pkt,
  1309. const E1000E_RxRing *rxr,
  1310. const E1000E_RSSInfo *rss_info,
  1311. uint16_t etqf, bool ts)
  1312. {
  1313. PCIDevice *d;
  1314. dma_addr_t base;
  1315. union e1000_rx_desc_union desc;
  1316. size_t desc_size;
  1317. size_t desc_offset = 0;
  1318. size_t iov_ofs = 0;
  1319. struct iovec *iov = net_rx_pkt_get_iovec(pkt);
  1320. size_t size = net_rx_pkt_get_total_len(pkt);
  1321. size_t total_size = size + e1000x_fcs_len(core->mac);
  1322. const E1000E_RingInfo *rxi = rxr->i;
  1323. size_t bufsize = igb_rxbufsize(core, rxi);
  1324. d = pcie_sriov_get_vf_at_index(core->owner, rxi->idx % 8);
  1325. if (!d) {
  1326. d = core->owner;
  1327. }
  1328. do {
  1329. hwaddr ba;
  1330. uint16_t written = 0;
  1331. bool is_last = false;
  1332. desc_size = total_size - desc_offset;
  1333. if (desc_size > bufsize) {
  1334. desc_size = bufsize;
  1335. }
  1336. if (igb_ring_empty(core, rxi)) {
  1337. return;
  1338. }
  1339. base = igb_ring_head_descr(core, rxi);
  1340. pci_dma_read(d, base, &desc, core->rx_desc_len);
  1341. trace_e1000e_rx_descr(rxi->idx, base, core->rx_desc_len);
  1342. igb_read_rx_descr(core, &desc, &ba);
  1343. if (ba) {
  1344. if (desc_offset < size) {
  1345. static const uint32_t fcs_pad;
  1346. size_t iov_copy;
  1347. size_t copy_size = size - desc_offset;
  1348. if (copy_size > bufsize) {
  1349. copy_size = bufsize;
  1350. }
  1351. /* Copy packet payload */
  1352. while (copy_size) {
  1353. iov_copy = MIN(copy_size, iov->iov_len - iov_ofs);
  1354. igb_write_to_rx_buffers(core, d, ba, &written,
  1355. iov->iov_base + iov_ofs, iov_copy);
  1356. copy_size -= iov_copy;
  1357. iov_ofs += iov_copy;
  1358. if (iov_ofs == iov->iov_len) {
  1359. iov++;
  1360. iov_ofs = 0;
  1361. }
  1362. }
  1363. if (desc_offset + desc_size >= total_size) {
  1364. /* Simulate FCS checksum presence in the last descriptor */
  1365. igb_write_to_rx_buffers(core, d, ba, &written,
  1366. (const char *) &fcs_pad, e1000x_fcs_len(core->mac));
  1367. }
  1368. }
  1369. } else { /* as per intel docs; skip descriptors with null buf addr */
  1370. trace_e1000e_rx_null_descriptor();
  1371. }
  1372. desc_offset += desc_size;
  1373. if (desc_offset >= total_size) {
  1374. is_last = true;
  1375. }
  1376. igb_write_rx_descr(core, &desc, is_last ? core->rx_pkt : NULL,
  1377. rss_info, etqf, ts, written);
  1378. igb_pci_dma_write_rx_desc(core, d, base, &desc, core->rx_desc_len);
  1379. igb_ring_advance(core, rxi, core->rx_desc_len / E1000_MIN_RX_DESC_LEN);
  1380. } while (desc_offset < total_size);
  1381. igb_update_rx_stats(core, rxi, size, total_size);
  1382. }
  1383. static bool
  1384. igb_rx_strip_vlan(IGBCore *core, const E1000E_RingInfo *rxi)
  1385. {
  1386. if (core->mac[MRQC] & 1) {
  1387. uint16_t pool = rxi->idx % IGB_NUM_VM_POOLS;
  1388. /* Sec 7.10.3.8: CTRL.VME is ignored, only VMOLR/RPLOLR is used */
  1389. return (net_rx_pkt_get_packet_type(core->rx_pkt) == ETH_PKT_MCAST) ?
  1390. core->mac[RPLOLR] & E1000_RPLOLR_STRVLAN :
  1391. core->mac[VMOLR0 + pool] & E1000_VMOLR_STRVLAN;
  1392. }
  1393. return e1000x_vlan_enabled(core->mac);
  1394. }
  1395. static inline void
  1396. igb_rx_fix_l4_csum(IGBCore *core, struct NetRxPkt *pkt)
  1397. {
  1398. struct virtio_net_hdr *vhdr = net_rx_pkt_get_vhdr(pkt);
  1399. if (vhdr->flags & VIRTIO_NET_HDR_F_NEEDS_CSUM) {
  1400. net_rx_pkt_fix_l4_csum(pkt);
  1401. }
  1402. }
  1403. ssize_t
  1404. igb_receive_iov(IGBCore *core, const struct iovec *iov, int iovcnt)
  1405. {
  1406. return igb_receive_internal(core, iov, iovcnt, core->has_vnet, NULL);
  1407. }
  1408. static ssize_t
  1409. igb_receive_internal(IGBCore *core, const struct iovec *iov, int iovcnt,
  1410. bool has_vnet, bool *external_tx)
  1411. {
  1412. uint16_t queues = 0;
  1413. uint32_t causes = 0;
  1414. uint32_t ecauses = 0;
  1415. union {
  1416. L2Header l2_header;
  1417. uint8_t octets[ETH_ZLEN];
  1418. } buf;
  1419. struct iovec min_iov;
  1420. size_t size, orig_size;
  1421. size_t iov_ofs = 0;
  1422. E1000E_RxRing rxr;
  1423. E1000E_RSSInfo rss_info;
  1424. uint16_t etqf;
  1425. bool ts;
  1426. size_t total_size;
  1427. int strip_vlan_index;
  1428. int i;
  1429. trace_e1000e_rx_receive_iov(iovcnt);
  1430. if (external_tx) {
  1431. *external_tx = true;
  1432. }
  1433. if (!e1000x_hw_rx_enabled(core->mac)) {
  1434. return -1;
  1435. }
  1436. /* Pull virtio header in */
  1437. if (has_vnet) {
  1438. net_rx_pkt_set_vhdr_iovec(core->rx_pkt, iov, iovcnt);
  1439. iov_ofs = sizeof(struct virtio_net_hdr);
  1440. } else {
  1441. net_rx_pkt_unset_vhdr(core->rx_pkt);
  1442. }
  1443. orig_size = iov_size(iov, iovcnt);
  1444. size = orig_size - iov_ofs;
  1445. /* Pad to minimum Ethernet frame length */
  1446. if (size < sizeof(buf)) {
  1447. iov_to_buf(iov, iovcnt, iov_ofs, &buf, size);
  1448. memset(&buf.octets[size], 0, sizeof(buf) - size);
  1449. e1000x_inc_reg_if_not_full(core->mac, RUC);
  1450. min_iov.iov_base = &buf;
  1451. min_iov.iov_len = size = sizeof(buf);
  1452. iovcnt = 1;
  1453. iov = &min_iov;
  1454. iov_ofs = 0;
  1455. } else {
  1456. iov_to_buf(iov, iovcnt, iov_ofs, &buf, sizeof(buf.l2_header));
  1457. }
  1458. net_rx_pkt_set_packet_type(core->rx_pkt,
  1459. get_eth_packet_type(&buf.l2_header.eth));
  1460. net_rx_pkt_set_protocols(core->rx_pkt, iov, iovcnt, iov_ofs);
  1461. queues = igb_receive_assign(core, iov, iovcnt, iov_ofs,
  1462. &buf.l2_header, size,
  1463. &rss_info, &etqf, &ts, external_tx);
  1464. if (!queues) {
  1465. trace_e1000e_rx_flt_dropped();
  1466. return orig_size;
  1467. }
  1468. for (i = 0; i < IGB_NUM_QUEUES; i++) {
  1469. if (!(queues & BIT(i)) ||
  1470. !(core->mac[RXDCTL0 + (i * 16)] & E1000_RXDCTL_QUEUE_ENABLE)) {
  1471. continue;
  1472. }
  1473. igb_rx_ring_init(core, &rxr, i);
  1474. if (!igb_rx_strip_vlan(core, rxr.i)) {
  1475. strip_vlan_index = -1;
  1476. } else if (core->mac[CTRL_EXT] & BIT(26)) {
  1477. strip_vlan_index = 1;
  1478. } else {
  1479. strip_vlan_index = 0;
  1480. }
  1481. net_rx_pkt_attach_iovec_ex(core->rx_pkt, iov, iovcnt, iov_ofs,
  1482. strip_vlan_index,
  1483. core->mac[VET] & 0xffff,
  1484. core->mac[VET] >> 16);
  1485. total_size = net_rx_pkt_get_total_len(core->rx_pkt) +
  1486. e1000x_fcs_len(core->mac);
  1487. if (!igb_has_rxbufs(core, rxr.i, total_size)) {
  1488. causes |= E1000_ICS_RXO;
  1489. trace_e1000e_rx_not_written_to_guest(rxr.i->idx);
  1490. continue;
  1491. }
  1492. causes |= E1000_ICR_RXDW;
  1493. igb_rx_fix_l4_csum(core, core->rx_pkt);
  1494. igb_write_packet_to_guest(core, core->rx_pkt, &rxr, &rss_info, etqf, ts);
  1495. /* Check if receive descriptor minimum threshold hit */
  1496. if (igb_rx_descr_threshold_hit(core, rxr.i)) {
  1497. causes |= E1000_ICS_RXDMT0;
  1498. }
  1499. ecauses |= igb_rx_wb_eic(core, rxr.i->idx);
  1500. trace_e1000e_rx_written_to_guest(rxr.i->idx);
  1501. }
  1502. trace_e1000e_rx_interrupt_set(causes);
  1503. igb_raise_interrupts(core, EICR, ecauses);
  1504. igb_raise_interrupts(core, ICR, causes);
  1505. return orig_size;
  1506. }
  1507. static inline bool
  1508. igb_have_autoneg(IGBCore *core)
  1509. {
  1510. return core->phy[MII_BMCR] & MII_BMCR_AUTOEN;
  1511. }
  1512. static void igb_update_flowctl_status(IGBCore *core)
  1513. {
  1514. if (igb_have_autoneg(core) && core->phy[MII_BMSR] & MII_BMSR_AN_COMP) {
  1515. trace_e1000e_link_autoneg_flowctl(true);
  1516. core->mac[CTRL] |= E1000_CTRL_TFCE | E1000_CTRL_RFCE;
  1517. } else {
  1518. trace_e1000e_link_autoneg_flowctl(false);
  1519. }
  1520. }
  1521. static inline void
  1522. igb_link_down(IGBCore *core)
  1523. {
  1524. e1000x_update_regs_on_link_down(core->mac, core->phy);
  1525. igb_update_flowctl_status(core);
  1526. }
  1527. static inline void
  1528. igb_set_phy_ctrl(IGBCore *core, uint16_t val)
  1529. {
  1530. /* bits 0-5 reserved; MII_BMCR_[ANRESTART,RESET] are self clearing */
  1531. core->phy[MII_BMCR] = val & ~(0x3f | MII_BMCR_RESET | MII_BMCR_ANRESTART);
  1532. if ((val & MII_BMCR_ANRESTART) && igb_have_autoneg(core)) {
  1533. e1000x_restart_autoneg(core->mac, core->phy, core->autoneg_timer);
  1534. }
  1535. }
  1536. void igb_core_set_link_status(IGBCore *core)
  1537. {
  1538. NetClientState *nc = qemu_get_queue(core->owner_nic);
  1539. uint32_t old_status = core->mac[STATUS];
  1540. trace_e1000e_link_status_changed(nc->link_down ? false : true);
  1541. if (nc->link_down) {
  1542. e1000x_update_regs_on_link_down(core->mac, core->phy);
  1543. } else {
  1544. if (igb_have_autoneg(core) &&
  1545. !(core->phy[MII_BMSR] & MII_BMSR_AN_COMP)) {
  1546. e1000x_restart_autoneg(core->mac, core->phy,
  1547. core->autoneg_timer);
  1548. } else {
  1549. e1000x_update_regs_on_link_up(core->mac, core->phy);
  1550. igb_start_recv(core);
  1551. }
  1552. }
  1553. if (core->mac[STATUS] != old_status) {
  1554. igb_raise_interrupts(core, ICR, E1000_ICR_LSC);
  1555. }
  1556. }
  1557. static void
  1558. igb_set_ctrl(IGBCore *core, int index, uint32_t val)
  1559. {
  1560. trace_e1000e_core_ctrl_write(index, val);
  1561. /* RST is self clearing */
  1562. core->mac[CTRL] = val & ~E1000_CTRL_RST;
  1563. core->mac[CTRL_DUP] = core->mac[CTRL];
  1564. trace_e1000e_link_set_params(
  1565. !!(val & E1000_CTRL_ASDE),
  1566. (val & E1000_CTRL_SPD_SEL) >> E1000_CTRL_SPD_SHIFT,
  1567. !!(val & E1000_CTRL_FRCSPD),
  1568. !!(val & E1000_CTRL_FRCDPX),
  1569. !!(val & E1000_CTRL_RFCE),
  1570. !!(val & E1000_CTRL_TFCE));
  1571. if (val & E1000_CTRL_RST) {
  1572. trace_e1000e_core_ctrl_sw_reset();
  1573. igb_reset(core, true);
  1574. }
  1575. if (val & E1000_CTRL_PHY_RST) {
  1576. trace_e1000e_core_ctrl_phy_reset();
  1577. core->mac[STATUS] |= E1000_STATUS_PHYRA;
  1578. }
  1579. }
  1580. static void
  1581. igb_set_rfctl(IGBCore *core, int index, uint32_t val)
  1582. {
  1583. trace_e1000e_rx_set_rfctl(val);
  1584. if (!(val & E1000_RFCTL_ISCSI_DIS)) {
  1585. trace_e1000e_wrn_iscsi_filtering_not_supported();
  1586. }
  1587. if (!(val & E1000_RFCTL_NFSW_DIS)) {
  1588. trace_e1000e_wrn_nfsw_filtering_not_supported();
  1589. }
  1590. if (!(val & E1000_RFCTL_NFSR_DIS)) {
  1591. trace_e1000e_wrn_nfsr_filtering_not_supported();
  1592. }
  1593. core->mac[RFCTL] = val;
  1594. }
  1595. static void
  1596. igb_calc_rxdesclen(IGBCore *core)
  1597. {
  1598. if (igb_rx_use_legacy_descriptor(core)) {
  1599. core->rx_desc_len = sizeof(struct e1000_rx_desc);
  1600. } else {
  1601. core->rx_desc_len = sizeof(union e1000_adv_rx_desc);
  1602. }
  1603. trace_e1000e_rx_desc_len(core->rx_desc_len);
  1604. }
  1605. static void
  1606. igb_set_rx_control(IGBCore *core, int index, uint32_t val)
  1607. {
  1608. core->mac[RCTL] = val;
  1609. trace_e1000e_rx_set_rctl(core->mac[RCTL]);
  1610. if (val & E1000_RCTL_DTYP_MASK) {
  1611. qemu_log_mask(LOG_GUEST_ERROR,
  1612. "igb: RCTL.DTYP must be zero for compatibility");
  1613. }
  1614. if (val & E1000_RCTL_EN) {
  1615. igb_calc_rxdesclen(core);
  1616. igb_start_recv(core);
  1617. }
  1618. }
  1619. static inline bool
  1620. igb_postpone_interrupt(IGBIntrDelayTimer *timer)
  1621. {
  1622. if (timer->running) {
  1623. trace_e1000e_irq_postponed_by_xitr(timer->delay_reg << 2);
  1624. return true;
  1625. }
  1626. if (timer->core->mac[timer->delay_reg] != 0) {
  1627. igb_intrmgr_rearm_timer(timer);
  1628. }
  1629. return false;
  1630. }
  1631. static inline bool
  1632. igb_eitr_should_postpone(IGBCore *core, int idx)
  1633. {
  1634. return igb_postpone_interrupt(&core->eitr[idx]);
  1635. }
  1636. static void igb_send_msix(IGBCore *core, uint32_t causes)
  1637. {
  1638. int vector;
  1639. for (vector = 0; vector < IGB_INTR_NUM; ++vector) {
  1640. if ((causes & BIT(vector)) && !igb_eitr_should_postpone(core, vector)) {
  1641. trace_e1000e_irq_msix_notify_vec(vector);
  1642. igb_msix_notify(core, vector);
  1643. }
  1644. }
  1645. }
  1646. static inline void
  1647. igb_fix_icr_asserted(IGBCore *core)
  1648. {
  1649. core->mac[ICR] &= ~E1000_ICR_ASSERTED;
  1650. if (core->mac[ICR]) {
  1651. core->mac[ICR] |= E1000_ICR_ASSERTED;
  1652. }
  1653. trace_e1000e_irq_fix_icr_asserted(core->mac[ICR]);
  1654. }
  1655. static void igb_raise_interrupts(IGBCore *core, size_t index, uint32_t causes)
  1656. {
  1657. uint32_t old_causes = core->mac[ICR] & core->mac[IMS];
  1658. uint32_t old_ecauses = core->mac[EICR] & core->mac[EIMS];
  1659. uint32_t raised_causes;
  1660. uint32_t raised_ecauses;
  1661. uint32_t int_alloc;
  1662. trace_e1000e_irq_set(index << 2,
  1663. core->mac[index], core->mac[index] | causes);
  1664. core->mac[index] |= causes;
  1665. if (core->mac[GPIE] & E1000_GPIE_MSIX_MODE) {
  1666. raised_causes = core->mac[ICR] & core->mac[IMS] & ~old_causes;
  1667. if (raised_causes & E1000_ICR_DRSTA) {
  1668. int_alloc = core->mac[IVAR_MISC] & 0xff;
  1669. if (int_alloc & E1000_IVAR_VALID) {
  1670. core->mac[EICR] |= BIT(int_alloc & 0x1f);
  1671. }
  1672. }
  1673. /* Check if other bits (excluding the TCP Timer) are enabled. */
  1674. if (raised_causes & ~E1000_ICR_DRSTA) {
  1675. int_alloc = (core->mac[IVAR_MISC] >> 8) & 0xff;
  1676. if (int_alloc & E1000_IVAR_VALID) {
  1677. core->mac[EICR] |= BIT(int_alloc & 0x1f);
  1678. }
  1679. }
  1680. raised_ecauses = core->mac[EICR] & core->mac[EIMS] & ~old_ecauses;
  1681. if (!raised_ecauses) {
  1682. return;
  1683. }
  1684. igb_send_msix(core, raised_ecauses);
  1685. } else {
  1686. igb_fix_icr_asserted(core);
  1687. raised_causes = core->mac[ICR] & core->mac[IMS] & ~old_causes;
  1688. if (!raised_causes) {
  1689. return;
  1690. }
  1691. core->mac[EICR] |= (raised_causes & E1000_ICR_DRSTA) | E1000_EICR_OTHER;
  1692. if (msix_enabled(core->owner)) {
  1693. trace_e1000e_irq_msix_notify_vec(0);
  1694. msix_notify(core->owner, 0);
  1695. } else if (msi_enabled(core->owner)) {
  1696. trace_e1000e_irq_msi_notify(raised_causes);
  1697. msi_notify(core->owner, 0);
  1698. } else {
  1699. igb_raise_legacy_irq(core);
  1700. }
  1701. }
  1702. }
  1703. static void igb_lower_interrupts(IGBCore *core, size_t index, uint32_t causes)
  1704. {
  1705. trace_e1000e_irq_clear(index << 2,
  1706. core->mac[index], core->mac[index] & ~causes);
  1707. core->mac[index] &= ~causes;
  1708. trace_e1000e_irq_pending_interrupts(core->mac[ICR] & core->mac[IMS],
  1709. core->mac[ICR], core->mac[IMS]);
  1710. if (!(core->mac[ICR] & core->mac[IMS]) &&
  1711. !(core->mac[GPIE] & E1000_GPIE_MSIX_MODE)) {
  1712. core->mac[EICR] &= ~E1000_EICR_OTHER;
  1713. if (!msix_enabled(core->owner) && !msi_enabled(core->owner)) {
  1714. igb_lower_legacy_irq(core);
  1715. }
  1716. }
  1717. }
  1718. static void igb_set_eics(IGBCore *core, int index, uint32_t val)
  1719. {
  1720. bool msix = !!(core->mac[GPIE] & E1000_GPIE_MSIX_MODE);
  1721. uint32_t mask = msix ? E1000_EICR_MSIX_MASK : E1000_EICR_LEGACY_MASK;
  1722. trace_igb_irq_write_eics(val, msix);
  1723. igb_raise_interrupts(core, EICR, val & mask);
  1724. }
  1725. static void igb_set_eims(IGBCore *core, int index, uint32_t val)
  1726. {
  1727. bool msix = !!(core->mac[GPIE] & E1000_GPIE_MSIX_MODE);
  1728. uint32_t mask = msix ? E1000_EICR_MSIX_MASK : E1000_EICR_LEGACY_MASK;
  1729. trace_igb_irq_write_eims(val, msix);
  1730. igb_raise_interrupts(core, EIMS, val & mask);
  1731. }
  1732. static void mailbox_interrupt_to_vf(IGBCore *core, uint16_t vfn)
  1733. {
  1734. uint32_t ent = core->mac[VTIVAR_MISC + vfn];
  1735. uint32_t causes;
  1736. if ((ent & E1000_IVAR_VALID)) {
  1737. causes = (ent & 0x3) << (22 - vfn * IGBVF_MSIX_VEC_NUM);
  1738. igb_raise_interrupts(core, EICR, causes);
  1739. }
  1740. }
  1741. static void mailbox_interrupt_to_pf(IGBCore *core)
  1742. {
  1743. igb_raise_interrupts(core, ICR, E1000_ICR_VMMB);
  1744. }
  1745. static void igb_set_pfmailbox(IGBCore *core, int index, uint32_t val)
  1746. {
  1747. uint16_t vfn = index - P2VMAILBOX0;
  1748. trace_igb_set_pfmailbox(vfn, val);
  1749. if (val & E1000_P2VMAILBOX_STS) {
  1750. core->mac[V2PMAILBOX0 + vfn] |= E1000_V2PMAILBOX_PFSTS;
  1751. mailbox_interrupt_to_vf(core, vfn);
  1752. }
  1753. if (val & E1000_P2VMAILBOX_ACK) {
  1754. core->mac[V2PMAILBOX0 + vfn] |= E1000_V2PMAILBOX_PFACK;
  1755. mailbox_interrupt_to_vf(core, vfn);
  1756. }
  1757. /* Buffer Taken by PF (can be set only if the VFU is cleared). */
  1758. if (val & E1000_P2VMAILBOX_PFU) {
  1759. if (!(core->mac[index] & E1000_P2VMAILBOX_VFU)) {
  1760. core->mac[index] |= E1000_P2VMAILBOX_PFU;
  1761. core->mac[V2PMAILBOX0 + vfn] |= E1000_V2PMAILBOX_PFU;
  1762. }
  1763. } else {
  1764. core->mac[index] &= ~E1000_P2VMAILBOX_PFU;
  1765. core->mac[V2PMAILBOX0 + vfn] &= ~E1000_V2PMAILBOX_PFU;
  1766. }
  1767. if (val & E1000_P2VMAILBOX_RVFU) {
  1768. core->mac[V2PMAILBOX0 + vfn] &= ~E1000_V2PMAILBOX_VFU;
  1769. core->mac[MBVFICR] &= ~((E1000_MBVFICR_VFACK_VF1 << vfn) |
  1770. (E1000_MBVFICR_VFREQ_VF1 << vfn));
  1771. }
  1772. }
  1773. static void igb_set_vfmailbox(IGBCore *core, int index, uint32_t val)
  1774. {
  1775. uint16_t vfn = index - V2PMAILBOX0;
  1776. trace_igb_set_vfmailbox(vfn, val);
  1777. if (val & E1000_V2PMAILBOX_REQ) {
  1778. core->mac[MBVFICR] |= E1000_MBVFICR_VFREQ_VF1 << vfn;
  1779. mailbox_interrupt_to_pf(core);
  1780. }
  1781. if (val & E1000_V2PMAILBOX_ACK) {
  1782. core->mac[MBVFICR] |= E1000_MBVFICR_VFACK_VF1 << vfn;
  1783. mailbox_interrupt_to_pf(core);
  1784. }
  1785. /* Buffer Taken by VF (can be set only if the PFU is cleared). */
  1786. if (val & E1000_V2PMAILBOX_VFU) {
  1787. if (!(core->mac[index] & E1000_V2PMAILBOX_PFU)) {
  1788. core->mac[index] |= E1000_V2PMAILBOX_VFU;
  1789. core->mac[P2VMAILBOX0 + vfn] |= E1000_P2VMAILBOX_VFU;
  1790. }
  1791. } else {
  1792. core->mac[index] &= ~E1000_V2PMAILBOX_VFU;
  1793. core->mac[P2VMAILBOX0 + vfn] &= ~E1000_P2VMAILBOX_VFU;
  1794. }
  1795. }
  1796. static void igb_vf_reset(IGBCore *core, uint16_t vfn)
  1797. {
  1798. uint16_t qn0 = vfn;
  1799. uint16_t qn1 = vfn + IGB_NUM_VM_POOLS;
  1800. /* disable Rx and Tx for the VF*/
  1801. core->mac[RXDCTL0 + (qn0 * 16)] &= ~E1000_RXDCTL_QUEUE_ENABLE;
  1802. core->mac[RXDCTL0 + (qn1 * 16)] &= ~E1000_RXDCTL_QUEUE_ENABLE;
  1803. core->mac[TXDCTL0 + (qn0 * 16)] &= ~E1000_TXDCTL_QUEUE_ENABLE;
  1804. core->mac[TXDCTL0 + (qn1 * 16)] &= ~E1000_TXDCTL_QUEUE_ENABLE;
  1805. core->mac[VFRE] &= ~BIT(vfn);
  1806. core->mac[VFTE] &= ~BIT(vfn);
  1807. /* indicate VF reset to PF */
  1808. core->mac[VFLRE] |= BIT(vfn);
  1809. /* VFLRE and mailbox use the same interrupt cause */
  1810. mailbox_interrupt_to_pf(core);
  1811. }
  1812. static void igb_w1c(IGBCore *core, int index, uint32_t val)
  1813. {
  1814. core->mac[index] &= ~val;
  1815. }
  1816. static void igb_set_eimc(IGBCore *core, int index, uint32_t val)
  1817. {
  1818. bool msix = !!(core->mac[GPIE] & E1000_GPIE_MSIX_MODE);
  1819. uint32_t mask = msix ? E1000_EICR_MSIX_MASK : E1000_EICR_LEGACY_MASK;
  1820. trace_igb_irq_write_eimc(val, msix);
  1821. /* Interrupts are disabled via a write to EIMC and reflected in EIMS. */
  1822. igb_lower_interrupts(core, EIMS, val & mask);
  1823. }
  1824. static void igb_set_eiac(IGBCore *core, int index, uint32_t val)
  1825. {
  1826. bool msix = !!(core->mac[GPIE] & E1000_GPIE_MSIX_MODE);
  1827. if (msix) {
  1828. trace_igb_irq_write_eiac(val);
  1829. /*
  1830. * TODO: When using IOV, the bits that correspond to MSI-X vectors
  1831. * that are assigned to a VF are read-only.
  1832. */
  1833. core->mac[EIAC] |= (val & E1000_EICR_MSIX_MASK);
  1834. }
  1835. }
  1836. static void igb_set_eiam(IGBCore *core, int index, uint32_t val)
  1837. {
  1838. bool msix = !!(core->mac[GPIE] & E1000_GPIE_MSIX_MODE);
  1839. /*
  1840. * TODO: When using IOV, the bits that correspond to MSI-X vectors that
  1841. * are assigned to a VF are read-only.
  1842. */
  1843. core->mac[EIAM] |=
  1844. ~(val & (msix ? E1000_EICR_MSIX_MASK : E1000_EICR_LEGACY_MASK));
  1845. trace_igb_irq_write_eiam(val, msix);
  1846. }
  1847. static void igb_set_eicr(IGBCore *core, int index, uint32_t val)
  1848. {
  1849. bool msix = !!(core->mac[GPIE] & E1000_GPIE_MSIX_MODE);
  1850. /*
  1851. * TODO: In IOV mode, only bit zero of this vector is available for the PF
  1852. * function.
  1853. */
  1854. uint32_t mask = msix ? E1000_EICR_MSIX_MASK : E1000_EICR_LEGACY_MASK;
  1855. trace_igb_irq_write_eicr(val, msix);
  1856. igb_lower_interrupts(core, EICR, val & mask);
  1857. }
  1858. static void igb_set_vtctrl(IGBCore *core, int index, uint32_t val)
  1859. {
  1860. uint16_t vfn;
  1861. if (val & E1000_CTRL_RST) {
  1862. vfn = (index - PVTCTRL0) / 0x40;
  1863. igb_vf_reset(core, vfn);
  1864. }
  1865. }
  1866. static void igb_set_vteics(IGBCore *core, int index, uint32_t val)
  1867. {
  1868. uint16_t vfn = (index - PVTEICS0) / 0x40;
  1869. core->mac[index] = val;
  1870. igb_set_eics(core, EICS, (val & 0x7) << (22 - vfn * IGBVF_MSIX_VEC_NUM));
  1871. }
  1872. static void igb_set_vteims(IGBCore *core, int index, uint32_t val)
  1873. {
  1874. uint16_t vfn = (index - PVTEIMS0) / 0x40;
  1875. core->mac[index] = val;
  1876. igb_set_eims(core, EIMS, (val & 0x7) << (22 - vfn * IGBVF_MSIX_VEC_NUM));
  1877. }
  1878. static void igb_set_vteimc(IGBCore *core, int index, uint32_t val)
  1879. {
  1880. uint16_t vfn = (index - PVTEIMC0) / 0x40;
  1881. core->mac[index] = val;
  1882. igb_set_eimc(core, EIMC, (val & 0x7) << (22 - vfn * IGBVF_MSIX_VEC_NUM));
  1883. }
  1884. static void igb_set_vteiac(IGBCore *core, int index, uint32_t val)
  1885. {
  1886. uint16_t vfn = (index - PVTEIAC0) / 0x40;
  1887. core->mac[index] = val;
  1888. igb_set_eiac(core, EIAC, (val & 0x7) << (22 - vfn * IGBVF_MSIX_VEC_NUM));
  1889. }
  1890. static void igb_set_vteiam(IGBCore *core, int index, uint32_t val)
  1891. {
  1892. uint16_t vfn = (index - PVTEIAM0) / 0x40;
  1893. core->mac[index] = val;
  1894. igb_set_eiam(core, EIAM, (val & 0x7) << (22 - vfn * IGBVF_MSIX_VEC_NUM));
  1895. }
  1896. static void igb_set_vteicr(IGBCore *core, int index, uint32_t val)
  1897. {
  1898. uint16_t vfn = (index - PVTEICR0) / 0x40;
  1899. core->mac[index] = val;
  1900. igb_set_eicr(core, EICR, (val & 0x7) << (22 - vfn * IGBVF_MSIX_VEC_NUM));
  1901. }
  1902. static void igb_set_vtivar(IGBCore *core, int index, uint32_t val)
  1903. {
  1904. uint16_t vfn = (index - VTIVAR);
  1905. uint16_t qn = vfn;
  1906. uint8_t ent;
  1907. int n;
  1908. core->mac[index] = val;
  1909. /* Get assigned vector associated with queue Rx#0. */
  1910. if ((val & E1000_IVAR_VALID)) {
  1911. n = igb_ivar_entry_rx(qn);
  1912. ent = E1000_IVAR_VALID | (24 - vfn * IGBVF_MSIX_VEC_NUM - (2 - (val & 0x7)));
  1913. core->mac[IVAR0 + n / 4] |= ent << 8 * (n % 4);
  1914. }
  1915. /* Get assigned vector associated with queue Tx#0 */
  1916. ent = val >> 8;
  1917. if ((ent & E1000_IVAR_VALID)) {
  1918. n = igb_ivar_entry_tx(qn);
  1919. ent = E1000_IVAR_VALID | (24 - vfn * IGBVF_MSIX_VEC_NUM - (2 - (ent & 0x7)));
  1920. core->mac[IVAR0 + n / 4] |= ent << 8 * (n % 4);
  1921. }
  1922. /*
  1923. * Ignoring assigned vectors associated with queues Rx#1 and Tx#1 for now.
  1924. */
  1925. }
  1926. static inline void
  1927. igb_autoneg_timer(void *opaque)
  1928. {
  1929. IGBCore *core = opaque;
  1930. if (!qemu_get_queue(core->owner_nic)->link_down) {
  1931. e1000x_update_regs_on_autoneg_done(core->mac, core->phy);
  1932. igb_start_recv(core);
  1933. igb_update_flowctl_status(core);
  1934. /* signal link status change to the guest */
  1935. igb_raise_interrupts(core, ICR, E1000_ICR_LSC);
  1936. }
  1937. }
  1938. static inline uint16_t
  1939. igb_get_reg_index_with_offset(const uint16_t *mac_reg_access, hwaddr addr)
  1940. {
  1941. uint16_t index = (addr & 0x1ffff) >> 2;
  1942. return index + (mac_reg_access[index] & 0xfffe);
  1943. }
  1944. static const char igb_phy_regcap[MAX_PHY_REG_ADDRESS + 1] = {
  1945. [MII_BMCR] = PHY_RW,
  1946. [MII_BMSR] = PHY_R,
  1947. [MII_PHYID1] = PHY_R,
  1948. [MII_PHYID2] = PHY_R,
  1949. [MII_ANAR] = PHY_RW,
  1950. [MII_ANLPAR] = PHY_R,
  1951. [MII_ANER] = PHY_R,
  1952. [MII_ANNP] = PHY_RW,
  1953. [MII_ANLPRNP] = PHY_R,
  1954. [MII_CTRL1000] = PHY_RW,
  1955. [MII_STAT1000] = PHY_R,
  1956. [MII_EXTSTAT] = PHY_R,
  1957. [IGP01E1000_PHY_PORT_CONFIG] = PHY_RW,
  1958. [IGP01E1000_PHY_PORT_STATUS] = PHY_R,
  1959. [IGP01E1000_PHY_PORT_CTRL] = PHY_RW,
  1960. [IGP01E1000_PHY_LINK_HEALTH] = PHY_R,
  1961. [IGP02E1000_PHY_POWER_MGMT] = PHY_RW,
  1962. [IGP01E1000_PHY_PAGE_SELECT] = PHY_W
  1963. };
  1964. static void
  1965. igb_phy_reg_write(IGBCore *core, uint32_t addr, uint16_t data)
  1966. {
  1967. assert(addr <= MAX_PHY_REG_ADDRESS);
  1968. if (addr == MII_BMCR) {
  1969. igb_set_phy_ctrl(core, data);
  1970. } else {
  1971. core->phy[addr] = data;
  1972. }
  1973. }
  1974. static void
  1975. igb_set_mdic(IGBCore *core, int index, uint32_t val)
  1976. {
  1977. uint32_t data = val & E1000_MDIC_DATA_MASK;
  1978. uint32_t addr = ((val & E1000_MDIC_REG_MASK) >> E1000_MDIC_REG_SHIFT);
  1979. if ((val & E1000_MDIC_PHY_MASK) >> E1000_MDIC_PHY_SHIFT != 1) { /* phy # */
  1980. val = core->mac[MDIC] | E1000_MDIC_ERROR;
  1981. } else if (val & E1000_MDIC_OP_READ) {
  1982. if (!(igb_phy_regcap[addr] & PHY_R)) {
  1983. trace_igb_core_mdic_read_unhandled(addr);
  1984. val |= E1000_MDIC_ERROR;
  1985. } else {
  1986. val = (val ^ data) | core->phy[addr];
  1987. trace_igb_core_mdic_read(addr, val);
  1988. }
  1989. } else if (val & E1000_MDIC_OP_WRITE) {
  1990. if (!(igb_phy_regcap[addr] & PHY_W)) {
  1991. trace_igb_core_mdic_write_unhandled(addr);
  1992. val |= E1000_MDIC_ERROR;
  1993. } else {
  1994. trace_igb_core_mdic_write(addr, data);
  1995. igb_phy_reg_write(core, addr, data);
  1996. }
  1997. }
  1998. core->mac[MDIC] = val | E1000_MDIC_READY;
  1999. if (val & E1000_MDIC_INT_EN) {
  2000. igb_raise_interrupts(core, ICR, E1000_ICR_MDAC);
  2001. }
  2002. }
  2003. static void
  2004. igb_set_rdt(IGBCore *core, int index, uint32_t val)
  2005. {
  2006. core->mac[index] = val & 0xffff;
  2007. trace_e1000e_rx_set_rdt(igb_mq_queue_idx(RDT0, index), val);
  2008. igb_start_recv(core);
  2009. }
  2010. static void
  2011. igb_set_status(IGBCore *core, int index, uint32_t val)
  2012. {
  2013. if ((val & E1000_STATUS_PHYRA) == 0) {
  2014. core->mac[index] &= ~E1000_STATUS_PHYRA;
  2015. }
  2016. }
  2017. static void
  2018. igb_set_ctrlext(IGBCore *core, int index, uint32_t val)
  2019. {
  2020. trace_igb_link_set_ext_params(!!(val & E1000_CTRL_EXT_ASDCHK),
  2021. !!(val & E1000_CTRL_EXT_SPD_BYPS),
  2022. !!(val & E1000_CTRL_EXT_PFRSTD));
  2023. /* Zero self-clearing bits */
  2024. val &= ~(E1000_CTRL_EXT_ASDCHK | E1000_CTRL_EXT_EE_RST);
  2025. core->mac[CTRL_EXT] = val;
  2026. if (core->mac[CTRL_EXT] & E1000_CTRL_EXT_PFRSTD) {
  2027. for (int vfn = 0; vfn < IGB_MAX_VF_FUNCTIONS; vfn++) {
  2028. core->mac[V2PMAILBOX0 + vfn] &= ~E1000_V2PMAILBOX_RSTI;
  2029. core->mac[V2PMAILBOX0 + vfn] |= E1000_V2PMAILBOX_RSTD;
  2030. }
  2031. }
  2032. }
  2033. static void
  2034. igb_set_pbaclr(IGBCore *core, int index, uint32_t val)
  2035. {
  2036. int i;
  2037. core->mac[PBACLR] = val & E1000_PBACLR_VALID_MASK;
  2038. if (!msix_enabled(core->owner)) {
  2039. return;
  2040. }
  2041. for (i = 0; i < IGB_INTR_NUM; i++) {
  2042. if (core->mac[PBACLR] & BIT(i)) {
  2043. msix_clr_pending(core->owner, i);
  2044. }
  2045. }
  2046. }
  2047. static void
  2048. igb_set_fcrth(IGBCore *core, int index, uint32_t val)
  2049. {
  2050. core->mac[FCRTH] = val & 0xFFF8;
  2051. }
  2052. static void
  2053. igb_set_fcrtl(IGBCore *core, int index, uint32_t val)
  2054. {
  2055. core->mac[FCRTL] = val & 0x8000FFF8;
  2056. }
  2057. #define IGB_LOW_BITS_SET_FUNC(num) \
  2058. static void \
  2059. igb_set_##num##bit(IGBCore *core, int index, uint32_t val) \
  2060. { \
  2061. core->mac[index] = val & (BIT(num) - 1); \
  2062. }
  2063. IGB_LOW_BITS_SET_FUNC(4)
  2064. IGB_LOW_BITS_SET_FUNC(13)
  2065. IGB_LOW_BITS_SET_FUNC(16)
  2066. static void
  2067. igb_set_dlen(IGBCore *core, int index, uint32_t val)
  2068. {
  2069. core->mac[index] = val & 0xffff0;
  2070. }
  2071. static void
  2072. igb_set_dbal(IGBCore *core, int index, uint32_t val)
  2073. {
  2074. core->mac[index] = val & E1000_XDBAL_MASK;
  2075. }
  2076. static void
  2077. igb_set_tdt(IGBCore *core, int index, uint32_t val)
  2078. {
  2079. IGB_TxRing txr;
  2080. int qn = igb_mq_queue_idx(TDT0, index);
  2081. core->mac[index] = val & 0xffff;
  2082. igb_tx_ring_init(core, &txr, qn);
  2083. igb_start_xmit(core, &txr);
  2084. }
  2085. static void
  2086. igb_set_ics(IGBCore *core, int index, uint32_t val)
  2087. {
  2088. trace_e1000e_irq_write_ics(val);
  2089. igb_raise_interrupts(core, ICR, val);
  2090. }
  2091. static void
  2092. igb_set_imc(IGBCore *core, int index, uint32_t val)
  2093. {
  2094. trace_e1000e_irq_ims_clear_set_imc(val);
  2095. igb_lower_interrupts(core, IMS, val);
  2096. }
  2097. static void
  2098. igb_set_ims(IGBCore *core, int index, uint32_t val)
  2099. {
  2100. igb_raise_interrupts(core, IMS, val & 0x77D4FBFD);
  2101. }
  2102. static void igb_nsicr(IGBCore *core)
  2103. {
  2104. /*
  2105. * If GPIE.NSICR = 0, then the clear of IMS will occur only if at
  2106. * least one bit is set in the IMS and there is a true interrupt as
  2107. * reflected in ICR.INTA.
  2108. */
  2109. if ((core->mac[GPIE] & E1000_GPIE_NSICR) ||
  2110. (core->mac[IMS] && (core->mac[ICR] & E1000_ICR_INT_ASSERTED))) {
  2111. igb_lower_interrupts(core, IMS, core->mac[IAM]);
  2112. }
  2113. }
  2114. static void igb_set_icr(IGBCore *core, int index, uint32_t val)
  2115. {
  2116. igb_nsicr(core);
  2117. igb_lower_interrupts(core, ICR, val);
  2118. }
  2119. static uint32_t
  2120. igb_mac_readreg(IGBCore *core, int index)
  2121. {
  2122. return core->mac[index];
  2123. }
  2124. static uint32_t
  2125. igb_mac_ics_read(IGBCore *core, int index)
  2126. {
  2127. trace_e1000e_irq_read_ics(core->mac[ICS]);
  2128. return core->mac[ICS];
  2129. }
  2130. static uint32_t
  2131. igb_mac_ims_read(IGBCore *core, int index)
  2132. {
  2133. trace_e1000e_irq_read_ims(core->mac[IMS]);
  2134. return core->mac[IMS];
  2135. }
  2136. static uint32_t
  2137. igb_mac_swsm_read(IGBCore *core, int index)
  2138. {
  2139. uint32_t val = core->mac[SWSM];
  2140. core->mac[SWSM] = val | E1000_SWSM_SMBI;
  2141. return val;
  2142. }
  2143. static uint32_t
  2144. igb_mac_eitr_read(IGBCore *core, int index)
  2145. {
  2146. return core->eitr_guest_value[index - EITR0];
  2147. }
  2148. static uint32_t igb_mac_vfmailbox_read(IGBCore *core, int index)
  2149. {
  2150. uint32_t val = core->mac[index];
  2151. core->mac[index] &= ~(E1000_V2PMAILBOX_PFSTS | E1000_V2PMAILBOX_PFACK |
  2152. E1000_V2PMAILBOX_RSTD);
  2153. return val;
  2154. }
  2155. static uint32_t
  2156. igb_mac_icr_read(IGBCore *core, int index)
  2157. {
  2158. uint32_t ret = core->mac[ICR];
  2159. if (core->mac[GPIE] & E1000_GPIE_NSICR) {
  2160. trace_igb_irq_icr_clear_gpie_nsicr();
  2161. igb_lower_interrupts(core, ICR, 0xffffffff);
  2162. } else if (core->mac[IMS] == 0) {
  2163. trace_e1000e_irq_icr_clear_zero_ims();
  2164. igb_lower_interrupts(core, ICR, 0xffffffff);
  2165. } else if (core->mac[ICR] & E1000_ICR_INT_ASSERTED) {
  2166. igb_lower_interrupts(core, ICR, 0xffffffff);
  2167. } else if (!msix_enabled(core->owner)) {
  2168. trace_e1000e_irq_icr_clear_nonmsix_icr_read();
  2169. igb_lower_interrupts(core, ICR, 0xffffffff);
  2170. }
  2171. igb_nsicr(core);
  2172. return ret;
  2173. }
  2174. static uint32_t
  2175. igb_mac_read_clr4(IGBCore *core, int index)
  2176. {
  2177. uint32_t ret = core->mac[index];
  2178. core->mac[index] = 0;
  2179. return ret;
  2180. }
  2181. static uint32_t
  2182. igb_mac_read_clr8(IGBCore *core, int index)
  2183. {
  2184. uint32_t ret = core->mac[index];
  2185. core->mac[index] = 0;
  2186. core->mac[index - 1] = 0;
  2187. return ret;
  2188. }
  2189. static uint32_t
  2190. igb_get_ctrl(IGBCore *core, int index)
  2191. {
  2192. uint32_t val = core->mac[CTRL];
  2193. trace_e1000e_link_read_params(
  2194. !!(val & E1000_CTRL_ASDE),
  2195. (val & E1000_CTRL_SPD_SEL) >> E1000_CTRL_SPD_SHIFT,
  2196. !!(val & E1000_CTRL_FRCSPD),
  2197. !!(val & E1000_CTRL_FRCDPX),
  2198. !!(val & E1000_CTRL_RFCE),
  2199. !!(val & E1000_CTRL_TFCE));
  2200. return val;
  2201. }
  2202. static uint32_t igb_get_status(IGBCore *core, int index)
  2203. {
  2204. uint32_t res = core->mac[STATUS];
  2205. uint16_t num_vfs = pcie_sriov_num_vfs(core->owner);
  2206. if (core->mac[CTRL] & E1000_CTRL_FRCDPX) {
  2207. res |= (core->mac[CTRL] & E1000_CTRL_FD) ? E1000_STATUS_FD : 0;
  2208. } else {
  2209. res |= E1000_STATUS_FD;
  2210. }
  2211. if ((core->mac[CTRL] & E1000_CTRL_FRCSPD) ||
  2212. (core->mac[CTRL_EXT] & E1000_CTRL_EXT_SPD_BYPS)) {
  2213. switch (core->mac[CTRL] & E1000_CTRL_SPD_SEL) {
  2214. case E1000_CTRL_SPD_10:
  2215. res |= E1000_STATUS_SPEED_10;
  2216. break;
  2217. case E1000_CTRL_SPD_100:
  2218. res |= E1000_STATUS_SPEED_100;
  2219. break;
  2220. case E1000_CTRL_SPD_1000:
  2221. default:
  2222. res |= E1000_STATUS_SPEED_1000;
  2223. break;
  2224. }
  2225. } else {
  2226. res |= E1000_STATUS_SPEED_1000;
  2227. }
  2228. if (num_vfs) {
  2229. res |= num_vfs << E1000_STATUS_NUM_VFS_SHIFT;
  2230. res |= E1000_STATUS_IOV_MODE;
  2231. }
  2232. if (!(core->mac[CTRL] & E1000_CTRL_GIO_MASTER_DISABLE)) {
  2233. res |= E1000_STATUS_GIO_MASTER_ENABLE;
  2234. }
  2235. return res;
  2236. }
  2237. static void
  2238. igb_mac_writereg(IGBCore *core, int index, uint32_t val)
  2239. {
  2240. core->mac[index] = val;
  2241. }
  2242. static void
  2243. igb_mac_setmacaddr(IGBCore *core, int index, uint32_t val)
  2244. {
  2245. uint32_t macaddr[2];
  2246. core->mac[index] = val;
  2247. macaddr[0] = cpu_to_le32(core->mac[RA]);
  2248. macaddr[1] = cpu_to_le32(core->mac[RA + 1]);
  2249. qemu_format_nic_info_str(qemu_get_queue(core->owner_nic),
  2250. (uint8_t *) macaddr);
  2251. trace_e1000e_mac_set_sw(MAC_ARG(macaddr));
  2252. }
  2253. static void
  2254. igb_set_eecd(IGBCore *core, int index, uint32_t val)
  2255. {
  2256. static const uint32_t ro_bits = E1000_EECD_PRES |
  2257. E1000_EECD_AUTO_RD |
  2258. E1000_EECD_SIZE_EX_MASK;
  2259. core->mac[EECD] = (core->mac[EECD] & ro_bits) | (val & ~ro_bits);
  2260. }
  2261. static void
  2262. igb_set_eerd(IGBCore *core, int index, uint32_t val)
  2263. {
  2264. uint32_t addr = (val >> E1000_EERW_ADDR_SHIFT) & E1000_EERW_ADDR_MASK;
  2265. uint32_t flags = 0;
  2266. uint32_t data = 0;
  2267. if ((addr < IGB_EEPROM_SIZE) && (val & E1000_EERW_START)) {
  2268. data = core->eeprom[addr];
  2269. flags = E1000_EERW_DONE;
  2270. }
  2271. core->mac[EERD] = flags |
  2272. (addr << E1000_EERW_ADDR_SHIFT) |
  2273. (data << E1000_EERW_DATA_SHIFT);
  2274. }
  2275. static void
  2276. igb_set_eitr(IGBCore *core, int index, uint32_t val)
  2277. {
  2278. uint32_t eitr_num = index - EITR0;
  2279. trace_igb_irq_eitr_set(eitr_num, val);
  2280. core->eitr_guest_value[eitr_num] = val & ~E1000_EITR_CNT_IGNR;
  2281. core->mac[index] = val & 0x7FFE;
  2282. }
  2283. static void
  2284. igb_update_rx_offloads(IGBCore *core)
  2285. {
  2286. int cso_state = igb_rx_l4_cso_enabled(core);
  2287. trace_e1000e_rx_set_cso(cso_state);
  2288. if (core->has_vnet) {
  2289. qemu_set_offload(qemu_get_queue(core->owner_nic)->peer,
  2290. cso_state, 0, 0, 0, 0, 0, 0);
  2291. }
  2292. }
  2293. static void
  2294. igb_set_rxcsum(IGBCore *core, int index, uint32_t val)
  2295. {
  2296. core->mac[RXCSUM] = val;
  2297. igb_update_rx_offloads(core);
  2298. }
  2299. static void
  2300. igb_set_gcr(IGBCore *core, int index, uint32_t val)
  2301. {
  2302. uint32_t ro_bits = core->mac[GCR] & E1000_GCR_RO_BITS;
  2303. core->mac[GCR] = (val & ~E1000_GCR_RO_BITS) | ro_bits;
  2304. }
  2305. static uint32_t igb_get_systiml(IGBCore *core, int index)
  2306. {
  2307. e1000x_timestamp(core->mac, core->timadj, SYSTIML, SYSTIMH);
  2308. return core->mac[SYSTIML];
  2309. }
  2310. static uint32_t igb_get_rxsatrh(IGBCore *core, int index)
  2311. {
  2312. core->mac[TSYNCRXCTL] &= ~E1000_TSYNCRXCTL_VALID;
  2313. return core->mac[RXSATRH];
  2314. }
  2315. static uint32_t igb_get_txstmph(IGBCore *core, int index)
  2316. {
  2317. core->mac[TSYNCTXCTL] &= ~E1000_TSYNCTXCTL_VALID;
  2318. return core->mac[TXSTMPH];
  2319. }
  2320. static void igb_set_timinca(IGBCore *core, int index, uint32_t val)
  2321. {
  2322. e1000x_set_timinca(core->mac, &core->timadj, val);
  2323. }
  2324. static void igb_set_timadjh(IGBCore *core, int index, uint32_t val)
  2325. {
  2326. core->mac[TIMADJH] = val;
  2327. core->timadj += core->mac[TIMADJL] | ((int64_t)core->mac[TIMADJH] << 32);
  2328. }
  2329. #define igb_getreg(x) [x] = igb_mac_readreg
  2330. typedef uint32_t (*readops)(IGBCore *, int);
  2331. static const readops igb_macreg_readops[] = {
  2332. igb_getreg(WUFC),
  2333. igb_getreg(MANC),
  2334. igb_getreg(TOTL),
  2335. igb_getreg(RDT0),
  2336. igb_getreg(RDT1),
  2337. igb_getreg(RDT2),
  2338. igb_getreg(RDT3),
  2339. igb_getreg(RDT4),
  2340. igb_getreg(RDT5),
  2341. igb_getreg(RDT6),
  2342. igb_getreg(RDT7),
  2343. igb_getreg(RDT8),
  2344. igb_getreg(RDT9),
  2345. igb_getreg(RDT10),
  2346. igb_getreg(RDT11),
  2347. igb_getreg(RDT12),
  2348. igb_getreg(RDT13),
  2349. igb_getreg(RDT14),
  2350. igb_getreg(RDT15),
  2351. igb_getreg(RDBAH0),
  2352. igb_getreg(RDBAH1),
  2353. igb_getreg(RDBAH2),
  2354. igb_getreg(RDBAH3),
  2355. igb_getreg(RDBAH4),
  2356. igb_getreg(RDBAH5),
  2357. igb_getreg(RDBAH6),
  2358. igb_getreg(RDBAH7),
  2359. igb_getreg(RDBAH8),
  2360. igb_getreg(RDBAH9),
  2361. igb_getreg(RDBAH10),
  2362. igb_getreg(RDBAH11),
  2363. igb_getreg(RDBAH12),
  2364. igb_getreg(RDBAH13),
  2365. igb_getreg(RDBAH14),
  2366. igb_getreg(RDBAH15),
  2367. igb_getreg(TDBAL0),
  2368. igb_getreg(TDBAL1),
  2369. igb_getreg(TDBAL2),
  2370. igb_getreg(TDBAL3),
  2371. igb_getreg(TDBAL4),
  2372. igb_getreg(TDBAL5),
  2373. igb_getreg(TDBAL6),
  2374. igb_getreg(TDBAL7),
  2375. igb_getreg(TDBAL8),
  2376. igb_getreg(TDBAL9),
  2377. igb_getreg(TDBAL10),
  2378. igb_getreg(TDBAL11),
  2379. igb_getreg(TDBAL12),
  2380. igb_getreg(TDBAL13),
  2381. igb_getreg(TDBAL14),
  2382. igb_getreg(TDBAL15),
  2383. igb_getreg(RDLEN0),
  2384. igb_getreg(RDLEN1),
  2385. igb_getreg(RDLEN2),
  2386. igb_getreg(RDLEN3),
  2387. igb_getreg(RDLEN4),
  2388. igb_getreg(RDLEN5),
  2389. igb_getreg(RDLEN6),
  2390. igb_getreg(RDLEN7),
  2391. igb_getreg(RDLEN8),
  2392. igb_getreg(RDLEN9),
  2393. igb_getreg(RDLEN10),
  2394. igb_getreg(RDLEN11),
  2395. igb_getreg(RDLEN12),
  2396. igb_getreg(RDLEN13),
  2397. igb_getreg(RDLEN14),
  2398. igb_getreg(RDLEN15),
  2399. igb_getreg(SRRCTL0),
  2400. igb_getreg(SRRCTL1),
  2401. igb_getreg(SRRCTL2),
  2402. igb_getreg(SRRCTL3),
  2403. igb_getreg(SRRCTL4),
  2404. igb_getreg(SRRCTL5),
  2405. igb_getreg(SRRCTL6),
  2406. igb_getreg(SRRCTL7),
  2407. igb_getreg(SRRCTL8),
  2408. igb_getreg(SRRCTL9),
  2409. igb_getreg(SRRCTL10),
  2410. igb_getreg(SRRCTL11),
  2411. igb_getreg(SRRCTL12),
  2412. igb_getreg(SRRCTL13),
  2413. igb_getreg(SRRCTL14),
  2414. igb_getreg(SRRCTL15),
  2415. igb_getreg(LATECOL),
  2416. igb_getreg(XONTXC),
  2417. igb_getreg(TDFH),
  2418. igb_getreg(TDFT),
  2419. igb_getreg(TDFHS),
  2420. igb_getreg(TDFTS),
  2421. igb_getreg(TDFPC),
  2422. igb_getreg(WUS),
  2423. igb_getreg(RDFH),
  2424. igb_getreg(RDFT),
  2425. igb_getreg(RDFHS),
  2426. igb_getreg(RDFTS),
  2427. igb_getreg(RDFPC),
  2428. igb_getreg(GORCL),
  2429. igb_getreg(MGTPRC),
  2430. igb_getreg(EERD),
  2431. igb_getreg(EIAC),
  2432. igb_getreg(MANC2H),
  2433. igb_getreg(RXCSUM),
  2434. igb_getreg(GSCL_3),
  2435. igb_getreg(GSCN_2),
  2436. igb_getreg(FCAH),
  2437. igb_getreg(FCRTH),
  2438. igb_getreg(FLOP),
  2439. igb_getreg(RXSTMPH),
  2440. igb_getreg(TXSTMPL),
  2441. igb_getreg(TIMADJL),
  2442. igb_getreg(RDH0),
  2443. igb_getreg(RDH1),
  2444. igb_getreg(RDH2),
  2445. igb_getreg(RDH3),
  2446. igb_getreg(RDH4),
  2447. igb_getreg(RDH5),
  2448. igb_getreg(RDH6),
  2449. igb_getreg(RDH7),
  2450. igb_getreg(RDH8),
  2451. igb_getreg(RDH9),
  2452. igb_getreg(RDH10),
  2453. igb_getreg(RDH11),
  2454. igb_getreg(RDH12),
  2455. igb_getreg(RDH13),
  2456. igb_getreg(RDH14),
  2457. igb_getreg(RDH15),
  2458. igb_getreg(TDT0),
  2459. igb_getreg(TDT1),
  2460. igb_getreg(TDT2),
  2461. igb_getreg(TDT3),
  2462. igb_getreg(TDT4),
  2463. igb_getreg(TDT5),
  2464. igb_getreg(TDT6),
  2465. igb_getreg(TDT7),
  2466. igb_getreg(TDT8),
  2467. igb_getreg(TDT9),
  2468. igb_getreg(TDT10),
  2469. igb_getreg(TDT11),
  2470. igb_getreg(TDT12),
  2471. igb_getreg(TDT13),
  2472. igb_getreg(TDT14),
  2473. igb_getreg(TDT15),
  2474. igb_getreg(TNCRS),
  2475. igb_getreg(RJC),
  2476. igb_getreg(IAM),
  2477. igb_getreg(GSCL_2),
  2478. igb_getreg(TIPG),
  2479. igb_getreg(FLMNGCTL),
  2480. igb_getreg(FLMNGCNT),
  2481. igb_getreg(TSYNCTXCTL),
  2482. igb_getreg(EEMNGDATA),
  2483. igb_getreg(CTRL_EXT),
  2484. igb_getreg(SYSTIMH),
  2485. igb_getreg(EEMNGCTL),
  2486. igb_getreg(FLMNGDATA),
  2487. igb_getreg(TSYNCRXCTL),
  2488. igb_getreg(LEDCTL),
  2489. igb_getreg(TCTL),
  2490. igb_getreg(TCTL_EXT),
  2491. igb_getreg(DTXCTL),
  2492. igb_getreg(RXPBS),
  2493. igb_getreg(TDH0),
  2494. igb_getreg(TDH1),
  2495. igb_getreg(TDH2),
  2496. igb_getreg(TDH3),
  2497. igb_getreg(TDH4),
  2498. igb_getreg(TDH5),
  2499. igb_getreg(TDH6),
  2500. igb_getreg(TDH7),
  2501. igb_getreg(TDH8),
  2502. igb_getreg(TDH9),
  2503. igb_getreg(TDH10),
  2504. igb_getreg(TDH11),
  2505. igb_getreg(TDH12),
  2506. igb_getreg(TDH13),
  2507. igb_getreg(TDH14),
  2508. igb_getreg(TDH15),
  2509. igb_getreg(ECOL),
  2510. igb_getreg(DC),
  2511. igb_getreg(RLEC),
  2512. igb_getreg(XOFFTXC),
  2513. igb_getreg(RFC),
  2514. igb_getreg(RNBC),
  2515. igb_getreg(MGTPTC),
  2516. igb_getreg(TIMINCA),
  2517. igb_getreg(FACTPS),
  2518. igb_getreg(GSCL_1),
  2519. igb_getreg(GSCN_0),
  2520. igb_getreg(PBACLR),
  2521. igb_getreg(FCTTV),
  2522. igb_getreg(RXSATRL),
  2523. igb_getreg(TORL),
  2524. igb_getreg(TDLEN0),
  2525. igb_getreg(TDLEN1),
  2526. igb_getreg(TDLEN2),
  2527. igb_getreg(TDLEN3),
  2528. igb_getreg(TDLEN4),
  2529. igb_getreg(TDLEN5),
  2530. igb_getreg(TDLEN6),
  2531. igb_getreg(TDLEN7),
  2532. igb_getreg(TDLEN8),
  2533. igb_getreg(TDLEN9),
  2534. igb_getreg(TDLEN10),
  2535. igb_getreg(TDLEN11),
  2536. igb_getreg(TDLEN12),
  2537. igb_getreg(TDLEN13),
  2538. igb_getreg(TDLEN14),
  2539. igb_getreg(TDLEN15),
  2540. igb_getreg(MCC),
  2541. igb_getreg(WUC),
  2542. igb_getreg(EECD),
  2543. igb_getreg(FCRTV),
  2544. igb_getreg(TXDCTL0),
  2545. igb_getreg(TXDCTL1),
  2546. igb_getreg(TXDCTL2),
  2547. igb_getreg(TXDCTL3),
  2548. igb_getreg(TXDCTL4),
  2549. igb_getreg(TXDCTL5),
  2550. igb_getreg(TXDCTL6),
  2551. igb_getreg(TXDCTL7),
  2552. igb_getreg(TXDCTL8),
  2553. igb_getreg(TXDCTL9),
  2554. igb_getreg(TXDCTL10),
  2555. igb_getreg(TXDCTL11),
  2556. igb_getreg(TXDCTL12),
  2557. igb_getreg(TXDCTL13),
  2558. igb_getreg(TXDCTL14),
  2559. igb_getreg(TXDCTL15),
  2560. igb_getreg(TXCTL0),
  2561. igb_getreg(TXCTL1),
  2562. igb_getreg(TXCTL2),
  2563. igb_getreg(TXCTL3),
  2564. igb_getreg(TXCTL4),
  2565. igb_getreg(TXCTL5),
  2566. igb_getreg(TXCTL6),
  2567. igb_getreg(TXCTL7),
  2568. igb_getreg(TXCTL8),
  2569. igb_getreg(TXCTL9),
  2570. igb_getreg(TXCTL10),
  2571. igb_getreg(TXCTL11),
  2572. igb_getreg(TXCTL12),
  2573. igb_getreg(TXCTL13),
  2574. igb_getreg(TXCTL14),
  2575. igb_getreg(TXCTL15),
  2576. igb_getreg(TDWBAL0),
  2577. igb_getreg(TDWBAL1),
  2578. igb_getreg(TDWBAL2),
  2579. igb_getreg(TDWBAL3),
  2580. igb_getreg(TDWBAL4),
  2581. igb_getreg(TDWBAL5),
  2582. igb_getreg(TDWBAL6),
  2583. igb_getreg(TDWBAL7),
  2584. igb_getreg(TDWBAL8),
  2585. igb_getreg(TDWBAL9),
  2586. igb_getreg(TDWBAL10),
  2587. igb_getreg(TDWBAL11),
  2588. igb_getreg(TDWBAL12),
  2589. igb_getreg(TDWBAL13),
  2590. igb_getreg(TDWBAL14),
  2591. igb_getreg(TDWBAL15),
  2592. igb_getreg(TDWBAH0),
  2593. igb_getreg(TDWBAH1),
  2594. igb_getreg(TDWBAH2),
  2595. igb_getreg(TDWBAH3),
  2596. igb_getreg(TDWBAH4),
  2597. igb_getreg(TDWBAH5),
  2598. igb_getreg(TDWBAH6),
  2599. igb_getreg(TDWBAH7),
  2600. igb_getreg(TDWBAH8),
  2601. igb_getreg(TDWBAH9),
  2602. igb_getreg(TDWBAH10),
  2603. igb_getreg(TDWBAH11),
  2604. igb_getreg(TDWBAH12),
  2605. igb_getreg(TDWBAH13),
  2606. igb_getreg(TDWBAH14),
  2607. igb_getreg(TDWBAH15),
  2608. igb_getreg(PVTCTRL0),
  2609. igb_getreg(PVTCTRL1),
  2610. igb_getreg(PVTCTRL2),
  2611. igb_getreg(PVTCTRL3),
  2612. igb_getreg(PVTCTRL4),
  2613. igb_getreg(PVTCTRL5),
  2614. igb_getreg(PVTCTRL6),
  2615. igb_getreg(PVTCTRL7),
  2616. igb_getreg(PVTEIMS0),
  2617. igb_getreg(PVTEIMS1),
  2618. igb_getreg(PVTEIMS2),
  2619. igb_getreg(PVTEIMS3),
  2620. igb_getreg(PVTEIMS4),
  2621. igb_getreg(PVTEIMS5),
  2622. igb_getreg(PVTEIMS6),
  2623. igb_getreg(PVTEIMS7),
  2624. igb_getreg(PVTEIAC0),
  2625. igb_getreg(PVTEIAC1),
  2626. igb_getreg(PVTEIAC2),
  2627. igb_getreg(PVTEIAC3),
  2628. igb_getreg(PVTEIAC4),
  2629. igb_getreg(PVTEIAC5),
  2630. igb_getreg(PVTEIAC6),
  2631. igb_getreg(PVTEIAC7),
  2632. igb_getreg(PVTEIAM0),
  2633. igb_getreg(PVTEIAM1),
  2634. igb_getreg(PVTEIAM2),
  2635. igb_getreg(PVTEIAM3),
  2636. igb_getreg(PVTEIAM4),
  2637. igb_getreg(PVTEIAM5),
  2638. igb_getreg(PVTEIAM6),
  2639. igb_getreg(PVTEIAM7),
  2640. igb_getreg(PVFGPRC0),
  2641. igb_getreg(PVFGPRC1),
  2642. igb_getreg(PVFGPRC2),
  2643. igb_getreg(PVFGPRC3),
  2644. igb_getreg(PVFGPRC4),
  2645. igb_getreg(PVFGPRC5),
  2646. igb_getreg(PVFGPRC6),
  2647. igb_getreg(PVFGPRC7),
  2648. igb_getreg(PVFGPTC0),
  2649. igb_getreg(PVFGPTC1),
  2650. igb_getreg(PVFGPTC2),
  2651. igb_getreg(PVFGPTC3),
  2652. igb_getreg(PVFGPTC4),
  2653. igb_getreg(PVFGPTC5),
  2654. igb_getreg(PVFGPTC6),
  2655. igb_getreg(PVFGPTC7),
  2656. igb_getreg(PVFGORC0),
  2657. igb_getreg(PVFGORC1),
  2658. igb_getreg(PVFGORC2),
  2659. igb_getreg(PVFGORC3),
  2660. igb_getreg(PVFGORC4),
  2661. igb_getreg(PVFGORC5),
  2662. igb_getreg(PVFGORC6),
  2663. igb_getreg(PVFGORC7),
  2664. igb_getreg(PVFGOTC0),
  2665. igb_getreg(PVFGOTC1),
  2666. igb_getreg(PVFGOTC2),
  2667. igb_getreg(PVFGOTC3),
  2668. igb_getreg(PVFGOTC4),
  2669. igb_getreg(PVFGOTC5),
  2670. igb_getreg(PVFGOTC6),
  2671. igb_getreg(PVFGOTC7),
  2672. igb_getreg(PVFMPRC0),
  2673. igb_getreg(PVFMPRC1),
  2674. igb_getreg(PVFMPRC2),
  2675. igb_getreg(PVFMPRC3),
  2676. igb_getreg(PVFMPRC4),
  2677. igb_getreg(PVFMPRC5),
  2678. igb_getreg(PVFMPRC6),
  2679. igb_getreg(PVFMPRC7),
  2680. igb_getreg(PVFGPRLBC0),
  2681. igb_getreg(PVFGPRLBC1),
  2682. igb_getreg(PVFGPRLBC2),
  2683. igb_getreg(PVFGPRLBC3),
  2684. igb_getreg(PVFGPRLBC4),
  2685. igb_getreg(PVFGPRLBC5),
  2686. igb_getreg(PVFGPRLBC6),
  2687. igb_getreg(PVFGPRLBC7),
  2688. igb_getreg(PVFGPTLBC0),
  2689. igb_getreg(PVFGPTLBC1),
  2690. igb_getreg(PVFGPTLBC2),
  2691. igb_getreg(PVFGPTLBC3),
  2692. igb_getreg(PVFGPTLBC4),
  2693. igb_getreg(PVFGPTLBC5),
  2694. igb_getreg(PVFGPTLBC6),
  2695. igb_getreg(PVFGPTLBC7),
  2696. igb_getreg(PVFGORLBC0),
  2697. igb_getreg(PVFGORLBC1),
  2698. igb_getreg(PVFGORLBC2),
  2699. igb_getreg(PVFGORLBC3),
  2700. igb_getreg(PVFGORLBC4),
  2701. igb_getreg(PVFGORLBC5),
  2702. igb_getreg(PVFGORLBC6),
  2703. igb_getreg(PVFGORLBC7),
  2704. igb_getreg(PVFGOTLBC0),
  2705. igb_getreg(PVFGOTLBC1),
  2706. igb_getreg(PVFGOTLBC2),
  2707. igb_getreg(PVFGOTLBC3),
  2708. igb_getreg(PVFGOTLBC4),
  2709. igb_getreg(PVFGOTLBC5),
  2710. igb_getreg(PVFGOTLBC6),
  2711. igb_getreg(PVFGOTLBC7),
  2712. igb_getreg(RCTL),
  2713. igb_getreg(MDIC),
  2714. igb_getreg(FCRUC),
  2715. igb_getreg(VET),
  2716. igb_getreg(RDBAL0),
  2717. igb_getreg(RDBAL1),
  2718. igb_getreg(RDBAL2),
  2719. igb_getreg(RDBAL3),
  2720. igb_getreg(RDBAL4),
  2721. igb_getreg(RDBAL5),
  2722. igb_getreg(RDBAL6),
  2723. igb_getreg(RDBAL7),
  2724. igb_getreg(RDBAL8),
  2725. igb_getreg(RDBAL9),
  2726. igb_getreg(RDBAL10),
  2727. igb_getreg(RDBAL11),
  2728. igb_getreg(RDBAL12),
  2729. igb_getreg(RDBAL13),
  2730. igb_getreg(RDBAL14),
  2731. igb_getreg(RDBAL15),
  2732. igb_getreg(TDBAH0),
  2733. igb_getreg(TDBAH1),
  2734. igb_getreg(TDBAH2),
  2735. igb_getreg(TDBAH3),
  2736. igb_getreg(TDBAH4),
  2737. igb_getreg(TDBAH5),
  2738. igb_getreg(TDBAH6),
  2739. igb_getreg(TDBAH7),
  2740. igb_getreg(TDBAH8),
  2741. igb_getreg(TDBAH9),
  2742. igb_getreg(TDBAH10),
  2743. igb_getreg(TDBAH11),
  2744. igb_getreg(TDBAH12),
  2745. igb_getreg(TDBAH13),
  2746. igb_getreg(TDBAH14),
  2747. igb_getreg(TDBAH15),
  2748. igb_getreg(SCC),
  2749. igb_getreg(COLC),
  2750. igb_getreg(XOFFRXC),
  2751. igb_getreg(IPAV),
  2752. igb_getreg(GOTCL),
  2753. igb_getreg(MGTPDC),
  2754. igb_getreg(GCR),
  2755. igb_getreg(MFVAL),
  2756. igb_getreg(FUNCTAG),
  2757. igb_getreg(GSCL_4),
  2758. igb_getreg(GSCN_3),
  2759. igb_getreg(MRQC),
  2760. igb_getreg(FCT),
  2761. igb_getreg(FLA),
  2762. igb_getreg(RXDCTL0),
  2763. igb_getreg(RXDCTL1),
  2764. igb_getreg(RXDCTL2),
  2765. igb_getreg(RXDCTL3),
  2766. igb_getreg(RXDCTL4),
  2767. igb_getreg(RXDCTL5),
  2768. igb_getreg(RXDCTL6),
  2769. igb_getreg(RXDCTL7),
  2770. igb_getreg(RXDCTL8),
  2771. igb_getreg(RXDCTL9),
  2772. igb_getreg(RXDCTL10),
  2773. igb_getreg(RXDCTL11),
  2774. igb_getreg(RXDCTL12),
  2775. igb_getreg(RXDCTL13),
  2776. igb_getreg(RXDCTL14),
  2777. igb_getreg(RXDCTL15),
  2778. igb_getreg(RXSTMPL),
  2779. igb_getreg(TIMADJH),
  2780. igb_getreg(FCRTL),
  2781. igb_getreg(XONRXC),
  2782. igb_getreg(RFCTL),
  2783. igb_getreg(GSCN_1),
  2784. igb_getreg(FCAL),
  2785. igb_getreg(GPIE),
  2786. igb_getreg(TXPBS),
  2787. igb_getreg(RLPML),
  2788. [TOTH] = igb_mac_read_clr8,
  2789. [GOTCH] = igb_mac_read_clr8,
  2790. [PRC64] = igb_mac_read_clr4,
  2791. [PRC255] = igb_mac_read_clr4,
  2792. [PRC1023] = igb_mac_read_clr4,
  2793. [PTC64] = igb_mac_read_clr4,
  2794. [PTC255] = igb_mac_read_clr4,
  2795. [PTC1023] = igb_mac_read_clr4,
  2796. [GPRC] = igb_mac_read_clr4,
  2797. [TPT] = igb_mac_read_clr4,
  2798. [RUC] = igb_mac_read_clr4,
  2799. [BPRC] = igb_mac_read_clr4,
  2800. [MPTC] = igb_mac_read_clr4,
  2801. [IAC] = igb_mac_read_clr4,
  2802. [ICR] = igb_mac_icr_read,
  2803. [STATUS] = igb_get_status,
  2804. [ICS] = igb_mac_ics_read,
  2805. /*
  2806. * 8.8.10: Reading the IMC register returns the value of the IMS register.
  2807. */
  2808. [IMC] = igb_mac_ims_read,
  2809. [TORH] = igb_mac_read_clr8,
  2810. [GORCH] = igb_mac_read_clr8,
  2811. [PRC127] = igb_mac_read_clr4,
  2812. [PRC511] = igb_mac_read_clr4,
  2813. [PRC1522] = igb_mac_read_clr4,
  2814. [PTC127] = igb_mac_read_clr4,
  2815. [PTC511] = igb_mac_read_clr4,
  2816. [PTC1522] = igb_mac_read_clr4,
  2817. [GPTC] = igb_mac_read_clr4,
  2818. [TPR] = igb_mac_read_clr4,
  2819. [ROC] = igb_mac_read_clr4,
  2820. [MPRC] = igb_mac_read_clr4,
  2821. [BPTC] = igb_mac_read_clr4,
  2822. [TSCTC] = igb_mac_read_clr4,
  2823. [CTRL] = igb_get_ctrl,
  2824. [SWSM] = igb_mac_swsm_read,
  2825. [IMS] = igb_mac_ims_read,
  2826. [SYSTIML] = igb_get_systiml,
  2827. [RXSATRH] = igb_get_rxsatrh,
  2828. [TXSTMPH] = igb_get_txstmph,
  2829. [CRCERRS ... MPC] = igb_mac_readreg,
  2830. [IP6AT ... IP6AT + 3] = igb_mac_readreg,
  2831. [IP4AT ... IP4AT + 6] = igb_mac_readreg,
  2832. [RA ... RA + 31] = igb_mac_readreg,
  2833. [RA2 ... RA2 + 31] = igb_mac_readreg,
  2834. [WUPM ... WUPM + 31] = igb_mac_readreg,
  2835. [MTA ... MTA + E1000_MC_TBL_SIZE - 1] = igb_mac_readreg,
  2836. [VFTA ... VFTA + E1000_VLAN_FILTER_TBL_SIZE - 1] = igb_mac_readreg,
  2837. [FFMT ... FFMT + 254] = igb_mac_readreg,
  2838. [MDEF ... MDEF + 7] = igb_mac_readreg,
  2839. [FTFT ... FTFT + 254] = igb_mac_readreg,
  2840. [RETA ... RETA + 31] = igb_mac_readreg,
  2841. [RSSRK ... RSSRK + 9] = igb_mac_readreg,
  2842. [MAVTV0 ... MAVTV3] = igb_mac_readreg,
  2843. [EITR0 ... EITR0 + IGB_INTR_NUM - 1] = igb_mac_eitr_read,
  2844. [PVTEICR0] = igb_mac_read_clr4,
  2845. [PVTEICR1] = igb_mac_read_clr4,
  2846. [PVTEICR2] = igb_mac_read_clr4,
  2847. [PVTEICR3] = igb_mac_read_clr4,
  2848. [PVTEICR4] = igb_mac_read_clr4,
  2849. [PVTEICR5] = igb_mac_read_clr4,
  2850. [PVTEICR6] = igb_mac_read_clr4,
  2851. [PVTEICR7] = igb_mac_read_clr4,
  2852. /* IGB specific: */
  2853. [FWSM] = igb_mac_readreg,
  2854. [SW_FW_SYNC] = igb_mac_readreg,
  2855. [HTCBDPC] = igb_mac_read_clr4,
  2856. [EICR] = igb_mac_read_clr4,
  2857. [EIMS] = igb_mac_readreg,
  2858. [EIAM] = igb_mac_readreg,
  2859. [IVAR0 ... IVAR0 + 7] = igb_mac_readreg,
  2860. igb_getreg(IVAR_MISC),
  2861. igb_getreg(TSYNCRXCFG),
  2862. [ETQF0 ... ETQF0 + 7] = igb_mac_readreg,
  2863. igb_getreg(VT_CTL),
  2864. [P2VMAILBOX0 ... P2VMAILBOX7] = igb_mac_readreg,
  2865. [V2PMAILBOX0 ... V2PMAILBOX7] = igb_mac_vfmailbox_read,
  2866. igb_getreg(MBVFICR),
  2867. [VMBMEM0 ... VMBMEM0 + 127] = igb_mac_readreg,
  2868. igb_getreg(MBVFIMR),
  2869. igb_getreg(VFLRE),
  2870. igb_getreg(VFRE),
  2871. igb_getreg(VFTE),
  2872. igb_getreg(QDE),
  2873. igb_getreg(DTXSWC),
  2874. igb_getreg(RPLOLR),
  2875. [VLVF0 ... VLVF0 + E1000_VLVF_ARRAY_SIZE - 1] = igb_mac_readreg,
  2876. [VMVIR0 ... VMVIR7] = igb_mac_readreg,
  2877. [VMOLR0 ... VMOLR7] = igb_mac_readreg,
  2878. [WVBR] = igb_mac_read_clr4,
  2879. [RQDPC0] = igb_mac_read_clr4,
  2880. [RQDPC1] = igb_mac_read_clr4,
  2881. [RQDPC2] = igb_mac_read_clr4,
  2882. [RQDPC3] = igb_mac_read_clr4,
  2883. [RQDPC4] = igb_mac_read_clr4,
  2884. [RQDPC5] = igb_mac_read_clr4,
  2885. [RQDPC6] = igb_mac_read_clr4,
  2886. [RQDPC7] = igb_mac_read_clr4,
  2887. [RQDPC8] = igb_mac_read_clr4,
  2888. [RQDPC9] = igb_mac_read_clr4,
  2889. [RQDPC10] = igb_mac_read_clr4,
  2890. [RQDPC11] = igb_mac_read_clr4,
  2891. [RQDPC12] = igb_mac_read_clr4,
  2892. [RQDPC13] = igb_mac_read_clr4,
  2893. [RQDPC14] = igb_mac_read_clr4,
  2894. [RQDPC15] = igb_mac_read_clr4,
  2895. [VTIVAR ... VTIVAR + 7] = igb_mac_readreg,
  2896. [VTIVAR_MISC ... VTIVAR_MISC + 7] = igb_mac_readreg,
  2897. };
  2898. enum { IGB_NREADOPS = ARRAY_SIZE(igb_macreg_readops) };
  2899. #define igb_putreg(x) [x] = igb_mac_writereg
  2900. typedef void (*writeops)(IGBCore *, int, uint32_t);
  2901. static const writeops igb_macreg_writeops[] = {
  2902. igb_putreg(SWSM),
  2903. igb_putreg(WUFC),
  2904. igb_putreg(RDBAH0),
  2905. igb_putreg(RDBAH1),
  2906. igb_putreg(RDBAH2),
  2907. igb_putreg(RDBAH3),
  2908. igb_putreg(RDBAH4),
  2909. igb_putreg(RDBAH5),
  2910. igb_putreg(RDBAH6),
  2911. igb_putreg(RDBAH7),
  2912. igb_putreg(RDBAH8),
  2913. igb_putreg(RDBAH9),
  2914. igb_putreg(RDBAH10),
  2915. igb_putreg(RDBAH11),
  2916. igb_putreg(RDBAH12),
  2917. igb_putreg(RDBAH13),
  2918. igb_putreg(RDBAH14),
  2919. igb_putreg(RDBAH15),
  2920. igb_putreg(SRRCTL0),
  2921. igb_putreg(SRRCTL1),
  2922. igb_putreg(SRRCTL2),
  2923. igb_putreg(SRRCTL3),
  2924. igb_putreg(SRRCTL4),
  2925. igb_putreg(SRRCTL5),
  2926. igb_putreg(SRRCTL6),
  2927. igb_putreg(SRRCTL7),
  2928. igb_putreg(SRRCTL8),
  2929. igb_putreg(SRRCTL9),
  2930. igb_putreg(SRRCTL10),
  2931. igb_putreg(SRRCTL11),
  2932. igb_putreg(SRRCTL12),
  2933. igb_putreg(SRRCTL13),
  2934. igb_putreg(SRRCTL14),
  2935. igb_putreg(SRRCTL15),
  2936. igb_putreg(RXDCTL0),
  2937. igb_putreg(RXDCTL1),
  2938. igb_putreg(RXDCTL2),
  2939. igb_putreg(RXDCTL3),
  2940. igb_putreg(RXDCTL4),
  2941. igb_putreg(RXDCTL5),
  2942. igb_putreg(RXDCTL6),
  2943. igb_putreg(RXDCTL7),
  2944. igb_putreg(RXDCTL8),
  2945. igb_putreg(RXDCTL9),
  2946. igb_putreg(RXDCTL10),
  2947. igb_putreg(RXDCTL11),
  2948. igb_putreg(RXDCTL12),
  2949. igb_putreg(RXDCTL13),
  2950. igb_putreg(RXDCTL14),
  2951. igb_putreg(RXDCTL15),
  2952. igb_putreg(LEDCTL),
  2953. igb_putreg(TCTL),
  2954. igb_putreg(TCTL_EXT),
  2955. igb_putreg(DTXCTL),
  2956. igb_putreg(RXPBS),
  2957. igb_putreg(RQDPC0),
  2958. igb_putreg(FCAL),
  2959. igb_putreg(FCRUC),
  2960. igb_putreg(WUC),
  2961. igb_putreg(WUS),
  2962. igb_putreg(IPAV),
  2963. igb_putreg(TDBAH0),
  2964. igb_putreg(TDBAH1),
  2965. igb_putreg(TDBAH2),
  2966. igb_putreg(TDBAH3),
  2967. igb_putreg(TDBAH4),
  2968. igb_putreg(TDBAH5),
  2969. igb_putreg(TDBAH6),
  2970. igb_putreg(TDBAH7),
  2971. igb_putreg(TDBAH8),
  2972. igb_putreg(TDBAH9),
  2973. igb_putreg(TDBAH10),
  2974. igb_putreg(TDBAH11),
  2975. igb_putreg(TDBAH12),
  2976. igb_putreg(TDBAH13),
  2977. igb_putreg(TDBAH14),
  2978. igb_putreg(TDBAH15),
  2979. igb_putreg(IAM),
  2980. igb_putreg(MANC),
  2981. igb_putreg(MANC2H),
  2982. igb_putreg(MFVAL),
  2983. igb_putreg(FACTPS),
  2984. igb_putreg(FUNCTAG),
  2985. igb_putreg(GSCL_1),
  2986. igb_putreg(GSCL_2),
  2987. igb_putreg(GSCL_3),
  2988. igb_putreg(GSCL_4),
  2989. igb_putreg(GSCN_0),
  2990. igb_putreg(GSCN_1),
  2991. igb_putreg(GSCN_2),
  2992. igb_putreg(GSCN_3),
  2993. igb_putreg(MRQC),
  2994. igb_putreg(FLOP),
  2995. igb_putreg(FLA),
  2996. igb_putreg(TXDCTL0),
  2997. igb_putreg(TXDCTL1),
  2998. igb_putreg(TXDCTL2),
  2999. igb_putreg(TXDCTL3),
  3000. igb_putreg(TXDCTL4),
  3001. igb_putreg(TXDCTL5),
  3002. igb_putreg(TXDCTL6),
  3003. igb_putreg(TXDCTL7),
  3004. igb_putreg(TXDCTL8),
  3005. igb_putreg(TXDCTL9),
  3006. igb_putreg(TXDCTL10),
  3007. igb_putreg(TXDCTL11),
  3008. igb_putreg(TXDCTL12),
  3009. igb_putreg(TXDCTL13),
  3010. igb_putreg(TXDCTL14),
  3011. igb_putreg(TXDCTL15),
  3012. igb_putreg(TXCTL0),
  3013. igb_putreg(TXCTL1),
  3014. igb_putreg(TXCTL2),
  3015. igb_putreg(TXCTL3),
  3016. igb_putreg(TXCTL4),
  3017. igb_putreg(TXCTL5),
  3018. igb_putreg(TXCTL6),
  3019. igb_putreg(TXCTL7),
  3020. igb_putreg(TXCTL8),
  3021. igb_putreg(TXCTL9),
  3022. igb_putreg(TXCTL10),
  3023. igb_putreg(TXCTL11),
  3024. igb_putreg(TXCTL12),
  3025. igb_putreg(TXCTL13),
  3026. igb_putreg(TXCTL14),
  3027. igb_putreg(TXCTL15),
  3028. igb_putreg(TDWBAL0),
  3029. igb_putreg(TDWBAL1),
  3030. igb_putreg(TDWBAL2),
  3031. igb_putreg(TDWBAL3),
  3032. igb_putreg(TDWBAL4),
  3033. igb_putreg(TDWBAL5),
  3034. igb_putreg(TDWBAL6),
  3035. igb_putreg(TDWBAL7),
  3036. igb_putreg(TDWBAL8),
  3037. igb_putreg(TDWBAL9),
  3038. igb_putreg(TDWBAL10),
  3039. igb_putreg(TDWBAL11),
  3040. igb_putreg(TDWBAL12),
  3041. igb_putreg(TDWBAL13),
  3042. igb_putreg(TDWBAL14),
  3043. igb_putreg(TDWBAL15),
  3044. igb_putreg(TDWBAH0),
  3045. igb_putreg(TDWBAH1),
  3046. igb_putreg(TDWBAH2),
  3047. igb_putreg(TDWBAH3),
  3048. igb_putreg(TDWBAH4),
  3049. igb_putreg(TDWBAH5),
  3050. igb_putreg(TDWBAH6),
  3051. igb_putreg(TDWBAH7),
  3052. igb_putreg(TDWBAH8),
  3053. igb_putreg(TDWBAH9),
  3054. igb_putreg(TDWBAH10),
  3055. igb_putreg(TDWBAH11),
  3056. igb_putreg(TDWBAH12),
  3057. igb_putreg(TDWBAH13),
  3058. igb_putreg(TDWBAH14),
  3059. igb_putreg(TDWBAH15),
  3060. igb_putreg(TIPG),
  3061. igb_putreg(RXSTMPH),
  3062. igb_putreg(RXSTMPL),
  3063. igb_putreg(RXSATRL),
  3064. igb_putreg(RXSATRH),
  3065. igb_putreg(TXSTMPL),
  3066. igb_putreg(TXSTMPH),
  3067. igb_putreg(SYSTIML),
  3068. igb_putreg(SYSTIMH),
  3069. igb_putreg(TIMADJL),
  3070. igb_putreg(TSYNCRXCTL),
  3071. igb_putreg(TSYNCTXCTL),
  3072. igb_putreg(EEMNGCTL),
  3073. igb_putreg(GPIE),
  3074. igb_putreg(TXPBS),
  3075. igb_putreg(RLPML),
  3076. igb_putreg(VET),
  3077. [TDH0] = igb_set_16bit,
  3078. [TDH1] = igb_set_16bit,
  3079. [TDH2] = igb_set_16bit,
  3080. [TDH3] = igb_set_16bit,
  3081. [TDH4] = igb_set_16bit,
  3082. [TDH5] = igb_set_16bit,
  3083. [TDH6] = igb_set_16bit,
  3084. [TDH7] = igb_set_16bit,
  3085. [TDH8] = igb_set_16bit,
  3086. [TDH9] = igb_set_16bit,
  3087. [TDH10] = igb_set_16bit,
  3088. [TDH11] = igb_set_16bit,
  3089. [TDH12] = igb_set_16bit,
  3090. [TDH13] = igb_set_16bit,
  3091. [TDH14] = igb_set_16bit,
  3092. [TDH15] = igb_set_16bit,
  3093. [TDT0] = igb_set_tdt,
  3094. [TDT1] = igb_set_tdt,
  3095. [TDT2] = igb_set_tdt,
  3096. [TDT3] = igb_set_tdt,
  3097. [TDT4] = igb_set_tdt,
  3098. [TDT5] = igb_set_tdt,
  3099. [TDT6] = igb_set_tdt,
  3100. [TDT7] = igb_set_tdt,
  3101. [TDT8] = igb_set_tdt,
  3102. [TDT9] = igb_set_tdt,
  3103. [TDT10] = igb_set_tdt,
  3104. [TDT11] = igb_set_tdt,
  3105. [TDT12] = igb_set_tdt,
  3106. [TDT13] = igb_set_tdt,
  3107. [TDT14] = igb_set_tdt,
  3108. [TDT15] = igb_set_tdt,
  3109. [MDIC] = igb_set_mdic,
  3110. [ICS] = igb_set_ics,
  3111. [RDH0] = igb_set_16bit,
  3112. [RDH1] = igb_set_16bit,
  3113. [RDH2] = igb_set_16bit,
  3114. [RDH3] = igb_set_16bit,
  3115. [RDH4] = igb_set_16bit,
  3116. [RDH5] = igb_set_16bit,
  3117. [RDH6] = igb_set_16bit,
  3118. [RDH7] = igb_set_16bit,
  3119. [RDH8] = igb_set_16bit,
  3120. [RDH9] = igb_set_16bit,
  3121. [RDH10] = igb_set_16bit,
  3122. [RDH11] = igb_set_16bit,
  3123. [RDH12] = igb_set_16bit,
  3124. [RDH13] = igb_set_16bit,
  3125. [RDH14] = igb_set_16bit,
  3126. [RDH15] = igb_set_16bit,
  3127. [RDT0] = igb_set_rdt,
  3128. [RDT1] = igb_set_rdt,
  3129. [RDT2] = igb_set_rdt,
  3130. [RDT3] = igb_set_rdt,
  3131. [RDT4] = igb_set_rdt,
  3132. [RDT5] = igb_set_rdt,
  3133. [RDT6] = igb_set_rdt,
  3134. [RDT7] = igb_set_rdt,
  3135. [RDT8] = igb_set_rdt,
  3136. [RDT9] = igb_set_rdt,
  3137. [RDT10] = igb_set_rdt,
  3138. [RDT11] = igb_set_rdt,
  3139. [RDT12] = igb_set_rdt,
  3140. [RDT13] = igb_set_rdt,
  3141. [RDT14] = igb_set_rdt,
  3142. [RDT15] = igb_set_rdt,
  3143. [IMC] = igb_set_imc,
  3144. [IMS] = igb_set_ims,
  3145. [ICR] = igb_set_icr,
  3146. [EECD] = igb_set_eecd,
  3147. [RCTL] = igb_set_rx_control,
  3148. [CTRL] = igb_set_ctrl,
  3149. [EERD] = igb_set_eerd,
  3150. [TDFH] = igb_set_13bit,
  3151. [TDFT] = igb_set_13bit,
  3152. [TDFHS] = igb_set_13bit,
  3153. [TDFTS] = igb_set_13bit,
  3154. [TDFPC] = igb_set_13bit,
  3155. [RDFH] = igb_set_13bit,
  3156. [RDFT] = igb_set_13bit,
  3157. [RDFHS] = igb_set_13bit,
  3158. [RDFTS] = igb_set_13bit,
  3159. [RDFPC] = igb_set_13bit,
  3160. [GCR] = igb_set_gcr,
  3161. [RXCSUM] = igb_set_rxcsum,
  3162. [TDLEN0] = igb_set_dlen,
  3163. [TDLEN1] = igb_set_dlen,
  3164. [TDLEN2] = igb_set_dlen,
  3165. [TDLEN3] = igb_set_dlen,
  3166. [TDLEN4] = igb_set_dlen,
  3167. [TDLEN5] = igb_set_dlen,
  3168. [TDLEN6] = igb_set_dlen,
  3169. [TDLEN7] = igb_set_dlen,
  3170. [TDLEN8] = igb_set_dlen,
  3171. [TDLEN9] = igb_set_dlen,
  3172. [TDLEN10] = igb_set_dlen,
  3173. [TDLEN11] = igb_set_dlen,
  3174. [TDLEN12] = igb_set_dlen,
  3175. [TDLEN13] = igb_set_dlen,
  3176. [TDLEN14] = igb_set_dlen,
  3177. [TDLEN15] = igb_set_dlen,
  3178. [RDLEN0] = igb_set_dlen,
  3179. [RDLEN1] = igb_set_dlen,
  3180. [RDLEN2] = igb_set_dlen,
  3181. [RDLEN3] = igb_set_dlen,
  3182. [RDLEN4] = igb_set_dlen,
  3183. [RDLEN5] = igb_set_dlen,
  3184. [RDLEN6] = igb_set_dlen,
  3185. [RDLEN7] = igb_set_dlen,
  3186. [RDLEN8] = igb_set_dlen,
  3187. [RDLEN9] = igb_set_dlen,
  3188. [RDLEN10] = igb_set_dlen,
  3189. [RDLEN11] = igb_set_dlen,
  3190. [RDLEN12] = igb_set_dlen,
  3191. [RDLEN13] = igb_set_dlen,
  3192. [RDLEN14] = igb_set_dlen,
  3193. [RDLEN15] = igb_set_dlen,
  3194. [TDBAL0] = igb_set_dbal,
  3195. [TDBAL1] = igb_set_dbal,
  3196. [TDBAL2] = igb_set_dbal,
  3197. [TDBAL3] = igb_set_dbal,
  3198. [TDBAL4] = igb_set_dbal,
  3199. [TDBAL5] = igb_set_dbal,
  3200. [TDBAL6] = igb_set_dbal,
  3201. [TDBAL7] = igb_set_dbal,
  3202. [TDBAL8] = igb_set_dbal,
  3203. [TDBAL9] = igb_set_dbal,
  3204. [TDBAL10] = igb_set_dbal,
  3205. [TDBAL11] = igb_set_dbal,
  3206. [TDBAL12] = igb_set_dbal,
  3207. [TDBAL13] = igb_set_dbal,
  3208. [TDBAL14] = igb_set_dbal,
  3209. [TDBAL15] = igb_set_dbal,
  3210. [RDBAL0] = igb_set_dbal,
  3211. [RDBAL1] = igb_set_dbal,
  3212. [RDBAL2] = igb_set_dbal,
  3213. [RDBAL3] = igb_set_dbal,
  3214. [RDBAL4] = igb_set_dbal,
  3215. [RDBAL5] = igb_set_dbal,
  3216. [RDBAL6] = igb_set_dbal,
  3217. [RDBAL7] = igb_set_dbal,
  3218. [RDBAL8] = igb_set_dbal,
  3219. [RDBAL9] = igb_set_dbal,
  3220. [RDBAL10] = igb_set_dbal,
  3221. [RDBAL11] = igb_set_dbal,
  3222. [RDBAL12] = igb_set_dbal,
  3223. [RDBAL13] = igb_set_dbal,
  3224. [RDBAL14] = igb_set_dbal,
  3225. [RDBAL15] = igb_set_dbal,
  3226. [STATUS] = igb_set_status,
  3227. [PBACLR] = igb_set_pbaclr,
  3228. [CTRL_EXT] = igb_set_ctrlext,
  3229. [FCAH] = igb_set_16bit,
  3230. [FCT] = igb_set_16bit,
  3231. [FCTTV] = igb_set_16bit,
  3232. [FCRTV] = igb_set_16bit,
  3233. [FCRTH] = igb_set_fcrth,
  3234. [FCRTL] = igb_set_fcrtl,
  3235. [CTRL_DUP] = igb_set_ctrl,
  3236. [RFCTL] = igb_set_rfctl,
  3237. [TIMINCA] = igb_set_timinca,
  3238. [TIMADJH] = igb_set_timadjh,
  3239. [IP6AT ... IP6AT + 3] = igb_mac_writereg,
  3240. [IP4AT ... IP4AT + 6] = igb_mac_writereg,
  3241. [RA] = igb_mac_writereg,
  3242. [RA + 1] = igb_mac_setmacaddr,
  3243. [RA + 2 ... RA + 31] = igb_mac_writereg,
  3244. [RA2 ... RA2 + 31] = igb_mac_writereg,
  3245. [WUPM ... WUPM + 31] = igb_mac_writereg,
  3246. [MTA ... MTA + E1000_MC_TBL_SIZE - 1] = igb_mac_writereg,
  3247. [VFTA ... VFTA + E1000_VLAN_FILTER_TBL_SIZE - 1] = igb_mac_writereg,
  3248. [FFMT ... FFMT + 254] = igb_set_4bit,
  3249. [MDEF ... MDEF + 7] = igb_mac_writereg,
  3250. [FTFT ... FTFT + 254] = igb_mac_writereg,
  3251. [RETA ... RETA + 31] = igb_mac_writereg,
  3252. [RSSRK ... RSSRK + 9] = igb_mac_writereg,
  3253. [MAVTV0 ... MAVTV3] = igb_mac_writereg,
  3254. [EITR0 ... EITR0 + IGB_INTR_NUM - 1] = igb_set_eitr,
  3255. /* IGB specific: */
  3256. [FWSM] = igb_mac_writereg,
  3257. [SW_FW_SYNC] = igb_mac_writereg,
  3258. [EICR] = igb_set_eicr,
  3259. [EICS] = igb_set_eics,
  3260. [EIAC] = igb_set_eiac,
  3261. [EIAM] = igb_set_eiam,
  3262. [EIMC] = igb_set_eimc,
  3263. [EIMS] = igb_set_eims,
  3264. [IVAR0 ... IVAR0 + 7] = igb_mac_writereg,
  3265. igb_putreg(IVAR_MISC),
  3266. igb_putreg(TSYNCRXCFG),
  3267. [ETQF0 ... ETQF0 + 7] = igb_mac_writereg,
  3268. igb_putreg(VT_CTL),
  3269. [P2VMAILBOX0 ... P2VMAILBOX7] = igb_set_pfmailbox,
  3270. [V2PMAILBOX0 ... V2PMAILBOX7] = igb_set_vfmailbox,
  3271. [MBVFICR] = igb_w1c,
  3272. [VMBMEM0 ... VMBMEM0 + 127] = igb_mac_writereg,
  3273. igb_putreg(MBVFIMR),
  3274. [VFLRE] = igb_w1c,
  3275. igb_putreg(VFRE),
  3276. igb_putreg(VFTE),
  3277. igb_putreg(QDE),
  3278. igb_putreg(DTXSWC),
  3279. igb_putreg(RPLOLR),
  3280. [VLVF0 ... VLVF0 + E1000_VLVF_ARRAY_SIZE - 1] = igb_mac_writereg,
  3281. [VMVIR0 ... VMVIR7] = igb_mac_writereg,
  3282. [VMOLR0 ... VMOLR7] = igb_mac_writereg,
  3283. [UTA ... UTA + E1000_MC_TBL_SIZE - 1] = igb_mac_writereg,
  3284. [PVTCTRL0] = igb_set_vtctrl,
  3285. [PVTCTRL1] = igb_set_vtctrl,
  3286. [PVTCTRL2] = igb_set_vtctrl,
  3287. [PVTCTRL3] = igb_set_vtctrl,
  3288. [PVTCTRL4] = igb_set_vtctrl,
  3289. [PVTCTRL5] = igb_set_vtctrl,
  3290. [PVTCTRL6] = igb_set_vtctrl,
  3291. [PVTCTRL7] = igb_set_vtctrl,
  3292. [PVTEICS0] = igb_set_vteics,
  3293. [PVTEICS1] = igb_set_vteics,
  3294. [PVTEICS2] = igb_set_vteics,
  3295. [PVTEICS3] = igb_set_vteics,
  3296. [PVTEICS4] = igb_set_vteics,
  3297. [PVTEICS5] = igb_set_vteics,
  3298. [PVTEICS6] = igb_set_vteics,
  3299. [PVTEICS7] = igb_set_vteics,
  3300. [PVTEIMS0] = igb_set_vteims,
  3301. [PVTEIMS1] = igb_set_vteims,
  3302. [PVTEIMS2] = igb_set_vteims,
  3303. [PVTEIMS3] = igb_set_vteims,
  3304. [PVTEIMS4] = igb_set_vteims,
  3305. [PVTEIMS5] = igb_set_vteims,
  3306. [PVTEIMS6] = igb_set_vteims,
  3307. [PVTEIMS7] = igb_set_vteims,
  3308. [PVTEIMC0] = igb_set_vteimc,
  3309. [PVTEIMC1] = igb_set_vteimc,
  3310. [PVTEIMC2] = igb_set_vteimc,
  3311. [PVTEIMC3] = igb_set_vteimc,
  3312. [PVTEIMC4] = igb_set_vteimc,
  3313. [PVTEIMC5] = igb_set_vteimc,
  3314. [PVTEIMC6] = igb_set_vteimc,
  3315. [PVTEIMC7] = igb_set_vteimc,
  3316. [PVTEIAC0] = igb_set_vteiac,
  3317. [PVTEIAC1] = igb_set_vteiac,
  3318. [PVTEIAC2] = igb_set_vteiac,
  3319. [PVTEIAC3] = igb_set_vteiac,
  3320. [PVTEIAC4] = igb_set_vteiac,
  3321. [PVTEIAC5] = igb_set_vteiac,
  3322. [PVTEIAC6] = igb_set_vteiac,
  3323. [PVTEIAC7] = igb_set_vteiac,
  3324. [PVTEIAM0] = igb_set_vteiam,
  3325. [PVTEIAM1] = igb_set_vteiam,
  3326. [PVTEIAM2] = igb_set_vteiam,
  3327. [PVTEIAM3] = igb_set_vteiam,
  3328. [PVTEIAM4] = igb_set_vteiam,
  3329. [PVTEIAM5] = igb_set_vteiam,
  3330. [PVTEIAM6] = igb_set_vteiam,
  3331. [PVTEIAM7] = igb_set_vteiam,
  3332. [PVTEICR0] = igb_set_vteicr,
  3333. [PVTEICR1] = igb_set_vteicr,
  3334. [PVTEICR2] = igb_set_vteicr,
  3335. [PVTEICR3] = igb_set_vteicr,
  3336. [PVTEICR4] = igb_set_vteicr,
  3337. [PVTEICR5] = igb_set_vteicr,
  3338. [PVTEICR6] = igb_set_vteicr,
  3339. [PVTEICR7] = igb_set_vteicr,
  3340. [VTIVAR ... VTIVAR + 7] = igb_set_vtivar,
  3341. [VTIVAR_MISC ... VTIVAR_MISC + 7] = igb_mac_writereg
  3342. };
  3343. enum { IGB_NWRITEOPS = ARRAY_SIZE(igb_macreg_writeops) };
  3344. enum { MAC_ACCESS_PARTIAL = 1 };
  3345. /*
  3346. * The array below combines alias offsets of the index values for the
  3347. * MAC registers that have aliases, with the indication of not fully
  3348. * implemented registers (lowest bit). This combination is possible
  3349. * because all of the offsets are even.
  3350. */
  3351. static const uint16_t mac_reg_access[E1000E_MAC_SIZE] = {
  3352. /* Alias index offsets */
  3353. [FCRTL_A] = 0x07fe,
  3354. [RDFH_A] = 0xe904, [RDFT_A] = 0xe904,
  3355. [TDFH_A] = 0xed00, [TDFT_A] = 0xed00,
  3356. [RA_A ... RA_A + 31] = 0x14f0,
  3357. [VFTA_A ... VFTA_A + E1000_VLAN_FILTER_TBL_SIZE - 1] = 0x1400,
  3358. [RDBAL0_A] = 0x2600,
  3359. [RDBAH0_A] = 0x2600,
  3360. [RDLEN0_A] = 0x2600,
  3361. [SRRCTL0_A] = 0x2600,
  3362. [RDH0_A] = 0x2600,
  3363. [RDT0_A] = 0x2600,
  3364. [RXDCTL0_A] = 0x2600,
  3365. [RXCTL0_A] = 0x2600,
  3366. [RQDPC0_A] = 0x2600,
  3367. [RDBAL1_A] = 0x25D0,
  3368. [RDBAL2_A] = 0x25A0,
  3369. [RDBAL3_A] = 0x2570,
  3370. [RDBAH1_A] = 0x25D0,
  3371. [RDBAH2_A] = 0x25A0,
  3372. [RDBAH3_A] = 0x2570,
  3373. [RDLEN1_A] = 0x25D0,
  3374. [RDLEN2_A] = 0x25A0,
  3375. [RDLEN3_A] = 0x2570,
  3376. [SRRCTL1_A] = 0x25D0,
  3377. [SRRCTL2_A] = 0x25A0,
  3378. [SRRCTL3_A] = 0x2570,
  3379. [RDH1_A] = 0x25D0,
  3380. [RDH2_A] = 0x25A0,
  3381. [RDH3_A] = 0x2570,
  3382. [RDT1_A] = 0x25D0,
  3383. [RDT2_A] = 0x25A0,
  3384. [RDT3_A] = 0x2570,
  3385. [RXDCTL1_A] = 0x25D0,
  3386. [RXDCTL2_A] = 0x25A0,
  3387. [RXDCTL3_A] = 0x2570,
  3388. [RXCTL1_A] = 0x25D0,
  3389. [RXCTL2_A] = 0x25A0,
  3390. [RXCTL3_A] = 0x2570,
  3391. [RQDPC1_A] = 0x25D0,
  3392. [RQDPC2_A] = 0x25A0,
  3393. [RQDPC3_A] = 0x2570,
  3394. [TDBAL0_A] = 0x2A00,
  3395. [TDBAH0_A] = 0x2A00,
  3396. [TDLEN0_A] = 0x2A00,
  3397. [TDH0_A] = 0x2A00,
  3398. [TDT0_A] = 0x2A00,
  3399. [TXCTL0_A] = 0x2A00,
  3400. [TDWBAL0_A] = 0x2A00,
  3401. [TDWBAH0_A] = 0x2A00,
  3402. [TDBAL1_A] = 0x29D0,
  3403. [TDBAL2_A] = 0x29A0,
  3404. [TDBAL3_A] = 0x2970,
  3405. [TDBAH1_A] = 0x29D0,
  3406. [TDBAH2_A] = 0x29A0,
  3407. [TDBAH3_A] = 0x2970,
  3408. [TDLEN1_A] = 0x29D0,
  3409. [TDLEN2_A] = 0x29A0,
  3410. [TDLEN3_A] = 0x2970,
  3411. [TDH1_A] = 0x29D0,
  3412. [TDH2_A] = 0x29A0,
  3413. [TDH3_A] = 0x2970,
  3414. [TDT1_A] = 0x29D0,
  3415. [TDT2_A] = 0x29A0,
  3416. [TDT3_A] = 0x2970,
  3417. [TXDCTL0_A] = 0x2A00,
  3418. [TXDCTL1_A] = 0x29D0,
  3419. [TXDCTL2_A] = 0x29A0,
  3420. [TXDCTL3_A] = 0x2970,
  3421. [TXCTL1_A] = 0x29D0,
  3422. [TXCTL2_A] = 0x29A0,
  3423. [TXCTL3_A] = 0x29D0,
  3424. [TDWBAL1_A] = 0x29D0,
  3425. [TDWBAL2_A] = 0x29A0,
  3426. [TDWBAL3_A] = 0x2970,
  3427. [TDWBAH1_A] = 0x29D0,
  3428. [TDWBAH2_A] = 0x29A0,
  3429. [TDWBAH3_A] = 0x2970,
  3430. /* Access options */
  3431. [RDFH] = MAC_ACCESS_PARTIAL, [RDFT] = MAC_ACCESS_PARTIAL,
  3432. [RDFHS] = MAC_ACCESS_PARTIAL, [RDFTS] = MAC_ACCESS_PARTIAL,
  3433. [RDFPC] = MAC_ACCESS_PARTIAL,
  3434. [TDFH] = MAC_ACCESS_PARTIAL, [TDFT] = MAC_ACCESS_PARTIAL,
  3435. [TDFHS] = MAC_ACCESS_PARTIAL, [TDFTS] = MAC_ACCESS_PARTIAL,
  3436. [TDFPC] = MAC_ACCESS_PARTIAL, [EECD] = MAC_ACCESS_PARTIAL,
  3437. [FLA] = MAC_ACCESS_PARTIAL,
  3438. [FCAL] = MAC_ACCESS_PARTIAL, [FCAH] = MAC_ACCESS_PARTIAL,
  3439. [FCT] = MAC_ACCESS_PARTIAL, [FCTTV] = MAC_ACCESS_PARTIAL,
  3440. [FCRTV] = MAC_ACCESS_PARTIAL, [FCRTL] = MAC_ACCESS_PARTIAL,
  3441. [FCRTH] = MAC_ACCESS_PARTIAL,
  3442. [MAVTV0 ... MAVTV3] = MAC_ACCESS_PARTIAL
  3443. };
  3444. void
  3445. igb_core_write(IGBCore *core, hwaddr addr, uint64_t val, unsigned size)
  3446. {
  3447. uint16_t index = igb_get_reg_index_with_offset(mac_reg_access, addr);
  3448. if (index < IGB_NWRITEOPS && igb_macreg_writeops[index]) {
  3449. if (mac_reg_access[index] & MAC_ACCESS_PARTIAL) {
  3450. trace_e1000e_wrn_regs_write_trivial(index << 2);
  3451. }
  3452. trace_e1000e_core_write(index << 2, size, val);
  3453. igb_macreg_writeops[index](core, index, val);
  3454. } else if (index < IGB_NREADOPS && igb_macreg_readops[index]) {
  3455. trace_e1000e_wrn_regs_write_ro(index << 2, size, val);
  3456. } else {
  3457. trace_e1000e_wrn_regs_write_unknown(index << 2, size, val);
  3458. }
  3459. }
  3460. uint64_t
  3461. igb_core_read(IGBCore *core, hwaddr addr, unsigned size)
  3462. {
  3463. uint64_t val;
  3464. uint16_t index = igb_get_reg_index_with_offset(mac_reg_access, addr);
  3465. if (index < IGB_NREADOPS && igb_macreg_readops[index]) {
  3466. if (mac_reg_access[index] & MAC_ACCESS_PARTIAL) {
  3467. trace_e1000e_wrn_regs_read_trivial(index << 2);
  3468. }
  3469. val = igb_macreg_readops[index](core, index);
  3470. trace_e1000e_core_read(index << 2, size, val);
  3471. return val;
  3472. } else {
  3473. trace_e1000e_wrn_regs_read_unknown(index << 2, size);
  3474. }
  3475. return 0;
  3476. }
  3477. static inline void
  3478. igb_autoneg_pause(IGBCore *core)
  3479. {
  3480. timer_del(core->autoneg_timer);
  3481. }
  3482. static void
  3483. igb_autoneg_resume(IGBCore *core)
  3484. {
  3485. if (igb_have_autoneg(core) &&
  3486. !(core->phy[MII_BMSR] & MII_BMSR_AN_COMP)) {
  3487. qemu_get_queue(core->owner_nic)->link_down = false;
  3488. timer_mod(core->autoneg_timer,
  3489. qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL) + 500);
  3490. }
  3491. }
  3492. static void
  3493. igb_vm_state_change(void *opaque, bool running, RunState state)
  3494. {
  3495. IGBCore *core = opaque;
  3496. if (running) {
  3497. trace_e1000e_vm_state_running();
  3498. igb_intrmgr_resume(core);
  3499. igb_autoneg_resume(core);
  3500. } else {
  3501. trace_e1000e_vm_state_stopped();
  3502. igb_autoneg_pause(core);
  3503. igb_intrmgr_pause(core);
  3504. }
  3505. }
  3506. void
  3507. igb_core_pci_realize(IGBCore *core,
  3508. const uint16_t *eeprom_templ,
  3509. uint32_t eeprom_size,
  3510. const uint8_t *macaddr)
  3511. {
  3512. int i;
  3513. core->autoneg_timer = timer_new_ms(QEMU_CLOCK_VIRTUAL,
  3514. igb_autoneg_timer, core);
  3515. igb_intrmgr_pci_realize(core);
  3516. core->vmstate = qemu_add_vm_change_state_handler(igb_vm_state_change, core);
  3517. for (i = 0; i < IGB_NUM_QUEUES; i++) {
  3518. net_tx_pkt_init(&core->tx[i].tx_pkt, E1000E_MAX_TX_FRAGS);
  3519. }
  3520. net_rx_pkt_init(&core->rx_pkt);
  3521. e1000x_core_prepare_eeprom(core->eeprom,
  3522. eeprom_templ,
  3523. eeprom_size,
  3524. PCI_DEVICE_GET_CLASS(core->owner)->device_id,
  3525. macaddr);
  3526. igb_update_rx_offloads(core);
  3527. }
  3528. void
  3529. igb_core_pci_uninit(IGBCore *core)
  3530. {
  3531. int i;
  3532. timer_free(core->autoneg_timer);
  3533. igb_intrmgr_pci_unint(core);
  3534. qemu_del_vm_change_state_handler(core->vmstate);
  3535. for (i = 0; i < IGB_NUM_QUEUES; i++) {
  3536. net_tx_pkt_uninit(core->tx[i].tx_pkt);
  3537. }
  3538. net_rx_pkt_uninit(core->rx_pkt);
  3539. }
  3540. static const uint16_t
  3541. igb_phy_reg_init[] = {
  3542. [MII_BMCR] = MII_BMCR_SPEED1000 |
  3543. MII_BMCR_FD |
  3544. MII_BMCR_AUTOEN,
  3545. [MII_BMSR] = MII_BMSR_EXTCAP |
  3546. MII_BMSR_LINK_ST |
  3547. MII_BMSR_AUTONEG |
  3548. MII_BMSR_MFPS |
  3549. MII_BMSR_EXTSTAT |
  3550. MII_BMSR_10T_HD |
  3551. MII_BMSR_10T_FD |
  3552. MII_BMSR_100TX_HD |
  3553. MII_BMSR_100TX_FD,
  3554. [MII_PHYID1] = IGP03E1000_E_PHY_ID >> 16,
  3555. [MII_PHYID2] = (IGP03E1000_E_PHY_ID & 0xfff0) | 1,
  3556. [MII_ANAR] = MII_ANAR_CSMACD | MII_ANAR_10 |
  3557. MII_ANAR_10FD | MII_ANAR_TX |
  3558. MII_ANAR_TXFD | MII_ANAR_PAUSE |
  3559. MII_ANAR_PAUSE_ASYM,
  3560. [MII_ANLPAR] = MII_ANLPAR_10 | MII_ANLPAR_10FD |
  3561. MII_ANLPAR_TX | MII_ANLPAR_TXFD |
  3562. MII_ANLPAR_T4 | MII_ANLPAR_PAUSE,
  3563. [MII_ANER] = MII_ANER_NP | MII_ANER_NWAY,
  3564. [MII_ANNP] = 0x1 | MII_ANNP_MP,
  3565. [MII_CTRL1000] = MII_CTRL1000_HALF | MII_CTRL1000_FULL |
  3566. MII_CTRL1000_PORT | MII_CTRL1000_MASTER,
  3567. [MII_STAT1000] = MII_STAT1000_HALF | MII_STAT1000_FULL |
  3568. MII_STAT1000_ROK | MII_STAT1000_LOK,
  3569. [MII_EXTSTAT] = MII_EXTSTAT_1000T_HD | MII_EXTSTAT_1000T_FD,
  3570. [IGP01E1000_PHY_PORT_CONFIG] = BIT(5) | BIT(8),
  3571. [IGP01E1000_PHY_PORT_STATUS] = IGP01E1000_PSSR_SPEED_1000MBPS,
  3572. [IGP02E1000_PHY_POWER_MGMT] = BIT(0) | BIT(3) | IGP02E1000_PM_D3_LPLU |
  3573. IGP01E1000_PSCFR_SMART_SPEED
  3574. };
  3575. static const uint32_t igb_mac_reg_init[] = {
  3576. [LEDCTL] = 2 | (3 << 8) | BIT(15) | (6 << 16) | (7 << 24),
  3577. [EEMNGCTL] = BIT(31),
  3578. [TXDCTL0] = E1000_TXDCTL_QUEUE_ENABLE,
  3579. [RXDCTL0] = E1000_RXDCTL_QUEUE_ENABLE | (1 << 16),
  3580. [RXDCTL1] = 1 << 16,
  3581. [RXDCTL2] = 1 << 16,
  3582. [RXDCTL3] = 1 << 16,
  3583. [RXDCTL4] = 1 << 16,
  3584. [RXDCTL5] = 1 << 16,
  3585. [RXDCTL6] = 1 << 16,
  3586. [RXDCTL7] = 1 << 16,
  3587. [RXDCTL8] = 1 << 16,
  3588. [RXDCTL9] = 1 << 16,
  3589. [RXDCTL10] = 1 << 16,
  3590. [RXDCTL11] = 1 << 16,
  3591. [RXDCTL12] = 1 << 16,
  3592. [RXDCTL13] = 1 << 16,
  3593. [RXDCTL14] = 1 << 16,
  3594. [RXDCTL15] = 1 << 16,
  3595. [TIPG] = 0x08 | (0x04 << 10) | (0x06 << 20),
  3596. [CTRL] = E1000_CTRL_FD | E1000_CTRL_LRST | E1000_CTRL_SPD_1000 |
  3597. E1000_CTRL_ADVD3WUC,
  3598. [STATUS] = E1000_STATUS_PHYRA | BIT(31),
  3599. [EECD] = E1000_EECD_FWE_DIS | E1000_EECD_PRES |
  3600. (2 << E1000_EECD_SIZE_EX_SHIFT),
  3601. [GCR] = E1000_L0S_ADJUST |
  3602. E1000_GCR_CMPL_TMOUT_RESEND |
  3603. E1000_GCR_CAP_VER2 |
  3604. E1000_L1_ENTRY_LATENCY_MSB |
  3605. E1000_L1_ENTRY_LATENCY_LSB,
  3606. [RXCSUM] = E1000_RXCSUM_IPOFLD | E1000_RXCSUM_TUOFLD,
  3607. [TXPBS] = 0x28,
  3608. [RXPBS] = 0x40,
  3609. [TCTL] = E1000_TCTL_PSP | (0xF << E1000_CT_SHIFT) |
  3610. (0x40 << E1000_COLD_SHIFT) | (0x1 << 26) | (0xA << 28),
  3611. [TCTL_EXT] = 0x40 | (0x42 << 10),
  3612. [DTXCTL] = E1000_DTXCTL_8023LL | E1000_DTXCTL_SPOOF_INT,
  3613. [VET] = ETH_P_VLAN | (ETH_P_VLAN << 16),
  3614. [V2PMAILBOX0 ... V2PMAILBOX0 + IGB_MAX_VF_FUNCTIONS - 1] = E1000_V2PMAILBOX_RSTI,
  3615. [MBVFIMR] = 0xFF,
  3616. [VFRE] = 0xFF,
  3617. [VFTE] = 0xFF,
  3618. [VMOLR0 ... VMOLR0 + 7] = 0x2600 | E1000_VMOLR_STRCRC,
  3619. [RPLOLR] = E1000_RPLOLR_STRCRC,
  3620. [RLPML] = 0x2600,
  3621. [TXCTL0] = E1000_DCA_TXCTRL_DATA_RRO_EN |
  3622. E1000_DCA_TXCTRL_TX_WB_RO_EN |
  3623. E1000_DCA_TXCTRL_DESC_RRO_EN,
  3624. [TXCTL1] = E1000_DCA_TXCTRL_DATA_RRO_EN |
  3625. E1000_DCA_TXCTRL_TX_WB_RO_EN |
  3626. E1000_DCA_TXCTRL_DESC_RRO_EN,
  3627. [TXCTL2] = E1000_DCA_TXCTRL_DATA_RRO_EN |
  3628. E1000_DCA_TXCTRL_TX_WB_RO_EN |
  3629. E1000_DCA_TXCTRL_DESC_RRO_EN,
  3630. [TXCTL3] = E1000_DCA_TXCTRL_DATA_RRO_EN |
  3631. E1000_DCA_TXCTRL_TX_WB_RO_EN |
  3632. E1000_DCA_TXCTRL_DESC_RRO_EN,
  3633. [TXCTL4] = E1000_DCA_TXCTRL_DATA_RRO_EN |
  3634. E1000_DCA_TXCTRL_TX_WB_RO_EN |
  3635. E1000_DCA_TXCTRL_DESC_RRO_EN,
  3636. [TXCTL5] = E1000_DCA_TXCTRL_DATA_RRO_EN |
  3637. E1000_DCA_TXCTRL_TX_WB_RO_EN |
  3638. E1000_DCA_TXCTRL_DESC_RRO_EN,
  3639. [TXCTL6] = E1000_DCA_TXCTRL_DATA_RRO_EN |
  3640. E1000_DCA_TXCTRL_TX_WB_RO_EN |
  3641. E1000_DCA_TXCTRL_DESC_RRO_EN,
  3642. [TXCTL7] = E1000_DCA_TXCTRL_DATA_RRO_EN |
  3643. E1000_DCA_TXCTRL_TX_WB_RO_EN |
  3644. E1000_DCA_TXCTRL_DESC_RRO_EN,
  3645. [TXCTL8] = E1000_DCA_TXCTRL_DATA_RRO_EN |
  3646. E1000_DCA_TXCTRL_TX_WB_RO_EN |
  3647. E1000_DCA_TXCTRL_DESC_RRO_EN,
  3648. [TXCTL9] = E1000_DCA_TXCTRL_DATA_RRO_EN |
  3649. E1000_DCA_TXCTRL_TX_WB_RO_EN |
  3650. E1000_DCA_TXCTRL_DESC_RRO_EN,
  3651. [TXCTL10] = E1000_DCA_TXCTRL_DATA_RRO_EN |
  3652. E1000_DCA_TXCTRL_TX_WB_RO_EN |
  3653. E1000_DCA_TXCTRL_DESC_RRO_EN,
  3654. [TXCTL11] = E1000_DCA_TXCTRL_DATA_RRO_EN |
  3655. E1000_DCA_TXCTRL_TX_WB_RO_EN |
  3656. E1000_DCA_TXCTRL_DESC_RRO_EN,
  3657. [TXCTL12] = E1000_DCA_TXCTRL_DATA_RRO_EN |
  3658. E1000_DCA_TXCTRL_TX_WB_RO_EN |
  3659. E1000_DCA_TXCTRL_DESC_RRO_EN,
  3660. [TXCTL13] = E1000_DCA_TXCTRL_DATA_RRO_EN |
  3661. E1000_DCA_TXCTRL_TX_WB_RO_EN |
  3662. E1000_DCA_TXCTRL_DESC_RRO_EN,
  3663. [TXCTL14] = E1000_DCA_TXCTRL_DATA_RRO_EN |
  3664. E1000_DCA_TXCTRL_TX_WB_RO_EN |
  3665. E1000_DCA_TXCTRL_DESC_RRO_EN,
  3666. [TXCTL15] = E1000_DCA_TXCTRL_DATA_RRO_EN |
  3667. E1000_DCA_TXCTRL_TX_WB_RO_EN |
  3668. E1000_DCA_TXCTRL_DESC_RRO_EN,
  3669. };
  3670. static void igb_reset(IGBCore *core, bool sw)
  3671. {
  3672. struct igb_tx *tx;
  3673. int i;
  3674. timer_del(core->autoneg_timer);
  3675. igb_intrmgr_reset(core);
  3676. memset(core->phy, 0, sizeof core->phy);
  3677. memcpy(core->phy, igb_phy_reg_init, sizeof igb_phy_reg_init);
  3678. for (i = 0; i < E1000E_MAC_SIZE; i++) {
  3679. if (sw &&
  3680. (i == RXPBS || i == TXPBS ||
  3681. (i >= EITR0 && i < EITR0 + IGB_INTR_NUM))) {
  3682. continue;
  3683. }
  3684. core->mac[i] = i < ARRAY_SIZE(igb_mac_reg_init) ?
  3685. igb_mac_reg_init[i] : 0;
  3686. }
  3687. if (qemu_get_queue(core->owner_nic)->link_down) {
  3688. igb_link_down(core);
  3689. }
  3690. e1000x_reset_mac_addr(core->owner_nic, core->mac, core->permanent_mac);
  3691. for (int vfn = 0; vfn < IGB_MAX_VF_FUNCTIONS; vfn++) {
  3692. /* Set RSTI, so VF can identify a PF reset is in progress */
  3693. core->mac[V2PMAILBOX0 + vfn] |= E1000_V2PMAILBOX_RSTI;
  3694. }
  3695. for (i = 0; i < ARRAY_SIZE(core->tx); i++) {
  3696. tx = &core->tx[i];
  3697. memset(tx->ctx, 0, sizeof(tx->ctx));
  3698. tx->first = true;
  3699. tx->skip_cp = false;
  3700. }
  3701. }
  3702. void
  3703. igb_core_reset(IGBCore *core)
  3704. {
  3705. igb_reset(core, false);
  3706. }
  3707. void igb_core_pre_save(IGBCore *core)
  3708. {
  3709. int i;
  3710. NetClientState *nc = qemu_get_queue(core->owner_nic);
  3711. /*
  3712. * If link is down and auto-negotiation is supported and ongoing,
  3713. * complete auto-negotiation immediately. This allows us to look
  3714. * at MII_BMSR_AN_COMP to infer link status on load.
  3715. */
  3716. if (nc->link_down && igb_have_autoneg(core)) {
  3717. core->phy[MII_BMSR] |= MII_BMSR_AN_COMP;
  3718. igb_update_flowctl_status(core);
  3719. }
  3720. for (i = 0; i < ARRAY_SIZE(core->tx); i++) {
  3721. if (net_tx_pkt_has_fragments(core->tx[i].tx_pkt)) {
  3722. core->tx[i].skip_cp = true;
  3723. }
  3724. }
  3725. }
  3726. int
  3727. igb_core_post_load(IGBCore *core)
  3728. {
  3729. NetClientState *nc = qemu_get_queue(core->owner_nic);
  3730. /*
  3731. * nc.link_down can't be migrated, so infer link_down according
  3732. * to link status bit in core.mac[STATUS].
  3733. */
  3734. nc->link_down = (core->mac[STATUS] & E1000_STATUS_LU) == 0;
  3735. return 0;
  3736. }