dev.c 211 KB

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