dev.c 209 KB

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