dev.c 214 KB

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