1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950295129522953295429552956295729582959296029612962296329642965296629672968296929702971297229732974297529762977297829792980298129822983298429852986298729882989299029912992299329942995299629972998299930003001300230033004300530063007300830093010301130123013301430153016301730183019302030213022302330243025302630273028302930303031303230333034303530363037303830393040304130423043304430453046304730483049305030513052305330543055305630573058305930603061306230633064306530663067306830693070307130723073307430753076307730783079308030813082308330843085308630873088308930903091309230933094309530963097309830993100310131023103310431053106310731083109311031113112311331143115311631173118311931203121312231233124312531263127312831293130313131323133313431353136313731383139314031413142314331443145314631473148314931503151315231533154315531563157315831593160316131623163316431653166316731683169317031713172317331743175317631773178317931803181318231833184318531863187318831893190319131923193319431953196319731983199320032013202320332043205320632073208320932103211321232133214321532163217321832193220322132223223322432253226322732283229323032313232323332343235323632373238323932403241324232433244324532463247324832493250325132523253325432553256325732583259326032613262326332643265326632673268326932703271327232733274327532763277327832793280328132823283328432853286328732883289329032913292329332943295329632973298329933003301330233033304330533063307330833093310 |
- /*
- * This file is part of the Chelsio T4 PCI-E SR-IOV Virtual Function Ethernet
- * driver for Linux.
- *
- * Copyright (c) 2009-2010 Chelsio Communications, Inc. All rights reserved.
- *
- * This software is available to you under a choice of one of two
- * licenses. You may choose to be licensed under the terms of the GNU
- * General Public License (GPL) Version 2, available from the file
- * COPYING in the main directory of this source tree, or the
- * OpenIB.org BSD license below:
- *
- * Redistribution and use in source and binary forms, with or
- * without modification, are permitted provided that the following
- * conditions are met:
- *
- * - Redistributions of source code must retain the above
- * copyright notice, this list of conditions and the following
- * disclaimer.
- *
- * - Redistributions in binary form must reproduce the above
- * copyright notice, this list of conditions and the following
- * disclaimer in the documentation and/or other materials
- * provided with the distribution.
- *
- * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
- * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
- * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
- * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
- * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
- * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
- * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
- * SOFTWARE.
- */
- #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
- #include <linux/module.h>
- #include <linux/moduleparam.h>
- #include <linux/init.h>
- #include <linux/pci.h>
- #include <linux/dma-mapping.h>
- #include <linux/netdevice.h>
- #include <linux/etherdevice.h>
- #include <linux/debugfs.h>
- #include <linux/ethtool.h>
- #include <linux/mdio.h>
- #include "t4vf_common.h"
- #include "t4vf_defs.h"
- #include "../cxgb4/t4_regs.h"
- #include "../cxgb4/t4_msg.h"
- /*
- * Generic information about the driver.
- */
- #define DRV_VERSION "2.0.0-ko"
- #define DRV_DESC "Chelsio T4/T5/T6 Virtual Function (VF) Network Driver"
- /*
- * Module Parameters.
- * ==================
- */
- /*
- * Default ethtool "message level" for adapters.
- */
- #define DFLT_MSG_ENABLE (NETIF_MSG_DRV | NETIF_MSG_PROBE | NETIF_MSG_LINK | \
- NETIF_MSG_TIMER | NETIF_MSG_IFDOWN | NETIF_MSG_IFUP |\
- NETIF_MSG_RX_ERR | NETIF_MSG_TX_ERR)
- /*
- * The driver uses the best interrupt scheme available on a platform in the
- * order MSI-X then MSI. This parameter determines which of these schemes the
- * driver may consider as follows:
- *
- * msi = 2: choose from among MSI-X and MSI
- * msi = 1: only consider MSI interrupts
- *
- * Note that unlike the Physical Function driver, this Virtual Function driver
- * does _not_ support legacy INTx interrupts (this limitation is mandated by
- * the PCI-E SR-IOV standard).
- */
- #define MSI_MSIX 2
- #define MSI_MSI 1
- #define MSI_DEFAULT MSI_MSIX
- static int msi = MSI_DEFAULT;
- module_param(msi, int, 0644);
- MODULE_PARM_DESC(msi, "whether to use MSI-X or MSI");
- /*
- * Fundamental constants.
- * ======================
- */
- enum {
- MAX_TXQ_ENTRIES = 16384,
- MAX_RSPQ_ENTRIES = 16384,
- MAX_RX_BUFFERS = 16384,
- MIN_TXQ_ENTRIES = 32,
- MIN_RSPQ_ENTRIES = 128,
- MIN_FL_ENTRIES = 16,
- /*
- * For purposes of manipulating the Free List size we need to
- * recognize that Free Lists are actually Egress Queues (the host
- * produces free buffers which the hardware consumes), Egress Queues
- * indices are all in units of Egress Context Units bytes, and free
- * list entries are 64-bit PCI DMA addresses. And since the state of
- * the Producer Index == the Consumer Index implies an EMPTY list, we
- * always have at least one Egress Unit's worth of Free List entries
- * unused. See sge.c for more details ...
- */
- EQ_UNIT = SGE_EQ_IDXSIZE,
- FL_PER_EQ_UNIT = EQ_UNIT / sizeof(__be64),
- MIN_FL_RESID = FL_PER_EQ_UNIT,
- };
- /*
- * Global driver state.
- * ====================
- */
- static struct dentry *cxgb4vf_debugfs_root;
- /*
- * OS "Callback" functions.
- * ========================
- */
- /*
- * The link status has changed on the indicated "port" (Virtual Interface).
- */
- void t4vf_os_link_changed(struct adapter *adapter, int pidx, int link_ok)
- {
- struct net_device *dev = adapter->port[pidx];
- /*
- * If the port is disabled or the current recorded "link up"
- * status matches the new status, just return.
- */
- if (!netif_running(dev) || link_ok == netif_carrier_ok(dev))
- return;
- /*
- * Tell the OS that the link status has changed and print a short
- * informative message on the console about the event.
- */
- if (link_ok) {
- const char *s;
- const char *fc;
- const struct port_info *pi = netdev_priv(dev);
- netif_carrier_on(dev);
- switch (pi->link_cfg.speed) {
- case 40000:
- s = "40Gbps";
- break;
- case 10000:
- s = "10Gbps";
- break;
- case 1000:
- s = "1000Mbps";
- break;
- case 100:
- s = "100Mbps";
- break;
- default:
- s = "unknown";
- break;
- }
- switch (pi->link_cfg.fc) {
- case PAUSE_RX:
- fc = "RX";
- break;
- case PAUSE_TX:
- fc = "TX";
- break;
- case PAUSE_RX|PAUSE_TX:
- fc = "RX/TX";
- break;
- default:
- fc = "no";
- break;
- }
- netdev_info(dev, "link up, %s, full-duplex, %s PAUSE\n", s, fc);
- } else {
- netif_carrier_off(dev);
- netdev_info(dev, "link down\n");
- }
- }
- /*
- * THe port module type has changed on the indicated "port" (Virtual
- * Interface).
- */
- void t4vf_os_portmod_changed(struct adapter *adapter, int pidx)
- {
- static const char * const mod_str[] = {
- NULL, "LR", "SR", "ER", "passive DA", "active DA", "LRM"
- };
- const struct net_device *dev = adapter->port[pidx];
- const struct port_info *pi = netdev_priv(dev);
- if (pi->mod_type == FW_PORT_MOD_TYPE_NONE)
- dev_info(adapter->pdev_dev, "%s: port module unplugged\n",
- dev->name);
- else if (pi->mod_type < ARRAY_SIZE(mod_str))
- dev_info(adapter->pdev_dev, "%s: %s port module inserted\n",
- dev->name, mod_str[pi->mod_type]);
- else if (pi->mod_type == FW_PORT_MOD_TYPE_NOTSUPPORTED)
- dev_info(adapter->pdev_dev, "%s: unsupported optical port "
- "module inserted\n", dev->name);
- else if (pi->mod_type == FW_PORT_MOD_TYPE_UNKNOWN)
- dev_info(adapter->pdev_dev, "%s: unknown port module inserted,"
- "forcing TWINAX\n", dev->name);
- else if (pi->mod_type == FW_PORT_MOD_TYPE_ERROR)
- dev_info(adapter->pdev_dev, "%s: transceiver module error\n",
- dev->name);
- else
- dev_info(adapter->pdev_dev, "%s: unknown module type %d "
- "inserted\n", dev->name, pi->mod_type);
- }
- /*
- * Net device operations.
- * ======================
- */
- /*
- * Perform the MAC and PHY actions needed to enable a "port" (Virtual
- * Interface).
- */
- static int link_start(struct net_device *dev)
- {
- int ret;
- struct port_info *pi = netdev_priv(dev);
- /*
- * We do not set address filters and promiscuity here, the stack does
- * that step explicitly. Enable vlan accel.
- */
- ret = t4vf_set_rxmode(pi->adapter, pi->viid, dev->mtu, -1, -1, -1, 1,
- true);
- if (ret == 0) {
- ret = t4vf_change_mac(pi->adapter, pi->viid,
- pi->xact_addr_filt, dev->dev_addr, true);
- if (ret >= 0) {
- pi->xact_addr_filt = ret;
- ret = 0;
- }
- }
- /*
- * We don't need to actually "start the link" itself since the
- * firmware will do that for us when the first Virtual Interface
- * is enabled on a port.
- */
- if (ret == 0)
- ret = t4vf_enable_vi(pi->adapter, pi->viid, true, true);
- return ret;
- }
- /*
- * Name the MSI-X interrupts.
- */
- static void name_msix_vecs(struct adapter *adapter)
- {
- int namelen = sizeof(adapter->msix_info[0].desc) - 1;
- int pidx;
- /*
- * Firmware events.
- */
- snprintf(adapter->msix_info[MSIX_FW].desc, namelen,
- "%s-FWeventq", adapter->name);
- adapter->msix_info[MSIX_FW].desc[namelen] = 0;
- /*
- * Ethernet queues.
- */
- for_each_port(adapter, pidx) {
- struct net_device *dev = adapter->port[pidx];
- const struct port_info *pi = netdev_priv(dev);
- int qs, msi;
- for (qs = 0, msi = MSIX_IQFLINT; qs < pi->nqsets; qs++, msi++) {
- snprintf(adapter->msix_info[msi].desc, namelen,
- "%s-%d", dev->name, qs);
- adapter->msix_info[msi].desc[namelen] = 0;
- }
- }
- }
- /*
- * Request all of our MSI-X resources.
- */
- static int request_msix_queue_irqs(struct adapter *adapter)
- {
- struct sge *s = &adapter->sge;
- int rxq, msi, err;
- /*
- * Firmware events.
- */
- err = request_irq(adapter->msix_info[MSIX_FW].vec, t4vf_sge_intr_msix,
- 0, adapter->msix_info[MSIX_FW].desc, &s->fw_evtq);
- if (err)
- return err;
- /*
- * Ethernet queues.
- */
- msi = MSIX_IQFLINT;
- for_each_ethrxq(s, rxq) {
- err = request_irq(adapter->msix_info[msi].vec,
- t4vf_sge_intr_msix, 0,
- adapter->msix_info[msi].desc,
- &s->ethrxq[rxq].rspq);
- if (err)
- goto err_free_irqs;
- msi++;
- }
- return 0;
- err_free_irqs:
- while (--rxq >= 0)
- free_irq(adapter->msix_info[--msi].vec, &s->ethrxq[rxq].rspq);
- free_irq(adapter->msix_info[MSIX_FW].vec, &s->fw_evtq);
- return err;
- }
- /*
- * Free our MSI-X resources.
- */
- static void free_msix_queue_irqs(struct adapter *adapter)
- {
- struct sge *s = &adapter->sge;
- int rxq, msi;
- free_irq(adapter->msix_info[MSIX_FW].vec, &s->fw_evtq);
- msi = MSIX_IQFLINT;
- for_each_ethrxq(s, rxq)
- free_irq(adapter->msix_info[msi++].vec,
- &s->ethrxq[rxq].rspq);
- }
- /*
- * Turn on NAPI and start up interrupts on a response queue.
- */
- static void qenable(struct sge_rspq *rspq)
- {
- napi_enable(&rspq->napi);
- /*
- * 0-increment the Going To Sleep register to start the timer and
- * enable interrupts.
- */
- t4_write_reg(rspq->adapter, T4VF_SGE_BASE_ADDR + SGE_VF_GTS,
- CIDXINC_V(0) |
- SEINTARM_V(rspq->intr_params) |
- INGRESSQID_V(rspq->cntxt_id));
- }
- /*
- * Enable NAPI scheduling and interrupt generation for all Receive Queues.
- */
- static void enable_rx(struct adapter *adapter)
- {
- int rxq;
- struct sge *s = &adapter->sge;
- for_each_ethrxq(s, rxq)
- qenable(&s->ethrxq[rxq].rspq);
- qenable(&s->fw_evtq);
- /*
- * The interrupt queue doesn't use NAPI so we do the 0-increment of
- * its Going To Sleep register here to get it started.
- */
- if (adapter->flags & USING_MSI)
- t4_write_reg(adapter, T4VF_SGE_BASE_ADDR + SGE_VF_GTS,
- CIDXINC_V(0) |
- SEINTARM_V(s->intrq.intr_params) |
- INGRESSQID_V(s->intrq.cntxt_id));
- }
- /*
- * Wait until all NAPI handlers are descheduled.
- */
- static void quiesce_rx(struct adapter *adapter)
- {
- struct sge *s = &adapter->sge;
- int rxq;
- for_each_ethrxq(s, rxq)
- napi_disable(&s->ethrxq[rxq].rspq.napi);
- napi_disable(&s->fw_evtq.napi);
- }
- /*
- * Response queue handler for the firmware event queue.
- */
- static int fwevtq_handler(struct sge_rspq *rspq, const __be64 *rsp,
- const struct pkt_gl *gl)
- {
- /*
- * Extract response opcode and get pointer to CPL message body.
- */
- struct adapter *adapter = rspq->adapter;
- u8 opcode = ((const struct rss_header *)rsp)->opcode;
- void *cpl = (void *)(rsp + 1);
- switch (opcode) {
- case CPL_FW6_MSG: {
- /*
- * We've received an asynchronous message from the firmware.
- */
- const struct cpl_fw6_msg *fw_msg = cpl;
- if (fw_msg->type == FW6_TYPE_CMD_RPL)
- t4vf_handle_fw_rpl(adapter, fw_msg->data);
- break;
- }
- case CPL_FW4_MSG: {
- /* FW can send EGR_UPDATEs encapsulated in a CPL_FW4_MSG.
- */
- const struct cpl_sge_egr_update *p = (void *)(rsp + 3);
- opcode = CPL_OPCODE_G(ntohl(p->opcode_qid));
- if (opcode != CPL_SGE_EGR_UPDATE) {
- dev_err(adapter->pdev_dev, "unexpected FW4/CPL %#x on FW event queue\n"
- , opcode);
- break;
- }
- cpl = (void *)p;
- /*FALLTHROUGH*/
- }
- case CPL_SGE_EGR_UPDATE: {
- /*
- * We've received an Egress Queue Status Update message. We
- * get these, if the SGE is configured to send these when the
- * firmware passes certain points in processing our TX
- * Ethernet Queue or if we make an explicit request for one.
- * We use these updates to determine when we may need to
- * restart a TX Ethernet Queue which was stopped for lack of
- * free TX Queue Descriptors ...
- */
- const struct cpl_sge_egr_update *p = cpl;
- unsigned int qid = EGR_QID_G(be32_to_cpu(p->opcode_qid));
- struct sge *s = &adapter->sge;
- struct sge_txq *tq;
- struct sge_eth_txq *txq;
- unsigned int eq_idx;
- /*
- * Perform sanity checking on the Queue ID to make sure it
- * really refers to one of our TX Ethernet Egress Queues which
- * is active and matches the queue's ID. None of these error
- * conditions should ever happen so we may want to either make
- * them fatal and/or conditionalized under DEBUG.
- */
- eq_idx = EQ_IDX(s, qid);
- if (unlikely(eq_idx >= MAX_EGRQ)) {
- dev_err(adapter->pdev_dev,
- "Egress Update QID %d out of range\n", qid);
- break;
- }
- tq = s->egr_map[eq_idx];
- if (unlikely(tq == NULL)) {
- dev_err(adapter->pdev_dev,
- "Egress Update QID %d TXQ=NULL\n", qid);
- break;
- }
- txq = container_of(tq, struct sge_eth_txq, q);
- if (unlikely(tq->abs_id != qid)) {
- dev_err(adapter->pdev_dev,
- "Egress Update QID %d refers to TXQ %d\n",
- qid, tq->abs_id);
- break;
- }
- /*
- * Restart a stopped TX Queue which has less than half of its
- * TX ring in use ...
- */
- txq->q.restarts++;
- netif_tx_wake_queue(txq->txq);
- break;
- }
- default:
- dev_err(adapter->pdev_dev,
- "unexpected CPL %#x on FW event queue\n", opcode);
- }
- return 0;
- }
- /*
- * Allocate SGE TX/RX response queues. Determine how many sets of SGE queues
- * to use and initializes them. We support multiple "Queue Sets" per port if
- * we have MSI-X, otherwise just one queue set per port.
- */
- static int setup_sge_queues(struct adapter *adapter)
- {
- struct sge *s = &adapter->sge;
- int err, pidx, msix;
- /*
- * Clear "Queue Set" Free List Starving and TX Queue Mapping Error
- * state.
- */
- bitmap_zero(s->starving_fl, MAX_EGRQ);
- /*
- * If we're using MSI interrupt mode we need to set up a "forwarded
- * interrupt" queue which we'll set up with our MSI vector. The rest
- * of the ingress queues will be set up to forward their interrupts to
- * this queue ... This must be first since t4vf_sge_alloc_rxq() uses
- * the intrq's queue ID as the interrupt forwarding queue for the
- * subsequent calls ...
- */
- if (adapter->flags & USING_MSI) {
- err = t4vf_sge_alloc_rxq(adapter, &s->intrq, false,
- adapter->port[0], 0, NULL, NULL);
- if (err)
- goto err_free_queues;
- }
- /*
- * Allocate our ingress queue for asynchronous firmware messages.
- */
- err = t4vf_sge_alloc_rxq(adapter, &s->fw_evtq, true, adapter->port[0],
- MSIX_FW, NULL, fwevtq_handler);
- if (err)
- goto err_free_queues;
- /*
- * Allocate each "port"'s initial Queue Sets. These can be changed
- * later on ... up to the point where any interface on the adapter is
- * brought up at which point lots of things get nailed down
- * permanently ...
- */
- msix = MSIX_IQFLINT;
- for_each_port(adapter, pidx) {
- struct net_device *dev = adapter->port[pidx];
- struct port_info *pi = netdev_priv(dev);
- struct sge_eth_rxq *rxq = &s->ethrxq[pi->first_qset];
- struct sge_eth_txq *txq = &s->ethtxq[pi->first_qset];
- int qs;
- for (qs = 0; qs < pi->nqsets; qs++, rxq++, txq++) {
- err = t4vf_sge_alloc_rxq(adapter, &rxq->rspq, false,
- dev, msix++,
- &rxq->fl, t4vf_ethrx_handler);
- if (err)
- goto err_free_queues;
- err = t4vf_sge_alloc_eth_txq(adapter, txq, dev,
- netdev_get_tx_queue(dev, qs),
- s->fw_evtq.cntxt_id);
- if (err)
- goto err_free_queues;
- rxq->rspq.idx = qs;
- memset(&rxq->stats, 0, sizeof(rxq->stats));
- }
- }
- /*
- * Create the reverse mappings for the queues.
- */
- s->egr_base = s->ethtxq[0].q.abs_id - s->ethtxq[0].q.cntxt_id;
- s->ingr_base = s->ethrxq[0].rspq.abs_id - s->ethrxq[0].rspq.cntxt_id;
- IQ_MAP(s, s->fw_evtq.abs_id) = &s->fw_evtq;
- for_each_port(adapter, pidx) {
- struct net_device *dev = adapter->port[pidx];
- struct port_info *pi = netdev_priv(dev);
- struct sge_eth_rxq *rxq = &s->ethrxq[pi->first_qset];
- struct sge_eth_txq *txq = &s->ethtxq[pi->first_qset];
- int qs;
- for (qs = 0; qs < pi->nqsets; qs++, rxq++, txq++) {
- IQ_MAP(s, rxq->rspq.abs_id) = &rxq->rspq;
- EQ_MAP(s, txq->q.abs_id) = &txq->q;
- /*
- * The FW_IQ_CMD doesn't return the Absolute Queue IDs
- * for Free Lists but since all of the Egress Queues
- * (including Free Lists) have Relative Queue IDs
- * which are computed as Absolute - Base Queue ID, we
- * can synthesize the Absolute Queue IDs for the Free
- * Lists. This is useful for debugging purposes when
- * we want to dump Queue Contexts via the PF Driver.
- */
- rxq->fl.abs_id = rxq->fl.cntxt_id + s->egr_base;
- EQ_MAP(s, rxq->fl.abs_id) = &rxq->fl;
- }
- }
- return 0;
- err_free_queues:
- t4vf_free_sge_resources(adapter);
- return err;
- }
- /*
- * Set up Receive Side Scaling (RSS) to distribute packets to multiple receive
- * queues. We configure the RSS CPU lookup table to distribute to the number
- * of HW receive queues, and the response queue lookup table to narrow that
- * down to the response queues actually configured for each "port" (Virtual
- * Interface). We always configure the RSS mapping for all ports since the
- * mapping table has plenty of entries.
- */
- static int setup_rss(struct adapter *adapter)
- {
- int pidx;
- for_each_port(adapter, pidx) {
- struct port_info *pi = adap2pinfo(adapter, pidx);
- struct sge_eth_rxq *rxq = &adapter->sge.ethrxq[pi->first_qset];
- u16 rss[MAX_PORT_QSETS];
- int qs, err;
- for (qs = 0; qs < pi->nqsets; qs++)
- rss[qs] = rxq[qs].rspq.abs_id;
- err = t4vf_config_rss_range(adapter, pi->viid,
- 0, pi->rss_size, rss, pi->nqsets);
- if (err)
- return err;
- /*
- * Perform Global RSS Mode-specific initialization.
- */
- switch (adapter->params.rss.mode) {
- case FW_RSS_GLB_CONFIG_CMD_MODE_BASICVIRTUAL:
- /*
- * If Tunnel All Lookup isn't specified in the global
- * RSS Configuration, then we need to specify a
- * default Ingress Queue for any ingress packets which
- * aren't hashed. We'll use our first ingress queue
- * ...
- */
- if (!adapter->params.rss.u.basicvirtual.tnlalllookup) {
- union rss_vi_config config;
- err = t4vf_read_rss_vi_config(adapter,
- pi->viid,
- &config);
- if (err)
- return err;
- config.basicvirtual.defaultq =
- rxq[0].rspq.abs_id;
- err = t4vf_write_rss_vi_config(adapter,
- pi->viid,
- &config);
- if (err)
- return err;
- }
- break;
- }
- }
- return 0;
- }
- /*
- * Bring the adapter up. Called whenever we go from no "ports" open to having
- * one open. This function performs the actions necessary to make an adapter
- * operational, such as completing the initialization of HW modules, and
- * enabling interrupts. Must be called with the rtnl lock held. (Note that
- * this is called "cxgb_up" in the PF Driver.)
- */
- static int adapter_up(struct adapter *adapter)
- {
- int err;
- /*
- * If this is the first time we've been called, perform basic
- * adapter setup. Once we've done this, many of our adapter
- * parameters can no longer be changed ...
- */
- if ((adapter->flags & FULL_INIT_DONE) == 0) {
- err = setup_sge_queues(adapter);
- if (err)
- return err;
- err = setup_rss(adapter);
- if (err) {
- t4vf_free_sge_resources(adapter);
- return err;
- }
- if (adapter->flags & USING_MSIX)
- name_msix_vecs(adapter);
- adapter->flags |= FULL_INIT_DONE;
- }
- /*
- * Acquire our interrupt resources. We only support MSI-X and MSI.
- */
- BUG_ON((adapter->flags & (USING_MSIX|USING_MSI)) == 0);
- if (adapter->flags & USING_MSIX)
- err = request_msix_queue_irqs(adapter);
- else
- err = request_irq(adapter->pdev->irq,
- t4vf_intr_handler(adapter), 0,
- adapter->name, adapter);
- if (err) {
- dev_err(adapter->pdev_dev, "request_irq failed, err %d\n",
- err);
- return err;
- }
- /*
- * Enable NAPI ingress processing and return success.
- */
- enable_rx(adapter);
- t4vf_sge_start(adapter);
- /* Initialize hash mac addr list*/
- INIT_LIST_HEAD(&adapter->mac_hlist);
- return 0;
- }
- /*
- * Bring the adapter down. Called whenever the last "port" (Virtual
- * Interface) closed. (Note that this routine is called "cxgb_down" in the PF
- * Driver.)
- */
- static void adapter_down(struct adapter *adapter)
- {
- /*
- * Free interrupt resources.
- */
- if (adapter->flags & USING_MSIX)
- free_msix_queue_irqs(adapter);
- else
- free_irq(adapter->pdev->irq, adapter);
- /*
- * Wait for NAPI handlers to finish.
- */
- quiesce_rx(adapter);
- }
- /*
- * Start up a net device.
- */
- static int cxgb4vf_open(struct net_device *dev)
- {
- int err;
- struct port_info *pi = netdev_priv(dev);
- struct adapter *adapter = pi->adapter;
- /*
- * If this is the first interface that we're opening on the "adapter",
- * bring the "adapter" up now.
- */
- if (adapter->open_device_map == 0) {
- err = adapter_up(adapter);
- if (err)
- return err;
- }
- /*
- * Note that this interface is up and start everything up ...
- */
- err = link_start(dev);
- if (err)
- goto err_unwind;
- netif_tx_start_all_queues(dev);
- set_bit(pi->port_id, &adapter->open_device_map);
- return 0;
- err_unwind:
- if (adapter->open_device_map == 0)
- adapter_down(adapter);
- return err;
- }
- /*
- * Shut down a net device. This routine is called "cxgb_close" in the PF
- * Driver ...
- */
- static int cxgb4vf_stop(struct net_device *dev)
- {
- struct port_info *pi = netdev_priv(dev);
- struct adapter *adapter = pi->adapter;
- netif_tx_stop_all_queues(dev);
- netif_carrier_off(dev);
- t4vf_enable_vi(adapter, pi->viid, false, false);
- pi->link_cfg.link_ok = 0;
- clear_bit(pi->port_id, &adapter->open_device_map);
- if (adapter->open_device_map == 0)
- adapter_down(adapter);
- return 0;
- }
- /*
- * Translate our basic statistics into the standard "ifconfig" statistics.
- */
- static struct net_device_stats *cxgb4vf_get_stats(struct net_device *dev)
- {
- struct t4vf_port_stats stats;
- struct port_info *pi = netdev2pinfo(dev);
- struct adapter *adapter = pi->adapter;
- struct net_device_stats *ns = &dev->stats;
- int err;
- spin_lock(&adapter->stats_lock);
- err = t4vf_get_port_stats(adapter, pi->pidx, &stats);
- spin_unlock(&adapter->stats_lock);
- memset(ns, 0, sizeof(*ns));
- if (err)
- return ns;
- ns->tx_bytes = (stats.tx_bcast_bytes + stats.tx_mcast_bytes +
- stats.tx_ucast_bytes + stats.tx_offload_bytes);
- ns->tx_packets = (stats.tx_bcast_frames + stats.tx_mcast_frames +
- stats.tx_ucast_frames + stats.tx_offload_frames);
- ns->rx_bytes = (stats.rx_bcast_bytes + stats.rx_mcast_bytes +
- stats.rx_ucast_bytes);
- ns->rx_packets = (stats.rx_bcast_frames + stats.rx_mcast_frames +
- stats.rx_ucast_frames);
- ns->multicast = stats.rx_mcast_frames;
- ns->tx_errors = stats.tx_drop_frames;
- ns->rx_errors = stats.rx_err_frames;
- return ns;
- }
- static inline int cxgb4vf_set_addr_hash(struct port_info *pi)
- {
- struct adapter *adapter = pi->adapter;
- u64 vec = 0;
- bool ucast = false;
- struct hash_mac_addr *entry;
- /* Calculate the hash vector for the updated list and program it */
- list_for_each_entry(entry, &adapter->mac_hlist, list) {
- ucast |= is_unicast_ether_addr(entry->addr);
- vec |= (1ULL << hash_mac_addr(entry->addr));
- }
- return t4vf_set_addr_hash(adapter, pi->viid, ucast, vec, false);
- }
- static int cxgb4vf_mac_sync(struct net_device *netdev, const u8 *mac_addr)
- {
- struct port_info *pi = netdev_priv(netdev);
- struct adapter *adapter = pi->adapter;
- int ret;
- u64 mhash = 0;
- u64 uhash = 0;
- bool free = false;
- bool ucast = is_unicast_ether_addr(mac_addr);
- const u8 *maclist[1] = {mac_addr};
- struct hash_mac_addr *new_entry;
- ret = t4vf_alloc_mac_filt(adapter, pi->viid, free, 1, maclist,
- NULL, ucast ? &uhash : &mhash, false);
- if (ret < 0)
- goto out;
- /* if hash != 0, then add the addr to hash addr list
- * so on the end we will calculate the hash for the
- * list and program it
- */
- if (uhash || mhash) {
- new_entry = kzalloc(sizeof(*new_entry), GFP_ATOMIC);
- if (!new_entry)
- return -ENOMEM;
- ether_addr_copy(new_entry->addr, mac_addr);
- list_add_tail(&new_entry->list, &adapter->mac_hlist);
- ret = cxgb4vf_set_addr_hash(pi);
- }
- out:
- return ret < 0 ? ret : 0;
- }
- static int cxgb4vf_mac_unsync(struct net_device *netdev, const u8 *mac_addr)
- {
- struct port_info *pi = netdev_priv(netdev);
- struct adapter *adapter = pi->adapter;
- int ret;
- const u8 *maclist[1] = {mac_addr};
- struct hash_mac_addr *entry, *tmp;
- /* If the MAC address to be removed is in the hash addr
- * list, delete it from the list and update hash vector
- */
- list_for_each_entry_safe(entry, tmp, &adapter->mac_hlist, list) {
- if (ether_addr_equal(entry->addr, mac_addr)) {
- list_del(&entry->list);
- kfree(entry);
- return cxgb4vf_set_addr_hash(pi);
- }
- }
- ret = t4vf_free_mac_filt(adapter, pi->viid, 1, maclist, false);
- return ret < 0 ? -EINVAL : 0;
- }
- /*
- * Set RX properties of a port, such as promiscruity, address filters, and MTU.
- * If @mtu is -1 it is left unchanged.
- */
- static int set_rxmode(struct net_device *dev, int mtu, bool sleep_ok)
- {
- struct port_info *pi = netdev_priv(dev);
- __dev_uc_sync(dev, cxgb4vf_mac_sync, cxgb4vf_mac_unsync);
- __dev_mc_sync(dev, cxgb4vf_mac_sync, cxgb4vf_mac_unsync);
- return t4vf_set_rxmode(pi->adapter, pi->viid, -1,
- (dev->flags & IFF_PROMISC) != 0,
- (dev->flags & IFF_ALLMULTI) != 0,
- 1, -1, sleep_ok);
- }
- /*
- * Set the current receive modes on the device.
- */
- static void cxgb4vf_set_rxmode(struct net_device *dev)
- {
- /* unfortunately we can't return errors to the stack */
- set_rxmode(dev, -1, false);
- }
- /*
- * Find the entry in the interrupt holdoff timer value array which comes
- * closest to the specified interrupt holdoff value.
- */
- static int closest_timer(const struct sge *s, int us)
- {
- int i, timer_idx = 0, min_delta = INT_MAX;
- for (i = 0; i < ARRAY_SIZE(s->timer_val); i++) {
- int delta = us - s->timer_val[i];
- if (delta < 0)
- delta = -delta;
- if (delta < min_delta) {
- min_delta = delta;
- timer_idx = i;
- }
- }
- return timer_idx;
- }
- static int closest_thres(const struct sge *s, int thres)
- {
- int i, delta, pktcnt_idx = 0, min_delta = INT_MAX;
- for (i = 0; i < ARRAY_SIZE(s->counter_val); i++) {
- delta = thres - s->counter_val[i];
- if (delta < 0)
- delta = -delta;
- if (delta < min_delta) {
- min_delta = delta;
- pktcnt_idx = i;
- }
- }
- return pktcnt_idx;
- }
- /*
- * Return a queue's interrupt hold-off time in us. 0 means no timer.
- */
- static unsigned int qtimer_val(const struct adapter *adapter,
- const struct sge_rspq *rspq)
- {
- unsigned int timer_idx = QINTR_TIMER_IDX_G(rspq->intr_params);
- return timer_idx < SGE_NTIMERS
- ? adapter->sge.timer_val[timer_idx]
- : 0;
- }
- /**
- * set_rxq_intr_params - set a queue's interrupt holdoff parameters
- * @adapter: the adapter
- * @rspq: the RX response queue
- * @us: the hold-off time in us, or 0 to disable timer
- * @cnt: the hold-off packet count, or 0 to disable counter
- *
- * Sets an RX response queue's interrupt hold-off time and packet count.
- * At least one of the two needs to be enabled for the queue to generate
- * interrupts.
- */
- static int set_rxq_intr_params(struct adapter *adapter, struct sge_rspq *rspq,
- unsigned int us, unsigned int cnt)
- {
- unsigned int timer_idx;
- /*
- * If both the interrupt holdoff timer and count are specified as
- * zero, default to a holdoff count of 1 ...
- */
- if ((us | cnt) == 0)
- cnt = 1;
- /*
- * If an interrupt holdoff count has been specified, then find the
- * closest configured holdoff count and use that. If the response
- * queue has already been created, then update its queue context
- * parameters ...
- */
- if (cnt) {
- int err;
- u32 v, pktcnt_idx;
- pktcnt_idx = closest_thres(&adapter->sge, cnt);
- if (rspq->desc && rspq->pktcnt_idx != pktcnt_idx) {
- v = FW_PARAMS_MNEM_V(FW_PARAMS_MNEM_DMAQ) |
- FW_PARAMS_PARAM_X_V(
- FW_PARAMS_PARAM_DMAQ_IQ_INTCNTTHRESH) |
- FW_PARAMS_PARAM_YZ_V(rspq->cntxt_id);
- err = t4vf_set_params(adapter, 1, &v, &pktcnt_idx);
- if (err)
- return err;
- }
- rspq->pktcnt_idx = pktcnt_idx;
- }
- /*
- * Compute the closest holdoff timer index from the supplied holdoff
- * timer value.
- */
- timer_idx = (us == 0
- ? SGE_TIMER_RSTRT_CNTR
- : closest_timer(&adapter->sge, us));
- /*
- * Update the response queue's interrupt coalescing parameters and
- * return success.
- */
- rspq->intr_params = (QINTR_TIMER_IDX_V(timer_idx) |
- QINTR_CNT_EN_V(cnt > 0));
- return 0;
- }
- /*
- * Return a version number to identify the type of adapter. The scheme is:
- * - bits 0..9: chip version
- * - bits 10..15: chip revision
- */
- static inline unsigned int mk_adap_vers(const struct adapter *adapter)
- {
- /*
- * Chip version 4, revision 0x3f (cxgb4vf).
- */
- return CHELSIO_CHIP_VERSION(adapter->params.chip) | (0x3f << 10);
- }
- /*
- * Execute the specified ioctl command.
- */
- static int cxgb4vf_do_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
- {
- int ret = 0;
- switch (cmd) {
- /*
- * The VF Driver doesn't have access to any of the other
- * common Ethernet device ioctl()'s (like reading/writing
- * PHY registers, etc.
- */
- default:
- ret = -EOPNOTSUPP;
- break;
- }
- return ret;
- }
- /*
- * Change the device's MTU.
- */
- static int cxgb4vf_change_mtu(struct net_device *dev, int new_mtu)
- {
- int ret;
- struct port_info *pi = netdev_priv(dev);
- ret = t4vf_set_rxmode(pi->adapter, pi->viid, new_mtu,
- -1, -1, -1, -1, true);
- if (!ret)
- dev->mtu = new_mtu;
- return ret;
- }
- static netdev_features_t cxgb4vf_fix_features(struct net_device *dev,
- netdev_features_t features)
- {
- /*
- * Since there is no support for separate rx/tx vlan accel
- * enable/disable make sure tx flag is always in same state as rx.
- */
- if (features & NETIF_F_HW_VLAN_CTAG_RX)
- features |= NETIF_F_HW_VLAN_CTAG_TX;
- else
- features &= ~NETIF_F_HW_VLAN_CTAG_TX;
- return features;
- }
- static int cxgb4vf_set_features(struct net_device *dev,
- netdev_features_t features)
- {
- struct port_info *pi = netdev_priv(dev);
- netdev_features_t changed = dev->features ^ features;
- if (changed & NETIF_F_HW_VLAN_CTAG_RX)
- t4vf_set_rxmode(pi->adapter, pi->viid, -1, -1, -1, -1,
- features & NETIF_F_HW_VLAN_CTAG_TX, 0);
- return 0;
- }
- /*
- * Change the devices MAC address.
- */
- static int cxgb4vf_set_mac_addr(struct net_device *dev, void *_addr)
- {
- int ret;
- struct sockaddr *addr = _addr;
- struct port_info *pi = netdev_priv(dev);
- if (!is_valid_ether_addr(addr->sa_data))
- return -EADDRNOTAVAIL;
- ret = t4vf_change_mac(pi->adapter, pi->viid, pi->xact_addr_filt,
- addr->sa_data, true);
- if (ret < 0)
- return ret;
- memcpy(dev->dev_addr, addr->sa_data, dev->addr_len);
- pi->xact_addr_filt = ret;
- return 0;
- }
- #ifdef CONFIG_NET_POLL_CONTROLLER
- /*
- * Poll all of our receive queues. This is called outside of normal interrupt
- * context.
- */
- static void cxgb4vf_poll_controller(struct net_device *dev)
- {
- struct port_info *pi = netdev_priv(dev);
- struct adapter *adapter = pi->adapter;
- if (adapter->flags & USING_MSIX) {
- struct sge_eth_rxq *rxq;
- int nqsets;
- rxq = &adapter->sge.ethrxq[pi->first_qset];
- for (nqsets = pi->nqsets; nqsets; nqsets--) {
- t4vf_sge_intr_msix(0, &rxq->rspq);
- rxq++;
- }
- } else
- t4vf_intr_handler(adapter)(0, adapter);
- }
- #endif
- /*
- * Ethtool operations.
- * ===================
- *
- * Note that we don't support any ethtool operations which change the physical
- * state of the port to which we're linked.
- */
- /**
- * from_fw_port_mod_type - translate Firmware Port/Module type to Ethtool
- * @port_type: Firmware Port Type
- * @mod_type: Firmware Module Type
- *
- * Translate Firmware Port/Module type to Ethtool Port Type.
- */
- static int from_fw_port_mod_type(enum fw_port_type port_type,
- enum fw_port_module_type mod_type)
- {
- if (port_type == FW_PORT_TYPE_BT_SGMII ||
- port_type == FW_PORT_TYPE_BT_XFI ||
- port_type == FW_PORT_TYPE_BT_XAUI) {
- return PORT_TP;
- } else if (port_type == FW_PORT_TYPE_FIBER_XFI ||
- port_type == FW_PORT_TYPE_FIBER_XAUI) {
- return PORT_FIBRE;
- } else if (port_type == FW_PORT_TYPE_SFP ||
- port_type == FW_PORT_TYPE_QSFP_10G ||
- port_type == FW_PORT_TYPE_QSA ||
- port_type == FW_PORT_TYPE_QSFP) {
- if (mod_type == FW_PORT_MOD_TYPE_LR ||
- mod_type == FW_PORT_MOD_TYPE_SR ||
- mod_type == FW_PORT_MOD_TYPE_ER ||
- mod_type == FW_PORT_MOD_TYPE_LRM)
- return PORT_FIBRE;
- else if (mod_type == FW_PORT_MOD_TYPE_TWINAX_PASSIVE ||
- mod_type == FW_PORT_MOD_TYPE_TWINAX_ACTIVE)
- return PORT_DA;
- else
- return PORT_OTHER;
- }
- return PORT_OTHER;
- }
- /**
- * fw_caps_to_lmm - translate Firmware to ethtool Link Mode Mask
- * @port_type: Firmware Port Type
- * @fw_caps: Firmware Port Capabilities
- * @link_mode_mask: ethtool Link Mode Mask
- *
- * Translate a Firmware Port Capabilities specification to an ethtool
- * Link Mode Mask.
- */
- static void fw_caps_to_lmm(enum fw_port_type port_type,
- unsigned int fw_caps,
- unsigned long *link_mode_mask)
- {
- #define SET_LMM(__lmm_name) __set_bit(ETHTOOL_LINK_MODE_ ## __lmm_name\
- ## _BIT, link_mode_mask)
- #define FW_CAPS_TO_LMM(__fw_name, __lmm_name) \
- do { \
- if (fw_caps & FW_PORT_CAP_ ## __fw_name) \
- SET_LMM(__lmm_name); \
- } while (0)
- switch (port_type) {
- case FW_PORT_TYPE_BT_SGMII:
- case FW_PORT_TYPE_BT_XFI:
- case FW_PORT_TYPE_BT_XAUI:
- SET_LMM(TP);
- FW_CAPS_TO_LMM(SPEED_100M, 100baseT_Full);
- FW_CAPS_TO_LMM(SPEED_1G, 1000baseT_Full);
- FW_CAPS_TO_LMM(SPEED_10G, 10000baseT_Full);
- break;
- case FW_PORT_TYPE_KX4:
- case FW_PORT_TYPE_KX:
- SET_LMM(Backplane);
- FW_CAPS_TO_LMM(SPEED_1G, 1000baseKX_Full);
- FW_CAPS_TO_LMM(SPEED_10G, 10000baseKX4_Full);
- break;
- case FW_PORT_TYPE_KR:
- SET_LMM(Backplane);
- SET_LMM(10000baseKR_Full);
- break;
- case FW_PORT_TYPE_BP_AP:
- SET_LMM(Backplane);
- SET_LMM(10000baseR_FEC);
- SET_LMM(10000baseKR_Full);
- SET_LMM(1000baseKX_Full);
- break;
- case FW_PORT_TYPE_BP4_AP:
- SET_LMM(Backplane);
- SET_LMM(10000baseR_FEC);
- SET_LMM(10000baseKR_Full);
- SET_LMM(1000baseKX_Full);
- SET_LMM(10000baseKX4_Full);
- break;
- case FW_PORT_TYPE_FIBER_XFI:
- case FW_PORT_TYPE_FIBER_XAUI:
- case FW_PORT_TYPE_SFP:
- case FW_PORT_TYPE_QSFP_10G:
- case FW_PORT_TYPE_QSA:
- SET_LMM(FIBRE);
- FW_CAPS_TO_LMM(SPEED_1G, 1000baseT_Full);
- FW_CAPS_TO_LMM(SPEED_10G, 10000baseT_Full);
- break;
- case FW_PORT_TYPE_BP40_BA:
- case FW_PORT_TYPE_QSFP:
- SET_LMM(FIBRE);
- SET_LMM(40000baseSR4_Full);
- break;
- case FW_PORT_TYPE_CR_QSFP:
- case FW_PORT_TYPE_SFP28:
- SET_LMM(FIBRE);
- SET_LMM(25000baseCR_Full);
- break;
- case FW_PORT_TYPE_KR4_100G:
- case FW_PORT_TYPE_CR4_QSFP:
- SET_LMM(FIBRE);
- SET_LMM(100000baseCR4_Full);
- break;
- default:
- break;
- }
- FW_CAPS_TO_LMM(ANEG, Autoneg);
- FW_CAPS_TO_LMM(802_3_PAUSE, Pause);
- FW_CAPS_TO_LMM(802_3_ASM_DIR, Asym_Pause);
- #undef FW_CAPS_TO_LMM
- #undef SET_LMM
- }
- static int cxgb4vf_get_link_ksettings(struct net_device *dev,
- struct ethtool_link_ksettings
- *link_ksettings)
- {
- const struct port_info *pi = netdev_priv(dev);
- struct ethtool_link_settings *base = &link_ksettings->base;
- ethtool_link_ksettings_zero_link_mode(link_ksettings, supported);
- ethtool_link_ksettings_zero_link_mode(link_ksettings, advertising);
- ethtool_link_ksettings_zero_link_mode(link_ksettings, lp_advertising);
- base->port = from_fw_port_mod_type(pi->port_type, pi->mod_type);
- if (pi->mdio_addr >= 0) {
- base->phy_address = pi->mdio_addr;
- base->mdio_support = (pi->port_type == FW_PORT_TYPE_BT_SGMII
- ? ETH_MDIO_SUPPORTS_C22
- : ETH_MDIO_SUPPORTS_C45);
- } else {
- base->phy_address = 255;
- base->mdio_support = 0;
- }
- fw_caps_to_lmm(pi->port_type, pi->link_cfg.supported,
- link_ksettings->link_modes.supported);
- fw_caps_to_lmm(pi->port_type, pi->link_cfg.advertising,
- link_ksettings->link_modes.advertising);
- fw_caps_to_lmm(pi->port_type, pi->link_cfg.lp_advertising,
- link_ksettings->link_modes.lp_advertising);
- if (netif_carrier_ok(dev)) {
- base->speed = pi->link_cfg.speed;
- base->duplex = DUPLEX_FULL;
- } else {
- base->speed = SPEED_UNKNOWN;
- base->duplex = DUPLEX_UNKNOWN;
- }
- base->autoneg = pi->link_cfg.autoneg;
- if (pi->link_cfg.supported & FW_PORT_CAP_ANEG)
- ethtool_link_ksettings_add_link_mode(link_ksettings,
- supported, Autoneg);
- if (pi->link_cfg.autoneg)
- ethtool_link_ksettings_add_link_mode(link_ksettings,
- advertising, Autoneg);
- return 0;
- }
- /*
- * Return our driver information.
- */
- static void cxgb4vf_get_drvinfo(struct net_device *dev,
- struct ethtool_drvinfo *drvinfo)
- {
- struct adapter *adapter = netdev2adap(dev);
- strlcpy(drvinfo->driver, KBUILD_MODNAME, sizeof(drvinfo->driver));
- strlcpy(drvinfo->version, DRV_VERSION, sizeof(drvinfo->version));
- strlcpy(drvinfo->bus_info, pci_name(to_pci_dev(dev->dev.parent)),
- sizeof(drvinfo->bus_info));
- snprintf(drvinfo->fw_version, sizeof(drvinfo->fw_version),
- "%u.%u.%u.%u, TP %u.%u.%u.%u",
- FW_HDR_FW_VER_MAJOR_G(adapter->params.dev.fwrev),
- FW_HDR_FW_VER_MINOR_G(adapter->params.dev.fwrev),
- FW_HDR_FW_VER_MICRO_G(adapter->params.dev.fwrev),
- FW_HDR_FW_VER_BUILD_G(adapter->params.dev.fwrev),
- FW_HDR_FW_VER_MAJOR_G(adapter->params.dev.tprev),
- FW_HDR_FW_VER_MINOR_G(adapter->params.dev.tprev),
- FW_HDR_FW_VER_MICRO_G(adapter->params.dev.tprev),
- FW_HDR_FW_VER_BUILD_G(adapter->params.dev.tprev));
- }
- /*
- * Return current adapter message level.
- */
- static u32 cxgb4vf_get_msglevel(struct net_device *dev)
- {
- return netdev2adap(dev)->msg_enable;
- }
- /*
- * Set current adapter message level.
- */
- static void cxgb4vf_set_msglevel(struct net_device *dev, u32 msglevel)
- {
- netdev2adap(dev)->msg_enable = msglevel;
- }
- /*
- * Return the device's current Queue Set ring size parameters along with the
- * allowed maximum values. Since ethtool doesn't understand the concept of
- * multi-queue devices, we just return the current values associated with the
- * first Queue Set.
- */
- static void cxgb4vf_get_ringparam(struct net_device *dev,
- struct ethtool_ringparam *rp)
- {
- const struct port_info *pi = netdev_priv(dev);
- const struct sge *s = &pi->adapter->sge;
- rp->rx_max_pending = MAX_RX_BUFFERS;
- rp->rx_mini_max_pending = MAX_RSPQ_ENTRIES;
- rp->rx_jumbo_max_pending = 0;
- rp->tx_max_pending = MAX_TXQ_ENTRIES;
- rp->rx_pending = s->ethrxq[pi->first_qset].fl.size - MIN_FL_RESID;
- rp->rx_mini_pending = s->ethrxq[pi->first_qset].rspq.size;
- rp->rx_jumbo_pending = 0;
- rp->tx_pending = s->ethtxq[pi->first_qset].q.size;
- }
- /*
- * Set the Queue Set ring size parameters for the device. Again, since
- * ethtool doesn't allow for the concept of multiple queues per device, we'll
- * apply these new values across all of the Queue Sets associated with the
- * device -- after vetting them of course!
- */
- static int cxgb4vf_set_ringparam(struct net_device *dev,
- struct ethtool_ringparam *rp)
- {
- const struct port_info *pi = netdev_priv(dev);
- struct adapter *adapter = pi->adapter;
- struct sge *s = &adapter->sge;
- int qs;
- if (rp->rx_pending > MAX_RX_BUFFERS ||
- rp->rx_jumbo_pending ||
- rp->tx_pending > MAX_TXQ_ENTRIES ||
- rp->rx_mini_pending > MAX_RSPQ_ENTRIES ||
- rp->rx_mini_pending < MIN_RSPQ_ENTRIES ||
- rp->rx_pending < MIN_FL_ENTRIES ||
- rp->tx_pending < MIN_TXQ_ENTRIES)
- return -EINVAL;
- if (adapter->flags & FULL_INIT_DONE)
- return -EBUSY;
- for (qs = pi->first_qset; qs < pi->first_qset + pi->nqsets; qs++) {
- s->ethrxq[qs].fl.size = rp->rx_pending + MIN_FL_RESID;
- s->ethrxq[qs].rspq.size = rp->rx_mini_pending;
- s->ethtxq[qs].q.size = rp->tx_pending;
- }
- return 0;
- }
- /*
- * Return the interrupt holdoff timer and count for the first Queue Set on the
- * device. Our extension ioctl() (the cxgbtool interface) allows the
- * interrupt holdoff timer to be read on all of the device's Queue Sets.
- */
- static int cxgb4vf_get_coalesce(struct net_device *dev,
- struct ethtool_coalesce *coalesce)
- {
- const struct port_info *pi = netdev_priv(dev);
- const struct adapter *adapter = pi->adapter;
- const struct sge_rspq *rspq = &adapter->sge.ethrxq[pi->first_qset].rspq;
- coalesce->rx_coalesce_usecs = qtimer_val(adapter, rspq);
- coalesce->rx_max_coalesced_frames =
- ((rspq->intr_params & QINTR_CNT_EN_F)
- ? adapter->sge.counter_val[rspq->pktcnt_idx]
- : 0);
- return 0;
- }
- /*
- * Set the RX interrupt holdoff timer and count for the first Queue Set on the
- * interface. Our extension ioctl() (the cxgbtool interface) allows us to set
- * the interrupt holdoff timer on any of the device's Queue Sets.
- */
- static int cxgb4vf_set_coalesce(struct net_device *dev,
- struct ethtool_coalesce *coalesce)
- {
- const struct port_info *pi = netdev_priv(dev);
- struct adapter *adapter = pi->adapter;
- return set_rxq_intr_params(adapter,
- &adapter->sge.ethrxq[pi->first_qset].rspq,
- coalesce->rx_coalesce_usecs,
- coalesce->rx_max_coalesced_frames);
- }
- /*
- * Report current port link pause parameter settings.
- */
- static void cxgb4vf_get_pauseparam(struct net_device *dev,
- struct ethtool_pauseparam *pauseparam)
- {
- struct port_info *pi = netdev_priv(dev);
- pauseparam->autoneg = (pi->link_cfg.requested_fc & PAUSE_AUTONEG) != 0;
- pauseparam->rx_pause = (pi->link_cfg.fc & PAUSE_RX) != 0;
- pauseparam->tx_pause = (pi->link_cfg.fc & PAUSE_TX) != 0;
- }
- /*
- * Identify the port by blinking the port's LED.
- */
- static int cxgb4vf_phys_id(struct net_device *dev,
- enum ethtool_phys_id_state state)
- {
- unsigned int val;
- struct port_info *pi = netdev_priv(dev);
- if (state == ETHTOOL_ID_ACTIVE)
- val = 0xffff;
- else if (state == ETHTOOL_ID_INACTIVE)
- val = 0;
- else
- return -EINVAL;
- return t4vf_identify_port(pi->adapter, pi->viid, val);
- }
- /*
- * Port stats maintained per queue of the port.
- */
- struct queue_port_stats {
- u64 tso;
- u64 tx_csum;
- u64 rx_csum;
- u64 vlan_ex;
- u64 vlan_ins;
- u64 lro_pkts;
- u64 lro_merged;
- };
- /*
- * Strings for the ETH_SS_STATS statistics set ("ethtool -S"). Note that
- * these need to match the order of statistics returned by
- * t4vf_get_port_stats().
- */
- static const char stats_strings[][ETH_GSTRING_LEN] = {
- /*
- * These must match the layout of the t4vf_port_stats structure.
- */
- "TxBroadcastBytes ",
- "TxBroadcastFrames ",
- "TxMulticastBytes ",
- "TxMulticastFrames ",
- "TxUnicastBytes ",
- "TxUnicastFrames ",
- "TxDroppedFrames ",
- "TxOffloadBytes ",
- "TxOffloadFrames ",
- "RxBroadcastBytes ",
- "RxBroadcastFrames ",
- "RxMulticastBytes ",
- "RxMulticastFrames ",
- "RxUnicastBytes ",
- "RxUnicastFrames ",
- "RxErrorFrames ",
- /*
- * These are accumulated per-queue statistics and must match the
- * order of the fields in the queue_port_stats structure.
- */
- "TSO ",
- "TxCsumOffload ",
- "RxCsumGood ",
- "VLANextractions ",
- "VLANinsertions ",
- "GROPackets ",
- "GROMerged ",
- };
- /*
- * Return the number of statistics in the specified statistics set.
- */
- static int cxgb4vf_get_sset_count(struct net_device *dev, int sset)
- {
- switch (sset) {
- case ETH_SS_STATS:
- return ARRAY_SIZE(stats_strings);
- default:
- return -EOPNOTSUPP;
- }
- /*NOTREACHED*/
- }
- /*
- * Return the strings for the specified statistics set.
- */
- static void cxgb4vf_get_strings(struct net_device *dev,
- u32 sset,
- u8 *data)
- {
- switch (sset) {
- case ETH_SS_STATS:
- memcpy(data, stats_strings, sizeof(stats_strings));
- break;
- }
- }
- /*
- * Small utility routine to accumulate queue statistics across the queues of
- * a "port".
- */
- static void collect_sge_port_stats(const struct adapter *adapter,
- const struct port_info *pi,
- struct queue_port_stats *stats)
- {
- const struct sge_eth_txq *txq = &adapter->sge.ethtxq[pi->first_qset];
- const struct sge_eth_rxq *rxq = &adapter->sge.ethrxq[pi->first_qset];
- int qs;
- memset(stats, 0, sizeof(*stats));
- for (qs = 0; qs < pi->nqsets; qs++, rxq++, txq++) {
- stats->tso += txq->tso;
- stats->tx_csum += txq->tx_cso;
- stats->rx_csum += rxq->stats.rx_cso;
- stats->vlan_ex += rxq->stats.vlan_ex;
- stats->vlan_ins += txq->vlan_ins;
- stats->lro_pkts += rxq->stats.lro_pkts;
- stats->lro_merged += rxq->stats.lro_merged;
- }
- }
- /*
- * Return the ETH_SS_STATS statistics set.
- */
- static void cxgb4vf_get_ethtool_stats(struct net_device *dev,
- struct ethtool_stats *stats,
- u64 *data)
- {
- struct port_info *pi = netdev2pinfo(dev);
- struct adapter *adapter = pi->adapter;
- int err = t4vf_get_port_stats(adapter, pi->pidx,
- (struct t4vf_port_stats *)data);
- if (err)
- memset(data, 0, sizeof(struct t4vf_port_stats));
- data += sizeof(struct t4vf_port_stats) / sizeof(u64);
- collect_sge_port_stats(adapter, pi, (struct queue_port_stats *)data);
- }
- /*
- * Return the size of our register map.
- */
- static int cxgb4vf_get_regs_len(struct net_device *dev)
- {
- return T4VF_REGMAP_SIZE;
- }
- /*
- * Dump a block of registers, start to end inclusive, into a buffer.
- */
- static void reg_block_dump(struct adapter *adapter, void *regbuf,
- unsigned int start, unsigned int end)
- {
- u32 *bp = regbuf + start - T4VF_REGMAP_START;
- for ( ; start <= end; start += sizeof(u32)) {
- /*
- * Avoid reading the Mailbox Control register since that
- * can trigger a Mailbox Ownership Arbitration cycle and
- * interfere with communication with the firmware.
- */
- if (start == T4VF_CIM_BASE_ADDR + CIM_VF_EXT_MAILBOX_CTRL)
- *bp++ = 0xffff;
- else
- *bp++ = t4_read_reg(adapter, start);
- }
- }
- /*
- * Copy our entire register map into the provided buffer.
- */
- static void cxgb4vf_get_regs(struct net_device *dev,
- struct ethtool_regs *regs,
- void *regbuf)
- {
- struct adapter *adapter = netdev2adap(dev);
- regs->version = mk_adap_vers(adapter);
- /*
- * Fill in register buffer with our register map.
- */
- memset(regbuf, 0, T4VF_REGMAP_SIZE);
- reg_block_dump(adapter, regbuf,
- T4VF_SGE_BASE_ADDR + T4VF_MOD_MAP_SGE_FIRST,
- T4VF_SGE_BASE_ADDR + T4VF_MOD_MAP_SGE_LAST);
- reg_block_dump(adapter, regbuf,
- T4VF_MPS_BASE_ADDR + T4VF_MOD_MAP_MPS_FIRST,
- T4VF_MPS_BASE_ADDR + T4VF_MOD_MAP_MPS_LAST);
- /* T5 adds new registers in the PL Register map.
- */
- reg_block_dump(adapter, regbuf,
- T4VF_PL_BASE_ADDR + T4VF_MOD_MAP_PL_FIRST,
- T4VF_PL_BASE_ADDR + (is_t4(adapter->params.chip)
- ? PL_VF_WHOAMI_A : PL_VF_REVISION_A));
- reg_block_dump(adapter, regbuf,
- T4VF_CIM_BASE_ADDR + T4VF_MOD_MAP_CIM_FIRST,
- T4VF_CIM_BASE_ADDR + T4VF_MOD_MAP_CIM_LAST);
- reg_block_dump(adapter, regbuf,
- T4VF_MBDATA_BASE_ADDR + T4VF_MBDATA_FIRST,
- T4VF_MBDATA_BASE_ADDR + T4VF_MBDATA_LAST);
- }
- /*
- * Report current Wake On LAN settings.
- */
- static void cxgb4vf_get_wol(struct net_device *dev,
- struct ethtool_wolinfo *wol)
- {
- wol->supported = 0;
- wol->wolopts = 0;
- memset(&wol->sopass, 0, sizeof(wol->sopass));
- }
- /*
- * TCP Segmentation Offload flags which we support.
- */
- #define TSO_FLAGS (NETIF_F_TSO | NETIF_F_TSO6 | NETIF_F_TSO_ECN)
- static const struct ethtool_ops cxgb4vf_ethtool_ops = {
- .get_link_ksettings = cxgb4vf_get_link_ksettings,
- .get_drvinfo = cxgb4vf_get_drvinfo,
- .get_msglevel = cxgb4vf_get_msglevel,
- .set_msglevel = cxgb4vf_set_msglevel,
- .get_ringparam = cxgb4vf_get_ringparam,
- .set_ringparam = cxgb4vf_set_ringparam,
- .get_coalesce = cxgb4vf_get_coalesce,
- .set_coalesce = cxgb4vf_set_coalesce,
- .get_pauseparam = cxgb4vf_get_pauseparam,
- .get_link = ethtool_op_get_link,
- .get_strings = cxgb4vf_get_strings,
- .set_phys_id = cxgb4vf_phys_id,
- .get_sset_count = cxgb4vf_get_sset_count,
- .get_ethtool_stats = cxgb4vf_get_ethtool_stats,
- .get_regs_len = cxgb4vf_get_regs_len,
- .get_regs = cxgb4vf_get_regs,
- .get_wol = cxgb4vf_get_wol,
- };
- /*
- * /sys/kernel/debug/cxgb4vf support code and data.
- * ================================================
- */
- /*
- * Show Firmware Mailbox Command/Reply Log
- *
- * Note that we don't do any locking when dumping the Firmware Mailbox Log so
- * it's possible that we can catch things during a log update and therefore
- * see partially corrupted log entries. But i9t's probably Good Enough(tm).
- * If we ever decide that we want to make sure that we're dumping a coherent
- * log, we'd need to perform locking in the mailbox logging and in
- * mboxlog_open() where we'd need to grab the entire mailbox log in one go
- * like we do for the Firmware Device Log. But as stated above, meh ...
- */
- static int mboxlog_show(struct seq_file *seq, void *v)
- {
- struct adapter *adapter = seq->private;
- struct mbox_cmd_log *log = adapter->mbox_log;
- struct mbox_cmd *entry;
- int entry_idx, i;
- if (v == SEQ_START_TOKEN) {
- seq_printf(seq,
- "%10s %15s %5s %5s %s\n",
- "Seq#", "Tstamp", "Atime", "Etime",
- "Command/Reply");
- return 0;
- }
- entry_idx = log->cursor + ((uintptr_t)v - 2);
- if (entry_idx >= log->size)
- entry_idx -= log->size;
- entry = mbox_cmd_log_entry(log, entry_idx);
- /* skip over unused entries */
- if (entry->timestamp == 0)
- return 0;
- seq_printf(seq, "%10u %15llu %5d %5d",
- entry->seqno, entry->timestamp,
- entry->access, entry->execute);
- for (i = 0; i < MBOX_LEN / 8; i++) {
- u64 flit = entry->cmd[i];
- u32 hi = (u32)(flit >> 32);
- u32 lo = (u32)flit;
- seq_printf(seq, " %08x %08x", hi, lo);
- }
- seq_puts(seq, "\n");
- return 0;
- }
- static inline void *mboxlog_get_idx(struct seq_file *seq, loff_t pos)
- {
- struct adapter *adapter = seq->private;
- struct mbox_cmd_log *log = adapter->mbox_log;
- return ((pos <= log->size) ? (void *)(uintptr_t)(pos + 1) : NULL);
- }
- static void *mboxlog_start(struct seq_file *seq, loff_t *pos)
- {
- return *pos ? mboxlog_get_idx(seq, *pos) : SEQ_START_TOKEN;
- }
- static void *mboxlog_next(struct seq_file *seq, void *v, loff_t *pos)
- {
- ++*pos;
- return mboxlog_get_idx(seq, *pos);
- }
- static void mboxlog_stop(struct seq_file *seq, void *v)
- {
- }
- static const struct seq_operations mboxlog_seq_ops = {
- .start = mboxlog_start,
- .next = mboxlog_next,
- .stop = mboxlog_stop,
- .show = mboxlog_show
- };
- static int mboxlog_open(struct inode *inode, struct file *file)
- {
- int res = seq_open(file, &mboxlog_seq_ops);
- if (!res) {
- struct seq_file *seq = file->private_data;
- seq->private = inode->i_private;
- }
- return res;
- }
- static const struct file_operations mboxlog_fops = {
- .owner = THIS_MODULE,
- .open = mboxlog_open,
- .read = seq_read,
- .llseek = seq_lseek,
- .release = seq_release,
- };
- /*
- * Show SGE Queue Set information. We display QPL Queues Sets per line.
- */
- #define QPL 4
- static int sge_qinfo_show(struct seq_file *seq, void *v)
- {
- struct adapter *adapter = seq->private;
- int eth_entries = DIV_ROUND_UP(adapter->sge.ethqsets, QPL);
- int qs, r = (uintptr_t)v - 1;
- if (r)
- seq_putc(seq, '\n');
- #define S3(fmt_spec, s, v) \
- do {\
- seq_printf(seq, "%-12s", s); \
- for (qs = 0; qs < n; ++qs) \
- seq_printf(seq, " %16" fmt_spec, v); \
- seq_putc(seq, '\n'); \
- } while (0)
- #define S(s, v) S3("s", s, v)
- #define T(s, v) S3("u", s, txq[qs].v)
- #define R(s, v) S3("u", s, rxq[qs].v)
- if (r < eth_entries) {
- const struct sge_eth_rxq *rxq = &adapter->sge.ethrxq[r * QPL];
- const struct sge_eth_txq *txq = &adapter->sge.ethtxq[r * QPL];
- int n = min(QPL, adapter->sge.ethqsets - QPL * r);
- S("QType:", "Ethernet");
- S("Interface:",
- (rxq[qs].rspq.netdev
- ? rxq[qs].rspq.netdev->name
- : "N/A"));
- S3("d", "Port:",
- (rxq[qs].rspq.netdev
- ? ((struct port_info *)
- netdev_priv(rxq[qs].rspq.netdev))->port_id
- : -1));
- T("TxQ ID:", q.abs_id);
- T("TxQ size:", q.size);
- T("TxQ inuse:", q.in_use);
- T("TxQ PIdx:", q.pidx);
- T("TxQ CIdx:", q.cidx);
- R("RspQ ID:", rspq.abs_id);
- R("RspQ size:", rspq.size);
- R("RspQE size:", rspq.iqe_len);
- S3("u", "Intr delay:", qtimer_val(adapter, &rxq[qs].rspq));
- S3("u", "Intr pktcnt:",
- adapter->sge.counter_val[rxq[qs].rspq.pktcnt_idx]);
- R("RspQ CIdx:", rspq.cidx);
- R("RspQ Gen:", rspq.gen);
- R("FL ID:", fl.abs_id);
- R("FL size:", fl.size - MIN_FL_RESID);
- R("FL avail:", fl.avail);
- R("FL PIdx:", fl.pidx);
- R("FL CIdx:", fl.cidx);
- return 0;
- }
- r -= eth_entries;
- if (r == 0) {
- const struct sge_rspq *evtq = &adapter->sge.fw_evtq;
- seq_printf(seq, "%-12s %16s\n", "QType:", "FW event queue");
- seq_printf(seq, "%-12s %16u\n", "RspQ ID:", evtq->abs_id);
- seq_printf(seq, "%-12s %16u\n", "Intr delay:",
- qtimer_val(adapter, evtq));
- seq_printf(seq, "%-12s %16u\n", "Intr pktcnt:",
- adapter->sge.counter_val[evtq->pktcnt_idx]);
- seq_printf(seq, "%-12s %16u\n", "RspQ Cidx:", evtq->cidx);
- seq_printf(seq, "%-12s %16u\n", "RspQ Gen:", evtq->gen);
- } else if (r == 1) {
- const struct sge_rspq *intrq = &adapter->sge.intrq;
- seq_printf(seq, "%-12s %16s\n", "QType:", "Interrupt Queue");
- seq_printf(seq, "%-12s %16u\n", "RspQ ID:", intrq->abs_id);
- seq_printf(seq, "%-12s %16u\n", "Intr delay:",
- qtimer_val(adapter, intrq));
- seq_printf(seq, "%-12s %16u\n", "Intr pktcnt:",
- adapter->sge.counter_val[intrq->pktcnt_idx]);
- seq_printf(seq, "%-12s %16u\n", "RspQ Cidx:", intrq->cidx);
- seq_printf(seq, "%-12s %16u\n", "RspQ Gen:", intrq->gen);
- }
- #undef R
- #undef T
- #undef S
- #undef S3
- return 0;
- }
- /*
- * Return the number of "entries" in our "file". We group the multi-Queue
- * sections with QPL Queue Sets per "entry". The sections of the output are:
- *
- * Ethernet RX/TX Queue Sets
- * Firmware Event Queue
- * Forwarded Interrupt Queue (if in MSI mode)
- */
- static int sge_queue_entries(const struct adapter *adapter)
- {
- return DIV_ROUND_UP(adapter->sge.ethqsets, QPL) + 1 +
- ((adapter->flags & USING_MSI) != 0);
- }
- static void *sge_queue_start(struct seq_file *seq, loff_t *pos)
- {
- int entries = sge_queue_entries(seq->private);
- return *pos < entries ? (void *)((uintptr_t)*pos + 1) : NULL;
- }
- static void sge_queue_stop(struct seq_file *seq, void *v)
- {
- }
- static void *sge_queue_next(struct seq_file *seq, void *v, loff_t *pos)
- {
- int entries = sge_queue_entries(seq->private);
- ++*pos;
- return *pos < entries ? (void *)((uintptr_t)*pos + 1) : NULL;
- }
- static const struct seq_operations sge_qinfo_seq_ops = {
- .start = sge_queue_start,
- .next = sge_queue_next,
- .stop = sge_queue_stop,
- .show = sge_qinfo_show
- };
- static int sge_qinfo_open(struct inode *inode, struct file *file)
- {
- int res = seq_open(file, &sge_qinfo_seq_ops);
- if (!res) {
- struct seq_file *seq = file->private_data;
- seq->private = inode->i_private;
- }
- return res;
- }
- static const struct file_operations sge_qinfo_debugfs_fops = {
- .owner = THIS_MODULE,
- .open = sge_qinfo_open,
- .read = seq_read,
- .llseek = seq_lseek,
- .release = seq_release,
- };
- /*
- * Show SGE Queue Set statistics. We display QPL Queues Sets per line.
- */
- #define QPL 4
- static int sge_qstats_show(struct seq_file *seq, void *v)
- {
- struct adapter *adapter = seq->private;
- int eth_entries = DIV_ROUND_UP(adapter->sge.ethqsets, QPL);
- int qs, r = (uintptr_t)v - 1;
- if (r)
- seq_putc(seq, '\n');
- #define S3(fmt, s, v) \
- do { \
- seq_printf(seq, "%-16s", s); \
- for (qs = 0; qs < n; ++qs) \
- seq_printf(seq, " %8" fmt, v); \
- seq_putc(seq, '\n'); \
- } while (0)
- #define S(s, v) S3("s", s, v)
- #define T3(fmt, s, v) S3(fmt, s, txq[qs].v)
- #define T(s, v) T3("lu", s, v)
- #define R3(fmt, s, v) S3(fmt, s, rxq[qs].v)
- #define R(s, v) R3("lu", s, v)
- if (r < eth_entries) {
- const struct sge_eth_rxq *rxq = &adapter->sge.ethrxq[r * QPL];
- const struct sge_eth_txq *txq = &adapter->sge.ethtxq[r * QPL];
- int n = min(QPL, adapter->sge.ethqsets - QPL * r);
- S("QType:", "Ethernet");
- S("Interface:",
- (rxq[qs].rspq.netdev
- ? rxq[qs].rspq.netdev->name
- : "N/A"));
- R3("u", "RspQNullInts:", rspq.unhandled_irqs);
- R("RxPackets:", stats.pkts);
- R("RxCSO:", stats.rx_cso);
- R("VLANxtract:", stats.vlan_ex);
- R("LROmerged:", stats.lro_merged);
- R("LROpackets:", stats.lro_pkts);
- R("RxDrops:", stats.rx_drops);
- T("TSO:", tso);
- T("TxCSO:", tx_cso);
- T("VLANins:", vlan_ins);
- T("TxQFull:", q.stops);
- T("TxQRestarts:", q.restarts);
- T("TxMapErr:", mapping_err);
- R("FLAllocErr:", fl.alloc_failed);
- R("FLLrgAlcErr:", fl.large_alloc_failed);
- R("FLStarving:", fl.starving);
- return 0;
- }
- r -= eth_entries;
- if (r == 0) {
- const struct sge_rspq *evtq = &adapter->sge.fw_evtq;
- seq_printf(seq, "%-8s %16s\n", "QType:", "FW event queue");
- seq_printf(seq, "%-16s %8u\n", "RspQNullInts:",
- evtq->unhandled_irqs);
- seq_printf(seq, "%-16s %8u\n", "RspQ CIdx:", evtq->cidx);
- seq_printf(seq, "%-16s %8u\n", "RspQ Gen:", evtq->gen);
- } else if (r == 1) {
- const struct sge_rspq *intrq = &adapter->sge.intrq;
- seq_printf(seq, "%-8s %16s\n", "QType:", "Interrupt Queue");
- seq_printf(seq, "%-16s %8u\n", "RspQNullInts:",
- intrq->unhandled_irqs);
- seq_printf(seq, "%-16s %8u\n", "RspQ CIdx:", intrq->cidx);
- seq_printf(seq, "%-16s %8u\n", "RspQ Gen:", intrq->gen);
- }
- #undef R
- #undef T
- #undef S
- #undef R3
- #undef T3
- #undef S3
- return 0;
- }
- /*
- * Return the number of "entries" in our "file". We group the multi-Queue
- * sections with QPL Queue Sets per "entry". The sections of the output are:
- *
- * Ethernet RX/TX Queue Sets
- * Firmware Event Queue
- * Forwarded Interrupt Queue (if in MSI mode)
- */
- static int sge_qstats_entries(const struct adapter *adapter)
- {
- return DIV_ROUND_UP(adapter->sge.ethqsets, QPL) + 1 +
- ((adapter->flags & USING_MSI) != 0);
- }
- static void *sge_qstats_start(struct seq_file *seq, loff_t *pos)
- {
- int entries = sge_qstats_entries(seq->private);
- return *pos < entries ? (void *)((uintptr_t)*pos + 1) : NULL;
- }
- static void sge_qstats_stop(struct seq_file *seq, void *v)
- {
- }
- static void *sge_qstats_next(struct seq_file *seq, void *v, loff_t *pos)
- {
- int entries = sge_qstats_entries(seq->private);
- (*pos)++;
- return *pos < entries ? (void *)((uintptr_t)*pos + 1) : NULL;
- }
- static const struct seq_operations sge_qstats_seq_ops = {
- .start = sge_qstats_start,
- .next = sge_qstats_next,
- .stop = sge_qstats_stop,
- .show = sge_qstats_show
- };
- static int sge_qstats_open(struct inode *inode, struct file *file)
- {
- int res = seq_open(file, &sge_qstats_seq_ops);
- if (res == 0) {
- struct seq_file *seq = file->private_data;
- seq->private = inode->i_private;
- }
- return res;
- }
- static const struct file_operations sge_qstats_proc_fops = {
- .owner = THIS_MODULE,
- .open = sge_qstats_open,
- .read = seq_read,
- .llseek = seq_lseek,
- .release = seq_release,
- };
- /*
- * Show PCI-E SR-IOV Virtual Function Resource Limits.
- */
- static int resources_show(struct seq_file *seq, void *v)
- {
- struct adapter *adapter = seq->private;
- struct vf_resources *vfres = &adapter->params.vfres;
- #define S(desc, fmt, var) \
- seq_printf(seq, "%-60s " fmt "\n", \
- desc " (" #var "):", vfres->var)
- S("Virtual Interfaces", "%d", nvi);
- S("Egress Queues", "%d", neq);
- S("Ethernet Control", "%d", nethctrl);
- S("Ingress Queues/w Free Lists/Interrupts", "%d", niqflint);
- S("Ingress Queues", "%d", niq);
- S("Traffic Class", "%d", tc);
- S("Port Access Rights Mask", "%#x", pmask);
- S("MAC Address Filters", "%d", nexactf);
- S("Firmware Command Read Capabilities", "%#x", r_caps);
- S("Firmware Command Write/Execute Capabilities", "%#x", wx_caps);
- #undef S
- return 0;
- }
- static int resources_open(struct inode *inode, struct file *file)
- {
- return single_open(file, resources_show, inode->i_private);
- }
- static const struct file_operations resources_proc_fops = {
- .owner = THIS_MODULE,
- .open = resources_open,
- .read = seq_read,
- .llseek = seq_lseek,
- .release = single_release,
- };
- /*
- * Show Virtual Interfaces.
- */
- static int interfaces_show(struct seq_file *seq, void *v)
- {
- if (v == SEQ_START_TOKEN) {
- seq_puts(seq, "Interface Port VIID\n");
- } else {
- struct adapter *adapter = seq->private;
- int pidx = (uintptr_t)v - 2;
- struct net_device *dev = adapter->port[pidx];
- struct port_info *pi = netdev_priv(dev);
- seq_printf(seq, "%9s %4d %#5x\n",
- dev->name, pi->port_id, pi->viid);
- }
- return 0;
- }
- static inline void *interfaces_get_idx(struct adapter *adapter, loff_t pos)
- {
- return pos <= adapter->params.nports
- ? (void *)(uintptr_t)(pos + 1)
- : NULL;
- }
- static void *interfaces_start(struct seq_file *seq, loff_t *pos)
- {
- return *pos
- ? interfaces_get_idx(seq->private, *pos)
- : SEQ_START_TOKEN;
- }
- static void *interfaces_next(struct seq_file *seq, void *v, loff_t *pos)
- {
- (*pos)++;
- return interfaces_get_idx(seq->private, *pos);
- }
- static void interfaces_stop(struct seq_file *seq, void *v)
- {
- }
- static const struct seq_operations interfaces_seq_ops = {
- .start = interfaces_start,
- .next = interfaces_next,
- .stop = interfaces_stop,
- .show = interfaces_show
- };
- static int interfaces_open(struct inode *inode, struct file *file)
- {
- int res = seq_open(file, &interfaces_seq_ops);
- if (res == 0) {
- struct seq_file *seq = file->private_data;
- seq->private = inode->i_private;
- }
- return res;
- }
- static const struct file_operations interfaces_proc_fops = {
- .owner = THIS_MODULE,
- .open = interfaces_open,
- .read = seq_read,
- .llseek = seq_lseek,
- .release = seq_release,
- };
- /*
- * /sys/kernel/debugfs/cxgb4vf/ files list.
- */
- struct cxgb4vf_debugfs_entry {
- const char *name; /* name of debugfs node */
- umode_t mode; /* file system mode */
- const struct file_operations *fops;
- };
- static struct cxgb4vf_debugfs_entry debugfs_files[] = {
- { "mboxlog", S_IRUGO, &mboxlog_fops },
- { "sge_qinfo", S_IRUGO, &sge_qinfo_debugfs_fops },
- { "sge_qstats", S_IRUGO, &sge_qstats_proc_fops },
- { "resources", S_IRUGO, &resources_proc_fops },
- { "interfaces", S_IRUGO, &interfaces_proc_fops },
- };
- /*
- * Module and device initialization and cleanup code.
- * ==================================================
- */
- /*
- * Set up out /sys/kernel/debug/cxgb4vf sub-nodes. We assume that the
- * directory (debugfs_root) has already been set up.
- */
- static int setup_debugfs(struct adapter *adapter)
- {
- int i;
- BUG_ON(IS_ERR_OR_NULL(adapter->debugfs_root));
- /*
- * Debugfs support is best effort.
- */
- for (i = 0; i < ARRAY_SIZE(debugfs_files); i++)
- (void)debugfs_create_file(debugfs_files[i].name,
- debugfs_files[i].mode,
- adapter->debugfs_root,
- (void *)adapter,
- debugfs_files[i].fops);
- return 0;
- }
- /*
- * Tear down the /sys/kernel/debug/cxgb4vf sub-nodes created above. We leave
- * it to our caller to tear down the directory (debugfs_root).
- */
- static void cleanup_debugfs(struct adapter *adapter)
- {
- BUG_ON(IS_ERR_OR_NULL(adapter->debugfs_root));
- /*
- * Unlike our sister routine cleanup_proc(), we don't need to remove
- * individual entries because a call will be made to
- * debugfs_remove_recursive(). We just need to clean up any ancillary
- * persistent state.
- */
- /* nothing to do */
- }
- /* Figure out how many Ports and Queue Sets we can support. This depends on
- * knowing our Virtual Function Resources and may be called a second time if
- * we fall back from MSI-X to MSI Interrupt Mode.
- */
- static void size_nports_qsets(struct adapter *adapter)
- {
- struct vf_resources *vfres = &adapter->params.vfres;
- unsigned int ethqsets, pmask_nports;
- /* The number of "ports" which we support is equal to the number of
- * Virtual Interfaces with which we've been provisioned.
- */
- adapter->params.nports = vfres->nvi;
- if (adapter->params.nports > MAX_NPORTS) {
- dev_warn(adapter->pdev_dev, "only using %d of %d maximum"
- " allowed virtual interfaces\n", MAX_NPORTS,
- adapter->params.nports);
- adapter->params.nports = MAX_NPORTS;
- }
- /* We may have been provisioned with more VIs than the number of
- * ports we're allowed to access (our Port Access Rights Mask).
- * This is obviously a configuration conflict but we don't want to
- * crash the kernel or anything silly just because of that.
- */
- pmask_nports = hweight32(adapter->params.vfres.pmask);
- if (pmask_nports < adapter->params.nports) {
- dev_warn(adapter->pdev_dev, "only using %d of %d provisioned"
- " virtual interfaces; limited by Port Access Rights"
- " mask %#x\n", pmask_nports, adapter->params.nports,
- adapter->params.vfres.pmask);
- adapter->params.nports = pmask_nports;
- }
- /* We need to reserve an Ingress Queue for the Asynchronous Firmware
- * Event Queue. And if we're using MSI Interrupts, we'll also need to
- * reserve an Ingress Queue for a Forwarded Interrupts.
- *
- * The rest of the FL/Intr-capable ingress queues will be matched up
- * one-for-one with Ethernet/Control egress queues in order to form
- * "Queue Sets" which will be aportioned between the "ports". For
- * each Queue Set, we'll need the ability to allocate two Egress
- * Contexts -- one for the Ingress Queue Free List and one for the TX
- * Ethernet Queue.
- *
- * Note that even if we're currently configured to use MSI-X
- * Interrupts (module variable msi == MSI_MSIX) we may get downgraded
- * to MSI Interrupts if we can't get enough MSI-X Interrupts. If that
- * happens we'll need to adjust things later.
- */
- ethqsets = vfres->niqflint - 1 - (msi == MSI_MSI);
- if (vfres->nethctrl != ethqsets)
- ethqsets = min(vfres->nethctrl, ethqsets);
- if (vfres->neq < ethqsets*2)
- ethqsets = vfres->neq/2;
- if (ethqsets > MAX_ETH_QSETS)
- ethqsets = MAX_ETH_QSETS;
- adapter->sge.max_ethqsets = ethqsets;
- if (adapter->sge.max_ethqsets < adapter->params.nports) {
- dev_warn(adapter->pdev_dev, "only using %d of %d available"
- " virtual interfaces (too few Queue Sets)\n",
- adapter->sge.max_ethqsets, adapter->params.nports);
- adapter->params.nports = adapter->sge.max_ethqsets;
- }
- }
- /*
- * Perform early "adapter" initialization. This is where we discover what
- * adapter parameters we're going to be using and initialize basic adapter
- * hardware support.
- */
- static int adap_init0(struct adapter *adapter)
- {
- struct sge_params *sge_params = &adapter->params.sge;
- struct sge *s = &adapter->sge;
- int err;
- u32 param, val = 0;
- /*
- * Some environments do not properly handle PCIE FLRs -- e.g. in Linux
- * 2.6.31 and later we can't call pci_reset_function() in order to
- * issue an FLR because of a self- deadlock on the device semaphore.
- * Meanwhile, the OS infrastructure doesn't issue FLRs in all the
- * cases where they're needed -- for instance, some versions of KVM
- * fail to reset "Assigned Devices" when the VM reboots. Therefore we
- * use the firmware based reset in order to reset any per function
- * state.
- */
- err = t4vf_fw_reset(adapter);
- if (err < 0) {
- dev_err(adapter->pdev_dev, "FW reset failed: err=%d\n", err);
- return err;
- }
- /*
- * Grab basic operational parameters. These will predominantly have
- * been set up by the Physical Function Driver or will be hard coded
- * into the adapter. We just have to live with them ... Note that
- * we _must_ get our VPD parameters before our SGE parameters because
- * we need to know the adapter's core clock from the VPD in order to
- * properly decode the SGE Timer Values.
- */
- err = t4vf_get_dev_params(adapter);
- if (err) {
- dev_err(adapter->pdev_dev, "unable to retrieve adapter"
- " device parameters: err=%d\n", err);
- return err;
- }
- err = t4vf_get_vpd_params(adapter);
- if (err) {
- dev_err(adapter->pdev_dev, "unable to retrieve adapter"
- " VPD parameters: err=%d\n", err);
- return err;
- }
- err = t4vf_get_sge_params(adapter);
- if (err) {
- dev_err(adapter->pdev_dev, "unable to retrieve adapter"
- " SGE parameters: err=%d\n", err);
- return err;
- }
- err = t4vf_get_rss_glb_config(adapter);
- if (err) {
- dev_err(adapter->pdev_dev, "unable to retrieve adapter"
- " RSS parameters: err=%d\n", err);
- return err;
- }
- if (adapter->params.rss.mode !=
- FW_RSS_GLB_CONFIG_CMD_MODE_BASICVIRTUAL) {
- dev_err(adapter->pdev_dev, "unable to operate with global RSS"
- " mode %d\n", adapter->params.rss.mode);
- return -EINVAL;
- }
- err = t4vf_sge_init(adapter);
- if (err) {
- dev_err(adapter->pdev_dev, "unable to use adapter parameters:"
- " err=%d\n", err);
- return err;
- }
- /* If we're running on newer firmware, let it know that we're
- * prepared to deal with encapsulated CPL messages. Older
- * firmware won't understand this and we'll just get
- * unencapsulated messages ...
- */
- param = FW_PARAMS_MNEM_V(FW_PARAMS_MNEM_PFVF) |
- FW_PARAMS_PARAM_X_V(FW_PARAMS_PARAM_PFVF_CPLFW4MSG_ENCAP);
- val = 1;
- (void) t4vf_set_params(adapter, 1, ¶m, &val);
- /*
- * Retrieve our RX interrupt holdoff timer values and counter
- * threshold values from the SGE parameters.
- */
- s->timer_val[0] = core_ticks_to_us(adapter,
- TIMERVALUE0_G(sge_params->sge_timer_value_0_and_1));
- s->timer_val[1] = core_ticks_to_us(adapter,
- TIMERVALUE1_G(sge_params->sge_timer_value_0_and_1));
- s->timer_val[2] = core_ticks_to_us(adapter,
- TIMERVALUE0_G(sge_params->sge_timer_value_2_and_3));
- s->timer_val[3] = core_ticks_to_us(adapter,
- TIMERVALUE1_G(sge_params->sge_timer_value_2_and_3));
- s->timer_val[4] = core_ticks_to_us(adapter,
- TIMERVALUE0_G(sge_params->sge_timer_value_4_and_5));
- s->timer_val[5] = core_ticks_to_us(adapter,
- TIMERVALUE1_G(sge_params->sge_timer_value_4_and_5));
- s->counter_val[0] = THRESHOLD_0_G(sge_params->sge_ingress_rx_threshold);
- s->counter_val[1] = THRESHOLD_1_G(sge_params->sge_ingress_rx_threshold);
- s->counter_val[2] = THRESHOLD_2_G(sge_params->sge_ingress_rx_threshold);
- s->counter_val[3] = THRESHOLD_3_G(sge_params->sge_ingress_rx_threshold);
- /*
- * Grab our Virtual Interface resource allocation, extract the
- * features that we're interested in and do a bit of sanity testing on
- * what we discover.
- */
- err = t4vf_get_vfres(adapter);
- if (err) {
- dev_err(adapter->pdev_dev, "unable to get virtual interface"
- " resources: err=%d\n", err);
- return err;
- }
- /* Check for various parameter sanity issues */
- if (adapter->params.vfres.pmask == 0) {
- dev_err(adapter->pdev_dev, "no port access configured\n"
- "usable!\n");
- return -EINVAL;
- }
- if (adapter->params.vfres.nvi == 0) {
- dev_err(adapter->pdev_dev, "no virtual interfaces configured/"
- "usable!\n");
- return -EINVAL;
- }
- /* Initialize nports and max_ethqsets now that we have our Virtual
- * Function Resources.
- */
- size_nports_qsets(adapter);
- return 0;
- }
- static inline void init_rspq(struct sge_rspq *rspq, u8 timer_idx,
- u8 pkt_cnt_idx, unsigned int size,
- unsigned int iqe_size)
- {
- rspq->intr_params = (QINTR_TIMER_IDX_V(timer_idx) |
- (pkt_cnt_idx < SGE_NCOUNTERS ?
- QINTR_CNT_EN_F : 0));
- rspq->pktcnt_idx = (pkt_cnt_idx < SGE_NCOUNTERS
- ? pkt_cnt_idx
- : 0);
- rspq->iqe_len = iqe_size;
- rspq->size = size;
- }
- /*
- * Perform default configuration of DMA queues depending on the number and
- * type of ports we found and the number of available CPUs. Most settings can
- * be modified by the admin via ethtool and cxgbtool prior to the adapter
- * being brought up for the first time.
- */
- static void cfg_queues(struct adapter *adapter)
- {
- struct sge *s = &adapter->sge;
- int q10g, n10g, qidx, pidx, qs;
- size_t iqe_size;
- /*
- * We should not be called till we know how many Queue Sets we can
- * support. In particular, this means that we need to know what kind
- * of interrupts we'll be using ...
- */
- BUG_ON((adapter->flags & (USING_MSIX|USING_MSI)) == 0);
- /*
- * Count the number of 10GbE Virtual Interfaces that we have.
- */
- n10g = 0;
- for_each_port(adapter, pidx)
- n10g += is_x_10g_port(&adap2pinfo(adapter, pidx)->link_cfg);
- /*
- * We default to 1 queue per non-10G port and up to # of cores queues
- * per 10G port.
- */
- if (n10g == 0)
- q10g = 0;
- else {
- int n1g = (adapter->params.nports - n10g);
- q10g = (adapter->sge.max_ethqsets - n1g) / n10g;
- if (q10g > num_online_cpus())
- q10g = num_online_cpus();
- }
- /*
- * Allocate the "Queue Sets" to the various Virtual Interfaces.
- * The layout will be established in setup_sge_queues() when the
- * adapter is brough up for the first time.
- */
- qidx = 0;
- for_each_port(adapter, pidx) {
- struct port_info *pi = adap2pinfo(adapter, pidx);
- pi->first_qset = qidx;
- pi->nqsets = is_x_10g_port(&pi->link_cfg) ? q10g : 1;
- qidx += pi->nqsets;
- }
- s->ethqsets = qidx;
- /*
- * The Ingress Queue Entry Size for our various Response Queues needs
- * to be big enough to accommodate the largest message we can receive
- * from the chip/firmware; which is 64 bytes ...
- */
- iqe_size = 64;
- /*
- * Set up default Queue Set parameters ... Start off with the
- * shortest interrupt holdoff timer.
- */
- for (qs = 0; qs < s->max_ethqsets; qs++) {
- struct sge_eth_rxq *rxq = &s->ethrxq[qs];
- struct sge_eth_txq *txq = &s->ethtxq[qs];
- init_rspq(&rxq->rspq, 0, 0, 1024, iqe_size);
- rxq->fl.size = 72;
- txq->q.size = 1024;
- }
- /*
- * The firmware event queue is used for link state changes and
- * notifications of TX DMA completions.
- */
- init_rspq(&s->fw_evtq, SGE_TIMER_RSTRT_CNTR, 0, 512, iqe_size);
- /*
- * The forwarded interrupt queue is used when we're in MSI interrupt
- * mode. In this mode all interrupts associated with RX queues will
- * be forwarded to a single queue which we'll associate with our MSI
- * interrupt vector. The messages dropped in the forwarded interrupt
- * queue will indicate which ingress queue needs servicing ... This
- * queue needs to be large enough to accommodate all of the ingress
- * queues which are forwarding their interrupt (+1 to prevent the PIDX
- * from equalling the CIDX if every ingress queue has an outstanding
- * interrupt). The queue doesn't need to be any larger because no
- * ingress queue will ever have more than one outstanding interrupt at
- * any time ...
- */
- init_rspq(&s->intrq, SGE_TIMER_RSTRT_CNTR, 0, MSIX_ENTRIES + 1,
- iqe_size);
- }
- /*
- * Reduce the number of Ethernet queues across all ports to at most n.
- * n provides at least one queue per port.
- */
- static void reduce_ethqs(struct adapter *adapter, int n)
- {
- int i;
- struct port_info *pi;
- /*
- * While we have too many active Ether Queue Sets, interate across the
- * "ports" and reduce their individual Queue Set allocations.
- */
- BUG_ON(n < adapter->params.nports);
- while (n < adapter->sge.ethqsets)
- for_each_port(adapter, i) {
- pi = adap2pinfo(adapter, i);
- if (pi->nqsets > 1) {
- pi->nqsets--;
- adapter->sge.ethqsets--;
- if (adapter->sge.ethqsets <= n)
- break;
- }
- }
- /*
- * Reassign the starting Queue Sets for each of the "ports" ...
- */
- n = 0;
- for_each_port(adapter, i) {
- pi = adap2pinfo(adapter, i);
- pi->first_qset = n;
- n += pi->nqsets;
- }
- }
- /*
- * We need to grab enough MSI-X vectors to cover our interrupt needs. Ideally
- * we get a separate MSI-X vector for every "Queue Set" plus any extras we
- * need. Minimally we need one for every Virtual Interface plus those needed
- * for our "extras". Note that this process may lower the maximum number of
- * allowed Queue Sets ...
- */
- static int enable_msix(struct adapter *adapter)
- {
- int i, want, need, nqsets;
- struct msix_entry entries[MSIX_ENTRIES];
- struct sge *s = &adapter->sge;
- for (i = 0; i < MSIX_ENTRIES; ++i)
- entries[i].entry = i;
- /*
- * We _want_ enough MSI-X interrupts to cover all of our "Queue Sets"
- * plus those needed for our "extras" (for example, the firmware
- * message queue). We _need_ at least one "Queue Set" per Virtual
- * Interface plus those needed for our "extras". So now we get to see
- * if the song is right ...
- */
- want = s->max_ethqsets + MSIX_EXTRAS;
- need = adapter->params.nports + MSIX_EXTRAS;
- want = pci_enable_msix_range(adapter->pdev, entries, need, want);
- if (want < 0)
- return want;
- nqsets = want - MSIX_EXTRAS;
- if (nqsets < s->max_ethqsets) {
- dev_warn(adapter->pdev_dev, "only enough MSI-X vectors"
- " for %d Queue Sets\n", nqsets);
- s->max_ethqsets = nqsets;
- if (nqsets < s->ethqsets)
- reduce_ethqs(adapter, nqsets);
- }
- for (i = 0; i < want; ++i)
- adapter->msix_info[i].vec = entries[i].vector;
- return 0;
- }
- static const struct net_device_ops cxgb4vf_netdev_ops = {
- .ndo_open = cxgb4vf_open,
- .ndo_stop = cxgb4vf_stop,
- .ndo_start_xmit = t4vf_eth_xmit,
- .ndo_get_stats = cxgb4vf_get_stats,
- .ndo_set_rx_mode = cxgb4vf_set_rxmode,
- .ndo_set_mac_address = cxgb4vf_set_mac_addr,
- .ndo_validate_addr = eth_validate_addr,
- .ndo_do_ioctl = cxgb4vf_do_ioctl,
- .ndo_change_mtu = cxgb4vf_change_mtu,
- .ndo_fix_features = cxgb4vf_fix_features,
- .ndo_set_features = cxgb4vf_set_features,
- #ifdef CONFIG_NET_POLL_CONTROLLER
- .ndo_poll_controller = cxgb4vf_poll_controller,
- #endif
- };
- /*
- * "Probe" a device: initialize a device and construct all kernel and driver
- * state needed to manage the device. This routine is called "init_one" in
- * the PF Driver ...
- */
- static int cxgb4vf_pci_probe(struct pci_dev *pdev,
- const struct pci_device_id *ent)
- {
- int pci_using_dac;
- int err, pidx;
- unsigned int pmask;
- struct adapter *adapter;
- struct port_info *pi;
- struct net_device *netdev;
- unsigned int pf;
- /*
- * Print our driver banner the first time we're called to initialize a
- * device.
- */
- pr_info_once("%s - version %s\n", DRV_DESC, DRV_VERSION);
- /*
- * Initialize generic PCI device state.
- */
- err = pci_enable_device(pdev);
- if (err) {
- dev_err(&pdev->dev, "cannot enable PCI device\n");
- return err;
- }
- /*
- * Reserve PCI resources for the device. If we can't get them some
- * other driver may have already claimed the device ...
- */
- err = pci_request_regions(pdev, KBUILD_MODNAME);
- if (err) {
- dev_err(&pdev->dev, "cannot obtain PCI resources\n");
- goto err_disable_device;
- }
- /*
- * Set up our DMA mask: try for 64-bit address masking first and
- * fall back to 32-bit if we can't get 64 bits ...
- */
- err = pci_set_dma_mask(pdev, DMA_BIT_MASK(64));
- if (err == 0) {
- err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64));
- if (err) {
- dev_err(&pdev->dev, "unable to obtain 64-bit DMA for"
- " coherent allocations\n");
- goto err_release_regions;
- }
- pci_using_dac = 1;
- } else {
- err = pci_set_dma_mask(pdev, DMA_BIT_MASK(32));
- if (err != 0) {
- dev_err(&pdev->dev, "no usable DMA configuration\n");
- goto err_release_regions;
- }
- pci_using_dac = 0;
- }
- /*
- * Enable bus mastering for the device ...
- */
- pci_set_master(pdev);
- /*
- * Allocate our adapter data structure and attach it to the device.
- */
- adapter = kzalloc(sizeof(*adapter), GFP_KERNEL);
- if (!adapter) {
- err = -ENOMEM;
- goto err_release_regions;
- }
- pci_set_drvdata(pdev, adapter);
- adapter->pdev = pdev;
- adapter->pdev_dev = &pdev->dev;
- adapter->mbox_log = kzalloc(sizeof(*adapter->mbox_log) +
- (sizeof(struct mbox_cmd) *
- T4VF_OS_LOG_MBOX_CMDS),
- GFP_KERNEL);
- if (!adapter->mbox_log) {
- err = -ENOMEM;
- goto err_free_adapter;
- }
- adapter->mbox_log->size = T4VF_OS_LOG_MBOX_CMDS;
- /*
- * Initialize SMP data synchronization resources.
- */
- spin_lock_init(&adapter->stats_lock);
- spin_lock_init(&adapter->mbox_lock);
- INIT_LIST_HEAD(&adapter->mlist.list);
- /*
- * Map our I/O registers in BAR0.
- */
- adapter->regs = pci_ioremap_bar(pdev, 0);
- if (!adapter->regs) {
- dev_err(&pdev->dev, "cannot map device registers\n");
- err = -ENOMEM;
- goto err_free_adapter;
- }
- /* Wait for the device to become ready before proceeding ...
- */
- err = t4vf_prep_adapter(adapter);
- if (err) {
- dev_err(adapter->pdev_dev, "device didn't become ready:"
- " err=%d\n", err);
- goto err_unmap_bar0;
- }
- /* For T5 and later we want to use the new BAR-based User Doorbells,
- * so we need to map BAR2 here ...
- */
- if (!is_t4(adapter->params.chip)) {
- adapter->bar2 = ioremap_wc(pci_resource_start(pdev, 2),
- pci_resource_len(pdev, 2));
- if (!adapter->bar2) {
- dev_err(adapter->pdev_dev, "cannot map BAR2 doorbells\n");
- err = -ENOMEM;
- goto err_unmap_bar0;
- }
- }
- /*
- * Initialize adapter level features.
- */
- adapter->name = pci_name(pdev);
- adapter->msg_enable = DFLT_MSG_ENABLE;
- err = adap_init0(adapter);
- if (err)
- goto err_unmap_bar;
- /*
- * Allocate our "adapter ports" and stitch everything together.
- */
- pmask = adapter->params.vfres.pmask;
- pf = t4vf_get_pf_from_vf(adapter);
- for_each_port(adapter, pidx) {
- int port_id, viid;
- u8 mac[ETH_ALEN];
- unsigned int naddr = 1;
- /*
- * We simplistically allocate our virtual interfaces
- * sequentially across the port numbers to which we have
- * access rights. This should be configurable in some manner
- * ...
- */
- if (pmask == 0)
- break;
- port_id = ffs(pmask) - 1;
- pmask &= ~(1 << port_id);
- viid = t4vf_alloc_vi(adapter, port_id);
- if (viid < 0) {
- dev_err(&pdev->dev, "cannot allocate VI for port %d:"
- " err=%d\n", port_id, viid);
- err = viid;
- goto err_free_dev;
- }
- /*
- * Allocate our network device and stitch things together.
- */
- netdev = alloc_etherdev_mq(sizeof(struct port_info),
- MAX_PORT_QSETS);
- if (netdev == NULL) {
- t4vf_free_vi(adapter, viid);
- err = -ENOMEM;
- goto err_free_dev;
- }
- adapter->port[pidx] = netdev;
- SET_NETDEV_DEV(netdev, &pdev->dev);
- pi = netdev_priv(netdev);
- pi->adapter = adapter;
- pi->pidx = pidx;
- pi->port_id = port_id;
- pi->viid = viid;
- /*
- * Initialize the starting state of our "port" and register
- * it.
- */
- pi->xact_addr_filt = -1;
- netif_carrier_off(netdev);
- netdev->irq = pdev->irq;
- netdev->hw_features = NETIF_F_SG | TSO_FLAGS |
- NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM |
- NETIF_F_HW_VLAN_CTAG_RX | NETIF_F_RXCSUM;
- netdev->vlan_features = NETIF_F_SG | TSO_FLAGS |
- NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM |
- NETIF_F_HIGHDMA;
- netdev->features = netdev->hw_features |
- NETIF_F_HW_VLAN_CTAG_TX;
- if (pci_using_dac)
- netdev->features |= NETIF_F_HIGHDMA;
- netdev->priv_flags |= IFF_UNICAST_FLT;
- netdev->min_mtu = 81;
- netdev->max_mtu = ETH_MAX_MTU;
- netdev->netdev_ops = &cxgb4vf_netdev_ops;
- netdev->ethtool_ops = &cxgb4vf_ethtool_ops;
- netdev->dev_port = pi->port_id;
- /*
- * Initialize the hardware/software state for the port.
- */
- err = t4vf_port_init(adapter, pidx);
- if (err) {
- dev_err(&pdev->dev, "cannot initialize port %d\n",
- pidx);
- goto err_free_dev;
- }
- err = t4vf_get_vf_mac_acl(adapter, pf, &naddr, mac);
- if (err) {
- dev_err(&pdev->dev,
- "unable to determine MAC ACL address, "
- "continuing anyway.. (status %d)\n", err);
- } else if (naddr && adapter->params.vfres.nvi == 1) {
- struct sockaddr addr;
- ether_addr_copy(addr.sa_data, mac);
- err = cxgb4vf_set_mac_addr(netdev, &addr);
- if (err) {
- dev_err(&pdev->dev,
- "unable to set MAC address %pM\n",
- mac);
- goto err_free_dev;
- }
- dev_info(&pdev->dev,
- "Using assigned MAC ACL: %pM\n", mac);
- }
- }
- /* See what interrupts we'll be using. If we've been configured to
- * use MSI-X interrupts, try to enable them but fall back to using
- * MSI interrupts if we can't enable MSI-X interrupts. If we can't
- * get MSI interrupts we bail with the error.
- */
- if (msi == MSI_MSIX && enable_msix(adapter) == 0)
- adapter->flags |= USING_MSIX;
- else {
- if (msi == MSI_MSIX) {
- dev_info(adapter->pdev_dev,
- "Unable to use MSI-X Interrupts; falling "
- "back to MSI Interrupts\n");
- /* We're going to need a Forwarded Interrupt Queue so
- * that may cut into how many Queue Sets we can
- * support.
- */
- msi = MSI_MSI;
- size_nports_qsets(adapter);
- }
- err = pci_enable_msi(pdev);
- if (err) {
- dev_err(&pdev->dev, "Unable to allocate MSI Interrupts;"
- " err=%d\n", err);
- goto err_free_dev;
- }
- adapter->flags |= USING_MSI;
- }
- /* Now that we know how many "ports" we have and what interrupt
- * mechanism we're going to use, we can configure our queue resources.
- */
- cfg_queues(adapter);
- /*
- * The "card" is now ready to go. If any errors occur during device
- * registration we do not fail the whole "card" but rather proceed
- * only with the ports we manage to register successfully. However we
- * must register at least one net device.
- */
- for_each_port(adapter, pidx) {
- struct port_info *pi = netdev_priv(adapter->port[pidx]);
- netdev = adapter->port[pidx];
- if (netdev == NULL)
- continue;
- netif_set_real_num_tx_queues(netdev, pi->nqsets);
- netif_set_real_num_rx_queues(netdev, pi->nqsets);
- err = register_netdev(netdev);
- if (err) {
- dev_warn(&pdev->dev, "cannot register net device %s,"
- " skipping\n", netdev->name);
- continue;
- }
- set_bit(pidx, &adapter->registered_device_map);
- }
- if (adapter->registered_device_map == 0) {
- dev_err(&pdev->dev, "could not register any net devices\n");
- goto err_disable_interrupts;
- }
- /*
- * Set up our debugfs entries.
- */
- if (!IS_ERR_OR_NULL(cxgb4vf_debugfs_root)) {
- adapter->debugfs_root =
- debugfs_create_dir(pci_name(pdev),
- cxgb4vf_debugfs_root);
- if (IS_ERR_OR_NULL(adapter->debugfs_root))
- dev_warn(&pdev->dev, "could not create debugfs"
- " directory");
- else
- setup_debugfs(adapter);
- }
- /*
- * Print a short notice on the existence and configuration of the new
- * VF network device ...
- */
- for_each_port(adapter, pidx) {
- dev_info(adapter->pdev_dev, "%s: Chelsio VF NIC PCIe %s\n",
- adapter->port[pidx]->name,
- (adapter->flags & USING_MSIX) ? "MSI-X" :
- (adapter->flags & USING_MSI) ? "MSI" : "");
- }
- /*
- * Return success!
- */
- return 0;
- /*
- * Error recovery and exit code. Unwind state that's been created
- * so far and return the error.
- */
- err_disable_interrupts:
- if (adapter->flags & USING_MSIX) {
- pci_disable_msix(adapter->pdev);
- adapter->flags &= ~USING_MSIX;
- } else if (adapter->flags & USING_MSI) {
- pci_disable_msi(adapter->pdev);
- adapter->flags &= ~USING_MSI;
- }
- err_free_dev:
- for_each_port(adapter, pidx) {
- netdev = adapter->port[pidx];
- if (netdev == NULL)
- continue;
- pi = netdev_priv(netdev);
- t4vf_free_vi(adapter, pi->viid);
- if (test_bit(pidx, &adapter->registered_device_map))
- unregister_netdev(netdev);
- free_netdev(netdev);
- }
- err_unmap_bar:
- if (!is_t4(adapter->params.chip))
- iounmap(adapter->bar2);
- err_unmap_bar0:
- iounmap(adapter->regs);
- err_free_adapter:
- kfree(adapter->mbox_log);
- kfree(adapter);
- err_release_regions:
- pci_release_regions(pdev);
- pci_clear_master(pdev);
- err_disable_device:
- pci_disable_device(pdev);
- return err;
- }
- /*
- * "Remove" a device: tear down all kernel and driver state created in the
- * "probe" routine and quiesce the device (disable interrupts, etc.). (Note
- * that this is called "remove_one" in the PF Driver.)
- */
- static void cxgb4vf_pci_remove(struct pci_dev *pdev)
- {
- struct adapter *adapter = pci_get_drvdata(pdev);
- /*
- * Tear down driver state associated with device.
- */
- if (adapter) {
- int pidx;
- /*
- * Stop all of our activity. Unregister network port,
- * disable interrupts, etc.
- */
- for_each_port(adapter, pidx)
- if (test_bit(pidx, &adapter->registered_device_map))
- unregister_netdev(adapter->port[pidx]);
- t4vf_sge_stop(adapter);
- if (adapter->flags & USING_MSIX) {
- pci_disable_msix(adapter->pdev);
- adapter->flags &= ~USING_MSIX;
- } else if (adapter->flags & USING_MSI) {
- pci_disable_msi(adapter->pdev);
- adapter->flags &= ~USING_MSI;
- }
- /*
- * Tear down our debugfs entries.
- */
- if (!IS_ERR_OR_NULL(adapter->debugfs_root)) {
- cleanup_debugfs(adapter);
- debugfs_remove_recursive(adapter->debugfs_root);
- }
- /*
- * Free all of the various resources which we've acquired ...
- */
- t4vf_free_sge_resources(adapter);
- for_each_port(adapter, pidx) {
- struct net_device *netdev = adapter->port[pidx];
- struct port_info *pi;
- if (netdev == NULL)
- continue;
- pi = netdev_priv(netdev);
- t4vf_free_vi(adapter, pi->viid);
- free_netdev(netdev);
- }
- iounmap(adapter->regs);
- if (!is_t4(adapter->params.chip))
- iounmap(adapter->bar2);
- kfree(adapter->mbox_log);
- kfree(adapter);
- }
- /*
- * Disable the device and release its PCI resources.
- */
- pci_disable_device(pdev);
- pci_clear_master(pdev);
- pci_release_regions(pdev);
- }
- /*
- * "Shutdown" quiesce the device, stopping Ingress Packet and Interrupt
- * delivery.
- */
- static void cxgb4vf_pci_shutdown(struct pci_dev *pdev)
- {
- struct adapter *adapter;
- int pidx;
- adapter = pci_get_drvdata(pdev);
- if (!adapter)
- return;
- /* Disable all Virtual Interfaces. This will shut down the
- * delivery of all ingress packets into the chip for these
- * Virtual Interfaces.
- */
- for_each_port(adapter, pidx)
- if (test_bit(pidx, &adapter->registered_device_map))
- unregister_netdev(adapter->port[pidx]);
- /* Free up all Queues which will prevent further DMA and
- * Interrupts allowing various internal pathways to drain.
- */
- t4vf_sge_stop(adapter);
- if (adapter->flags & USING_MSIX) {
- pci_disable_msix(adapter->pdev);
- adapter->flags &= ~USING_MSIX;
- } else if (adapter->flags & USING_MSI) {
- pci_disable_msi(adapter->pdev);
- adapter->flags &= ~USING_MSI;
- }
- /*
- * Free up all Queues which will prevent further DMA and
- * Interrupts allowing various internal pathways to drain.
- */
- t4vf_free_sge_resources(adapter);
- pci_set_drvdata(pdev, NULL);
- }
- /* Macros needed to support the PCI Device ID Table ...
- */
- #define CH_PCI_DEVICE_ID_TABLE_DEFINE_BEGIN \
- static const struct pci_device_id cxgb4vf_pci_tbl[] = {
- #define CH_PCI_DEVICE_ID_FUNCTION 0x8
- #define CH_PCI_ID_TABLE_ENTRY(devid) \
- { PCI_VDEVICE(CHELSIO, (devid)), 0 }
- #define CH_PCI_DEVICE_ID_TABLE_DEFINE_END { 0, } }
- #include "../cxgb4/t4_pci_id_tbl.h"
- MODULE_DESCRIPTION(DRV_DESC);
- MODULE_AUTHOR("Chelsio Communications");
- MODULE_LICENSE("Dual BSD/GPL");
- MODULE_VERSION(DRV_VERSION);
- MODULE_DEVICE_TABLE(pci, cxgb4vf_pci_tbl);
- static struct pci_driver cxgb4vf_driver = {
- .name = KBUILD_MODNAME,
- .id_table = cxgb4vf_pci_tbl,
- .probe = cxgb4vf_pci_probe,
- .remove = cxgb4vf_pci_remove,
- .shutdown = cxgb4vf_pci_shutdown,
- };
- /*
- * Initialize global driver state.
- */
- static int __init cxgb4vf_module_init(void)
- {
- int ret;
- /*
- * Vet our module parameters.
- */
- if (msi != MSI_MSIX && msi != MSI_MSI) {
- pr_warn("bad module parameter msi=%d; must be %d (MSI-X or MSI) or %d (MSI)\n",
- msi, MSI_MSIX, MSI_MSI);
- return -EINVAL;
- }
- /* Debugfs support is optional, just warn if this fails */
- cxgb4vf_debugfs_root = debugfs_create_dir(KBUILD_MODNAME, NULL);
- if (IS_ERR_OR_NULL(cxgb4vf_debugfs_root))
- pr_warn("could not create debugfs entry, continuing\n");
- ret = pci_register_driver(&cxgb4vf_driver);
- if (ret < 0 && !IS_ERR_OR_NULL(cxgb4vf_debugfs_root))
- debugfs_remove(cxgb4vf_debugfs_root);
- return ret;
- }
- /*
- * Tear down global driver state.
- */
- static void __exit cxgb4vf_module_exit(void)
- {
- pci_unregister_driver(&cxgb4vf_driver);
- debugfs_remove(cxgb4vf_debugfs_root);
- }
- module_init(cxgb4vf_module_init);
- module_exit(cxgb4vf_module_exit);
|