1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950295129522953295429552956295729582959296029612962296329642965296629672968296929702971297229732974297529762977297829792980298129822983298429852986298729882989299029912992299329942995299629972998299930003001300230033004300530063007300830093010301130123013301430153016301730183019302030213022302330243025302630273028302930303031303230333034303530363037303830393040304130423043304430453046304730483049305030513052305330543055305630573058305930603061306230633064306530663067306830693070307130723073307430753076307730783079308030813082308330843085308630873088308930903091309230933094309530963097309830993100310131023103310431053106310731083109311031113112311331143115311631173118311931203121312231233124312531263127312831293130313131323133313431353136313731383139314031413142314331443145314631473148314931503151315231533154315531563157315831593160316131623163316431653166316731683169317031713172317331743175317631773178317931803181318231833184318531863187318831893190319131923193319431953196319731983199320032013202320332043205320632073208320932103211321232133214321532163217321832193220322132223223322432253226322732283229323032313232323332343235323632373238323932403241324232433244324532463247324832493250325132523253325432553256325732583259326032613262326332643265326632673268326932703271327232733274327532763277327832793280328132823283328432853286328732883289329032913292329332943295329632973298329933003301330233033304330533063307330833093310331133123313331433153316331733183319332033213322332333243325332633273328332933303331333233333334333533363337333833393340334133423343334433453346334733483349335033513352335333543355335633573358335933603361336233633364336533663367336833693370337133723373337433753376337733783379338033813382338333843385338633873388338933903391339233933394339533963397339833993400340134023403340434053406340734083409341034113412341334143415341634173418341934203421342234233424342534263427342834293430343134323433343434353436343734383439344034413442344334443445344634473448344934503451345234533454345534563457345834593460346134623463346434653466346734683469347034713472347334743475347634773478347934803481348234833484348534863487348834893490349134923493349434953496349734983499350035013502350335043505350635073508350935103511351235133514351535163517351835193520352135223523352435253526352735283529353035313532353335343535353635373538353935403541354235433544354535463547354835493550355135523553355435553556355735583559356035613562356335643565356635673568356935703571357235733574357535763577357835793580358135823583358435853586358735883589359035913592359335943595359635973598359936003601360236033604360536063607360836093610361136123613361436153616361736183619362036213622362336243625362636273628 |
- // SPDX-License-Identifier: GPL-2.0
- /* Copyright (c) 2018 Intel Corporation */
- #include <linux/module.h>
- #include <linux/types.h>
- #include <linux/if_vlan.h>
- #include <linux/aer.h>
- #include "igc.h"
- #include "igc_hw.h"
- #define DRV_VERSION "0.0.1-k"
- #define DRV_SUMMARY "Intel(R) 2.5G Ethernet Linux Driver"
- static int debug = -1;
- MODULE_AUTHOR("Intel Corporation, <linux.nics@intel.com>");
- MODULE_DESCRIPTION(DRV_SUMMARY);
- MODULE_LICENSE("GPL v2");
- MODULE_VERSION(DRV_VERSION);
- module_param(debug, int, 0);
- MODULE_PARM_DESC(debug, "Debug level (0=none,...,16=all)");
- char igc_driver_name[] = "igc";
- char igc_driver_version[] = DRV_VERSION;
- static const char igc_driver_string[] = DRV_SUMMARY;
- static const char igc_copyright[] =
- "Copyright(c) 2018 Intel Corporation.";
- static const struct igc_info *igc_info_tbl[] = {
- [board_base] = &igc_base_info,
- };
- static const struct pci_device_id igc_pci_tbl[] = {
- { PCI_VDEVICE(INTEL, IGC_DEV_ID_I225_LM), board_base },
- { PCI_VDEVICE(INTEL, IGC_DEV_ID_I225_V), board_base },
- /* required last entry */
- {0, }
- };
- MODULE_DEVICE_TABLE(pci, igc_pci_tbl);
- /* forward declaration */
- static void igc_clean_tx_ring(struct igc_ring *tx_ring);
- static int igc_sw_init(struct igc_adapter *);
- static void igc_configure(struct igc_adapter *adapter);
- static void igc_power_down_link(struct igc_adapter *adapter);
- static void igc_set_default_mac_filter(struct igc_adapter *adapter);
- static void igc_set_rx_mode(struct net_device *netdev);
- static void igc_write_itr(struct igc_q_vector *q_vector);
- static void igc_assign_vector(struct igc_q_vector *q_vector, int msix_vector);
- static void igc_free_q_vector(struct igc_adapter *adapter, int v_idx);
- static void igc_set_interrupt_capability(struct igc_adapter *adapter,
- bool msix);
- static void igc_free_q_vectors(struct igc_adapter *adapter);
- static void igc_irq_disable(struct igc_adapter *adapter);
- static void igc_irq_enable(struct igc_adapter *adapter);
- static void igc_configure_msix(struct igc_adapter *adapter);
- static bool igc_alloc_mapped_page(struct igc_ring *rx_ring,
- struct igc_rx_buffer *bi);
- enum latency_range {
- lowest_latency = 0,
- low_latency = 1,
- bulk_latency = 2,
- latency_invalid = 255
- };
- static void igc_reset(struct igc_adapter *adapter)
- {
- struct pci_dev *pdev = adapter->pdev;
- struct igc_hw *hw = &adapter->hw;
- hw->mac.ops.reset_hw(hw);
- if (hw->mac.ops.init_hw(hw))
- dev_err(&pdev->dev, "Hardware Error\n");
- if (!netif_running(adapter->netdev))
- igc_power_down_link(adapter);
- }
- /**
- * igc_power_up_link - Power up the phy/serdes link
- * @adapter: address of board private structure
- */
- static void igc_power_up_link(struct igc_adapter *adapter)
- {
- }
- /**
- * igc_power_down_link - Power down the phy/serdes link
- * @adapter: address of board private structure
- */
- static void igc_power_down_link(struct igc_adapter *adapter)
- {
- }
- /**
- * igc_release_hw_control - release control of the h/w to f/w
- * @adapter: address of board private structure
- *
- * igc_release_hw_control resets CTRL_EXT:DRV_LOAD bit.
- * For ASF and Pass Through versions of f/w this means that the
- * driver is no longer loaded.
- */
- static void igc_release_hw_control(struct igc_adapter *adapter)
- {
- struct igc_hw *hw = &adapter->hw;
- u32 ctrl_ext;
- /* Let firmware take over control of h/w */
- ctrl_ext = rd32(IGC_CTRL_EXT);
- wr32(IGC_CTRL_EXT,
- ctrl_ext & ~IGC_CTRL_EXT_DRV_LOAD);
- }
- /**
- * igc_get_hw_control - get control of the h/w from f/w
- * @adapter: address of board private structure
- *
- * igc_get_hw_control sets CTRL_EXT:DRV_LOAD bit.
- * For ASF and Pass Through versions of f/w this means that
- * the driver is loaded.
- */
- static void igc_get_hw_control(struct igc_adapter *adapter)
- {
- struct igc_hw *hw = &adapter->hw;
- u32 ctrl_ext;
- /* Let firmware know the driver has taken over */
- ctrl_ext = rd32(IGC_CTRL_EXT);
- wr32(IGC_CTRL_EXT,
- ctrl_ext | IGC_CTRL_EXT_DRV_LOAD);
- }
- /**
- * igc_free_tx_resources - Free Tx Resources per Queue
- * @tx_ring: Tx descriptor ring for a specific queue
- *
- * Free all transmit software resources
- */
- static void igc_free_tx_resources(struct igc_ring *tx_ring)
- {
- igc_clean_tx_ring(tx_ring);
- vfree(tx_ring->tx_buffer_info);
- tx_ring->tx_buffer_info = NULL;
- /* if not set, then don't free */
- if (!tx_ring->desc)
- return;
- dma_free_coherent(tx_ring->dev, tx_ring->size,
- tx_ring->desc, tx_ring->dma);
- tx_ring->desc = NULL;
- }
- /**
- * igc_free_all_tx_resources - Free Tx Resources for All Queues
- * @adapter: board private structure
- *
- * Free all transmit software resources
- */
- static void igc_free_all_tx_resources(struct igc_adapter *adapter)
- {
- int i;
- for (i = 0; i < adapter->num_tx_queues; i++)
- igc_free_tx_resources(adapter->tx_ring[i]);
- }
- /**
- * igc_clean_tx_ring - Free Tx Buffers
- * @tx_ring: ring to be cleaned
- */
- static void igc_clean_tx_ring(struct igc_ring *tx_ring)
- {
- u16 i = tx_ring->next_to_clean;
- struct igc_tx_buffer *tx_buffer = &tx_ring->tx_buffer_info[i];
- while (i != tx_ring->next_to_use) {
- union igc_adv_tx_desc *eop_desc, *tx_desc;
- /* Free all the Tx ring sk_buffs */
- dev_kfree_skb_any(tx_buffer->skb);
- /* unmap skb header data */
- dma_unmap_single(tx_ring->dev,
- dma_unmap_addr(tx_buffer, dma),
- dma_unmap_len(tx_buffer, len),
- DMA_TO_DEVICE);
- /* check for eop_desc to determine the end of the packet */
- eop_desc = tx_buffer->next_to_watch;
- tx_desc = IGC_TX_DESC(tx_ring, i);
- /* unmap remaining buffers */
- while (tx_desc != eop_desc) {
- tx_buffer++;
- tx_desc++;
- i++;
- if (unlikely(i == tx_ring->count)) {
- i = 0;
- tx_buffer = tx_ring->tx_buffer_info;
- tx_desc = IGC_TX_DESC(tx_ring, 0);
- }
- /* unmap any remaining paged data */
- if (dma_unmap_len(tx_buffer, len))
- dma_unmap_page(tx_ring->dev,
- dma_unmap_addr(tx_buffer, dma),
- dma_unmap_len(tx_buffer, len),
- DMA_TO_DEVICE);
- }
- /* move us one more past the eop_desc for start of next pkt */
- tx_buffer++;
- i++;
- if (unlikely(i == tx_ring->count)) {
- i = 0;
- tx_buffer = tx_ring->tx_buffer_info;
- }
- }
- /* reset BQL for queue */
- netdev_tx_reset_queue(txring_txq(tx_ring));
- /* reset next_to_use and next_to_clean */
- tx_ring->next_to_use = 0;
- tx_ring->next_to_clean = 0;
- }
- /**
- * igc_clean_all_tx_rings - Free Tx Buffers for all queues
- * @adapter: board private structure
- */
- static void igc_clean_all_tx_rings(struct igc_adapter *adapter)
- {
- int i;
- for (i = 0; i < adapter->num_tx_queues; i++)
- if (adapter->tx_ring[i])
- igc_clean_tx_ring(adapter->tx_ring[i]);
- }
- /**
- * igc_setup_tx_resources - allocate Tx resources (Descriptors)
- * @tx_ring: tx descriptor ring (for a specific queue) to setup
- *
- * Return 0 on success, negative on failure
- */
- static int igc_setup_tx_resources(struct igc_ring *tx_ring)
- {
- struct device *dev = tx_ring->dev;
- int size = 0;
- size = sizeof(struct igc_tx_buffer) * tx_ring->count;
- tx_ring->tx_buffer_info = vzalloc(size);
- if (!tx_ring->tx_buffer_info)
- goto err;
- /* round up to nearest 4K */
- tx_ring->size = tx_ring->count * sizeof(union igc_adv_tx_desc);
- tx_ring->size = ALIGN(tx_ring->size, 4096);
- tx_ring->desc = dma_alloc_coherent(dev, tx_ring->size,
- &tx_ring->dma, GFP_KERNEL);
- if (!tx_ring->desc)
- goto err;
- tx_ring->next_to_use = 0;
- tx_ring->next_to_clean = 0;
- return 0;
- err:
- vfree(tx_ring->tx_buffer_info);
- dev_err(dev,
- "Unable to allocate memory for the transmit descriptor ring\n");
- return -ENOMEM;
- }
- /**
- * igc_setup_all_tx_resources - wrapper to allocate Tx resources for all queues
- * @adapter: board private structure
- *
- * Return 0 on success, negative on failure
- */
- static int igc_setup_all_tx_resources(struct igc_adapter *adapter)
- {
- struct pci_dev *pdev = adapter->pdev;
- int i, err = 0;
- for (i = 0; i < adapter->num_tx_queues; i++) {
- err = igc_setup_tx_resources(adapter->tx_ring[i]);
- if (err) {
- dev_err(&pdev->dev,
- "Allocation for Tx Queue %u failed\n", i);
- for (i--; i >= 0; i--)
- igc_free_tx_resources(adapter->tx_ring[i]);
- break;
- }
- }
- return err;
- }
- /**
- * igc_clean_rx_ring - Free Rx Buffers per Queue
- * @rx_ring: ring to free buffers from
- */
- static void igc_clean_rx_ring(struct igc_ring *rx_ring)
- {
- u16 i = rx_ring->next_to_clean;
- if (rx_ring->skb)
- dev_kfree_skb(rx_ring->skb);
- rx_ring->skb = NULL;
- /* Free all the Rx ring sk_buffs */
- while (i != rx_ring->next_to_alloc) {
- struct igc_rx_buffer *buffer_info = &rx_ring->rx_buffer_info[i];
- /* Invalidate cache lines that may have been written to by
- * device so that we avoid corrupting memory.
- */
- dma_sync_single_range_for_cpu(rx_ring->dev,
- buffer_info->dma,
- buffer_info->page_offset,
- igc_rx_bufsz(rx_ring),
- DMA_FROM_DEVICE);
- /* free resources associated with mapping */
- dma_unmap_page_attrs(rx_ring->dev,
- buffer_info->dma,
- igc_rx_pg_size(rx_ring),
- DMA_FROM_DEVICE,
- IGC_RX_DMA_ATTR);
- __page_frag_cache_drain(buffer_info->page,
- buffer_info->pagecnt_bias);
- i++;
- if (i == rx_ring->count)
- i = 0;
- }
- rx_ring->next_to_alloc = 0;
- rx_ring->next_to_clean = 0;
- rx_ring->next_to_use = 0;
- }
- /**
- * igc_clean_all_rx_rings - Free Rx Buffers for all queues
- * @adapter: board private structure
- */
- static void igc_clean_all_rx_rings(struct igc_adapter *adapter)
- {
- int i;
- for (i = 0; i < adapter->num_rx_queues; i++)
- if (adapter->rx_ring[i])
- igc_clean_rx_ring(adapter->rx_ring[i]);
- }
- /**
- * igc_free_rx_resources - Free Rx Resources
- * @rx_ring: ring to clean the resources from
- *
- * Free all receive software resources
- */
- static void igc_free_rx_resources(struct igc_ring *rx_ring)
- {
- igc_clean_rx_ring(rx_ring);
- vfree(rx_ring->rx_buffer_info);
- rx_ring->rx_buffer_info = NULL;
- /* if not set, then don't free */
- if (!rx_ring->desc)
- return;
- dma_free_coherent(rx_ring->dev, rx_ring->size,
- rx_ring->desc, rx_ring->dma);
- rx_ring->desc = NULL;
- }
- /**
- * igc_free_all_rx_resources - Free Rx Resources for All Queues
- * @adapter: board private structure
- *
- * Free all receive software resources
- */
- static void igc_free_all_rx_resources(struct igc_adapter *adapter)
- {
- int i;
- for (i = 0; i < adapter->num_rx_queues; i++)
- igc_free_rx_resources(adapter->rx_ring[i]);
- }
- /**
- * igc_setup_rx_resources - allocate Rx resources (Descriptors)
- * @rx_ring: rx descriptor ring (for a specific queue) to setup
- *
- * Returns 0 on success, negative on failure
- */
- static int igc_setup_rx_resources(struct igc_ring *rx_ring)
- {
- struct device *dev = rx_ring->dev;
- int size, desc_len;
- size = sizeof(struct igc_rx_buffer) * rx_ring->count;
- rx_ring->rx_buffer_info = vzalloc(size);
- if (!rx_ring->rx_buffer_info)
- goto err;
- desc_len = sizeof(union igc_adv_rx_desc);
- /* Round up to nearest 4K */
- rx_ring->size = rx_ring->count * desc_len;
- rx_ring->size = ALIGN(rx_ring->size, 4096);
- rx_ring->desc = dma_alloc_coherent(dev, rx_ring->size,
- &rx_ring->dma, GFP_KERNEL);
- if (!rx_ring->desc)
- goto err;
- rx_ring->next_to_alloc = 0;
- rx_ring->next_to_clean = 0;
- rx_ring->next_to_use = 0;
- return 0;
- err:
- vfree(rx_ring->rx_buffer_info);
- rx_ring->rx_buffer_info = NULL;
- dev_err(dev,
- "Unable to allocate memory for the receive descriptor ring\n");
- return -ENOMEM;
- }
- /**
- * igc_setup_all_rx_resources - wrapper to allocate Rx resources
- * (Descriptors) for all queues
- * @adapter: board private structure
- *
- * Return 0 on success, negative on failure
- */
- static int igc_setup_all_rx_resources(struct igc_adapter *adapter)
- {
- struct pci_dev *pdev = adapter->pdev;
- int i, err = 0;
- for (i = 0; i < adapter->num_rx_queues; i++) {
- err = igc_setup_rx_resources(adapter->rx_ring[i]);
- if (err) {
- dev_err(&pdev->dev,
- "Allocation for Rx Queue %u failed\n", i);
- for (i--; i >= 0; i--)
- igc_free_rx_resources(adapter->rx_ring[i]);
- break;
- }
- }
- return err;
- }
- /**
- * igc_configure_rx_ring - Configure a receive ring after Reset
- * @adapter: board private structure
- * @ring: receive ring to be configured
- *
- * Configure the Rx unit of the MAC after a reset.
- */
- static void igc_configure_rx_ring(struct igc_adapter *adapter,
- struct igc_ring *ring)
- {
- struct igc_hw *hw = &adapter->hw;
- union igc_adv_rx_desc *rx_desc;
- int reg_idx = ring->reg_idx;
- u32 srrctl = 0, rxdctl = 0;
- u64 rdba = ring->dma;
- /* disable the queue */
- wr32(IGC_RXDCTL(reg_idx), 0);
- /* Set DMA base address registers */
- wr32(IGC_RDBAL(reg_idx),
- rdba & 0x00000000ffffffffULL);
- wr32(IGC_RDBAH(reg_idx), rdba >> 32);
- wr32(IGC_RDLEN(reg_idx),
- ring->count * sizeof(union igc_adv_rx_desc));
- /* initialize head and tail */
- ring->tail = adapter->io_addr + IGC_RDT(reg_idx);
- wr32(IGC_RDH(reg_idx), 0);
- writel(0, ring->tail);
- /* reset next-to- use/clean to place SW in sync with hardware */
- ring->next_to_clean = 0;
- ring->next_to_use = 0;
- /* set descriptor configuration */
- srrctl = IGC_RX_HDR_LEN << IGC_SRRCTL_BSIZEHDRSIZE_SHIFT;
- if (ring_uses_large_buffer(ring))
- srrctl |= IGC_RXBUFFER_3072 >> IGC_SRRCTL_BSIZEPKT_SHIFT;
- else
- srrctl |= IGC_RXBUFFER_2048 >> IGC_SRRCTL_BSIZEPKT_SHIFT;
- srrctl |= IGC_SRRCTL_DESCTYPE_ADV_ONEBUF;
- wr32(IGC_SRRCTL(reg_idx), srrctl);
- rxdctl |= IGC_RX_PTHRESH;
- rxdctl |= IGC_RX_HTHRESH << 8;
- rxdctl |= IGC_RX_WTHRESH << 16;
- /* initialize rx_buffer_info */
- memset(ring->rx_buffer_info, 0,
- sizeof(struct igc_rx_buffer) * ring->count);
- /* initialize Rx descriptor 0 */
- rx_desc = IGC_RX_DESC(ring, 0);
- rx_desc->wb.upper.length = 0;
- /* enable receive descriptor fetching */
- rxdctl |= IGC_RXDCTL_QUEUE_ENABLE;
- wr32(IGC_RXDCTL(reg_idx), rxdctl);
- }
- /**
- * igc_configure_rx - Configure receive Unit after Reset
- * @adapter: board private structure
- *
- * Configure the Rx unit of the MAC after a reset.
- */
- static void igc_configure_rx(struct igc_adapter *adapter)
- {
- int i;
- /* Setup the HW Rx Head and Tail Descriptor Pointers and
- * the Base and Length of the Rx Descriptor Ring
- */
- for (i = 0; i < adapter->num_rx_queues; i++)
- igc_configure_rx_ring(adapter, adapter->rx_ring[i]);
- }
- /**
- * igc_configure_tx_ring - Configure transmit ring after Reset
- * @adapter: board private structure
- * @ring: tx ring to configure
- *
- * Configure a transmit ring after a reset.
- */
- static void igc_configure_tx_ring(struct igc_adapter *adapter,
- struct igc_ring *ring)
- {
- struct igc_hw *hw = &adapter->hw;
- int reg_idx = ring->reg_idx;
- u64 tdba = ring->dma;
- u32 txdctl = 0;
- /* disable the queue */
- wr32(IGC_TXDCTL(reg_idx), 0);
- wrfl();
- mdelay(10);
- wr32(IGC_TDLEN(reg_idx),
- ring->count * sizeof(union igc_adv_tx_desc));
- wr32(IGC_TDBAL(reg_idx),
- tdba & 0x00000000ffffffffULL);
- wr32(IGC_TDBAH(reg_idx), tdba >> 32);
- ring->tail = adapter->io_addr + IGC_TDT(reg_idx);
- wr32(IGC_TDH(reg_idx), 0);
- writel(0, ring->tail);
- txdctl |= IGC_TX_PTHRESH;
- txdctl |= IGC_TX_HTHRESH << 8;
- txdctl |= IGC_TX_WTHRESH << 16;
- txdctl |= IGC_TXDCTL_QUEUE_ENABLE;
- wr32(IGC_TXDCTL(reg_idx), txdctl);
- }
- /**
- * igc_configure_tx - Configure transmit Unit after Reset
- * @adapter: board private structure
- *
- * Configure the Tx unit of the MAC after a reset.
- */
- static void igc_configure_tx(struct igc_adapter *adapter)
- {
- int i;
- for (i = 0; i < adapter->num_tx_queues; i++)
- igc_configure_tx_ring(adapter, adapter->tx_ring[i]);
- }
- /**
- * igc_setup_mrqc - configure the multiple receive queue control registers
- * @adapter: Board private structure
- */
- static void igc_setup_mrqc(struct igc_adapter *adapter)
- {
- }
- /**
- * igc_setup_rctl - configure the receive control registers
- * @adapter: Board private structure
- */
- static void igc_setup_rctl(struct igc_adapter *adapter)
- {
- struct igc_hw *hw = &adapter->hw;
- u32 rctl;
- rctl = rd32(IGC_RCTL);
- rctl &= ~(3 << IGC_RCTL_MO_SHIFT);
- rctl &= ~(IGC_RCTL_LBM_TCVR | IGC_RCTL_LBM_MAC);
- rctl |= IGC_RCTL_EN | IGC_RCTL_BAM | IGC_RCTL_RDMTS_HALF |
- (hw->mac.mc_filter_type << IGC_RCTL_MO_SHIFT);
- /* enable stripping of CRC. Newer features require
- * that the HW strips the CRC.
- */
- rctl |= IGC_RCTL_SECRC;
- /* disable store bad packets and clear size bits. */
- rctl &= ~(IGC_RCTL_SBP | IGC_RCTL_SZ_256);
- /* enable LPE to allow for reception of jumbo frames */
- rctl |= IGC_RCTL_LPE;
- /* disable queue 0 to prevent tail write w/o re-config */
- wr32(IGC_RXDCTL(0), 0);
- /* This is useful for sniffing bad packets. */
- if (adapter->netdev->features & NETIF_F_RXALL) {
- /* UPE and MPE will be handled by normal PROMISC logic
- * in set_rx_mode
- */
- rctl |= (IGC_RCTL_SBP | /* Receive bad packets */
- IGC_RCTL_BAM | /* RX All Bcast Pkts */
- IGC_RCTL_PMCF); /* RX All MAC Ctrl Pkts */
- rctl &= ~(IGC_RCTL_DPF | /* Allow filtered pause */
- IGC_RCTL_CFIEN); /* Disable VLAN CFIEN Filter */
- }
- wr32(IGC_RCTL, rctl);
- }
- /**
- * igc_setup_tctl - configure the transmit control registers
- * @adapter: Board private structure
- */
- static void igc_setup_tctl(struct igc_adapter *adapter)
- {
- struct igc_hw *hw = &adapter->hw;
- u32 tctl;
- /* disable queue 0 which icould be enabled by default */
- wr32(IGC_TXDCTL(0), 0);
- /* Program the Transmit Control Register */
- tctl = rd32(IGC_TCTL);
- tctl &= ~IGC_TCTL_CT;
- tctl |= IGC_TCTL_PSP | IGC_TCTL_RTLC |
- (IGC_COLLISION_THRESHOLD << IGC_CT_SHIFT);
- /* Enable transmits */
- tctl |= IGC_TCTL_EN;
- wr32(IGC_TCTL, tctl);
- }
- /**
- * igc_set_mac - Change the Ethernet Address of the NIC
- * @netdev: network interface device structure
- * @p: pointer to an address structure
- *
- * Returns 0 on success, negative on failure
- */
- static int igc_set_mac(struct net_device *netdev, void *p)
- {
- struct igc_adapter *adapter = netdev_priv(netdev);
- struct igc_hw *hw = &adapter->hw;
- struct sockaddr *addr = p;
- if (!is_valid_ether_addr(addr->sa_data))
- return -EADDRNOTAVAIL;
- memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len);
- memcpy(hw->mac.addr, addr->sa_data, netdev->addr_len);
- /* set the correct pool for the new PF MAC address in entry 0 */
- igc_set_default_mac_filter(adapter);
- return 0;
- }
- static void igc_tx_csum(struct igc_ring *tx_ring, struct igc_tx_buffer *first)
- {
- }
- static int __igc_maybe_stop_tx(struct igc_ring *tx_ring, const u16 size)
- {
- struct net_device *netdev = tx_ring->netdev;
- netif_stop_subqueue(netdev, tx_ring->queue_index);
- /* memory barriier comment */
- smp_mb();
- /* We need to check again in a case another CPU has just
- * made room available.
- */
- if (igc_desc_unused(tx_ring) < size)
- return -EBUSY;
- /* A reprieve! */
- netif_wake_subqueue(netdev, tx_ring->queue_index);
- u64_stats_update_begin(&tx_ring->tx_syncp2);
- tx_ring->tx_stats.restart_queue2++;
- u64_stats_update_end(&tx_ring->tx_syncp2);
- return 0;
- }
- static inline int igc_maybe_stop_tx(struct igc_ring *tx_ring, const u16 size)
- {
- if (igc_desc_unused(tx_ring) >= size)
- return 0;
- return __igc_maybe_stop_tx(tx_ring, size);
- }
- static u32 igc_tx_cmd_type(struct sk_buff *skb, u32 tx_flags)
- {
- /* set type for advanced descriptor with frame checksum insertion */
- u32 cmd_type = IGC_ADVTXD_DTYP_DATA |
- IGC_ADVTXD_DCMD_DEXT |
- IGC_ADVTXD_DCMD_IFCS;
- return cmd_type;
- }
- static void igc_tx_olinfo_status(struct igc_ring *tx_ring,
- union igc_adv_tx_desc *tx_desc,
- u32 tx_flags, unsigned int paylen)
- {
- u32 olinfo_status = paylen << IGC_ADVTXD_PAYLEN_SHIFT;
- /* insert L4 checksum */
- olinfo_status |= (tx_flags & IGC_TX_FLAGS_CSUM) *
- ((IGC_TXD_POPTS_TXSM << 8) /
- IGC_TX_FLAGS_CSUM);
- /* insert IPv4 checksum */
- olinfo_status |= (tx_flags & IGC_TX_FLAGS_IPV4) *
- (((IGC_TXD_POPTS_IXSM << 8)) /
- IGC_TX_FLAGS_IPV4);
- tx_desc->read.olinfo_status = cpu_to_le32(olinfo_status);
- }
- static int igc_tx_map(struct igc_ring *tx_ring,
- struct igc_tx_buffer *first,
- const u8 hdr_len)
- {
- struct sk_buff *skb = first->skb;
- struct igc_tx_buffer *tx_buffer;
- union igc_adv_tx_desc *tx_desc;
- u32 tx_flags = first->tx_flags;
- struct skb_frag_struct *frag;
- u16 i = tx_ring->next_to_use;
- unsigned int data_len, size;
- dma_addr_t dma;
- u32 cmd_type = igc_tx_cmd_type(skb, tx_flags);
- tx_desc = IGC_TX_DESC(tx_ring, i);
- igc_tx_olinfo_status(tx_ring, tx_desc, tx_flags, skb->len - hdr_len);
- size = skb_headlen(skb);
- data_len = skb->data_len;
- dma = dma_map_single(tx_ring->dev, skb->data, size, DMA_TO_DEVICE);
- tx_buffer = first;
- for (frag = &skb_shinfo(skb)->frags[0];; frag++) {
- if (dma_mapping_error(tx_ring->dev, dma))
- goto dma_error;
- /* record length, and DMA address */
- dma_unmap_len_set(tx_buffer, len, size);
- dma_unmap_addr_set(tx_buffer, dma, dma);
- tx_desc->read.buffer_addr = cpu_to_le64(dma);
- while (unlikely(size > IGC_MAX_DATA_PER_TXD)) {
- tx_desc->read.cmd_type_len =
- cpu_to_le32(cmd_type ^ IGC_MAX_DATA_PER_TXD);
- i++;
- tx_desc++;
- if (i == tx_ring->count) {
- tx_desc = IGC_TX_DESC(tx_ring, 0);
- i = 0;
- }
- tx_desc->read.olinfo_status = 0;
- dma += IGC_MAX_DATA_PER_TXD;
- size -= IGC_MAX_DATA_PER_TXD;
- tx_desc->read.buffer_addr = cpu_to_le64(dma);
- }
- if (likely(!data_len))
- break;
- tx_desc->read.cmd_type_len = cpu_to_le32(cmd_type ^ size);
- i++;
- tx_desc++;
- if (i == tx_ring->count) {
- tx_desc = IGC_TX_DESC(tx_ring, 0);
- i = 0;
- }
- tx_desc->read.olinfo_status = 0;
- size = skb_frag_size(frag);
- data_len -= size;
- dma = skb_frag_dma_map(tx_ring->dev, frag, 0,
- size, DMA_TO_DEVICE);
- tx_buffer = &tx_ring->tx_buffer_info[i];
- }
- /* write last descriptor with RS and EOP bits */
- cmd_type |= size | IGC_TXD_DCMD;
- tx_desc->read.cmd_type_len = cpu_to_le32(cmd_type);
- netdev_tx_sent_queue(txring_txq(tx_ring), first->bytecount);
- /* set the timestamp */
- first->time_stamp = jiffies;
- /* Force memory writes to complete before letting h/w know there
- * are new descriptors to fetch. (Only applicable for weak-ordered
- * memory model archs, such as IA-64).
- *
- * We also need this memory barrier to make certain all of the
- * status bits have been updated before next_to_watch is written.
- */
- wmb();
- /* set next_to_watch value indicating a packet is present */
- first->next_to_watch = tx_desc;
- i++;
- if (i == tx_ring->count)
- i = 0;
- tx_ring->next_to_use = i;
- /* Make sure there is space in the ring for the next send. */
- igc_maybe_stop_tx(tx_ring, DESC_NEEDED);
- if (netif_xmit_stopped(txring_txq(tx_ring)) || !skb->xmit_more) {
- writel(i, tx_ring->tail);
- /* we need this if more than one processor can write to our tail
- * at a time, it synchronizes IO on IA64/Altix systems
- */
- mmiowb();
- }
- return 0;
- dma_error:
- dev_err(tx_ring->dev, "TX DMA map failed\n");
- tx_buffer = &tx_ring->tx_buffer_info[i];
- /* clear dma mappings for failed tx_buffer_info map */
- while (tx_buffer != first) {
- if (dma_unmap_len(tx_buffer, len))
- dma_unmap_page(tx_ring->dev,
- dma_unmap_addr(tx_buffer, dma),
- dma_unmap_len(tx_buffer, len),
- DMA_TO_DEVICE);
- dma_unmap_len_set(tx_buffer, len, 0);
- if (i-- == 0)
- i += tx_ring->count;
- tx_buffer = &tx_ring->tx_buffer_info[i];
- }
- if (dma_unmap_len(tx_buffer, len))
- dma_unmap_single(tx_ring->dev,
- dma_unmap_addr(tx_buffer, dma),
- dma_unmap_len(tx_buffer, len),
- DMA_TO_DEVICE);
- dma_unmap_len_set(tx_buffer, len, 0);
- dev_kfree_skb_any(tx_buffer->skb);
- tx_buffer->skb = NULL;
- tx_ring->next_to_use = i;
- return -1;
- }
- static netdev_tx_t igc_xmit_frame_ring(struct sk_buff *skb,
- struct igc_ring *tx_ring)
- {
- u16 count = TXD_USE_COUNT(skb_headlen(skb));
- __be16 protocol = vlan_get_protocol(skb);
- struct igc_tx_buffer *first;
- u32 tx_flags = 0;
- unsigned short f;
- u8 hdr_len = 0;
- /* need: 1 descriptor per page * PAGE_SIZE/IGC_MAX_DATA_PER_TXD,
- * + 1 desc for skb_headlen/IGC_MAX_DATA_PER_TXD,
- * + 2 desc gap to keep tail from touching head,
- * + 1 desc for context descriptor,
- * otherwise try next time
- */
- for (f = 0; f < skb_shinfo(skb)->nr_frags; f++)
- count += TXD_USE_COUNT(skb_shinfo(skb)->frags[f].size);
- if (igc_maybe_stop_tx(tx_ring, count + 3)) {
- /* this is a hard error */
- return NETDEV_TX_BUSY;
- }
- /* record the location of the first descriptor for this packet */
- first = &tx_ring->tx_buffer_info[tx_ring->next_to_use];
- first->skb = skb;
- first->bytecount = skb->len;
- first->gso_segs = 1;
- skb_tx_timestamp(skb);
- /* record initial flags and protocol */
- first->tx_flags = tx_flags;
- first->protocol = protocol;
- igc_tx_csum(tx_ring, first);
- igc_tx_map(tx_ring, first, hdr_len);
- return NETDEV_TX_OK;
- }
- static inline struct igc_ring *igc_tx_queue_mapping(struct igc_adapter *adapter,
- struct sk_buff *skb)
- {
- unsigned int r_idx = skb->queue_mapping;
- if (r_idx >= adapter->num_tx_queues)
- r_idx = r_idx % adapter->num_tx_queues;
- return adapter->tx_ring[r_idx];
- }
- static netdev_tx_t igc_xmit_frame(struct sk_buff *skb,
- struct net_device *netdev)
- {
- struct igc_adapter *adapter = netdev_priv(netdev);
- /* The minimum packet size with TCTL.PSP set is 17 so pad the skb
- * in order to meet this minimum size requirement.
- */
- if (skb->len < 17) {
- if (skb_padto(skb, 17))
- return NETDEV_TX_OK;
- skb->len = 17;
- }
- return igc_xmit_frame_ring(skb, igc_tx_queue_mapping(adapter, skb));
- }
- static inline void igc_rx_hash(struct igc_ring *ring,
- union igc_adv_rx_desc *rx_desc,
- struct sk_buff *skb)
- {
- if (ring->netdev->features & NETIF_F_RXHASH)
- skb_set_hash(skb,
- le32_to_cpu(rx_desc->wb.lower.hi_dword.rss),
- PKT_HASH_TYPE_L3);
- }
- /**
- * igc_process_skb_fields - Populate skb header fields from Rx descriptor
- * @rx_ring: rx descriptor ring packet is being transacted on
- * @rx_desc: pointer to the EOP Rx descriptor
- * @skb: pointer to current skb being populated
- *
- * This function checks the ring, descriptor, and packet information in
- * order to populate the hash, checksum, VLAN, timestamp, protocol, and
- * other fields within the skb.
- */
- static void igc_process_skb_fields(struct igc_ring *rx_ring,
- union igc_adv_rx_desc *rx_desc,
- struct sk_buff *skb)
- {
- igc_rx_hash(rx_ring, rx_desc, skb);
- skb_record_rx_queue(skb, rx_ring->queue_index);
- skb->protocol = eth_type_trans(skb, rx_ring->netdev);
- }
- static struct igc_rx_buffer *igc_get_rx_buffer(struct igc_ring *rx_ring,
- const unsigned int size)
- {
- struct igc_rx_buffer *rx_buffer;
- rx_buffer = &rx_ring->rx_buffer_info[rx_ring->next_to_clean];
- prefetchw(rx_buffer->page);
- /* we are reusing so sync this buffer for CPU use */
- dma_sync_single_range_for_cpu(rx_ring->dev,
- rx_buffer->dma,
- rx_buffer->page_offset,
- size,
- DMA_FROM_DEVICE);
- rx_buffer->pagecnt_bias--;
- return rx_buffer;
- }
- /**
- * igc_add_rx_frag - Add contents of Rx buffer to sk_buff
- * @rx_ring: rx descriptor ring to transact packets on
- * @rx_buffer: buffer containing page to add
- * @skb: sk_buff to place the data into
- * @size: size of buffer to be added
- *
- * This function will add the data contained in rx_buffer->page to the skb.
- */
- static void igc_add_rx_frag(struct igc_ring *rx_ring,
- struct igc_rx_buffer *rx_buffer,
- struct sk_buff *skb,
- unsigned int size)
- {
- #if (PAGE_SIZE < 8192)
- unsigned int truesize = igc_rx_pg_size(rx_ring) / 2;
- skb_add_rx_frag(skb, skb_shinfo(skb)->nr_frags, rx_buffer->page,
- rx_buffer->page_offset, size, truesize);
- rx_buffer->page_offset ^= truesize;
- #else
- unsigned int truesize = ring_uses_build_skb(rx_ring) ?
- SKB_DATA_ALIGN(IGC_SKB_PAD + size) :
- SKB_DATA_ALIGN(size);
- skb_add_rx_frag(skb, skb_shinfo(skb)->nr_frags, rx_buffer->page,
- rx_buffer->page_offset, size, truesize);
- rx_buffer->page_offset += truesize;
- #endif
- }
- static struct sk_buff *igc_build_skb(struct igc_ring *rx_ring,
- struct igc_rx_buffer *rx_buffer,
- union igc_adv_rx_desc *rx_desc,
- unsigned int size)
- {
- void *va = page_address(rx_buffer->page) + rx_buffer->page_offset;
- #if (PAGE_SIZE < 8192)
- unsigned int truesize = igc_rx_pg_size(rx_ring) / 2;
- #else
- unsigned int truesize = SKB_DATA_ALIGN(sizeof(struct skb_shared_info)) +
- SKB_DATA_ALIGN(IGC_SKB_PAD + size);
- #endif
- struct sk_buff *skb;
- /* prefetch first cache line of first page */
- prefetch(va);
- #if L1_CACHE_BYTES < 128
- prefetch(va + L1_CACHE_BYTES);
- #endif
- /* build an skb around the page buffer */
- skb = build_skb(va - IGC_SKB_PAD, truesize);
- if (unlikely(!skb))
- return NULL;
- /* update pointers within the skb to store the data */
- skb_reserve(skb, IGC_SKB_PAD);
- __skb_put(skb, size);
- /* update buffer offset */
- #if (PAGE_SIZE < 8192)
- rx_buffer->page_offset ^= truesize;
- #else
- rx_buffer->page_offset += truesize;
- #endif
- return skb;
- }
- static struct sk_buff *igc_construct_skb(struct igc_ring *rx_ring,
- struct igc_rx_buffer *rx_buffer,
- union igc_adv_rx_desc *rx_desc,
- unsigned int size)
- {
- void *va = page_address(rx_buffer->page) + rx_buffer->page_offset;
- #if (PAGE_SIZE < 8192)
- unsigned int truesize = igc_rx_pg_size(rx_ring) / 2;
- #else
- unsigned int truesize = SKB_DATA_ALIGN(size);
- #endif
- unsigned int headlen;
- struct sk_buff *skb;
- /* prefetch first cache line of first page */
- prefetch(va);
- #if L1_CACHE_BYTES < 128
- prefetch(va + L1_CACHE_BYTES);
- #endif
- /* allocate a skb to store the frags */
- skb = napi_alloc_skb(&rx_ring->q_vector->napi, IGC_RX_HDR_LEN);
- if (unlikely(!skb))
- return NULL;
- /* Determine available headroom for copy */
- headlen = size;
- if (headlen > IGC_RX_HDR_LEN)
- headlen = eth_get_headlen(va, IGC_RX_HDR_LEN);
- /* align pull length to size of long to optimize memcpy performance */
- memcpy(__skb_put(skb, headlen), va, ALIGN(headlen, sizeof(long)));
- /* update all of the pointers */
- size -= headlen;
- if (size) {
- skb_add_rx_frag(skb, 0, rx_buffer->page,
- (va + headlen) - page_address(rx_buffer->page),
- size, truesize);
- #if (PAGE_SIZE < 8192)
- rx_buffer->page_offset ^= truesize;
- #else
- rx_buffer->page_offset += truesize;
- #endif
- } else {
- rx_buffer->pagecnt_bias++;
- }
- return skb;
- }
- /**
- * igc_reuse_rx_page - page flip buffer and store it back on the ring
- * @rx_ring: rx descriptor ring to store buffers on
- * @old_buff: donor buffer to have page reused
- *
- * Synchronizes page for reuse by the adapter
- */
- static void igc_reuse_rx_page(struct igc_ring *rx_ring,
- struct igc_rx_buffer *old_buff)
- {
- u16 nta = rx_ring->next_to_alloc;
- struct igc_rx_buffer *new_buff;
- new_buff = &rx_ring->rx_buffer_info[nta];
- /* update, and store next to alloc */
- nta++;
- rx_ring->next_to_alloc = (nta < rx_ring->count) ? nta : 0;
- /* Transfer page from old buffer to new buffer.
- * Move each member individually to avoid possible store
- * forwarding stalls.
- */
- new_buff->dma = old_buff->dma;
- new_buff->page = old_buff->page;
- new_buff->page_offset = old_buff->page_offset;
- new_buff->pagecnt_bias = old_buff->pagecnt_bias;
- }
- static inline bool igc_page_is_reserved(struct page *page)
- {
- return (page_to_nid(page) != numa_mem_id()) || page_is_pfmemalloc(page);
- }
- static bool igc_can_reuse_rx_page(struct igc_rx_buffer *rx_buffer)
- {
- unsigned int pagecnt_bias = rx_buffer->pagecnt_bias;
- struct page *page = rx_buffer->page;
- /* avoid re-using remote pages */
- if (unlikely(igc_page_is_reserved(page)))
- return false;
- #if (PAGE_SIZE < 8192)
- /* if we are only owner of page we can reuse it */
- if (unlikely((page_ref_count(page) - pagecnt_bias) > 1))
- return false;
- #else
- #define IGC_LAST_OFFSET \
- (SKB_WITH_OVERHEAD(PAGE_SIZE) - IGC_RXBUFFER_2048)
- if (rx_buffer->page_offset > IGC_LAST_OFFSET)
- return false;
- #endif
- /* If we have drained the page fragment pool we need to update
- * the pagecnt_bias and page count so that we fully restock the
- * number of references the driver holds.
- */
- if (unlikely(!pagecnt_bias)) {
- page_ref_add(page, USHRT_MAX);
- rx_buffer->pagecnt_bias = USHRT_MAX;
- }
- return true;
- }
- /**
- * igc_is_non_eop - process handling of non-EOP buffers
- * @rx_ring: Rx ring being processed
- * @rx_desc: Rx descriptor for current buffer
- * @skb: current socket buffer containing buffer in progress
- *
- * This function updates next to clean. If the buffer is an EOP buffer
- * this function exits returning false, otherwise it will place the
- * sk_buff in the next buffer to be chained and return true indicating
- * that this is in fact a non-EOP buffer.
- */
- static bool igc_is_non_eop(struct igc_ring *rx_ring,
- union igc_adv_rx_desc *rx_desc)
- {
- u32 ntc = rx_ring->next_to_clean + 1;
- /* fetch, update, and store next to clean */
- ntc = (ntc < rx_ring->count) ? ntc : 0;
- rx_ring->next_to_clean = ntc;
- prefetch(IGC_RX_DESC(rx_ring, ntc));
- if (likely(igc_test_staterr(rx_desc, IGC_RXD_STAT_EOP)))
- return false;
- return true;
- }
- /**
- * igc_cleanup_headers - Correct corrupted or empty headers
- * @rx_ring: rx descriptor ring packet is being transacted on
- * @rx_desc: pointer to the EOP Rx descriptor
- * @skb: pointer to current skb being fixed
- *
- * Address the case where we are pulling data in on pages only
- * and as such no data is present in the skb header.
- *
- * In addition if skb is not at least 60 bytes we need to pad it so that
- * it is large enough to qualify as a valid Ethernet frame.
- *
- * Returns true if an error was encountered and skb was freed.
- */
- static bool igc_cleanup_headers(struct igc_ring *rx_ring,
- union igc_adv_rx_desc *rx_desc,
- struct sk_buff *skb)
- {
- if (unlikely((igc_test_staterr(rx_desc,
- IGC_RXDEXT_ERR_FRAME_ERR_MASK)))) {
- struct net_device *netdev = rx_ring->netdev;
- if (!(netdev->features & NETIF_F_RXALL)) {
- dev_kfree_skb_any(skb);
- return true;
- }
- }
- /* if eth_skb_pad returns an error the skb was freed */
- if (eth_skb_pad(skb))
- return true;
- return false;
- }
- static void igc_put_rx_buffer(struct igc_ring *rx_ring,
- struct igc_rx_buffer *rx_buffer)
- {
- if (igc_can_reuse_rx_page(rx_buffer)) {
- /* hand second half of page back to the ring */
- igc_reuse_rx_page(rx_ring, rx_buffer);
- } else {
- /* We are not reusing the buffer so unmap it and free
- * any references we are holding to it
- */
- dma_unmap_page_attrs(rx_ring->dev, rx_buffer->dma,
- igc_rx_pg_size(rx_ring), DMA_FROM_DEVICE,
- IGC_RX_DMA_ATTR);
- __page_frag_cache_drain(rx_buffer->page,
- rx_buffer->pagecnt_bias);
- }
- /* clear contents of rx_buffer */
- rx_buffer->page = NULL;
- }
- /**
- * igc_alloc_rx_buffers - Replace used receive buffers; packet split
- * @adapter: address of board private structure
- */
- static void igc_alloc_rx_buffers(struct igc_ring *rx_ring, u16 cleaned_count)
- {
- union igc_adv_rx_desc *rx_desc;
- u16 i = rx_ring->next_to_use;
- struct igc_rx_buffer *bi;
- u16 bufsz;
- /* nothing to do */
- if (!cleaned_count)
- return;
- rx_desc = IGC_RX_DESC(rx_ring, i);
- bi = &rx_ring->rx_buffer_info[i];
- i -= rx_ring->count;
- bufsz = igc_rx_bufsz(rx_ring);
- do {
- if (!igc_alloc_mapped_page(rx_ring, bi))
- break;
- /* sync the buffer for use by the device */
- dma_sync_single_range_for_device(rx_ring->dev, bi->dma,
- bi->page_offset, bufsz,
- DMA_FROM_DEVICE);
- /* Refresh the desc even if buffer_addrs didn't change
- * because each write-back erases this info.
- */
- rx_desc->read.pkt_addr = cpu_to_le64(bi->dma + bi->page_offset);
- rx_desc++;
- bi++;
- i++;
- if (unlikely(!i)) {
- rx_desc = IGC_RX_DESC(rx_ring, 0);
- bi = rx_ring->rx_buffer_info;
- i -= rx_ring->count;
- }
- /* clear the length for the next_to_use descriptor */
- rx_desc->wb.upper.length = 0;
- cleaned_count--;
- } while (cleaned_count);
- i += rx_ring->count;
- if (rx_ring->next_to_use != i) {
- /* record the next descriptor to use */
- rx_ring->next_to_use = i;
- /* update next to alloc since we have filled the ring */
- rx_ring->next_to_alloc = i;
- /* Force memory writes to complete before letting h/w
- * know there are new descriptors to fetch. (Only
- * applicable for weak-ordered memory model archs,
- * such as IA-64).
- */
- wmb();
- writel(i, rx_ring->tail);
- }
- }
- static int igc_clean_rx_irq(struct igc_q_vector *q_vector, const int budget)
- {
- unsigned int total_bytes = 0, total_packets = 0;
- struct igc_ring *rx_ring = q_vector->rx.ring;
- struct sk_buff *skb = rx_ring->skb;
- u16 cleaned_count = igc_desc_unused(rx_ring);
- while (likely(total_packets < budget)) {
- union igc_adv_rx_desc *rx_desc;
- struct igc_rx_buffer *rx_buffer;
- unsigned int size;
- /* return some buffers to hardware, one at a time is too slow */
- if (cleaned_count >= IGC_RX_BUFFER_WRITE) {
- igc_alloc_rx_buffers(rx_ring, cleaned_count);
- cleaned_count = 0;
- }
- rx_desc = IGC_RX_DESC(rx_ring, rx_ring->next_to_clean);
- size = le16_to_cpu(rx_desc->wb.upper.length);
- if (!size)
- break;
- /* This memory barrier is needed to keep us from reading
- * any other fields out of the rx_desc until we know the
- * descriptor has been written back
- */
- dma_rmb();
- rx_buffer = igc_get_rx_buffer(rx_ring, size);
- /* retrieve a buffer from the ring */
- if (skb)
- igc_add_rx_frag(rx_ring, rx_buffer, skb, size);
- else if (ring_uses_build_skb(rx_ring))
- skb = igc_build_skb(rx_ring, rx_buffer, rx_desc, size);
- else
- skb = igc_construct_skb(rx_ring, rx_buffer,
- rx_desc, size);
- /* exit if we failed to retrieve a buffer */
- if (!skb) {
- rx_ring->rx_stats.alloc_failed++;
- rx_buffer->pagecnt_bias++;
- break;
- }
- igc_put_rx_buffer(rx_ring, rx_buffer);
- cleaned_count++;
- /* fetch next buffer in frame if non-eop */
- if (igc_is_non_eop(rx_ring, rx_desc))
- continue;
- /* verify the packet layout is correct */
- if (igc_cleanup_headers(rx_ring, rx_desc, skb)) {
- skb = NULL;
- continue;
- }
- /* probably a little skewed due to removing CRC */
- total_bytes += skb->len;
- /* populate checksum, timestamp, VLAN, and protocol */
- igc_process_skb_fields(rx_ring, rx_desc, skb);
- napi_gro_receive(&q_vector->napi, skb);
- /* reset skb pointer */
- skb = NULL;
- /* update budget accounting */
- total_packets++;
- }
- /* place incomplete frames back on ring for completion */
- rx_ring->skb = skb;
- u64_stats_update_begin(&rx_ring->rx_syncp);
- rx_ring->rx_stats.packets += total_packets;
- rx_ring->rx_stats.bytes += total_bytes;
- u64_stats_update_end(&rx_ring->rx_syncp);
- q_vector->rx.total_packets += total_packets;
- q_vector->rx.total_bytes += total_bytes;
- if (cleaned_count)
- igc_alloc_rx_buffers(rx_ring, cleaned_count);
- return total_packets;
- }
- static inline unsigned int igc_rx_offset(struct igc_ring *rx_ring)
- {
- return ring_uses_build_skb(rx_ring) ? IGC_SKB_PAD : 0;
- }
- static bool igc_alloc_mapped_page(struct igc_ring *rx_ring,
- struct igc_rx_buffer *bi)
- {
- struct page *page = bi->page;
- dma_addr_t dma;
- /* since we are recycling buffers we should seldom need to alloc */
- if (likely(page))
- return true;
- /* alloc new page for storage */
- page = dev_alloc_pages(igc_rx_pg_order(rx_ring));
- if (unlikely(!page)) {
- rx_ring->rx_stats.alloc_failed++;
- return false;
- }
- /* map page for use */
- dma = dma_map_page_attrs(rx_ring->dev, page, 0,
- igc_rx_pg_size(rx_ring),
- DMA_FROM_DEVICE,
- IGC_RX_DMA_ATTR);
- /* if mapping failed free memory back to system since
- * there isn't much point in holding memory we can't use
- */
- if (dma_mapping_error(rx_ring->dev, dma)) {
- __free_page(page);
- rx_ring->rx_stats.alloc_failed++;
- return false;
- }
- bi->dma = dma;
- bi->page = page;
- bi->page_offset = igc_rx_offset(rx_ring);
- bi->pagecnt_bias = 1;
- return true;
- }
- /**
- * igc_clean_tx_irq - Reclaim resources after transmit completes
- * @q_vector: pointer to q_vector containing needed info
- * @napi_budget: Used to determine if we are in netpoll
- *
- * returns true if ring is completely cleaned
- */
- static bool igc_clean_tx_irq(struct igc_q_vector *q_vector, int napi_budget)
- {
- struct igc_adapter *adapter = q_vector->adapter;
- unsigned int total_bytes = 0, total_packets = 0;
- unsigned int budget = q_vector->tx.work_limit;
- struct igc_ring *tx_ring = q_vector->tx.ring;
- unsigned int i = tx_ring->next_to_clean;
- struct igc_tx_buffer *tx_buffer;
- union igc_adv_tx_desc *tx_desc;
- if (test_bit(__IGC_DOWN, &adapter->state))
- return true;
- tx_buffer = &tx_ring->tx_buffer_info[i];
- tx_desc = IGC_TX_DESC(tx_ring, i);
- i -= tx_ring->count;
- do {
- union igc_adv_tx_desc *eop_desc = tx_buffer->next_to_watch;
- /* if next_to_watch is not set then there is no work pending */
- if (!eop_desc)
- break;
- /* prevent any other reads prior to eop_desc */
- smp_rmb();
- /* if DD is not set pending work has not been completed */
- if (!(eop_desc->wb.status & cpu_to_le32(IGC_TXD_STAT_DD)))
- break;
- /* clear next_to_watch to prevent false hangs */
- tx_buffer->next_to_watch = NULL;
- /* update the statistics for this packet */
- total_bytes += tx_buffer->bytecount;
- total_packets += tx_buffer->gso_segs;
- /* free the skb */
- napi_consume_skb(tx_buffer->skb, napi_budget);
- /* unmap skb header data */
- dma_unmap_single(tx_ring->dev,
- dma_unmap_addr(tx_buffer, dma),
- dma_unmap_len(tx_buffer, len),
- DMA_TO_DEVICE);
- /* clear tx_buffer data */
- dma_unmap_len_set(tx_buffer, len, 0);
- /* clear last DMA location and unmap remaining buffers */
- while (tx_desc != eop_desc) {
- tx_buffer++;
- tx_desc++;
- i++;
- if (unlikely(!i)) {
- i -= tx_ring->count;
- tx_buffer = tx_ring->tx_buffer_info;
- tx_desc = IGC_TX_DESC(tx_ring, 0);
- }
- /* unmap any remaining paged data */
- if (dma_unmap_len(tx_buffer, len)) {
- dma_unmap_page(tx_ring->dev,
- dma_unmap_addr(tx_buffer, dma),
- dma_unmap_len(tx_buffer, len),
- DMA_TO_DEVICE);
- dma_unmap_len_set(tx_buffer, len, 0);
- }
- }
- /* move us one more past the eop_desc for start of next pkt */
- tx_buffer++;
- tx_desc++;
- i++;
- if (unlikely(!i)) {
- i -= tx_ring->count;
- tx_buffer = tx_ring->tx_buffer_info;
- tx_desc = IGC_TX_DESC(tx_ring, 0);
- }
- /* issue prefetch for next Tx descriptor */
- prefetch(tx_desc);
- /* update budget accounting */
- budget--;
- } while (likely(budget));
- netdev_tx_completed_queue(txring_txq(tx_ring),
- total_packets, total_bytes);
- i += tx_ring->count;
- tx_ring->next_to_clean = i;
- u64_stats_update_begin(&tx_ring->tx_syncp);
- tx_ring->tx_stats.bytes += total_bytes;
- tx_ring->tx_stats.packets += total_packets;
- u64_stats_update_end(&tx_ring->tx_syncp);
- q_vector->tx.total_bytes += total_bytes;
- q_vector->tx.total_packets += total_packets;
- if (test_bit(IGC_RING_FLAG_TX_DETECT_HANG, &tx_ring->flags)) {
- struct igc_hw *hw = &adapter->hw;
- /* Detect a transmit hang in hardware, this serializes the
- * check with the clearing of time_stamp and movement of i
- */
- clear_bit(IGC_RING_FLAG_TX_DETECT_HANG, &tx_ring->flags);
- if (tx_buffer->next_to_watch &&
- time_after(jiffies, tx_buffer->time_stamp +
- (adapter->tx_timeout_factor * HZ)) &&
- !(rd32(IGC_STATUS) & IGC_STATUS_TXOFF)) {
- /* detected Tx unit hang */
- dev_err(tx_ring->dev,
- "Detected Tx Unit Hang\n"
- " Tx Queue <%d>\n"
- " TDH <%x>\n"
- " TDT <%x>\n"
- " next_to_use <%x>\n"
- " next_to_clean <%x>\n"
- "buffer_info[next_to_clean]\n"
- " time_stamp <%lx>\n"
- " next_to_watch <%p>\n"
- " jiffies <%lx>\n"
- " desc.status <%x>\n",
- tx_ring->queue_index,
- rd32(IGC_TDH(tx_ring->reg_idx)),
- readl(tx_ring->tail),
- tx_ring->next_to_use,
- tx_ring->next_to_clean,
- tx_buffer->time_stamp,
- tx_buffer->next_to_watch,
- jiffies,
- tx_buffer->next_to_watch->wb.status);
- netif_stop_subqueue(tx_ring->netdev,
- tx_ring->queue_index);
- /* we are about to reset, no point in enabling stuff */
- return true;
- }
- }
- #define TX_WAKE_THRESHOLD (DESC_NEEDED * 2)
- if (unlikely(total_packets &&
- netif_carrier_ok(tx_ring->netdev) &&
- igc_desc_unused(tx_ring) >= TX_WAKE_THRESHOLD)) {
- /* Make sure that anybody stopping the queue after this
- * sees the new next_to_clean.
- */
- smp_mb();
- if (__netif_subqueue_stopped(tx_ring->netdev,
- tx_ring->queue_index) &&
- !(test_bit(__IGC_DOWN, &adapter->state))) {
- netif_wake_subqueue(tx_ring->netdev,
- tx_ring->queue_index);
- u64_stats_update_begin(&tx_ring->tx_syncp);
- tx_ring->tx_stats.restart_queue++;
- u64_stats_update_end(&tx_ring->tx_syncp);
- }
- }
- return !!budget;
- }
- /**
- * igc_ioctl - I/O control method
- * @netdev: network interface device structure
- * @ifreq: frequency
- * @cmd: command
- */
- static int igc_ioctl(struct net_device *netdev, struct ifreq *ifr, int cmd)
- {
- switch (cmd) {
- default:
- return -EOPNOTSUPP;
- }
- }
- /**
- * igc_up - Open the interface and prepare it to handle traffic
- * @adapter: board private structure
- */
- static void igc_up(struct igc_adapter *adapter)
- {
- struct igc_hw *hw = &adapter->hw;
- int i = 0;
- /* hardware has been reset, we need to reload some things */
- igc_configure(adapter);
- clear_bit(__IGC_DOWN, &adapter->state);
- for (i = 0; i < adapter->num_q_vectors; i++)
- napi_enable(&adapter->q_vector[i]->napi);
- if (adapter->msix_entries)
- igc_configure_msix(adapter);
- else
- igc_assign_vector(adapter->q_vector[0], 0);
- /* Clear any pending interrupts. */
- rd32(IGC_ICR);
- igc_irq_enable(adapter);
- netif_tx_start_all_queues(adapter->netdev);
- /* start the watchdog. */
- hw->mac.get_link_status = 1;
- }
- /**
- * igc_update_stats - Update the board statistics counters
- * @adapter: board private structure
- */
- static void igc_update_stats(struct igc_adapter *adapter)
- {
- }
- static void igc_nfc_filter_exit(struct igc_adapter *adapter)
- {
- }
- /**
- * igc_down - Close the interface
- * @adapter: board private structure
- */
- static void igc_down(struct igc_adapter *adapter)
- {
- struct net_device *netdev = adapter->netdev;
- struct igc_hw *hw = &adapter->hw;
- u32 tctl, rctl;
- int i = 0;
- set_bit(__IGC_DOWN, &adapter->state);
- /* disable receives in the hardware */
- rctl = rd32(IGC_RCTL);
- wr32(IGC_RCTL, rctl & ~IGC_RCTL_EN);
- /* flush and sleep below */
- igc_nfc_filter_exit(adapter);
- /* set trans_start so we don't get spurious watchdogs during reset */
- netif_trans_update(netdev);
- netif_carrier_off(netdev);
- netif_tx_stop_all_queues(netdev);
- /* disable transmits in the hardware */
- tctl = rd32(IGC_TCTL);
- tctl &= ~IGC_TCTL_EN;
- wr32(IGC_TCTL, tctl);
- /* flush both disables and wait for them to finish */
- wrfl();
- usleep_range(10000, 20000);
- igc_irq_disable(adapter);
- adapter->flags &= ~IGC_FLAG_NEED_LINK_UPDATE;
- for (i = 0; i < adapter->num_q_vectors; i++) {
- if (adapter->q_vector[i]) {
- napi_synchronize(&adapter->q_vector[i]->napi);
- napi_disable(&adapter->q_vector[i]->napi);
- }
- }
- del_timer_sync(&adapter->watchdog_timer);
- del_timer_sync(&adapter->phy_info_timer);
- /* record the stats before reset*/
- spin_lock(&adapter->stats64_lock);
- igc_update_stats(adapter);
- spin_unlock(&adapter->stats64_lock);
- adapter->link_speed = 0;
- adapter->link_duplex = 0;
- if (!pci_channel_offline(adapter->pdev))
- igc_reset(adapter);
- /* clear VLAN promisc flag so VFTA will be updated if necessary */
- adapter->flags &= ~IGC_FLAG_VLAN_PROMISC;
- igc_clean_all_tx_rings(adapter);
- igc_clean_all_rx_rings(adapter);
- }
- static void igc_reinit_locked(struct igc_adapter *adapter)
- {
- WARN_ON(in_interrupt());
- while (test_and_set_bit(__IGC_RESETTING, &adapter->state))
- usleep_range(1000, 2000);
- igc_down(adapter);
- igc_up(adapter);
- clear_bit(__IGC_RESETTING, &adapter->state);
- }
- static void igc_reset_task(struct work_struct *work)
- {
- struct igc_adapter *adapter;
- adapter = container_of(work, struct igc_adapter, reset_task);
- netdev_err(adapter->netdev, "Reset adapter\n");
- igc_reinit_locked(adapter);
- }
- /**
- * igc_change_mtu - Change the Maximum Transfer Unit
- * @netdev: network interface device structure
- * @new_mtu: new value for maximum frame size
- *
- * Returns 0 on success, negative on failure
- */
- static int igc_change_mtu(struct net_device *netdev, int new_mtu)
- {
- int max_frame = new_mtu + ETH_HLEN + ETH_FCS_LEN + VLAN_HLEN;
- struct igc_adapter *adapter = netdev_priv(netdev);
- struct pci_dev *pdev = adapter->pdev;
- /* adjust max frame to be at least the size of a standard frame */
- if (max_frame < (ETH_FRAME_LEN + ETH_FCS_LEN))
- max_frame = ETH_FRAME_LEN + ETH_FCS_LEN;
- while (test_and_set_bit(__IGC_RESETTING, &adapter->state))
- usleep_range(1000, 2000);
- /* igc_down has a dependency on max_frame_size */
- adapter->max_frame_size = max_frame;
- if (netif_running(netdev))
- igc_down(adapter);
- dev_info(&pdev->dev, "changing MTU from %d to %d\n",
- netdev->mtu, new_mtu);
- netdev->mtu = new_mtu;
- if (netif_running(netdev))
- igc_up(adapter);
- else
- igc_reset(adapter);
- clear_bit(__IGC_RESETTING, &adapter->state);
- return 0;
- }
- /**
- * igc_get_stats - Get System Network Statistics
- * @netdev: network interface device structure
- *
- * Returns the address of the device statistics structure.
- * The statistics are updated here and also from the timer callback.
- */
- static struct net_device_stats *igc_get_stats(struct net_device *netdev)
- {
- struct igc_adapter *adapter = netdev_priv(netdev);
- if (!test_bit(__IGC_RESETTING, &adapter->state))
- igc_update_stats(adapter);
- /* only return the current stats */
- return &netdev->stats;
- }
- /**
- * igc_configure - configure the hardware for RX and TX
- * @adapter: private board structure
- */
- static void igc_configure(struct igc_adapter *adapter)
- {
- struct net_device *netdev = adapter->netdev;
- int i = 0;
- igc_get_hw_control(adapter);
- igc_set_rx_mode(netdev);
- igc_setup_tctl(adapter);
- igc_setup_mrqc(adapter);
- igc_setup_rctl(adapter);
- igc_configure_tx(adapter);
- igc_configure_rx(adapter);
- igc_rx_fifo_flush_base(&adapter->hw);
- /* call igc_desc_unused which always leaves
- * at least 1 descriptor unused to make sure
- * next_to_use != next_to_clean
- */
- for (i = 0; i < adapter->num_rx_queues; i++) {
- struct igc_ring *ring = adapter->rx_ring[i];
- igc_alloc_rx_buffers(ring, igc_desc_unused(ring));
- }
- }
- /**
- * igc_rar_set_index - Sync RAL[index] and RAH[index] registers with MAC table
- * @adapter: Pointer to adapter structure
- * @index: Index of the RAR entry which need to be synced with MAC table
- */
- static void igc_rar_set_index(struct igc_adapter *adapter, u32 index)
- {
- u8 *addr = adapter->mac_table[index].addr;
- struct igc_hw *hw = &adapter->hw;
- u32 rar_low, rar_high;
- /* HW expects these to be in network order when they are plugged
- * into the registers which are little endian. In order to guarantee
- * that ordering we need to do an leXX_to_cpup here in order to be
- * ready for the byteswap that occurs with writel
- */
- rar_low = le32_to_cpup((__le32 *)(addr));
- rar_high = le16_to_cpup((__le16 *)(addr + 4));
- /* Indicate to hardware the Address is Valid. */
- if (adapter->mac_table[index].state & IGC_MAC_STATE_IN_USE) {
- if (is_valid_ether_addr(addr))
- rar_high |= IGC_RAH_AV;
- rar_high |= IGC_RAH_POOL_1 <<
- adapter->mac_table[index].queue;
- }
- wr32(IGC_RAL(index), rar_low);
- wrfl();
- wr32(IGC_RAH(index), rar_high);
- wrfl();
- }
- /* Set default MAC address for the PF in the first RAR entry */
- static void igc_set_default_mac_filter(struct igc_adapter *adapter)
- {
- struct igc_mac_addr *mac_table = &adapter->mac_table[0];
- ether_addr_copy(mac_table->addr, adapter->hw.mac.addr);
- mac_table->state = IGC_MAC_STATE_DEFAULT | IGC_MAC_STATE_IN_USE;
- igc_rar_set_index(adapter, 0);
- }
- /**
- * igc_set_rx_mode - Secondary Unicast, Multicast and Promiscuous mode set
- * @netdev: network interface device structure
- *
- * The set_rx_mode entry point is called whenever the unicast or multicast
- * address lists or the network interface flags are updated. This routine is
- * responsible for configuring the hardware for proper unicast, multicast,
- * promiscuous mode, and all-multi behavior.
- */
- static void igc_set_rx_mode(struct net_device *netdev)
- {
- }
- /**
- * igc_msix_other - msix other interrupt handler
- * @irq: interrupt number
- * @data: pointer to a q_vector
- */
- static irqreturn_t igc_msix_other(int irq, void *data)
- {
- struct igc_adapter *adapter = data;
- struct igc_hw *hw = &adapter->hw;
- u32 icr = rd32(IGC_ICR);
- /* reading ICR causes bit 31 of EICR to be cleared */
- if (icr & IGC_ICR_DRSTA)
- schedule_work(&adapter->reset_task);
- if (icr & IGC_ICR_DOUTSYNC) {
- /* HW is reporting DMA is out of sync */
- adapter->stats.doosync++;
- }
- if (icr & IGC_ICR_LSC) {
- hw->mac.get_link_status = 1;
- /* guard against interrupt when we're going down */
- if (!test_bit(__IGC_DOWN, &adapter->state))
- mod_timer(&adapter->watchdog_timer, jiffies + 1);
- }
- wr32(IGC_EIMS, adapter->eims_other);
- return IRQ_HANDLED;
- }
- /**
- * igc_write_ivar - configure ivar for given MSI-X vector
- * @hw: pointer to the HW structure
- * @msix_vector: vector number we are allocating to a given ring
- * @index: row index of IVAR register to write within IVAR table
- * @offset: column offset of in IVAR, should be multiple of 8
- *
- * The IVAR table consists of 2 columns,
- * each containing an cause allocation for an Rx and Tx ring, and a
- * variable number of rows depending on the number of queues supported.
- */
- static void igc_write_ivar(struct igc_hw *hw, int msix_vector,
- int index, int offset)
- {
- u32 ivar = array_rd32(IGC_IVAR0, index);
- /* clear any bits that are currently set */
- ivar &= ~((u32)0xFF << offset);
- /* write vector and valid bit */
- ivar |= (msix_vector | IGC_IVAR_VALID) << offset;
- array_wr32(IGC_IVAR0, index, ivar);
- }
- static void igc_assign_vector(struct igc_q_vector *q_vector, int msix_vector)
- {
- struct igc_adapter *adapter = q_vector->adapter;
- struct igc_hw *hw = &adapter->hw;
- int rx_queue = IGC_N0_QUEUE;
- int tx_queue = IGC_N0_QUEUE;
- if (q_vector->rx.ring)
- rx_queue = q_vector->rx.ring->reg_idx;
- if (q_vector->tx.ring)
- tx_queue = q_vector->tx.ring->reg_idx;
- switch (hw->mac.type) {
- case igc_i225:
- if (rx_queue > IGC_N0_QUEUE)
- igc_write_ivar(hw, msix_vector,
- rx_queue >> 1,
- (rx_queue & 0x1) << 4);
- if (tx_queue > IGC_N0_QUEUE)
- igc_write_ivar(hw, msix_vector,
- tx_queue >> 1,
- ((tx_queue & 0x1) << 4) + 8);
- q_vector->eims_value = BIT(msix_vector);
- break;
- default:
- WARN_ONCE(hw->mac.type != igc_i225, "Wrong MAC type\n");
- break;
- }
- /* add q_vector eims value to global eims_enable_mask */
- adapter->eims_enable_mask |= q_vector->eims_value;
- /* configure q_vector to set itr on first interrupt */
- q_vector->set_itr = 1;
- }
- /**
- * igc_configure_msix - Configure MSI-X hardware
- * @adapter: Pointer to adapter structure
- *
- * igc_configure_msix sets up the hardware to properly
- * generate MSI-X interrupts.
- */
- static void igc_configure_msix(struct igc_adapter *adapter)
- {
- struct igc_hw *hw = &adapter->hw;
- int i, vector = 0;
- u32 tmp;
- adapter->eims_enable_mask = 0;
- /* set vector for other causes, i.e. link changes */
- switch (hw->mac.type) {
- case igc_i225:
- /* Turn on MSI-X capability first, or our settings
- * won't stick. And it will take days to debug.
- */
- wr32(IGC_GPIE, IGC_GPIE_MSIX_MODE |
- IGC_GPIE_PBA | IGC_GPIE_EIAME |
- IGC_GPIE_NSICR);
- /* enable msix_other interrupt */
- adapter->eims_other = BIT(vector);
- tmp = (vector++ | IGC_IVAR_VALID) << 8;
- wr32(IGC_IVAR_MISC, tmp);
- break;
- default:
- /* do nothing, since nothing else supports MSI-X */
- break;
- } /* switch (hw->mac.type) */
- adapter->eims_enable_mask |= adapter->eims_other;
- for (i = 0; i < adapter->num_q_vectors; i++)
- igc_assign_vector(adapter->q_vector[i], vector++);
- wrfl();
- }
- static irqreturn_t igc_msix_ring(int irq, void *data)
- {
- struct igc_q_vector *q_vector = data;
- /* Write the ITR value calculated from the previous interrupt. */
- igc_write_itr(q_vector);
- napi_schedule(&q_vector->napi);
- return IRQ_HANDLED;
- }
- /**
- * igc_request_msix - Initialize MSI-X interrupts
- * @adapter: Pointer to adapter structure
- *
- * igc_request_msix allocates MSI-X vectors and requests interrupts from the
- * kernel.
- */
- static int igc_request_msix(struct igc_adapter *adapter)
- {
- int i = 0, err = 0, vector = 0, free_vector = 0;
- struct net_device *netdev = adapter->netdev;
- err = request_irq(adapter->msix_entries[vector].vector,
- &igc_msix_other, 0, netdev->name, adapter);
- if (err)
- goto err_out;
- for (i = 0; i < adapter->num_q_vectors; i++) {
- struct igc_q_vector *q_vector = adapter->q_vector[i];
- vector++;
- q_vector->itr_register = adapter->io_addr + IGC_EITR(vector);
- if (q_vector->rx.ring && q_vector->tx.ring)
- sprintf(q_vector->name, "%s-TxRx-%u", netdev->name,
- q_vector->rx.ring->queue_index);
- else if (q_vector->tx.ring)
- sprintf(q_vector->name, "%s-tx-%u", netdev->name,
- q_vector->tx.ring->queue_index);
- else if (q_vector->rx.ring)
- sprintf(q_vector->name, "%s-rx-%u", netdev->name,
- q_vector->rx.ring->queue_index);
- else
- sprintf(q_vector->name, "%s-unused", netdev->name);
- err = request_irq(adapter->msix_entries[vector].vector,
- igc_msix_ring, 0, q_vector->name,
- q_vector);
- if (err)
- goto err_free;
- }
- igc_configure_msix(adapter);
- return 0;
- err_free:
- /* free already assigned IRQs */
- free_irq(adapter->msix_entries[free_vector++].vector, adapter);
- vector--;
- for (i = 0; i < vector; i++) {
- free_irq(adapter->msix_entries[free_vector++].vector,
- adapter->q_vector[i]);
- }
- err_out:
- return err;
- }
- /**
- * igc_reset_q_vector - Reset config for interrupt vector
- * @adapter: board private structure to initialize
- * @v_idx: Index of vector to be reset
- *
- * If NAPI is enabled it will delete any references to the
- * NAPI struct. This is preparation for igc_free_q_vector.
- */
- static void igc_reset_q_vector(struct igc_adapter *adapter, int v_idx)
- {
- struct igc_q_vector *q_vector = adapter->q_vector[v_idx];
- /* if we're coming from igc_set_interrupt_capability, the vectors are
- * not yet allocated
- */
- if (!q_vector)
- return;
- if (q_vector->tx.ring)
- adapter->tx_ring[q_vector->tx.ring->queue_index] = NULL;
- if (q_vector->rx.ring)
- adapter->rx_ring[q_vector->rx.ring->queue_index] = NULL;
- netif_napi_del(&q_vector->napi);
- }
- static void igc_reset_interrupt_capability(struct igc_adapter *adapter)
- {
- int v_idx = adapter->num_q_vectors;
- if (adapter->msix_entries) {
- pci_disable_msix(adapter->pdev);
- kfree(adapter->msix_entries);
- adapter->msix_entries = NULL;
- } else if (adapter->flags & IGC_FLAG_HAS_MSI) {
- pci_disable_msi(adapter->pdev);
- }
- while (v_idx--)
- igc_reset_q_vector(adapter, v_idx);
- }
- /**
- * igc_clear_interrupt_scheme - reset the device to a state of no interrupts
- * @adapter: Pointer to adapter structure
- *
- * This function resets the device so that it has 0 rx queues, tx queues, and
- * MSI-X interrupts allocated.
- */
- static void igc_clear_interrupt_scheme(struct igc_adapter *adapter)
- {
- igc_free_q_vectors(adapter);
- igc_reset_interrupt_capability(adapter);
- }
- /**
- * igc_free_q_vectors - Free memory allocated for interrupt vectors
- * @adapter: board private structure to initialize
- *
- * This function frees the memory allocated to the q_vectors. In addition if
- * NAPI is enabled it will delete any references to the NAPI struct prior
- * to freeing the q_vector.
- */
- static void igc_free_q_vectors(struct igc_adapter *adapter)
- {
- int v_idx = adapter->num_q_vectors;
- adapter->num_tx_queues = 0;
- adapter->num_rx_queues = 0;
- adapter->num_q_vectors = 0;
- while (v_idx--) {
- igc_reset_q_vector(adapter, v_idx);
- igc_free_q_vector(adapter, v_idx);
- }
- }
- /**
- * igc_free_q_vector - Free memory allocated for specific interrupt vector
- * @adapter: board private structure to initialize
- * @v_idx: Index of vector to be freed
- *
- * This function frees the memory allocated to the q_vector.
- */
- static void igc_free_q_vector(struct igc_adapter *adapter, int v_idx)
- {
- struct igc_q_vector *q_vector = adapter->q_vector[v_idx];
- adapter->q_vector[v_idx] = NULL;
- /* igc_get_stats64() might access the rings on this vector,
- * we must wait a grace period before freeing it.
- */
- if (q_vector)
- kfree_rcu(q_vector, rcu);
- }
- /**
- * igc_watchdog - Timer Call-back
- * @data: pointer to adapter cast into an unsigned long
- */
- static void igc_watchdog(struct timer_list *t)
- {
- struct igc_adapter *adapter = from_timer(adapter, t, watchdog_timer);
- }
- /**
- * igc_update_ring_itr - update the dynamic ITR value based on packet size
- * @q_vector: pointer to q_vector
- *
- * Stores a new ITR value based on strictly on packet size. This
- * algorithm is less sophisticated than that used in igc_update_itr,
- * due to the difficulty of synchronizing statistics across multiple
- * receive rings. The divisors and thresholds used by this function
- * were determined based on theoretical maximum wire speed and testing
- * data, in order to minimize response time while increasing bulk
- * throughput.
- * NOTE: This function is called only when operating in a multiqueue
- * receive environment.
- */
- static void igc_update_ring_itr(struct igc_q_vector *q_vector)
- {
- struct igc_adapter *adapter = q_vector->adapter;
- int new_val = q_vector->itr_val;
- int avg_wire_size = 0;
- unsigned int packets;
- /* For non-gigabit speeds, just fix the interrupt rate at 4000
- * ints/sec - ITR timer value of 120 ticks.
- */
- switch (adapter->link_speed) {
- case SPEED_10:
- case SPEED_100:
- new_val = IGC_4K_ITR;
- goto set_itr_val;
- default:
- break;
- }
- packets = q_vector->rx.total_packets;
- if (packets)
- avg_wire_size = q_vector->rx.total_bytes / packets;
- packets = q_vector->tx.total_packets;
- if (packets)
- avg_wire_size = max_t(u32, avg_wire_size,
- q_vector->tx.total_bytes / packets);
- /* if avg_wire_size isn't set no work was done */
- if (!avg_wire_size)
- goto clear_counts;
- /* Add 24 bytes to size to account for CRC, preamble, and gap */
- avg_wire_size += 24;
- /* Don't starve jumbo frames */
- avg_wire_size = min(avg_wire_size, 3000);
- /* Give a little boost to mid-size frames */
- if (avg_wire_size > 300 && avg_wire_size < 1200)
- new_val = avg_wire_size / 3;
- else
- new_val = avg_wire_size / 2;
- /* conservative mode (itr 3) eliminates the lowest_latency setting */
- if (new_val < IGC_20K_ITR &&
- ((q_vector->rx.ring && adapter->rx_itr_setting == 3) ||
- (!q_vector->rx.ring && adapter->tx_itr_setting == 3)))
- new_val = IGC_20K_ITR;
- set_itr_val:
- if (new_val != q_vector->itr_val) {
- q_vector->itr_val = new_val;
- q_vector->set_itr = 1;
- }
- clear_counts:
- q_vector->rx.total_bytes = 0;
- q_vector->rx.total_packets = 0;
- q_vector->tx.total_bytes = 0;
- q_vector->tx.total_packets = 0;
- }
- /**
- * igc_update_itr - update the dynamic ITR value based on statistics
- * @q_vector: pointer to q_vector
- * @ring_container: ring info to update the itr for
- *
- * Stores a new ITR value based on packets and byte
- * counts during the last interrupt. The advantage of per interrupt
- * computation is faster updates and more accurate ITR for the current
- * traffic pattern. Constants in this function were computed
- * based on theoretical maximum wire speed and thresholds were set based
- * on testing data as well as attempting to minimize response time
- * while increasing bulk throughput.
- * NOTE: These calculations are only valid when operating in a single-
- * queue environment.
- */
- static void igc_update_itr(struct igc_q_vector *q_vector,
- struct igc_ring_container *ring_container)
- {
- unsigned int packets = ring_container->total_packets;
- unsigned int bytes = ring_container->total_bytes;
- u8 itrval = ring_container->itr;
- /* no packets, exit with status unchanged */
- if (packets == 0)
- return;
- switch (itrval) {
- case lowest_latency:
- /* handle TSO and jumbo frames */
- if (bytes / packets > 8000)
- itrval = bulk_latency;
- else if ((packets < 5) && (bytes > 512))
- itrval = low_latency;
- break;
- case low_latency: /* 50 usec aka 20000 ints/s */
- if (bytes > 10000) {
- /* this if handles the TSO accounting */
- if (bytes / packets > 8000)
- itrval = bulk_latency;
- else if ((packets < 10) || ((bytes / packets) > 1200))
- itrval = bulk_latency;
- else if ((packets > 35))
- itrval = lowest_latency;
- } else if (bytes / packets > 2000) {
- itrval = bulk_latency;
- } else if (packets <= 2 && bytes < 512) {
- itrval = lowest_latency;
- }
- break;
- case bulk_latency: /* 250 usec aka 4000 ints/s */
- if (bytes > 25000) {
- if (packets > 35)
- itrval = low_latency;
- } else if (bytes < 1500) {
- itrval = low_latency;
- }
- break;
- }
- /* clear work counters since we have the values we need */
- ring_container->total_bytes = 0;
- ring_container->total_packets = 0;
- /* write updated itr to ring container */
- ring_container->itr = itrval;
- }
- /**
- * igc_intr_msi - Interrupt Handler
- * @irq: interrupt number
- * @data: pointer to a network interface device structure
- */
- static irqreturn_t igc_intr_msi(int irq, void *data)
- {
- struct igc_adapter *adapter = data;
- struct igc_q_vector *q_vector = adapter->q_vector[0];
- struct igc_hw *hw = &adapter->hw;
- /* read ICR disables interrupts using IAM */
- u32 icr = rd32(IGC_ICR);
- igc_write_itr(q_vector);
- if (icr & IGC_ICR_DRSTA)
- schedule_work(&adapter->reset_task);
- if (icr & IGC_ICR_DOUTSYNC) {
- /* HW is reporting DMA is out of sync */
- adapter->stats.doosync++;
- }
- if (icr & (IGC_ICR_RXSEQ | IGC_ICR_LSC)) {
- hw->mac.get_link_status = 1;
- if (!test_bit(__IGC_DOWN, &adapter->state))
- mod_timer(&adapter->watchdog_timer, jiffies + 1);
- }
- napi_schedule(&q_vector->napi);
- return IRQ_HANDLED;
- }
- /**
- * igc_intr - Legacy Interrupt Handler
- * @irq: interrupt number
- * @data: pointer to a network interface device structure
- */
- static irqreturn_t igc_intr(int irq, void *data)
- {
- struct igc_adapter *adapter = data;
- struct igc_q_vector *q_vector = adapter->q_vector[0];
- struct igc_hw *hw = &adapter->hw;
- /* Interrupt Auto-Mask...upon reading ICR, interrupts are masked. No
- * need for the IMC write
- */
- u32 icr = rd32(IGC_ICR);
- /* IMS will not auto-mask if INT_ASSERTED is not set, and if it is
- * not set, then the adapter didn't send an interrupt
- */
- if (!(icr & IGC_ICR_INT_ASSERTED))
- return IRQ_NONE;
- igc_write_itr(q_vector);
- if (icr & IGC_ICR_DRSTA)
- schedule_work(&adapter->reset_task);
- if (icr & IGC_ICR_DOUTSYNC) {
- /* HW is reporting DMA is out of sync */
- adapter->stats.doosync++;
- }
- if (icr & (IGC_ICR_RXSEQ | IGC_ICR_LSC)) {
- hw->mac.get_link_status = 1;
- /* guard against interrupt when we're going down */
- if (!test_bit(__IGC_DOWN, &adapter->state))
- mod_timer(&adapter->watchdog_timer, jiffies + 1);
- }
- napi_schedule(&q_vector->napi);
- return IRQ_HANDLED;
- }
- static void igc_set_itr(struct igc_q_vector *q_vector)
- {
- struct igc_adapter *adapter = q_vector->adapter;
- u32 new_itr = q_vector->itr_val;
- u8 current_itr = 0;
- /* for non-gigabit speeds, just fix the interrupt rate at 4000 */
- switch (adapter->link_speed) {
- case SPEED_10:
- case SPEED_100:
- current_itr = 0;
- new_itr = IGC_4K_ITR;
- goto set_itr_now;
- default:
- break;
- }
- igc_update_itr(q_vector, &q_vector->tx);
- igc_update_itr(q_vector, &q_vector->rx);
- current_itr = max(q_vector->rx.itr, q_vector->tx.itr);
- /* conservative mode (itr 3) eliminates the lowest_latency setting */
- if (current_itr == lowest_latency &&
- ((q_vector->rx.ring && adapter->rx_itr_setting == 3) ||
- (!q_vector->rx.ring && adapter->tx_itr_setting == 3)))
- current_itr = low_latency;
- switch (current_itr) {
- /* counts and packets in update_itr are dependent on these numbers */
- case lowest_latency:
- new_itr = IGC_70K_ITR; /* 70,000 ints/sec */
- break;
- case low_latency:
- new_itr = IGC_20K_ITR; /* 20,000 ints/sec */
- break;
- case bulk_latency:
- new_itr = IGC_4K_ITR; /* 4,000 ints/sec */
- break;
- default:
- break;
- }
- set_itr_now:
- if (new_itr != q_vector->itr_val) {
- /* this attempts to bias the interrupt rate towards Bulk
- * by adding intermediate steps when interrupt rate is
- * increasing
- */
- new_itr = new_itr > q_vector->itr_val ?
- max((new_itr * q_vector->itr_val) /
- (new_itr + (q_vector->itr_val >> 2)),
- new_itr) : new_itr;
- /* Don't write the value here; it resets the adapter's
- * internal timer, and causes us to delay far longer than
- * we should between interrupts. Instead, we write the ITR
- * value at the beginning of the next interrupt so the timing
- * ends up being correct.
- */
- q_vector->itr_val = new_itr;
- q_vector->set_itr = 1;
- }
- }
- static void igc_ring_irq_enable(struct igc_q_vector *q_vector)
- {
- struct igc_adapter *adapter = q_vector->adapter;
- struct igc_hw *hw = &adapter->hw;
- if ((q_vector->rx.ring && (adapter->rx_itr_setting & 3)) ||
- (!q_vector->rx.ring && (adapter->tx_itr_setting & 3))) {
- if (adapter->num_q_vectors == 1)
- igc_set_itr(q_vector);
- else
- igc_update_ring_itr(q_vector);
- }
- if (!test_bit(__IGC_DOWN, &adapter->state)) {
- if (adapter->msix_entries)
- wr32(IGC_EIMS, q_vector->eims_value);
- else
- igc_irq_enable(adapter);
- }
- }
- /**
- * igc_poll - NAPI Rx polling callback
- * @napi: napi polling structure
- * @budget: count of how many packets we should handle
- */
- static int igc_poll(struct napi_struct *napi, int budget)
- {
- struct igc_q_vector *q_vector = container_of(napi,
- struct igc_q_vector,
- napi);
- bool clean_complete = true;
- int work_done = 0;
- if (q_vector->tx.ring)
- clean_complete = igc_clean_tx_irq(q_vector, budget);
- if (q_vector->rx.ring) {
- int cleaned = igc_clean_rx_irq(q_vector, budget);
- work_done += cleaned;
- if (cleaned >= budget)
- clean_complete = false;
- }
- /* If all work not completed, return budget and keep polling */
- if (!clean_complete)
- return budget;
- /* If not enough Rx work done, exit the polling mode */
- napi_complete_done(napi, work_done);
- igc_ring_irq_enable(q_vector);
- return 0;
- }
- /**
- * igc_set_interrupt_capability - set MSI or MSI-X if supported
- * @adapter: Pointer to adapter structure
- *
- * Attempt to configure interrupts using the best available
- * capabilities of the hardware and kernel.
- */
- static void igc_set_interrupt_capability(struct igc_adapter *adapter,
- bool msix)
- {
- int numvecs, i;
- int err;
- if (!msix)
- goto msi_only;
- adapter->flags |= IGC_FLAG_HAS_MSIX;
- /* Number of supported queues. */
- adapter->num_rx_queues = adapter->rss_queues;
- adapter->num_tx_queues = adapter->rss_queues;
- /* start with one vector for every Rx queue */
- numvecs = adapter->num_rx_queues;
- /* if Tx handler is separate add 1 for every Tx queue */
- if (!(adapter->flags & IGC_FLAG_QUEUE_PAIRS))
- numvecs += adapter->num_tx_queues;
- /* store the number of vectors reserved for queues */
- adapter->num_q_vectors = numvecs;
- /* add 1 vector for link status interrupts */
- numvecs++;
- adapter->msix_entries = kcalloc(numvecs, sizeof(struct msix_entry),
- GFP_KERNEL);
- if (!adapter->msix_entries)
- return;
- /* populate entry values */
- for (i = 0; i < numvecs; i++)
- adapter->msix_entries[i].entry = i;
- err = pci_enable_msix_range(adapter->pdev,
- adapter->msix_entries,
- numvecs,
- numvecs);
- if (err > 0)
- return;
- kfree(adapter->msix_entries);
- adapter->msix_entries = NULL;
- igc_reset_interrupt_capability(adapter);
- msi_only:
- adapter->flags &= ~IGC_FLAG_HAS_MSIX;
- adapter->rss_queues = 1;
- adapter->flags |= IGC_FLAG_QUEUE_PAIRS;
- adapter->num_rx_queues = 1;
- adapter->num_tx_queues = 1;
- adapter->num_q_vectors = 1;
- if (!pci_enable_msi(adapter->pdev))
- adapter->flags |= IGC_FLAG_HAS_MSI;
- }
- static void igc_add_ring(struct igc_ring *ring,
- struct igc_ring_container *head)
- {
- head->ring = ring;
- head->count++;
- }
- /**
- * igc_alloc_q_vector - Allocate memory for a single interrupt vector
- * @adapter: board private structure to initialize
- * @v_count: q_vectors allocated on adapter, used for ring interleaving
- * @v_idx: index of vector in adapter struct
- * @txr_count: total number of Tx rings to allocate
- * @txr_idx: index of first Tx ring to allocate
- * @rxr_count: total number of Rx rings to allocate
- * @rxr_idx: index of first Rx ring to allocate
- *
- * We allocate one q_vector. If allocation fails we return -ENOMEM.
- */
- static int igc_alloc_q_vector(struct igc_adapter *adapter,
- unsigned int v_count, unsigned int v_idx,
- unsigned int txr_count, unsigned int txr_idx,
- unsigned int rxr_count, unsigned int rxr_idx)
- {
- struct igc_q_vector *q_vector;
- struct igc_ring *ring;
- int ring_count, size;
- /* igc only supports 1 Tx and/or 1 Rx queue per vector */
- if (txr_count > 1 || rxr_count > 1)
- return -ENOMEM;
- ring_count = txr_count + rxr_count;
- size = sizeof(struct igc_q_vector) +
- (sizeof(struct igc_ring) * ring_count);
- /* allocate q_vector and rings */
- q_vector = adapter->q_vector[v_idx];
- if (!q_vector)
- q_vector = kzalloc(size, GFP_KERNEL);
- else
- memset(q_vector, 0, size);
- if (!q_vector)
- return -ENOMEM;
- /* initialize NAPI */
- netif_napi_add(adapter->netdev, &q_vector->napi,
- igc_poll, 64);
- /* tie q_vector and adapter together */
- adapter->q_vector[v_idx] = q_vector;
- q_vector->adapter = adapter;
- /* initialize work limits */
- q_vector->tx.work_limit = adapter->tx_work_limit;
- /* initialize ITR configuration */
- q_vector->itr_register = adapter->io_addr + IGC_EITR(0);
- q_vector->itr_val = IGC_START_ITR;
- /* initialize pointer to rings */
- ring = q_vector->ring;
- /* initialize ITR */
- if (rxr_count) {
- /* rx or rx/tx vector */
- if (!adapter->rx_itr_setting || adapter->rx_itr_setting > 3)
- q_vector->itr_val = adapter->rx_itr_setting;
- } else {
- /* tx only vector */
- if (!adapter->tx_itr_setting || adapter->tx_itr_setting > 3)
- q_vector->itr_val = adapter->tx_itr_setting;
- }
- if (txr_count) {
- /* assign generic ring traits */
- ring->dev = &adapter->pdev->dev;
- ring->netdev = adapter->netdev;
- /* configure backlink on ring */
- ring->q_vector = q_vector;
- /* update q_vector Tx values */
- igc_add_ring(ring, &q_vector->tx);
- /* apply Tx specific ring traits */
- ring->count = adapter->tx_ring_count;
- ring->queue_index = txr_idx;
- /* assign ring to adapter */
- adapter->tx_ring[txr_idx] = ring;
- /* push pointer to next ring */
- ring++;
- }
- if (rxr_count) {
- /* assign generic ring traits */
- ring->dev = &adapter->pdev->dev;
- ring->netdev = adapter->netdev;
- /* configure backlink on ring */
- ring->q_vector = q_vector;
- /* update q_vector Rx values */
- igc_add_ring(ring, &q_vector->rx);
- /* apply Rx specific ring traits */
- ring->count = adapter->rx_ring_count;
- ring->queue_index = rxr_idx;
- /* assign ring to adapter */
- adapter->rx_ring[rxr_idx] = ring;
- }
- return 0;
- }
- /**
- * igc_alloc_q_vectors - Allocate memory for interrupt vectors
- * @adapter: board private structure to initialize
- *
- * We allocate one q_vector per queue interrupt. If allocation fails we
- * return -ENOMEM.
- */
- static int igc_alloc_q_vectors(struct igc_adapter *adapter)
- {
- int rxr_remaining = adapter->num_rx_queues;
- int txr_remaining = adapter->num_tx_queues;
- int rxr_idx = 0, txr_idx = 0, v_idx = 0;
- int q_vectors = adapter->num_q_vectors;
- int err;
- if (q_vectors >= (rxr_remaining + txr_remaining)) {
- for (; rxr_remaining; v_idx++) {
- err = igc_alloc_q_vector(adapter, q_vectors, v_idx,
- 0, 0, 1, rxr_idx);
- if (err)
- goto err_out;
- /* update counts and index */
- rxr_remaining--;
- rxr_idx++;
- }
- }
- for (; v_idx < q_vectors; v_idx++) {
- int rqpv = DIV_ROUND_UP(rxr_remaining, q_vectors - v_idx);
- int tqpv = DIV_ROUND_UP(txr_remaining, q_vectors - v_idx);
- err = igc_alloc_q_vector(adapter, q_vectors, v_idx,
- tqpv, txr_idx, rqpv, rxr_idx);
- if (err)
- goto err_out;
- /* update counts and index */
- rxr_remaining -= rqpv;
- txr_remaining -= tqpv;
- rxr_idx++;
- txr_idx++;
- }
- return 0;
- err_out:
- adapter->num_tx_queues = 0;
- adapter->num_rx_queues = 0;
- adapter->num_q_vectors = 0;
- while (v_idx--)
- igc_free_q_vector(adapter, v_idx);
- return -ENOMEM;
- }
- /**
- * igc_cache_ring_register - Descriptor ring to register mapping
- * @adapter: board private structure to initialize
- *
- * Once we know the feature-set enabled for the device, we'll cache
- * the register offset the descriptor ring is assigned to.
- */
- static void igc_cache_ring_register(struct igc_adapter *adapter)
- {
- int i = 0, j = 0;
- switch (adapter->hw.mac.type) {
- case igc_i225:
- /* Fall through */
- default:
- for (; i < adapter->num_rx_queues; i++)
- adapter->rx_ring[i]->reg_idx = i;
- for (; j < adapter->num_tx_queues; j++)
- adapter->tx_ring[j]->reg_idx = j;
- break;
- }
- }
- /**
- * igc_init_interrupt_scheme - initialize interrupts, allocate queues/vectors
- * @adapter: Pointer to adapter structure
- *
- * This function initializes the interrupts and allocates all of the queues.
- */
- static int igc_init_interrupt_scheme(struct igc_adapter *adapter, bool msix)
- {
- struct pci_dev *pdev = adapter->pdev;
- int err = 0;
- igc_set_interrupt_capability(adapter, msix);
- err = igc_alloc_q_vectors(adapter);
- if (err) {
- dev_err(&pdev->dev, "Unable to allocate memory for vectors\n");
- goto err_alloc_q_vectors;
- }
- igc_cache_ring_register(adapter);
- return 0;
- err_alloc_q_vectors:
- igc_reset_interrupt_capability(adapter);
- return err;
- }
- static void igc_free_irq(struct igc_adapter *adapter)
- {
- if (adapter->msix_entries) {
- int vector = 0, i;
- free_irq(adapter->msix_entries[vector++].vector, adapter);
- for (i = 0; i < adapter->num_q_vectors; i++)
- free_irq(adapter->msix_entries[vector++].vector,
- adapter->q_vector[i]);
- } else {
- free_irq(adapter->pdev->irq, adapter);
- }
- }
- /**
- * igc_irq_disable - Mask off interrupt generation on the NIC
- * @adapter: board private structure
- */
- static void igc_irq_disable(struct igc_adapter *adapter)
- {
- struct igc_hw *hw = &adapter->hw;
- if (adapter->msix_entries) {
- u32 regval = rd32(IGC_EIAM);
- wr32(IGC_EIAM, regval & ~adapter->eims_enable_mask);
- wr32(IGC_EIMC, adapter->eims_enable_mask);
- regval = rd32(IGC_EIAC);
- wr32(IGC_EIAC, regval & ~adapter->eims_enable_mask);
- }
- wr32(IGC_IAM, 0);
- wr32(IGC_IMC, ~0);
- wrfl();
- if (adapter->msix_entries) {
- int vector = 0, i;
- synchronize_irq(adapter->msix_entries[vector++].vector);
- for (i = 0; i < adapter->num_q_vectors; i++)
- synchronize_irq(adapter->msix_entries[vector++].vector);
- } else {
- synchronize_irq(adapter->pdev->irq);
- }
- }
- /**
- * igc_irq_enable - Enable default interrupt generation settings
- * @adapter: board private structure
- */
- static void igc_irq_enable(struct igc_adapter *adapter)
- {
- struct igc_hw *hw = &adapter->hw;
- if (adapter->msix_entries) {
- u32 ims = IGC_IMS_LSC | IGC_IMS_DOUTSYNC | IGC_IMS_DRSTA;
- u32 regval = rd32(IGC_EIAC);
- wr32(IGC_EIAC, regval | adapter->eims_enable_mask);
- regval = rd32(IGC_EIAM);
- wr32(IGC_EIAM, regval | adapter->eims_enable_mask);
- wr32(IGC_EIMS, adapter->eims_enable_mask);
- wr32(IGC_IMS, ims);
- } else {
- wr32(IGC_IMS, IMS_ENABLE_MASK | IGC_IMS_DRSTA);
- wr32(IGC_IAM, IMS_ENABLE_MASK | IGC_IMS_DRSTA);
- }
- }
- /**
- * igc_request_irq - initialize interrupts
- * @adapter: Pointer to adapter structure
- *
- * Attempts to configure interrupts using the best available
- * capabilities of the hardware and kernel.
- */
- static int igc_request_irq(struct igc_adapter *adapter)
- {
- struct net_device *netdev = adapter->netdev;
- struct pci_dev *pdev = adapter->pdev;
- int err = 0;
- if (adapter->flags & IGC_FLAG_HAS_MSIX) {
- err = igc_request_msix(adapter);
- if (!err)
- goto request_done;
- /* fall back to MSI */
- igc_free_all_tx_resources(adapter);
- igc_free_all_rx_resources(adapter);
- igc_clear_interrupt_scheme(adapter);
- err = igc_init_interrupt_scheme(adapter, false);
- if (err)
- goto request_done;
- igc_setup_all_tx_resources(adapter);
- igc_setup_all_rx_resources(adapter);
- igc_configure(adapter);
- }
- igc_assign_vector(adapter->q_vector[0], 0);
- if (adapter->flags & IGC_FLAG_HAS_MSI) {
- err = request_irq(pdev->irq, &igc_intr_msi, 0,
- netdev->name, adapter);
- if (!err)
- goto request_done;
- /* fall back to legacy interrupts */
- igc_reset_interrupt_capability(adapter);
- adapter->flags &= ~IGC_FLAG_HAS_MSI;
- }
- err = request_irq(pdev->irq, &igc_intr, IRQF_SHARED,
- netdev->name, adapter);
- if (err)
- dev_err(&pdev->dev, "Error %d getting interrupt\n",
- err);
- request_done:
- return err;
- }
- static void igc_write_itr(struct igc_q_vector *q_vector)
- {
- u32 itr_val = q_vector->itr_val & IGC_QVECTOR_MASK;
- if (!q_vector->set_itr)
- return;
- if (!itr_val)
- itr_val = IGC_ITR_VAL_MASK;
- itr_val |= IGC_EITR_CNT_IGNR;
- writel(itr_val, q_vector->itr_register);
- q_vector->set_itr = 0;
- }
- /**
- * igc_open - Called when a network interface is made active
- * @netdev: network interface device structure
- *
- * Returns 0 on success, negative value on failure
- *
- * The open entry point is called when a network interface is made
- * active by the system (IFF_UP). At this point all resources needed
- * for transmit and receive operations are allocated, the interrupt
- * handler is registered with the OS, the watchdog timer is started,
- * and the stack is notified that the interface is ready.
- */
- static int __igc_open(struct net_device *netdev, bool resuming)
- {
- struct igc_adapter *adapter = netdev_priv(netdev);
- struct igc_hw *hw = &adapter->hw;
- int err = 0;
- int i = 0;
- /* disallow open during test */
- if (test_bit(__IGC_TESTING, &adapter->state)) {
- WARN_ON(resuming);
- return -EBUSY;
- }
- netif_carrier_off(netdev);
- /* allocate transmit descriptors */
- err = igc_setup_all_tx_resources(adapter);
- if (err)
- goto err_setup_tx;
- /* allocate receive descriptors */
- err = igc_setup_all_rx_resources(adapter);
- if (err)
- goto err_setup_rx;
- igc_power_up_link(adapter);
- igc_configure(adapter);
- err = igc_request_irq(adapter);
- if (err)
- goto err_req_irq;
- /* Notify the stack of the actual queue counts. */
- netif_set_real_num_tx_queues(netdev, adapter->num_tx_queues);
- if (err)
- goto err_set_queues;
- err = netif_set_real_num_rx_queues(netdev, adapter->num_rx_queues);
- if (err)
- goto err_set_queues;
- clear_bit(__IGC_DOWN, &adapter->state);
- for (i = 0; i < adapter->num_q_vectors; i++)
- napi_enable(&adapter->q_vector[i]->napi);
- /* Clear any pending interrupts. */
- rd32(IGC_ICR);
- igc_irq_enable(adapter);
- netif_tx_start_all_queues(netdev);
- /* start the watchdog. */
- hw->mac.get_link_status = 1;
- return IGC_SUCCESS;
- err_set_queues:
- igc_free_irq(adapter);
- err_req_irq:
- igc_release_hw_control(adapter);
- igc_power_down_link(adapter);
- igc_free_all_rx_resources(adapter);
- err_setup_rx:
- igc_free_all_tx_resources(adapter);
- err_setup_tx:
- igc_reset(adapter);
- return err;
- }
- static int igc_open(struct net_device *netdev)
- {
- return __igc_open(netdev, false);
- }
- /**
- * igc_close - Disables a network interface
- * @netdev: network interface device structure
- *
- * Returns 0, this is not allowed to fail
- *
- * The close entry point is called when an interface is de-activated
- * by the OS. The hardware is still under the driver's control, but
- * needs to be disabled. A global MAC reset is issued to stop the
- * hardware, and all transmit and receive resources are freed.
- */
- static int __igc_close(struct net_device *netdev, bool suspending)
- {
- struct igc_adapter *adapter = netdev_priv(netdev);
- WARN_ON(test_bit(__IGC_RESETTING, &adapter->state));
- igc_down(adapter);
- igc_release_hw_control(adapter);
- igc_free_irq(adapter);
- igc_free_all_tx_resources(adapter);
- igc_free_all_rx_resources(adapter);
- return 0;
- }
- static int igc_close(struct net_device *netdev)
- {
- if (netif_device_present(netdev) || netdev->dismantle)
- return __igc_close(netdev, false);
- return 0;
- }
- static const struct net_device_ops igc_netdev_ops = {
- .ndo_open = igc_open,
- .ndo_stop = igc_close,
- .ndo_start_xmit = igc_xmit_frame,
- .ndo_set_mac_address = igc_set_mac,
- .ndo_change_mtu = igc_change_mtu,
- .ndo_get_stats = igc_get_stats,
- .ndo_do_ioctl = igc_ioctl,
- };
- /* PCIe configuration access */
- void igc_read_pci_cfg(struct igc_hw *hw, u32 reg, u16 *value)
- {
- struct igc_adapter *adapter = hw->back;
- pci_read_config_word(adapter->pdev, reg, value);
- }
- void igc_write_pci_cfg(struct igc_hw *hw, u32 reg, u16 *value)
- {
- struct igc_adapter *adapter = hw->back;
- pci_write_config_word(adapter->pdev, reg, *value);
- }
- s32 igc_read_pcie_cap_reg(struct igc_hw *hw, u32 reg, u16 *value)
- {
- struct igc_adapter *adapter = hw->back;
- u16 cap_offset;
- cap_offset = pci_find_capability(adapter->pdev, PCI_CAP_ID_EXP);
- if (!cap_offset)
- return -IGC_ERR_CONFIG;
- pci_read_config_word(adapter->pdev, cap_offset + reg, value);
- return IGC_SUCCESS;
- }
- s32 igc_write_pcie_cap_reg(struct igc_hw *hw, u32 reg, u16 *value)
- {
- struct igc_adapter *adapter = hw->back;
- u16 cap_offset;
- cap_offset = pci_find_capability(adapter->pdev, PCI_CAP_ID_EXP);
- if (!cap_offset)
- return -IGC_ERR_CONFIG;
- pci_write_config_word(adapter->pdev, cap_offset + reg, *value);
- return IGC_SUCCESS;
- }
- u32 igc_rd32(struct igc_hw *hw, u32 reg)
- {
- struct igc_adapter *igc = container_of(hw, struct igc_adapter, hw);
- u8 __iomem *hw_addr = READ_ONCE(hw->hw_addr);
- u32 value = 0;
- if (IGC_REMOVED(hw_addr))
- return ~value;
- value = readl(&hw_addr[reg]);
- /* reads should not return all F's */
- if (!(~value) && (!reg || !(~readl(hw_addr)))) {
- struct net_device *netdev = igc->netdev;
- hw->hw_addr = NULL;
- netif_device_detach(netdev);
- netdev_err(netdev, "PCIe link lost, device now detached\n");
- }
- return value;
- }
- /**
- * igc_probe - Device Initialization Routine
- * @pdev: PCI device information struct
- * @ent: entry in igc_pci_tbl
- *
- * Returns 0 on success, negative on failure
- *
- * igc_probe initializes an adapter identified by a pci_dev structure.
- * The OS initialization, configuring the adapter private structure,
- * and a hardware reset occur.
- */
- static int igc_probe(struct pci_dev *pdev,
- const struct pci_device_id *ent)
- {
- struct igc_adapter *adapter;
- struct net_device *netdev;
- struct igc_hw *hw;
- const struct igc_info *ei = igc_info_tbl[ent->driver_data];
- int err, pci_using_dac;
- err = pci_enable_device_mem(pdev);
- if (err)
- return err;
- pci_using_dac = 0;
- err = dma_set_mask(&pdev->dev, DMA_BIT_MASK(64));
- if (!err) {
- err = dma_set_coherent_mask(&pdev->dev,
- DMA_BIT_MASK(64));
- if (!err)
- pci_using_dac = 1;
- } else {
- err = dma_set_mask(&pdev->dev, DMA_BIT_MASK(32));
- if (err) {
- err = dma_set_coherent_mask(&pdev->dev,
- DMA_BIT_MASK(32));
- if (err) {
- IGC_ERR("Wrong DMA configuration, aborting\n");
- goto err_dma;
- }
- }
- }
- err = pci_request_selected_regions(pdev,
- pci_select_bars(pdev,
- IORESOURCE_MEM),
- igc_driver_name);
- if (err)
- goto err_pci_reg;
- pci_enable_pcie_error_reporting(pdev);
- pci_set_master(pdev);
- err = -ENOMEM;
- netdev = alloc_etherdev_mq(sizeof(struct igc_adapter),
- IGC_MAX_TX_QUEUES);
- if (!netdev)
- goto err_alloc_etherdev;
- SET_NETDEV_DEV(netdev, &pdev->dev);
- pci_set_drvdata(pdev, netdev);
- adapter = netdev_priv(netdev);
- adapter->netdev = netdev;
- adapter->pdev = pdev;
- hw = &adapter->hw;
- hw->back = adapter;
- adapter->port_num = hw->bus.func;
- adapter->msg_enable = GENMASK(debug - 1, 0);
- err = pci_save_state(pdev);
- if (err)
- goto err_ioremap;
- err = -EIO;
- adapter->io_addr = ioremap(pci_resource_start(pdev, 0),
- pci_resource_len(pdev, 0));
- if (!adapter->io_addr)
- goto err_ioremap;
- /* hw->hw_addr can be zeroed, so use adapter->io_addr for unmap */
- hw->hw_addr = adapter->io_addr;
- netdev->netdev_ops = &igc_netdev_ops;
- netdev->watchdog_timeo = 5 * HZ;
- netdev->mem_start = pci_resource_start(pdev, 0);
- netdev->mem_end = pci_resource_end(pdev, 0);
- /* PCI config space info */
- hw->vendor_id = pdev->vendor;
- hw->device_id = pdev->device;
- hw->revision_id = pdev->revision;
- hw->subsystem_vendor_id = pdev->subsystem_vendor;
- hw->subsystem_device_id = pdev->subsystem_device;
- /* Copy the default MAC and PHY function pointers */
- memcpy(&hw->mac.ops, ei->mac_ops, sizeof(hw->mac.ops));
- /* Initialize skew-specific constants */
- err = ei->get_invariants(hw);
- if (err)
- goto err_sw_init;
- /* setup the private structure */
- err = igc_sw_init(adapter);
- if (err)
- goto err_sw_init;
- /* MTU range: 68 - 9216 */
- netdev->min_mtu = ETH_MIN_MTU;
- netdev->max_mtu = MAX_STD_JUMBO_FRAME_SIZE;
- /* configure RXPBSIZE and TXPBSIZE */
- wr32(IGC_RXPBS, I225_RXPBSIZE_DEFAULT);
- wr32(IGC_TXPBS, I225_TXPBSIZE_DEFAULT);
- timer_setup(&adapter->watchdog_timer, igc_watchdog, 0);
- INIT_WORK(&adapter->reset_task, igc_reset_task);
- /* reset the hardware with the new settings */
- igc_reset(adapter);
- /* let the f/w know that the h/w is now under the control of the
- * driver.
- */
- igc_get_hw_control(adapter);
- strncpy(netdev->name, "eth%d", IFNAMSIZ);
- err = register_netdev(netdev);
- if (err)
- goto err_register;
- /* carrier off reporting is important to ethtool even BEFORE open */
- netif_carrier_off(netdev);
- /* Check if Media Autosense is enabled */
- adapter->ei = *ei;
- /* print pcie link status and MAC address */
- pcie_print_link_status(pdev);
- netdev_info(netdev, "MAC: %pM\n", netdev->dev_addr);
- return 0;
- err_register:
- igc_release_hw_control(adapter);
- err_sw_init:
- igc_clear_interrupt_scheme(adapter);
- iounmap(adapter->io_addr);
- err_ioremap:
- free_netdev(netdev);
- err_alloc_etherdev:
- pci_release_selected_regions(pdev,
- pci_select_bars(pdev, IORESOURCE_MEM));
- err_pci_reg:
- err_dma:
- pci_disable_device(pdev);
- return err;
- }
- /**
- * igc_remove - Device Removal Routine
- * @pdev: PCI device information struct
- *
- * igc_remove is called by the PCI subsystem to alert the driver
- * that it should release a PCI device. This could be caused by a
- * Hot-Plug event, or because the driver is going to be removed from
- * memory.
- */
- static void igc_remove(struct pci_dev *pdev)
- {
- struct net_device *netdev = pci_get_drvdata(pdev);
- struct igc_adapter *adapter = netdev_priv(netdev);
- set_bit(__IGC_DOWN, &adapter->state);
- del_timer_sync(&adapter->watchdog_timer);
- cancel_work_sync(&adapter->reset_task);
- /* Release control of h/w to f/w. If f/w is AMT enabled, this
- * would have already happened in close and is redundant.
- */
- igc_release_hw_control(adapter);
- unregister_netdev(netdev);
- igc_clear_interrupt_scheme(adapter);
- pci_iounmap(pdev, adapter->io_addr);
- pci_release_mem_regions(pdev);
- kfree(adapter->mac_table);
- kfree(adapter->shadow_vfta);
- free_netdev(netdev);
- pci_disable_pcie_error_reporting(pdev);
- pci_disable_device(pdev);
- }
- static struct pci_driver igc_driver = {
- .name = igc_driver_name,
- .id_table = igc_pci_tbl,
- .probe = igc_probe,
- .remove = igc_remove,
- };
- static void igc_set_flag_queue_pairs(struct igc_adapter *adapter,
- const u32 max_rss_queues)
- {
- /* Determine if we need to pair queues. */
- /* If rss_queues > half of max_rss_queues, pair the queues in
- * order to conserve interrupts due to limited supply.
- */
- if (adapter->rss_queues > (max_rss_queues / 2))
- adapter->flags |= IGC_FLAG_QUEUE_PAIRS;
- else
- adapter->flags &= ~IGC_FLAG_QUEUE_PAIRS;
- }
- static unsigned int igc_get_max_rss_queues(struct igc_adapter *adapter)
- {
- unsigned int max_rss_queues;
- /* Determine the maximum number of RSS queues supported. */
- max_rss_queues = IGC_MAX_RX_QUEUES;
- return max_rss_queues;
- }
- static void igc_init_queue_configuration(struct igc_adapter *adapter)
- {
- u32 max_rss_queues;
- max_rss_queues = igc_get_max_rss_queues(adapter);
- adapter->rss_queues = min_t(u32, max_rss_queues, num_online_cpus());
- igc_set_flag_queue_pairs(adapter, max_rss_queues);
- }
- /**
- * igc_sw_init - Initialize general software structures (struct igc_adapter)
- * @adapter: board private structure to initialize
- *
- * igc_sw_init initializes the Adapter private data structure.
- * Fields are initialized based on PCI device information and
- * OS network device settings (MTU size).
- */
- static int igc_sw_init(struct igc_adapter *adapter)
- {
- struct net_device *netdev = adapter->netdev;
- struct pci_dev *pdev = adapter->pdev;
- struct igc_hw *hw = &adapter->hw;
- int size = sizeof(struct igc_mac_addr) * hw->mac.rar_entry_count;
- pci_read_config_word(pdev, PCI_COMMAND, &hw->bus.pci_cmd_word);
- /* set default ring sizes */
- adapter->tx_ring_count = IGC_DEFAULT_TXD;
- adapter->rx_ring_count = IGC_DEFAULT_RXD;
- /* set default ITR values */
- adapter->rx_itr_setting = IGC_DEFAULT_ITR;
- adapter->tx_itr_setting = IGC_DEFAULT_ITR;
- /* set default work limits */
- adapter->tx_work_limit = IGC_DEFAULT_TX_WORK;
- /* adjust max frame to be at least the size of a standard frame */
- adapter->max_frame_size = netdev->mtu + ETH_HLEN + ETH_FCS_LEN +
- VLAN_HLEN;
- adapter->min_frame_size = ETH_ZLEN + ETH_FCS_LEN;
- spin_lock_init(&adapter->nfc_lock);
- spin_lock_init(&adapter->stats64_lock);
- /* Assume MSI-X interrupts, will be checked during IRQ allocation */
- adapter->flags |= IGC_FLAG_HAS_MSIX;
- adapter->mac_table = kzalloc(size, GFP_ATOMIC);
- if (!adapter->mac_table)
- return -ENOMEM;
- igc_init_queue_configuration(adapter);
- /* This call may decrease the number of queues */
- if (igc_init_interrupt_scheme(adapter, true)) {
- dev_err(&pdev->dev, "Unable to allocate memory for queues\n");
- return -ENOMEM;
- }
- /* Explicitly disable IRQ since the NIC can be in any state. */
- igc_irq_disable(adapter);
- set_bit(__IGC_DOWN, &adapter->state);
- return 0;
- }
- /**
- * igc_get_hw_dev - return device
- * @hw: pointer to hardware structure
- *
- * used by hardware layer to print debugging information
- */
- struct net_device *igc_get_hw_dev(struct igc_hw *hw)
- {
- struct igc_adapter *adapter = hw->back;
- return adapter->netdev;
- }
- /**
- * igc_init_module - Driver Registration Routine
- *
- * igc_init_module is the first routine called when the driver is
- * loaded. All it does is register with the PCI subsystem.
- */
- static int __init igc_init_module(void)
- {
- int ret;
- pr_info("%s - version %s\n",
- igc_driver_string, igc_driver_version);
- pr_info("%s\n", igc_copyright);
- ret = pci_register_driver(&igc_driver);
- return ret;
- }
- module_init(igc_init_module);
- /**
- * igc_exit_module - Driver Exit Cleanup Routine
- *
- * igc_exit_module is called just before the driver is removed
- * from memory.
- */
- static void __exit igc_exit_module(void)
- {
- pci_unregister_driver(&igc_driver);
- }
- module_exit(igc_exit_module);
- /* igc_main.c */
|