dev.c 226 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950295129522953295429552956295729582959296029612962296329642965296629672968296929702971297229732974297529762977297829792980298129822983298429852986298729882989299029912992299329942995299629972998299930003001300230033004300530063007300830093010301130123013301430153016301730183019302030213022302330243025302630273028302930303031303230333034303530363037303830393040304130423043304430453046304730483049305030513052305330543055305630573058305930603061306230633064306530663067306830693070307130723073307430753076307730783079308030813082308330843085308630873088308930903091309230933094309530963097309830993100310131023103310431053106310731083109311031113112311331143115311631173118311931203121312231233124312531263127312831293130313131323133313431353136313731383139314031413142314331443145314631473148314931503151315231533154315531563157315831593160316131623163316431653166316731683169317031713172317331743175317631773178317931803181318231833184318531863187318831893190319131923193319431953196319731983199320032013202320332043205320632073208320932103211321232133214321532163217321832193220322132223223322432253226322732283229323032313232323332343235323632373238323932403241324232433244324532463247324832493250325132523253325432553256325732583259326032613262326332643265326632673268326932703271327232733274327532763277327832793280328132823283328432853286328732883289329032913292329332943295329632973298329933003301330233033304330533063307330833093310331133123313331433153316331733183319332033213322332333243325332633273328332933303331333233333334333533363337333833393340334133423343334433453346334733483349335033513352335333543355335633573358335933603361336233633364336533663367336833693370337133723373337433753376337733783379338033813382338333843385338633873388338933903391339233933394339533963397339833993400340134023403340434053406340734083409341034113412341334143415341634173418341934203421342234233424342534263427342834293430343134323433343434353436343734383439344034413442344334443445344634473448344934503451345234533454345534563457345834593460346134623463346434653466346734683469347034713472347334743475347634773478347934803481348234833484348534863487348834893490349134923493349434953496349734983499350035013502350335043505350635073508350935103511351235133514351535163517351835193520352135223523352435253526352735283529353035313532353335343535353635373538353935403541354235433544354535463547354835493550355135523553355435553556355735583559356035613562356335643565356635673568356935703571357235733574357535763577357835793580358135823583358435853586358735883589359035913592359335943595359635973598359936003601360236033604360536063607360836093610361136123613361436153616361736183619362036213622362336243625362636273628362936303631363236333634363536363637363836393640364136423643364436453646364736483649365036513652365336543655365636573658365936603661366236633664366536663667366836693670367136723673367436753676367736783679368036813682368336843685368636873688368936903691369236933694369536963697369836993700370137023703370437053706370737083709371037113712371337143715371637173718371937203721372237233724372537263727372837293730373137323733373437353736373737383739374037413742374337443745374637473748374937503751375237533754375537563757375837593760376137623763376437653766376737683769377037713772377337743775377637773778377937803781378237833784378537863787378837893790379137923793379437953796379737983799380038013802380338043805380638073808380938103811381238133814381538163817381838193820382138223823382438253826382738283829383038313832383338343835383638373838383938403841384238433844384538463847384838493850385138523853385438553856385738583859386038613862386338643865386638673868386938703871387238733874387538763877387838793880388138823883388438853886388738883889389038913892389338943895389638973898389939003901390239033904390539063907390839093910391139123913391439153916391739183919392039213922392339243925392639273928392939303931393239333934393539363937393839393940394139423943394439453946394739483949395039513952395339543955395639573958395939603961396239633964396539663967396839693970397139723973397439753976397739783979398039813982398339843985398639873988398939903991399239933994399539963997399839994000400140024003400440054006400740084009401040114012401340144015401640174018401940204021402240234024402540264027402840294030403140324033403440354036403740384039404040414042404340444045404640474048404940504051405240534054405540564057405840594060406140624063406440654066406740684069407040714072407340744075407640774078407940804081408240834084408540864087408840894090409140924093409440954096409740984099410041014102410341044105410641074108410941104111411241134114411541164117411841194120412141224123412441254126412741284129413041314132413341344135413641374138413941404141414241434144414541464147414841494150415141524153415441554156415741584159416041614162416341644165416641674168416941704171417241734174417541764177417841794180418141824183418441854186418741884189419041914192419341944195419641974198419942004201420242034204420542064207420842094210421142124213421442154216421742184219422042214222422342244225422642274228422942304231423242334234423542364237423842394240424142424243424442454246424742484249425042514252425342544255425642574258425942604261426242634264426542664267426842694270427142724273427442754276427742784279428042814282428342844285428642874288428942904291429242934294429542964297429842994300430143024303430443054306430743084309431043114312431343144315431643174318431943204321432243234324432543264327432843294330433143324333433443354336433743384339434043414342434343444345434643474348434943504351435243534354435543564357435843594360436143624363436443654366436743684369437043714372437343744375437643774378437943804381438243834384438543864387438843894390439143924393439443954396439743984399440044014402440344044405440644074408440944104411441244134414441544164417441844194420442144224423442444254426442744284429443044314432443344344435443644374438443944404441444244434444444544464447444844494450445144524453445444554456445744584459446044614462446344644465446644674468446944704471447244734474447544764477447844794480448144824483448444854486448744884489449044914492449344944495449644974498449945004501450245034504450545064507450845094510451145124513451445154516451745184519452045214522452345244525452645274528452945304531453245334534453545364537453845394540454145424543454445454546454745484549455045514552455345544555455645574558455945604561456245634564456545664567456845694570457145724573457445754576457745784579458045814582458345844585458645874588458945904591459245934594459545964597459845994600460146024603460446054606460746084609461046114612461346144615461646174618461946204621462246234624462546264627462846294630463146324633463446354636463746384639464046414642464346444645464646474648464946504651465246534654465546564657465846594660466146624663466446654666466746684669467046714672467346744675467646774678467946804681468246834684468546864687468846894690469146924693469446954696469746984699470047014702470347044705470647074708470947104711471247134714471547164717471847194720472147224723472447254726472747284729473047314732473347344735473647374738473947404741474247434744474547464747474847494750475147524753475447554756475747584759476047614762476347644765476647674768476947704771477247734774477547764777477847794780478147824783478447854786478747884789479047914792479347944795479647974798479948004801480248034804480548064807480848094810481148124813481448154816481748184819482048214822482348244825482648274828482948304831483248334834483548364837483848394840484148424843484448454846484748484849485048514852485348544855485648574858485948604861486248634864486548664867486848694870487148724873487448754876487748784879488048814882488348844885488648874888488948904891489248934894489548964897489848994900490149024903490449054906490749084909491049114912491349144915491649174918491949204921492249234924492549264927492849294930493149324933493449354936493749384939494049414942494349444945494649474948494949504951495249534954495549564957495849594960496149624963496449654966496749684969497049714972497349744975497649774978497949804981498249834984498549864987498849894990499149924993499449954996499749984999500050015002500350045005500650075008500950105011501250135014501550165017501850195020502150225023502450255026502750285029503050315032503350345035503650375038503950405041504250435044504550465047504850495050505150525053505450555056505750585059506050615062506350645065506650675068506950705071507250735074507550765077507850795080508150825083508450855086508750885089509050915092509350945095509650975098509951005101510251035104510551065107510851095110511151125113511451155116511751185119512051215122512351245125512651275128512951305131513251335134513551365137513851395140514151425143514451455146514751485149515051515152515351545155515651575158515951605161516251635164516551665167516851695170517151725173517451755176517751785179518051815182518351845185518651875188518951905191519251935194519551965197519851995200520152025203520452055206520752085209521052115212521352145215521652175218521952205221522252235224522552265227522852295230523152325233523452355236523752385239524052415242524352445245524652475248524952505251525252535254525552565257525852595260526152625263526452655266526752685269527052715272527352745275527652775278527952805281528252835284528552865287528852895290529152925293529452955296529752985299530053015302530353045305530653075308530953105311531253135314531553165317531853195320532153225323532453255326532753285329533053315332533353345335533653375338533953405341534253435344534553465347534853495350535153525353535453555356535753585359536053615362536353645365536653675368536953705371537253735374537553765377537853795380538153825383538453855386538753885389539053915392539353945395539653975398539954005401540254035404540554065407540854095410541154125413541454155416541754185419542054215422542354245425542654275428542954305431543254335434543554365437543854395440544154425443544454455446544754485449545054515452545354545455545654575458545954605461546254635464546554665467546854695470547154725473547454755476547754785479548054815482548354845485548654875488548954905491549254935494549554965497549854995500550155025503550455055506550755085509551055115512551355145515551655175518551955205521552255235524552555265527552855295530553155325533553455355536553755385539554055415542554355445545554655475548554955505551555255535554555555565557555855595560556155625563556455655566556755685569557055715572557355745575557655775578557955805581558255835584558555865587558855895590559155925593559455955596559755985599560056015602560356045605560656075608560956105611561256135614561556165617561856195620562156225623562456255626562756285629563056315632563356345635563656375638563956405641564256435644564556465647564856495650565156525653565456555656565756585659566056615662566356645665566656675668566956705671567256735674567556765677567856795680568156825683568456855686568756885689569056915692569356945695569656975698569957005701570257035704570557065707570857095710571157125713571457155716571757185719572057215722572357245725572657275728572957305731573257335734573557365737573857395740574157425743574457455746574757485749575057515752575357545755575657575758575957605761576257635764576557665767576857695770577157725773577457755776577757785779578057815782578357845785578657875788578957905791579257935794579557965797579857995800580158025803580458055806580758085809581058115812581358145815581658175818581958205821582258235824582558265827582858295830583158325833583458355836583758385839584058415842584358445845584658475848584958505851585258535854585558565857585858595860586158625863586458655866586758685869587058715872587358745875587658775878587958805881588258835884588558865887588858895890589158925893589458955896589758985899590059015902590359045905590659075908590959105911591259135914591559165917591859195920592159225923592459255926592759285929593059315932593359345935593659375938593959405941594259435944594559465947594859495950595159525953595459555956595759585959596059615962596359645965596659675968596959705971597259735974597559765977597859795980598159825983598459855986598759885989599059915992599359945995599659975998599960006001600260036004600560066007600860096010601160126013601460156016601760186019602060216022602360246025602660276028602960306031603260336034603560366037603860396040604160426043604460456046604760486049605060516052605360546055605660576058605960606061606260636064606560666067606860696070607160726073607460756076607760786079608060816082608360846085608660876088608960906091609260936094609560966097609860996100610161026103610461056106610761086109611061116112611361146115611661176118611961206121612261236124612561266127612861296130613161326133613461356136613761386139614061416142614361446145614661476148614961506151615261536154615561566157615861596160616161626163616461656166616761686169617061716172617361746175617661776178617961806181618261836184618561866187618861896190619161926193619461956196619761986199620062016202620362046205620662076208620962106211621262136214621562166217621862196220622162226223622462256226622762286229623062316232623362346235623662376238623962406241624262436244624562466247624862496250625162526253625462556256625762586259626062616262626362646265626662676268626962706271627262736274627562766277627862796280628162826283628462856286628762886289629062916292629362946295629662976298629963006301630263036304630563066307630863096310631163126313631463156316631763186319632063216322632363246325632663276328632963306331633263336334633563366337633863396340634163426343634463456346634763486349635063516352635363546355635663576358635963606361636263636364636563666367636863696370637163726373637463756376637763786379638063816382638363846385638663876388638963906391639263936394639563966397639863996400640164026403640464056406640764086409641064116412641364146415641664176418641964206421642264236424642564266427642864296430643164326433643464356436643764386439644064416442644364446445644664476448644964506451645264536454645564566457645864596460646164626463646464656466646764686469647064716472647364746475647664776478647964806481648264836484648564866487648864896490649164926493649464956496649764986499650065016502650365046505650665076508650965106511651265136514651565166517651865196520652165226523652465256526652765286529653065316532653365346535653665376538653965406541654265436544654565466547654865496550655165526553655465556556655765586559656065616562656365646565656665676568656965706571657265736574657565766577657865796580658165826583658465856586658765886589659065916592659365946595659665976598659966006601660266036604660566066607660866096610661166126613661466156616661766186619662066216622662366246625662666276628662966306631663266336634663566366637663866396640664166426643664466456646664766486649665066516652665366546655665666576658665966606661666266636664666566666667666866696670667166726673667466756676667766786679668066816682668366846685668666876688668966906691669266936694669566966697669866996700670167026703670467056706670767086709671067116712671367146715671667176718671967206721672267236724672567266727672867296730673167326733673467356736673767386739674067416742674367446745674667476748674967506751675267536754675567566757675867596760676167626763676467656766676767686769677067716772677367746775677667776778677967806781678267836784678567866787678867896790679167926793679467956796679767986799680068016802680368046805680668076808680968106811681268136814681568166817681868196820682168226823682468256826682768286829683068316832683368346835683668376838683968406841684268436844684568466847684868496850685168526853685468556856685768586859686068616862686368646865686668676868686968706871687268736874687568766877687868796880688168826883688468856886688768886889689068916892689368946895689668976898689969006901690269036904690569066907690869096910691169126913691469156916691769186919692069216922692369246925692669276928692969306931693269336934693569366937693869396940694169426943694469456946694769486949695069516952695369546955695669576958695969606961696269636964696569666967696869696970697169726973697469756976697769786979698069816982698369846985698669876988698969906991699269936994699569966997699869997000700170027003700470057006700770087009701070117012701370147015701670177018701970207021702270237024702570267027702870297030703170327033703470357036703770387039704070417042704370447045704670477048704970507051705270537054705570567057705870597060706170627063706470657066706770687069707070717072707370747075707670777078707970807081708270837084708570867087708870897090709170927093709470957096709770987099710071017102710371047105710671077108710971107111711271137114711571167117711871197120712171227123712471257126712771287129713071317132713371347135713671377138713971407141714271437144714571467147714871497150715171527153715471557156715771587159716071617162716371647165716671677168716971707171717271737174717571767177717871797180718171827183718471857186718771887189719071917192719371947195719671977198719972007201720272037204720572067207720872097210721172127213721472157216721772187219722072217222722372247225722672277228722972307231723272337234723572367237723872397240724172427243724472457246724772487249725072517252725372547255725672577258725972607261726272637264726572667267726872697270727172727273727472757276727772787279728072817282728372847285728672877288728972907291729272937294729572967297729872997300730173027303730473057306730773087309731073117312731373147315731673177318731973207321732273237324732573267327732873297330733173327333733473357336733773387339734073417342734373447345734673477348734973507351735273537354735573567357735873597360736173627363736473657366736773687369737073717372737373747375737673777378737973807381738273837384738573867387738873897390739173927393739473957396739773987399740074017402740374047405740674077408740974107411741274137414741574167417741874197420742174227423742474257426742774287429743074317432743374347435743674377438743974407441744274437444744574467447744874497450745174527453745474557456745774587459746074617462746374647465746674677468746974707471747274737474747574767477747874797480748174827483748474857486748774887489749074917492749374947495749674977498749975007501750275037504750575067507750875097510751175127513751475157516751775187519752075217522752375247525752675277528752975307531753275337534753575367537753875397540754175427543754475457546754775487549755075517552755375547555755675577558755975607561756275637564756575667567756875697570757175727573757475757576757775787579758075817582758375847585758675877588758975907591759275937594759575967597759875997600760176027603760476057606760776087609761076117612761376147615761676177618761976207621762276237624762576267627762876297630763176327633763476357636763776387639764076417642764376447645764676477648764976507651765276537654765576567657765876597660766176627663766476657666766776687669767076717672767376747675767676777678767976807681768276837684768576867687768876897690769176927693769476957696769776987699770077017702770377047705770677077708770977107711771277137714771577167717771877197720772177227723772477257726772777287729773077317732773377347735773677377738773977407741774277437744774577467747774877497750775177527753775477557756775777587759776077617762776377647765776677677768776977707771777277737774777577767777777877797780778177827783778477857786778777887789779077917792779377947795779677977798779978007801780278037804780578067807780878097810781178127813781478157816781778187819782078217822782378247825782678277828782978307831783278337834783578367837783878397840784178427843784478457846784778487849785078517852785378547855785678577858785978607861786278637864786578667867786878697870787178727873787478757876787778787879788078817882788378847885788678877888788978907891789278937894789578967897789878997900790179027903790479057906790779087909791079117912791379147915791679177918791979207921792279237924792579267927792879297930793179327933793479357936793779387939794079417942794379447945794679477948794979507951795279537954795579567957795879597960796179627963796479657966796779687969797079717972797379747975797679777978797979807981798279837984798579867987798879897990799179927993799479957996799779987999800080018002800380048005800680078008800980108011801280138014801580168017801880198020802180228023802480258026802780288029803080318032803380348035803680378038803980408041804280438044804580468047804880498050805180528053805480558056805780588059806080618062806380648065806680678068806980708071807280738074807580768077807880798080808180828083808480858086808780888089809080918092809380948095809680978098809981008101810281038104810581068107810881098110811181128113811481158116811781188119812081218122812381248125812681278128812981308131813281338134813581368137813881398140814181428143814481458146814781488149815081518152815381548155815681578158815981608161816281638164816581668167816881698170817181728173817481758176817781788179818081818182818381848185818681878188818981908191819281938194819581968197819881998200820182028203820482058206820782088209821082118212821382148215821682178218821982208221822282238224822582268227822882298230823182328233823482358236823782388239824082418242824382448245824682478248824982508251825282538254825582568257825882598260826182628263826482658266826782688269827082718272827382748275827682778278827982808281828282838284828582868287828882898290829182928293829482958296829782988299830083018302830383048305830683078308830983108311831283138314831583168317831883198320832183228323832483258326832783288329833083318332833383348335833683378338833983408341834283438344834583468347834883498350835183528353835483558356835783588359836083618362836383648365836683678368836983708371837283738374837583768377837883798380838183828383838483858386838783888389839083918392839383948395839683978398839984008401840284038404840584068407840884098410841184128413841484158416841784188419842084218422842384248425842684278428842984308431843284338434843584368437843884398440844184428443844484458446844784488449845084518452845384548455845684578458845984608461846284638464846584668467846884698470847184728473847484758476847784788479848084818482848384848485848684878488848984908491849284938494849584968497849884998500850185028503850485058506850785088509851085118512851385148515851685178518851985208521852285238524852585268527852885298530853185328533853485358536853785388539854085418542854385448545854685478548854985508551855285538554855585568557855885598560856185628563856485658566856785688569857085718572857385748575857685778578857985808581858285838584858585868587858885898590859185928593859485958596859785988599860086018602860386048605860686078608860986108611861286138614861586168617861886198620862186228623862486258626862786288629863086318632863386348635863686378638863986408641864286438644864586468647864886498650865186528653865486558656865786588659866086618662866386648665866686678668866986708671867286738674867586768677867886798680868186828683868486858686868786888689869086918692869386948695869686978698869987008701870287038704870587068707870887098710871187128713871487158716871787188719872087218722872387248725872687278728872987308731873287338734873587368737873887398740874187428743874487458746874787488749875087518752875387548755875687578758875987608761876287638764876587668767876887698770877187728773877487758776877787788779878087818782878387848785878687878788878987908791879287938794879587968797879887998800880188028803880488058806880788088809881088118812881388148815881688178818881988208821882288238824882588268827882888298830883188328833883488358836883788388839884088418842884388448845884688478848884988508851885288538854885588568857885888598860886188628863886488658866886788688869887088718872887388748875887688778878887988808881888288838884888588868887888888898890889188928893889488958896889788988899890089018902890389048905890689078908890989108911891289138914891589168917891889198920892189228923892489258926892789288929893089318932893389348935893689378938893989408941894289438944894589468947894889498950895189528953895489558956895789588959896089618962896389648965896689678968896989708971897289738974897589768977897889798980898189828983898489858986898789888989899089918992899389948995899689978998899990009001900290039004900590069007900890099010901190129013901490159016901790189019902090219022902390249025902690279028902990309031903290339034903590369037903890399040904190429043904490459046904790489049905090519052905390549055905690579058905990609061906290639064906590669067906890699070907190729073907490759076907790789079908090819082908390849085908690879088908990909091909290939094909590969097909890999100910191029103910491059106910791089109911091119112
  1. /*
  2. * NET3 Protocol independent device support routines.
  3. *
  4. * This program is free software; you can redistribute it and/or
  5. * modify it under the terms of the GNU General Public License
  6. * as published by the Free Software Foundation; either version
  7. * 2 of the License, or (at your option) any later version.
  8. *
  9. * Derived from the non IP parts of dev.c 1.0.19
  10. * Authors: Ross Biro
  11. * Fred N. van Kempen, <waltje@uWalt.NL.Mugnet.ORG>
  12. * Mark Evans, <evansmp@uhura.aston.ac.uk>
  13. *
  14. * Additional Authors:
  15. * Florian la Roche <rzsfl@rz.uni-sb.de>
  16. * Alan Cox <gw4pts@gw4pts.ampr.org>
  17. * David Hinds <dahinds@users.sourceforge.net>
  18. * Alexey Kuznetsov <kuznet@ms2.inr.ac.ru>
  19. * Adam Sulmicki <adam@cfar.umd.edu>
  20. * Pekka Riikonen <priikone@poesidon.pspt.fi>
  21. *
  22. * Changes:
  23. * D.J. Barrow : Fixed bug where dev->refcnt gets set
  24. * to 2 if register_netdev gets called
  25. * before net_dev_init & also removed a
  26. * few lines of code in the process.
  27. * Alan Cox : device private ioctl copies fields back.
  28. * Alan Cox : Transmit queue code does relevant
  29. * stunts to keep the queue safe.
  30. * Alan Cox : Fixed double lock.
  31. * Alan Cox : Fixed promisc NULL pointer trap
  32. * ???????? : Support the full private ioctl range
  33. * Alan Cox : Moved ioctl permission check into
  34. * drivers
  35. * Tim Kordas : SIOCADDMULTI/SIOCDELMULTI
  36. * Alan Cox : 100 backlog just doesn't cut it when
  37. * you start doing multicast video 8)
  38. * Alan Cox : Rewrote net_bh and list manager.
  39. * Alan Cox : Fix ETH_P_ALL echoback lengths.
  40. * Alan Cox : Took out transmit every packet pass
  41. * Saved a few bytes in the ioctl handler
  42. * Alan Cox : Network driver sets packet type before
  43. * calling netif_rx. Saves a function
  44. * call a packet.
  45. * Alan Cox : Hashed net_bh()
  46. * Richard Kooijman: Timestamp fixes.
  47. * Alan Cox : Wrong field in SIOCGIFDSTADDR
  48. * Alan Cox : Device lock protection.
  49. * Alan Cox : Fixed nasty side effect of device close
  50. * changes.
  51. * Rudi Cilibrasi : Pass the right thing to
  52. * set_mac_address()
  53. * Dave Miller : 32bit quantity for the device lock to
  54. * make it work out on a Sparc.
  55. * Bjorn Ekwall : Added KERNELD hack.
  56. * Alan Cox : Cleaned up the backlog initialise.
  57. * Craig Metz : SIOCGIFCONF fix if space for under
  58. * 1 device.
  59. * Thomas Bogendoerfer : Return ENODEV for dev_open, if there
  60. * is no device open function.
  61. * Andi Kleen : Fix error reporting for SIOCGIFCONF
  62. * Michael Chastain : Fix signed/unsigned for SIOCGIFCONF
  63. * Cyrus Durgin : Cleaned for KMOD
  64. * Adam Sulmicki : Bug Fix : Network Device Unload
  65. * A network device unload needs to purge
  66. * the backlog queue.
  67. * Paul Rusty Russell : SIOCSIFNAME
  68. * Pekka Riikonen : Netdev boot-time settings code
  69. * Andrew Morton : Make unregister_netdevice wait
  70. * indefinitely on dev->refcnt
  71. * J Hadi Salim : - Backlog queue sampling
  72. * - netif_rx() feedback
  73. */
  74. #include <linux/uaccess.h>
  75. #include <linux/bitops.h>
  76. #include <linux/capability.h>
  77. #include <linux/cpu.h>
  78. #include <linux/types.h>
  79. #include <linux/kernel.h>
  80. #include <linux/hash.h>
  81. #include <linux/slab.h>
  82. #include <linux/sched.h>
  83. #include <linux/sched/mm.h>
  84. #include <linux/mutex.h>
  85. #include <linux/string.h>
  86. #include <linux/mm.h>
  87. #include <linux/socket.h>
  88. #include <linux/sockios.h>
  89. #include <linux/errno.h>
  90. #include <linux/interrupt.h>
  91. #include <linux/if_ether.h>
  92. #include <linux/netdevice.h>
  93. #include <linux/etherdevice.h>
  94. #include <linux/ethtool.h>
  95. #include <linux/notifier.h>
  96. #include <linux/skbuff.h>
  97. #include <linux/bpf.h>
  98. #include <linux/bpf_trace.h>
  99. #include <net/net_namespace.h>
  100. #include <net/sock.h>
  101. #include <net/busy_poll.h>
  102. #include <linux/rtnetlink.h>
  103. #include <linux/stat.h>
  104. #include <net/dst.h>
  105. #include <net/dst_metadata.h>
  106. #include <net/pkt_sched.h>
  107. #include <net/pkt_cls.h>
  108. #include <net/checksum.h>
  109. #include <net/xfrm.h>
  110. #include <linux/highmem.h>
  111. #include <linux/init.h>
  112. #include <linux/module.h>
  113. #include <linux/netpoll.h>
  114. #include <linux/rcupdate.h>
  115. #include <linux/delay.h>
  116. #include <net/iw_handler.h>
  117. #include <asm/current.h>
  118. #include <linux/audit.h>
  119. #include <linux/dmaengine.h>
  120. #include <linux/err.h>
  121. #include <linux/ctype.h>
  122. #include <linux/if_arp.h>
  123. #include <linux/if_vlan.h>
  124. #include <linux/ip.h>
  125. #include <net/ip.h>
  126. #include <net/mpls.h>
  127. #include <linux/ipv6.h>
  128. #include <linux/in.h>
  129. #include <linux/jhash.h>
  130. #include <linux/random.h>
  131. #include <trace/events/napi.h>
  132. #include <trace/events/net.h>
  133. #include <trace/events/skb.h>
  134. #include <linux/pci.h>
  135. #include <linux/inetdevice.h>
  136. #include <linux/cpu_rmap.h>
  137. #include <linux/static_key.h>
  138. #include <linux/hashtable.h>
  139. #include <linux/vmalloc.h>
  140. #include <linux/if_macvlan.h>
  141. #include <linux/errqueue.h>
  142. #include <linux/hrtimer.h>
  143. #include <linux/netfilter_ingress.h>
  144. #include <linux/crash_dump.h>
  145. #include <linux/sctp.h>
  146. #include <net/udp_tunnel.h>
  147. #include <linux/net_namespace.h>
  148. #include "net-sysfs.h"
  149. /* Instead of increasing this, you should create a hash table. */
  150. #define MAX_GRO_SKBS 8
  151. /* This should be increased if a protocol with a bigger head is added. */
  152. #define GRO_MAX_HEAD (MAX_HEADER + 128)
  153. static DEFINE_SPINLOCK(ptype_lock);
  154. static DEFINE_SPINLOCK(offload_lock);
  155. struct list_head ptype_base[PTYPE_HASH_SIZE] __read_mostly;
  156. struct list_head ptype_all __read_mostly; /* Taps */
  157. static struct list_head offload_base __read_mostly;
  158. static int netif_rx_internal(struct sk_buff *skb);
  159. static int call_netdevice_notifiers_info(unsigned long val,
  160. struct netdev_notifier_info *info);
  161. static struct napi_struct *napi_by_id(unsigned int napi_id);
  162. /*
  163. * The @dev_base_head list is protected by @dev_base_lock and the rtnl
  164. * semaphore.
  165. *
  166. * Pure readers hold dev_base_lock for reading, or rcu_read_lock()
  167. *
  168. * Writers must hold the rtnl semaphore while they loop through the
  169. * dev_base_head list, and hold dev_base_lock for writing when they do the
  170. * actual updates. This allows pure readers to access the list even
  171. * while a writer is preparing to update it.
  172. *
  173. * To put it another way, dev_base_lock is held for writing only to
  174. * protect against pure readers; the rtnl semaphore provides the
  175. * protection against other writers.
  176. *
  177. * See, for example usages, register_netdevice() and
  178. * unregister_netdevice(), which must be called with the rtnl
  179. * semaphore held.
  180. */
  181. DEFINE_RWLOCK(dev_base_lock);
  182. EXPORT_SYMBOL(dev_base_lock);
  183. static DEFINE_MUTEX(ifalias_mutex);
  184. /* protects napi_hash addition/deletion and napi_gen_id */
  185. static DEFINE_SPINLOCK(napi_hash_lock);
  186. static unsigned int napi_gen_id = NR_CPUS;
  187. static DEFINE_READ_MOSTLY_HASHTABLE(napi_hash, 8);
  188. static seqcount_t devnet_rename_seq;
  189. static inline void dev_base_seq_inc(struct net *net)
  190. {
  191. while (++net->dev_base_seq == 0)
  192. ;
  193. }
  194. static inline struct hlist_head *dev_name_hash(struct net *net, const char *name)
  195. {
  196. unsigned int hash = full_name_hash(net, name, strnlen(name, IFNAMSIZ));
  197. return &net->dev_name_head[hash_32(hash, NETDEV_HASHBITS)];
  198. }
  199. static inline struct hlist_head *dev_index_hash(struct net *net, int ifindex)
  200. {
  201. return &net->dev_index_head[ifindex & (NETDEV_HASHENTRIES - 1)];
  202. }
  203. static inline void rps_lock(struct softnet_data *sd)
  204. {
  205. #ifdef CONFIG_RPS
  206. spin_lock(&sd->input_pkt_queue.lock);
  207. #endif
  208. }
  209. static inline void rps_unlock(struct softnet_data *sd)
  210. {
  211. #ifdef CONFIG_RPS
  212. spin_unlock(&sd->input_pkt_queue.lock);
  213. #endif
  214. }
  215. /* Device list insertion */
  216. static void list_netdevice(struct net_device *dev)
  217. {
  218. struct net *net = dev_net(dev);
  219. ASSERT_RTNL();
  220. write_lock_bh(&dev_base_lock);
  221. list_add_tail_rcu(&dev->dev_list, &net->dev_base_head);
  222. hlist_add_head_rcu(&dev->name_hlist, dev_name_hash(net, dev->name));
  223. hlist_add_head_rcu(&dev->index_hlist,
  224. dev_index_hash(net, dev->ifindex));
  225. write_unlock_bh(&dev_base_lock);
  226. dev_base_seq_inc(net);
  227. }
  228. /* Device list removal
  229. * caller must respect a RCU grace period before freeing/reusing dev
  230. */
  231. static void unlist_netdevice(struct net_device *dev)
  232. {
  233. ASSERT_RTNL();
  234. /* Unlink dev from the device chain */
  235. write_lock_bh(&dev_base_lock);
  236. list_del_rcu(&dev->dev_list);
  237. hlist_del_rcu(&dev->name_hlist);
  238. hlist_del_rcu(&dev->index_hlist);
  239. write_unlock_bh(&dev_base_lock);
  240. dev_base_seq_inc(dev_net(dev));
  241. }
  242. /*
  243. * Our notifier list
  244. */
  245. static RAW_NOTIFIER_HEAD(netdev_chain);
  246. /*
  247. * Device drivers call our routines to queue packets here. We empty the
  248. * queue in the local softnet handler.
  249. */
  250. DEFINE_PER_CPU_ALIGNED(struct softnet_data, softnet_data);
  251. EXPORT_PER_CPU_SYMBOL(softnet_data);
  252. #ifdef CONFIG_LOCKDEP
  253. /*
  254. * register_netdevice() inits txq->_xmit_lock and sets lockdep class
  255. * according to dev->type
  256. */
  257. static const unsigned short netdev_lock_type[] = {
  258. ARPHRD_NETROM, ARPHRD_ETHER, ARPHRD_EETHER, ARPHRD_AX25,
  259. ARPHRD_PRONET, ARPHRD_CHAOS, ARPHRD_IEEE802, ARPHRD_ARCNET,
  260. ARPHRD_APPLETLK, ARPHRD_DLCI, ARPHRD_ATM, ARPHRD_METRICOM,
  261. ARPHRD_IEEE1394, ARPHRD_EUI64, ARPHRD_INFINIBAND, ARPHRD_SLIP,
  262. ARPHRD_CSLIP, ARPHRD_SLIP6, ARPHRD_CSLIP6, ARPHRD_RSRVD,
  263. ARPHRD_ADAPT, ARPHRD_ROSE, ARPHRD_X25, ARPHRD_HWX25,
  264. ARPHRD_PPP, ARPHRD_CISCO, ARPHRD_LAPB, ARPHRD_DDCMP,
  265. ARPHRD_RAWHDLC, ARPHRD_TUNNEL, ARPHRD_TUNNEL6, ARPHRD_FRAD,
  266. ARPHRD_SKIP, ARPHRD_LOOPBACK, ARPHRD_LOCALTLK, ARPHRD_FDDI,
  267. ARPHRD_BIF, ARPHRD_SIT, ARPHRD_IPDDP, ARPHRD_IPGRE,
  268. ARPHRD_PIMREG, ARPHRD_HIPPI, ARPHRD_ASH, ARPHRD_ECONET,
  269. ARPHRD_IRDA, ARPHRD_FCPP, ARPHRD_FCAL, ARPHRD_FCPL,
  270. ARPHRD_FCFABRIC, ARPHRD_IEEE80211, ARPHRD_IEEE80211_PRISM,
  271. ARPHRD_IEEE80211_RADIOTAP, ARPHRD_PHONET, ARPHRD_PHONET_PIPE,
  272. ARPHRD_IEEE802154, ARPHRD_VOID, ARPHRD_NONE};
  273. static const char *const netdev_lock_name[] = {
  274. "_xmit_NETROM", "_xmit_ETHER", "_xmit_EETHER", "_xmit_AX25",
  275. "_xmit_PRONET", "_xmit_CHAOS", "_xmit_IEEE802", "_xmit_ARCNET",
  276. "_xmit_APPLETLK", "_xmit_DLCI", "_xmit_ATM", "_xmit_METRICOM",
  277. "_xmit_IEEE1394", "_xmit_EUI64", "_xmit_INFINIBAND", "_xmit_SLIP",
  278. "_xmit_CSLIP", "_xmit_SLIP6", "_xmit_CSLIP6", "_xmit_RSRVD",
  279. "_xmit_ADAPT", "_xmit_ROSE", "_xmit_X25", "_xmit_HWX25",
  280. "_xmit_PPP", "_xmit_CISCO", "_xmit_LAPB", "_xmit_DDCMP",
  281. "_xmit_RAWHDLC", "_xmit_TUNNEL", "_xmit_TUNNEL6", "_xmit_FRAD",
  282. "_xmit_SKIP", "_xmit_LOOPBACK", "_xmit_LOCALTLK", "_xmit_FDDI",
  283. "_xmit_BIF", "_xmit_SIT", "_xmit_IPDDP", "_xmit_IPGRE",
  284. "_xmit_PIMREG", "_xmit_HIPPI", "_xmit_ASH", "_xmit_ECONET",
  285. "_xmit_IRDA", "_xmit_FCPP", "_xmit_FCAL", "_xmit_FCPL",
  286. "_xmit_FCFABRIC", "_xmit_IEEE80211", "_xmit_IEEE80211_PRISM",
  287. "_xmit_IEEE80211_RADIOTAP", "_xmit_PHONET", "_xmit_PHONET_PIPE",
  288. "_xmit_IEEE802154", "_xmit_VOID", "_xmit_NONE"};
  289. static struct lock_class_key netdev_xmit_lock_key[ARRAY_SIZE(netdev_lock_type)];
  290. static struct lock_class_key netdev_addr_lock_key[ARRAY_SIZE(netdev_lock_type)];
  291. static inline unsigned short netdev_lock_pos(unsigned short dev_type)
  292. {
  293. int i;
  294. for (i = 0; i < ARRAY_SIZE(netdev_lock_type); i++)
  295. if (netdev_lock_type[i] == dev_type)
  296. return i;
  297. /* the last key is used by default */
  298. return ARRAY_SIZE(netdev_lock_type) - 1;
  299. }
  300. static inline void netdev_set_xmit_lockdep_class(spinlock_t *lock,
  301. unsigned short dev_type)
  302. {
  303. int i;
  304. i = netdev_lock_pos(dev_type);
  305. lockdep_set_class_and_name(lock, &netdev_xmit_lock_key[i],
  306. netdev_lock_name[i]);
  307. }
  308. static inline void netdev_set_addr_lockdep_class(struct net_device *dev)
  309. {
  310. int i;
  311. i = netdev_lock_pos(dev->type);
  312. lockdep_set_class_and_name(&dev->addr_list_lock,
  313. &netdev_addr_lock_key[i],
  314. netdev_lock_name[i]);
  315. }
  316. #else
  317. static inline void netdev_set_xmit_lockdep_class(spinlock_t *lock,
  318. unsigned short dev_type)
  319. {
  320. }
  321. static inline void netdev_set_addr_lockdep_class(struct net_device *dev)
  322. {
  323. }
  324. #endif
  325. /*******************************************************************************
  326. *
  327. * Protocol management and registration routines
  328. *
  329. *******************************************************************************/
  330. /*
  331. * Add a protocol ID to the list. Now that the input handler is
  332. * smarter we can dispense with all the messy stuff that used to be
  333. * here.
  334. *
  335. * BEWARE!!! Protocol handlers, mangling input packets,
  336. * MUST BE last in hash buckets and checking protocol handlers
  337. * MUST start from promiscuous ptype_all chain in net_bh.
  338. * It is true now, do not change it.
  339. * Explanation follows: if protocol handler, mangling packet, will
  340. * be the first on list, it is not able to sense, that packet
  341. * is cloned and should be copied-on-write, so that it will
  342. * change it and subsequent readers will get broken packet.
  343. * --ANK (980803)
  344. */
  345. static inline struct list_head *ptype_head(const struct packet_type *pt)
  346. {
  347. if (pt->type == htons(ETH_P_ALL))
  348. return pt->dev ? &pt->dev->ptype_all : &ptype_all;
  349. else
  350. return pt->dev ? &pt->dev->ptype_specific :
  351. &ptype_base[ntohs(pt->type) & PTYPE_HASH_MASK];
  352. }
  353. /**
  354. * dev_add_pack - add packet handler
  355. * @pt: packet type declaration
  356. *
  357. * Add a protocol handler to the networking stack. The passed &packet_type
  358. * is linked into kernel lists and may not be freed until it has been
  359. * removed from the kernel lists.
  360. *
  361. * This call does not sleep therefore it can not
  362. * guarantee all CPU's that are in middle of receiving packets
  363. * will see the new packet type (until the next received packet).
  364. */
  365. void dev_add_pack(struct packet_type *pt)
  366. {
  367. struct list_head *head = ptype_head(pt);
  368. spin_lock(&ptype_lock);
  369. list_add_rcu(&pt->list, head);
  370. spin_unlock(&ptype_lock);
  371. }
  372. EXPORT_SYMBOL(dev_add_pack);
  373. /**
  374. * __dev_remove_pack - remove packet handler
  375. * @pt: packet type declaration
  376. *
  377. * Remove a protocol handler that was previously added to the kernel
  378. * protocol handlers by dev_add_pack(). The passed &packet_type is removed
  379. * from the kernel lists and can be freed or reused once this function
  380. * returns.
  381. *
  382. * The packet type might still be in use by receivers
  383. * and must not be freed until after all the CPU's have gone
  384. * through a quiescent state.
  385. */
  386. void __dev_remove_pack(struct packet_type *pt)
  387. {
  388. struct list_head *head = ptype_head(pt);
  389. struct packet_type *pt1;
  390. spin_lock(&ptype_lock);
  391. list_for_each_entry(pt1, head, list) {
  392. if (pt == pt1) {
  393. list_del_rcu(&pt->list);
  394. goto out;
  395. }
  396. }
  397. pr_warn("dev_remove_pack: %p not found\n", pt);
  398. out:
  399. spin_unlock(&ptype_lock);
  400. }
  401. EXPORT_SYMBOL(__dev_remove_pack);
  402. /**
  403. * dev_remove_pack - remove packet handler
  404. * @pt: packet type declaration
  405. *
  406. * Remove a protocol handler that was previously added to the kernel
  407. * protocol handlers by dev_add_pack(). The passed &packet_type is removed
  408. * from the kernel lists and can be freed or reused once this function
  409. * returns.
  410. *
  411. * This call sleeps to guarantee that no CPU is looking at the packet
  412. * type after return.
  413. */
  414. void dev_remove_pack(struct packet_type *pt)
  415. {
  416. __dev_remove_pack(pt);
  417. synchronize_net();
  418. }
  419. EXPORT_SYMBOL(dev_remove_pack);
  420. /**
  421. * dev_add_offload - register offload handlers
  422. * @po: protocol offload declaration
  423. *
  424. * Add protocol offload handlers to the networking stack. The passed
  425. * &proto_offload is linked into kernel lists and may not be freed until
  426. * it has been removed from the kernel lists.
  427. *
  428. * This call does not sleep therefore it can not
  429. * guarantee all CPU's that are in middle of receiving packets
  430. * will see the new offload handlers (until the next received packet).
  431. */
  432. void dev_add_offload(struct packet_offload *po)
  433. {
  434. struct packet_offload *elem;
  435. spin_lock(&offload_lock);
  436. list_for_each_entry(elem, &offload_base, list) {
  437. if (po->priority < elem->priority)
  438. break;
  439. }
  440. list_add_rcu(&po->list, elem->list.prev);
  441. spin_unlock(&offload_lock);
  442. }
  443. EXPORT_SYMBOL(dev_add_offload);
  444. /**
  445. * __dev_remove_offload - remove offload handler
  446. * @po: packet offload declaration
  447. *
  448. * Remove a protocol offload handler that was previously added to the
  449. * kernel offload handlers by dev_add_offload(). The passed &offload_type
  450. * is removed from the kernel lists and can be freed or reused once this
  451. * function returns.
  452. *
  453. * The packet type might still be in use by receivers
  454. * and must not be freed until after all the CPU's have gone
  455. * through a quiescent state.
  456. */
  457. static void __dev_remove_offload(struct packet_offload *po)
  458. {
  459. struct list_head *head = &offload_base;
  460. struct packet_offload *po1;
  461. spin_lock(&offload_lock);
  462. list_for_each_entry(po1, head, list) {
  463. if (po == po1) {
  464. list_del_rcu(&po->list);
  465. goto out;
  466. }
  467. }
  468. pr_warn("dev_remove_offload: %p not found\n", po);
  469. out:
  470. spin_unlock(&offload_lock);
  471. }
  472. /**
  473. * dev_remove_offload - remove packet offload handler
  474. * @po: packet offload declaration
  475. *
  476. * Remove a packet offload handler that was previously added to the kernel
  477. * offload handlers by dev_add_offload(). The passed &offload_type is
  478. * removed from the kernel lists and can be freed or reused once this
  479. * function returns.
  480. *
  481. * This call sleeps to guarantee that no CPU is looking at the packet
  482. * type after return.
  483. */
  484. void dev_remove_offload(struct packet_offload *po)
  485. {
  486. __dev_remove_offload(po);
  487. synchronize_net();
  488. }
  489. EXPORT_SYMBOL(dev_remove_offload);
  490. /******************************************************************************
  491. *
  492. * Device Boot-time Settings Routines
  493. *
  494. ******************************************************************************/
  495. /* Boot time configuration table */
  496. static struct netdev_boot_setup dev_boot_setup[NETDEV_BOOT_SETUP_MAX];
  497. /**
  498. * netdev_boot_setup_add - add new setup entry
  499. * @name: name of the device
  500. * @map: configured settings for the device
  501. *
  502. * Adds new setup entry to the dev_boot_setup list. The function
  503. * returns 0 on error and 1 on success. This is a generic routine to
  504. * all netdevices.
  505. */
  506. static int netdev_boot_setup_add(char *name, struct ifmap *map)
  507. {
  508. struct netdev_boot_setup *s;
  509. int i;
  510. s = dev_boot_setup;
  511. for (i = 0; i < NETDEV_BOOT_SETUP_MAX; i++) {
  512. if (s[i].name[0] == '\0' || s[i].name[0] == ' ') {
  513. memset(s[i].name, 0, sizeof(s[i].name));
  514. strlcpy(s[i].name, name, IFNAMSIZ);
  515. memcpy(&s[i].map, map, sizeof(s[i].map));
  516. break;
  517. }
  518. }
  519. return i >= NETDEV_BOOT_SETUP_MAX ? 0 : 1;
  520. }
  521. /**
  522. * netdev_boot_setup_check - check boot time settings
  523. * @dev: the netdevice
  524. *
  525. * Check boot time settings for the device.
  526. * The found settings are set for the device to be used
  527. * later in the device probing.
  528. * Returns 0 if no settings found, 1 if they are.
  529. */
  530. int netdev_boot_setup_check(struct net_device *dev)
  531. {
  532. struct netdev_boot_setup *s = dev_boot_setup;
  533. int i;
  534. for (i = 0; i < NETDEV_BOOT_SETUP_MAX; i++) {
  535. if (s[i].name[0] != '\0' && s[i].name[0] != ' ' &&
  536. !strcmp(dev->name, s[i].name)) {
  537. dev->irq = s[i].map.irq;
  538. dev->base_addr = s[i].map.base_addr;
  539. dev->mem_start = s[i].map.mem_start;
  540. dev->mem_end = s[i].map.mem_end;
  541. return 1;
  542. }
  543. }
  544. return 0;
  545. }
  546. EXPORT_SYMBOL(netdev_boot_setup_check);
  547. /**
  548. * netdev_boot_base - get address from boot time settings
  549. * @prefix: prefix for network device
  550. * @unit: id for network device
  551. *
  552. * Check boot time settings for the base address of device.
  553. * The found settings are set for the device to be used
  554. * later in the device probing.
  555. * Returns 0 if no settings found.
  556. */
  557. unsigned long netdev_boot_base(const char *prefix, int unit)
  558. {
  559. const struct netdev_boot_setup *s = dev_boot_setup;
  560. char name[IFNAMSIZ];
  561. int i;
  562. sprintf(name, "%s%d", prefix, unit);
  563. /*
  564. * If device already registered then return base of 1
  565. * to indicate not to probe for this interface
  566. */
  567. if (__dev_get_by_name(&init_net, name))
  568. return 1;
  569. for (i = 0; i < NETDEV_BOOT_SETUP_MAX; i++)
  570. if (!strcmp(name, s[i].name))
  571. return s[i].map.base_addr;
  572. return 0;
  573. }
  574. /*
  575. * Saves at boot time configured settings for any netdevice.
  576. */
  577. int __init netdev_boot_setup(char *str)
  578. {
  579. int ints[5];
  580. struct ifmap map;
  581. str = get_options(str, ARRAY_SIZE(ints), ints);
  582. if (!str || !*str)
  583. return 0;
  584. /* Save settings */
  585. memset(&map, 0, sizeof(map));
  586. if (ints[0] > 0)
  587. map.irq = ints[1];
  588. if (ints[0] > 1)
  589. map.base_addr = ints[2];
  590. if (ints[0] > 2)
  591. map.mem_start = ints[3];
  592. if (ints[0] > 3)
  593. map.mem_end = ints[4];
  594. /* Add new entry to the list */
  595. return netdev_boot_setup_add(str, &map);
  596. }
  597. __setup("netdev=", netdev_boot_setup);
  598. /*******************************************************************************
  599. *
  600. * Device Interface Subroutines
  601. *
  602. *******************************************************************************/
  603. /**
  604. * dev_get_iflink - get 'iflink' value of a interface
  605. * @dev: targeted interface
  606. *
  607. * Indicates the ifindex the interface is linked to.
  608. * Physical interfaces have the same 'ifindex' and 'iflink' values.
  609. */
  610. int dev_get_iflink(const struct net_device *dev)
  611. {
  612. if (dev->netdev_ops && dev->netdev_ops->ndo_get_iflink)
  613. return dev->netdev_ops->ndo_get_iflink(dev);
  614. return dev->ifindex;
  615. }
  616. EXPORT_SYMBOL(dev_get_iflink);
  617. /**
  618. * dev_fill_metadata_dst - Retrieve tunnel egress information.
  619. * @dev: targeted interface
  620. * @skb: The packet.
  621. *
  622. * For better visibility of tunnel traffic OVS needs to retrieve
  623. * egress tunnel information for a packet. Following API allows
  624. * user to get this info.
  625. */
  626. int dev_fill_metadata_dst(struct net_device *dev, struct sk_buff *skb)
  627. {
  628. struct ip_tunnel_info *info;
  629. if (!dev->netdev_ops || !dev->netdev_ops->ndo_fill_metadata_dst)
  630. return -EINVAL;
  631. info = skb_tunnel_info_unclone(skb);
  632. if (!info)
  633. return -ENOMEM;
  634. if (unlikely(!(info->mode & IP_TUNNEL_INFO_TX)))
  635. return -EINVAL;
  636. return dev->netdev_ops->ndo_fill_metadata_dst(dev, skb);
  637. }
  638. EXPORT_SYMBOL_GPL(dev_fill_metadata_dst);
  639. /**
  640. * __dev_get_by_name - find a device by its name
  641. * @net: the applicable net namespace
  642. * @name: name to find
  643. *
  644. * Find an interface by name. Must be called under RTNL semaphore
  645. * or @dev_base_lock. If the name is found a pointer to the device
  646. * is returned. If the name is not found then %NULL is returned. The
  647. * reference counters are not incremented so the caller must be
  648. * careful with locks.
  649. */
  650. struct net_device *__dev_get_by_name(struct net *net, const char *name)
  651. {
  652. struct net_device *dev;
  653. struct hlist_head *head = dev_name_hash(net, name);
  654. hlist_for_each_entry(dev, head, name_hlist)
  655. if (!strncmp(dev->name, name, IFNAMSIZ))
  656. return dev;
  657. return NULL;
  658. }
  659. EXPORT_SYMBOL(__dev_get_by_name);
  660. /**
  661. * dev_get_by_name_rcu - find a device by its name
  662. * @net: the applicable net namespace
  663. * @name: name to find
  664. *
  665. * Find an interface by name.
  666. * If the name is found a pointer to the device is returned.
  667. * If the name is not found then %NULL is returned.
  668. * The reference counters are not incremented so the caller must be
  669. * careful with locks. The caller must hold RCU lock.
  670. */
  671. struct net_device *dev_get_by_name_rcu(struct net *net, const char *name)
  672. {
  673. struct net_device *dev;
  674. struct hlist_head *head = dev_name_hash(net, name);
  675. hlist_for_each_entry_rcu(dev, head, name_hlist)
  676. if (!strncmp(dev->name, name, IFNAMSIZ))
  677. return dev;
  678. return NULL;
  679. }
  680. EXPORT_SYMBOL(dev_get_by_name_rcu);
  681. /**
  682. * dev_get_by_name - find a device by its name
  683. * @net: the applicable net namespace
  684. * @name: name to find
  685. *
  686. * Find an interface by name. This can be called from any
  687. * context and does its own locking. The returned handle has
  688. * the usage count incremented and the caller must use dev_put() to
  689. * release it when it is no longer needed. %NULL is returned if no
  690. * matching device is found.
  691. */
  692. struct net_device *dev_get_by_name(struct net *net, const char *name)
  693. {
  694. struct net_device *dev;
  695. rcu_read_lock();
  696. dev = dev_get_by_name_rcu(net, name);
  697. if (dev)
  698. dev_hold(dev);
  699. rcu_read_unlock();
  700. return dev;
  701. }
  702. EXPORT_SYMBOL(dev_get_by_name);
  703. /**
  704. * __dev_get_by_index - find a device by its ifindex
  705. * @net: the applicable net namespace
  706. * @ifindex: index of device
  707. *
  708. * Search for an interface by index. Returns %NULL if the device
  709. * is not found or a pointer to the device. The device has not
  710. * had its reference counter increased so the caller must be careful
  711. * about locking. The caller must hold either the RTNL semaphore
  712. * or @dev_base_lock.
  713. */
  714. struct net_device *__dev_get_by_index(struct net *net, int ifindex)
  715. {
  716. struct net_device *dev;
  717. struct hlist_head *head = dev_index_hash(net, ifindex);
  718. hlist_for_each_entry(dev, head, index_hlist)
  719. if (dev->ifindex == ifindex)
  720. return dev;
  721. return NULL;
  722. }
  723. EXPORT_SYMBOL(__dev_get_by_index);
  724. /**
  725. * dev_get_by_index_rcu - find a device by its ifindex
  726. * @net: the applicable net namespace
  727. * @ifindex: index of device
  728. *
  729. * Search for an interface by index. Returns %NULL if the device
  730. * is not found or a pointer to the device. The device has not
  731. * had its reference counter increased so the caller must be careful
  732. * about locking. The caller must hold RCU lock.
  733. */
  734. struct net_device *dev_get_by_index_rcu(struct net *net, int ifindex)
  735. {
  736. struct net_device *dev;
  737. struct hlist_head *head = dev_index_hash(net, ifindex);
  738. hlist_for_each_entry_rcu(dev, head, index_hlist)
  739. if (dev->ifindex == ifindex)
  740. return dev;
  741. return NULL;
  742. }
  743. EXPORT_SYMBOL(dev_get_by_index_rcu);
  744. /**
  745. * dev_get_by_index - find a device by its ifindex
  746. * @net: the applicable net namespace
  747. * @ifindex: index of device
  748. *
  749. * Search for an interface by index. Returns NULL if the device
  750. * is not found or a pointer to the device. The device returned has
  751. * had a reference added and the pointer is safe until the user calls
  752. * dev_put to indicate they have finished with it.
  753. */
  754. struct net_device *dev_get_by_index(struct net *net, int ifindex)
  755. {
  756. struct net_device *dev;
  757. rcu_read_lock();
  758. dev = dev_get_by_index_rcu(net, ifindex);
  759. if (dev)
  760. dev_hold(dev);
  761. rcu_read_unlock();
  762. return dev;
  763. }
  764. EXPORT_SYMBOL(dev_get_by_index);
  765. /**
  766. * dev_get_by_napi_id - find a device by napi_id
  767. * @napi_id: ID of the NAPI struct
  768. *
  769. * Search for an interface by NAPI ID. Returns %NULL if the device
  770. * is not found or a pointer to the device. The device has not had
  771. * its reference counter increased so the caller must be careful
  772. * about locking. The caller must hold RCU lock.
  773. */
  774. struct net_device *dev_get_by_napi_id(unsigned int napi_id)
  775. {
  776. struct napi_struct *napi;
  777. WARN_ON_ONCE(!rcu_read_lock_held());
  778. if (napi_id < MIN_NAPI_ID)
  779. return NULL;
  780. napi = napi_by_id(napi_id);
  781. return napi ? napi->dev : NULL;
  782. }
  783. EXPORT_SYMBOL(dev_get_by_napi_id);
  784. /**
  785. * netdev_get_name - get a netdevice name, knowing its ifindex.
  786. * @net: network namespace
  787. * @name: a pointer to the buffer where the name will be stored.
  788. * @ifindex: the ifindex of the interface to get the name from.
  789. *
  790. * The use of raw_seqcount_begin() and cond_resched() before
  791. * retrying is required as we want to give the writers a chance
  792. * to complete when CONFIG_PREEMPT is not set.
  793. */
  794. int netdev_get_name(struct net *net, char *name, int ifindex)
  795. {
  796. struct net_device *dev;
  797. unsigned int seq;
  798. retry:
  799. seq = raw_seqcount_begin(&devnet_rename_seq);
  800. rcu_read_lock();
  801. dev = dev_get_by_index_rcu(net, ifindex);
  802. if (!dev) {
  803. rcu_read_unlock();
  804. return -ENODEV;
  805. }
  806. strcpy(name, dev->name);
  807. rcu_read_unlock();
  808. if (read_seqcount_retry(&devnet_rename_seq, seq)) {
  809. cond_resched();
  810. goto retry;
  811. }
  812. return 0;
  813. }
  814. /**
  815. * dev_getbyhwaddr_rcu - find a device by its hardware address
  816. * @net: the applicable net namespace
  817. * @type: media type of device
  818. * @ha: hardware address
  819. *
  820. * Search for an interface by MAC address. Returns NULL if the device
  821. * is not found or a pointer to the device.
  822. * The caller must hold RCU or RTNL.
  823. * The returned device has not had its ref count increased
  824. * and the caller must therefore be careful about locking
  825. *
  826. */
  827. struct net_device *dev_getbyhwaddr_rcu(struct net *net, unsigned short type,
  828. const char *ha)
  829. {
  830. struct net_device *dev;
  831. for_each_netdev_rcu(net, dev)
  832. if (dev->type == type &&
  833. !memcmp(dev->dev_addr, ha, dev->addr_len))
  834. return dev;
  835. return NULL;
  836. }
  837. EXPORT_SYMBOL(dev_getbyhwaddr_rcu);
  838. struct net_device *__dev_getfirstbyhwtype(struct net *net, unsigned short type)
  839. {
  840. struct net_device *dev;
  841. ASSERT_RTNL();
  842. for_each_netdev(net, dev)
  843. if (dev->type == type)
  844. return dev;
  845. return NULL;
  846. }
  847. EXPORT_SYMBOL(__dev_getfirstbyhwtype);
  848. struct net_device *dev_getfirstbyhwtype(struct net *net, unsigned short type)
  849. {
  850. struct net_device *dev, *ret = NULL;
  851. rcu_read_lock();
  852. for_each_netdev_rcu(net, dev)
  853. if (dev->type == type) {
  854. dev_hold(dev);
  855. ret = dev;
  856. break;
  857. }
  858. rcu_read_unlock();
  859. return ret;
  860. }
  861. EXPORT_SYMBOL(dev_getfirstbyhwtype);
  862. /**
  863. * __dev_get_by_flags - find any device with given flags
  864. * @net: the applicable net namespace
  865. * @if_flags: IFF_* values
  866. * @mask: bitmask of bits in if_flags to check
  867. *
  868. * Search for any interface with the given flags. Returns NULL if a device
  869. * is not found or a pointer to the device. Must be called inside
  870. * rtnl_lock(), and result refcount is unchanged.
  871. */
  872. struct net_device *__dev_get_by_flags(struct net *net, unsigned short if_flags,
  873. unsigned short mask)
  874. {
  875. struct net_device *dev, *ret;
  876. ASSERT_RTNL();
  877. ret = NULL;
  878. for_each_netdev(net, dev) {
  879. if (((dev->flags ^ if_flags) & mask) == 0) {
  880. ret = dev;
  881. break;
  882. }
  883. }
  884. return ret;
  885. }
  886. EXPORT_SYMBOL(__dev_get_by_flags);
  887. /**
  888. * dev_valid_name - check if name is okay for network device
  889. * @name: name string
  890. *
  891. * Network device names need to be valid file names to
  892. * to allow sysfs to work. We also disallow any kind of
  893. * whitespace.
  894. */
  895. bool dev_valid_name(const char *name)
  896. {
  897. if (*name == '\0')
  898. return false;
  899. if (strnlen(name, IFNAMSIZ) == IFNAMSIZ)
  900. return false;
  901. if (!strcmp(name, ".") || !strcmp(name, ".."))
  902. return false;
  903. while (*name) {
  904. if (*name == '/' || *name == ':' || isspace(*name))
  905. return false;
  906. name++;
  907. }
  908. return true;
  909. }
  910. EXPORT_SYMBOL(dev_valid_name);
  911. /**
  912. * __dev_alloc_name - allocate a name for a device
  913. * @net: network namespace to allocate the device name in
  914. * @name: name format string
  915. * @buf: scratch buffer and result name string
  916. *
  917. * Passed a format string - eg "lt%d" it will try and find a suitable
  918. * id. It scans list of devices to build up a free map, then chooses
  919. * the first empty slot. The caller must hold the dev_base or rtnl lock
  920. * while allocating the name and adding the device in order to avoid
  921. * duplicates.
  922. * Limited to bits_per_byte * page size devices (ie 32K on most platforms).
  923. * Returns the number of the unit assigned or a negative errno code.
  924. */
  925. static int __dev_alloc_name(struct net *net, const char *name, char *buf)
  926. {
  927. int i = 0;
  928. const char *p;
  929. const int max_netdevices = 8*PAGE_SIZE;
  930. unsigned long *inuse;
  931. struct net_device *d;
  932. if (!dev_valid_name(name))
  933. return -EINVAL;
  934. p = strchr(name, '%');
  935. if (p) {
  936. /*
  937. * Verify the string as this thing may have come from
  938. * the user. There must be either one "%d" and no other "%"
  939. * characters.
  940. */
  941. if (p[1] != 'd' || strchr(p + 2, '%'))
  942. return -EINVAL;
  943. /* Use one page as a bit array of possible slots */
  944. inuse = (unsigned long *) get_zeroed_page(GFP_ATOMIC);
  945. if (!inuse)
  946. return -ENOMEM;
  947. for_each_netdev(net, d) {
  948. if (!sscanf(d->name, name, &i))
  949. continue;
  950. if (i < 0 || i >= max_netdevices)
  951. continue;
  952. /* avoid cases where sscanf is not exact inverse of printf */
  953. snprintf(buf, IFNAMSIZ, name, i);
  954. if (!strncmp(buf, d->name, IFNAMSIZ))
  955. set_bit(i, inuse);
  956. }
  957. i = find_first_zero_bit(inuse, max_netdevices);
  958. free_page((unsigned long) inuse);
  959. }
  960. snprintf(buf, IFNAMSIZ, name, i);
  961. if (!__dev_get_by_name(net, buf))
  962. return i;
  963. /* It is possible to run out of possible slots
  964. * when the name is long and there isn't enough space left
  965. * for the digits, or if all bits are used.
  966. */
  967. return -ENFILE;
  968. }
  969. static int dev_alloc_name_ns(struct net *net,
  970. struct net_device *dev,
  971. const char *name)
  972. {
  973. char buf[IFNAMSIZ];
  974. int ret;
  975. BUG_ON(!net);
  976. ret = __dev_alloc_name(net, name, buf);
  977. if (ret >= 0)
  978. strlcpy(dev->name, buf, IFNAMSIZ);
  979. return ret;
  980. }
  981. /**
  982. * dev_alloc_name - allocate a name for a device
  983. * @dev: device
  984. * @name: name format string
  985. *
  986. * Passed a format string - eg "lt%d" it will try and find a suitable
  987. * id. It scans list of devices to build up a free map, then chooses
  988. * the first empty slot. The caller must hold the dev_base or rtnl lock
  989. * while allocating the name and adding the device in order to avoid
  990. * duplicates.
  991. * Limited to bits_per_byte * page size devices (ie 32K on most platforms).
  992. * Returns the number of the unit assigned or a negative errno code.
  993. */
  994. int dev_alloc_name(struct net_device *dev, const char *name)
  995. {
  996. return dev_alloc_name_ns(dev_net(dev), dev, name);
  997. }
  998. EXPORT_SYMBOL(dev_alloc_name);
  999. int dev_get_valid_name(struct net *net, struct net_device *dev,
  1000. const char *name)
  1001. {
  1002. BUG_ON(!net);
  1003. if (!dev_valid_name(name))
  1004. return -EINVAL;
  1005. if (strchr(name, '%'))
  1006. return dev_alloc_name_ns(net, dev, name);
  1007. else if (__dev_get_by_name(net, name))
  1008. return -EEXIST;
  1009. else if (dev->name != name)
  1010. strlcpy(dev->name, name, IFNAMSIZ);
  1011. return 0;
  1012. }
  1013. EXPORT_SYMBOL(dev_get_valid_name);
  1014. /**
  1015. * dev_change_name - change name of a device
  1016. * @dev: device
  1017. * @newname: name (or format string) must be at least IFNAMSIZ
  1018. *
  1019. * Change name of a device, can pass format strings "eth%d".
  1020. * for wildcarding.
  1021. */
  1022. int dev_change_name(struct net_device *dev, const char *newname)
  1023. {
  1024. unsigned char old_assign_type;
  1025. char oldname[IFNAMSIZ];
  1026. int err = 0;
  1027. int ret;
  1028. struct net *net;
  1029. ASSERT_RTNL();
  1030. BUG_ON(!dev_net(dev));
  1031. net = dev_net(dev);
  1032. if (dev->flags & IFF_UP)
  1033. return -EBUSY;
  1034. write_seqcount_begin(&devnet_rename_seq);
  1035. if (strncmp(newname, dev->name, IFNAMSIZ) == 0) {
  1036. write_seqcount_end(&devnet_rename_seq);
  1037. return 0;
  1038. }
  1039. memcpy(oldname, dev->name, IFNAMSIZ);
  1040. err = dev_get_valid_name(net, dev, newname);
  1041. if (err < 0) {
  1042. write_seqcount_end(&devnet_rename_seq);
  1043. return err;
  1044. }
  1045. if (oldname[0] && !strchr(oldname, '%'))
  1046. netdev_info(dev, "renamed from %s\n", oldname);
  1047. old_assign_type = dev->name_assign_type;
  1048. dev->name_assign_type = NET_NAME_RENAMED;
  1049. rollback:
  1050. ret = device_rename(&dev->dev, dev->name);
  1051. if (ret) {
  1052. memcpy(dev->name, oldname, IFNAMSIZ);
  1053. dev->name_assign_type = old_assign_type;
  1054. write_seqcount_end(&devnet_rename_seq);
  1055. return ret;
  1056. }
  1057. write_seqcount_end(&devnet_rename_seq);
  1058. netdev_adjacent_rename_links(dev, oldname);
  1059. write_lock_bh(&dev_base_lock);
  1060. hlist_del_rcu(&dev->name_hlist);
  1061. write_unlock_bh(&dev_base_lock);
  1062. synchronize_rcu();
  1063. write_lock_bh(&dev_base_lock);
  1064. hlist_add_head_rcu(&dev->name_hlist, dev_name_hash(net, dev->name));
  1065. write_unlock_bh(&dev_base_lock);
  1066. ret = call_netdevice_notifiers(NETDEV_CHANGENAME, dev);
  1067. ret = notifier_to_errno(ret);
  1068. if (ret) {
  1069. /* err >= 0 after dev_alloc_name() or stores the first errno */
  1070. if (err >= 0) {
  1071. err = ret;
  1072. write_seqcount_begin(&devnet_rename_seq);
  1073. memcpy(dev->name, oldname, IFNAMSIZ);
  1074. memcpy(oldname, newname, IFNAMSIZ);
  1075. dev->name_assign_type = old_assign_type;
  1076. old_assign_type = NET_NAME_RENAMED;
  1077. goto rollback;
  1078. } else {
  1079. pr_err("%s: name change rollback failed: %d\n",
  1080. dev->name, ret);
  1081. }
  1082. }
  1083. return err;
  1084. }
  1085. /**
  1086. * dev_set_alias - change ifalias of a device
  1087. * @dev: device
  1088. * @alias: name up to IFALIASZ
  1089. * @len: limit of bytes to copy from info
  1090. *
  1091. * Set ifalias for a device,
  1092. */
  1093. int dev_set_alias(struct net_device *dev, const char *alias, size_t len)
  1094. {
  1095. struct dev_ifalias *new_alias = NULL;
  1096. if (len >= IFALIASZ)
  1097. return -EINVAL;
  1098. if (len) {
  1099. new_alias = kmalloc(sizeof(*new_alias) + len + 1, GFP_KERNEL);
  1100. if (!new_alias)
  1101. return -ENOMEM;
  1102. memcpy(new_alias->ifalias, alias, len);
  1103. new_alias->ifalias[len] = 0;
  1104. }
  1105. mutex_lock(&ifalias_mutex);
  1106. rcu_swap_protected(dev->ifalias, new_alias,
  1107. mutex_is_locked(&ifalias_mutex));
  1108. mutex_unlock(&ifalias_mutex);
  1109. if (new_alias)
  1110. kfree_rcu(new_alias, rcuhead);
  1111. return len;
  1112. }
  1113. EXPORT_SYMBOL(dev_set_alias);
  1114. /**
  1115. * dev_get_alias - get ifalias of a device
  1116. * @dev: device
  1117. * @name: buffer to store name of ifalias
  1118. * @len: size of buffer
  1119. *
  1120. * get ifalias for a device. Caller must make sure dev cannot go
  1121. * away, e.g. rcu read lock or own a reference count to device.
  1122. */
  1123. int dev_get_alias(const struct net_device *dev, char *name, size_t len)
  1124. {
  1125. const struct dev_ifalias *alias;
  1126. int ret = 0;
  1127. rcu_read_lock();
  1128. alias = rcu_dereference(dev->ifalias);
  1129. if (alias)
  1130. ret = snprintf(name, len, "%s", alias->ifalias);
  1131. rcu_read_unlock();
  1132. return ret;
  1133. }
  1134. /**
  1135. * netdev_features_change - device changes features
  1136. * @dev: device to cause notification
  1137. *
  1138. * Called to indicate a device has changed features.
  1139. */
  1140. void netdev_features_change(struct net_device *dev)
  1141. {
  1142. call_netdevice_notifiers(NETDEV_FEAT_CHANGE, dev);
  1143. }
  1144. EXPORT_SYMBOL(netdev_features_change);
  1145. /**
  1146. * netdev_state_change - device changes state
  1147. * @dev: device to cause notification
  1148. *
  1149. * Called to indicate a device has changed state. This function calls
  1150. * the notifier chains for netdev_chain and sends a NEWLINK message
  1151. * to the routing socket.
  1152. */
  1153. void netdev_state_change(struct net_device *dev)
  1154. {
  1155. if (dev->flags & IFF_UP) {
  1156. struct netdev_notifier_change_info change_info = {
  1157. .info.dev = dev,
  1158. };
  1159. call_netdevice_notifiers_info(NETDEV_CHANGE,
  1160. &change_info.info);
  1161. rtmsg_ifinfo(RTM_NEWLINK, dev, 0, GFP_KERNEL);
  1162. }
  1163. }
  1164. EXPORT_SYMBOL(netdev_state_change);
  1165. /**
  1166. * netdev_notify_peers - notify network peers about existence of @dev
  1167. * @dev: network device
  1168. *
  1169. * Generate traffic such that interested network peers are aware of
  1170. * @dev, such as by generating a gratuitous ARP. This may be used when
  1171. * a device wants to inform the rest of the network about some sort of
  1172. * reconfiguration such as a failover event or virtual machine
  1173. * migration.
  1174. */
  1175. void netdev_notify_peers(struct net_device *dev)
  1176. {
  1177. rtnl_lock();
  1178. call_netdevice_notifiers(NETDEV_NOTIFY_PEERS, dev);
  1179. call_netdevice_notifiers(NETDEV_RESEND_IGMP, dev);
  1180. rtnl_unlock();
  1181. }
  1182. EXPORT_SYMBOL(netdev_notify_peers);
  1183. static int __dev_open(struct net_device *dev)
  1184. {
  1185. const struct net_device_ops *ops = dev->netdev_ops;
  1186. int ret;
  1187. ASSERT_RTNL();
  1188. if (!netif_device_present(dev))
  1189. return -ENODEV;
  1190. /* Block netpoll from trying to do any rx path servicing.
  1191. * If we don't do this there is a chance ndo_poll_controller
  1192. * or ndo_poll may be running while we open the device
  1193. */
  1194. netpoll_poll_disable(dev);
  1195. ret = call_netdevice_notifiers(NETDEV_PRE_UP, dev);
  1196. ret = notifier_to_errno(ret);
  1197. if (ret)
  1198. return ret;
  1199. set_bit(__LINK_STATE_START, &dev->state);
  1200. if (ops->ndo_validate_addr)
  1201. ret = ops->ndo_validate_addr(dev);
  1202. if (!ret && ops->ndo_open)
  1203. ret = ops->ndo_open(dev);
  1204. netpoll_poll_enable(dev);
  1205. if (ret)
  1206. clear_bit(__LINK_STATE_START, &dev->state);
  1207. else {
  1208. dev->flags |= IFF_UP;
  1209. dev_set_rx_mode(dev);
  1210. dev_activate(dev);
  1211. add_device_randomness(dev->dev_addr, dev->addr_len);
  1212. }
  1213. return ret;
  1214. }
  1215. /**
  1216. * dev_open - prepare an interface for use.
  1217. * @dev: device to open
  1218. *
  1219. * Takes a device from down to up state. The device's private open
  1220. * function is invoked and then the multicast lists are loaded. Finally
  1221. * the device is moved into the up state and a %NETDEV_UP message is
  1222. * sent to the netdev notifier chain.
  1223. *
  1224. * Calling this function on an active interface is a nop. On a failure
  1225. * a negative errno code is returned.
  1226. */
  1227. int dev_open(struct net_device *dev)
  1228. {
  1229. int ret;
  1230. if (dev->flags & IFF_UP)
  1231. return 0;
  1232. ret = __dev_open(dev);
  1233. if (ret < 0)
  1234. return ret;
  1235. rtmsg_ifinfo(RTM_NEWLINK, dev, IFF_UP|IFF_RUNNING, GFP_KERNEL);
  1236. call_netdevice_notifiers(NETDEV_UP, dev);
  1237. return ret;
  1238. }
  1239. EXPORT_SYMBOL(dev_open);
  1240. static void __dev_close_many(struct list_head *head)
  1241. {
  1242. struct net_device *dev;
  1243. ASSERT_RTNL();
  1244. might_sleep();
  1245. list_for_each_entry(dev, head, close_list) {
  1246. /* Temporarily disable netpoll until the interface is down */
  1247. netpoll_poll_disable(dev);
  1248. call_netdevice_notifiers(NETDEV_GOING_DOWN, dev);
  1249. clear_bit(__LINK_STATE_START, &dev->state);
  1250. /* Synchronize to scheduled poll. We cannot touch poll list, it
  1251. * can be even on different cpu. So just clear netif_running().
  1252. *
  1253. * dev->stop() will invoke napi_disable() on all of it's
  1254. * napi_struct instances on this device.
  1255. */
  1256. smp_mb__after_atomic(); /* Commit netif_running(). */
  1257. }
  1258. dev_deactivate_many(head);
  1259. list_for_each_entry(dev, head, close_list) {
  1260. const struct net_device_ops *ops = dev->netdev_ops;
  1261. /*
  1262. * Call the device specific close. This cannot fail.
  1263. * Only if device is UP
  1264. *
  1265. * We allow it to be called even after a DETACH hot-plug
  1266. * event.
  1267. */
  1268. if (ops->ndo_stop)
  1269. ops->ndo_stop(dev);
  1270. dev->flags &= ~IFF_UP;
  1271. netpoll_poll_enable(dev);
  1272. }
  1273. }
  1274. static void __dev_close(struct net_device *dev)
  1275. {
  1276. LIST_HEAD(single);
  1277. list_add(&dev->close_list, &single);
  1278. __dev_close_many(&single);
  1279. list_del(&single);
  1280. }
  1281. void dev_close_many(struct list_head *head, bool unlink)
  1282. {
  1283. struct net_device *dev, *tmp;
  1284. /* Remove the devices that don't need to be closed */
  1285. list_for_each_entry_safe(dev, tmp, head, close_list)
  1286. if (!(dev->flags & IFF_UP))
  1287. list_del_init(&dev->close_list);
  1288. __dev_close_many(head);
  1289. list_for_each_entry_safe(dev, tmp, head, close_list) {
  1290. rtmsg_ifinfo(RTM_NEWLINK, dev, IFF_UP|IFF_RUNNING, GFP_KERNEL);
  1291. call_netdevice_notifiers(NETDEV_DOWN, dev);
  1292. if (unlink)
  1293. list_del_init(&dev->close_list);
  1294. }
  1295. }
  1296. EXPORT_SYMBOL(dev_close_many);
  1297. /**
  1298. * dev_close - shutdown an interface.
  1299. * @dev: device to shutdown
  1300. *
  1301. * This function moves an active device into down state. A
  1302. * %NETDEV_GOING_DOWN is sent to the netdev notifier chain. The device
  1303. * is then deactivated and finally a %NETDEV_DOWN is sent to the notifier
  1304. * chain.
  1305. */
  1306. void dev_close(struct net_device *dev)
  1307. {
  1308. if (dev->flags & IFF_UP) {
  1309. LIST_HEAD(single);
  1310. list_add(&dev->close_list, &single);
  1311. dev_close_many(&single, true);
  1312. list_del(&single);
  1313. }
  1314. }
  1315. EXPORT_SYMBOL(dev_close);
  1316. /**
  1317. * dev_disable_lro - disable Large Receive Offload on a device
  1318. * @dev: device
  1319. *
  1320. * Disable Large Receive Offload (LRO) on a net device. Must be
  1321. * called under RTNL. This is needed if received packets may be
  1322. * forwarded to another interface.
  1323. */
  1324. void dev_disable_lro(struct net_device *dev)
  1325. {
  1326. struct net_device *lower_dev;
  1327. struct list_head *iter;
  1328. dev->wanted_features &= ~NETIF_F_LRO;
  1329. netdev_update_features(dev);
  1330. if (unlikely(dev->features & NETIF_F_LRO))
  1331. netdev_WARN(dev, "failed to disable LRO!\n");
  1332. netdev_for_each_lower_dev(dev, lower_dev, iter)
  1333. dev_disable_lro(lower_dev);
  1334. }
  1335. EXPORT_SYMBOL(dev_disable_lro);
  1336. /**
  1337. * dev_disable_gro_hw - disable HW Generic Receive Offload on a device
  1338. * @dev: device
  1339. *
  1340. * Disable HW Generic Receive Offload (GRO_HW) on a net device. Must be
  1341. * called under RTNL. This is needed if Generic XDP is installed on
  1342. * the device.
  1343. */
  1344. static void dev_disable_gro_hw(struct net_device *dev)
  1345. {
  1346. dev->wanted_features &= ~NETIF_F_GRO_HW;
  1347. netdev_update_features(dev);
  1348. if (unlikely(dev->features & NETIF_F_GRO_HW))
  1349. netdev_WARN(dev, "failed to disable GRO_HW!\n");
  1350. }
  1351. const char *netdev_cmd_to_name(enum netdev_cmd cmd)
  1352. {
  1353. #define N(val) \
  1354. case NETDEV_##val: \
  1355. return "NETDEV_" __stringify(val);
  1356. switch (cmd) {
  1357. N(UP) N(DOWN) N(REBOOT) N(CHANGE) N(REGISTER) N(UNREGISTER)
  1358. N(CHANGEMTU) N(CHANGEADDR) N(GOING_DOWN) N(CHANGENAME) N(FEAT_CHANGE)
  1359. N(BONDING_FAILOVER) N(PRE_UP) N(PRE_TYPE_CHANGE) N(POST_TYPE_CHANGE)
  1360. N(POST_INIT) N(RELEASE) N(NOTIFY_PEERS) N(JOIN) N(CHANGEUPPER)
  1361. N(RESEND_IGMP) N(PRECHANGEMTU) N(CHANGEINFODATA) N(BONDING_INFO)
  1362. N(PRECHANGEUPPER) N(CHANGELOWERSTATE) N(UDP_TUNNEL_PUSH_INFO)
  1363. N(UDP_TUNNEL_DROP_INFO) N(CHANGE_TX_QUEUE_LEN)
  1364. N(CVLAN_FILTER_PUSH_INFO) N(CVLAN_FILTER_DROP_INFO)
  1365. N(SVLAN_FILTER_PUSH_INFO) N(SVLAN_FILTER_DROP_INFO)
  1366. };
  1367. #undef N
  1368. return "UNKNOWN_NETDEV_EVENT";
  1369. }
  1370. EXPORT_SYMBOL_GPL(netdev_cmd_to_name);
  1371. static int call_netdevice_notifier(struct notifier_block *nb, unsigned long val,
  1372. struct net_device *dev)
  1373. {
  1374. struct netdev_notifier_info info = {
  1375. .dev = dev,
  1376. };
  1377. return nb->notifier_call(nb, val, &info);
  1378. }
  1379. static int dev_boot_phase = 1;
  1380. /**
  1381. * register_netdevice_notifier - register a network notifier block
  1382. * @nb: notifier
  1383. *
  1384. * Register a notifier to be called when network device events occur.
  1385. * The notifier passed is linked into the kernel structures and must
  1386. * not be reused until it has been unregistered. A negative errno code
  1387. * is returned on a failure.
  1388. *
  1389. * When registered all registration and up events are replayed
  1390. * to the new notifier to allow device to have a race free
  1391. * view of the network device list.
  1392. */
  1393. int register_netdevice_notifier(struct notifier_block *nb)
  1394. {
  1395. struct net_device *dev;
  1396. struct net_device *last;
  1397. struct net *net;
  1398. int err;
  1399. /* Close race with setup_net() and cleanup_net() */
  1400. down_write(&pernet_ops_rwsem);
  1401. rtnl_lock();
  1402. err = raw_notifier_chain_register(&netdev_chain, nb);
  1403. if (err)
  1404. goto unlock;
  1405. if (dev_boot_phase)
  1406. goto unlock;
  1407. for_each_net(net) {
  1408. for_each_netdev(net, dev) {
  1409. err = call_netdevice_notifier(nb, NETDEV_REGISTER, dev);
  1410. err = notifier_to_errno(err);
  1411. if (err)
  1412. goto rollback;
  1413. if (!(dev->flags & IFF_UP))
  1414. continue;
  1415. call_netdevice_notifier(nb, NETDEV_UP, dev);
  1416. }
  1417. }
  1418. unlock:
  1419. rtnl_unlock();
  1420. up_write(&pernet_ops_rwsem);
  1421. return err;
  1422. rollback:
  1423. last = dev;
  1424. for_each_net(net) {
  1425. for_each_netdev(net, dev) {
  1426. if (dev == last)
  1427. goto outroll;
  1428. if (dev->flags & IFF_UP) {
  1429. call_netdevice_notifier(nb, NETDEV_GOING_DOWN,
  1430. dev);
  1431. call_netdevice_notifier(nb, NETDEV_DOWN, dev);
  1432. }
  1433. call_netdevice_notifier(nb, NETDEV_UNREGISTER, dev);
  1434. }
  1435. }
  1436. outroll:
  1437. raw_notifier_chain_unregister(&netdev_chain, nb);
  1438. goto unlock;
  1439. }
  1440. EXPORT_SYMBOL(register_netdevice_notifier);
  1441. /**
  1442. * unregister_netdevice_notifier - unregister a network notifier block
  1443. * @nb: notifier
  1444. *
  1445. * Unregister a notifier previously registered by
  1446. * register_netdevice_notifier(). The notifier is unlinked into the
  1447. * kernel structures and may then be reused. A negative errno code
  1448. * is returned on a failure.
  1449. *
  1450. * After unregistering unregister and down device events are synthesized
  1451. * for all devices on the device list to the removed notifier to remove
  1452. * the need for special case cleanup code.
  1453. */
  1454. int unregister_netdevice_notifier(struct notifier_block *nb)
  1455. {
  1456. struct net_device *dev;
  1457. struct net *net;
  1458. int err;
  1459. /* Close race with setup_net() and cleanup_net() */
  1460. down_write(&pernet_ops_rwsem);
  1461. rtnl_lock();
  1462. err = raw_notifier_chain_unregister(&netdev_chain, nb);
  1463. if (err)
  1464. goto unlock;
  1465. for_each_net(net) {
  1466. for_each_netdev(net, dev) {
  1467. if (dev->flags & IFF_UP) {
  1468. call_netdevice_notifier(nb, NETDEV_GOING_DOWN,
  1469. dev);
  1470. call_netdevice_notifier(nb, NETDEV_DOWN, dev);
  1471. }
  1472. call_netdevice_notifier(nb, NETDEV_UNREGISTER, dev);
  1473. }
  1474. }
  1475. unlock:
  1476. rtnl_unlock();
  1477. up_write(&pernet_ops_rwsem);
  1478. return err;
  1479. }
  1480. EXPORT_SYMBOL(unregister_netdevice_notifier);
  1481. /**
  1482. * call_netdevice_notifiers_info - call all network notifier blocks
  1483. * @val: value passed unmodified to notifier function
  1484. * @info: notifier information data
  1485. *
  1486. * Call all network notifier blocks. Parameters and return value
  1487. * are as for raw_notifier_call_chain().
  1488. */
  1489. static int call_netdevice_notifiers_info(unsigned long val,
  1490. struct netdev_notifier_info *info)
  1491. {
  1492. ASSERT_RTNL();
  1493. return raw_notifier_call_chain(&netdev_chain, val, info);
  1494. }
  1495. /**
  1496. * call_netdevice_notifiers - call all network notifier blocks
  1497. * @val: value passed unmodified to notifier function
  1498. * @dev: net_device pointer passed unmodified to notifier function
  1499. *
  1500. * Call all network notifier blocks. Parameters and return value
  1501. * are as for raw_notifier_call_chain().
  1502. */
  1503. int call_netdevice_notifiers(unsigned long val, struct net_device *dev)
  1504. {
  1505. struct netdev_notifier_info info = {
  1506. .dev = dev,
  1507. };
  1508. return call_netdevice_notifiers_info(val, &info);
  1509. }
  1510. EXPORT_SYMBOL(call_netdevice_notifiers);
  1511. #ifdef CONFIG_NET_INGRESS
  1512. static struct static_key ingress_needed __read_mostly;
  1513. void net_inc_ingress_queue(void)
  1514. {
  1515. static_key_slow_inc(&ingress_needed);
  1516. }
  1517. EXPORT_SYMBOL_GPL(net_inc_ingress_queue);
  1518. void net_dec_ingress_queue(void)
  1519. {
  1520. static_key_slow_dec(&ingress_needed);
  1521. }
  1522. EXPORT_SYMBOL_GPL(net_dec_ingress_queue);
  1523. #endif
  1524. #ifdef CONFIG_NET_EGRESS
  1525. static struct static_key egress_needed __read_mostly;
  1526. void net_inc_egress_queue(void)
  1527. {
  1528. static_key_slow_inc(&egress_needed);
  1529. }
  1530. EXPORT_SYMBOL_GPL(net_inc_egress_queue);
  1531. void net_dec_egress_queue(void)
  1532. {
  1533. static_key_slow_dec(&egress_needed);
  1534. }
  1535. EXPORT_SYMBOL_GPL(net_dec_egress_queue);
  1536. #endif
  1537. static struct static_key netstamp_needed __read_mostly;
  1538. #ifdef HAVE_JUMP_LABEL
  1539. static atomic_t netstamp_needed_deferred;
  1540. static atomic_t netstamp_wanted;
  1541. static void netstamp_clear(struct work_struct *work)
  1542. {
  1543. int deferred = atomic_xchg(&netstamp_needed_deferred, 0);
  1544. int wanted;
  1545. wanted = atomic_add_return(deferred, &netstamp_wanted);
  1546. if (wanted > 0)
  1547. static_key_enable(&netstamp_needed);
  1548. else
  1549. static_key_disable(&netstamp_needed);
  1550. }
  1551. static DECLARE_WORK(netstamp_work, netstamp_clear);
  1552. #endif
  1553. void net_enable_timestamp(void)
  1554. {
  1555. #ifdef HAVE_JUMP_LABEL
  1556. int wanted;
  1557. while (1) {
  1558. wanted = atomic_read(&netstamp_wanted);
  1559. if (wanted <= 0)
  1560. break;
  1561. if (atomic_cmpxchg(&netstamp_wanted, wanted, wanted + 1) == wanted)
  1562. return;
  1563. }
  1564. atomic_inc(&netstamp_needed_deferred);
  1565. schedule_work(&netstamp_work);
  1566. #else
  1567. static_key_slow_inc(&netstamp_needed);
  1568. #endif
  1569. }
  1570. EXPORT_SYMBOL(net_enable_timestamp);
  1571. void net_disable_timestamp(void)
  1572. {
  1573. #ifdef HAVE_JUMP_LABEL
  1574. int wanted;
  1575. while (1) {
  1576. wanted = atomic_read(&netstamp_wanted);
  1577. if (wanted <= 1)
  1578. break;
  1579. if (atomic_cmpxchg(&netstamp_wanted, wanted, wanted - 1) == wanted)
  1580. return;
  1581. }
  1582. atomic_dec(&netstamp_needed_deferred);
  1583. schedule_work(&netstamp_work);
  1584. #else
  1585. static_key_slow_dec(&netstamp_needed);
  1586. #endif
  1587. }
  1588. EXPORT_SYMBOL(net_disable_timestamp);
  1589. static inline void net_timestamp_set(struct sk_buff *skb)
  1590. {
  1591. skb->tstamp = 0;
  1592. if (static_key_false(&netstamp_needed))
  1593. __net_timestamp(skb);
  1594. }
  1595. #define net_timestamp_check(COND, SKB) \
  1596. if (static_key_false(&netstamp_needed)) { \
  1597. if ((COND) && !(SKB)->tstamp) \
  1598. __net_timestamp(SKB); \
  1599. } \
  1600. bool is_skb_forwardable(const struct net_device *dev, const struct sk_buff *skb)
  1601. {
  1602. unsigned int len;
  1603. if (!(dev->flags & IFF_UP))
  1604. return false;
  1605. len = dev->mtu + dev->hard_header_len + VLAN_HLEN;
  1606. if (skb->len <= len)
  1607. return true;
  1608. /* if TSO is enabled, we don't care about the length as the packet
  1609. * could be forwarded without being segmented before
  1610. */
  1611. if (skb_is_gso(skb))
  1612. return true;
  1613. return false;
  1614. }
  1615. EXPORT_SYMBOL_GPL(is_skb_forwardable);
  1616. int __dev_forward_skb(struct net_device *dev, struct sk_buff *skb)
  1617. {
  1618. int ret = ____dev_forward_skb(dev, skb);
  1619. if (likely(!ret)) {
  1620. skb->protocol = eth_type_trans(skb, dev);
  1621. skb_postpull_rcsum(skb, eth_hdr(skb), ETH_HLEN);
  1622. }
  1623. return ret;
  1624. }
  1625. EXPORT_SYMBOL_GPL(__dev_forward_skb);
  1626. /**
  1627. * dev_forward_skb - loopback an skb to another netif
  1628. *
  1629. * @dev: destination network device
  1630. * @skb: buffer to forward
  1631. *
  1632. * return values:
  1633. * NET_RX_SUCCESS (no congestion)
  1634. * NET_RX_DROP (packet was dropped, but freed)
  1635. *
  1636. * dev_forward_skb can be used for injecting an skb from the
  1637. * start_xmit function of one device into the receive queue
  1638. * of another device.
  1639. *
  1640. * The receiving device may be in another namespace, so
  1641. * we have to clear all information in the skb that could
  1642. * impact namespace isolation.
  1643. */
  1644. int dev_forward_skb(struct net_device *dev, struct sk_buff *skb)
  1645. {
  1646. return __dev_forward_skb(dev, skb) ?: netif_rx_internal(skb);
  1647. }
  1648. EXPORT_SYMBOL_GPL(dev_forward_skb);
  1649. static inline int deliver_skb(struct sk_buff *skb,
  1650. struct packet_type *pt_prev,
  1651. struct net_device *orig_dev)
  1652. {
  1653. if (unlikely(skb_orphan_frags_rx(skb, GFP_ATOMIC)))
  1654. return -ENOMEM;
  1655. refcount_inc(&skb->users);
  1656. return pt_prev->func(skb, skb->dev, pt_prev, orig_dev);
  1657. }
  1658. static inline void deliver_ptype_list_skb(struct sk_buff *skb,
  1659. struct packet_type **pt,
  1660. struct net_device *orig_dev,
  1661. __be16 type,
  1662. struct list_head *ptype_list)
  1663. {
  1664. struct packet_type *ptype, *pt_prev = *pt;
  1665. list_for_each_entry_rcu(ptype, ptype_list, list) {
  1666. if (ptype->type != type)
  1667. continue;
  1668. if (pt_prev)
  1669. deliver_skb(skb, pt_prev, orig_dev);
  1670. pt_prev = ptype;
  1671. }
  1672. *pt = pt_prev;
  1673. }
  1674. static inline bool skb_loop_sk(struct packet_type *ptype, struct sk_buff *skb)
  1675. {
  1676. if (!ptype->af_packet_priv || !skb->sk)
  1677. return false;
  1678. if (ptype->id_match)
  1679. return ptype->id_match(ptype, skb->sk);
  1680. else if ((struct sock *)ptype->af_packet_priv == skb->sk)
  1681. return true;
  1682. return false;
  1683. }
  1684. /*
  1685. * Support routine. Sends outgoing frames to any network
  1686. * taps currently in use.
  1687. */
  1688. void dev_queue_xmit_nit(struct sk_buff *skb, struct net_device *dev)
  1689. {
  1690. struct packet_type *ptype;
  1691. struct sk_buff *skb2 = NULL;
  1692. struct packet_type *pt_prev = NULL;
  1693. struct list_head *ptype_list = &ptype_all;
  1694. rcu_read_lock();
  1695. again:
  1696. list_for_each_entry_rcu(ptype, ptype_list, list) {
  1697. /* Never send packets back to the socket
  1698. * they originated from - MvS (miquels@drinkel.ow.org)
  1699. */
  1700. if (skb_loop_sk(ptype, skb))
  1701. continue;
  1702. if (pt_prev) {
  1703. deliver_skb(skb2, pt_prev, skb->dev);
  1704. pt_prev = ptype;
  1705. continue;
  1706. }
  1707. /* need to clone skb, done only once */
  1708. skb2 = skb_clone(skb, GFP_ATOMIC);
  1709. if (!skb2)
  1710. goto out_unlock;
  1711. net_timestamp_set(skb2);
  1712. /* skb->nh should be correctly
  1713. * set by sender, so that the second statement is
  1714. * just protection against buggy protocols.
  1715. */
  1716. skb_reset_mac_header(skb2);
  1717. if (skb_network_header(skb2) < skb2->data ||
  1718. skb_network_header(skb2) > skb_tail_pointer(skb2)) {
  1719. net_crit_ratelimited("protocol %04x is buggy, dev %s\n",
  1720. ntohs(skb2->protocol),
  1721. dev->name);
  1722. skb_reset_network_header(skb2);
  1723. }
  1724. skb2->transport_header = skb2->network_header;
  1725. skb2->pkt_type = PACKET_OUTGOING;
  1726. pt_prev = ptype;
  1727. }
  1728. if (ptype_list == &ptype_all) {
  1729. ptype_list = &dev->ptype_all;
  1730. goto again;
  1731. }
  1732. out_unlock:
  1733. if (pt_prev) {
  1734. if (!skb_orphan_frags_rx(skb2, GFP_ATOMIC))
  1735. pt_prev->func(skb2, skb->dev, pt_prev, skb->dev);
  1736. else
  1737. kfree_skb(skb2);
  1738. }
  1739. rcu_read_unlock();
  1740. }
  1741. EXPORT_SYMBOL_GPL(dev_queue_xmit_nit);
  1742. /**
  1743. * netif_setup_tc - Handle tc mappings on real_num_tx_queues change
  1744. * @dev: Network device
  1745. * @txq: number of queues available
  1746. *
  1747. * If real_num_tx_queues is changed the tc mappings may no longer be
  1748. * valid. To resolve this verify the tc mapping remains valid and if
  1749. * not NULL the mapping. With no priorities mapping to this
  1750. * offset/count pair it will no longer be used. In the worst case TC0
  1751. * is invalid nothing can be done so disable priority mappings. If is
  1752. * expected that drivers will fix this mapping if they can before
  1753. * calling netif_set_real_num_tx_queues.
  1754. */
  1755. static void netif_setup_tc(struct net_device *dev, unsigned int txq)
  1756. {
  1757. int i;
  1758. struct netdev_tc_txq *tc = &dev->tc_to_txq[0];
  1759. /* If TC0 is invalidated disable TC mapping */
  1760. if (tc->offset + tc->count > txq) {
  1761. pr_warn("Number of in use tx queues changed invalidating tc mappings. Priority traffic classification disabled!\n");
  1762. dev->num_tc = 0;
  1763. return;
  1764. }
  1765. /* Invalidated prio to tc mappings set to TC0 */
  1766. for (i = 1; i < TC_BITMASK + 1; i++) {
  1767. int q = netdev_get_prio_tc_map(dev, i);
  1768. tc = &dev->tc_to_txq[q];
  1769. if (tc->offset + tc->count > txq) {
  1770. pr_warn("Number of in use tx queues changed. Priority %i to tc mapping %i is no longer valid. Setting map to 0\n",
  1771. i, q);
  1772. netdev_set_prio_tc_map(dev, i, 0);
  1773. }
  1774. }
  1775. }
  1776. int netdev_txq_to_tc(struct net_device *dev, unsigned int txq)
  1777. {
  1778. if (dev->num_tc) {
  1779. struct netdev_tc_txq *tc = &dev->tc_to_txq[0];
  1780. int i;
  1781. for (i = 0; i < TC_MAX_QUEUE; i++, tc++) {
  1782. if ((txq - tc->offset) < tc->count)
  1783. return i;
  1784. }
  1785. return -1;
  1786. }
  1787. return 0;
  1788. }
  1789. EXPORT_SYMBOL(netdev_txq_to_tc);
  1790. #ifdef CONFIG_XPS
  1791. static DEFINE_MUTEX(xps_map_mutex);
  1792. #define xmap_dereference(P) \
  1793. rcu_dereference_protected((P), lockdep_is_held(&xps_map_mutex))
  1794. static bool remove_xps_queue(struct xps_dev_maps *dev_maps,
  1795. int tci, u16 index)
  1796. {
  1797. struct xps_map *map = NULL;
  1798. int pos;
  1799. if (dev_maps)
  1800. map = xmap_dereference(dev_maps->cpu_map[tci]);
  1801. if (!map)
  1802. return false;
  1803. for (pos = map->len; pos--;) {
  1804. if (map->queues[pos] != index)
  1805. continue;
  1806. if (map->len > 1) {
  1807. map->queues[pos] = map->queues[--map->len];
  1808. break;
  1809. }
  1810. RCU_INIT_POINTER(dev_maps->cpu_map[tci], NULL);
  1811. kfree_rcu(map, rcu);
  1812. return false;
  1813. }
  1814. return true;
  1815. }
  1816. static bool remove_xps_queue_cpu(struct net_device *dev,
  1817. struct xps_dev_maps *dev_maps,
  1818. int cpu, u16 offset, u16 count)
  1819. {
  1820. int num_tc = dev->num_tc ? : 1;
  1821. bool active = false;
  1822. int tci;
  1823. for (tci = cpu * num_tc; num_tc--; tci++) {
  1824. int i, j;
  1825. for (i = count, j = offset; i--; j++) {
  1826. if (!remove_xps_queue(dev_maps, cpu, j))
  1827. break;
  1828. }
  1829. active |= i < 0;
  1830. }
  1831. return active;
  1832. }
  1833. static void netif_reset_xps_queues(struct net_device *dev, u16 offset,
  1834. u16 count)
  1835. {
  1836. struct xps_dev_maps *dev_maps;
  1837. int cpu, i;
  1838. bool active = false;
  1839. mutex_lock(&xps_map_mutex);
  1840. dev_maps = xmap_dereference(dev->xps_maps);
  1841. if (!dev_maps)
  1842. goto out_no_maps;
  1843. for_each_possible_cpu(cpu)
  1844. active |= remove_xps_queue_cpu(dev, dev_maps, cpu,
  1845. offset, count);
  1846. if (!active) {
  1847. RCU_INIT_POINTER(dev->xps_maps, NULL);
  1848. kfree_rcu(dev_maps, rcu);
  1849. }
  1850. for (i = offset + (count - 1); count--; i--)
  1851. netdev_queue_numa_node_write(netdev_get_tx_queue(dev, i),
  1852. NUMA_NO_NODE);
  1853. out_no_maps:
  1854. mutex_unlock(&xps_map_mutex);
  1855. }
  1856. static void netif_reset_xps_queues_gt(struct net_device *dev, u16 index)
  1857. {
  1858. netif_reset_xps_queues(dev, index, dev->num_tx_queues - index);
  1859. }
  1860. static struct xps_map *expand_xps_map(struct xps_map *map,
  1861. int cpu, u16 index)
  1862. {
  1863. struct xps_map *new_map;
  1864. int alloc_len = XPS_MIN_MAP_ALLOC;
  1865. int i, pos;
  1866. for (pos = 0; map && pos < map->len; pos++) {
  1867. if (map->queues[pos] != index)
  1868. continue;
  1869. return map;
  1870. }
  1871. /* Need to add queue to this CPU's existing map */
  1872. if (map) {
  1873. if (pos < map->alloc_len)
  1874. return map;
  1875. alloc_len = map->alloc_len * 2;
  1876. }
  1877. /* Need to allocate new map to store queue on this CPU's map */
  1878. new_map = kzalloc_node(XPS_MAP_SIZE(alloc_len), GFP_KERNEL,
  1879. cpu_to_node(cpu));
  1880. if (!new_map)
  1881. return NULL;
  1882. for (i = 0; i < pos; i++)
  1883. new_map->queues[i] = map->queues[i];
  1884. new_map->alloc_len = alloc_len;
  1885. new_map->len = pos;
  1886. return new_map;
  1887. }
  1888. int netif_set_xps_queue(struct net_device *dev, const struct cpumask *mask,
  1889. u16 index)
  1890. {
  1891. struct xps_dev_maps *dev_maps, *new_dev_maps = NULL;
  1892. int i, cpu, tci, numa_node_id = -2;
  1893. int maps_sz, num_tc = 1, tc = 0;
  1894. struct xps_map *map, *new_map;
  1895. bool active = false;
  1896. if (dev->num_tc) {
  1897. num_tc = dev->num_tc;
  1898. tc = netdev_txq_to_tc(dev, index);
  1899. if (tc < 0)
  1900. return -EINVAL;
  1901. }
  1902. maps_sz = XPS_DEV_MAPS_SIZE(num_tc);
  1903. if (maps_sz < L1_CACHE_BYTES)
  1904. maps_sz = L1_CACHE_BYTES;
  1905. mutex_lock(&xps_map_mutex);
  1906. dev_maps = xmap_dereference(dev->xps_maps);
  1907. /* allocate memory for queue storage */
  1908. for_each_cpu_and(cpu, cpu_online_mask, mask) {
  1909. if (!new_dev_maps)
  1910. new_dev_maps = kzalloc(maps_sz, GFP_KERNEL);
  1911. if (!new_dev_maps) {
  1912. mutex_unlock(&xps_map_mutex);
  1913. return -ENOMEM;
  1914. }
  1915. tci = cpu * num_tc + tc;
  1916. map = dev_maps ? xmap_dereference(dev_maps->cpu_map[tci]) :
  1917. NULL;
  1918. map = expand_xps_map(map, cpu, index);
  1919. if (!map)
  1920. goto error;
  1921. RCU_INIT_POINTER(new_dev_maps->cpu_map[tci], map);
  1922. }
  1923. if (!new_dev_maps)
  1924. goto out_no_new_maps;
  1925. for_each_possible_cpu(cpu) {
  1926. /* copy maps belonging to foreign traffic classes */
  1927. for (i = tc, tci = cpu * num_tc; dev_maps && i--; tci++) {
  1928. /* fill in the new device map from the old device map */
  1929. map = xmap_dereference(dev_maps->cpu_map[tci]);
  1930. RCU_INIT_POINTER(new_dev_maps->cpu_map[tci], map);
  1931. }
  1932. /* We need to explicitly update tci as prevous loop
  1933. * could break out early if dev_maps is NULL.
  1934. */
  1935. tci = cpu * num_tc + tc;
  1936. if (cpumask_test_cpu(cpu, mask) && cpu_online(cpu)) {
  1937. /* add queue to CPU maps */
  1938. int pos = 0;
  1939. map = xmap_dereference(new_dev_maps->cpu_map[tci]);
  1940. while ((pos < map->len) && (map->queues[pos] != index))
  1941. pos++;
  1942. if (pos == map->len)
  1943. map->queues[map->len++] = index;
  1944. #ifdef CONFIG_NUMA
  1945. if (numa_node_id == -2)
  1946. numa_node_id = cpu_to_node(cpu);
  1947. else if (numa_node_id != cpu_to_node(cpu))
  1948. numa_node_id = -1;
  1949. #endif
  1950. } else if (dev_maps) {
  1951. /* fill in the new device map from the old device map */
  1952. map = xmap_dereference(dev_maps->cpu_map[tci]);
  1953. RCU_INIT_POINTER(new_dev_maps->cpu_map[tci], map);
  1954. }
  1955. /* copy maps belonging to foreign traffic classes */
  1956. for (i = num_tc - tc, tci++; dev_maps && --i; tci++) {
  1957. /* fill in the new device map from the old device map */
  1958. map = xmap_dereference(dev_maps->cpu_map[tci]);
  1959. RCU_INIT_POINTER(new_dev_maps->cpu_map[tci], map);
  1960. }
  1961. }
  1962. rcu_assign_pointer(dev->xps_maps, new_dev_maps);
  1963. /* Cleanup old maps */
  1964. if (!dev_maps)
  1965. goto out_no_old_maps;
  1966. for_each_possible_cpu(cpu) {
  1967. for (i = num_tc, tci = cpu * num_tc; i--; tci++) {
  1968. new_map = xmap_dereference(new_dev_maps->cpu_map[tci]);
  1969. map = xmap_dereference(dev_maps->cpu_map[tci]);
  1970. if (map && map != new_map)
  1971. kfree_rcu(map, rcu);
  1972. }
  1973. }
  1974. kfree_rcu(dev_maps, rcu);
  1975. out_no_old_maps:
  1976. dev_maps = new_dev_maps;
  1977. active = true;
  1978. out_no_new_maps:
  1979. /* update Tx queue numa node */
  1980. netdev_queue_numa_node_write(netdev_get_tx_queue(dev, index),
  1981. (numa_node_id >= 0) ? numa_node_id :
  1982. NUMA_NO_NODE);
  1983. if (!dev_maps)
  1984. goto out_no_maps;
  1985. /* removes queue from unused CPUs */
  1986. for_each_possible_cpu(cpu) {
  1987. for (i = tc, tci = cpu * num_tc; i--; tci++)
  1988. active |= remove_xps_queue(dev_maps, tci, index);
  1989. if (!cpumask_test_cpu(cpu, mask) || !cpu_online(cpu))
  1990. active |= remove_xps_queue(dev_maps, tci, index);
  1991. for (i = num_tc - tc, tci++; --i; tci++)
  1992. active |= remove_xps_queue(dev_maps, tci, index);
  1993. }
  1994. /* free map if not active */
  1995. if (!active) {
  1996. RCU_INIT_POINTER(dev->xps_maps, NULL);
  1997. kfree_rcu(dev_maps, rcu);
  1998. }
  1999. out_no_maps:
  2000. mutex_unlock(&xps_map_mutex);
  2001. return 0;
  2002. error:
  2003. /* remove any maps that we added */
  2004. for_each_possible_cpu(cpu) {
  2005. for (i = num_tc, tci = cpu * num_tc; i--; tci++) {
  2006. new_map = xmap_dereference(new_dev_maps->cpu_map[tci]);
  2007. map = dev_maps ?
  2008. xmap_dereference(dev_maps->cpu_map[tci]) :
  2009. NULL;
  2010. if (new_map && new_map != map)
  2011. kfree(new_map);
  2012. }
  2013. }
  2014. mutex_unlock(&xps_map_mutex);
  2015. kfree(new_dev_maps);
  2016. return -ENOMEM;
  2017. }
  2018. EXPORT_SYMBOL(netif_set_xps_queue);
  2019. #endif
  2020. void netdev_reset_tc(struct net_device *dev)
  2021. {
  2022. #ifdef CONFIG_XPS
  2023. netif_reset_xps_queues_gt(dev, 0);
  2024. #endif
  2025. dev->num_tc = 0;
  2026. memset(dev->tc_to_txq, 0, sizeof(dev->tc_to_txq));
  2027. memset(dev->prio_tc_map, 0, sizeof(dev->prio_tc_map));
  2028. }
  2029. EXPORT_SYMBOL(netdev_reset_tc);
  2030. int netdev_set_tc_queue(struct net_device *dev, u8 tc, u16 count, u16 offset)
  2031. {
  2032. if (tc >= dev->num_tc)
  2033. return -EINVAL;
  2034. #ifdef CONFIG_XPS
  2035. netif_reset_xps_queues(dev, offset, count);
  2036. #endif
  2037. dev->tc_to_txq[tc].count = count;
  2038. dev->tc_to_txq[tc].offset = offset;
  2039. return 0;
  2040. }
  2041. EXPORT_SYMBOL(netdev_set_tc_queue);
  2042. int netdev_set_num_tc(struct net_device *dev, u8 num_tc)
  2043. {
  2044. if (num_tc > TC_MAX_QUEUE)
  2045. return -EINVAL;
  2046. #ifdef CONFIG_XPS
  2047. netif_reset_xps_queues_gt(dev, 0);
  2048. #endif
  2049. dev->num_tc = num_tc;
  2050. return 0;
  2051. }
  2052. EXPORT_SYMBOL(netdev_set_num_tc);
  2053. /*
  2054. * Routine to help set real_num_tx_queues. To avoid skbs mapped to queues
  2055. * greater than real_num_tx_queues stale skbs on the qdisc must be flushed.
  2056. */
  2057. int netif_set_real_num_tx_queues(struct net_device *dev, unsigned int txq)
  2058. {
  2059. bool disabling;
  2060. int rc;
  2061. disabling = txq < dev->real_num_tx_queues;
  2062. if (txq < 1 || txq > dev->num_tx_queues)
  2063. return -EINVAL;
  2064. if (dev->reg_state == NETREG_REGISTERED ||
  2065. dev->reg_state == NETREG_UNREGISTERING) {
  2066. ASSERT_RTNL();
  2067. rc = netdev_queue_update_kobjects(dev, dev->real_num_tx_queues,
  2068. txq);
  2069. if (rc)
  2070. return rc;
  2071. if (dev->num_tc)
  2072. netif_setup_tc(dev, txq);
  2073. dev->real_num_tx_queues = txq;
  2074. if (disabling) {
  2075. synchronize_net();
  2076. qdisc_reset_all_tx_gt(dev, txq);
  2077. #ifdef CONFIG_XPS
  2078. netif_reset_xps_queues_gt(dev, txq);
  2079. #endif
  2080. }
  2081. } else {
  2082. dev->real_num_tx_queues = txq;
  2083. }
  2084. return 0;
  2085. }
  2086. EXPORT_SYMBOL(netif_set_real_num_tx_queues);
  2087. #ifdef CONFIG_SYSFS
  2088. /**
  2089. * netif_set_real_num_rx_queues - set actual number of RX queues used
  2090. * @dev: Network device
  2091. * @rxq: Actual number of RX queues
  2092. *
  2093. * This must be called either with the rtnl_lock held or before
  2094. * registration of the net device. Returns 0 on success, or a
  2095. * negative error code. If called before registration, it always
  2096. * succeeds.
  2097. */
  2098. int netif_set_real_num_rx_queues(struct net_device *dev, unsigned int rxq)
  2099. {
  2100. int rc;
  2101. if (rxq < 1 || rxq > dev->num_rx_queues)
  2102. return -EINVAL;
  2103. if (dev->reg_state == NETREG_REGISTERED) {
  2104. ASSERT_RTNL();
  2105. rc = net_rx_queue_update_kobjects(dev, dev->real_num_rx_queues,
  2106. rxq);
  2107. if (rc)
  2108. return rc;
  2109. }
  2110. dev->real_num_rx_queues = rxq;
  2111. return 0;
  2112. }
  2113. EXPORT_SYMBOL(netif_set_real_num_rx_queues);
  2114. #endif
  2115. /**
  2116. * netif_get_num_default_rss_queues - default number of RSS queues
  2117. *
  2118. * This routine should set an upper limit on the number of RSS queues
  2119. * used by default by multiqueue devices.
  2120. */
  2121. int netif_get_num_default_rss_queues(void)
  2122. {
  2123. return is_kdump_kernel() ?
  2124. 1 : min_t(int, DEFAULT_MAX_NUM_RSS_QUEUES, num_online_cpus());
  2125. }
  2126. EXPORT_SYMBOL(netif_get_num_default_rss_queues);
  2127. static void __netif_reschedule(struct Qdisc *q)
  2128. {
  2129. struct softnet_data *sd;
  2130. unsigned long flags;
  2131. local_irq_save(flags);
  2132. sd = this_cpu_ptr(&softnet_data);
  2133. q->next_sched = NULL;
  2134. *sd->output_queue_tailp = q;
  2135. sd->output_queue_tailp = &q->next_sched;
  2136. raise_softirq_irqoff(NET_TX_SOFTIRQ);
  2137. local_irq_restore(flags);
  2138. }
  2139. void __netif_schedule(struct Qdisc *q)
  2140. {
  2141. if (!test_and_set_bit(__QDISC_STATE_SCHED, &q->state))
  2142. __netif_reschedule(q);
  2143. }
  2144. EXPORT_SYMBOL(__netif_schedule);
  2145. struct dev_kfree_skb_cb {
  2146. enum skb_free_reason reason;
  2147. };
  2148. static struct dev_kfree_skb_cb *get_kfree_skb_cb(const struct sk_buff *skb)
  2149. {
  2150. return (struct dev_kfree_skb_cb *)skb->cb;
  2151. }
  2152. void netif_schedule_queue(struct netdev_queue *txq)
  2153. {
  2154. rcu_read_lock();
  2155. if (!(txq->state & QUEUE_STATE_ANY_XOFF)) {
  2156. struct Qdisc *q = rcu_dereference(txq->qdisc);
  2157. __netif_schedule(q);
  2158. }
  2159. rcu_read_unlock();
  2160. }
  2161. EXPORT_SYMBOL(netif_schedule_queue);
  2162. void netif_tx_wake_queue(struct netdev_queue *dev_queue)
  2163. {
  2164. if (test_and_clear_bit(__QUEUE_STATE_DRV_XOFF, &dev_queue->state)) {
  2165. struct Qdisc *q;
  2166. rcu_read_lock();
  2167. q = rcu_dereference(dev_queue->qdisc);
  2168. __netif_schedule(q);
  2169. rcu_read_unlock();
  2170. }
  2171. }
  2172. EXPORT_SYMBOL(netif_tx_wake_queue);
  2173. void __dev_kfree_skb_irq(struct sk_buff *skb, enum skb_free_reason reason)
  2174. {
  2175. unsigned long flags;
  2176. if (unlikely(!skb))
  2177. return;
  2178. if (likely(refcount_read(&skb->users) == 1)) {
  2179. smp_rmb();
  2180. refcount_set(&skb->users, 0);
  2181. } else if (likely(!refcount_dec_and_test(&skb->users))) {
  2182. return;
  2183. }
  2184. get_kfree_skb_cb(skb)->reason = reason;
  2185. local_irq_save(flags);
  2186. skb->next = __this_cpu_read(softnet_data.completion_queue);
  2187. __this_cpu_write(softnet_data.completion_queue, skb);
  2188. raise_softirq_irqoff(NET_TX_SOFTIRQ);
  2189. local_irq_restore(flags);
  2190. }
  2191. EXPORT_SYMBOL(__dev_kfree_skb_irq);
  2192. void __dev_kfree_skb_any(struct sk_buff *skb, enum skb_free_reason reason)
  2193. {
  2194. if (in_irq() || irqs_disabled())
  2195. __dev_kfree_skb_irq(skb, reason);
  2196. else
  2197. dev_kfree_skb(skb);
  2198. }
  2199. EXPORT_SYMBOL(__dev_kfree_skb_any);
  2200. /**
  2201. * netif_device_detach - mark device as removed
  2202. * @dev: network device
  2203. *
  2204. * Mark device as removed from system and therefore no longer available.
  2205. */
  2206. void netif_device_detach(struct net_device *dev)
  2207. {
  2208. if (test_and_clear_bit(__LINK_STATE_PRESENT, &dev->state) &&
  2209. netif_running(dev)) {
  2210. netif_tx_stop_all_queues(dev);
  2211. }
  2212. }
  2213. EXPORT_SYMBOL(netif_device_detach);
  2214. /**
  2215. * netif_device_attach - mark device as attached
  2216. * @dev: network device
  2217. *
  2218. * Mark device as attached from system and restart if needed.
  2219. */
  2220. void netif_device_attach(struct net_device *dev)
  2221. {
  2222. if (!test_and_set_bit(__LINK_STATE_PRESENT, &dev->state) &&
  2223. netif_running(dev)) {
  2224. netif_tx_wake_all_queues(dev);
  2225. __netdev_watchdog_up(dev);
  2226. }
  2227. }
  2228. EXPORT_SYMBOL(netif_device_attach);
  2229. /*
  2230. * Returns a Tx hash based on the given packet descriptor a Tx queues' number
  2231. * to be used as a distribution range.
  2232. */
  2233. u16 __skb_tx_hash(const struct net_device *dev, struct sk_buff *skb,
  2234. unsigned int num_tx_queues)
  2235. {
  2236. u32 hash;
  2237. u16 qoffset = 0;
  2238. u16 qcount = num_tx_queues;
  2239. if (skb_rx_queue_recorded(skb)) {
  2240. hash = skb_get_rx_queue(skb);
  2241. while (unlikely(hash >= num_tx_queues))
  2242. hash -= num_tx_queues;
  2243. return hash;
  2244. }
  2245. if (dev->num_tc) {
  2246. u8 tc = netdev_get_prio_tc_map(dev, skb->priority);
  2247. qoffset = dev->tc_to_txq[tc].offset;
  2248. qcount = dev->tc_to_txq[tc].count;
  2249. }
  2250. return (u16) reciprocal_scale(skb_get_hash(skb), qcount) + qoffset;
  2251. }
  2252. EXPORT_SYMBOL(__skb_tx_hash);
  2253. static void skb_warn_bad_offload(const struct sk_buff *skb)
  2254. {
  2255. static const netdev_features_t null_features;
  2256. struct net_device *dev = skb->dev;
  2257. const char *name = "";
  2258. if (!net_ratelimit())
  2259. return;
  2260. if (dev) {
  2261. if (dev->dev.parent)
  2262. name = dev_driver_string(dev->dev.parent);
  2263. else
  2264. name = netdev_name(dev);
  2265. }
  2266. WARN(1, "%s: caps=(%pNF, %pNF) len=%d data_len=%d gso_size=%d "
  2267. "gso_type=%d ip_summed=%d\n",
  2268. name, dev ? &dev->features : &null_features,
  2269. skb->sk ? &skb->sk->sk_route_caps : &null_features,
  2270. skb->len, skb->data_len, skb_shinfo(skb)->gso_size,
  2271. skb_shinfo(skb)->gso_type, skb->ip_summed);
  2272. }
  2273. /*
  2274. * Invalidate hardware checksum when packet is to be mangled, and
  2275. * complete checksum manually on outgoing path.
  2276. */
  2277. int skb_checksum_help(struct sk_buff *skb)
  2278. {
  2279. __wsum csum;
  2280. int ret = 0, offset;
  2281. if (skb->ip_summed == CHECKSUM_COMPLETE)
  2282. goto out_set_summed;
  2283. if (unlikely(skb_shinfo(skb)->gso_size)) {
  2284. skb_warn_bad_offload(skb);
  2285. return -EINVAL;
  2286. }
  2287. /* Before computing a checksum, we should make sure no frag could
  2288. * be modified by an external entity : checksum could be wrong.
  2289. */
  2290. if (skb_has_shared_frag(skb)) {
  2291. ret = __skb_linearize(skb);
  2292. if (ret)
  2293. goto out;
  2294. }
  2295. offset = skb_checksum_start_offset(skb);
  2296. BUG_ON(offset >= skb_headlen(skb));
  2297. csum = skb_checksum(skb, offset, skb->len - offset, 0);
  2298. offset += skb->csum_offset;
  2299. BUG_ON(offset + sizeof(__sum16) > skb_headlen(skb));
  2300. if (skb_cloned(skb) &&
  2301. !skb_clone_writable(skb, offset + sizeof(__sum16))) {
  2302. ret = pskb_expand_head(skb, 0, 0, GFP_ATOMIC);
  2303. if (ret)
  2304. goto out;
  2305. }
  2306. *(__sum16 *)(skb->data + offset) = csum_fold(csum) ?: CSUM_MANGLED_0;
  2307. out_set_summed:
  2308. skb->ip_summed = CHECKSUM_NONE;
  2309. out:
  2310. return ret;
  2311. }
  2312. EXPORT_SYMBOL(skb_checksum_help);
  2313. int skb_crc32c_csum_help(struct sk_buff *skb)
  2314. {
  2315. __le32 crc32c_csum;
  2316. int ret = 0, offset, start;
  2317. if (skb->ip_summed != CHECKSUM_PARTIAL)
  2318. goto out;
  2319. if (unlikely(skb_is_gso(skb)))
  2320. goto out;
  2321. /* Before computing a checksum, we should make sure no frag could
  2322. * be modified by an external entity : checksum could be wrong.
  2323. */
  2324. if (unlikely(skb_has_shared_frag(skb))) {
  2325. ret = __skb_linearize(skb);
  2326. if (ret)
  2327. goto out;
  2328. }
  2329. start = skb_checksum_start_offset(skb);
  2330. offset = start + offsetof(struct sctphdr, checksum);
  2331. if (WARN_ON_ONCE(offset >= skb_headlen(skb))) {
  2332. ret = -EINVAL;
  2333. goto out;
  2334. }
  2335. if (skb_cloned(skb) &&
  2336. !skb_clone_writable(skb, offset + sizeof(__le32))) {
  2337. ret = pskb_expand_head(skb, 0, 0, GFP_ATOMIC);
  2338. if (ret)
  2339. goto out;
  2340. }
  2341. crc32c_csum = cpu_to_le32(~__skb_checksum(skb, start,
  2342. skb->len - start, ~(__u32)0,
  2343. crc32c_csum_stub));
  2344. *(__le32 *)(skb->data + offset) = crc32c_csum;
  2345. skb->ip_summed = CHECKSUM_NONE;
  2346. skb->csum_not_inet = 0;
  2347. out:
  2348. return ret;
  2349. }
  2350. __be16 skb_network_protocol(struct sk_buff *skb, int *depth)
  2351. {
  2352. __be16 type = skb->protocol;
  2353. /* Tunnel gso handlers can set protocol to ethernet. */
  2354. if (type == htons(ETH_P_TEB)) {
  2355. struct ethhdr *eth;
  2356. if (unlikely(!pskb_may_pull(skb, sizeof(struct ethhdr))))
  2357. return 0;
  2358. eth = (struct ethhdr *)skb->data;
  2359. type = eth->h_proto;
  2360. }
  2361. return __vlan_get_protocol(skb, type, depth);
  2362. }
  2363. /**
  2364. * skb_mac_gso_segment - mac layer segmentation handler.
  2365. * @skb: buffer to segment
  2366. * @features: features for the output path (see dev->features)
  2367. */
  2368. struct sk_buff *skb_mac_gso_segment(struct sk_buff *skb,
  2369. netdev_features_t features)
  2370. {
  2371. struct sk_buff *segs = ERR_PTR(-EPROTONOSUPPORT);
  2372. struct packet_offload *ptype;
  2373. int vlan_depth = skb->mac_len;
  2374. __be16 type = skb_network_protocol(skb, &vlan_depth);
  2375. if (unlikely(!type))
  2376. return ERR_PTR(-EINVAL);
  2377. __skb_pull(skb, vlan_depth);
  2378. rcu_read_lock();
  2379. list_for_each_entry_rcu(ptype, &offload_base, list) {
  2380. if (ptype->type == type && ptype->callbacks.gso_segment) {
  2381. segs = ptype->callbacks.gso_segment(skb, features);
  2382. break;
  2383. }
  2384. }
  2385. rcu_read_unlock();
  2386. __skb_push(skb, skb->data - skb_mac_header(skb));
  2387. return segs;
  2388. }
  2389. EXPORT_SYMBOL(skb_mac_gso_segment);
  2390. /* openvswitch calls this on rx path, so we need a different check.
  2391. */
  2392. static inline bool skb_needs_check(struct sk_buff *skb, bool tx_path)
  2393. {
  2394. if (tx_path)
  2395. return skb->ip_summed != CHECKSUM_PARTIAL &&
  2396. skb->ip_summed != CHECKSUM_UNNECESSARY;
  2397. return skb->ip_summed == CHECKSUM_NONE;
  2398. }
  2399. /**
  2400. * __skb_gso_segment - Perform segmentation on skb.
  2401. * @skb: buffer to segment
  2402. * @features: features for the output path (see dev->features)
  2403. * @tx_path: whether it is called in TX path
  2404. *
  2405. * This function segments the given skb and returns a list of segments.
  2406. *
  2407. * It may return NULL if the skb requires no segmentation. This is
  2408. * only possible when GSO is used for verifying header integrity.
  2409. *
  2410. * Segmentation preserves SKB_SGO_CB_OFFSET bytes of previous skb cb.
  2411. */
  2412. struct sk_buff *__skb_gso_segment(struct sk_buff *skb,
  2413. netdev_features_t features, bool tx_path)
  2414. {
  2415. struct sk_buff *segs;
  2416. if (unlikely(skb_needs_check(skb, tx_path))) {
  2417. int err;
  2418. /* We're going to init ->check field in TCP or UDP header */
  2419. err = skb_cow_head(skb, 0);
  2420. if (err < 0)
  2421. return ERR_PTR(err);
  2422. }
  2423. /* Only report GSO partial support if it will enable us to
  2424. * support segmentation on this frame without needing additional
  2425. * work.
  2426. */
  2427. if (features & NETIF_F_GSO_PARTIAL) {
  2428. netdev_features_t partial_features = NETIF_F_GSO_ROBUST;
  2429. struct net_device *dev = skb->dev;
  2430. partial_features |= dev->features & dev->gso_partial_features;
  2431. if (!skb_gso_ok(skb, features | partial_features))
  2432. features &= ~NETIF_F_GSO_PARTIAL;
  2433. }
  2434. BUILD_BUG_ON(SKB_SGO_CB_OFFSET +
  2435. sizeof(*SKB_GSO_CB(skb)) > sizeof(skb->cb));
  2436. SKB_GSO_CB(skb)->mac_offset = skb_headroom(skb);
  2437. SKB_GSO_CB(skb)->encap_level = 0;
  2438. skb_reset_mac_header(skb);
  2439. skb_reset_mac_len(skb);
  2440. segs = skb_mac_gso_segment(skb, features);
  2441. if (unlikely(skb_needs_check(skb, tx_path) && !IS_ERR(segs)))
  2442. skb_warn_bad_offload(skb);
  2443. return segs;
  2444. }
  2445. EXPORT_SYMBOL(__skb_gso_segment);
  2446. /* Take action when hardware reception checksum errors are detected. */
  2447. #ifdef CONFIG_BUG
  2448. void netdev_rx_csum_fault(struct net_device *dev)
  2449. {
  2450. if (net_ratelimit()) {
  2451. pr_err("%s: hw csum failure\n", dev ? dev->name : "<unknown>");
  2452. dump_stack();
  2453. }
  2454. }
  2455. EXPORT_SYMBOL(netdev_rx_csum_fault);
  2456. #endif
  2457. /* Actually, we should eliminate this check as soon as we know, that:
  2458. * 1. IOMMU is present and allows to map all the memory.
  2459. * 2. No high memory really exists on this machine.
  2460. */
  2461. static int illegal_highdma(struct net_device *dev, struct sk_buff *skb)
  2462. {
  2463. #ifdef CONFIG_HIGHMEM
  2464. int i;
  2465. if (!(dev->features & NETIF_F_HIGHDMA)) {
  2466. for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
  2467. skb_frag_t *frag = &skb_shinfo(skb)->frags[i];
  2468. if (PageHighMem(skb_frag_page(frag)))
  2469. return 1;
  2470. }
  2471. }
  2472. if (PCI_DMA_BUS_IS_PHYS) {
  2473. struct device *pdev = dev->dev.parent;
  2474. if (!pdev)
  2475. return 0;
  2476. for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
  2477. skb_frag_t *frag = &skb_shinfo(skb)->frags[i];
  2478. dma_addr_t addr = page_to_phys(skb_frag_page(frag));
  2479. if (!pdev->dma_mask || addr + PAGE_SIZE - 1 > *pdev->dma_mask)
  2480. return 1;
  2481. }
  2482. }
  2483. #endif
  2484. return 0;
  2485. }
  2486. /* If MPLS offload request, verify we are testing hardware MPLS features
  2487. * instead of standard features for the netdev.
  2488. */
  2489. #if IS_ENABLED(CONFIG_NET_MPLS_GSO)
  2490. static netdev_features_t net_mpls_features(struct sk_buff *skb,
  2491. netdev_features_t features,
  2492. __be16 type)
  2493. {
  2494. if (eth_p_mpls(type))
  2495. features &= skb->dev->mpls_features;
  2496. return features;
  2497. }
  2498. #else
  2499. static netdev_features_t net_mpls_features(struct sk_buff *skb,
  2500. netdev_features_t features,
  2501. __be16 type)
  2502. {
  2503. return features;
  2504. }
  2505. #endif
  2506. static netdev_features_t harmonize_features(struct sk_buff *skb,
  2507. netdev_features_t features)
  2508. {
  2509. int tmp;
  2510. __be16 type;
  2511. type = skb_network_protocol(skb, &tmp);
  2512. features = net_mpls_features(skb, features, type);
  2513. if (skb->ip_summed != CHECKSUM_NONE &&
  2514. !can_checksum_protocol(features, type)) {
  2515. features &= ~(NETIF_F_CSUM_MASK | NETIF_F_GSO_MASK);
  2516. }
  2517. if (illegal_highdma(skb->dev, skb))
  2518. features &= ~NETIF_F_SG;
  2519. return features;
  2520. }
  2521. netdev_features_t passthru_features_check(struct sk_buff *skb,
  2522. struct net_device *dev,
  2523. netdev_features_t features)
  2524. {
  2525. return features;
  2526. }
  2527. EXPORT_SYMBOL(passthru_features_check);
  2528. static netdev_features_t dflt_features_check(struct sk_buff *skb,
  2529. struct net_device *dev,
  2530. netdev_features_t features)
  2531. {
  2532. return vlan_features_check(skb, features);
  2533. }
  2534. static netdev_features_t gso_features_check(const struct sk_buff *skb,
  2535. struct net_device *dev,
  2536. netdev_features_t features)
  2537. {
  2538. u16 gso_segs = skb_shinfo(skb)->gso_segs;
  2539. if (gso_segs > dev->gso_max_segs)
  2540. return features & ~NETIF_F_GSO_MASK;
  2541. /* Support for GSO partial features requires software
  2542. * intervention before we can actually process the packets
  2543. * so we need to strip support for any partial features now
  2544. * and we can pull them back in after we have partially
  2545. * segmented the frame.
  2546. */
  2547. if (!(skb_shinfo(skb)->gso_type & SKB_GSO_PARTIAL))
  2548. features &= ~dev->gso_partial_features;
  2549. /* Make sure to clear the IPv4 ID mangling feature if the
  2550. * IPv4 header has the potential to be fragmented.
  2551. */
  2552. if (skb_shinfo(skb)->gso_type & SKB_GSO_TCPV4) {
  2553. struct iphdr *iph = skb->encapsulation ?
  2554. inner_ip_hdr(skb) : ip_hdr(skb);
  2555. if (!(iph->frag_off & htons(IP_DF)))
  2556. features &= ~NETIF_F_TSO_MANGLEID;
  2557. }
  2558. return features;
  2559. }
  2560. netdev_features_t netif_skb_features(struct sk_buff *skb)
  2561. {
  2562. struct net_device *dev = skb->dev;
  2563. netdev_features_t features = dev->features;
  2564. if (skb_is_gso(skb))
  2565. features = gso_features_check(skb, dev, features);
  2566. /* If encapsulation offload request, verify we are testing
  2567. * hardware encapsulation features instead of standard
  2568. * features for the netdev
  2569. */
  2570. if (skb->encapsulation)
  2571. features &= dev->hw_enc_features;
  2572. if (skb_vlan_tagged(skb))
  2573. features = netdev_intersect_features(features,
  2574. dev->vlan_features |
  2575. NETIF_F_HW_VLAN_CTAG_TX |
  2576. NETIF_F_HW_VLAN_STAG_TX);
  2577. if (dev->netdev_ops->ndo_features_check)
  2578. features &= dev->netdev_ops->ndo_features_check(skb, dev,
  2579. features);
  2580. else
  2581. features &= dflt_features_check(skb, dev, features);
  2582. return harmonize_features(skb, features);
  2583. }
  2584. EXPORT_SYMBOL(netif_skb_features);
  2585. static int xmit_one(struct sk_buff *skb, struct net_device *dev,
  2586. struct netdev_queue *txq, bool more)
  2587. {
  2588. unsigned int len;
  2589. int rc;
  2590. if (!list_empty(&ptype_all) || !list_empty(&dev->ptype_all))
  2591. dev_queue_xmit_nit(skb, dev);
  2592. len = skb->len;
  2593. trace_net_dev_start_xmit(skb, dev);
  2594. rc = netdev_start_xmit(skb, dev, txq, more);
  2595. trace_net_dev_xmit(skb, rc, dev, len);
  2596. return rc;
  2597. }
  2598. struct sk_buff *dev_hard_start_xmit(struct sk_buff *first, struct net_device *dev,
  2599. struct netdev_queue *txq, int *ret)
  2600. {
  2601. struct sk_buff *skb = first;
  2602. int rc = NETDEV_TX_OK;
  2603. while (skb) {
  2604. struct sk_buff *next = skb->next;
  2605. skb->next = NULL;
  2606. rc = xmit_one(skb, dev, txq, next != NULL);
  2607. if (unlikely(!dev_xmit_complete(rc))) {
  2608. skb->next = next;
  2609. goto out;
  2610. }
  2611. skb = next;
  2612. if (netif_xmit_stopped(txq) && skb) {
  2613. rc = NETDEV_TX_BUSY;
  2614. break;
  2615. }
  2616. }
  2617. out:
  2618. *ret = rc;
  2619. return skb;
  2620. }
  2621. static struct sk_buff *validate_xmit_vlan(struct sk_buff *skb,
  2622. netdev_features_t features)
  2623. {
  2624. if (skb_vlan_tag_present(skb) &&
  2625. !vlan_hw_offload_capable(features, skb->vlan_proto))
  2626. skb = __vlan_hwaccel_push_inside(skb);
  2627. return skb;
  2628. }
  2629. int skb_csum_hwoffload_help(struct sk_buff *skb,
  2630. const netdev_features_t features)
  2631. {
  2632. if (unlikely(skb->csum_not_inet))
  2633. return !!(features & NETIF_F_SCTP_CRC) ? 0 :
  2634. skb_crc32c_csum_help(skb);
  2635. return !!(features & NETIF_F_CSUM_MASK) ? 0 : skb_checksum_help(skb);
  2636. }
  2637. EXPORT_SYMBOL(skb_csum_hwoffload_help);
  2638. static struct sk_buff *validate_xmit_skb(struct sk_buff *skb, struct net_device *dev, bool *again)
  2639. {
  2640. netdev_features_t features;
  2641. features = netif_skb_features(skb);
  2642. skb = validate_xmit_vlan(skb, features);
  2643. if (unlikely(!skb))
  2644. goto out_null;
  2645. if (netif_needs_gso(skb, features)) {
  2646. struct sk_buff *segs;
  2647. segs = skb_gso_segment(skb, features);
  2648. if (IS_ERR(segs)) {
  2649. goto out_kfree_skb;
  2650. } else if (segs) {
  2651. consume_skb(skb);
  2652. skb = segs;
  2653. }
  2654. } else {
  2655. if (skb_needs_linearize(skb, features) &&
  2656. __skb_linearize(skb))
  2657. goto out_kfree_skb;
  2658. /* If packet is not checksummed and device does not
  2659. * support checksumming for this protocol, complete
  2660. * checksumming here.
  2661. */
  2662. if (skb->ip_summed == CHECKSUM_PARTIAL) {
  2663. if (skb->encapsulation)
  2664. skb_set_inner_transport_header(skb,
  2665. skb_checksum_start_offset(skb));
  2666. else
  2667. skb_set_transport_header(skb,
  2668. skb_checksum_start_offset(skb));
  2669. if (skb_csum_hwoffload_help(skb, features))
  2670. goto out_kfree_skb;
  2671. }
  2672. }
  2673. skb = validate_xmit_xfrm(skb, features, again);
  2674. return skb;
  2675. out_kfree_skb:
  2676. kfree_skb(skb);
  2677. out_null:
  2678. atomic_long_inc(&dev->tx_dropped);
  2679. return NULL;
  2680. }
  2681. struct sk_buff *validate_xmit_skb_list(struct sk_buff *skb, struct net_device *dev, bool *again)
  2682. {
  2683. struct sk_buff *next, *head = NULL, *tail;
  2684. for (; skb != NULL; skb = next) {
  2685. next = skb->next;
  2686. skb->next = NULL;
  2687. /* in case skb wont be segmented, point to itself */
  2688. skb->prev = skb;
  2689. skb = validate_xmit_skb(skb, dev, again);
  2690. if (!skb)
  2691. continue;
  2692. if (!head)
  2693. head = skb;
  2694. else
  2695. tail->next = skb;
  2696. /* If skb was segmented, skb->prev points to
  2697. * the last segment. If not, it still contains skb.
  2698. */
  2699. tail = skb->prev;
  2700. }
  2701. return head;
  2702. }
  2703. EXPORT_SYMBOL_GPL(validate_xmit_skb_list);
  2704. static void qdisc_pkt_len_init(struct sk_buff *skb)
  2705. {
  2706. const struct skb_shared_info *shinfo = skb_shinfo(skb);
  2707. qdisc_skb_cb(skb)->pkt_len = skb->len;
  2708. /* To get more precise estimation of bytes sent on wire,
  2709. * we add to pkt_len the headers size of all segments
  2710. */
  2711. if (shinfo->gso_size) {
  2712. unsigned int hdr_len;
  2713. u16 gso_segs = shinfo->gso_segs;
  2714. /* mac layer + network layer */
  2715. hdr_len = skb_transport_header(skb) - skb_mac_header(skb);
  2716. /* + transport layer */
  2717. if (likely(shinfo->gso_type & (SKB_GSO_TCPV4 | SKB_GSO_TCPV6))) {
  2718. const struct tcphdr *th;
  2719. struct tcphdr _tcphdr;
  2720. th = skb_header_pointer(skb, skb_transport_offset(skb),
  2721. sizeof(_tcphdr), &_tcphdr);
  2722. if (likely(th))
  2723. hdr_len += __tcp_hdrlen(th);
  2724. } else {
  2725. struct udphdr _udphdr;
  2726. if (skb_header_pointer(skb, skb_transport_offset(skb),
  2727. sizeof(_udphdr), &_udphdr))
  2728. hdr_len += sizeof(struct udphdr);
  2729. }
  2730. if (shinfo->gso_type & SKB_GSO_DODGY)
  2731. gso_segs = DIV_ROUND_UP(skb->len - hdr_len,
  2732. shinfo->gso_size);
  2733. qdisc_skb_cb(skb)->pkt_len += (gso_segs - 1) * hdr_len;
  2734. }
  2735. }
  2736. static inline int __dev_xmit_skb(struct sk_buff *skb, struct Qdisc *q,
  2737. struct net_device *dev,
  2738. struct netdev_queue *txq)
  2739. {
  2740. spinlock_t *root_lock = qdisc_lock(q);
  2741. struct sk_buff *to_free = NULL;
  2742. bool contended;
  2743. int rc;
  2744. qdisc_calculate_pkt_len(skb, q);
  2745. if (q->flags & TCQ_F_NOLOCK) {
  2746. if (unlikely(test_bit(__QDISC_STATE_DEACTIVATED, &q->state))) {
  2747. __qdisc_drop(skb, &to_free);
  2748. rc = NET_XMIT_DROP;
  2749. } else {
  2750. rc = q->enqueue(skb, q, &to_free) & NET_XMIT_MASK;
  2751. __qdisc_run(q);
  2752. }
  2753. if (unlikely(to_free))
  2754. kfree_skb_list(to_free);
  2755. return rc;
  2756. }
  2757. /*
  2758. * Heuristic to force contended enqueues to serialize on a
  2759. * separate lock before trying to get qdisc main lock.
  2760. * This permits qdisc->running owner to get the lock more
  2761. * often and dequeue packets faster.
  2762. */
  2763. contended = qdisc_is_running(q);
  2764. if (unlikely(contended))
  2765. spin_lock(&q->busylock);
  2766. spin_lock(root_lock);
  2767. if (unlikely(test_bit(__QDISC_STATE_DEACTIVATED, &q->state))) {
  2768. __qdisc_drop(skb, &to_free);
  2769. rc = NET_XMIT_DROP;
  2770. } else if ((q->flags & TCQ_F_CAN_BYPASS) && !qdisc_qlen(q) &&
  2771. qdisc_run_begin(q)) {
  2772. /*
  2773. * This is a work-conserving queue; there are no old skbs
  2774. * waiting to be sent out; and the qdisc is not running -
  2775. * xmit the skb directly.
  2776. */
  2777. qdisc_bstats_update(q, skb);
  2778. if (sch_direct_xmit(skb, q, dev, txq, root_lock, true)) {
  2779. if (unlikely(contended)) {
  2780. spin_unlock(&q->busylock);
  2781. contended = false;
  2782. }
  2783. __qdisc_run(q);
  2784. }
  2785. qdisc_run_end(q);
  2786. rc = NET_XMIT_SUCCESS;
  2787. } else {
  2788. rc = q->enqueue(skb, q, &to_free) & NET_XMIT_MASK;
  2789. if (qdisc_run_begin(q)) {
  2790. if (unlikely(contended)) {
  2791. spin_unlock(&q->busylock);
  2792. contended = false;
  2793. }
  2794. __qdisc_run(q);
  2795. qdisc_run_end(q);
  2796. }
  2797. }
  2798. spin_unlock(root_lock);
  2799. if (unlikely(to_free))
  2800. kfree_skb_list(to_free);
  2801. if (unlikely(contended))
  2802. spin_unlock(&q->busylock);
  2803. return rc;
  2804. }
  2805. #if IS_ENABLED(CONFIG_CGROUP_NET_PRIO)
  2806. static void skb_update_prio(struct sk_buff *skb)
  2807. {
  2808. const struct netprio_map *map;
  2809. const struct sock *sk;
  2810. unsigned int prioidx;
  2811. if (skb->priority)
  2812. return;
  2813. map = rcu_dereference_bh(skb->dev->priomap);
  2814. if (!map)
  2815. return;
  2816. sk = skb_to_full_sk(skb);
  2817. if (!sk)
  2818. return;
  2819. prioidx = sock_cgroup_prioidx(&sk->sk_cgrp_data);
  2820. if (prioidx < map->priomap_len)
  2821. skb->priority = map->priomap[prioidx];
  2822. }
  2823. #else
  2824. #define skb_update_prio(skb)
  2825. #endif
  2826. DEFINE_PER_CPU(int, xmit_recursion);
  2827. EXPORT_SYMBOL(xmit_recursion);
  2828. /**
  2829. * dev_loopback_xmit - loop back @skb
  2830. * @net: network namespace this loopback is happening in
  2831. * @sk: sk needed to be a netfilter okfn
  2832. * @skb: buffer to transmit
  2833. */
  2834. int dev_loopback_xmit(struct net *net, struct sock *sk, struct sk_buff *skb)
  2835. {
  2836. skb_reset_mac_header(skb);
  2837. __skb_pull(skb, skb_network_offset(skb));
  2838. skb->pkt_type = PACKET_LOOPBACK;
  2839. skb->ip_summed = CHECKSUM_UNNECESSARY;
  2840. WARN_ON(!skb_dst(skb));
  2841. skb_dst_force(skb);
  2842. netif_rx_ni(skb);
  2843. return 0;
  2844. }
  2845. EXPORT_SYMBOL(dev_loopback_xmit);
  2846. #ifdef CONFIG_NET_EGRESS
  2847. static struct sk_buff *
  2848. sch_handle_egress(struct sk_buff *skb, int *ret, struct net_device *dev)
  2849. {
  2850. struct mini_Qdisc *miniq = rcu_dereference_bh(dev->miniq_egress);
  2851. struct tcf_result cl_res;
  2852. if (!miniq)
  2853. return skb;
  2854. /* qdisc_skb_cb(skb)->pkt_len was already set by the caller. */
  2855. mini_qdisc_bstats_cpu_update(miniq, skb);
  2856. switch (tcf_classify(skb, miniq->filter_list, &cl_res, false)) {
  2857. case TC_ACT_OK:
  2858. case TC_ACT_RECLASSIFY:
  2859. skb->tc_index = TC_H_MIN(cl_res.classid);
  2860. break;
  2861. case TC_ACT_SHOT:
  2862. mini_qdisc_qstats_cpu_drop(miniq);
  2863. *ret = NET_XMIT_DROP;
  2864. kfree_skb(skb);
  2865. return NULL;
  2866. case TC_ACT_STOLEN:
  2867. case TC_ACT_QUEUED:
  2868. case TC_ACT_TRAP:
  2869. *ret = NET_XMIT_SUCCESS;
  2870. consume_skb(skb);
  2871. return NULL;
  2872. case TC_ACT_REDIRECT:
  2873. /* No need to push/pop skb's mac_header here on egress! */
  2874. skb_do_redirect(skb);
  2875. *ret = NET_XMIT_SUCCESS;
  2876. return NULL;
  2877. default:
  2878. break;
  2879. }
  2880. return skb;
  2881. }
  2882. #endif /* CONFIG_NET_EGRESS */
  2883. static inline int get_xps_queue(struct net_device *dev, struct sk_buff *skb)
  2884. {
  2885. #ifdef CONFIG_XPS
  2886. struct xps_dev_maps *dev_maps;
  2887. struct xps_map *map;
  2888. int queue_index = -1;
  2889. rcu_read_lock();
  2890. dev_maps = rcu_dereference(dev->xps_maps);
  2891. if (dev_maps) {
  2892. unsigned int tci = skb->sender_cpu - 1;
  2893. if (dev->num_tc) {
  2894. tci *= dev->num_tc;
  2895. tci += netdev_get_prio_tc_map(dev, skb->priority);
  2896. }
  2897. map = rcu_dereference(dev_maps->cpu_map[tci]);
  2898. if (map) {
  2899. if (map->len == 1)
  2900. queue_index = map->queues[0];
  2901. else
  2902. queue_index = map->queues[reciprocal_scale(skb_get_hash(skb),
  2903. map->len)];
  2904. if (unlikely(queue_index >= dev->real_num_tx_queues))
  2905. queue_index = -1;
  2906. }
  2907. }
  2908. rcu_read_unlock();
  2909. return queue_index;
  2910. #else
  2911. return -1;
  2912. #endif
  2913. }
  2914. static u16 __netdev_pick_tx(struct net_device *dev, struct sk_buff *skb)
  2915. {
  2916. struct sock *sk = skb->sk;
  2917. int queue_index = sk_tx_queue_get(sk);
  2918. if (queue_index < 0 || skb->ooo_okay ||
  2919. queue_index >= dev->real_num_tx_queues) {
  2920. int new_index = get_xps_queue(dev, skb);
  2921. if (new_index < 0)
  2922. new_index = skb_tx_hash(dev, skb);
  2923. if (queue_index != new_index && sk &&
  2924. sk_fullsock(sk) &&
  2925. rcu_access_pointer(sk->sk_dst_cache))
  2926. sk_tx_queue_set(sk, new_index);
  2927. queue_index = new_index;
  2928. }
  2929. return queue_index;
  2930. }
  2931. struct netdev_queue *netdev_pick_tx(struct net_device *dev,
  2932. struct sk_buff *skb,
  2933. void *accel_priv)
  2934. {
  2935. int queue_index = 0;
  2936. #ifdef CONFIG_XPS
  2937. u32 sender_cpu = skb->sender_cpu - 1;
  2938. if (sender_cpu >= (u32)NR_CPUS)
  2939. skb->sender_cpu = raw_smp_processor_id() + 1;
  2940. #endif
  2941. if (dev->real_num_tx_queues != 1) {
  2942. const struct net_device_ops *ops = dev->netdev_ops;
  2943. if (ops->ndo_select_queue)
  2944. queue_index = ops->ndo_select_queue(dev, skb, accel_priv,
  2945. __netdev_pick_tx);
  2946. else
  2947. queue_index = __netdev_pick_tx(dev, skb);
  2948. queue_index = netdev_cap_txqueue(dev, queue_index);
  2949. }
  2950. skb_set_queue_mapping(skb, queue_index);
  2951. return netdev_get_tx_queue(dev, queue_index);
  2952. }
  2953. /**
  2954. * __dev_queue_xmit - transmit a buffer
  2955. * @skb: buffer to transmit
  2956. * @accel_priv: private data used for L2 forwarding offload
  2957. *
  2958. * Queue a buffer for transmission to a network device. The caller must
  2959. * have set the device and priority and built the buffer before calling
  2960. * this function. The function can be called from an interrupt.
  2961. *
  2962. * A negative errno code is returned on a failure. A success does not
  2963. * guarantee the frame will be transmitted as it may be dropped due
  2964. * to congestion or traffic shaping.
  2965. *
  2966. * -----------------------------------------------------------------------------------
  2967. * I notice this method can also return errors from the queue disciplines,
  2968. * including NET_XMIT_DROP, which is a positive value. So, errors can also
  2969. * be positive.
  2970. *
  2971. * Regardless of the return value, the skb is consumed, so it is currently
  2972. * difficult to retry a send to this method. (You can bump the ref count
  2973. * before sending to hold a reference for retry if you are careful.)
  2974. *
  2975. * When calling this method, interrupts MUST be enabled. This is because
  2976. * the BH enable code must have IRQs enabled so that it will not deadlock.
  2977. * --BLG
  2978. */
  2979. static int __dev_queue_xmit(struct sk_buff *skb, void *accel_priv)
  2980. {
  2981. struct net_device *dev = skb->dev;
  2982. struct netdev_queue *txq;
  2983. struct Qdisc *q;
  2984. int rc = -ENOMEM;
  2985. bool again = false;
  2986. skb_reset_mac_header(skb);
  2987. if (unlikely(skb_shinfo(skb)->tx_flags & SKBTX_SCHED_TSTAMP))
  2988. __skb_tstamp_tx(skb, NULL, skb->sk, SCM_TSTAMP_SCHED);
  2989. /* Disable soft irqs for various locks below. Also
  2990. * stops preemption for RCU.
  2991. */
  2992. rcu_read_lock_bh();
  2993. skb_update_prio(skb);
  2994. qdisc_pkt_len_init(skb);
  2995. #ifdef CONFIG_NET_CLS_ACT
  2996. skb->tc_at_ingress = 0;
  2997. # ifdef CONFIG_NET_EGRESS
  2998. if (static_key_false(&egress_needed)) {
  2999. skb = sch_handle_egress(skb, &rc, dev);
  3000. if (!skb)
  3001. goto out;
  3002. }
  3003. # endif
  3004. #endif
  3005. /* If device/qdisc don't need skb->dst, release it right now while
  3006. * its hot in this cpu cache.
  3007. */
  3008. if (dev->priv_flags & IFF_XMIT_DST_RELEASE)
  3009. skb_dst_drop(skb);
  3010. else
  3011. skb_dst_force(skb);
  3012. txq = netdev_pick_tx(dev, skb, accel_priv);
  3013. q = rcu_dereference_bh(txq->qdisc);
  3014. trace_net_dev_queue(skb);
  3015. if (q->enqueue) {
  3016. rc = __dev_xmit_skb(skb, q, dev, txq);
  3017. goto out;
  3018. }
  3019. /* The device has no queue. Common case for software devices:
  3020. * loopback, all the sorts of tunnels...
  3021. * Really, it is unlikely that netif_tx_lock protection is necessary
  3022. * here. (f.e. loopback and IP tunnels are clean ignoring statistics
  3023. * counters.)
  3024. * However, it is possible, that they rely on protection
  3025. * made by us here.
  3026. * Check this and shot the lock. It is not prone from deadlocks.
  3027. *Either shot noqueue qdisc, it is even simpler 8)
  3028. */
  3029. if (dev->flags & IFF_UP) {
  3030. int cpu = smp_processor_id(); /* ok because BHs are off */
  3031. if (txq->xmit_lock_owner != cpu) {
  3032. if (unlikely(__this_cpu_read(xmit_recursion) >
  3033. XMIT_RECURSION_LIMIT))
  3034. goto recursion_alert;
  3035. skb = validate_xmit_skb(skb, dev, &again);
  3036. if (!skb)
  3037. goto out;
  3038. HARD_TX_LOCK(dev, txq, cpu);
  3039. if (!netif_xmit_stopped(txq)) {
  3040. __this_cpu_inc(xmit_recursion);
  3041. skb = dev_hard_start_xmit(skb, dev, txq, &rc);
  3042. __this_cpu_dec(xmit_recursion);
  3043. if (dev_xmit_complete(rc)) {
  3044. HARD_TX_UNLOCK(dev, txq);
  3045. goto out;
  3046. }
  3047. }
  3048. HARD_TX_UNLOCK(dev, txq);
  3049. net_crit_ratelimited("Virtual device %s asks to queue packet!\n",
  3050. dev->name);
  3051. } else {
  3052. /* Recursion is detected! It is possible,
  3053. * unfortunately
  3054. */
  3055. recursion_alert:
  3056. net_crit_ratelimited("Dead loop on virtual device %s, fix it urgently!\n",
  3057. dev->name);
  3058. }
  3059. }
  3060. rc = -ENETDOWN;
  3061. rcu_read_unlock_bh();
  3062. atomic_long_inc(&dev->tx_dropped);
  3063. kfree_skb_list(skb);
  3064. return rc;
  3065. out:
  3066. rcu_read_unlock_bh();
  3067. return rc;
  3068. }
  3069. int dev_queue_xmit(struct sk_buff *skb)
  3070. {
  3071. return __dev_queue_xmit(skb, NULL);
  3072. }
  3073. EXPORT_SYMBOL(dev_queue_xmit);
  3074. int dev_queue_xmit_accel(struct sk_buff *skb, void *accel_priv)
  3075. {
  3076. return __dev_queue_xmit(skb, accel_priv);
  3077. }
  3078. EXPORT_SYMBOL(dev_queue_xmit_accel);
  3079. /*************************************************************************
  3080. * Receiver routines
  3081. *************************************************************************/
  3082. int netdev_max_backlog __read_mostly = 1000;
  3083. EXPORT_SYMBOL(netdev_max_backlog);
  3084. int netdev_tstamp_prequeue __read_mostly = 1;
  3085. int netdev_budget __read_mostly = 300;
  3086. unsigned int __read_mostly netdev_budget_usecs = 2000;
  3087. int weight_p __read_mostly = 64; /* old backlog weight */
  3088. int dev_weight_rx_bias __read_mostly = 1; /* bias for backlog weight */
  3089. int dev_weight_tx_bias __read_mostly = 1; /* bias for output_queue quota */
  3090. int dev_rx_weight __read_mostly = 64;
  3091. int dev_tx_weight __read_mostly = 64;
  3092. /* Called with irq disabled */
  3093. static inline void ____napi_schedule(struct softnet_data *sd,
  3094. struct napi_struct *napi)
  3095. {
  3096. list_add_tail(&napi->poll_list, &sd->poll_list);
  3097. __raise_softirq_irqoff(NET_RX_SOFTIRQ);
  3098. }
  3099. #ifdef CONFIG_RPS
  3100. /* One global table that all flow-based protocols share. */
  3101. struct rps_sock_flow_table __rcu *rps_sock_flow_table __read_mostly;
  3102. EXPORT_SYMBOL(rps_sock_flow_table);
  3103. u32 rps_cpu_mask __read_mostly;
  3104. EXPORT_SYMBOL(rps_cpu_mask);
  3105. struct static_key rps_needed __read_mostly;
  3106. EXPORT_SYMBOL(rps_needed);
  3107. struct static_key rfs_needed __read_mostly;
  3108. EXPORT_SYMBOL(rfs_needed);
  3109. static struct rps_dev_flow *
  3110. set_rps_cpu(struct net_device *dev, struct sk_buff *skb,
  3111. struct rps_dev_flow *rflow, u16 next_cpu)
  3112. {
  3113. if (next_cpu < nr_cpu_ids) {
  3114. #ifdef CONFIG_RFS_ACCEL
  3115. struct netdev_rx_queue *rxqueue;
  3116. struct rps_dev_flow_table *flow_table;
  3117. struct rps_dev_flow *old_rflow;
  3118. u32 flow_id;
  3119. u16 rxq_index;
  3120. int rc;
  3121. /* Should we steer this flow to a different hardware queue? */
  3122. if (!skb_rx_queue_recorded(skb) || !dev->rx_cpu_rmap ||
  3123. !(dev->features & NETIF_F_NTUPLE))
  3124. goto out;
  3125. rxq_index = cpu_rmap_lookup_index(dev->rx_cpu_rmap, next_cpu);
  3126. if (rxq_index == skb_get_rx_queue(skb))
  3127. goto out;
  3128. rxqueue = dev->_rx + rxq_index;
  3129. flow_table = rcu_dereference(rxqueue->rps_flow_table);
  3130. if (!flow_table)
  3131. goto out;
  3132. flow_id = skb_get_hash(skb) & flow_table->mask;
  3133. rc = dev->netdev_ops->ndo_rx_flow_steer(dev, skb,
  3134. rxq_index, flow_id);
  3135. if (rc < 0)
  3136. goto out;
  3137. old_rflow = rflow;
  3138. rflow = &flow_table->flows[flow_id];
  3139. rflow->filter = rc;
  3140. if (old_rflow->filter == rflow->filter)
  3141. old_rflow->filter = RPS_NO_FILTER;
  3142. out:
  3143. #endif
  3144. rflow->last_qtail =
  3145. per_cpu(softnet_data, next_cpu).input_queue_head;
  3146. }
  3147. rflow->cpu = next_cpu;
  3148. return rflow;
  3149. }
  3150. /*
  3151. * get_rps_cpu is called from netif_receive_skb and returns the target
  3152. * CPU from the RPS map of the receiving queue for a given skb.
  3153. * rcu_read_lock must be held on entry.
  3154. */
  3155. static int get_rps_cpu(struct net_device *dev, struct sk_buff *skb,
  3156. struct rps_dev_flow **rflowp)
  3157. {
  3158. const struct rps_sock_flow_table *sock_flow_table;
  3159. struct netdev_rx_queue *rxqueue = dev->_rx;
  3160. struct rps_dev_flow_table *flow_table;
  3161. struct rps_map *map;
  3162. int cpu = -1;
  3163. u32 tcpu;
  3164. u32 hash;
  3165. if (skb_rx_queue_recorded(skb)) {
  3166. u16 index = skb_get_rx_queue(skb);
  3167. if (unlikely(index >= dev->real_num_rx_queues)) {
  3168. WARN_ONCE(dev->real_num_rx_queues > 1,
  3169. "%s received packet on queue %u, but number "
  3170. "of RX queues is %u\n",
  3171. dev->name, index, dev->real_num_rx_queues);
  3172. goto done;
  3173. }
  3174. rxqueue += index;
  3175. }
  3176. /* Avoid computing hash if RFS/RPS is not active for this rxqueue */
  3177. flow_table = rcu_dereference(rxqueue->rps_flow_table);
  3178. map = rcu_dereference(rxqueue->rps_map);
  3179. if (!flow_table && !map)
  3180. goto done;
  3181. skb_reset_network_header(skb);
  3182. hash = skb_get_hash(skb);
  3183. if (!hash)
  3184. goto done;
  3185. sock_flow_table = rcu_dereference(rps_sock_flow_table);
  3186. if (flow_table && sock_flow_table) {
  3187. struct rps_dev_flow *rflow;
  3188. u32 next_cpu;
  3189. u32 ident;
  3190. /* First check into global flow table if there is a match */
  3191. ident = sock_flow_table->ents[hash & sock_flow_table->mask];
  3192. if ((ident ^ hash) & ~rps_cpu_mask)
  3193. goto try_rps;
  3194. next_cpu = ident & rps_cpu_mask;
  3195. /* OK, now we know there is a match,
  3196. * we can look at the local (per receive queue) flow table
  3197. */
  3198. rflow = &flow_table->flows[hash & flow_table->mask];
  3199. tcpu = rflow->cpu;
  3200. /*
  3201. * If the desired CPU (where last recvmsg was done) is
  3202. * different from current CPU (one in the rx-queue flow
  3203. * table entry), switch if one of the following holds:
  3204. * - Current CPU is unset (>= nr_cpu_ids).
  3205. * - Current CPU is offline.
  3206. * - The current CPU's queue tail has advanced beyond the
  3207. * last packet that was enqueued using this table entry.
  3208. * This guarantees that all previous packets for the flow
  3209. * have been dequeued, thus preserving in order delivery.
  3210. */
  3211. if (unlikely(tcpu != next_cpu) &&
  3212. (tcpu >= nr_cpu_ids || !cpu_online(tcpu) ||
  3213. ((int)(per_cpu(softnet_data, tcpu).input_queue_head -
  3214. rflow->last_qtail)) >= 0)) {
  3215. tcpu = next_cpu;
  3216. rflow = set_rps_cpu(dev, skb, rflow, next_cpu);
  3217. }
  3218. if (tcpu < nr_cpu_ids && cpu_online(tcpu)) {
  3219. *rflowp = rflow;
  3220. cpu = tcpu;
  3221. goto done;
  3222. }
  3223. }
  3224. try_rps:
  3225. if (map) {
  3226. tcpu = map->cpus[reciprocal_scale(hash, map->len)];
  3227. if (cpu_online(tcpu)) {
  3228. cpu = tcpu;
  3229. goto done;
  3230. }
  3231. }
  3232. done:
  3233. return cpu;
  3234. }
  3235. #ifdef CONFIG_RFS_ACCEL
  3236. /**
  3237. * rps_may_expire_flow - check whether an RFS hardware filter may be removed
  3238. * @dev: Device on which the filter was set
  3239. * @rxq_index: RX queue index
  3240. * @flow_id: Flow ID passed to ndo_rx_flow_steer()
  3241. * @filter_id: Filter ID returned by ndo_rx_flow_steer()
  3242. *
  3243. * Drivers that implement ndo_rx_flow_steer() should periodically call
  3244. * this function for each installed filter and remove the filters for
  3245. * which it returns %true.
  3246. */
  3247. bool rps_may_expire_flow(struct net_device *dev, u16 rxq_index,
  3248. u32 flow_id, u16 filter_id)
  3249. {
  3250. struct netdev_rx_queue *rxqueue = dev->_rx + rxq_index;
  3251. struct rps_dev_flow_table *flow_table;
  3252. struct rps_dev_flow *rflow;
  3253. bool expire = true;
  3254. unsigned int cpu;
  3255. rcu_read_lock();
  3256. flow_table = rcu_dereference(rxqueue->rps_flow_table);
  3257. if (flow_table && flow_id <= flow_table->mask) {
  3258. rflow = &flow_table->flows[flow_id];
  3259. cpu = READ_ONCE(rflow->cpu);
  3260. if (rflow->filter == filter_id && cpu < nr_cpu_ids &&
  3261. ((int)(per_cpu(softnet_data, cpu).input_queue_head -
  3262. rflow->last_qtail) <
  3263. (int)(10 * flow_table->mask)))
  3264. expire = false;
  3265. }
  3266. rcu_read_unlock();
  3267. return expire;
  3268. }
  3269. EXPORT_SYMBOL(rps_may_expire_flow);
  3270. #endif /* CONFIG_RFS_ACCEL */
  3271. /* Called from hardirq (IPI) context */
  3272. static void rps_trigger_softirq(void *data)
  3273. {
  3274. struct softnet_data *sd = data;
  3275. ____napi_schedule(sd, &sd->backlog);
  3276. sd->received_rps++;
  3277. }
  3278. #endif /* CONFIG_RPS */
  3279. /*
  3280. * Check if this softnet_data structure is another cpu one
  3281. * If yes, queue it to our IPI list and return 1
  3282. * If no, return 0
  3283. */
  3284. static int rps_ipi_queued(struct softnet_data *sd)
  3285. {
  3286. #ifdef CONFIG_RPS
  3287. struct softnet_data *mysd = this_cpu_ptr(&softnet_data);
  3288. if (sd != mysd) {
  3289. sd->rps_ipi_next = mysd->rps_ipi_list;
  3290. mysd->rps_ipi_list = sd;
  3291. __raise_softirq_irqoff(NET_RX_SOFTIRQ);
  3292. return 1;
  3293. }
  3294. #endif /* CONFIG_RPS */
  3295. return 0;
  3296. }
  3297. #ifdef CONFIG_NET_FLOW_LIMIT
  3298. int netdev_flow_limit_table_len __read_mostly = (1 << 12);
  3299. #endif
  3300. static bool skb_flow_limit(struct sk_buff *skb, unsigned int qlen)
  3301. {
  3302. #ifdef CONFIG_NET_FLOW_LIMIT
  3303. struct sd_flow_limit *fl;
  3304. struct softnet_data *sd;
  3305. unsigned int old_flow, new_flow;
  3306. if (qlen < (netdev_max_backlog >> 1))
  3307. return false;
  3308. sd = this_cpu_ptr(&softnet_data);
  3309. rcu_read_lock();
  3310. fl = rcu_dereference(sd->flow_limit);
  3311. if (fl) {
  3312. new_flow = skb_get_hash(skb) & (fl->num_buckets - 1);
  3313. old_flow = fl->history[fl->history_head];
  3314. fl->history[fl->history_head] = new_flow;
  3315. fl->history_head++;
  3316. fl->history_head &= FLOW_LIMIT_HISTORY - 1;
  3317. if (likely(fl->buckets[old_flow]))
  3318. fl->buckets[old_flow]--;
  3319. if (++fl->buckets[new_flow] > (FLOW_LIMIT_HISTORY >> 1)) {
  3320. fl->count++;
  3321. rcu_read_unlock();
  3322. return true;
  3323. }
  3324. }
  3325. rcu_read_unlock();
  3326. #endif
  3327. return false;
  3328. }
  3329. /*
  3330. * enqueue_to_backlog is called to queue an skb to a per CPU backlog
  3331. * queue (may be a remote CPU queue).
  3332. */
  3333. static int enqueue_to_backlog(struct sk_buff *skb, int cpu,
  3334. unsigned int *qtail)
  3335. {
  3336. struct softnet_data *sd;
  3337. unsigned long flags;
  3338. unsigned int qlen;
  3339. sd = &per_cpu(softnet_data, cpu);
  3340. local_irq_save(flags);
  3341. rps_lock(sd);
  3342. if (!netif_running(skb->dev))
  3343. goto drop;
  3344. qlen = skb_queue_len(&sd->input_pkt_queue);
  3345. if (qlen <= netdev_max_backlog && !skb_flow_limit(skb, qlen)) {
  3346. if (qlen) {
  3347. enqueue:
  3348. __skb_queue_tail(&sd->input_pkt_queue, skb);
  3349. input_queue_tail_incr_save(sd, qtail);
  3350. rps_unlock(sd);
  3351. local_irq_restore(flags);
  3352. return NET_RX_SUCCESS;
  3353. }
  3354. /* Schedule NAPI for backlog device
  3355. * We can use non atomic operation since we own the queue lock
  3356. */
  3357. if (!__test_and_set_bit(NAPI_STATE_SCHED, &sd->backlog.state)) {
  3358. if (!rps_ipi_queued(sd))
  3359. ____napi_schedule(sd, &sd->backlog);
  3360. }
  3361. goto enqueue;
  3362. }
  3363. drop:
  3364. sd->dropped++;
  3365. rps_unlock(sd);
  3366. local_irq_restore(flags);
  3367. atomic_long_inc(&skb->dev->rx_dropped);
  3368. kfree_skb(skb);
  3369. return NET_RX_DROP;
  3370. }
  3371. static struct netdev_rx_queue *netif_get_rxqueue(struct sk_buff *skb)
  3372. {
  3373. struct net_device *dev = skb->dev;
  3374. struct netdev_rx_queue *rxqueue;
  3375. rxqueue = dev->_rx;
  3376. if (skb_rx_queue_recorded(skb)) {
  3377. u16 index = skb_get_rx_queue(skb);
  3378. if (unlikely(index >= dev->real_num_rx_queues)) {
  3379. WARN_ONCE(dev->real_num_rx_queues > 1,
  3380. "%s received packet on queue %u, but number "
  3381. "of RX queues is %u\n",
  3382. dev->name, index, dev->real_num_rx_queues);
  3383. return rxqueue; /* Return first rxqueue */
  3384. }
  3385. rxqueue += index;
  3386. }
  3387. return rxqueue;
  3388. }
  3389. static u32 netif_receive_generic_xdp(struct sk_buff *skb,
  3390. struct bpf_prog *xdp_prog)
  3391. {
  3392. struct netdev_rx_queue *rxqueue;
  3393. void *orig_data, *orig_data_end;
  3394. u32 metalen, act = XDP_DROP;
  3395. struct xdp_buff xdp;
  3396. int hlen, off;
  3397. u32 mac_len;
  3398. /* Reinjected packets coming from act_mirred or similar should
  3399. * not get XDP generic processing.
  3400. */
  3401. if (skb_cloned(skb))
  3402. return XDP_PASS;
  3403. /* XDP packets must be linear and must have sufficient headroom
  3404. * of XDP_PACKET_HEADROOM bytes. This is the guarantee that also
  3405. * native XDP provides, thus we need to do it here as well.
  3406. */
  3407. if (skb_is_nonlinear(skb) ||
  3408. skb_headroom(skb) < XDP_PACKET_HEADROOM) {
  3409. int hroom = XDP_PACKET_HEADROOM - skb_headroom(skb);
  3410. int troom = skb->tail + skb->data_len - skb->end;
  3411. /* In case we have to go down the path and also linearize,
  3412. * then lets do the pskb_expand_head() work just once here.
  3413. */
  3414. if (pskb_expand_head(skb,
  3415. hroom > 0 ? ALIGN(hroom, NET_SKB_PAD) : 0,
  3416. troom > 0 ? troom + 128 : 0, GFP_ATOMIC))
  3417. goto do_drop;
  3418. if (skb_linearize(skb))
  3419. goto do_drop;
  3420. }
  3421. /* The XDP program wants to see the packet starting at the MAC
  3422. * header.
  3423. */
  3424. mac_len = skb->data - skb_mac_header(skb);
  3425. hlen = skb_headlen(skb) + mac_len;
  3426. xdp.data = skb->data - mac_len;
  3427. xdp.data_meta = xdp.data;
  3428. xdp.data_end = xdp.data + hlen;
  3429. xdp.data_hard_start = skb->data - skb_headroom(skb);
  3430. orig_data_end = xdp.data_end;
  3431. orig_data = xdp.data;
  3432. rxqueue = netif_get_rxqueue(skb);
  3433. xdp.rxq = &rxqueue->xdp_rxq;
  3434. act = bpf_prog_run_xdp(xdp_prog, &xdp);
  3435. off = xdp.data - orig_data;
  3436. if (off > 0)
  3437. __skb_pull(skb, off);
  3438. else if (off < 0)
  3439. __skb_push(skb, -off);
  3440. skb->mac_header += off;
  3441. /* check if bpf_xdp_adjust_tail was used. it can only "shrink"
  3442. * pckt.
  3443. */
  3444. off = orig_data_end - xdp.data_end;
  3445. if (off != 0) {
  3446. skb_set_tail_pointer(skb, xdp.data_end - xdp.data);
  3447. skb->len -= off;
  3448. }
  3449. switch (act) {
  3450. case XDP_REDIRECT:
  3451. case XDP_TX:
  3452. __skb_push(skb, mac_len);
  3453. break;
  3454. case XDP_PASS:
  3455. metalen = xdp.data - xdp.data_meta;
  3456. if (metalen)
  3457. skb_metadata_set(skb, metalen);
  3458. break;
  3459. default:
  3460. bpf_warn_invalid_xdp_action(act);
  3461. /* fall through */
  3462. case XDP_ABORTED:
  3463. trace_xdp_exception(skb->dev, xdp_prog, act);
  3464. /* fall through */
  3465. case XDP_DROP:
  3466. do_drop:
  3467. kfree_skb(skb);
  3468. break;
  3469. }
  3470. return act;
  3471. }
  3472. /* When doing generic XDP we have to bypass the qdisc layer and the
  3473. * network taps in order to match in-driver-XDP behavior.
  3474. */
  3475. void generic_xdp_tx(struct sk_buff *skb, struct bpf_prog *xdp_prog)
  3476. {
  3477. struct net_device *dev = skb->dev;
  3478. struct netdev_queue *txq;
  3479. bool free_skb = true;
  3480. int cpu, rc;
  3481. txq = netdev_pick_tx(dev, skb, NULL);
  3482. cpu = smp_processor_id();
  3483. HARD_TX_LOCK(dev, txq, cpu);
  3484. if (!netif_xmit_stopped(txq)) {
  3485. rc = netdev_start_xmit(skb, dev, txq, 0);
  3486. if (dev_xmit_complete(rc))
  3487. free_skb = false;
  3488. }
  3489. HARD_TX_UNLOCK(dev, txq);
  3490. if (free_skb) {
  3491. trace_xdp_exception(dev, xdp_prog, XDP_TX);
  3492. kfree_skb(skb);
  3493. }
  3494. }
  3495. EXPORT_SYMBOL_GPL(generic_xdp_tx);
  3496. static struct static_key generic_xdp_needed __read_mostly;
  3497. int do_xdp_generic(struct bpf_prog *xdp_prog, struct sk_buff *skb)
  3498. {
  3499. if (xdp_prog) {
  3500. u32 act = netif_receive_generic_xdp(skb, xdp_prog);
  3501. int err;
  3502. if (act != XDP_PASS) {
  3503. switch (act) {
  3504. case XDP_REDIRECT:
  3505. err = xdp_do_generic_redirect(skb->dev, skb,
  3506. xdp_prog);
  3507. if (err)
  3508. goto out_redir;
  3509. /* fallthru to submit skb */
  3510. case XDP_TX:
  3511. generic_xdp_tx(skb, xdp_prog);
  3512. break;
  3513. }
  3514. return XDP_DROP;
  3515. }
  3516. }
  3517. return XDP_PASS;
  3518. out_redir:
  3519. kfree_skb(skb);
  3520. return XDP_DROP;
  3521. }
  3522. EXPORT_SYMBOL_GPL(do_xdp_generic);
  3523. static int netif_rx_internal(struct sk_buff *skb)
  3524. {
  3525. int ret;
  3526. net_timestamp_check(netdev_tstamp_prequeue, skb);
  3527. trace_netif_rx(skb);
  3528. if (static_key_false(&generic_xdp_needed)) {
  3529. int ret;
  3530. preempt_disable();
  3531. rcu_read_lock();
  3532. ret = do_xdp_generic(rcu_dereference(skb->dev->xdp_prog), skb);
  3533. rcu_read_unlock();
  3534. preempt_enable();
  3535. /* Consider XDP consuming the packet a success from
  3536. * the netdev point of view we do not want to count
  3537. * this as an error.
  3538. */
  3539. if (ret != XDP_PASS)
  3540. return NET_RX_SUCCESS;
  3541. }
  3542. #ifdef CONFIG_RPS
  3543. if (static_key_false(&rps_needed)) {
  3544. struct rps_dev_flow voidflow, *rflow = &voidflow;
  3545. int cpu;
  3546. preempt_disable();
  3547. rcu_read_lock();
  3548. cpu = get_rps_cpu(skb->dev, skb, &rflow);
  3549. if (cpu < 0)
  3550. cpu = smp_processor_id();
  3551. ret = enqueue_to_backlog(skb, cpu, &rflow->last_qtail);
  3552. rcu_read_unlock();
  3553. preempt_enable();
  3554. } else
  3555. #endif
  3556. {
  3557. unsigned int qtail;
  3558. ret = enqueue_to_backlog(skb, get_cpu(), &qtail);
  3559. put_cpu();
  3560. }
  3561. return ret;
  3562. }
  3563. /**
  3564. * netif_rx - post buffer to the network code
  3565. * @skb: buffer to post
  3566. *
  3567. * This function receives a packet from a device driver and queues it for
  3568. * the upper (protocol) levels to process. It always succeeds. The buffer
  3569. * may be dropped during processing for congestion control or by the
  3570. * protocol layers.
  3571. *
  3572. * return values:
  3573. * NET_RX_SUCCESS (no congestion)
  3574. * NET_RX_DROP (packet was dropped)
  3575. *
  3576. */
  3577. int netif_rx(struct sk_buff *skb)
  3578. {
  3579. trace_netif_rx_entry(skb);
  3580. return netif_rx_internal(skb);
  3581. }
  3582. EXPORT_SYMBOL(netif_rx);
  3583. int netif_rx_ni(struct sk_buff *skb)
  3584. {
  3585. int err;
  3586. trace_netif_rx_ni_entry(skb);
  3587. preempt_disable();
  3588. err = netif_rx_internal(skb);
  3589. if (local_softirq_pending())
  3590. do_softirq();
  3591. preempt_enable();
  3592. return err;
  3593. }
  3594. EXPORT_SYMBOL(netif_rx_ni);
  3595. static __latent_entropy void net_tx_action(struct softirq_action *h)
  3596. {
  3597. struct softnet_data *sd = this_cpu_ptr(&softnet_data);
  3598. if (sd->completion_queue) {
  3599. struct sk_buff *clist;
  3600. local_irq_disable();
  3601. clist = sd->completion_queue;
  3602. sd->completion_queue = NULL;
  3603. local_irq_enable();
  3604. while (clist) {
  3605. struct sk_buff *skb = clist;
  3606. clist = clist->next;
  3607. WARN_ON(refcount_read(&skb->users));
  3608. if (likely(get_kfree_skb_cb(skb)->reason == SKB_REASON_CONSUMED))
  3609. trace_consume_skb(skb);
  3610. else
  3611. trace_kfree_skb(skb, net_tx_action);
  3612. if (skb->fclone != SKB_FCLONE_UNAVAILABLE)
  3613. __kfree_skb(skb);
  3614. else
  3615. __kfree_skb_defer(skb);
  3616. }
  3617. __kfree_skb_flush();
  3618. }
  3619. if (sd->output_queue) {
  3620. struct Qdisc *head;
  3621. local_irq_disable();
  3622. head = sd->output_queue;
  3623. sd->output_queue = NULL;
  3624. sd->output_queue_tailp = &sd->output_queue;
  3625. local_irq_enable();
  3626. while (head) {
  3627. struct Qdisc *q = head;
  3628. spinlock_t *root_lock = NULL;
  3629. head = head->next_sched;
  3630. if (!(q->flags & TCQ_F_NOLOCK)) {
  3631. root_lock = qdisc_lock(q);
  3632. spin_lock(root_lock);
  3633. }
  3634. /* We need to make sure head->next_sched is read
  3635. * before clearing __QDISC_STATE_SCHED
  3636. */
  3637. smp_mb__before_atomic();
  3638. clear_bit(__QDISC_STATE_SCHED, &q->state);
  3639. qdisc_run(q);
  3640. if (root_lock)
  3641. spin_unlock(root_lock);
  3642. }
  3643. }
  3644. xfrm_dev_backlog(sd);
  3645. }
  3646. #if IS_ENABLED(CONFIG_BRIDGE) && IS_ENABLED(CONFIG_ATM_LANE)
  3647. /* This hook is defined here for ATM LANE */
  3648. int (*br_fdb_test_addr_hook)(struct net_device *dev,
  3649. unsigned char *addr) __read_mostly;
  3650. EXPORT_SYMBOL_GPL(br_fdb_test_addr_hook);
  3651. #endif
  3652. static inline struct sk_buff *
  3653. sch_handle_ingress(struct sk_buff *skb, struct packet_type **pt_prev, int *ret,
  3654. struct net_device *orig_dev)
  3655. {
  3656. #ifdef CONFIG_NET_CLS_ACT
  3657. struct mini_Qdisc *miniq = rcu_dereference_bh(skb->dev->miniq_ingress);
  3658. struct tcf_result cl_res;
  3659. /* If there's at least one ingress present somewhere (so
  3660. * we get here via enabled static key), remaining devices
  3661. * that are not configured with an ingress qdisc will bail
  3662. * out here.
  3663. */
  3664. if (!miniq)
  3665. return skb;
  3666. if (*pt_prev) {
  3667. *ret = deliver_skb(skb, *pt_prev, orig_dev);
  3668. *pt_prev = NULL;
  3669. }
  3670. qdisc_skb_cb(skb)->pkt_len = skb->len;
  3671. skb->tc_at_ingress = 1;
  3672. mini_qdisc_bstats_cpu_update(miniq, skb);
  3673. switch (tcf_classify(skb, miniq->filter_list, &cl_res, false)) {
  3674. case TC_ACT_OK:
  3675. case TC_ACT_RECLASSIFY:
  3676. skb->tc_index = TC_H_MIN(cl_res.classid);
  3677. break;
  3678. case TC_ACT_SHOT:
  3679. mini_qdisc_qstats_cpu_drop(miniq);
  3680. kfree_skb(skb);
  3681. return NULL;
  3682. case TC_ACT_STOLEN:
  3683. case TC_ACT_QUEUED:
  3684. case TC_ACT_TRAP:
  3685. consume_skb(skb);
  3686. return NULL;
  3687. case TC_ACT_REDIRECT:
  3688. /* skb_mac_header check was done by cls/act_bpf, so
  3689. * we can safely push the L2 header back before
  3690. * redirecting to another netdev
  3691. */
  3692. __skb_push(skb, skb->mac_len);
  3693. skb_do_redirect(skb);
  3694. return NULL;
  3695. default:
  3696. break;
  3697. }
  3698. #endif /* CONFIG_NET_CLS_ACT */
  3699. return skb;
  3700. }
  3701. /**
  3702. * netdev_is_rx_handler_busy - check if receive handler is registered
  3703. * @dev: device to check
  3704. *
  3705. * Check if a receive handler is already registered for a given device.
  3706. * Return true if there one.
  3707. *
  3708. * The caller must hold the rtnl_mutex.
  3709. */
  3710. bool netdev_is_rx_handler_busy(struct net_device *dev)
  3711. {
  3712. ASSERT_RTNL();
  3713. return dev && rtnl_dereference(dev->rx_handler);
  3714. }
  3715. EXPORT_SYMBOL_GPL(netdev_is_rx_handler_busy);
  3716. /**
  3717. * netdev_rx_handler_register - register receive handler
  3718. * @dev: device to register a handler for
  3719. * @rx_handler: receive handler to register
  3720. * @rx_handler_data: data pointer that is used by rx handler
  3721. *
  3722. * Register a receive handler for a device. This handler will then be
  3723. * called from __netif_receive_skb. A negative errno code is returned
  3724. * on a failure.
  3725. *
  3726. * The caller must hold the rtnl_mutex.
  3727. *
  3728. * For a general description of rx_handler, see enum rx_handler_result.
  3729. */
  3730. int netdev_rx_handler_register(struct net_device *dev,
  3731. rx_handler_func_t *rx_handler,
  3732. void *rx_handler_data)
  3733. {
  3734. if (netdev_is_rx_handler_busy(dev))
  3735. return -EBUSY;
  3736. if (dev->priv_flags & IFF_NO_RX_HANDLER)
  3737. return -EINVAL;
  3738. /* Note: rx_handler_data must be set before rx_handler */
  3739. rcu_assign_pointer(dev->rx_handler_data, rx_handler_data);
  3740. rcu_assign_pointer(dev->rx_handler, rx_handler);
  3741. return 0;
  3742. }
  3743. EXPORT_SYMBOL_GPL(netdev_rx_handler_register);
  3744. /**
  3745. * netdev_rx_handler_unregister - unregister receive handler
  3746. * @dev: device to unregister a handler from
  3747. *
  3748. * Unregister a receive handler from a device.
  3749. *
  3750. * The caller must hold the rtnl_mutex.
  3751. */
  3752. void netdev_rx_handler_unregister(struct net_device *dev)
  3753. {
  3754. ASSERT_RTNL();
  3755. RCU_INIT_POINTER(dev->rx_handler, NULL);
  3756. /* a reader seeing a non NULL rx_handler in a rcu_read_lock()
  3757. * section has a guarantee to see a non NULL rx_handler_data
  3758. * as well.
  3759. */
  3760. synchronize_net();
  3761. RCU_INIT_POINTER(dev->rx_handler_data, NULL);
  3762. }
  3763. EXPORT_SYMBOL_GPL(netdev_rx_handler_unregister);
  3764. /*
  3765. * Limit the use of PFMEMALLOC reserves to those protocols that implement
  3766. * the special handling of PFMEMALLOC skbs.
  3767. */
  3768. static bool skb_pfmemalloc_protocol(struct sk_buff *skb)
  3769. {
  3770. switch (skb->protocol) {
  3771. case htons(ETH_P_ARP):
  3772. case htons(ETH_P_IP):
  3773. case htons(ETH_P_IPV6):
  3774. case htons(ETH_P_8021Q):
  3775. case htons(ETH_P_8021AD):
  3776. return true;
  3777. default:
  3778. return false;
  3779. }
  3780. }
  3781. static inline int nf_ingress(struct sk_buff *skb, struct packet_type **pt_prev,
  3782. int *ret, struct net_device *orig_dev)
  3783. {
  3784. #ifdef CONFIG_NETFILTER_INGRESS
  3785. if (nf_hook_ingress_active(skb)) {
  3786. int ingress_retval;
  3787. if (*pt_prev) {
  3788. *ret = deliver_skb(skb, *pt_prev, orig_dev);
  3789. *pt_prev = NULL;
  3790. }
  3791. rcu_read_lock();
  3792. ingress_retval = nf_hook_ingress(skb);
  3793. rcu_read_unlock();
  3794. return ingress_retval;
  3795. }
  3796. #endif /* CONFIG_NETFILTER_INGRESS */
  3797. return 0;
  3798. }
  3799. static int __netif_receive_skb_core(struct sk_buff *skb, bool pfmemalloc)
  3800. {
  3801. struct packet_type *ptype, *pt_prev;
  3802. rx_handler_func_t *rx_handler;
  3803. struct net_device *orig_dev;
  3804. bool deliver_exact = false;
  3805. int ret = NET_RX_DROP;
  3806. __be16 type;
  3807. net_timestamp_check(!netdev_tstamp_prequeue, skb);
  3808. trace_netif_receive_skb(skb);
  3809. orig_dev = skb->dev;
  3810. skb_reset_network_header(skb);
  3811. if (!skb_transport_header_was_set(skb))
  3812. skb_reset_transport_header(skb);
  3813. skb_reset_mac_len(skb);
  3814. pt_prev = NULL;
  3815. another_round:
  3816. skb->skb_iif = skb->dev->ifindex;
  3817. __this_cpu_inc(softnet_data.processed);
  3818. if (skb->protocol == cpu_to_be16(ETH_P_8021Q) ||
  3819. skb->protocol == cpu_to_be16(ETH_P_8021AD)) {
  3820. skb = skb_vlan_untag(skb);
  3821. if (unlikely(!skb))
  3822. goto out;
  3823. }
  3824. if (skb_skip_tc_classify(skb))
  3825. goto skip_classify;
  3826. if (pfmemalloc)
  3827. goto skip_taps;
  3828. list_for_each_entry_rcu(ptype, &ptype_all, list) {
  3829. if (pt_prev)
  3830. ret = deliver_skb(skb, pt_prev, orig_dev);
  3831. pt_prev = ptype;
  3832. }
  3833. list_for_each_entry_rcu(ptype, &skb->dev->ptype_all, list) {
  3834. if (pt_prev)
  3835. ret = deliver_skb(skb, pt_prev, orig_dev);
  3836. pt_prev = ptype;
  3837. }
  3838. skip_taps:
  3839. #ifdef CONFIG_NET_INGRESS
  3840. if (static_key_false(&ingress_needed)) {
  3841. skb = sch_handle_ingress(skb, &pt_prev, &ret, orig_dev);
  3842. if (!skb)
  3843. goto out;
  3844. if (nf_ingress(skb, &pt_prev, &ret, orig_dev) < 0)
  3845. goto out;
  3846. }
  3847. #endif
  3848. skb_reset_tc(skb);
  3849. skip_classify:
  3850. if (pfmemalloc && !skb_pfmemalloc_protocol(skb))
  3851. goto drop;
  3852. if (skb_vlan_tag_present(skb)) {
  3853. if (pt_prev) {
  3854. ret = deliver_skb(skb, pt_prev, orig_dev);
  3855. pt_prev = NULL;
  3856. }
  3857. if (vlan_do_receive(&skb))
  3858. goto another_round;
  3859. else if (unlikely(!skb))
  3860. goto out;
  3861. }
  3862. rx_handler = rcu_dereference(skb->dev->rx_handler);
  3863. if (rx_handler) {
  3864. if (pt_prev) {
  3865. ret = deliver_skb(skb, pt_prev, orig_dev);
  3866. pt_prev = NULL;
  3867. }
  3868. switch (rx_handler(&skb)) {
  3869. case RX_HANDLER_CONSUMED:
  3870. ret = NET_RX_SUCCESS;
  3871. goto out;
  3872. case RX_HANDLER_ANOTHER:
  3873. goto another_round;
  3874. case RX_HANDLER_EXACT:
  3875. deliver_exact = true;
  3876. case RX_HANDLER_PASS:
  3877. break;
  3878. default:
  3879. BUG();
  3880. }
  3881. }
  3882. if (unlikely(skb_vlan_tag_present(skb))) {
  3883. if (skb_vlan_tag_get_id(skb))
  3884. skb->pkt_type = PACKET_OTHERHOST;
  3885. /* Note: we might in the future use prio bits
  3886. * and set skb->priority like in vlan_do_receive()
  3887. * For the time being, just ignore Priority Code Point
  3888. */
  3889. skb->vlan_tci = 0;
  3890. }
  3891. type = skb->protocol;
  3892. /* deliver only exact match when indicated */
  3893. if (likely(!deliver_exact)) {
  3894. deliver_ptype_list_skb(skb, &pt_prev, orig_dev, type,
  3895. &ptype_base[ntohs(type) &
  3896. PTYPE_HASH_MASK]);
  3897. }
  3898. deliver_ptype_list_skb(skb, &pt_prev, orig_dev, type,
  3899. &orig_dev->ptype_specific);
  3900. if (unlikely(skb->dev != orig_dev)) {
  3901. deliver_ptype_list_skb(skb, &pt_prev, orig_dev, type,
  3902. &skb->dev->ptype_specific);
  3903. }
  3904. if (pt_prev) {
  3905. if (unlikely(skb_orphan_frags_rx(skb, GFP_ATOMIC)))
  3906. goto drop;
  3907. else
  3908. ret = pt_prev->func(skb, skb->dev, pt_prev, orig_dev);
  3909. } else {
  3910. drop:
  3911. if (!deliver_exact)
  3912. atomic_long_inc(&skb->dev->rx_dropped);
  3913. else
  3914. atomic_long_inc(&skb->dev->rx_nohandler);
  3915. kfree_skb(skb);
  3916. /* Jamal, now you will not able to escape explaining
  3917. * me how you were going to use this. :-)
  3918. */
  3919. ret = NET_RX_DROP;
  3920. }
  3921. out:
  3922. return ret;
  3923. }
  3924. /**
  3925. * netif_receive_skb_core - special purpose version of netif_receive_skb
  3926. * @skb: buffer to process
  3927. *
  3928. * More direct receive version of netif_receive_skb(). It should
  3929. * only be used by callers that have a need to skip RPS and Generic XDP.
  3930. * Caller must also take care of handling if (page_is_)pfmemalloc.
  3931. *
  3932. * This function may only be called from softirq context and interrupts
  3933. * should be enabled.
  3934. *
  3935. * Return values (usually ignored):
  3936. * NET_RX_SUCCESS: no congestion
  3937. * NET_RX_DROP: packet was dropped
  3938. */
  3939. int netif_receive_skb_core(struct sk_buff *skb)
  3940. {
  3941. int ret;
  3942. rcu_read_lock();
  3943. ret = __netif_receive_skb_core(skb, false);
  3944. rcu_read_unlock();
  3945. return ret;
  3946. }
  3947. EXPORT_SYMBOL(netif_receive_skb_core);
  3948. static int __netif_receive_skb(struct sk_buff *skb)
  3949. {
  3950. int ret;
  3951. if (sk_memalloc_socks() && skb_pfmemalloc(skb)) {
  3952. unsigned int noreclaim_flag;
  3953. /*
  3954. * PFMEMALLOC skbs are special, they should
  3955. * - be delivered to SOCK_MEMALLOC sockets only
  3956. * - stay away from userspace
  3957. * - have bounded memory usage
  3958. *
  3959. * Use PF_MEMALLOC as this saves us from propagating the allocation
  3960. * context down to all allocation sites.
  3961. */
  3962. noreclaim_flag = memalloc_noreclaim_save();
  3963. ret = __netif_receive_skb_core(skb, true);
  3964. memalloc_noreclaim_restore(noreclaim_flag);
  3965. } else
  3966. ret = __netif_receive_skb_core(skb, false);
  3967. return ret;
  3968. }
  3969. static int generic_xdp_install(struct net_device *dev, struct netdev_bpf *xdp)
  3970. {
  3971. struct bpf_prog *old = rtnl_dereference(dev->xdp_prog);
  3972. struct bpf_prog *new = xdp->prog;
  3973. int ret = 0;
  3974. switch (xdp->command) {
  3975. case XDP_SETUP_PROG:
  3976. rcu_assign_pointer(dev->xdp_prog, new);
  3977. if (old)
  3978. bpf_prog_put(old);
  3979. if (old && !new) {
  3980. static_key_slow_dec(&generic_xdp_needed);
  3981. } else if (new && !old) {
  3982. static_key_slow_inc(&generic_xdp_needed);
  3983. dev_disable_lro(dev);
  3984. dev_disable_gro_hw(dev);
  3985. }
  3986. break;
  3987. case XDP_QUERY_PROG:
  3988. xdp->prog_attached = !!old;
  3989. xdp->prog_id = old ? old->aux->id : 0;
  3990. break;
  3991. default:
  3992. ret = -EINVAL;
  3993. break;
  3994. }
  3995. return ret;
  3996. }
  3997. static int netif_receive_skb_internal(struct sk_buff *skb)
  3998. {
  3999. int ret;
  4000. net_timestamp_check(netdev_tstamp_prequeue, skb);
  4001. if (skb_defer_rx_timestamp(skb))
  4002. return NET_RX_SUCCESS;
  4003. if (static_key_false(&generic_xdp_needed)) {
  4004. int ret;
  4005. preempt_disable();
  4006. rcu_read_lock();
  4007. ret = do_xdp_generic(rcu_dereference(skb->dev->xdp_prog), skb);
  4008. rcu_read_unlock();
  4009. preempt_enable();
  4010. if (ret != XDP_PASS)
  4011. return NET_RX_DROP;
  4012. }
  4013. rcu_read_lock();
  4014. #ifdef CONFIG_RPS
  4015. if (static_key_false(&rps_needed)) {
  4016. struct rps_dev_flow voidflow, *rflow = &voidflow;
  4017. int cpu = get_rps_cpu(skb->dev, skb, &rflow);
  4018. if (cpu >= 0) {
  4019. ret = enqueue_to_backlog(skb, cpu, &rflow->last_qtail);
  4020. rcu_read_unlock();
  4021. return ret;
  4022. }
  4023. }
  4024. #endif
  4025. ret = __netif_receive_skb(skb);
  4026. rcu_read_unlock();
  4027. return ret;
  4028. }
  4029. /**
  4030. * netif_receive_skb - process receive buffer from network
  4031. * @skb: buffer to process
  4032. *
  4033. * netif_receive_skb() is the main receive data processing function.
  4034. * It always succeeds. The buffer may be dropped during processing
  4035. * for congestion control or by the protocol layers.
  4036. *
  4037. * This function may only be called from softirq context and interrupts
  4038. * should be enabled.
  4039. *
  4040. * Return values (usually ignored):
  4041. * NET_RX_SUCCESS: no congestion
  4042. * NET_RX_DROP: packet was dropped
  4043. */
  4044. int netif_receive_skb(struct sk_buff *skb)
  4045. {
  4046. trace_netif_receive_skb_entry(skb);
  4047. return netif_receive_skb_internal(skb);
  4048. }
  4049. EXPORT_SYMBOL(netif_receive_skb);
  4050. DEFINE_PER_CPU(struct work_struct, flush_works);
  4051. /* Network device is going away, flush any packets still pending */
  4052. static void flush_backlog(struct work_struct *work)
  4053. {
  4054. struct sk_buff *skb, *tmp;
  4055. struct softnet_data *sd;
  4056. local_bh_disable();
  4057. sd = this_cpu_ptr(&softnet_data);
  4058. local_irq_disable();
  4059. rps_lock(sd);
  4060. skb_queue_walk_safe(&sd->input_pkt_queue, skb, tmp) {
  4061. if (skb->dev->reg_state == NETREG_UNREGISTERING) {
  4062. __skb_unlink(skb, &sd->input_pkt_queue);
  4063. kfree_skb(skb);
  4064. input_queue_head_incr(sd);
  4065. }
  4066. }
  4067. rps_unlock(sd);
  4068. local_irq_enable();
  4069. skb_queue_walk_safe(&sd->process_queue, skb, tmp) {
  4070. if (skb->dev->reg_state == NETREG_UNREGISTERING) {
  4071. __skb_unlink(skb, &sd->process_queue);
  4072. kfree_skb(skb);
  4073. input_queue_head_incr(sd);
  4074. }
  4075. }
  4076. local_bh_enable();
  4077. }
  4078. static void flush_all_backlogs(void)
  4079. {
  4080. unsigned int cpu;
  4081. get_online_cpus();
  4082. for_each_online_cpu(cpu)
  4083. queue_work_on(cpu, system_highpri_wq,
  4084. per_cpu_ptr(&flush_works, cpu));
  4085. for_each_online_cpu(cpu)
  4086. flush_work(per_cpu_ptr(&flush_works, cpu));
  4087. put_online_cpus();
  4088. }
  4089. static int napi_gro_complete(struct sk_buff *skb)
  4090. {
  4091. struct packet_offload *ptype;
  4092. __be16 type = skb->protocol;
  4093. struct list_head *head = &offload_base;
  4094. int err = -ENOENT;
  4095. BUILD_BUG_ON(sizeof(struct napi_gro_cb) > sizeof(skb->cb));
  4096. if (NAPI_GRO_CB(skb)->count == 1) {
  4097. skb_shinfo(skb)->gso_size = 0;
  4098. goto out;
  4099. }
  4100. rcu_read_lock();
  4101. list_for_each_entry_rcu(ptype, head, list) {
  4102. if (ptype->type != type || !ptype->callbacks.gro_complete)
  4103. continue;
  4104. err = ptype->callbacks.gro_complete(skb, 0);
  4105. break;
  4106. }
  4107. rcu_read_unlock();
  4108. if (err) {
  4109. WARN_ON(&ptype->list == head);
  4110. kfree_skb(skb);
  4111. return NET_RX_SUCCESS;
  4112. }
  4113. out:
  4114. return netif_receive_skb_internal(skb);
  4115. }
  4116. /* napi->gro_list contains packets ordered by age.
  4117. * youngest packets at the head of it.
  4118. * Complete skbs in reverse order to reduce latencies.
  4119. */
  4120. void napi_gro_flush(struct napi_struct *napi, bool flush_old)
  4121. {
  4122. struct sk_buff *skb, *prev = NULL;
  4123. /* scan list and build reverse chain */
  4124. for (skb = napi->gro_list; skb != NULL; skb = skb->next) {
  4125. skb->prev = prev;
  4126. prev = skb;
  4127. }
  4128. for (skb = prev; skb; skb = prev) {
  4129. skb->next = NULL;
  4130. if (flush_old && NAPI_GRO_CB(skb)->age == jiffies)
  4131. return;
  4132. prev = skb->prev;
  4133. napi_gro_complete(skb);
  4134. napi->gro_count--;
  4135. }
  4136. napi->gro_list = NULL;
  4137. }
  4138. EXPORT_SYMBOL(napi_gro_flush);
  4139. static void gro_list_prepare(struct napi_struct *napi, struct sk_buff *skb)
  4140. {
  4141. struct sk_buff *p;
  4142. unsigned int maclen = skb->dev->hard_header_len;
  4143. u32 hash = skb_get_hash_raw(skb);
  4144. for (p = napi->gro_list; p; p = p->next) {
  4145. unsigned long diffs;
  4146. NAPI_GRO_CB(p)->flush = 0;
  4147. if (hash != skb_get_hash_raw(p)) {
  4148. NAPI_GRO_CB(p)->same_flow = 0;
  4149. continue;
  4150. }
  4151. diffs = (unsigned long)p->dev ^ (unsigned long)skb->dev;
  4152. diffs |= p->vlan_tci ^ skb->vlan_tci;
  4153. diffs |= skb_metadata_dst_cmp(p, skb);
  4154. diffs |= skb_metadata_differs(p, skb);
  4155. if (maclen == ETH_HLEN)
  4156. diffs |= compare_ether_header(skb_mac_header(p),
  4157. skb_mac_header(skb));
  4158. else if (!diffs)
  4159. diffs = memcmp(skb_mac_header(p),
  4160. skb_mac_header(skb),
  4161. maclen);
  4162. NAPI_GRO_CB(p)->same_flow = !diffs;
  4163. }
  4164. }
  4165. static void skb_gro_reset_offset(struct sk_buff *skb)
  4166. {
  4167. const struct skb_shared_info *pinfo = skb_shinfo(skb);
  4168. const skb_frag_t *frag0 = &pinfo->frags[0];
  4169. NAPI_GRO_CB(skb)->data_offset = 0;
  4170. NAPI_GRO_CB(skb)->frag0 = NULL;
  4171. NAPI_GRO_CB(skb)->frag0_len = 0;
  4172. if (skb_mac_header(skb) == skb_tail_pointer(skb) &&
  4173. pinfo->nr_frags &&
  4174. !PageHighMem(skb_frag_page(frag0))) {
  4175. NAPI_GRO_CB(skb)->frag0 = skb_frag_address(frag0);
  4176. NAPI_GRO_CB(skb)->frag0_len = min_t(unsigned int,
  4177. skb_frag_size(frag0),
  4178. skb->end - skb->tail);
  4179. }
  4180. }
  4181. static void gro_pull_from_frag0(struct sk_buff *skb, int grow)
  4182. {
  4183. struct skb_shared_info *pinfo = skb_shinfo(skb);
  4184. BUG_ON(skb->end - skb->tail < grow);
  4185. memcpy(skb_tail_pointer(skb), NAPI_GRO_CB(skb)->frag0, grow);
  4186. skb->data_len -= grow;
  4187. skb->tail += grow;
  4188. pinfo->frags[0].page_offset += grow;
  4189. skb_frag_size_sub(&pinfo->frags[0], grow);
  4190. if (unlikely(!skb_frag_size(&pinfo->frags[0]))) {
  4191. skb_frag_unref(skb, 0);
  4192. memmove(pinfo->frags, pinfo->frags + 1,
  4193. --pinfo->nr_frags * sizeof(pinfo->frags[0]));
  4194. }
  4195. }
  4196. static enum gro_result dev_gro_receive(struct napi_struct *napi, struct sk_buff *skb)
  4197. {
  4198. struct sk_buff **pp = NULL;
  4199. struct packet_offload *ptype;
  4200. __be16 type = skb->protocol;
  4201. struct list_head *head = &offload_base;
  4202. int same_flow;
  4203. enum gro_result ret;
  4204. int grow;
  4205. if (netif_elide_gro(skb->dev))
  4206. goto normal;
  4207. gro_list_prepare(napi, skb);
  4208. rcu_read_lock();
  4209. list_for_each_entry_rcu(ptype, head, list) {
  4210. if (ptype->type != type || !ptype->callbacks.gro_receive)
  4211. continue;
  4212. skb_set_network_header(skb, skb_gro_offset(skb));
  4213. skb_reset_mac_len(skb);
  4214. NAPI_GRO_CB(skb)->same_flow = 0;
  4215. NAPI_GRO_CB(skb)->flush = skb_is_gso(skb) || skb_has_frag_list(skb);
  4216. NAPI_GRO_CB(skb)->free = 0;
  4217. NAPI_GRO_CB(skb)->encap_mark = 0;
  4218. NAPI_GRO_CB(skb)->recursion_counter = 0;
  4219. NAPI_GRO_CB(skb)->is_fou = 0;
  4220. NAPI_GRO_CB(skb)->is_atomic = 1;
  4221. NAPI_GRO_CB(skb)->gro_remcsum_start = 0;
  4222. /* Setup for GRO checksum validation */
  4223. switch (skb->ip_summed) {
  4224. case CHECKSUM_COMPLETE:
  4225. NAPI_GRO_CB(skb)->csum = skb->csum;
  4226. NAPI_GRO_CB(skb)->csum_valid = 1;
  4227. NAPI_GRO_CB(skb)->csum_cnt = 0;
  4228. break;
  4229. case CHECKSUM_UNNECESSARY:
  4230. NAPI_GRO_CB(skb)->csum_cnt = skb->csum_level + 1;
  4231. NAPI_GRO_CB(skb)->csum_valid = 0;
  4232. break;
  4233. default:
  4234. NAPI_GRO_CB(skb)->csum_cnt = 0;
  4235. NAPI_GRO_CB(skb)->csum_valid = 0;
  4236. }
  4237. pp = ptype->callbacks.gro_receive(&napi->gro_list, skb);
  4238. break;
  4239. }
  4240. rcu_read_unlock();
  4241. if (&ptype->list == head)
  4242. goto normal;
  4243. if (IS_ERR(pp) && PTR_ERR(pp) == -EINPROGRESS) {
  4244. ret = GRO_CONSUMED;
  4245. goto ok;
  4246. }
  4247. same_flow = NAPI_GRO_CB(skb)->same_flow;
  4248. ret = NAPI_GRO_CB(skb)->free ? GRO_MERGED_FREE : GRO_MERGED;
  4249. if (pp) {
  4250. struct sk_buff *nskb = *pp;
  4251. *pp = nskb->next;
  4252. nskb->next = NULL;
  4253. napi_gro_complete(nskb);
  4254. napi->gro_count--;
  4255. }
  4256. if (same_flow)
  4257. goto ok;
  4258. if (NAPI_GRO_CB(skb)->flush)
  4259. goto normal;
  4260. if (unlikely(napi->gro_count >= MAX_GRO_SKBS)) {
  4261. struct sk_buff *nskb = napi->gro_list;
  4262. /* locate the end of the list to select the 'oldest' flow */
  4263. while (nskb->next) {
  4264. pp = &nskb->next;
  4265. nskb = *pp;
  4266. }
  4267. *pp = NULL;
  4268. nskb->next = NULL;
  4269. napi_gro_complete(nskb);
  4270. } else {
  4271. napi->gro_count++;
  4272. }
  4273. NAPI_GRO_CB(skb)->count = 1;
  4274. NAPI_GRO_CB(skb)->age = jiffies;
  4275. NAPI_GRO_CB(skb)->last = skb;
  4276. skb_shinfo(skb)->gso_size = skb_gro_len(skb);
  4277. skb->next = napi->gro_list;
  4278. napi->gro_list = skb;
  4279. ret = GRO_HELD;
  4280. pull:
  4281. grow = skb_gro_offset(skb) - skb_headlen(skb);
  4282. if (grow > 0)
  4283. gro_pull_from_frag0(skb, grow);
  4284. ok:
  4285. return ret;
  4286. normal:
  4287. ret = GRO_NORMAL;
  4288. goto pull;
  4289. }
  4290. struct packet_offload *gro_find_receive_by_type(__be16 type)
  4291. {
  4292. struct list_head *offload_head = &offload_base;
  4293. struct packet_offload *ptype;
  4294. list_for_each_entry_rcu(ptype, offload_head, list) {
  4295. if (ptype->type != type || !ptype->callbacks.gro_receive)
  4296. continue;
  4297. return ptype;
  4298. }
  4299. return NULL;
  4300. }
  4301. EXPORT_SYMBOL(gro_find_receive_by_type);
  4302. struct packet_offload *gro_find_complete_by_type(__be16 type)
  4303. {
  4304. struct list_head *offload_head = &offload_base;
  4305. struct packet_offload *ptype;
  4306. list_for_each_entry_rcu(ptype, offload_head, list) {
  4307. if (ptype->type != type || !ptype->callbacks.gro_complete)
  4308. continue;
  4309. return ptype;
  4310. }
  4311. return NULL;
  4312. }
  4313. EXPORT_SYMBOL(gro_find_complete_by_type);
  4314. static void napi_skb_free_stolen_head(struct sk_buff *skb)
  4315. {
  4316. skb_dst_drop(skb);
  4317. secpath_reset(skb);
  4318. kmem_cache_free(skbuff_head_cache, skb);
  4319. }
  4320. static gro_result_t napi_skb_finish(gro_result_t ret, struct sk_buff *skb)
  4321. {
  4322. switch (ret) {
  4323. case GRO_NORMAL:
  4324. if (netif_receive_skb_internal(skb))
  4325. ret = GRO_DROP;
  4326. break;
  4327. case GRO_DROP:
  4328. kfree_skb(skb);
  4329. break;
  4330. case GRO_MERGED_FREE:
  4331. if (NAPI_GRO_CB(skb)->free == NAPI_GRO_FREE_STOLEN_HEAD)
  4332. napi_skb_free_stolen_head(skb);
  4333. else
  4334. __kfree_skb(skb);
  4335. break;
  4336. case GRO_HELD:
  4337. case GRO_MERGED:
  4338. case GRO_CONSUMED:
  4339. break;
  4340. }
  4341. return ret;
  4342. }
  4343. gro_result_t napi_gro_receive(struct napi_struct *napi, struct sk_buff *skb)
  4344. {
  4345. skb_mark_napi_id(skb, napi);
  4346. trace_napi_gro_receive_entry(skb);
  4347. skb_gro_reset_offset(skb);
  4348. return napi_skb_finish(dev_gro_receive(napi, skb), skb);
  4349. }
  4350. EXPORT_SYMBOL(napi_gro_receive);
  4351. static void napi_reuse_skb(struct napi_struct *napi, struct sk_buff *skb)
  4352. {
  4353. if (unlikely(skb->pfmemalloc)) {
  4354. consume_skb(skb);
  4355. return;
  4356. }
  4357. __skb_pull(skb, skb_headlen(skb));
  4358. /* restore the reserve we had after netdev_alloc_skb_ip_align() */
  4359. skb_reserve(skb, NET_SKB_PAD + NET_IP_ALIGN - skb_headroom(skb));
  4360. skb->vlan_tci = 0;
  4361. skb->dev = napi->dev;
  4362. skb->skb_iif = 0;
  4363. skb->encapsulation = 0;
  4364. skb_shinfo(skb)->gso_type = 0;
  4365. skb->truesize = SKB_TRUESIZE(skb_end_offset(skb));
  4366. secpath_reset(skb);
  4367. napi->skb = skb;
  4368. }
  4369. struct sk_buff *napi_get_frags(struct napi_struct *napi)
  4370. {
  4371. struct sk_buff *skb = napi->skb;
  4372. if (!skb) {
  4373. skb = napi_alloc_skb(napi, GRO_MAX_HEAD);
  4374. if (skb) {
  4375. napi->skb = skb;
  4376. skb_mark_napi_id(skb, napi);
  4377. }
  4378. }
  4379. return skb;
  4380. }
  4381. EXPORT_SYMBOL(napi_get_frags);
  4382. static gro_result_t napi_frags_finish(struct napi_struct *napi,
  4383. struct sk_buff *skb,
  4384. gro_result_t ret)
  4385. {
  4386. switch (ret) {
  4387. case GRO_NORMAL:
  4388. case GRO_HELD:
  4389. __skb_push(skb, ETH_HLEN);
  4390. skb->protocol = eth_type_trans(skb, skb->dev);
  4391. if (ret == GRO_NORMAL && netif_receive_skb_internal(skb))
  4392. ret = GRO_DROP;
  4393. break;
  4394. case GRO_DROP:
  4395. napi_reuse_skb(napi, skb);
  4396. break;
  4397. case GRO_MERGED_FREE:
  4398. if (NAPI_GRO_CB(skb)->free == NAPI_GRO_FREE_STOLEN_HEAD)
  4399. napi_skb_free_stolen_head(skb);
  4400. else
  4401. napi_reuse_skb(napi, skb);
  4402. break;
  4403. case GRO_MERGED:
  4404. case GRO_CONSUMED:
  4405. break;
  4406. }
  4407. return ret;
  4408. }
  4409. /* Upper GRO stack assumes network header starts at gro_offset=0
  4410. * Drivers could call both napi_gro_frags() and napi_gro_receive()
  4411. * We copy ethernet header into skb->data to have a common layout.
  4412. */
  4413. static struct sk_buff *napi_frags_skb(struct napi_struct *napi)
  4414. {
  4415. struct sk_buff *skb = napi->skb;
  4416. const struct ethhdr *eth;
  4417. unsigned int hlen = sizeof(*eth);
  4418. napi->skb = NULL;
  4419. skb_reset_mac_header(skb);
  4420. skb_gro_reset_offset(skb);
  4421. eth = skb_gro_header_fast(skb, 0);
  4422. if (unlikely(skb_gro_header_hard(skb, hlen))) {
  4423. eth = skb_gro_header_slow(skb, hlen, 0);
  4424. if (unlikely(!eth)) {
  4425. net_warn_ratelimited("%s: dropping impossible skb from %s\n",
  4426. __func__, napi->dev->name);
  4427. napi_reuse_skb(napi, skb);
  4428. return NULL;
  4429. }
  4430. } else {
  4431. gro_pull_from_frag0(skb, hlen);
  4432. NAPI_GRO_CB(skb)->frag0 += hlen;
  4433. NAPI_GRO_CB(skb)->frag0_len -= hlen;
  4434. }
  4435. __skb_pull(skb, hlen);
  4436. /*
  4437. * This works because the only protocols we care about don't require
  4438. * special handling.
  4439. * We'll fix it up properly in napi_frags_finish()
  4440. */
  4441. skb->protocol = eth->h_proto;
  4442. return skb;
  4443. }
  4444. gro_result_t napi_gro_frags(struct napi_struct *napi)
  4445. {
  4446. struct sk_buff *skb = napi_frags_skb(napi);
  4447. if (!skb)
  4448. return GRO_DROP;
  4449. trace_napi_gro_frags_entry(skb);
  4450. return napi_frags_finish(napi, skb, dev_gro_receive(napi, skb));
  4451. }
  4452. EXPORT_SYMBOL(napi_gro_frags);
  4453. /* Compute the checksum from gro_offset and return the folded value
  4454. * after adding in any pseudo checksum.
  4455. */
  4456. __sum16 __skb_gro_checksum_complete(struct sk_buff *skb)
  4457. {
  4458. __wsum wsum;
  4459. __sum16 sum;
  4460. wsum = skb_checksum(skb, skb_gro_offset(skb), skb_gro_len(skb), 0);
  4461. /* NAPI_GRO_CB(skb)->csum holds pseudo checksum */
  4462. sum = csum_fold(csum_add(NAPI_GRO_CB(skb)->csum, wsum));
  4463. if (likely(!sum)) {
  4464. if (unlikely(skb->ip_summed == CHECKSUM_COMPLETE) &&
  4465. !skb->csum_complete_sw)
  4466. netdev_rx_csum_fault(skb->dev);
  4467. }
  4468. NAPI_GRO_CB(skb)->csum = wsum;
  4469. NAPI_GRO_CB(skb)->csum_valid = 1;
  4470. return sum;
  4471. }
  4472. EXPORT_SYMBOL(__skb_gro_checksum_complete);
  4473. static void net_rps_send_ipi(struct softnet_data *remsd)
  4474. {
  4475. #ifdef CONFIG_RPS
  4476. while (remsd) {
  4477. struct softnet_data *next = remsd->rps_ipi_next;
  4478. if (cpu_online(remsd->cpu))
  4479. smp_call_function_single_async(remsd->cpu, &remsd->csd);
  4480. remsd = next;
  4481. }
  4482. #endif
  4483. }
  4484. /*
  4485. * net_rps_action_and_irq_enable sends any pending IPI's for rps.
  4486. * Note: called with local irq disabled, but exits with local irq enabled.
  4487. */
  4488. static void net_rps_action_and_irq_enable(struct softnet_data *sd)
  4489. {
  4490. #ifdef CONFIG_RPS
  4491. struct softnet_data *remsd = sd->rps_ipi_list;
  4492. if (remsd) {
  4493. sd->rps_ipi_list = NULL;
  4494. local_irq_enable();
  4495. /* Send pending IPI's to kick RPS processing on remote cpus. */
  4496. net_rps_send_ipi(remsd);
  4497. } else
  4498. #endif
  4499. local_irq_enable();
  4500. }
  4501. static bool sd_has_rps_ipi_waiting(struct softnet_data *sd)
  4502. {
  4503. #ifdef CONFIG_RPS
  4504. return sd->rps_ipi_list != NULL;
  4505. #else
  4506. return false;
  4507. #endif
  4508. }
  4509. static int process_backlog(struct napi_struct *napi, int quota)
  4510. {
  4511. struct softnet_data *sd = container_of(napi, struct softnet_data, backlog);
  4512. bool again = true;
  4513. int work = 0;
  4514. /* Check if we have pending ipi, its better to send them now,
  4515. * not waiting net_rx_action() end.
  4516. */
  4517. if (sd_has_rps_ipi_waiting(sd)) {
  4518. local_irq_disable();
  4519. net_rps_action_and_irq_enable(sd);
  4520. }
  4521. napi->weight = dev_rx_weight;
  4522. while (again) {
  4523. struct sk_buff *skb;
  4524. while ((skb = __skb_dequeue(&sd->process_queue))) {
  4525. rcu_read_lock();
  4526. __netif_receive_skb(skb);
  4527. rcu_read_unlock();
  4528. input_queue_head_incr(sd);
  4529. if (++work >= quota)
  4530. return work;
  4531. }
  4532. local_irq_disable();
  4533. rps_lock(sd);
  4534. if (skb_queue_empty(&sd->input_pkt_queue)) {
  4535. /*
  4536. * Inline a custom version of __napi_complete().
  4537. * only current cpu owns and manipulates this napi,
  4538. * and NAPI_STATE_SCHED is the only possible flag set
  4539. * on backlog.
  4540. * We can use a plain write instead of clear_bit(),
  4541. * and we dont need an smp_mb() memory barrier.
  4542. */
  4543. napi->state = 0;
  4544. again = false;
  4545. } else {
  4546. skb_queue_splice_tail_init(&sd->input_pkt_queue,
  4547. &sd->process_queue);
  4548. }
  4549. rps_unlock(sd);
  4550. local_irq_enable();
  4551. }
  4552. return work;
  4553. }
  4554. /**
  4555. * __napi_schedule - schedule for receive
  4556. * @n: entry to schedule
  4557. *
  4558. * The entry's receive function will be scheduled to run.
  4559. * Consider using __napi_schedule_irqoff() if hard irqs are masked.
  4560. */
  4561. void __napi_schedule(struct napi_struct *n)
  4562. {
  4563. unsigned long flags;
  4564. local_irq_save(flags);
  4565. ____napi_schedule(this_cpu_ptr(&softnet_data), n);
  4566. local_irq_restore(flags);
  4567. }
  4568. EXPORT_SYMBOL(__napi_schedule);
  4569. /**
  4570. * napi_schedule_prep - check if napi can be scheduled
  4571. * @n: napi context
  4572. *
  4573. * Test if NAPI routine is already running, and if not mark
  4574. * it as running. This is used as a condition variable
  4575. * insure only one NAPI poll instance runs. We also make
  4576. * sure there is no pending NAPI disable.
  4577. */
  4578. bool napi_schedule_prep(struct napi_struct *n)
  4579. {
  4580. unsigned long val, new;
  4581. do {
  4582. val = READ_ONCE(n->state);
  4583. if (unlikely(val & NAPIF_STATE_DISABLE))
  4584. return false;
  4585. new = val | NAPIF_STATE_SCHED;
  4586. /* Sets STATE_MISSED bit if STATE_SCHED was already set
  4587. * This was suggested by Alexander Duyck, as compiler
  4588. * emits better code than :
  4589. * if (val & NAPIF_STATE_SCHED)
  4590. * new |= NAPIF_STATE_MISSED;
  4591. */
  4592. new |= (val & NAPIF_STATE_SCHED) / NAPIF_STATE_SCHED *
  4593. NAPIF_STATE_MISSED;
  4594. } while (cmpxchg(&n->state, val, new) != val);
  4595. return !(val & NAPIF_STATE_SCHED);
  4596. }
  4597. EXPORT_SYMBOL(napi_schedule_prep);
  4598. /**
  4599. * __napi_schedule_irqoff - schedule for receive
  4600. * @n: entry to schedule
  4601. *
  4602. * Variant of __napi_schedule() assuming hard irqs are masked
  4603. */
  4604. void __napi_schedule_irqoff(struct napi_struct *n)
  4605. {
  4606. ____napi_schedule(this_cpu_ptr(&softnet_data), n);
  4607. }
  4608. EXPORT_SYMBOL(__napi_schedule_irqoff);
  4609. bool napi_complete_done(struct napi_struct *n, int work_done)
  4610. {
  4611. unsigned long flags, val, new;
  4612. /*
  4613. * 1) Don't let napi dequeue from the cpu poll list
  4614. * just in case its running on a different cpu.
  4615. * 2) If we are busy polling, do nothing here, we have
  4616. * the guarantee we will be called later.
  4617. */
  4618. if (unlikely(n->state & (NAPIF_STATE_NPSVC |
  4619. NAPIF_STATE_IN_BUSY_POLL)))
  4620. return false;
  4621. if (n->gro_list) {
  4622. unsigned long timeout = 0;
  4623. if (work_done)
  4624. timeout = n->dev->gro_flush_timeout;
  4625. if (timeout)
  4626. hrtimer_start(&n->timer, ns_to_ktime(timeout),
  4627. HRTIMER_MODE_REL_PINNED);
  4628. else
  4629. napi_gro_flush(n, false);
  4630. }
  4631. if (unlikely(!list_empty(&n->poll_list))) {
  4632. /* If n->poll_list is not empty, we need to mask irqs */
  4633. local_irq_save(flags);
  4634. list_del_init(&n->poll_list);
  4635. local_irq_restore(flags);
  4636. }
  4637. do {
  4638. val = READ_ONCE(n->state);
  4639. WARN_ON_ONCE(!(val & NAPIF_STATE_SCHED));
  4640. new = val & ~(NAPIF_STATE_MISSED | NAPIF_STATE_SCHED);
  4641. /* If STATE_MISSED was set, leave STATE_SCHED set,
  4642. * because we will call napi->poll() one more time.
  4643. * This C code was suggested by Alexander Duyck to help gcc.
  4644. */
  4645. new |= (val & NAPIF_STATE_MISSED) / NAPIF_STATE_MISSED *
  4646. NAPIF_STATE_SCHED;
  4647. } while (cmpxchg(&n->state, val, new) != val);
  4648. if (unlikely(val & NAPIF_STATE_MISSED)) {
  4649. __napi_schedule(n);
  4650. return false;
  4651. }
  4652. return true;
  4653. }
  4654. EXPORT_SYMBOL(napi_complete_done);
  4655. /* must be called under rcu_read_lock(), as we dont take a reference */
  4656. static struct napi_struct *napi_by_id(unsigned int napi_id)
  4657. {
  4658. unsigned int hash = napi_id % HASH_SIZE(napi_hash);
  4659. struct napi_struct *napi;
  4660. hlist_for_each_entry_rcu(napi, &napi_hash[hash], napi_hash_node)
  4661. if (napi->napi_id == napi_id)
  4662. return napi;
  4663. return NULL;
  4664. }
  4665. #if defined(CONFIG_NET_RX_BUSY_POLL)
  4666. #define BUSY_POLL_BUDGET 8
  4667. static void busy_poll_stop(struct napi_struct *napi, void *have_poll_lock)
  4668. {
  4669. int rc;
  4670. /* Busy polling means there is a high chance device driver hard irq
  4671. * could not grab NAPI_STATE_SCHED, and that NAPI_STATE_MISSED was
  4672. * set in napi_schedule_prep().
  4673. * Since we are about to call napi->poll() once more, we can safely
  4674. * clear NAPI_STATE_MISSED.
  4675. *
  4676. * Note: x86 could use a single "lock and ..." instruction
  4677. * to perform these two clear_bit()
  4678. */
  4679. clear_bit(NAPI_STATE_MISSED, &napi->state);
  4680. clear_bit(NAPI_STATE_IN_BUSY_POLL, &napi->state);
  4681. local_bh_disable();
  4682. /* All we really want here is to re-enable device interrupts.
  4683. * Ideally, a new ndo_busy_poll_stop() could avoid another round.
  4684. */
  4685. rc = napi->poll(napi, BUSY_POLL_BUDGET);
  4686. trace_napi_poll(napi, rc, BUSY_POLL_BUDGET);
  4687. netpoll_poll_unlock(have_poll_lock);
  4688. if (rc == BUSY_POLL_BUDGET)
  4689. __napi_schedule(napi);
  4690. local_bh_enable();
  4691. }
  4692. void napi_busy_loop(unsigned int napi_id,
  4693. bool (*loop_end)(void *, unsigned long),
  4694. void *loop_end_arg)
  4695. {
  4696. unsigned long start_time = loop_end ? busy_loop_current_time() : 0;
  4697. int (*napi_poll)(struct napi_struct *napi, int budget);
  4698. void *have_poll_lock = NULL;
  4699. struct napi_struct *napi;
  4700. restart:
  4701. napi_poll = NULL;
  4702. rcu_read_lock();
  4703. napi = napi_by_id(napi_id);
  4704. if (!napi)
  4705. goto out;
  4706. preempt_disable();
  4707. for (;;) {
  4708. int work = 0;
  4709. local_bh_disable();
  4710. if (!napi_poll) {
  4711. unsigned long val = READ_ONCE(napi->state);
  4712. /* If multiple threads are competing for this napi,
  4713. * we avoid dirtying napi->state as much as we can.
  4714. */
  4715. if (val & (NAPIF_STATE_DISABLE | NAPIF_STATE_SCHED |
  4716. NAPIF_STATE_IN_BUSY_POLL))
  4717. goto count;
  4718. if (cmpxchg(&napi->state, val,
  4719. val | NAPIF_STATE_IN_BUSY_POLL |
  4720. NAPIF_STATE_SCHED) != val)
  4721. goto count;
  4722. have_poll_lock = netpoll_poll_lock(napi);
  4723. napi_poll = napi->poll;
  4724. }
  4725. work = napi_poll(napi, BUSY_POLL_BUDGET);
  4726. trace_napi_poll(napi, work, BUSY_POLL_BUDGET);
  4727. count:
  4728. if (work > 0)
  4729. __NET_ADD_STATS(dev_net(napi->dev),
  4730. LINUX_MIB_BUSYPOLLRXPACKETS, work);
  4731. local_bh_enable();
  4732. if (!loop_end || loop_end(loop_end_arg, start_time))
  4733. break;
  4734. if (unlikely(need_resched())) {
  4735. if (napi_poll)
  4736. busy_poll_stop(napi, have_poll_lock);
  4737. preempt_enable();
  4738. rcu_read_unlock();
  4739. cond_resched();
  4740. if (loop_end(loop_end_arg, start_time))
  4741. return;
  4742. goto restart;
  4743. }
  4744. cpu_relax();
  4745. }
  4746. if (napi_poll)
  4747. busy_poll_stop(napi, have_poll_lock);
  4748. preempt_enable();
  4749. out:
  4750. rcu_read_unlock();
  4751. }
  4752. EXPORT_SYMBOL(napi_busy_loop);
  4753. #endif /* CONFIG_NET_RX_BUSY_POLL */
  4754. static void napi_hash_add(struct napi_struct *napi)
  4755. {
  4756. if (test_bit(NAPI_STATE_NO_BUSY_POLL, &napi->state) ||
  4757. test_and_set_bit(NAPI_STATE_HASHED, &napi->state))
  4758. return;
  4759. spin_lock(&napi_hash_lock);
  4760. /* 0..NR_CPUS range is reserved for sender_cpu use */
  4761. do {
  4762. if (unlikely(++napi_gen_id < MIN_NAPI_ID))
  4763. napi_gen_id = MIN_NAPI_ID;
  4764. } while (napi_by_id(napi_gen_id));
  4765. napi->napi_id = napi_gen_id;
  4766. hlist_add_head_rcu(&napi->napi_hash_node,
  4767. &napi_hash[napi->napi_id % HASH_SIZE(napi_hash)]);
  4768. spin_unlock(&napi_hash_lock);
  4769. }
  4770. /* Warning : caller is responsible to make sure rcu grace period
  4771. * is respected before freeing memory containing @napi
  4772. */
  4773. bool napi_hash_del(struct napi_struct *napi)
  4774. {
  4775. bool rcu_sync_needed = false;
  4776. spin_lock(&napi_hash_lock);
  4777. if (test_and_clear_bit(NAPI_STATE_HASHED, &napi->state)) {
  4778. rcu_sync_needed = true;
  4779. hlist_del_rcu(&napi->napi_hash_node);
  4780. }
  4781. spin_unlock(&napi_hash_lock);
  4782. return rcu_sync_needed;
  4783. }
  4784. EXPORT_SYMBOL_GPL(napi_hash_del);
  4785. static enum hrtimer_restart napi_watchdog(struct hrtimer *timer)
  4786. {
  4787. struct napi_struct *napi;
  4788. napi = container_of(timer, struct napi_struct, timer);
  4789. /* Note : we use a relaxed variant of napi_schedule_prep() not setting
  4790. * NAPI_STATE_MISSED, since we do not react to a device IRQ.
  4791. */
  4792. if (napi->gro_list && !napi_disable_pending(napi) &&
  4793. !test_and_set_bit(NAPI_STATE_SCHED, &napi->state))
  4794. __napi_schedule_irqoff(napi);
  4795. return HRTIMER_NORESTART;
  4796. }
  4797. void netif_napi_add(struct net_device *dev, struct napi_struct *napi,
  4798. int (*poll)(struct napi_struct *, int), int weight)
  4799. {
  4800. INIT_LIST_HEAD(&napi->poll_list);
  4801. hrtimer_init(&napi->timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL_PINNED);
  4802. napi->timer.function = napi_watchdog;
  4803. napi->gro_count = 0;
  4804. napi->gro_list = NULL;
  4805. napi->skb = NULL;
  4806. napi->poll = poll;
  4807. if (weight > NAPI_POLL_WEIGHT)
  4808. pr_err_once("netif_napi_add() called with weight %d on device %s\n",
  4809. weight, dev->name);
  4810. napi->weight = weight;
  4811. list_add(&napi->dev_list, &dev->napi_list);
  4812. napi->dev = dev;
  4813. #ifdef CONFIG_NETPOLL
  4814. napi->poll_owner = -1;
  4815. #endif
  4816. set_bit(NAPI_STATE_SCHED, &napi->state);
  4817. napi_hash_add(napi);
  4818. }
  4819. EXPORT_SYMBOL(netif_napi_add);
  4820. void napi_disable(struct napi_struct *n)
  4821. {
  4822. might_sleep();
  4823. set_bit(NAPI_STATE_DISABLE, &n->state);
  4824. while (test_and_set_bit(NAPI_STATE_SCHED, &n->state))
  4825. msleep(1);
  4826. while (test_and_set_bit(NAPI_STATE_NPSVC, &n->state))
  4827. msleep(1);
  4828. hrtimer_cancel(&n->timer);
  4829. clear_bit(NAPI_STATE_DISABLE, &n->state);
  4830. }
  4831. EXPORT_SYMBOL(napi_disable);
  4832. /* Must be called in process context */
  4833. void netif_napi_del(struct napi_struct *napi)
  4834. {
  4835. might_sleep();
  4836. if (napi_hash_del(napi))
  4837. synchronize_net();
  4838. list_del_init(&napi->dev_list);
  4839. napi_free_frags(napi);
  4840. kfree_skb_list(napi->gro_list);
  4841. napi->gro_list = NULL;
  4842. napi->gro_count = 0;
  4843. }
  4844. EXPORT_SYMBOL(netif_napi_del);
  4845. static int napi_poll(struct napi_struct *n, struct list_head *repoll)
  4846. {
  4847. void *have;
  4848. int work, weight;
  4849. list_del_init(&n->poll_list);
  4850. have = netpoll_poll_lock(n);
  4851. weight = n->weight;
  4852. /* This NAPI_STATE_SCHED test is for avoiding a race
  4853. * with netpoll's poll_napi(). Only the entity which
  4854. * obtains the lock and sees NAPI_STATE_SCHED set will
  4855. * actually make the ->poll() call. Therefore we avoid
  4856. * accidentally calling ->poll() when NAPI is not scheduled.
  4857. */
  4858. work = 0;
  4859. if (test_bit(NAPI_STATE_SCHED, &n->state)) {
  4860. work = n->poll(n, weight);
  4861. trace_napi_poll(n, work, weight);
  4862. }
  4863. WARN_ON_ONCE(work > weight);
  4864. if (likely(work < weight))
  4865. goto out_unlock;
  4866. /* Drivers must not modify the NAPI state if they
  4867. * consume the entire weight. In such cases this code
  4868. * still "owns" the NAPI instance and therefore can
  4869. * move the instance around on the list at-will.
  4870. */
  4871. if (unlikely(napi_disable_pending(n))) {
  4872. napi_complete(n);
  4873. goto out_unlock;
  4874. }
  4875. if (n->gro_list) {
  4876. /* flush too old packets
  4877. * If HZ < 1000, flush all packets.
  4878. */
  4879. napi_gro_flush(n, HZ >= 1000);
  4880. }
  4881. /* Some drivers may have called napi_schedule
  4882. * prior to exhausting their budget.
  4883. */
  4884. if (unlikely(!list_empty(&n->poll_list))) {
  4885. pr_warn_once("%s: Budget exhausted after napi rescheduled\n",
  4886. n->dev ? n->dev->name : "backlog");
  4887. goto out_unlock;
  4888. }
  4889. list_add_tail(&n->poll_list, repoll);
  4890. out_unlock:
  4891. netpoll_poll_unlock(have);
  4892. return work;
  4893. }
  4894. static __latent_entropy void net_rx_action(struct softirq_action *h)
  4895. {
  4896. struct softnet_data *sd = this_cpu_ptr(&softnet_data);
  4897. unsigned long time_limit = jiffies +
  4898. usecs_to_jiffies(netdev_budget_usecs);
  4899. int budget = netdev_budget;
  4900. LIST_HEAD(list);
  4901. LIST_HEAD(repoll);
  4902. local_irq_disable();
  4903. list_splice_init(&sd->poll_list, &list);
  4904. local_irq_enable();
  4905. for (;;) {
  4906. struct napi_struct *n;
  4907. if (list_empty(&list)) {
  4908. if (!sd_has_rps_ipi_waiting(sd) && list_empty(&repoll))
  4909. goto out;
  4910. break;
  4911. }
  4912. n = list_first_entry(&list, struct napi_struct, poll_list);
  4913. budget -= napi_poll(n, &repoll);
  4914. /* If softirq window is exhausted then punt.
  4915. * Allow this to run for 2 jiffies since which will allow
  4916. * an average latency of 1.5/HZ.
  4917. */
  4918. if (unlikely(budget <= 0 ||
  4919. time_after_eq(jiffies, time_limit))) {
  4920. sd->time_squeeze++;
  4921. break;
  4922. }
  4923. }
  4924. local_irq_disable();
  4925. list_splice_tail_init(&sd->poll_list, &list);
  4926. list_splice_tail(&repoll, &list);
  4927. list_splice(&list, &sd->poll_list);
  4928. if (!list_empty(&sd->poll_list))
  4929. __raise_softirq_irqoff(NET_RX_SOFTIRQ);
  4930. net_rps_action_and_irq_enable(sd);
  4931. out:
  4932. __kfree_skb_flush();
  4933. }
  4934. struct netdev_adjacent {
  4935. struct net_device *dev;
  4936. /* upper master flag, there can only be one master device per list */
  4937. bool master;
  4938. /* counter for the number of times this device was added to us */
  4939. u16 ref_nr;
  4940. /* private field for the users */
  4941. void *private;
  4942. struct list_head list;
  4943. struct rcu_head rcu;
  4944. };
  4945. static struct netdev_adjacent *__netdev_find_adj(struct net_device *adj_dev,
  4946. struct list_head *adj_list)
  4947. {
  4948. struct netdev_adjacent *adj;
  4949. list_for_each_entry(adj, adj_list, list) {
  4950. if (adj->dev == adj_dev)
  4951. return adj;
  4952. }
  4953. return NULL;
  4954. }
  4955. static int __netdev_has_upper_dev(struct net_device *upper_dev, void *data)
  4956. {
  4957. struct net_device *dev = data;
  4958. return upper_dev == dev;
  4959. }
  4960. /**
  4961. * netdev_has_upper_dev - Check if device is linked to an upper device
  4962. * @dev: device
  4963. * @upper_dev: upper device to check
  4964. *
  4965. * Find out if a device is linked to specified upper device and return true
  4966. * in case it is. Note that this checks only immediate upper device,
  4967. * not through a complete stack of devices. The caller must hold the RTNL lock.
  4968. */
  4969. bool netdev_has_upper_dev(struct net_device *dev,
  4970. struct net_device *upper_dev)
  4971. {
  4972. ASSERT_RTNL();
  4973. return netdev_walk_all_upper_dev_rcu(dev, __netdev_has_upper_dev,
  4974. upper_dev);
  4975. }
  4976. EXPORT_SYMBOL(netdev_has_upper_dev);
  4977. /**
  4978. * netdev_has_upper_dev_all - Check if device is linked to an upper device
  4979. * @dev: device
  4980. * @upper_dev: upper device to check
  4981. *
  4982. * Find out if a device is linked to specified upper device and return true
  4983. * in case it is. Note that this checks the entire upper device chain.
  4984. * The caller must hold rcu lock.
  4985. */
  4986. bool netdev_has_upper_dev_all_rcu(struct net_device *dev,
  4987. struct net_device *upper_dev)
  4988. {
  4989. return !!netdev_walk_all_upper_dev_rcu(dev, __netdev_has_upper_dev,
  4990. upper_dev);
  4991. }
  4992. EXPORT_SYMBOL(netdev_has_upper_dev_all_rcu);
  4993. /**
  4994. * netdev_has_any_upper_dev - Check if device is linked to some device
  4995. * @dev: device
  4996. *
  4997. * Find out if a device is linked to an upper device and return true in case
  4998. * it is. The caller must hold the RTNL lock.
  4999. */
  5000. bool netdev_has_any_upper_dev(struct net_device *dev)
  5001. {
  5002. ASSERT_RTNL();
  5003. return !list_empty(&dev->adj_list.upper);
  5004. }
  5005. EXPORT_SYMBOL(netdev_has_any_upper_dev);
  5006. /**
  5007. * netdev_master_upper_dev_get - Get master upper device
  5008. * @dev: device
  5009. *
  5010. * Find a master upper device and return pointer to it or NULL in case
  5011. * it's not there. The caller must hold the RTNL lock.
  5012. */
  5013. struct net_device *netdev_master_upper_dev_get(struct net_device *dev)
  5014. {
  5015. struct netdev_adjacent *upper;
  5016. ASSERT_RTNL();
  5017. if (list_empty(&dev->adj_list.upper))
  5018. return NULL;
  5019. upper = list_first_entry(&dev->adj_list.upper,
  5020. struct netdev_adjacent, list);
  5021. if (likely(upper->master))
  5022. return upper->dev;
  5023. return NULL;
  5024. }
  5025. EXPORT_SYMBOL(netdev_master_upper_dev_get);
  5026. /**
  5027. * netdev_has_any_lower_dev - Check if device is linked to some device
  5028. * @dev: device
  5029. *
  5030. * Find out if a device is linked to a lower device and return true in case
  5031. * it is. The caller must hold the RTNL lock.
  5032. */
  5033. static bool netdev_has_any_lower_dev(struct net_device *dev)
  5034. {
  5035. ASSERT_RTNL();
  5036. return !list_empty(&dev->adj_list.lower);
  5037. }
  5038. void *netdev_adjacent_get_private(struct list_head *adj_list)
  5039. {
  5040. struct netdev_adjacent *adj;
  5041. adj = list_entry(adj_list, struct netdev_adjacent, list);
  5042. return adj->private;
  5043. }
  5044. EXPORT_SYMBOL(netdev_adjacent_get_private);
  5045. /**
  5046. * netdev_upper_get_next_dev_rcu - Get the next dev from upper list
  5047. * @dev: device
  5048. * @iter: list_head ** of the current position
  5049. *
  5050. * Gets the next device from the dev's upper list, starting from iter
  5051. * position. The caller must hold RCU read lock.
  5052. */
  5053. struct net_device *netdev_upper_get_next_dev_rcu(struct net_device *dev,
  5054. struct list_head **iter)
  5055. {
  5056. struct netdev_adjacent *upper;
  5057. WARN_ON_ONCE(!rcu_read_lock_held() && !lockdep_rtnl_is_held());
  5058. upper = list_entry_rcu((*iter)->next, struct netdev_adjacent, list);
  5059. if (&upper->list == &dev->adj_list.upper)
  5060. return NULL;
  5061. *iter = &upper->list;
  5062. return upper->dev;
  5063. }
  5064. EXPORT_SYMBOL(netdev_upper_get_next_dev_rcu);
  5065. static struct net_device *netdev_next_upper_dev_rcu(struct net_device *dev,
  5066. struct list_head **iter)
  5067. {
  5068. struct netdev_adjacent *upper;
  5069. WARN_ON_ONCE(!rcu_read_lock_held() && !lockdep_rtnl_is_held());
  5070. upper = list_entry_rcu((*iter)->next, struct netdev_adjacent, list);
  5071. if (&upper->list == &dev->adj_list.upper)
  5072. return NULL;
  5073. *iter = &upper->list;
  5074. return upper->dev;
  5075. }
  5076. int netdev_walk_all_upper_dev_rcu(struct net_device *dev,
  5077. int (*fn)(struct net_device *dev,
  5078. void *data),
  5079. void *data)
  5080. {
  5081. struct net_device *udev;
  5082. struct list_head *iter;
  5083. int ret;
  5084. for (iter = &dev->adj_list.upper,
  5085. udev = netdev_next_upper_dev_rcu(dev, &iter);
  5086. udev;
  5087. udev = netdev_next_upper_dev_rcu(dev, &iter)) {
  5088. /* first is the upper device itself */
  5089. ret = fn(udev, data);
  5090. if (ret)
  5091. return ret;
  5092. /* then look at all of its upper devices */
  5093. ret = netdev_walk_all_upper_dev_rcu(udev, fn, data);
  5094. if (ret)
  5095. return ret;
  5096. }
  5097. return 0;
  5098. }
  5099. EXPORT_SYMBOL_GPL(netdev_walk_all_upper_dev_rcu);
  5100. /**
  5101. * netdev_lower_get_next_private - Get the next ->private from the
  5102. * lower neighbour list
  5103. * @dev: device
  5104. * @iter: list_head ** of the current position
  5105. *
  5106. * Gets the next netdev_adjacent->private from the dev's lower neighbour
  5107. * list, starting from iter position. The caller must hold either hold the
  5108. * RTNL lock or its own locking that guarantees that the neighbour lower
  5109. * list will remain unchanged.
  5110. */
  5111. void *netdev_lower_get_next_private(struct net_device *dev,
  5112. struct list_head **iter)
  5113. {
  5114. struct netdev_adjacent *lower;
  5115. lower = list_entry(*iter, struct netdev_adjacent, list);
  5116. if (&lower->list == &dev->adj_list.lower)
  5117. return NULL;
  5118. *iter = lower->list.next;
  5119. return lower->private;
  5120. }
  5121. EXPORT_SYMBOL(netdev_lower_get_next_private);
  5122. /**
  5123. * netdev_lower_get_next_private_rcu - Get the next ->private from the
  5124. * lower neighbour list, RCU
  5125. * variant
  5126. * @dev: device
  5127. * @iter: list_head ** of the current position
  5128. *
  5129. * Gets the next netdev_adjacent->private from the dev's lower neighbour
  5130. * list, starting from iter position. The caller must hold RCU read lock.
  5131. */
  5132. void *netdev_lower_get_next_private_rcu(struct net_device *dev,
  5133. struct list_head **iter)
  5134. {
  5135. struct netdev_adjacent *lower;
  5136. WARN_ON_ONCE(!rcu_read_lock_held());
  5137. lower = list_entry_rcu((*iter)->next, struct netdev_adjacent, list);
  5138. if (&lower->list == &dev->adj_list.lower)
  5139. return NULL;
  5140. *iter = &lower->list;
  5141. return lower->private;
  5142. }
  5143. EXPORT_SYMBOL(netdev_lower_get_next_private_rcu);
  5144. /**
  5145. * netdev_lower_get_next - Get the next device from the lower neighbour
  5146. * list
  5147. * @dev: device
  5148. * @iter: list_head ** of the current position
  5149. *
  5150. * Gets the next netdev_adjacent from the dev's lower neighbour
  5151. * list, starting from iter position. The caller must hold RTNL lock or
  5152. * its own locking that guarantees that the neighbour lower
  5153. * list will remain unchanged.
  5154. */
  5155. void *netdev_lower_get_next(struct net_device *dev, struct list_head **iter)
  5156. {
  5157. struct netdev_adjacent *lower;
  5158. lower = list_entry(*iter, struct netdev_adjacent, list);
  5159. if (&lower->list == &dev->adj_list.lower)
  5160. return NULL;
  5161. *iter = lower->list.next;
  5162. return lower->dev;
  5163. }
  5164. EXPORT_SYMBOL(netdev_lower_get_next);
  5165. static struct net_device *netdev_next_lower_dev(struct net_device *dev,
  5166. struct list_head **iter)
  5167. {
  5168. struct netdev_adjacent *lower;
  5169. lower = list_entry((*iter)->next, struct netdev_adjacent, list);
  5170. if (&lower->list == &dev->adj_list.lower)
  5171. return NULL;
  5172. *iter = &lower->list;
  5173. return lower->dev;
  5174. }
  5175. int netdev_walk_all_lower_dev(struct net_device *dev,
  5176. int (*fn)(struct net_device *dev,
  5177. void *data),
  5178. void *data)
  5179. {
  5180. struct net_device *ldev;
  5181. struct list_head *iter;
  5182. int ret;
  5183. for (iter = &dev->adj_list.lower,
  5184. ldev = netdev_next_lower_dev(dev, &iter);
  5185. ldev;
  5186. ldev = netdev_next_lower_dev(dev, &iter)) {
  5187. /* first is the lower device itself */
  5188. ret = fn(ldev, data);
  5189. if (ret)
  5190. return ret;
  5191. /* then look at all of its lower devices */
  5192. ret = netdev_walk_all_lower_dev(ldev, fn, data);
  5193. if (ret)
  5194. return ret;
  5195. }
  5196. return 0;
  5197. }
  5198. EXPORT_SYMBOL_GPL(netdev_walk_all_lower_dev);
  5199. static struct net_device *netdev_next_lower_dev_rcu(struct net_device *dev,
  5200. struct list_head **iter)
  5201. {
  5202. struct netdev_adjacent *lower;
  5203. lower = list_entry_rcu((*iter)->next, struct netdev_adjacent, list);
  5204. if (&lower->list == &dev->adj_list.lower)
  5205. return NULL;
  5206. *iter = &lower->list;
  5207. return lower->dev;
  5208. }
  5209. int netdev_walk_all_lower_dev_rcu(struct net_device *dev,
  5210. int (*fn)(struct net_device *dev,
  5211. void *data),
  5212. void *data)
  5213. {
  5214. struct net_device *ldev;
  5215. struct list_head *iter;
  5216. int ret;
  5217. for (iter = &dev->adj_list.lower,
  5218. ldev = netdev_next_lower_dev_rcu(dev, &iter);
  5219. ldev;
  5220. ldev = netdev_next_lower_dev_rcu(dev, &iter)) {
  5221. /* first is the lower device itself */
  5222. ret = fn(ldev, data);
  5223. if (ret)
  5224. return ret;
  5225. /* then look at all of its lower devices */
  5226. ret = netdev_walk_all_lower_dev_rcu(ldev, fn, data);
  5227. if (ret)
  5228. return ret;
  5229. }
  5230. return 0;
  5231. }
  5232. EXPORT_SYMBOL_GPL(netdev_walk_all_lower_dev_rcu);
  5233. /**
  5234. * netdev_lower_get_first_private_rcu - Get the first ->private from the
  5235. * lower neighbour list, RCU
  5236. * variant
  5237. * @dev: device
  5238. *
  5239. * Gets the first netdev_adjacent->private from the dev's lower neighbour
  5240. * list. The caller must hold RCU read lock.
  5241. */
  5242. void *netdev_lower_get_first_private_rcu(struct net_device *dev)
  5243. {
  5244. struct netdev_adjacent *lower;
  5245. lower = list_first_or_null_rcu(&dev->adj_list.lower,
  5246. struct netdev_adjacent, list);
  5247. if (lower)
  5248. return lower->private;
  5249. return NULL;
  5250. }
  5251. EXPORT_SYMBOL(netdev_lower_get_first_private_rcu);
  5252. /**
  5253. * netdev_master_upper_dev_get_rcu - Get master upper device
  5254. * @dev: device
  5255. *
  5256. * Find a master upper device and return pointer to it or NULL in case
  5257. * it's not there. The caller must hold the RCU read lock.
  5258. */
  5259. struct net_device *netdev_master_upper_dev_get_rcu(struct net_device *dev)
  5260. {
  5261. struct netdev_adjacent *upper;
  5262. upper = list_first_or_null_rcu(&dev->adj_list.upper,
  5263. struct netdev_adjacent, list);
  5264. if (upper && likely(upper->master))
  5265. return upper->dev;
  5266. return NULL;
  5267. }
  5268. EXPORT_SYMBOL(netdev_master_upper_dev_get_rcu);
  5269. static int netdev_adjacent_sysfs_add(struct net_device *dev,
  5270. struct net_device *adj_dev,
  5271. struct list_head *dev_list)
  5272. {
  5273. char linkname[IFNAMSIZ+7];
  5274. sprintf(linkname, dev_list == &dev->adj_list.upper ?
  5275. "upper_%s" : "lower_%s", adj_dev->name);
  5276. return sysfs_create_link(&(dev->dev.kobj), &(adj_dev->dev.kobj),
  5277. linkname);
  5278. }
  5279. static void netdev_adjacent_sysfs_del(struct net_device *dev,
  5280. char *name,
  5281. struct list_head *dev_list)
  5282. {
  5283. char linkname[IFNAMSIZ+7];
  5284. sprintf(linkname, dev_list == &dev->adj_list.upper ?
  5285. "upper_%s" : "lower_%s", name);
  5286. sysfs_remove_link(&(dev->dev.kobj), linkname);
  5287. }
  5288. static inline bool netdev_adjacent_is_neigh_list(struct net_device *dev,
  5289. struct net_device *adj_dev,
  5290. struct list_head *dev_list)
  5291. {
  5292. return (dev_list == &dev->adj_list.upper ||
  5293. dev_list == &dev->adj_list.lower) &&
  5294. net_eq(dev_net(dev), dev_net(adj_dev));
  5295. }
  5296. static int __netdev_adjacent_dev_insert(struct net_device *dev,
  5297. struct net_device *adj_dev,
  5298. struct list_head *dev_list,
  5299. void *private, bool master)
  5300. {
  5301. struct netdev_adjacent *adj;
  5302. int ret;
  5303. adj = __netdev_find_adj(adj_dev, dev_list);
  5304. if (adj) {
  5305. adj->ref_nr += 1;
  5306. pr_debug("Insert adjacency: dev %s adj_dev %s adj->ref_nr %d\n",
  5307. dev->name, adj_dev->name, adj->ref_nr);
  5308. return 0;
  5309. }
  5310. adj = kmalloc(sizeof(*adj), GFP_KERNEL);
  5311. if (!adj)
  5312. return -ENOMEM;
  5313. adj->dev = adj_dev;
  5314. adj->master = master;
  5315. adj->ref_nr = 1;
  5316. adj->private = private;
  5317. dev_hold(adj_dev);
  5318. pr_debug("Insert adjacency: dev %s adj_dev %s adj->ref_nr %d; dev_hold on %s\n",
  5319. dev->name, adj_dev->name, adj->ref_nr, adj_dev->name);
  5320. if (netdev_adjacent_is_neigh_list(dev, adj_dev, dev_list)) {
  5321. ret = netdev_adjacent_sysfs_add(dev, adj_dev, dev_list);
  5322. if (ret)
  5323. goto free_adj;
  5324. }
  5325. /* Ensure that master link is always the first item in list. */
  5326. if (master) {
  5327. ret = sysfs_create_link(&(dev->dev.kobj),
  5328. &(adj_dev->dev.kobj), "master");
  5329. if (ret)
  5330. goto remove_symlinks;
  5331. list_add_rcu(&adj->list, dev_list);
  5332. } else {
  5333. list_add_tail_rcu(&adj->list, dev_list);
  5334. }
  5335. return 0;
  5336. remove_symlinks:
  5337. if (netdev_adjacent_is_neigh_list(dev, adj_dev, dev_list))
  5338. netdev_adjacent_sysfs_del(dev, adj_dev->name, dev_list);
  5339. free_adj:
  5340. kfree(adj);
  5341. dev_put(adj_dev);
  5342. return ret;
  5343. }
  5344. static void __netdev_adjacent_dev_remove(struct net_device *dev,
  5345. struct net_device *adj_dev,
  5346. u16 ref_nr,
  5347. struct list_head *dev_list)
  5348. {
  5349. struct netdev_adjacent *adj;
  5350. pr_debug("Remove adjacency: dev %s adj_dev %s ref_nr %d\n",
  5351. dev->name, adj_dev->name, ref_nr);
  5352. adj = __netdev_find_adj(adj_dev, dev_list);
  5353. if (!adj) {
  5354. pr_err("Adjacency does not exist for device %s from %s\n",
  5355. dev->name, adj_dev->name);
  5356. WARN_ON(1);
  5357. return;
  5358. }
  5359. if (adj->ref_nr > ref_nr) {
  5360. pr_debug("adjacency: %s to %s ref_nr - %d = %d\n",
  5361. dev->name, adj_dev->name, ref_nr,
  5362. adj->ref_nr - ref_nr);
  5363. adj->ref_nr -= ref_nr;
  5364. return;
  5365. }
  5366. if (adj->master)
  5367. sysfs_remove_link(&(dev->dev.kobj), "master");
  5368. if (netdev_adjacent_is_neigh_list(dev, adj_dev, dev_list))
  5369. netdev_adjacent_sysfs_del(dev, adj_dev->name, dev_list);
  5370. list_del_rcu(&adj->list);
  5371. pr_debug("adjacency: dev_put for %s, because link removed from %s to %s\n",
  5372. adj_dev->name, dev->name, adj_dev->name);
  5373. dev_put(adj_dev);
  5374. kfree_rcu(adj, rcu);
  5375. }
  5376. static int __netdev_adjacent_dev_link_lists(struct net_device *dev,
  5377. struct net_device *upper_dev,
  5378. struct list_head *up_list,
  5379. struct list_head *down_list,
  5380. void *private, bool master)
  5381. {
  5382. int ret;
  5383. ret = __netdev_adjacent_dev_insert(dev, upper_dev, up_list,
  5384. private, master);
  5385. if (ret)
  5386. return ret;
  5387. ret = __netdev_adjacent_dev_insert(upper_dev, dev, down_list,
  5388. private, false);
  5389. if (ret) {
  5390. __netdev_adjacent_dev_remove(dev, upper_dev, 1, up_list);
  5391. return ret;
  5392. }
  5393. return 0;
  5394. }
  5395. static void __netdev_adjacent_dev_unlink_lists(struct net_device *dev,
  5396. struct net_device *upper_dev,
  5397. u16 ref_nr,
  5398. struct list_head *up_list,
  5399. struct list_head *down_list)
  5400. {
  5401. __netdev_adjacent_dev_remove(dev, upper_dev, ref_nr, up_list);
  5402. __netdev_adjacent_dev_remove(upper_dev, dev, ref_nr, down_list);
  5403. }
  5404. static int __netdev_adjacent_dev_link_neighbour(struct net_device *dev,
  5405. struct net_device *upper_dev,
  5406. void *private, bool master)
  5407. {
  5408. return __netdev_adjacent_dev_link_lists(dev, upper_dev,
  5409. &dev->adj_list.upper,
  5410. &upper_dev->adj_list.lower,
  5411. private, master);
  5412. }
  5413. static void __netdev_adjacent_dev_unlink_neighbour(struct net_device *dev,
  5414. struct net_device *upper_dev)
  5415. {
  5416. __netdev_adjacent_dev_unlink_lists(dev, upper_dev, 1,
  5417. &dev->adj_list.upper,
  5418. &upper_dev->adj_list.lower);
  5419. }
  5420. static int __netdev_upper_dev_link(struct net_device *dev,
  5421. struct net_device *upper_dev, bool master,
  5422. void *upper_priv, void *upper_info,
  5423. struct netlink_ext_ack *extack)
  5424. {
  5425. struct netdev_notifier_changeupper_info changeupper_info = {
  5426. .info = {
  5427. .dev = dev,
  5428. .extack = extack,
  5429. },
  5430. .upper_dev = upper_dev,
  5431. .master = master,
  5432. .linking = true,
  5433. .upper_info = upper_info,
  5434. };
  5435. struct net_device *master_dev;
  5436. int ret = 0;
  5437. ASSERT_RTNL();
  5438. if (dev == upper_dev)
  5439. return -EBUSY;
  5440. /* To prevent loops, check if dev is not upper device to upper_dev. */
  5441. if (netdev_has_upper_dev(upper_dev, dev))
  5442. return -EBUSY;
  5443. if (!master) {
  5444. if (netdev_has_upper_dev(dev, upper_dev))
  5445. return -EEXIST;
  5446. } else {
  5447. master_dev = netdev_master_upper_dev_get(dev);
  5448. if (master_dev)
  5449. return master_dev == upper_dev ? -EEXIST : -EBUSY;
  5450. }
  5451. ret = call_netdevice_notifiers_info(NETDEV_PRECHANGEUPPER,
  5452. &changeupper_info.info);
  5453. ret = notifier_to_errno(ret);
  5454. if (ret)
  5455. return ret;
  5456. ret = __netdev_adjacent_dev_link_neighbour(dev, upper_dev, upper_priv,
  5457. master);
  5458. if (ret)
  5459. return ret;
  5460. ret = call_netdevice_notifiers_info(NETDEV_CHANGEUPPER,
  5461. &changeupper_info.info);
  5462. ret = notifier_to_errno(ret);
  5463. if (ret)
  5464. goto rollback;
  5465. return 0;
  5466. rollback:
  5467. __netdev_adjacent_dev_unlink_neighbour(dev, upper_dev);
  5468. return ret;
  5469. }
  5470. /**
  5471. * netdev_upper_dev_link - Add a link to the upper device
  5472. * @dev: device
  5473. * @upper_dev: new upper device
  5474. * @extack: netlink extended ack
  5475. *
  5476. * Adds a link to device which is upper to this one. The caller must hold
  5477. * the RTNL lock. On a failure a negative errno code is returned.
  5478. * On success the reference counts are adjusted and the function
  5479. * returns zero.
  5480. */
  5481. int netdev_upper_dev_link(struct net_device *dev,
  5482. struct net_device *upper_dev,
  5483. struct netlink_ext_ack *extack)
  5484. {
  5485. return __netdev_upper_dev_link(dev, upper_dev, false,
  5486. NULL, NULL, extack);
  5487. }
  5488. EXPORT_SYMBOL(netdev_upper_dev_link);
  5489. /**
  5490. * netdev_master_upper_dev_link - Add a master link to the upper device
  5491. * @dev: device
  5492. * @upper_dev: new upper device
  5493. * @upper_priv: upper device private
  5494. * @upper_info: upper info to be passed down via notifier
  5495. * @extack: netlink extended ack
  5496. *
  5497. * Adds a link to device which is upper to this one. In this case, only
  5498. * one master upper device can be linked, although other non-master devices
  5499. * might be linked as well. The caller must hold the RTNL lock.
  5500. * On a failure a negative errno code is returned. On success the reference
  5501. * counts are adjusted and the function returns zero.
  5502. */
  5503. int netdev_master_upper_dev_link(struct net_device *dev,
  5504. struct net_device *upper_dev,
  5505. void *upper_priv, void *upper_info,
  5506. struct netlink_ext_ack *extack)
  5507. {
  5508. return __netdev_upper_dev_link(dev, upper_dev, true,
  5509. upper_priv, upper_info, extack);
  5510. }
  5511. EXPORT_SYMBOL(netdev_master_upper_dev_link);
  5512. /**
  5513. * netdev_upper_dev_unlink - Removes a link to upper device
  5514. * @dev: device
  5515. * @upper_dev: new upper device
  5516. *
  5517. * Removes a link to device which is upper to this one. The caller must hold
  5518. * the RTNL lock.
  5519. */
  5520. void netdev_upper_dev_unlink(struct net_device *dev,
  5521. struct net_device *upper_dev)
  5522. {
  5523. struct netdev_notifier_changeupper_info changeupper_info = {
  5524. .info = {
  5525. .dev = dev,
  5526. },
  5527. .upper_dev = upper_dev,
  5528. .linking = false,
  5529. };
  5530. ASSERT_RTNL();
  5531. changeupper_info.master = netdev_master_upper_dev_get(dev) == upper_dev;
  5532. call_netdevice_notifiers_info(NETDEV_PRECHANGEUPPER,
  5533. &changeupper_info.info);
  5534. __netdev_adjacent_dev_unlink_neighbour(dev, upper_dev);
  5535. call_netdevice_notifiers_info(NETDEV_CHANGEUPPER,
  5536. &changeupper_info.info);
  5537. }
  5538. EXPORT_SYMBOL(netdev_upper_dev_unlink);
  5539. /**
  5540. * netdev_bonding_info_change - Dispatch event about slave change
  5541. * @dev: device
  5542. * @bonding_info: info to dispatch
  5543. *
  5544. * Send NETDEV_BONDING_INFO to netdev notifiers with info.
  5545. * The caller must hold the RTNL lock.
  5546. */
  5547. void netdev_bonding_info_change(struct net_device *dev,
  5548. struct netdev_bonding_info *bonding_info)
  5549. {
  5550. struct netdev_notifier_bonding_info info = {
  5551. .info.dev = dev,
  5552. };
  5553. memcpy(&info.bonding_info, bonding_info,
  5554. sizeof(struct netdev_bonding_info));
  5555. call_netdevice_notifiers_info(NETDEV_BONDING_INFO,
  5556. &info.info);
  5557. }
  5558. EXPORT_SYMBOL(netdev_bonding_info_change);
  5559. static void netdev_adjacent_add_links(struct net_device *dev)
  5560. {
  5561. struct netdev_adjacent *iter;
  5562. struct net *net = dev_net(dev);
  5563. list_for_each_entry(iter, &dev->adj_list.upper, list) {
  5564. if (!net_eq(net, dev_net(iter->dev)))
  5565. continue;
  5566. netdev_adjacent_sysfs_add(iter->dev, dev,
  5567. &iter->dev->adj_list.lower);
  5568. netdev_adjacent_sysfs_add(dev, iter->dev,
  5569. &dev->adj_list.upper);
  5570. }
  5571. list_for_each_entry(iter, &dev->adj_list.lower, list) {
  5572. if (!net_eq(net, dev_net(iter->dev)))
  5573. continue;
  5574. netdev_adjacent_sysfs_add(iter->dev, dev,
  5575. &iter->dev->adj_list.upper);
  5576. netdev_adjacent_sysfs_add(dev, iter->dev,
  5577. &dev->adj_list.lower);
  5578. }
  5579. }
  5580. static void netdev_adjacent_del_links(struct net_device *dev)
  5581. {
  5582. struct netdev_adjacent *iter;
  5583. struct net *net = dev_net(dev);
  5584. list_for_each_entry(iter, &dev->adj_list.upper, list) {
  5585. if (!net_eq(net, dev_net(iter->dev)))
  5586. continue;
  5587. netdev_adjacent_sysfs_del(iter->dev, dev->name,
  5588. &iter->dev->adj_list.lower);
  5589. netdev_adjacent_sysfs_del(dev, iter->dev->name,
  5590. &dev->adj_list.upper);
  5591. }
  5592. list_for_each_entry(iter, &dev->adj_list.lower, list) {
  5593. if (!net_eq(net, dev_net(iter->dev)))
  5594. continue;
  5595. netdev_adjacent_sysfs_del(iter->dev, dev->name,
  5596. &iter->dev->adj_list.upper);
  5597. netdev_adjacent_sysfs_del(dev, iter->dev->name,
  5598. &dev->adj_list.lower);
  5599. }
  5600. }
  5601. void netdev_adjacent_rename_links(struct net_device *dev, char *oldname)
  5602. {
  5603. struct netdev_adjacent *iter;
  5604. struct net *net = dev_net(dev);
  5605. list_for_each_entry(iter, &dev->adj_list.upper, list) {
  5606. if (!net_eq(net, dev_net(iter->dev)))
  5607. continue;
  5608. netdev_adjacent_sysfs_del(iter->dev, oldname,
  5609. &iter->dev->adj_list.lower);
  5610. netdev_adjacent_sysfs_add(iter->dev, dev,
  5611. &iter->dev->adj_list.lower);
  5612. }
  5613. list_for_each_entry(iter, &dev->adj_list.lower, list) {
  5614. if (!net_eq(net, dev_net(iter->dev)))
  5615. continue;
  5616. netdev_adjacent_sysfs_del(iter->dev, oldname,
  5617. &iter->dev->adj_list.upper);
  5618. netdev_adjacent_sysfs_add(iter->dev, dev,
  5619. &iter->dev->adj_list.upper);
  5620. }
  5621. }
  5622. void *netdev_lower_dev_get_private(struct net_device *dev,
  5623. struct net_device *lower_dev)
  5624. {
  5625. struct netdev_adjacent *lower;
  5626. if (!lower_dev)
  5627. return NULL;
  5628. lower = __netdev_find_adj(lower_dev, &dev->adj_list.lower);
  5629. if (!lower)
  5630. return NULL;
  5631. return lower->private;
  5632. }
  5633. EXPORT_SYMBOL(netdev_lower_dev_get_private);
  5634. int dev_get_nest_level(struct net_device *dev)
  5635. {
  5636. struct net_device *lower = NULL;
  5637. struct list_head *iter;
  5638. int max_nest = -1;
  5639. int nest;
  5640. ASSERT_RTNL();
  5641. netdev_for_each_lower_dev(dev, lower, iter) {
  5642. nest = dev_get_nest_level(lower);
  5643. if (max_nest < nest)
  5644. max_nest = nest;
  5645. }
  5646. return max_nest + 1;
  5647. }
  5648. EXPORT_SYMBOL(dev_get_nest_level);
  5649. /**
  5650. * netdev_lower_change - Dispatch event about lower device state change
  5651. * @lower_dev: device
  5652. * @lower_state_info: state to dispatch
  5653. *
  5654. * Send NETDEV_CHANGELOWERSTATE to netdev notifiers with info.
  5655. * The caller must hold the RTNL lock.
  5656. */
  5657. void netdev_lower_state_changed(struct net_device *lower_dev,
  5658. void *lower_state_info)
  5659. {
  5660. struct netdev_notifier_changelowerstate_info changelowerstate_info = {
  5661. .info.dev = lower_dev,
  5662. };
  5663. ASSERT_RTNL();
  5664. changelowerstate_info.lower_state_info = lower_state_info;
  5665. call_netdevice_notifiers_info(NETDEV_CHANGELOWERSTATE,
  5666. &changelowerstate_info.info);
  5667. }
  5668. EXPORT_SYMBOL(netdev_lower_state_changed);
  5669. static void dev_change_rx_flags(struct net_device *dev, int flags)
  5670. {
  5671. const struct net_device_ops *ops = dev->netdev_ops;
  5672. if (ops->ndo_change_rx_flags)
  5673. ops->ndo_change_rx_flags(dev, flags);
  5674. }
  5675. static int __dev_set_promiscuity(struct net_device *dev, int inc, bool notify)
  5676. {
  5677. unsigned int old_flags = dev->flags;
  5678. kuid_t uid;
  5679. kgid_t gid;
  5680. ASSERT_RTNL();
  5681. dev->flags |= IFF_PROMISC;
  5682. dev->promiscuity += inc;
  5683. if (dev->promiscuity == 0) {
  5684. /*
  5685. * Avoid overflow.
  5686. * If inc causes overflow, untouch promisc and return error.
  5687. */
  5688. if (inc < 0)
  5689. dev->flags &= ~IFF_PROMISC;
  5690. else {
  5691. dev->promiscuity -= inc;
  5692. pr_warn("%s: promiscuity touches roof, set promiscuity failed. promiscuity feature of device might be broken.\n",
  5693. dev->name);
  5694. return -EOVERFLOW;
  5695. }
  5696. }
  5697. if (dev->flags != old_flags) {
  5698. pr_info("device %s %s promiscuous mode\n",
  5699. dev->name,
  5700. dev->flags & IFF_PROMISC ? "entered" : "left");
  5701. if (audit_enabled) {
  5702. current_uid_gid(&uid, &gid);
  5703. audit_log(current->audit_context, GFP_ATOMIC,
  5704. AUDIT_ANOM_PROMISCUOUS,
  5705. "dev=%s prom=%d old_prom=%d auid=%u uid=%u gid=%u ses=%u",
  5706. dev->name, (dev->flags & IFF_PROMISC),
  5707. (old_flags & IFF_PROMISC),
  5708. from_kuid(&init_user_ns, audit_get_loginuid(current)),
  5709. from_kuid(&init_user_ns, uid),
  5710. from_kgid(&init_user_ns, gid),
  5711. audit_get_sessionid(current));
  5712. }
  5713. dev_change_rx_flags(dev, IFF_PROMISC);
  5714. }
  5715. if (notify)
  5716. __dev_notify_flags(dev, old_flags, IFF_PROMISC);
  5717. return 0;
  5718. }
  5719. /**
  5720. * dev_set_promiscuity - update promiscuity count on a device
  5721. * @dev: device
  5722. * @inc: modifier
  5723. *
  5724. * Add or remove promiscuity from a device. While the count in the device
  5725. * remains above zero the interface remains promiscuous. Once it hits zero
  5726. * the device reverts back to normal filtering operation. A negative inc
  5727. * value is used to drop promiscuity on the device.
  5728. * Return 0 if successful or a negative errno code on error.
  5729. */
  5730. int dev_set_promiscuity(struct net_device *dev, int inc)
  5731. {
  5732. unsigned int old_flags = dev->flags;
  5733. int err;
  5734. err = __dev_set_promiscuity(dev, inc, true);
  5735. if (err < 0)
  5736. return err;
  5737. if (dev->flags != old_flags)
  5738. dev_set_rx_mode(dev);
  5739. return err;
  5740. }
  5741. EXPORT_SYMBOL(dev_set_promiscuity);
  5742. static int __dev_set_allmulti(struct net_device *dev, int inc, bool notify)
  5743. {
  5744. unsigned int old_flags = dev->flags, old_gflags = dev->gflags;
  5745. ASSERT_RTNL();
  5746. dev->flags |= IFF_ALLMULTI;
  5747. dev->allmulti += inc;
  5748. if (dev->allmulti == 0) {
  5749. /*
  5750. * Avoid overflow.
  5751. * If inc causes overflow, untouch allmulti and return error.
  5752. */
  5753. if (inc < 0)
  5754. dev->flags &= ~IFF_ALLMULTI;
  5755. else {
  5756. dev->allmulti -= inc;
  5757. pr_warn("%s: allmulti touches roof, set allmulti failed. allmulti feature of device might be broken.\n",
  5758. dev->name);
  5759. return -EOVERFLOW;
  5760. }
  5761. }
  5762. if (dev->flags ^ old_flags) {
  5763. dev_change_rx_flags(dev, IFF_ALLMULTI);
  5764. dev_set_rx_mode(dev);
  5765. if (notify)
  5766. __dev_notify_flags(dev, old_flags,
  5767. dev->gflags ^ old_gflags);
  5768. }
  5769. return 0;
  5770. }
  5771. /**
  5772. * dev_set_allmulti - update allmulti count on a device
  5773. * @dev: device
  5774. * @inc: modifier
  5775. *
  5776. * Add or remove reception of all multicast frames to a device. While the
  5777. * count in the device remains above zero the interface remains listening
  5778. * to all interfaces. Once it hits zero the device reverts back to normal
  5779. * filtering operation. A negative @inc value is used to drop the counter
  5780. * when releasing a resource needing all multicasts.
  5781. * Return 0 if successful or a negative errno code on error.
  5782. */
  5783. int dev_set_allmulti(struct net_device *dev, int inc)
  5784. {
  5785. return __dev_set_allmulti(dev, inc, true);
  5786. }
  5787. EXPORT_SYMBOL(dev_set_allmulti);
  5788. /*
  5789. * Upload unicast and multicast address lists to device and
  5790. * configure RX filtering. When the device doesn't support unicast
  5791. * filtering it is put in promiscuous mode while unicast addresses
  5792. * are present.
  5793. */
  5794. void __dev_set_rx_mode(struct net_device *dev)
  5795. {
  5796. const struct net_device_ops *ops = dev->netdev_ops;
  5797. /* dev_open will call this function so the list will stay sane. */
  5798. if (!(dev->flags&IFF_UP))
  5799. return;
  5800. if (!netif_device_present(dev))
  5801. return;
  5802. if (!(dev->priv_flags & IFF_UNICAST_FLT)) {
  5803. /* Unicast addresses changes may only happen under the rtnl,
  5804. * therefore calling __dev_set_promiscuity here is safe.
  5805. */
  5806. if (!netdev_uc_empty(dev) && !dev->uc_promisc) {
  5807. __dev_set_promiscuity(dev, 1, false);
  5808. dev->uc_promisc = true;
  5809. } else if (netdev_uc_empty(dev) && dev->uc_promisc) {
  5810. __dev_set_promiscuity(dev, -1, false);
  5811. dev->uc_promisc = false;
  5812. }
  5813. }
  5814. if (ops->ndo_set_rx_mode)
  5815. ops->ndo_set_rx_mode(dev);
  5816. }
  5817. void dev_set_rx_mode(struct net_device *dev)
  5818. {
  5819. netif_addr_lock_bh(dev);
  5820. __dev_set_rx_mode(dev);
  5821. netif_addr_unlock_bh(dev);
  5822. }
  5823. /**
  5824. * dev_get_flags - get flags reported to userspace
  5825. * @dev: device
  5826. *
  5827. * Get the combination of flag bits exported through APIs to userspace.
  5828. */
  5829. unsigned int dev_get_flags(const struct net_device *dev)
  5830. {
  5831. unsigned int flags;
  5832. flags = (dev->flags & ~(IFF_PROMISC |
  5833. IFF_ALLMULTI |
  5834. IFF_RUNNING |
  5835. IFF_LOWER_UP |
  5836. IFF_DORMANT)) |
  5837. (dev->gflags & (IFF_PROMISC |
  5838. IFF_ALLMULTI));
  5839. if (netif_running(dev)) {
  5840. if (netif_oper_up(dev))
  5841. flags |= IFF_RUNNING;
  5842. if (netif_carrier_ok(dev))
  5843. flags |= IFF_LOWER_UP;
  5844. if (netif_dormant(dev))
  5845. flags |= IFF_DORMANT;
  5846. }
  5847. return flags;
  5848. }
  5849. EXPORT_SYMBOL(dev_get_flags);
  5850. int __dev_change_flags(struct net_device *dev, unsigned int flags)
  5851. {
  5852. unsigned int old_flags = dev->flags;
  5853. int ret;
  5854. ASSERT_RTNL();
  5855. /*
  5856. * Set the flags on our device.
  5857. */
  5858. dev->flags = (flags & (IFF_DEBUG | IFF_NOTRAILERS | IFF_NOARP |
  5859. IFF_DYNAMIC | IFF_MULTICAST | IFF_PORTSEL |
  5860. IFF_AUTOMEDIA)) |
  5861. (dev->flags & (IFF_UP | IFF_VOLATILE | IFF_PROMISC |
  5862. IFF_ALLMULTI));
  5863. /*
  5864. * Load in the correct multicast list now the flags have changed.
  5865. */
  5866. if ((old_flags ^ flags) & IFF_MULTICAST)
  5867. dev_change_rx_flags(dev, IFF_MULTICAST);
  5868. dev_set_rx_mode(dev);
  5869. /*
  5870. * Have we downed the interface. We handle IFF_UP ourselves
  5871. * according to user attempts to set it, rather than blindly
  5872. * setting it.
  5873. */
  5874. ret = 0;
  5875. if ((old_flags ^ flags) & IFF_UP) {
  5876. if (old_flags & IFF_UP)
  5877. __dev_close(dev);
  5878. else
  5879. ret = __dev_open(dev);
  5880. }
  5881. if ((flags ^ dev->gflags) & IFF_PROMISC) {
  5882. int inc = (flags & IFF_PROMISC) ? 1 : -1;
  5883. unsigned int old_flags = dev->flags;
  5884. dev->gflags ^= IFF_PROMISC;
  5885. if (__dev_set_promiscuity(dev, inc, false) >= 0)
  5886. if (dev->flags != old_flags)
  5887. dev_set_rx_mode(dev);
  5888. }
  5889. /* NOTE: order of synchronization of IFF_PROMISC and IFF_ALLMULTI
  5890. * is important. Some (broken) drivers set IFF_PROMISC, when
  5891. * IFF_ALLMULTI is requested not asking us and not reporting.
  5892. */
  5893. if ((flags ^ dev->gflags) & IFF_ALLMULTI) {
  5894. int inc = (flags & IFF_ALLMULTI) ? 1 : -1;
  5895. dev->gflags ^= IFF_ALLMULTI;
  5896. __dev_set_allmulti(dev, inc, false);
  5897. }
  5898. return ret;
  5899. }
  5900. void __dev_notify_flags(struct net_device *dev, unsigned int old_flags,
  5901. unsigned int gchanges)
  5902. {
  5903. unsigned int changes = dev->flags ^ old_flags;
  5904. if (gchanges)
  5905. rtmsg_ifinfo(RTM_NEWLINK, dev, gchanges, GFP_ATOMIC);
  5906. if (changes & IFF_UP) {
  5907. if (dev->flags & IFF_UP)
  5908. call_netdevice_notifiers(NETDEV_UP, dev);
  5909. else
  5910. call_netdevice_notifiers(NETDEV_DOWN, dev);
  5911. }
  5912. if (dev->flags & IFF_UP &&
  5913. (changes & ~(IFF_UP | IFF_PROMISC | IFF_ALLMULTI | IFF_VOLATILE))) {
  5914. struct netdev_notifier_change_info change_info = {
  5915. .info = {
  5916. .dev = dev,
  5917. },
  5918. .flags_changed = changes,
  5919. };
  5920. call_netdevice_notifiers_info(NETDEV_CHANGE, &change_info.info);
  5921. }
  5922. }
  5923. /**
  5924. * dev_change_flags - change device settings
  5925. * @dev: device
  5926. * @flags: device state flags
  5927. *
  5928. * Change settings on device based state flags. The flags are
  5929. * in the userspace exported format.
  5930. */
  5931. int dev_change_flags(struct net_device *dev, unsigned int flags)
  5932. {
  5933. int ret;
  5934. unsigned int changes, old_flags = dev->flags, old_gflags = dev->gflags;
  5935. ret = __dev_change_flags(dev, flags);
  5936. if (ret < 0)
  5937. return ret;
  5938. changes = (old_flags ^ dev->flags) | (old_gflags ^ dev->gflags);
  5939. __dev_notify_flags(dev, old_flags, changes);
  5940. return ret;
  5941. }
  5942. EXPORT_SYMBOL(dev_change_flags);
  5943. int __dev_set_mtu(struct net_device *dev, int new_mtu)
  5944. {
  5945. const struct net_device_ops *ops = dev->netdev_ops;
  5946. if (ops->ndo_change_mtu)
  5947. return ops->ndo_change_mtu(dev, new_mtu);
  5948. dev->mtu = new_mtu;
  5949. return 0;
  5950. }
  5951. EXPORT_SYMBOL(__dev_set_mtu);
  5952. /**
  5953. * dev_set_mtu - Change maximum transfer unit
  5954. * @dev: device
  5955. * @new_mtu: new transfer unit
  5956. *
  5957. * Change the maximum transfer size of the network device.
  5958. */
  5959. int dev_set_mtu(struct net_device *dev, int new_mtu)
  5960. {
  5961. int err, orig_mtu;
  5962. if (new_mtu == dev->mtu)
  5963. return 0;
  5964. /* MTU must be positive, and in range */
  5965. if (new_mtu < 0 || new_mtu < dev->min_mtu) {
  5966. net_err_ratelimited("%s: Invalid MTU %d requested, hw min %d\n",
  5967. dev->name, new_mtu, dev->min_mtu);
  5968. return -EINVAL;
  5969. }
  5970. if (dev->max_mtu > 0 && new_mtu > dev->max_mtu) {
  5971. net_err_ratelimited("%s: Invalid MTU %d requested, hw max %d\n",
  5972. dev->name, new_mtu, dev->max_mtu);
  5973. return -EINVAL;
  5974. }
  5975. if (!netif_device_present(dev))
  5976. return -ENODEV;
  5977. err = call_netdevice_notifiers(NETDEV_PRECHANGEMTU, dev);
  5978. err = notifier_to_errno(err);
  5979. if (err)
  5980. return err;
  5981. orig_mtu = dev->mtu;
  5982. err = __dev_set_mtu(dev, new_mtu);
  5983. if (!err) {
  5984. err = call_netdevice_notifiers(NETDEV_CHANGEMTU, dev);
  5985. err = notifier_to_errno(err);
  5986. if (err) {
  5987. /* setting mtu back and notifying everyone again,
  5988. * so that they have a chance to revert changes.
  5989. */
  5990. __dev_set_mtu(dev, orig_mtu);
  5991. call_netdevice_notifiers(NETDEV_CHANGEMTU, dev);
  5992. }
  5993. }
  5994. return err;
  5995. }
  5996. EXPORT_SYMBOL(dev_set_mtu);
  5997. /**
  5998. * dev_change_tx_queue_len - Change TX queue length of a netdevice
  5999. * @dev: device
  6000. * @new_len: new tx queue length
  6001. */
  6002. int dev_change_tx_queue_len(struct net_device *dev, unsigned long new_len)
  6003. {
  6004. unsigned int orig_len = dev->tx_queue_len;
  6005. int res;
  6006. if (new_len != (unsigned int)new_len)
  6007. return -ERANGE;
  6008. if (new_len != orig_len) {
  6009. dev->tx_queue_len = new_len;
  6010. res = call_netdevice_notifiers(NETDEV_CHANGE_TX_QUEUE_LEN, dev);
  6011. res = notifier_to_errno(res);
  6012. if (res) {
  6013. netdev_err(dev,
  6014. "refused to change device tx_queue_len\n");
  6015. dev->tx_queue_len = orig_len;
  6016. return res;
  6017. }
  6018. return dev_qdisc_change_tx_queue_len(dev);
  6019. }
  6020. return 0;
  6021. }
  6022. /**
  6023. * dev_set_group - Change group this device belongs to
  6024. * @dev: device
  6025. * @new_group: group this device should belong to
  6026. */
  6027. void dev_set_group(struct net_device *dev, int new_group)
  6028. {
  6029. dev->group = new_group;
  6030. }
  6031. EXPORT_SYMBOL(dev_set_group);
  6032. /**
  6033. * dev_set_mac_address - Change Media Access Control Address
  6034. * @dev: device
  6035. * @sa: new address
  6036. *
  6037. * Change the hardware (MAC) address of the device
  6038. */
  6039. int dev_set_mac_address(struct net_device *dev, struct sockaddr *sa)
  6040. {
  6041. const struct net_device_ops *ops = dev->netdev_ops;
  6042. int err;
  6043. if (!ops->ndo_set_mac_address)
  6044. return -EOPNOTSUPP;
  6045. if (sa->sa_family != dev->type)
  6046. return -EINVAL;
  6047. if (!netif_device_present(dev))
  6048. return -ENODEV;
  6049. err = ops->ndo_set_mac_address(dev, sa);
  6050. if (err)
  6051. return err;
  6052. dev->addr_assign_type = NET_ADDR_SET;
  6053. call_netdevice_notifiers(NETDEV_CHANGEADDR, dev);
  6054. add_device_randomness(dev->dev_addr, dev->addr_len);
  6055. return 0;
  6056. }
  6057. EXPORT_SYMBOL(dev_set_mac_address);
  6058. /**
  6059. * dev_change_carrier - Change device carrier
  6060. * @dev: device
  6061. * @new_carrier: new value
  6062. *
  6063. * Change device carrier
  6064. */
  6065. int dev_change_carrier(struct net_device *dev, bool new_carrier)
  6066. {
  6067. const struct net_device_ops *ops = dev->netdev_ops;
  6068. if (!ops->ndo_change_carrier)
  6069. return -EOPNOTSUPP;
  6070. if (!netif_device_present(dev))
  6071. return -ENODEV;
  6072. return ops->ndo_change_carrier(dev, new_carrier);
  6073. }
  6074. EXPORT_SYMBOL(dev_change_carrier);
  6075. /**
  6076. * dev_get_phys_port_id - Get device physical port ID
  6077. * @dev: device
  6078. * @ppid: port ID
  6079. *
  6080. * Get device physical port ID
  6081. */
  6082. int dev_get_phys_port_id(struct net_device *dev,
  6083. struct netdev_phys_item_id *ppid)
  6084. {
  6085. const struct net_device_ops *ops = dev->netdev_ops;
  6086. if (!ops->ndo_get_phys_port_id)
  6087. return -EOPNOTSUPP;
  6088. return ops->ndo_get_phys_port_id(dev, ppid);
  6089. }
  6090. EXPORT_SYMBOL(dev_get_phys_port_id);
  6091. /**
  6092. * dev_get_phys_port_name - Get device physical port name
  6093. * @dev: device
  6094. * @name: port name
  6095. * @len: limit of bytes to copy to name
  6096. *
  6097. * Get device physical port name
  6098. */
  6099. int dev_get_phys_port_name(struct net_device *dev,
  6100. char *name, size_t len)
  6101. {
  6102. const struct net_device_ops *ops = dev->netdev_ops;
  6103. if (!ops->ndo_get_phys_port_name)
  6104. return -EOPNOTSUPP;
  6105. return ops->ndo_get_phys_port_name(dev, name, len);
  6106. }
  6107. EXPORT_SYMBOL(dev_get_phys_port_name);
  6108. /**
  6109. * dev_change_proto_down - update protocol port state information
  6110. * @dev: device
  6111. * @proto_down: new value
  6112. *
  6113. * This info can be used by switch drivers to set the phys state of the
  6114. * port.
  6115. */
  6116. int dev_change_proto_down(struct net_device *dev, bool proto_down)
  6117. {
  6118. const struct net_device_ops *ops = dev->netdev_ops;
  6119. if (!ops->ndo_change_proto_down)
  6120. return -EOPNOTSUPP;
  6121. if (!netif_device_present(dev))
  6122. return -ENODEV;
  6123. return ops->ndo_change_proto_down(dev, proto_down);
  6124. }
  6125. EXPORT_SYMBOL(dev_change_proto_down);
  6126. void __dev_xdp_query(struct net_device *dev, bpf_op_t bpf_op,
  6127. struct netdev_bpf *xdp)
  6128. {
  6129. memset(xdp, 0, sizeof(*xdp));
  6130. xdp->command = XDP_QUERY_PROG;
  6131. /* Query must always succeed. */
  6132. WARN_ON(bpf_op(dev, xdp) < 0);
  6133. }
  6134. static u8 __dev_xdp_attached(struct net_device *dev, bpf_op_t bpf_op)
  6135. {
  6136. struct netdev_bpf xdp;
  6137. __dev_xdp_query(dev, bpf_op, &xdp);
  6138. return xdp.prog_attached;
  6139. }
  6140. static int dev_xdp_install(struct net_device *dev, bpf_op_t bpf_op,
  6141. struct netlink_ext_ack *extack, u32 flags,
  6142. struct bpf_prog *prog)
  6143. {
  6144. struct netdev_bpf xdp;
  6145. memset(&xdp, 0, sizeof(xdp));
  6146. if (flags & XDP_FLAGS_HW_MODE)
  6147. xdp.command = XDP_SETUP_PROG_HW;
  6148. else
  6149. xdp.command = XDP_SETUP_PROG;
  6150. xdp.extack = extack;
  6151. xdp.flags = flags;
  6152. xdp.prog = prog;
  6153. return bpf_op(dev, &xdp);
  6154. }
  6155. static void dev_xdp_uninstall(struct net_device *dev)
  6156. {
  6157. struct netdev_bpf xdp;
  6158. bpf_op_t ndo_bpf;
  6159. /* Remove generic XDP */
  6160. WARN_ON(dev_xdp_install(dev, generic_xdp_install, NULL, 0, NULL));
  6161. /* Remove from the driver */
  6162. ndo_bpf = dev->netdev_ops->ndo_bpf;
  6163. if (!ndo_bpf)
  6164. return;
  6165. __dev_xdp_query(dev, ndo_bpf, &xdp);
  6166. if (xdp.prog_attached == XDP_ATTACHED_NONE)
  6167. return;
  6168. /* Program removal should always succeed */
  6169. WARN_ON(dev_xdp_install(dev, ndo_bpf, NULL, xdp.prog_flags, NULL));
  6170. }
  6171. /**
  6172. * dev_change_xdp_fd - set or clear a bpf program for a device rx path
  6173. * @dev: device
  6174. * @extack: netlink extended ack
  6175. * @fd: new program fd or negative value to clear
  6176. * @flags: xdp-related flags
  6177. *
  6178. * Set or clear a bpf program for a device
  6179. */
  6180. int dev_change_xdp_fd(struct net_device *dev, struct netlink_ext_ack *extack,
  6181. int fd, u32 flags)
  6182. {
  6183. const struct net_device_ops *ops = dev->netdev_ops;
  6184. struct bpf_prog *prog = NULL;
  6185. bpf_op_t bpf_op, bpf_chk;
  6186. int err;
  6187. ASSERT_RTNL();
  6188. bpf_op = bpf_chk = ops->ndo_bpf;
  6189. if (!bpf_op && (flags & (XDP_FLAGS_DRV_MODE | XDP_FLAGS_HW_MODE)))
  6190. return -EOPNOTSUPP;
  6191. if (!bpf_op || (flags & XDP_FLAGS_SKB_MODE))
  6192. bpf_op = generic_xdp_install;
  6193. if (bpf_op == bpf_chk)
  6194. bpf_chk = generic_xdp_install;
  6195. if (fd >= 0) {
  6196. if (bpf_chk && __dev_xdp_attached(dev, bpf_chk))
  6197. return -EEXIST;
  6198. if ((flags & XDP_FLAGS_UPDATE_IF_NOEXIST) &&
  6199. __dev_xdp_attached(dev, bpf_op))
  6200. return -EBUSY;
  6201. prog = bpf_prog_get_type_dev(fd, BPF_PROG_TYPE_XDP,
  6202. bpf_op == ops->ndo_bpf);
  6203. if (IS_ERR(prog))
  6204. return PTR_ERR(prog);
  6205. if (!(flags & XDP_FLAGS_HW_MODE) &&
  6206. bpf_prog_is_dev_bound(prog->aux)) {
  6207. NL_SET_ERR_MSG(extack, "using device-bound program without HW_MODE flag is not supported");
  6208. bpf_prog_put(prog);
  6209. return -EINVAL;
  6210. }
  6211. }
  6212. err = dev_xdp_install(dev, bpf_op, extack, flags, prog);
  6213. if (err < 0 && prog)
  6214. bpf_prog_put(prog);
  6215. return err;
  6216. }
  6217. /**
  6218. * dev_new_index - allocate an ifindex
  6219. * @net: the applicable net namespace
  6220. *
  6221. * Returns a suitable unique value for a new device interface
  6222. * number. The caller must hold the rtnl semaphore or the
  6223. * dev_base_lock to be sure it remains unique.
  6224. */
  6225. static int dev_new_index(struct net *net)
  6226. {
  6227. int ifindex = net->ifindex;
  6228. for (;;) {
  6229. if (++ifindex <= 0)
  6230. ifindex = 1;
  6231. if (!__dev_get_by_index(net, ifindex))
  6232. return net->ifindex = ifindex;
  6233. }
  6234. }
  6235. /* Delayed registration/unregisteration */
  6236. static LIST_HEAD(net_todo_list);
  6237. DECLARE_WAIT_QUEUE_HEAD(netdev_unregistering_wq);
  6238. static void net_set_todo(struct net_device *dev)
  6239. {
  6240. list_add_tail(&dev->todo_list, &net_todo_list);
  6241. dev_net(dev)->dev_unreg_count++;
  6242. }
  6243. static void rollback_registered_many(struct list_head *head)
  6244. {
  6245. struct net_device *dev, *tmp;
  6246. LIST_HEAD(close_head);
  6247. BUG_ON(dev_boot_phase);
  6248. ASSERT_RTNL();
  6249. list_for_each_entry_safe(dev, tmp, head, unreg_list) {
  6250. /* Some devices call without registering
  6251. * for initialization unwind. Remove those
  6252. * devices and proceed with the remaining.
  6253. */
  6254. if (dev->reg_state == NETREG_UNINITIALIZED) {
  6255. pr_debug("unregister_netdevice: device %s/%p never was registered\n",
  6256. dev->name, dev);
  6257. WARN_ON(1);
  6258. list_del(&dev->unreg_list);
  6259. continue;
  6260. }
  6261. dev->dismantle = true;
  6262. BUG_ON(dev->reg_state != NETREG_REGISTERED);
  6263. }
  6264. /* If device is running, close it first. */
  6265. list_for_each_entry(dev, head, unreg_list)
  6266. list_add_tail(&dev->close_list, &close_head);
  6267. dev_close_many(&close_head, true);
  6268. list_for_each_entry(dev, head, unreg_list) {
  6269. /* And unlink it from device chain. */
  6270. unlist_netdevice(dev);
  6271. dev->reg_state = NETREG_UNREGISTERING;
  6272. }
  6273. flush_all_backlogs();
  6274. synchronize_net();
  6275. list_for_each_entry(dev, head, unreg_list) {
  6276. struct sk_buff *skb = NULL;
  6277. /* Shutdown queueing discipline. */
  6278. dev_shutdown(dev);
  6279. dev_xdp_uninstall(dev);
  6280. /* Notify protocols, that we are about to destroy
  6281. * this device. They should clean all the things.
  6282. */
  6283. call_netdevice_notifiers(NETDEV_UNREGISTER, dev);
  6284. if (!dev->rtnl_link_ops ||
  6285. dev->rtnl_link_state == RTNL_LINK_INITIALIZED)
  6286. skb = rtmsg_ifinfo_build_skb(RTM_DELLINK, dev, ~0U, 0,
  6287. GFP_KERNEL, NULL, 0);
  6288. /*
  6289. * Flush the unicast and multicast chains
  6290. */
  6291. dev_uc_flush(dev);
  6292. dev_mc_flush(dev);
  6293. if (dev->netdev_ops->ndo_uninit)
  6294. dev->netdev_ops->ndo_uninit(dev);
  6295. if (skb)
  6296. rtmsg_ifinfo_send(skb, dev, GFP_KERNEL);
  6297. /* Notifier chain MUST detach us all upper devices. */
  6298. WARN_ON(netdev_has_any_upper_dev(dev));
  6299. WARN_ON(netdev_has_any_lower_dev(dev));
  6300. /* Remove entries from kobject tree */
  6301. netdev_unregister_kobject(dev);
  6302. #ifdef CONFIG_XPS
  6303. /* Remove XPS queueing entries */
  6304. netif_reset_xps_queues_gt(dev, 0);
  6305. #endif
  6306. }
  6307. synchronize_net();
  6308. list_for_each_entry(dev, head, unreg_list)
  6309. dev_put(dev);
  6310. }
  6311. static void rollback_registered(struct net_device *dev)
  6312. {
  6313. LIST_HEAD(single);
  6314. list_add(&dev->unreg_list, &single);
  6315. rollback_registered_many(&single);
  6316. list_del(&single);
  6317. }
  6318. static netdev_features_t netdev_sync_upper_features(struct net_device *lower,
  6319. struct net_device *upper, netdev_features_t features)
  6320. {
  6321. netdev_features_t upper_disables = NETIF_F_UPPER_DISABLES;
  6322. netdev_features_t feature;
  6323. int feature_bit;
  6324. for_each_netdev_feature(&upper_disables, feature_bit) {
  6325. feature = __NETIF_F_BIT(feature_bit);
  6326. if (!(upper->wanted_features & feature)
  6327. && (features & feature)) {
  6328. netdev_dbg(lower, "Dropping feature %pNF, upper dev %s has it off.\n",
  6329. &feature, upper->name);
  6330. features &= ~feature;
  6331. }
  6332. }
  6333. return features;
  6334. }
  6335. static void netdev_sync_lower_features(struct net_device *upper,
  6336. struct net_device *lower, netdev_features_t features)
  6337. {
  6338. netdev_features_t upper_disables = NETIF_F_UPPER_DISABLES;
  6339. netdev_features_t feature;
  6340. int feature_bit;
  6341. for_each_netdev_feature(&upper_disables, feature_bit) {
  6342. feature = __NETIF_F_BIT(feature_bit);
  6343. if (!(features & feature) && (lower->features & feature)) {
  6344. netdev_dbg(upper, "Disabling feature %pNF on lower dev %s.\n",
  6345. &feature, lower->name);
  6346. lower->wanted_features &= ~feature;
  6347. netdev_update_features(lower);
  6348. if (unlikely(lower->features & feature))
  6349. netdev_WARN(upper, "failed to disable %pNF on %s!\n",
  6350. &feature, lower->name);
  6351. }
  6352. }
  6353. }
  6354. static netdev_features_t netdev_fix_features(struct net_device *dev,
  6355. netdev_features_t features)
  6356. {
  6357. /* Fix illegal checksum combinations */
  6358. if ((features & NETIF_F_HW_CSUM) &&
  6359. (features & (NETIF_F_IP_CSUM|NETIF_F_IPV6_CSUM))) {
  6360. netdev_warn(dev, "mixed HW and IP checksum settings.\n");
  6361. features &= ~(NETIF_F_IP_CSUM|NETIF_F_IPV6_CSUM);
  6362. }
  6363. /* TSO requires that SG is present as well. */
  6364. if ((features & NETIF_F_ALL_TSO) && !(features & NETIF_F_SG)) {
  6365. netdev_dbg(dev, "Dropping TSO features since no SG feature.\n");
  6366. features &= ~NETIF_F_ALL_TSO;
  6367. }
  6368. if ((features & NETIF_F_TSO) && !(features & NETIF_F_HW_CSUM) &&
  6369. !(features & NETIF_F_IP_CSUM)) {
  6370. netdev_dbg(dev, "Dropping TSO features since no CSUM feature.\n");
  6371. features &= ~NETIF_F_TSO;
  6372. features &= ~NETIF_F_TSO_ECN;
  6373. }
  6374. if ((features & NETIF_F_TSO6) && !(features & NETIF_F_HW_CSUM) &&
  6375. !(features & NETIF_F_IPV6_CSUM)) {
  6376. netdev_dbg(dev, "Dropping TSO6 features since no CSUM feature.\n");
  6377. features &= ~NETIF_F_TSO6;
  6378. }
  6379. /* TSO with IPv4 ID mangling requires IPv4 TSO be enabled */
  6380. if ((features & NETIF_F_TSO_MANGLEID) && !(features & NETIF_F_TSO))
  6381. features &= ~NETIF_F_TSO_MANGLEID;
  6382. /* TSO ECN requires that TSO is present as well. */
  6383. if ((features & NETIF_F_ALL_TSO) == NETIF_F_TSO_ECN)
  6384. features &= ~NETIF_F_TSO_ECN;
  6385. /* Software GSO depends on SG. */
  6386. if ((features & NETIF_F_GSO) && !(features & NETIF_F_SG)) {
  6387. netdev_dbg(dev, "Dropping NETIF_F_GSO since no SG feature.\n");
  6388. features &= ~NETIF_F_GSO;
  6389. }
  6390. /* GSO partial features require GSO partial be set */
  6391. if ((features & dev->gso_partial_features) &&
  6392. !(features & NETIF_F_GSO_PARTIAL)) {
  6393. netdev_dbg(dev,
  6394. "Dropping partially supported GSO features since no GSO partial.\n");
  6395. features &= ~dev->gso_partial_features;
  6396. }
  6397. if (!(features & NETIF_F_RXCSUM)) {
  6398. /* NETIF_F_GRO_HW implies doing RXCSUM since every packet
  6399. * successfully merged by hardware must also have the
  6400. * checksum verified by hardware. If the user does not
  6401. * want to enable RXCSUM, logically, we should disable GRO_HW.
  6402. */
  6403. if (features & NETIF_F_GRO_HW) {
  6404. netdev_dbg(dev, "Dropping NETIF_F_GRO_HW since no RXCSUM feature.\n");
  6405. features &= ~NETIF_F_GRO_HW;
  6406. }
  6407. }
  6408. /* LRO/HW-GRO features cannot be combined with RX-FCS */
  6409. if (features & NETIF_F_RXFCS) {
  6410. if (features & NETIF_F_LRO) {
  6411. netdev_dbg(dev, "Dropping LRO feature since RX-FCS is requested.\n");
  6412. features &= ~NETIF_F_LRO;
  6413. }
  6414. if (features & NETIF_F_GRO_HW) {
  6415. netdev_dbg(dev, "Dropping HW-GRO feature since RX-FCS is requested.\n");
  6416. features &= ~NETIF_F_GRO_HW;
  6417. }
  6418. }
  6419. return features;
  6420. }
  6421. int __netdev_update_features(struct net_device *dev)
  6422. {
  6423. struct net_device *upper, *lower;
  6424. netdev_features_t features;
  6425. struct list_head *iter;
  6426. int err = -1;
  6427. ASSERT_RTNL();
  6428. features = netdev_get_wanted_features(dev);
  6429. if (dev->netdev_ops->ndo_fix_features)
  6430. features = dev->netdev_ops->ndo_fix_features(dev, features);
  6431. /* driver might be less strict about feature dependencies */
  6432. features = netdev_fix_features(dev, features);
  6433. /* some features can't be enabled if they're off an an upper device */
  6434. netdev_for_each_upper_dev_rcu(dev, upper, iter)
  6435. features = netdev_sync_upper_features(dev, upper, features);
  6436. if (dev->features == features)
  6437. goto sync_lower;
  6438. netdev_dbg(dev, "Features changed: %pNF -> %pNF\n",
  6439. &dev->features, &features);
  6440. if (dev->netdev_ops->ndo_set_features)
  6441. err = dev->netdev_ops->ndo_set_features(dev, features);
  6442. else
  6443. err = 0;
  6444. if (unlikely(err < 0)) {
  6445. netdev_err(dev,
  6446. "set_features() failed (%d); wanted %pNF, left %pNF\n",
  6447. err, &features, &dev->features);
  6448. /* return non-0 since some features might have changed and
  6449. * it's better to fire a spurious notification than miss it
  6450. */
  6451. return -1;
  6452. }
  6453. sync_lower:
  6454. /* some features must be disabled on lower devices when disabled
  6455. * on an upper device (think: bonding master or bridge)
  6456. */
  6457. netdev_for_each_lower_dev(dev, lower, iter)
  6458. netdev_sync_lower_features(dev, lower, features);
  6459. if (!err) {
  6460. netdev_features_t diff = features ^ dev->features;
  6461. if (diff & NETIF_F_RX_UDP_TUNNEL_PORT) {
  6462. /* udp_tunnel_{get,drop}_rx_info both need
  6463. * NETIF_F_RX_UDP_TUNNEL_PORT enabled on the
  6464. * device, or they won't do anything.
  6465. * Thus we need to update dev->features
  6466. * *before* calling udp_tunnel_get_rx_info,
  6467. * but *after* calling udp_tunnel_drop_rx_info.
  6468. */
  6469. if (features & NETIF_F_RX_UDP_TUNNEL_PORT) {
  6470. dev->features = features;
  6471. udp_tunnel_get_rx_info(dev);
  6472. } else {
  6473. udp_tunnel_drop_rx_info(dev);
  6474. }
  6475. }
  6476. if (diff & NETIF_F_HW_VLAN_CTAG_FILTER) {
  6477. if (features & NETIF_F_HW_VLAN_CTAG_FILTER) {
  6478. dev->features = features;
  6479. err |= vlan_get_rx_ctag_filter_info(dev);
  6480. } else {
  6481. vlan_drop_rx_ctag_filter_info(dev);
  6482. }
  6483. }
  6484. if (diff & NETIF_F_HW_VLAN_STAG_FILTER) {
  6485. if (features & NETIF_F_HW_VLAN_STAG_FILTER) {
  6486. dev->features = features;
  6487. err |= vlan_get_rx_stag_filter_info(dev);
  6488. } else {
  6489. vlan_drop_rx_stag_filter_info(dev);
  6490. }
  6491. }
  6492. dev->features = features;
  6493. }
  6494. return err < 0 ? 0 : 1;
  6495. }
  6496. /**
  6497. * netdev_update_features - recalculate device features
  6498. * @dev: the device to check
  6499. *
  6500. * Recalculate dev->features set and send notifications if it
  6501. * has changed. Should be called after driver or hardware dependent
  6502. * conditions might have changed that influence the features.
  6503. */
  6504. void netdev_update_features(struct net_device *dev)
  6505. {
  6506. if (__netdev_update_features(dev))
  6507. netdev_features_change(dev);
  6508. }
  6509. EXPORT_SYMBOL(netdev_update_features);
  6510. /**
  6511. * netdev_change_features - recalculate device features
  6512. * @dev: the device to check
  6513. *
  6514. * Recalculate dev->features set and send notifications even
  6515. * if they have not changed. Should be called instead of
  6516. * netdev_update_features() if also dev->vlan_features might
  6517. * have changed to allow the changes to be propagated to stacked
  6518. * VLAN devices.
  6519. */
  6520. void netdev_change_features(struct net_device *dev)
  6521. {
  6522. __netdev_update_features(dev);
  6523. netdev_features_change(dev);
  6524. }
  6525. EXPORT_SYMBOL(netdev_change_features);
  6526. /**
  6527. * netif_stacked_transfer_operstate - transfer operstate
  6528. * @rootdev: the root or lower level device to transfer state from
  6529. * @dev: the device to transfer operstate to
  6530. *
  6531. * Transfer operational state from root to device. This is normally
  6532. * called when a stacking relationship exists between the root
  6533. * device and the device(a leaf device).
  6534. */
  6535. void netif_stacked_transfer_operstate(const struct net_device *rootdev,
  6536. struct net_device *dev)
  6537. {
  6538. if (rootdev->operstate == IF_OPER_DORMANT)
  6539. netif_dormant_on(dev);
  6540. else
  6541. netif_dormant_off(dev);
  6542. if (netif_carrier_ok(rootdev))
  6543. netif_carrier_on(dev);
  6544. else
  6545. netif_carrier_off(dev);
  6546. }
  6547. EXPORT_SYMBOL(netif_stacked_transfer_operstate);
  6548. static int netif_alloc_rx_queues(struct net_device *dev)
  6549. {
  6550. unsigned int i, count = dev->num_rx_queues;
  6551. struct netdev_rx_queue *rx;
  6552. size_t sz = count * sizeof(*rx);
  6553. int err = 0;
  6554. BUG_ON(count < 1);
  6555. rx = kvzalloc(sz, GFP_KERNEL | __GFP_RETRY_MAYFAIL);
  6556. if (!rx)
  6557. return -ENOMEM;
  6558. dev->_rx = rx;
  6559. for (i = 0; i < count; i++) {
  6560. rx[i].dev = dev;
  6561. /* XDP RX-queue setup */
  6562. err = xdp_rxq_info_reg(&rx[i].xdp_rxq, dev, i);
  6563. if (err < 0)
  6564. goto err_rxq_info;
  6565. }
  6566. return 0;
  6567. err_rxq_info:
  6568. /* Rollback successful reg's and free other resources */
  6569. while (i--)
  6570. xdp_rxq_info_unreg(&rx[i].xdp_rxq);
  6571. kvfree(dev->_rx);
  6572. dev->_rx = NULL;
  6573. return err;
  6574. }
  6575. static void netif_free_rx_queues(struct net_device *dev)
  6576. {
  6577. unsigned int i, count = dev->num_rx_queues;
  6578. /* netif_alloc_rx_queues alloc failed, resources have been unreg'ed */
  6579. if (!dev->_rx)
  6580. return;
  6581. for (i = 0; i < count; i++)
  6582. xdp_rxq_info_unreg(&dev->_rx[i].xdp_rxq);
  6583. kvfree(dev->_rx);
  6584. }
  6585. static void netdev_init_one_queue(struct net_device *dev,
  6586. struct netdev_queue *queue, void *_unused)
  6587. {
  6588. /* Initialize queue lock */
  6589. spin_lock_init(&queue->_xmit_lock);
  6590. netdev_set_xmit_lockdep_class(&queue->_xmit_lock, dev->type);
  6591. queue->xmit_lock_owner = -1;
  6592. netdev_queue_numa_node_write(queue, NUMA_NO_NODE);
  6593. queue->dev = dev;
  6594. #ifdef CONFIG_BQL
  6595. dql_init(&queue->dql, HZ);
  6596. #endif
  6597. }
  6598. static void netif_free_tx_queues(struct net_device *dev)
  6599. {
  6600. kvfree(dev->_tx);
  6601. }
  6602. static int netif_alloc_netdev_queues(struct net_device *dev)
  6603. {
  6604. unsigned int count = dev->num_tx_queues;
  6605. struct netdev_queue *tx;
  6606. size_t sz = count * sizeof(*tx);
  6607. if (count < 1 || count > 0xffff)
  6608. return -EINVAL;
  6609. tx = kvzalloc(sz, GFP_KERNEL | __GFP_RETRY_MAYFAIL);
  6610. if (!tx)
  6611. return -ENOMEM;
  6612. dev->_tx = tx;
  6613. netdev_for_each_tx_queue(dev, netdev_init_one_queue, NULL);
  6614. spin_lock_init(&dev->tx_global_lock);
  6615. return 0;
  6616. }
  6617. void netif_tx_stop_all_queues(struct net_device *dev)
  6618. {
  6619. unsigned int i;
  6620. for (i = 0; i < dev->num_tx_queues; i++) {
  6621. struct netdev_queue *txq = netdev_get_tx_queue(dev, i);
  6622. netif_tx_stop_queue(txq);
  6623. }
  6624. }
  6625. EXPORT_SYMBOL(netif_tx_stop_all_queues);
  6626. /**
  6627. * register_netdevice - register a network device
  6628. * @dev: device to register
  6629. *
  6630. * Take a completed network device structure and add it to the kernel
  6631. * interfaces. A %NETDEV_REGISTER message is sent to the netdev notifier
  6632. * chain. 0 is returned on success. A negative errno code is returned
  6633. * on a failure to set up the device, or if the name is a duplicate.
  6634. *
  6635. * Callers must hold the rtnl semaphore. You may want
  6636. * register_netdev() instead of this.
  6637. *
  6638. * BUGS:
  6639. * The locking appears insufficient to guarantee two parallel registers
  6640. * will not get the same name.
  6641. */
  6642. int register_netdevice(struct net_device *dev)
  6643. {
  6644. int ret;
  6645. struct net *net = dev_net(dev);
  6646. BUG_ON(dev_boot_phase);
  6647. ASSERT_RTNL();
  6648. might_sleep();
  6649. /* When net_device's are persistent, this will be fatal. */
  6650. BUG_ON(dev->reg_state != NETREG_UNINITIALIZED);
  6651. BUG_ON(!net);
  6652. spin_lock_init(&dev->addr_list_lock);
  6653. netdev_set_addr_lockdep_class(dev);
  6654. ret = dev_get_valid_name(net, dev, dev->name);
  6655. if (ret < 0)
  6656. goto out;
  6657. /* Init, if this function is available */
  6658. if (dev->netdev_ops->ndo_init) {
  6659. ret = dev->netdev_ops->ndo_init(dev);
  6660. if (ret) {
  6661. if (ret > 0)
  6662. ret = -EIO;
  6663. goto out;
  6664. }
  6665. }
  6666. if (((dev->hw_features | dev->features) &
  6667. NETIF_F_HW_VLAN_CTAG_FILTER) &&
  6668. (!dev->netdev_ops->ndo_vlan_rx_add_vid ||
  6669. !dev->netdev_ops->ndo_vlan_rx_kill_vid)) {
  6670. netdev_WARN(dev, "Buggy VLAN acceleration in driver!\n");
  6671. ret = -EINVAL;
  6672. goto err_uninit;
  6673. }
  6674. ret = -EBUSY;
  6675. if (!dev->ifindex)
  6676. dev->ifindex = dev_new_index(net);
  6677. else if (__dev_get_by_index(net, dev->ifindex))
  6678. goto err_uninit;
  6679. /* Transfer changeable features to wanted_features and enable
  6680. * software offloads (GSO and GRO).
  6681. */
  6682. dev->hw_features |= NETIF_F_SOFT_FEATURES;
  6683. dev->features |= NETIF_F_SOFT_FEATURES;
  6684. if (dev->netdev_ops->ndo_udp_tunnel_add) {
  6685. dev->features |= NETIF_F_RX_UDP_TUNNEL_PORT;
  6686. dev->hw_features |= NETIF_F_RX_UDP_TUNNEL_PORT;
  6687. }
  6688. dev->wanted_features = dev->features & dev->hw_features;
  6689. if (!(dev->flags & IFF_LOOPBACK))
  6690. dev->hw_features |= NETIF_F_NOCACHE_COPY;
  6691. /* If IPv4 TCP segmentation offload is supported we should also
  6692. * allow the device to enable segmenting the frame with the option
  6693. * of ignoring a static IP ID value. This doesn't enable the
  6694. * feature itself but allows the user to enable it later.
  6695. */
  6696. if (dev->hw_features & NETIF_F_TSO)
  6697. dev->hw_features |= NETIF_F_TSO_MANGLEID;
  6698. if (dev->vlan_features & NETIF_F_TSO)
  6699. dev->vlan_features |= NETIF_F_TSO_MANGLEID;
  6700. if (dev->mpls_features & NETIF_F_TSO)
  6701. dev->mpls_features |= NETIF_F_TSO_MANGLEID;
  6702. if (dev->hw_enc_features & NETIF_F_TSO)
  6703. dev->hw_enc_features |= NETIF_F_TSO_MANGLEID;
  6704. /* Make NETIF_F_HIGHDMA inheritable to VLAN devices.
  6705. */
  6706. dev->vlan_features |= NETIF_F_HIGHDMA;
  6707. /* Make NETIF_F_SG inheritable to tunnel devices.
  6708. */
  6709. dev->hw_enc_features |= NETIF_F_SG | NETIF_F_GSO_PARTIAL;
  6710. /* Make NETIF_F_SG inheritable to MPLS.
  6711. */
  6712. dev->mpls_features |= NETIF_F_SG;
  6713. ret = call_netdevice_notifiers(NETDEV_POST_INIT, dev);
  6714. ret = notifier_to_errno(ret);
  6715. if (ret)
  6716. goto err_uninit;
  6717. ret = netdev_register_kobject(dev);
  6718. if (ret)
  6719. goto err_uninit;
  6720. dev->reg_state = NETREG_REGISTERED;
  6721. __netdev_update_features(dev);
  6722. /*
  6723. * Default initial state at registry is that the
  6724. * device is present.
  6725. */
  6726. set_bit(__LINK_STATE_PRESENT, &dev->state);
  6727. linkwatch_init_dev(dev);
  6728. dev_init_scheduler(dev);
  6729. dev_hold(dev);
  6730. list_netdevice(dev);
  6731. add_device_randomness(dev->dev_addr, dev->addr_len);
  6732. /* If the device has permanent device address, driver should
  6733. * set dev_addr and also addr_assign_type should be set to
  6734. * NET_ADDR_PERM (default value).
  6735. */
  6736. if (dev->addr_assign_type == NET_ADDR_PERM)
  6737. memcpy(dev->perm_addr, dev->dev_addr, dev->addr_len);
  6738. /* Notify protocols, that a new device appeared. */
  6739. ret = call_netdevice_notifiers(NETDEV_REGISTER, dev);
  6740. ret = notifier_to_errno(ret);
  6741. if (ret) {
  6742. rollback_registered(dev);
  6743. dev->reg_state = NETREG_UNREGISTERED;
  6744. }
  6745. /*
  6746. * Prevent userspace races by waiting until the network
  6747. * device is fully setup before sending notifications.
  6748. */
  6749. if (!dev->rtnl_link_ops ||
  6750. dev->rtnl_link_state == RTNL_LINK_INITIALIZED)
  6751. rtmsg_ifinfo(RTM_NEWLINK, dev, ~0U, GFP_KERNEL);
  6752. out:
  6753. return ret;
  6754. err_uninit:
  6755. if (dev->netdev_ops->ndo_uninit)
  6756. dev->netdev_ops->ndo_uninit(dev);
  6757. if (dev->priv_destructor)
  6758. dev->priv_destructor(dev);
  6759. goto out;
  6760. }
  6761. EXPORT_SYMBOL(register_netdevice);
  6762. /**
  6763. * init_dummy_netdev - init a dummy network device for NAPI
  6764. * @dev: device to init
  6765. *
  6766. * This takes a network device structure and initialize the minimum
  6767. * amount of fields so it can be used to schedule NAPI polls without
  6768. * registering a full blown interface. This is to be used by drivers
  6769. * that need to tie several hardware interfaces to a single NAPI
  6770. * poll scheduler due to HW limitations.
  6771. */
  6772. int init_dummy_netdev(struct net_device *dev)
  6773. {
  6774. /* Clear everything. Note we don't initialize spinlocks
  6775. * are they aren't supposed to be taken by any of the
  6776. * NAPI code and this dummy netdev is supposed to be
  6777. * only ever used for NAPI polls
  6778. */
  6779. memset(dev, 0, sizeof(struct net_device));
  6780. /* make sure we BUG if trying to hit standard
  6781. * register/unregister code path
  6782. */
  6783. dev->reg_state = NETREG_DUMMY;
  6784. /* NAPI wants this */
  6785. INIT_LIST_HEAD(&dev->napi_list);
  6786. /* a dummy interface is started by default */
  6787. set_bit(__LINK_STATE_PRESENT, &dev->state);
  6788. set_bit(__LINK_STATE_START, &dev->state);
  6789. /* Note : We dont allocate pcpu_refcnt for dummy devices,
  6790. * because users of this 'device' dont need to change
  6791. * its refcount.
  6792. */
  6793. return 0;
  6794. }
  6795. EXPORT_SYMBOL_GPL(init_dummy_netdev);
  6796. /**
  6797. * register_netdev - register a network device
  6798. * @dev: device to register
  6799. *
  6800. * Take a completed network device structure and add it to the kernel
  6801. * interfaces. A %NETDEV_REGISTER message is sent to the netdev notifier
  6802. * chain. 0 is returned on success. A negative errno code is returned
  6803. * on a failure to set up the device, or if the name is a duplicate.
  6804. *
  6805. * This is a wrapper around register_netdevice that takes the rtnl semaphore
  6806. * and expands the device name if you passed a format string to
  6807. * alloc_netdev.
  6808. */
  6809. int register_netdev(struct net_device *dev)
  6810. {
  6811. int err;
  6812. if (rtnl_lock_killable())
  6813. return -EINTR;
  6814. err = register_netdevice(dev);
  6815. rtnl_unlock();
  6816. return err;
  6817. }
  6818. EXPORT_SYMBOL(register_netdev);
  6819. int netdev_refcnt_read(const struct net_device *dev)
  6820. {
  6821. int i, refcnt = 0;
  6822. for_each_possible_cpu(i)
  6823. refcnt += *per_cpu_ptr(dev->pcpu_refcnt, i);
  6824. return refcnt;
  6825. }
  6826. EXPORT_SYMBOL(netdev_refcnt_read);
  6827. /**
  6828. * netdev_wait_allrefs - wait until all references are gone.
  6829. * @dev: target net_device
  6830. *
  6831. * This is called when unregistering network devices.
  6832. *
  6833. * Any protocol or device that holds a reference should register
  6834. * for netdevice notification, and cleanup and put back the
  6835. * reference if they receive an UNREGISTER event.
  6836. * We can get stuck here if buggy protocols don't correctly
  6837. * call dev_put.
  6838. */
  6839. static void netdev_wait_allrefs(struct net_device *dev)
  6840. {
  6841. unsigned long rebroadcast_time, warning_time;
  6842. int refcnt;
  6843. linkwatch_forget_dev(dev);
  6844. rebroadcast_time = warning_time = jiffies;
  6845. refcnt = netdev_refcnt_read(dev);
  6846. while (refcnt != 0) {
  6847. if (time_after(jiffies, rebroadcast_time + 1 * HZ)) {
  6848. rtnl_lock();
  6849. /* Rebroadcast unregister notification */
  6850. call_netdevice_notifiers(NETDEV_UNREGISTER, dev);
  6851. __rtnl_unlock();
  6852. rcu_barrier();
  6853. rtnl_lock();
  6854. if (test_bit(__LINK_STATE_LINKWATCH_PENDING,
  6855. &dev->state)) {
  6856. /* We must not have linkwatch events
  6857. * pending on unregister. If this
  6858. * happens, we simply run the queue
  6859. * unscheduled, resulting in a noop
  6860. * for this device.
  6861. */
  6862. linkwatch_run_queue();
  6863. }
  6864. __rtnl_unlock();
  6865. rebroadcast_time = jiffies;
  6866. }
  6867. msleep(250);
  6868. refcnt = netdev_refcnt_read(dev);
  6869. if (time_after(jiffies, warning_time + 10 * HZ)) {
  6870. pr_emerg("unregister_netdevice: waiting for %s to become free. Usage count = %d\n",
  6871. dev->name, refcnt);
  6872. warning_time = jiffies;
  6873. }
  6874. }
  6875. }
  6876. /* The sequence is:
  6877. *
  6878. * rtnl_lock();
  6879. * ...
  6880. * register_netdevice(x1);
  6881. * register_netdevice(x2);
  6882. * ...
  6883. * unregister_netdevice(y1);
  6884. * unregister_netdevice(y2);
  6885. * ...
  6886. * rtnl_unlock();
  6887. * free_netdev(y1);
  6888. * free_netdev(y2);
  6889. *
  6890. * We are invoked by rtnl_unlock().
  6891. * This allows us to deal with problems:
  6892. * 1) We can delete sysfs objects which invoke hotplug
  6893. * without deadlocking with linkwatch via keventd.
  6894. * 2) Since we run with the RTNL semaphore not held, we can sleep
  6895. * safely in order to wait for the netdev refcnt to drop to zero.
  6896. *
  6897. * We must not return until all unregister events added during
  6898. * the interval the lock was held have been completed.
  6899. */
  6900. void netdev_run_todo(void)
  6901. {
  6902. struct list_head list;
  6903. /* Snapshot list, allow later requests */
  6904. list_replace_init(&net_todo_list, &list);
  6905. __rtnl_unlock();
  6906. /* Wait for rcu callbacks to finish before next phase */
  6907. if (!list_empty(&list))
  6908. rcu_barrier();
  6909. while (!list_empty(&list)) {
  6910. struct net_device *dev
  6911. = list_first_entry(&list, struct net_device, todo_list);
  6912. list_del(&dev->todo_list);
  6913. if (unlikely(dev->reg_state != NETREG_UNREGISTERING)) {
  6914. pr_err("network todo '%s' but state %d\n",
  6915. dev->name, dev->reg_state);
  6916. dump_stack();
  6917. continue;
  6918. }
  6919. dev->reg_state = NETREG_UNREGISTERED;
  6920. netdev_wait_allrefs(dev);
  6921. /* paranoia */
  6922. BUG_ON(netdev_refcnt_read(dev));
  6923. BUG_ON(!list_empty(&dev->ptype_all));
  6924. BUG_ON(!list_empty(&dev->ptype_specific));
  6925. WARN_ON(rcu_access_pointer(dev->ip_ptr));
  6926. WARN_ON(rcu_access_pointer(dev->ip6_ptr));
  6927. #if IS_ENABLED(CONFIG_DECNET)
  6928. WARN_ON(dev->dn_ptr);
  6929. #endif
  6930. if (dev->priv_destructor)
  6931. dev->priv_destructor(dev);
  6932. if (dev->needs_free_netdev)
  6933. free_netdev(dev);
  6934. /* Report a network device has been unregistered */
  6935. rtnl_lock();
  6936. dev_net(dev)->dev_unreg_count--;
  6937. __rtnl_unlock();
  6938. wake_up(&netdev_unregistering_wq);
  6939. /* Free network device */
  6940. kobject_put(&dev->dev.kobj);
  6941. }
  6942. }
  6943. /* Convert net_device_stats to rtnl_link_stats64. rtnl_link_stats64 has
  6944. * all the same fields in the same order as net_device_stats, with only
  6945. * the type differing, but rtnl_link_stats64 may have additional fields
  6946. * at the end for newer counters.
  6947. */
  6948. void netdev_stats_to_stats64(struct rtnl_link_stats64 *stats64,
  6949. const struct net_device_stats *netdev_stats)
  6950. {
  6951. #if BITS_PER_LONG == 64
  6952. BUILD_BUG_ON(sizeof(*stats64) < sizeof(*netdev_stats));
  6953. memcpy(stats64, netdev_stats, sizeof(*netdev_stats));
  6954. /* zero out counters that only exist in rtnl_link_stats64 */
  6955. memset((char *)stats64 + sizeof(*netdev_stats), 0,
  6956. sizeof(*stats64) - sizeof(*netdev_stats));
  6957. #else
  6958. size_t i, n = sizeof(*netdev_stats) / sizeof(unsigned long);
  6959. const unsigned long *src = (const unsigned long *)netdev_stats;
  6960. u64 *dst = (u64 *)stats64;
  6961. BUILD_BUG_ON(n > sizeof(*stats64) / sizeof(u64));
  6962. for (i = 0; i < n; i++)
  6963. dst[i] = src[i];
  6964. /* zero out counters that only exist in rtnl_link_stats64 */
  6965. memset((char *)stats64 + n * sizeof(u64), 0,
  6966. sizeof(*stats64) - n * sizeof(u64));
  6967. #endif
  6968. }
  6969. EXPORT_SYMBOL(netdev_stats_to_stats64);
  6970. /**
  6971. * dev_get_stats - get network device statistics
  6972. * @dev: device to get statistics from
  6973. * @storage: place to store stats
  6974. *
  6975. * Get network statistics from device. Return @storage.
  6976. * The device driver may provide its own method by setting
  6977. * dev->netdev_ops->get_stats64 or dev->netdev_ops->get_stats;
  6978. * otherwise the internal statistics structure is used.
  6979. */
  6980. struct rtnl_link_stats64 *dev_get_stats(struct net_device *dev,
  6981. struct rtnl_link_stats64 *storage)
  6982. {
  6983. const struct net_device_ops *ops = dev->netdev_ops;
  6984. if (ops->ndo_get_stats64) {
  6985. memset(storage, 0, sizeof(*storage));
  6986. ops->ndo_get_stats64(dev, storage);
  6987. } else if (ops->ndo_get_stats) {
  6988. netdev_stats_to_stats64(storage, ops->ndo_get_stats(dev));
  6989. } else {
  6990. netdev_stats_to_stats64(storage, &dev->stats);
  6991. }
  6992. storage->rx_dropped += (unsigned long)atomic_long_read(&dev->rx_dropped);
  6993. storage->tx_dropped += (unsigned long)atomic_long_read(&dev->tx_dropped);
  6994. storage->rx_nohandler += (unsigned long)atomic_long_read(&dev->rx_nohandler);
  6995. return storage;
  6996. }
  6997. EXPORT_SYMBOL(dev_get_stats);
  6998. struct netdev_queue *dev_ingress_queue_create(struct net_device *dev)
  6999. {
  7000. struct netdev_queue *queue = dev_ingress_queue(dev);
  7001. #ifdef CONFIG_NET_CLS_ACT
  7002. if (queue)
  7003. return queue;
  7004. queue = kzalloc(sizeof(*queue), GFP_KERNEL);
  7005. if (!queue)
  7006. return NULL;
  7007. netdev_init_one_queue(dev, queue, NULL);
  7008. RCU_INIT_POINTER(queue->qdisc, &noop_qdisc);
  7009. queue->qdisc_sleeping = &noop_qdisc;
  7010. rcu_assign_pointer(dev->ingress_queue, queue);
  7011. #endif
  7012. return queue;
  7013. }
  7014. static const struct ethtool_ops default_ethtool_ops;
  7015. void netdev_set_default_ethtool_ops(struct net_device *dev,
  7016. const struct ethtool_ops *ops)
  7017. {
  7018. if (dev->ethtool_ops == &default_ethtool_ops)
  7019. dev->ethtool_ops = ops;
  7020. }
  7021. EXPORT_SYMBOL_GPL(netdev_set_default_ethtool_ops);
  7022. void netdev_freemem(struct net_device *dev)
  7023. {
  7024. char *addr = (char *)dev - dev->padded;
  7025. kvfree(addr);
  7026. }
  7027. /**
  7028. * alloc_netdev_mqs - allocate network device
  7029. * @sizeof_priv: size of private data to allocate space for
  7030. * @name: device name format string
  7031. * @name_assign_type: origin of device name
  7032. * @setup: callback to initialize device
  7033. * @txqs: the number of TX subqueues to allocate
  7034. * @rxqs: the number of RX subqueues to allocate
  7035. *
  7036. * Allocates a struct net_device with private data area for driver use
  7037. * and performs basic initialization. Also allocates subqueue structs
  7038. * for each queue on the device.
  7039. */
  7040. struct net_device *alloc_netdev_mqs(int sizeof_priv, const char *name,
  7041. unsigned char name_assign_type,
  7042. void (*setup)(struct net_device *),
  7043. unsigned int txqs, unsigned int rxqs)
  7044. {
  7045. struct net_device *dev;
  7046. unsigned int alloc_size;
  7047. struct net_device *p;
  7048. BUG_ON(strlen(name) >= sizeof(dev->name));
  7049. if (txqs < 1) {
  7050. pr_err("alloc_netdev: Unable to allocate device with zero queues\n");
  7051. return NULL;
  7052. }
  7053. if (rxqs < 1) {
  7054. pr_err("alloc_netdev: Unable to allocate device with zero RX queues\n");
  7055. return NULL;
  7056. }
  7057. alloc_size = sizeof(struct net_device);
  7058. if (sizeof_priv) {
  7059. /* ensure 32-byte alignment of private area */
  7060. alloc_size = ALIGN(alloc_size, NETDEV_ALIGN);
  7061. alloc_size += sizeof_priv;
  7062. }
  7063. /* ensure 32-byte alignment of whole construct */
  7064. alloc_size += NETDEV_ALIGN - 1;
  7065. p = kvzalloc(alloc_size, GFP_KERNEL | __GFP_RETRY_MAYFAIL);
  7066. if (!p)
  7067. return NULL;
  7068. dev = PTR_ALIGN(p, NETDEV_ALIGN);
  7069. dev->padded = (char *)dev - (char *)p;
  7070. dev->pcpu_refcnt = alloc_percpu(int);
  7071. if (!dev->pcpu_refcnt)
  7072. goto free_dev;
  7073. if (dev_addr_init(dev))
  7074. goto free_pcpu;
  7075. dev_mc_init(dev);
  7076. dev_uc_init(dev);
  7077. dev_net_set(dev, &init_net);
  7078. dev->gso_max_size = GSO_MAX_SIZE;
  7079. dev->gso_max_segs = GSO_MAX_SEGS;
  7080. INIT_LIST_HEAD(&dev->napi_list);
  7081. INIT_LIST_HEAD(&dev->unreg_list);
  7082. INIT_LIST_HEAD(&dev->close_list);
  7083. INIT_LIST_HEAD(&dev->link_watch_list);
  7084. INIT_LIST_HEAD(&dev->adj_list.upper);
  7085. INIT_LIST_HEAD(&dev->adj_list.lower);
  7086. INIT_LIST_HEAD(&dev->ptype_all);
  7087. INIT_LIST_HEAD(&dev->ptype_specific);
  7088. #ifdef CONFIG_NET_SCHED
  7089. hash_init(dev->qdisc_hash);
  7090. #endif
  7091. dev->priv_flags = IFF_XMIT_DST_RELEASE | IFF_XMIT_DST_RELEASE_PERM;
  7092. setup(dev);
  7093. if (!dev->tx_queue_len) {
  7094. dev->priv_flags |= IFF_NO_QUEUE;
  7095. dev->tx_queue_len = DEFAULT_TX_QUEUE_LEN;
  7096. }
  7097. dev->num_tx_queues = txqs;
  7098. dev->real_num_tx_queues = txqs;
  7099. if (netif_alloc_netdev_queues(dev))
  7100. goto free_all;
  7101. dev->num_rx_queues = rxqs;
  7102. dev->real_num_rx_queues = rxqs;
  7103. if (netif_alloc_rx_queues(dev))
  7104. goto free_all;
  7105. strcpy(dev->name, name);
  7106. dev->name_assign_type = name_assign_type;
  7107. dev->group = INIT_NETDEV_GROUP;
  7108. if (!dev->ethtool_ops)
  7109. dev->ethtool_ops = &default_ethtool_ops;
  7110. nf_hook_ingress_init(dev);
  7111. return dev;
  7112. free_all:
  7113. free_netdev(dev);
  7114. return NULL;
  7115. free_pcpu:
  7116. free_percpu(dev->pcpu_refcnt);
  7117. free_dev:
  7118. netdev_freemem(dev);
  7119. return NULL;
  7120. }
  7121. EXPORT_SYMBOL(alloc_netdev_mqs);
  7122. /**
  7123. * free_netdev - free network device
  7124. * @dev: device
  7125. *
  7126. * This function does the last stage of destroying an allocated device
  7127. * interface. The reference to the device object is released. If this
  7128. * is the last reference then it will be freed.Must be called in process
  7129. * context.
  7130. */
  7131. void free_netdev(struct net_device *dev)
  7132. {
  7133. struct napi_struct *p, *n;
  7134. might_sleep();
  7135. netif_free_tx_queues(dev);
  7136. netif_free_rx_queues(dev);
  7137. kfree(rcu_dereference_protected(dev->ingress_queue, 1));
  7138. /* Flush device addresses */
  7139. dev_addr_flush(dev);
  7140. list_for_each_entry_safe(p, n, &dev->napi_list, dev_list)
  7141. netif_napi_del(p);
  7142. free_percpu(dev->pcpu_refcnt);
  7143. dev->pcpu_refcnt = NULL;
  7144. /* Compatibility with error handling in drivers */
  7145. if (dev->reg_state == NETREG_UNINITIALIZED) {
  7146. netdev_freemem(dev);
  7147. return;
  7148. }
  7149. BUG_ON(dev->reg_state != NETREG_UNREGISTERED);
  7150. dev->reg_state = NETREG_RELEASED;
  7151. /* will free via device release */
  7152. put_device(&dev->dev);
  7153. }
  7154. EXPORT_SYMBOL(free_netdev);
  7155. /**
  7156. * synchronize_net - Synchronize with packet receive processing
  7157. *
  7158. * Wait for packets currently being received to be done.
  7159. * Does not block later packets from starting.
  7160. */
  7161. void synchronize_net(void)
  7162. {
  7163. might_sleep();
  7164. if (rtnl_is_locked())
  7165. synchronize_rcu_expedited();
  7166. else
  7167. synchronize_rcu();
  7168. }
  7169. EXPORT_SYMBOL(synchronize_net);
  7170. /**
  7171. * unregister_netdevice_queue - remove device from the kernel
  7172. * @dev: device
  7173. * @head: list
  7174. *
  7175. * This function shuts down a device interface and removes it
  7176. * from the kernel tables.
  7177. * If head not NULL, device is queued to be unregistered later.
  7178. *
  7179. * Callers must hold the rtnl semaphore. You may want
  7180. * unregister_netdev() instead of this.
  7181. */
  7182. void unregister_netdevice_queue(struct net_device *dev, struct list_head *head)
  7183. {
  7184. ASSERT_RTNL();
  7185. if (head) {
  7186. list_move_tail(&dev->unreg_list, head);
  7187. } else {
  7188. rollback_registered(dev);
  7189. /* Finish processing unregister after unlock */
  7190. net_set_todo(dev);
  7191. }
  7192. }
  7193. EXPORT_SYMBOL(unregister_netdevice_queue);
  7194. /**
  7195. * unregister_netdevice_many - unregister many devices
  7196. * @head: list of devices
  7197. *
  7198. * Note: As most callers use a stack allocated list_head,
  7199. * we force a list_del() to make sure stack wont be corrupted later.
  7200. */
  7201. void unregister_netdevice_many(struct list_head *head)
  7202. {
  7203. struct net_device *dev;
  7204. if (!list_empty(head)) {
  7205. rollback_registered_many(head);
  7206. list_for_each_entry(dev, head, unreg_list)
  7207. net_set_todo(dev);
  7208. list_del(head);
  7209. }
  7210. }
  7211. EXPORT_SYMBOL(unregister_netdevice_many);
  7212. /**
  7213. * unregister_netdev - remove device from the kernel
  7214. * @dev: device
  7215. *
  7216. * This function shuts down a device interface and removes it
  7217. * from the kernel tables.
  7218. *
  7219. * This is just a wrapper for unregister_netdevice that takes
  7220. * the rtnl semaphore. In general you want to use this and not
  7221. * unregister_netdevice.
  7222. */
  7223. void unregister_netdev(struct net_device *dev)
  7224. {
  7225. rtnl_lock();
  7226. unregister_netdevice(dev);
  7227. rtnl_unlock();
  7228. }
  7229. EXPORT_SYMBOL(unregister_netdev);
  7230. /**
  7231. * dev_change_net_namespace - move device to different nethost namespace
  7232. * @dev: device
  7233. * @net: network namespace
  7234. * @pat: If not NULL name pattern to try if the current device name
  7235. * is already taken in the destination network namespace.
  7236. *
  7237. * This function shuts down a device interface and moves it
  7238. * to a new network namespace. On success 0 is returned, on
  7239. * a failure a netagive errno code is returned.
  7240. *
  7241. * Callers must hold the rtnl semaphore.
  7242. */
  7243. int dev_change_net_namespace(struct net_device *dev, struct net *net, const char *pat)
  7244. {
  7245. int err, new_nsid, new_ifindex;
  7246. ASSERT_RTNL();
  7247. /* Don't allow namespace local devices to be moved. */
  7248. err = -EINVAL;
  7249. if (dev->features & NETIF_F_NETNS_LOCAL)
  7250. goto out;
  7251. /* Ensure the device has been registrered */
  7252. if (dev->reg_state != NETREG_REGISTERED)
  7253. goto out;
  7254. /* Get out if there is nothing todo */
  7255. err = 0;
  7256. if (net_eq(dev_net(dev), net))
  7257. goto out;
  7258. /* Pick the destination device name, and ensure
  7259. * we can use it in the destination network namespace.
  7260. */
  7261. err = -EEXIST;
  7262. if (__dev_get_by_name(net, dev->name)) {
  7263. /* We get here if we can't use the current device name */
  7264. if (!pat)
  7265. goto out;
  7266. if (dev_get_valid_name(net, dev, pat) < 0)
  7267. goto out;
  7268. }
  7269. /*
  7270. * And now a mini version of register_netdevice unregister_netdevice.
  7271. */
  7272. /* If device is running close it first. */
  7273. dev_close(dev);
  7274. /* And unlink it from device chain */
  7275. err = -ENODEV;
  7276. unlist_netdevice(dev);
  7277. synchronize_net();
  7278. /* Shutdown queueing discipline. */
  7279. dev_shutdown(dev);
  7280. /* Notify protocols, that we are about to destroy
  7281. * this device. They should clean all the things.
  7282. *
  7283. * Note that dev->reg_state stays at NETREG_REGISTERED.
  7284. * This is wanted because this way 8021q and macvlan know
  7285. * the device is just moving and can keep their slaves up.
  7286. */
  7287. call_netdevice_notifiers(NETDEV_UNREGISTER, dev);
  7288. rcu_barrier();
  7289. new_nsid = peernet2id_alloc(dev_net(dev), net);
  7290. /* If there is an ifindex conflict assign a new one */
  7291. if (__dev_get_by_index(net, dev->ifindex))
  7292. new_ifindex = dev_new_index(net);
  7293. else
  7294. new_ifindex = dev->ifindex;
  7295. rtmsg_ifinfo_newnet(RTM_DELLINK, dev, ~0U, GFP_KERNEL, &new_nsid,
  7296. new_ifindex);
  7297. /*
  7298. * Flush the unicast and multicast chains
  7299. */
  7300. dev_uc_flush(dev);
  7301. dev_mc_flush(dev);
  7302. /* Send a netdev-removed uevent to the old namespace */
  7303. kobject_uevent(&dev->dev.kobj, KOBJ_REMOVE);
  7304. netdev_adjacent_del_links(dev);
  7305. /* Actually switch the network namespace */
  7306. dev_net_set(dev, net);
  7307. dev->ifindex = new_ifindex;
  7308. /* Send a netdev-add uevent to the new namespace */
  7309. kobject_uevent(&dev->dev.kobj, KOBJ_ADD);
  7310. netdev_adjacent_add_links(dev);
  7311. /* Fixup kobjects */
  7312. err = device_rename(&dev->dev, dev->name);
  7313. WARN_ON(err);
  7314. /* Add the device back in the hashes */
  7315. list_netdevice(dev);
  7316. /* Notify protocols, that a new device appeared. */
  7317. call_netdevice_notifiers(NETDEV_REGISTER, dev);
  7318. /*
  7319. * Prevent userspace races by waiting until the network
  7320. * device is fully setup before sending notifications.
  7321. */
  7322. rtmsg_ifinfo(RTM_NEWLINK, dev, ~0U, GFP_KERNEL);
  7323. synchronize_net();
  7324. err = 0;
  7325. out:
  7326. return err;
  7327. }
  7328. EXPORT_SYMBOL_GPL(dev_change_net_namespace);
  7329. static int dev_cpu_dead(unsigned int oldcpu)
  7330. {
  7331. struct sk_buff **list_skb;
  7332. struct sk_buff *skb;
  7333. unsigned int cpu;
  7334. struct softnet_data *sd, *oldsd, *remsd = NULL;
  7335. local_irq_disable();
  7336. cpu = smp_processor_id();
  7337. sd = &per_cpu(softnet_data, cpu);
  7338. oldsd = &per_cpu(softnet_data, oldcpu);
  7339. /* Find end of our completion_queue. */
  7340. list_skb = &sd->completion_queue;
  7341. while (*list_skb)
  7342. list_skb = &(*list_skb)->next;
  7343. /* Append completion queue from offline CPU. */
  7344. *list_skb = oldsd->completion_queue;
  7345. oldsd->completion_queue = NULL;
  7346. /* Append output queue from offline CPU. */
  7347. if (oldsd->output_queue) {
  7348. *sd->output_queue_tailp = oldsd->output_queue;
  7349. sd->output_queue_tailp = oldsd->output_queue_tailp;
  7350. oldsd->output_queue = NULL;
  7351. oldsd->output_queue_tailp = &oldsd->output_queue;
  7352. }
  7353. /* Append NAPI poll list from offline CPU, with one exception :
  7354. * process_backlog() must be called by cpu owning percpu backlog.
  7355. * We properly handle process_queue & input_pkt_queue later.
  7356. */
  7357. while (!list_empty(&oldsd->poll_list)) {
  7358. struct napi_struct *napi = list_first_entry(&oldsd->poll_list,
  7359. struct napi_struct,
  7360. poll_list);
  7361. list_del_init(&napi->poll_list);
  7362. if (napi->poll == process_backlog)
  7363. napi->state = 0;
  7364. else
  7365. ____napi_schedule(sd, napi);
  7366. }
  7367. raise_softirq_irqoff(NET_TX_SOFTIRQ);
  7368. local_irq_enable();
  7369. #ifdef CONFIG_RPS
  7370. remsd = oldsd->rps_ipi_list;
  7371. oldsd->rps_ipi_list = NULL;
  7372. #endif
  7373. /* send out pending IPI's on offline CPU */
  7374. net_rps_send_ipi(remsd);
  7375. /* Process offline CPU's input_pkt_queue */
  7376. while ((skb = __skb_dequeue(&oldsd->process_queue))) {
  7377. netif_rx_ni(skb);
  7378. input_queue_head_incr(oldsd);
  7379. }
  7380. while ((skb = skb_dequeue(&oldsd->input_pkt_queue))) {
  7381. netif_rx_ni(skb);
  7382. input_queue_head_incr(oldsd);
  7383. }
  7384. return 0;
  7385. }
  7386. /**
  7387. * netdev_increment_features - increment feature set by one
  7388. * @all: current feature set
  7389. * @one: new feature set
  7390. * @mask: mask feature set
  7391. *
  7392. * Computes a new feature set after adding a device with feature set
  7393. * @one to the master device with current feature set @all. Will not
  7394. * enable anything that is off in @mask. Returns the new feature set.
  7395. */
  7396. netdev_features_t netdev_increment_features(netdev_features_t all,
  7397. netdev_features_t one, netdev_features_t mask)
  7398. {
  7399. if (mask & NETIF_F_HW_CSUM)
  7400. mask |= NETIF_F_CSUM_MASK;
  7401. mask |= NETIF_F_VLAN_CHALLENGED;
  7402. all |= one & (NETIF_F_ONE_FOR_ALL | NETIF_F_CSUM_MASK) & mask;
  7403. all &= one | ~NETIF_F_ALL_FOR_ALL;
  7404. /* If one device supports hw checksumming, set for all. */
  7405. if (all & NETIF_F_HW_CSUM)
  7406. all &= ~(NETIF_F_CSUM_MASK & ~NETIF_F_HW_CSUM);
  7407. return all;
  7408. }
  7409. EXPORT_SYMBOL(netdev_increment_features);
  7410. static struct hlist_head * __net_init netdev_create_hash(void)
  7411. {
  7412. int i;
  7413. struct hlist_head *hash;
  7414. hash = kmalloc(sizeof(*hash) * NETDEV_HASHENTRIES, GFP_KERNEL);
  7415. if (hash != NULL)
  7416. for (i = 0; i < NETDEV_HASHENTRIES; i++)
  7417. INIT_HLIST_HEAD(&hash[i]);
  7418. return hash;
  7419. }
  7420. /* Initialize per network namespace state */
  7421. static int __net_init netdev_init(struct net *net)
  7422. {
  7423. if (net != &init_net)
  7424. INIT_LIST_HEAD(&net->dev_base_head);
  7425. net->dev_name_head = netdev_create_hash();
  7426. if (net->dev_name_head == NULL)
  7427. goto err_name;
  7428. net->dev_index_head = netdev_create_hash();
  7429. if (net->dev_index_head == NULL)
  7430. goto err_idx;
  7431. return 0;
  7432. err_idx:
  7433. kfree(net->dev_name_head);
  7434. err_name:
  7435. return -ENOMEM;
  7436. }
  7437. /**
  7438. * netdev_drivername - network driver for the device
  7439. * @dev: network device
  7440. *
  7441. * Determine network driver for device.
  7442. */
  7443. const char *netdev_drivername(const struct net_device *dev)
  7444. {
  7445. const struct device_driver *driver;
  7446. const struct device *parent;
  7447. const char *empty = "";
  7448. parent = dev->dev.parent;
  7449. if (!parent)
  7450. return empty;
  7451. driver = parent->driver;
  7452. if (driver && driver->name)
  7453. return driver->name;
  7454. return empty;
  7455. }
  7456. static void __netdev_printk(const char *level, const struct net_device *dev,
  7457. struct va_format *vaf)
  7458. {
  7459. if (dev && dev->dev.parent) {
  7460. dev_printk_emit(level[1] - '0',
  7461. dev->dev.parent,
  7462. "%s %s %s%s: %pV",
  7463. dev_driver_string(dev->dev.parent),
  7464. dev_name(dev->dev.parent),
  7465. netdev_name(dev), netdev_reg_state(dev),
  7466. vaf);
  7467. } else if (dev) {
  7468. printk("%s%s%s: %pV",
  7469. level, netdev_name(dev), netdev_reg_state(dev), vaf);
  7470. } else {
  7471. printk("%s(NULL net_device): %pV", level, vaf);
  7472. }
  7473. }
  7474. void netdev_printk(const char *level, const struct net_device *dev,
  7475. const char *format, ...)
  7476. {
  7477. struct va_format vaf;
  7478. va_list args;
  7479. va_start(args, format);
  7480. vaf.fmt = format;
  7481. vaf.va = &args;
  7482. __netdev_printk(level, dev, &vaf);
  7483. va_end(args);
  7484. }
  7485. EXPORT_SYMBOL(netdev_printk);
  7486. #define define_netdev_printk_level(func, level) \
  7487. void func(const struct net_device *dev, const char *fmt, ...) \
  7488. { \
  7489. struct va_format vaf; \
  7490. va_list args; \
  7491. \
  7492. va_start(args, fmt); \
  7493. \
  7494. vaf.fmt = fmt; \
  7495. vaf.va = &args; \
  7496. \
  7497. __netdev_printk(level, dev, &vaf); \
  7498. \
  7499. va_end(args); \
  7500. } \
  7501. EXPORT_SYMBOL(func);
  7502. define_netdev_printk_level(netdev_emerg, KERN_EMERG);
  7503. define_netdev_printk_level(netdev_alert, KERN_ALERT);
  7504. define_netdev_printk_level(netdev_crit, KERN_CRIT);
  7505. define_netdev_printk_level(netdev_err, KERN_ERR);
  7506. define_netdev_printk_level(netdev_warn, KERN_WARNING);
  7507. define_netdev_printk_level(netdev_notice, KERN_NOTICE);
  7508. define_netdev_printk_level(netdev_info, KERN_INFO);
  7509. static void __net_exit netdev_exit(struct net *net)
  7510. {
  7511. kfree(net->dev_name_head);
  7512. kfree(net->dev_index_head);
  7513. if (net != &init_net)
  7514. WARN_ON_ONCE(!list_empty(&net->dev_base_head));
  7515. }
  7516. static struct pernet_operations __net_initdata netdev_net_ops = {
  7517. .init = netdev_init,
  7518. .exit = netdev_exit,
  7519. };
  7520. static void __net_exit default_device_exit(struct net *net)
  7521. {
  7522. struct net_device *dev, *aux;
  7523. /*
  7524. * Push all migratable network devices back to the
  7525. * initial network namespace
  7526. */
  7527. rtnl_lock();
  7528. for_each_netdev_safe(net, dev, aux) {
  7529. int err;
  7530. char fb_name[IFNAMSIZ];
  7531. /* Ignore unmoveable devices (i.e. loopback) */
  7532. if (dev->features & NETIF_F_NETNS_LOCAL)
  7533. continue;
  7534. /* Leave virtual devices for the generic cleanup */
  7535. if (dev->rtnl_link_ops)
  7536. continue;
  7537. /* Push remaining network devices to init_net */
  7538. snprintf(fb_name, IFNAMSIZ, "dev%d", dev->ifindex);
  7539. err = dev_change_net_namespace(dev, &init_net, fb_name);
  7540. if (err) {
  7541. pr_emerg("%s: failed to move %s to init_net: %d\n",
  7542. __func__, dev->name, err);
  7543. BUG();
  7544. }
  7545. }
  7546. rtnl_unlock();
  7547. }
  7548. static void __net_exit rtnl_lock_unregistering(struct list_head *net_list)
  7549. {
  7550. /* Return with the rtnl_lock held when there are no network
  7551. * devices unregistering in any network namespace in net_list.
  7552. */
  7553. struct net *net;
  7554. bool unregistering;
  7555. DEFINE_WAIT_FUNC(wait, woken_wake_function);
  7556. add_wait_queue(&netdev_unregistering_wq, &wait);
  7557. for (;;) {
  7558. unregistering = false;
  7559. rtnl_lock();
  7560. list_for_each_entry(net, net_list, exit_list) {
  7561. if (net->dev_unreg_count > 0) {
  7562. unregistering = true;
  7563. break;
  7564. }
  7565. }
  7566. if (!unregistering)
  7567. break;
  7568. __rtnl_unlock();
  7569. wait_woken(&wait, TASK_UNINTERRUPTIBLE, MAX_SCHEDULE_TIMEOUT);
  7570. }
  7571. remove_wait_queue(&netdev_unregistering_wq, &wait);
  7572. }
  7573. static void __net_exit default_device_exit_batch(struct list_head *net_list)
  7574. {
  7575. /* At exit all network devices most be removed from a network
  7576. * namespace. Do this in the reverse order of registration.
  7577. * Do this across as many network namespaces as possible to
  7578. * improve batching efficiency.
  7579. */
  7580. struct net_device *dev;
  7581. struct net *net;
  7582. LIST_HEAD(dev_kill_list);
  7583. /* To prevent network device cleanup code from dereferencing
  7584. * loopback devices or network devices that have been freed
  7585. * wait here for all pending unregistrations to complete,
  7586. * before unregistring the loopback device and allowing the
  7587. * network namespace be freed.
  7588. *
  7589. * The netdev todo list containing all network devices
  7590. * unregistrations that happen in default_device_exit_batch
  7591. * will run in the rtnl_unlock() at the end of
  7592. * default_device_exit_batch.
  7593. */
  7594. rtnl_lock_unregistering(net_list);
  7595. list_for_each_entry(net, net_list, exit_list) {
  7596. for_each_netdev_reverse(net, dev) {
  7597. if (dev->rtnl_link_ops && dev->rtnl_link_ops->dellink)
  7598. dev->rtnl_link_ops->dellink(dev, &dev_kill_list);
  7599. else
  7600. unregister_netdevice_queue(dev, &dev_kill_list);
  7601. }
  7602. }
  7603. unregister_netdevice_many(&dev_kill_list);
  7604. rtnl_unlock();
  7605. }
  7606. static struct pernet_operations __net_initdata default_device_ops = {
  7607. .exit = default_device_exit,
  7608. .exit_batch = default_device_exit_batch,
  7609. };
  7610. /*
  7611. * Initialize the DEV module. At boot time this walks the device list and
  7612. * unhooks any devices that fail to initialise (normally hardware not
  7613. * present) and leaves us with a valid list of present and active devices.
  7614. *
  7615. */
  7616. /*
  7617. * This is called single threaded during boot, so no need
  7618. * to take the rtnl semaphore.
  7619. */
  7620. static int __init net_dev_init(void)
  7621. {
  7622. int i, rc = -ENOMEM;
  7623. BUG_ON(!dev_boot_phase);
  7624. if (dev_proc_init())
  7625. goto out;
  7626. if (netdev_kobject_init())
  7627. goto out;
  7628. INIT_LIST_HEAD(&ptype_all);
  7629. for (i = 0; i < PTYPE_HASH_SIZE; i++)
  7630. INIT_LIST_HEAD(&ptype_base[i]);
  7631. INIT_LIST_HEAD(&offload_base);
  7632. if (register_pernet_subsys(&netdev_net_ops))
  7633. goto out;
  7634. /*
  7635. * Initialise the packet receive queues.
  7636. */
  7637. for_each_possible_cpu(i) {
  7638. struct work_struct *flush = per_cpu_ptr(&flush_works, i);
  7639. struct softnet_data *sd = &per_cpu(softnet_data, i);
  7640. INIT_WORK(flush, flush_backlog);
  7641. skb_queue_head_init(&sd->input_pkt_queue);
  7642. skb_queue_head_init(&sd->process_queue);
  7643. #ifdef CONFIG_XFRM_OFFLOAD
  7644. skb_queue_head_init(&sd->xfrm_backlog);
  7645. #endif
  7646. INIT_LIST_HEAD(&sd->poll_list);
  7647. sd->output_queue_tailp = &sd->output_queue;
  7648. #ifdef CONFIG_RPS
  7649. sd->csd.func = rps_trigger_softirq;
  7650. sd->csd.info = sd;
  7651. sd->cpu = i;
  7652. #endif
  7653. sd->backlog.poll = process_backlog;
  7654. sd->backlog.weight = weight_p;
  7655. }
  7656. dev_boot_phase = 0;
  7657. /* The loopback device is special if any other network devices
  7658. * is present in a network namespace the loopback device must
  7659. * be present. Since we now dynamically allocate and free the
  7660. * loopback device ensure this invariant is maintained by
  7661. * keeping the loopback device as the first device on the
  7662. * list of network devices. Ensuring the loopback devices
  7663. * is the first device that appears and the last network device
  7664. * that disappears.
  7665. */
  7666. if (register_pernet_device(&loopback_net_ops))
  7667. goto out;
  7668. if (register_pernet_device(&default_device_ops))
  7669. goto out;
  7670. open_softirq(NET_TX_SOFTIRQ, net_tx_action);
  7671. open_softirq(NET_RX_SOFTIRQ, net_rx_action);
  7672. rc = cpuhp_setup_state_nocalls(CPUHP_NET_DEV_DEAD, "net/dev:dead",
  7673. NULL, dev_cpu_dead);
  7674. WARN_ON(rc < 0);
  7675. rc = 0;
  7676. out:
  7677. return rc;
  7678. }
  7679. subsys_initcall(net_dev_init);