123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556 |
- // 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 pci_device_id igc_pci_tbl[] = {
- { PCI_VDEVICE(INTEL, IGC_DEV_ID_I225_LM) },
- { PCI_VDEVICE(INTEL, IGC_DEV_ID_I225_V) },
- /* 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);
- enum latency_range {
- lowest_latency = 0,
- low_latency = 1,
- bulk_latency = 2,
- latency_invalid = 255
- };
- static void igc_reset(struct igc_adapter *adapter)
- {
- 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_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_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 netdev_tx_t igc_xmit_frame(struct sk_buff *skb,
- struct net_device *netdev)
- {
- dev_kfree_skb_any(skb);
- return NETDEV_TX_OK;
- }
- 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_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);
- }
- }
- /**
- * 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)
- {
- }
- /**
- * igc_down - Close the interface
- * @adapter: board private structure
- */
- static void igc_down(struct igc_adapter *adapter)
- {
- struct net_device *netdev = adapter->netdev;
- int i = 0;
- set_bit(__IGC_DOWN, &adapter->state);
- /* 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);
- for (i = 0; i < adapter->num_q_vectors; i++)
- napi_disable(&adapter->q_vector[i]->napi);
- adapter->link_speed = 0;
- adapter->link_duplex = 0;
- }
- /**
- * 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_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;
- int cleaned = 0;
- if (q_vector->rx.ring) {
- 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;
- 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;
- /* 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;
- /* 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);
- /* 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);
- flush_scheduled_work();
- /* 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);
- pci_release_selected_regions(pdev,
- pci_select_bars(pdev, IORESOURCE_MEM));
- free_netdev(netdev);
- 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,
- };
- /**
- * 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;
- /* PCI config space info */
- hw->vendor_id = pdev->vendor;
- hw->device_id = pdev->device;
- hw->subsystem_vendor_id = pdev->subsystem_vendor;
- hw->subsystem_device_id = pdev->subsystem_device;
- pci_read_config_byte(pdev, PCI_REVISION_ID, &hw->revision_id);
- pci_read_config_word(pdev, PCI_COMMAND, &hw->bus.pci_cmd_word);
- /* 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;
- 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_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 */
|