dev.c 205 KB

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