cls_flower.c 99 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000300130023003300430053006300730083009301030113012301330143015301630173018301930203021302230233024302530263027302830293030303130323033303430353036303730383039304030413042304330443045304630473048304930503051305230533054305530563057305830593060306130623063306430653066306730683069307030713072307330743075307630773078307930803081308230833084308530863087308830893090309130923093309430953096309730983099310031013102310331043105310631073108310931103111311231133114311531163117311831193120312131223123312431253126312731283129313031313132313331343135313631373138313931403141314231433144314531463147314831493150315131523153315431553156315731583159316031613162316331643165316631673168316931703171317231733174317531763177317831793180318131823183318431853186318731883189319031913192319331943195319631973198319932003201320232033204320532063207320832093210321132123213321432153216321732183219322032213222322332243225322632273228322932303231323232333234323532363237323832393240324132423243324432453246324732483249325032513252325332543255325632573258325932603261326232633264326532663267326832693270327132723273327432753276327732783279328032813282328332843285328632873288328932903291329232933294329532963297329832993300330133023303330433053306330733083309331033113312331333143315331633173318331933203321332233233324332533263327332833293330333133323333333433353336333733383339334033413342334333443345334633473348334933503351335233533354335533563357335833593360336133623363336433653366336733683369337033713372337333743375337633773378337933803381338233833384338533863387338833893390339133923393339433953396339733983399340034013402340334043405340634073408340934103411341234133414341534163417341834193420342134223423342434253426342734283429343034313432343334343435343634373438343934403441344234433444344534463447344834493450345134523453345434553456345734583459346034613462346334643465346634673468346934703471347234733474
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*
  3. * net/sched/cls_flower.c Flower classifier
  4. *
  5. * Copyright (c) 2015 Jiri Pirko <[email protected]>
  6. */
  7. #include <linux/kernel.h>
  8. #include <linux/init.h>
  9. #include <linux/module.h>
  10. #include <linux/rhashtable.h>
  11. #include <linux/workqueue.h>
  12. #include <linux/refcount.h>
  13. #include <linux/if_ether.h>
  14. #include <linux/in6.h>
  15. #include <linux/ip.h>
  16. #include <linux/mpls.h>
  17. #include <linux/ppp_defs.h>
  18. #include <net/sch_generic.h>
  19. #include <net/pkt_cls.h>
  20. #include <net/pkt_sched.h>
  21. #include <net/ip.h>
  22. #include <net/flow_dissector.h>
  23. #include <net/geneve.h>
  24. #include <net/vxlan.h>
  25. #include <net/erspan.h>
  26. #include <net/gtp.h>
  27. #include <net/dst.h>
  28. #include <net/dst_metadata.h>
  29. #include <uapi/linux/netfilter/nf_conntrack_common.h>
  30. #define TCA_FLOWER_KEY_CT_FLAGS_MAX \
  31. ((__TCA_FLOWER_KEY_CT_FLAGS_MAX - 1) << 1)
  32. #define TCA_FLOWER_KEY_CT_FLAGS_MASK \
  33. (TCA_FLOWER_KEY_CT_FLAGS_MAX - 1)
  34. struct fl_flow_key {
  35. struct flow_dissector_key_meta meta;
  36. struct flow_dissector_key_control control;
  37. struct flow_dissector_key_control enc_control;
  38. struct flow_dissector_key_basic basic;
  39. struct flow_dissector_key_eth_addrs eth;
  40. struct flow_dissector_key_vlan vlan;
  41. struct flow_dissector_key_vlan cvlan;
  42. union {
  43. struct flow_dissector_key_ipv4_addrs ipv4;
  44. struct flow_dissector_key_ipv6_addrs ipv6;
  45. };
  46. struct flow_dissector_key_ports tp;
  47. struct flow_dissector_key_icmp icmp;
  48. struct flow_dissector_key_arp arp;
  49. struct flow_dissector_key_keyid enc_key_id;
  50. union {
  51. struct flow_dissector_key_ipv4_addrs enc_ipv4;
  52. struct flow_dissector_key_ipv6_addrs enc_ipv6;
  53. };
  54. struct flow_dissector_key_ports enc_tp;
  55. struct flow_dissector_key_mpls mpls;
  56. struct flow_dissector_key_tcp tcp;
  57. struct flow_dissector_key_ip ip;
  58. struct flow_dissector_key_ip enc_ip;
  59. struct flow_dissector_key_enc_opts enc_opts;
  60. struct flow_dissector_key_ports_range tp_range;
  61. struct flow_dissector_key_ct ct;
  62. struct flow_dissector_key_hash hash;
  63. struct flow_dissector_key_num_of_vlans num_of_vlans;
  64. struct flow_dissector_key_pppoe pppoe;
  65. struct flow_dissector_key_l2tpv3 l2tpv3;
  66. } __aligned(BITS_PER_LONG / 8); /* Ensure that we can do comparisons as longs. */
  67. struct fl_flow_mask_range {
  68. unsigned short int start;
  69. unsigned short int end;
  70. };
  71. struct fl_flow_mask {
  72. struct fl_flow_key key;
  73. struct fl_flow_mask_range range;
  74. u32 flags;
  75. struct rhash_head ht_node;
  76. struct rhashtable ht;
  77. struct rhashtable_params filter_ht_params;
  78. struct flow_dissector dissector;
  79. struct list_head filters;
  80. struct rcu_work rwork;
  81. struct list_head list;
  82. refcount_t refcnt;
  83. };
  84. struct fl_flow_tmplt {
  85. struct fl_flow_key dummy_key;
  86. struct fl_flow_key mask;
  87. struct flow_dissector dissector;
  88. struct tcf_chain *chain;
  89. };
  90. struct cls_fl_head {
  91. struct rhashtable ht;
  92. spinlock_t masks_lock; /* Protect masks list */
  93. struct list_head masks;
  94. struct list_head hw_filters;
  95. struct rcu_work rwork;
  96. struct idr handle_idr;
  97. };
  98. struct cls_fl_filter {
  99. struct fl_flow_mask *mask;
  100. struct rhash_head ht_node;
  101. struct fl_flow_key mkey;
  102. struct tcf_exts exts;
  103. struct tcf_result res;
  104. struct fl_flow_key key;
  105. struct list_head list;
  106. struct list_head hw_list;
  107. u32 handle;
  108. u32 flags;
  109. u32 in_hw_count;
  110. struct rcu_work rwork;
  111. struct net_device *hw_dev;
  112. /* Flower classifier is unlocked, which means that its reference counter
  113. * can be changed concurrently without any kind of external
  114. * synchronization. Use atomic reference counter to be concurrency-safe.
  115. */
  116. refcount_t refcnt;
  117. bool deleted;
  118. };
  119. static const struct rhashtable_params mask_ht_params = {
  120. .key_offset = offsetof(struct fl_flow_mask, key),
  121. .key_len = sizeof(struct fl_flow_key),
  122. .head_offset = offsetof(struct fl_flow_mask, ht_node),
  123. .automatic_shrinking = true,
  124. };
  125. static unsigned short int fl_mask_range(const struct fl_flow_mask *mask)
  126. {
  127. return mask->range.end - mask->range.start;
  128. }
  129. static void fl_mask_update_range(struct fl_flow_mask *mask)
  130. {
  131. const u8 *bytes = (const u8 *) &mask->key;
  132. size_t size = sizeof(mask->key);
  133. size_t i, first = 0, last;
  134. for (i = 0; i < size; i++) {
  135. if (bytes[i]) {
  136. first = i;
  137. break;
  138. }
  139. }
  140. last = first;
  141. for (i = size - 1; i != first; i--) {
  142. if (bytes[i]) {
  143. last = i;
  144. break;
  145. }
  146. }
  147. mask->range.start = rounddown(first, sizeof(long));
  148. mask->range.end = roundup(last + 1, sizeof(long));
  149. }
  150. static void *fl_key_get_start(struct fl_flow_key *key,
  151. const struct fl_flow_mask *mask)
  152. {
  153. return (u8 *) key + mask->range.start;
  154. }
  155. static void fl_set_masked_key(struct fl_flow_key *mkey, struct fl_flow_key *key,
  156. struct fl_flow_mask *mask)
  157. {
  158. const long *lkey = fl_key_get_start(key, mask);
  159. const long *lmask = fl_key_get_start(&mask->key, mask);
  160. long *lmkey = fl_key_get_start(mkey, mask);
  161. int i;
  162. for (i = 0; i < fl_mask_range(mask); i += sizeof(long))
  163. *lmkey++ = *lkey++ & *lmask++;
  164. }
  165. static bool fl_mask_fits_tmplt(struct fl_flow_tmplt *tmplt,
  166. struct fl_flow_mask *mask)
  167. {
  168. const long *lmask = fl_key_get_start(&mask->key, mask);
  169. const long *ltmplt;
  170. int i;
  171. if (!tmplt)
  172. return true;
  173. ltmplt = fl_key_get_start(&tmplt->mask, mask);
  174. for (i = 0; i < fl_mask_range(mask); i += sizeof(long)) {
  175. if (~*ltmplt++ & *lmask++)
  176. return false;
  177. }
  178. return true;
  179. }
  180. static void fl_clear_masked_range(struct fl_flow_key *key,
  181. struct fl_flow_mask *mask)
  182. {
  183. memset(fl_key_get_start(key, mask), 0, fl_mask_range(mask));
  184. }
  185. static bool fl_range_port_dst_cmp(struct cls_fl_filter *filter,
  186. struct fl_flow_key *key,
  187. struct fl_flow_key *mkey)
  188. {
  189. u16 min_mask, max_mask, min_val, max_val;
  190. min_mask = ntohs(filter->mask->key.tp_range.tp_min.dst);
  191. max_mask = ntohs(filter->mask->key.tp_range.tp_max.dst);
  192. min_val = ntohs(filter->key.tp_range.tp_min.dst);
  193. max_val = ntohs(filter->key.tp_range.tp_max.dst);
  194. if (min_mask && max_mask) {
  195. if (ntohs(key->tp_range.tp.dst) < min_val ||
  196. ntohs(key->tp_range.tp.dst) > max_val)
  197. return false;
  198. /* skb does not have min and max values */
  199. mkey->tp_range.tp_min.dst = filter->mkey.tp_range.tp_min.dst;
  200. mkey->tp_range.tp_max.dst = filter->mkey.tp_range.tp_max.dst;
  201. }
  202. return true;
  203. }
  204. static bool fl_range_port_src_cmp(struct cls_fl_filter *filter,
  205. struct fl_flow_key *key,
  206. struct fl_flow_key *mkey)
  207. {
  208. u16 min_mask, max_mask, min_val, max_val;
  209. min_mask = ntohs(filter->mask->key.tp_range.tp_min.src);
  210. max_mask = ntohs(filter->mask->key.tp_range.tp_max.src);
  211. min_val = ntohs(filter->key.tp_range.tp_min.src);
  212. max_val = ntohs(filter->key.tp_range.tp_max.src);
  213. if (min_mask && max_mask) {
  214. if (ntohs(key->tp_range.tp.src) < min_val ||
  215. ntohs(key->tp_range.tp.src) > max_val)
  216. return false;
  217. /* skb does not have min and max values */
  218. mkey->tp_range.tp_min.src = filter->mkey.tp_range.tp_min.src;
  219. mkey->tp_range.tp_max.src = filter->mkey.tp_range.tp_max.src;
  220. }
  221. return true;
  222. }
  223. static struct cls_fl_filter *__fl_lookup(struct fl_flow_mask *mask,
  224. struct fl_flow_key *mkey)
  225. {
  226. return rhashtable_lookup_fast(&mask->ht, fl_key_get_start(mkey, mask),
  227. mask->filter_ht_params);
  228. }
  229. static struct cls_fl_filter *fl_lookup_range(struct fl_flow_mask *mask,
  230. struct fl_flow_key *mkey,
  231. struct fl_flow_key *key)
  232. {
  233. struct cls_fl_filter *filter, *f;
  234. list_for_each_entry_rcu(filter, &mask->filters, list) {
  235. if (!fl_range_port_dst_cmp(filter, key, mkey))
  236. continue;
  237. if (!fl_range_port_src_cmp(filter, key, mkey))
  238. continue;
  239. f = __fl_lookup(mask, mkey);
  240. if (f)
  241. return f;
  242. }
  243. return NULL;
  244. }
  245. static noinline_for_stack
  246. struct cls_fl_filter *fl_mask_lookup(struct fl_flow_mask *mask, struct fl_flow_key *key)
  247. {
  248. struct fl_flow_key mkey;
  249. fl_set_masked_key(&mkey, key, mask);
  250. if ((mask->flags & TCA_FLOWER_MASK_FLAGS_RANGE))
  251. return fl_lookup_range(mask, &mkey, key);
  252. return __fl_lookup(mask, &mkey);
  253. }
  254. static u16 fl_ct_info_to_flower_map[] = {
  255. [IP_CT_ESTABLISHED] = TCA_FLOWER_KEY_CT_FLAGS_TRACKED |
  256. TCA_FLOWER_KEY_CT_FLAGS_ESTABLISHED,
  257. [IP_CT_RELATED] = TCA_FLOWER_KEY_CT_FLAGS_TRACKED |
  258. TCA_FLOWER_KEY_CT_FLAGS_RELATED,
  259. [IP_CT_ESTABLISHED_REPLY] = TCA_FLOWER_KEY_CT_FLAGS_TRACKED |
  260. TCA_FLOWER_KEY_CT_FLAGS_ESTABLISHED |
  261. TCA_FLOWER_KEY_CT_FLAGS_REPLY,
  262. [IP_CT_RELATED_REPLY] = TCA_FLOWER_KEY_CT_FLAGS_TRACKED |
  263. TCA_FLOWER_KEY_CT_FLAGS_RELATED |
  264. TCA_FLOWER_KEY_CT_FLAGS_REPLY,
  265. [IP_CT_NEW] = TCA_FLOWER_KEY_CT_FLAGS_TRACKED |
  266. TCA_FLOWER_KEY_CT_FLAGS_NEW,
  267. };
  268. static int fl_classify(struct sk_buff *skb, const struct tcf_proto *tp,
  269. struct tcf_result *res)
  270. {
  271. struct cls_fl_head *head = rcu_dereference_bh(tp->root);
  272. bool post_ct = tc_skb_cb(skb)->post_ct;
  273. u16 zone = tc_skb_cb(skb)->zone;
  274. struct fl_flow_key skb_key;
  275. struct fl_flow_mask *mask;
  276. struct cls_fl_filter *f;
  277. list_for_each_entry_rcu(mask, &head->masks, list) {
  278. flow_dissector_init_keys(&skb_key.control, &skb_key.basic);
  279. fl_clear_masked_range(&skb_key, mask);
  280. skb_flow_dissect_meta(skb, &mask->dissector, &skb_key);
  281. /* skb_flow_dissect() does not set n_proto in case an unknown
  282. * protocol, so do it rather here.
  283. */
  284. skb_key.basic.n_proto = skb_protocol(skb, false);
  285. skb_flow_dissect_tunnel_info(skb, &mask->dissector, &skb_key);
  286. skb_flow_dissect_ct(skb, &mask->dissector, &skb_key,
  287. fl_ct_info_to_flower_map,
  288. ARRAY_SIZE(fl_ct_info_to_flower_map),
  289. post_ct, zone);
  290. skb_flow_dissect_hash(skb, &mask->dissector, &skb_key);
  291. skb_flow_dissect(skb, &mask->dissector, &skb_key,
  292. FLOW_DISSECTOR_F_STOP_BEFORE_ENCAP);
  293. f = fl_mask_lookup(mask, &skb_key);
  294. if (f && !tc_skip_sw(f->flags)) {
  295. *res = f->res;
  296. return tcf_exts_exec(skb, &f->exts, res);
  297. }
  298. }
  299. return -1;
  300. }
  301. static int fl_init(struct tcf_proto *tp)
  302. {
  303. struct cls_fl_head *head;
  304. head = kzalloc(sizeof(*head), GFP_KERNEL);
  305. if (!head)
  306. return -ENOBUFS;
  307. spin_lock_init(&head->masks_lock);
  308. INIT_LIST_HEAD_RCU(&head->masks);
  309. INIT_LIST_HEAD(&head->hw_filters);
  310. rcu_assign_pointer(tp->root, head);
  311. idr_init(&head->handle_idr);
  312. return rhashtable_init(&head->ht, &mask_ht_params);
  313. }
  314. static void fl_mask_free(struct fl_flow_mask *mask, bool mask_init_done)
  315. {
  316. /* temporary masks don't have their filters list and ht initialized */
  317. if (mask_init_done) {
  318. WARN_ON(!list_empty(&mask->filters));
  319. rhashtable_destroy(&mask->ht);
  320. }
  321. kfree(mask);
  322. }
  323. static void fl_mask_free_work(struct work_struct *work)
  324. {
  325. struct fl_flow_mask *mask = container_of(to_rcu_work(work),
  326. struct fl_flow_mask, rwork);
  327. fl_mask_free(mask, true);
  328. }
  329. static void fl_uninit_mask_free_work(struct work_struct *work)
  330. {
  331. struct fl_flow_mask *mask = container_of(to_rcu_work(work),
  332. struct fl_flow_mask, rwork);
  333. fl_mask_free(mask, false);
  334. }
  335. static bool fl_mask_put(struct cls_fl_head *head, struct fl_flow_mask *mask)
  336. {
  337. if (!refcount_dec_and_test(&mask->refcnt))
  338. return false;
  339. rhashtable_remove_fast(&head->ht, &mask->ht_node, mask_ht_params);
  340. spin_lock(&head->masks_lock);
  341. list_del_rcu(&mask->list);
  342. spin_unlock(&head->masks_lock);
  343. tcf_queue_work(&mask->rwork, fl_mask_free_work);
  344. return true;
  345. }
  346. static struct cls_fl_head *fl_head_dereference(struct tcf_proto *tp)
  347. {
  348. /* Flower classifier only changes root pointer during init and destroy.
  349. * Users must obtain reference to tcf_proto instance before calling its
  350. * API, so tp->root pointer is protected from concurrent call to
  351. * fl_destroy() by reference counting.
  352. */
  353. return rcu_dereference_raw(tp->root);
  354. }
  355. static void __fl_destroy_filter(struct cls_fl_filter *f)
  356. {
  357. tcf_exts_destroy(&f->exts);
  358. tcf_exts_put_net(&f->exts);
  359. kfree(f);
  360. }
  361. static void fl_destroy_filter_work(struct work_struct *work)
  362. {
  363. struct cls_fl_filter *f = container_of(to_rcu_work(work),
  364. struct cls_fl_filter, rwork);
  365. __fl_destroy_filter(f);
  366. }
  367. static void fl_hw_destroy_filter(struct tcf_proto *tp, struct cls_fl_filter *f,
  368. bool rtnl_held, struct netlink_ext_ack *extack)
  369. {
  370. struct tcf_block *block = tp->chain->block;
  371. struct flow_cls_offload cls_flower = {};
  372. tc_cls_common_offload_init(&cls_flower.common, tp, f->flags, extack);
  373. cls_flower.command = FLOW_CLS_DESTROY;
  374. cls_flower.cookie = (unsigned long) f;
  375. tc_setup_cb_destroy(block, tp, TC_SETUP_CLSFLOWER, &cls_flower, false,
  376. &f->flags, &f->in_hw_count, rtnl_held);
  377. }
  378. static int fl_hw_replace_filter(struct tcf_proto *tp,
  379. struct cls_fl_filter *f, bool rtnl_held,
  380. struct netlink_ext_ack *extack)
  381. {
  382. struct tcf_block *block = tp->chain->block;
  383. struct flow_cls_offload cls_flower = {};
  384. bool skip_sw = tc_skip_sw(f->flags);
  385. int err = 0;
  386. cls_flower.rule = flow_rule_alloc(tcf_exts_num_actions(&f->exts));
  387. if (!cls_flower.rule)
  388. return -ENOMEM;
  389. tc_cls_common_offload_init(&cls_flower.common, tp, f->flags, extack);
  390. cls_flower.command = FLOW_CLS_REPLACE;
  391. cls_flower.cookie = (unsigned long) f;
  392. cls_flower.rule->match.dissector = &f->mask->dissector;
  393. cls_flower.rule->match.mask = &f->mask->key;
  394. cls_flower.rule->match.key = &f->mkey;
  395. cls_flower.classid = f->res.classid;
  396. err = tc_setup_offload_action(&cls_flower.rule->action, &f->exts,
  397. cls_flower.common.extack);
  398. if (err) {
  399. kfree(cls_flower.rule);
  400. return skip_sw ? err : 0;
  401. }
  402. err = tc_setup_cb_add(block, tp, TC_SETUP_CLSFLOWER, &cls_flower,
  403. skip_sw, &f->flags, &f->in_hw_count, rtnl_held);
  404. tc_cleanup_offload_action(&cls_flower.rule->action);
  405. kfree(cls_flower.rule);
  406. if (err) {
  407. fl_hw_destroy_filter(tp, f, rtnl_held, NULL);
  408. return err;
  409. }
  410. if (skip_sw && !(f->flags & TCA_CLS_FLAGS_IN_HW))
  411. return -EINVAL;
  412. return 0;
  413. }
  414. static void fl_hw_update_stats(struct tcf_proto *tp, struct cls_fl_filter *f,
  415. bool rtnl_held)
  416. {
  417. struct tcf_block *block = tp->chain->block;
  418. struct flow_cls_offload cls_flower = {};
  419. tc_cls_common_offload_init(&cls_flower.common, tp, f->flags, NULL);
  420. cls_flower.command = FLOW_CLS_STATS;
  421. cls_flower.cookie = (unsigned long) f;
  422. cls_flower.classid = f->res.classid;
  423. tc_setup_cb_call(block, TC_SETUP_CLSFLOWER, &cls_flower, false,
  424. rtnl_held);
  425. tcf_exts_hw_stats_update(&f->exts, cls_flower.stats.bytes,
  426. cls_flower.stats.pkts,
  427. cls_flower.stats.drops,
  428. cls_flower.stats.lastused,
  429. cls_flower.stats.used_hw_stats,
  430. cls_flower.stats.used_hw_stats_valid);
  431. }
  432. static void __fl_put(struct cls_fl_filter *f)
  433. {
  434. if (!refcount_dec_and_test(&f->refcnt))
  435. return;
  436. if (tcf_exts_get_net(&f->exts))
  437. tcf_queue_work(&f->rwork, fl_destroy_filter_work);
  438. else
  439. __fl_destroy_filter(f);
  440. }
  441. static struct cls_fl_filter *__fl_get(struct cls_fl_head *head, u32 handle)
  442. {
  443. struct cls_fl_filter *f;
  444. rcu_read_lock();
  445. f = idr_find(&head->handle_idr, handle);
  446. if (f && !refcount_inc_not_zero(&f->refcnt))
  447. f = NULL;
  448. rcu_read_unlock();
  449. return f;
  450. }
  451. static int __fl_delete(struct tcf_proto *tp, struct cls_fl_filter *f,
  452. bool *last, bool rtnl_held,
  453. struct netlink_ext_ack *extack)
  454. {
  455. struct cls_fl_head *head = fl_head_dereference(tp);
  456. *last = false;
  457. spin_lock(&tp->lock);
  458. if (f->deleted) {
  459. spin_unlock(&tp->lock);
  460. return -ENOENT;
  461. }
  462. f->deleted = true;
  463. rhashtable_remove_fast(&f->mask->ht, &f->ht_node,
  464. f->mask->filter_ht_params);
  465. idr_remove(&head->handle_idr, f->handle);
  466. list_del_rcu(&f->list);
  467. spin_unlock(&tp->lock);
  468. *last = fl_mask_put(head, f->mask);
  469. if (!tc_skip_hw(f->flags))
  470. fl_hw_destroy_filter(tp, f, rtnl_held, extack);
  471. tcf_unbind_filter(tp, &f->res);
  472. __fl_put(f);
  473. return 0;
  474. }
  475. static void fl_destroy_sleepable(struct work_struct *work)
  476. {
  477. struct cls_fl_head *head = container_of(to_rcu_work(work),
  478. struct cls_fl_head,
  479. rwork);
  480. rhashtable_destroy(&head->ht);
  481. kfree(head);
  482. module_put(THIS_MODULE);
  483. }
  484. static void fl_destroy(struct tcf_proto *tp, bool rtnl_held,
  485. struct netlink_ext_ack *extack)
  486. {
  487. struct cls_fl_head *head = fl_head_dereference(tp);
  488. struct fl_flow_mask *mask, *next_mask;
  489. struct cls_fl_filter *f, *next;
  490. bool last;
  491. list_for_each_entry_safe(mask, next_mask, &head->masks, list) {
  492. list_for_each_entry_safe(f, next, &mask->filters, list) {
  493. __fl_delete(tp, f, &last, rtnl_held, extack);
  494. if (last)
  495. break;
  496. }
  497. }
  498. idr_destroy(&head->handle_idr);
  499. __module_get(THIS_MODULE);
  500. tcf_queue_work(&head->rwork, fl_destroy_sleepable);
  501. }
  502. static void fl_put(struct tcf_proto *tp, void *arg)
  503. {
  504. struct cls_fl_filter *f = arg;
  505. __fl_put(f);
  506. }
  507. static void *fl_get(struct tcf_proto *tp, u32 handle)
  508. {
  509. struct cls_fl_head *head = fl_head_dereference(tp);
  510. return __fl_get(head, handle);
  511. }
  512. static const struct nla_policy fl_policy[TCA_FLOWER_MAX + 1] = {
  513. [TCA_FLOWER_UNSPEC] = { .type = NLA_UNSPEC },
  514. [TCA_FLOWER_CLASSID] = { .type = NLA_U32 },
  515. [TCA_FLOWER_INDEV] = { .type = NLA_STRING,
  516. .len = IFNAMSIZ },
  517. [TCA_FLOWER_KEY_ETH_DST] = { .len = ETH_ALEN },
  518. [TCA_FLOWER_KEY_ETH_DST_MASK] = { .len = ETH_ALEN },
  519. [TCA_FLOWER_KEY_ETH_SRC] = { .len = ETH_ALEN },
  520. [TCA_FLOWER_KEY_ETH_SRC_MASK] = { .len = ETH_ALEN },
  521. [TCA_FLOWER_KEY_ETH_TYPE] = { .type = NLA_U16 },
  522. [TCA_FLOWER_KEY_IP_PROTO] = { .type = NLA_U8 },
  523. [TCA_FLOWER_KEY_IPV4_SRC] = { .type = NLA_U32 },
  524. [TCA_FLOWER_KEY_IPV4_SRC_MASK] = { .type = NLA_U32 },
  525. [TCA_FLOWER_KEY_IPV4_DST] = { .type = NLA_U32 },
  526. [TCA_FLOWER_KEY_IPV4_DST_MASK] = { .type = NLA_U32 },
  527. [TCA_FLOWER_KEY_IPV6_SRC] = { .len = sizeof(struct in6_addr) },
  528. [TCA_FLOWER_KEY_IPV6_SRC_MASK] = { .len = sizeof(struct in6_addr) },
  529. [TCA_FLOWER_KEY_IPV6_DST] = { .len = sizeof(struct in6_addr) },
  530. [TCA_FLOWER_KEY_IPV6_DST_MASK] = { .len = sizeof(struct in6_addr) },
  531. [TCA_FLOWER_KEY_TCP_SRC] = { .type = NLA_U16 },
  532. [TCA_FLOWER_KEY_TCP_DST] = { .type = NLA_U16 },
  533. [TCA_FLOWER_KEY_UDP_SRC] = { .type = NLA_U16 },
  534. [TCA_FLOWER_KEY_UDP_DST] = { .type = NLA_U16 },
  535. [TCA_FLOWER_KEY_VLAN_ID] = { .type = NLA_U16 },
  536. [TCA_FLOWER_KEY_VLAN_PRIO] = { .type = NLA_U8 },
  537. [TCA_FLOWER_KEY_VLAN_ETH_TYPE] = { .type = NLA_U16 },
  538. [TCA_FLOWER_KEY_ENC_KEY_ID] = { .type = NLA_U32 },
  539. [TCA_FLOWER_KEY_ENC_IPV4_SRC] = { .type = NLA_U32 },
  540. [TCA_FLOWER_KEY_ENC_IPV4_SRC_MASK] = { .type = NLA_U32 },
  541. [TCA_FLOWER_KEY_ENC_IPV4_DST] = { .type = NLA_U32 },
  542. [TCA_FLOWER_KEY_ENC_IPV4_DST_MASK] = { .type = NLA_U32 },
  543. [TCA_FLOWER_KEY_ENC_IPV6_SRC] = { .len = sizeof(struct in6_addr) },
  544. [TCA_FLOWER_KEY_ENC_IPV6_SRC_MASK] = { .len = sizeof(struct in6_addr) },
  545. [TCA_FLOWER_KEY_ENC_IPV6_DST] = { .len = sizeof(struct in6_addr) },
  546. [TCA_FLOWER_KEY_ENC_IPV6_DST_MASK] = { .len = sizeof(struct in6_addr) },
  547. [TCA_FLOWER_KEY_TCP_SRC_MASK] = { .type = NLA_U16 },
  548. [TCA_FLOWER_KEY_TCP_DST_MASK] = { .type = NLA_U16 },
  549. [TCA_FLOWER_KEY_UDP_SRC_MASK] = { .type = NLA_U16 },
  550. [TCA_FLOWER_KEY_UDP_DST_MASK] = { .type = NLA_U16 },
  551. [TCA_FLOWER_KEY_SCTP_SRC_MASK] = { .type = NLA_U16 },
  552. [TCA_FLOWER_KEY_SCTP_DST_MASK] = { .type = NLA_U16 },
  553. [TCA_FLOWER_KEY_SCTP_SRC] = { .type = NLA_U16 },
  554. [TCA_FLOWER_KEY_SCTP_DST] = { .type = NLA_U16 },
  555. [TCA_FLOWER_KEY_ENC_UDP_SRC_PORT] = { .type = NLA_U16 },
  556. [TCA_FLOWER_KEY_ENC_UDP_SRC_PORT_MASK] = { .type = NLA_U16 },
  557. [TCA_FLOWER_KEY_ENC_UDP_DST_PORT] = { .type = NLA_U16 },
  558. [TCA_FLOWER_KEY_ENC_UDP_DST_PORT_MASK] = { .type = NLA_U16 },
  559. [TCA_FLOWER_KEY_FLAGS] = { .type = NLA_U32 },
  560. [TCA_FLOWER_KEY_FLAGS_MASK] = { .type = NLA_U32 },
  561. [TCA_FLOWER_KEY_ICMPV4_TYPE] = { .type = NLA_U8 },
  562. [TCA_FLOWER_KEY_ICMPV4_TYPE_MASK] = { .type = NLA_U8 },
  563. [TCA_FLOWER_KEY_ICMPV4_CODE] = { .type = NLA_U8 },
  564. [TCA_FLOWER_KEY_ICMPV4_CODE_MASK] = { .type = NLA_U8 },
  565. [TCA_FLOWER_KEY_ICMPV6_TYPE] = { .type = NLA_U8 },
  566. [TCA_FLOWER_KEY_ICMPV6_TYPE_MASK] = { .type = NLA_U8 },
  567. [TCA_FLOWER_KEY_ICMPV6_CODE] = { .type = NLA_U8 },
  568. [TCA_FLOWER_KEY_ICMPV6_CODE_MASK] = { .type = NLA_U8 },
  569. [TCA_FLOWER_KEY_ARP_SIP] = { .type = NLA_U32 },
  570. [TCA_FLOWER_KEY_ARP_SIP_MASK] = { .type = NLA_U32 },
  571. [TCA_FLOWER_KEY_ARP_TIP] = { .type = NLA_U32 },
  572. [TCA_FLOWER_KEY_ARP_TIP_MASK] = { .type = NLA_U32 },
  573. [TCA_FLOWER_KEY_ARP_OP] = { .type = NLA_U8 },
  574. [TCA_FLOWER_KEY_ARP_OP_MASK] = { .type = NLA_U8 },
  575. [TCA_FLOWER_KEY_ARP_SHA] = { .len = ETH_ALEN },
  576. [TCA_FLOWER_KEY_ARP_SHA_MASK] = { .len = ETH_ALEN },
  577. [TCA_FLOWER_KEY_ARP_THA] = { .len = ETH_ALEN },
  578. [TCA_FLOWER_KEY_ARP_THA_MASK] = { .len = ETH_ALEN },
  579. [TCA_FLOWER_KEY_MPLS_TTL] = { .type = NLA_U8 },
  580. [TCA_FLOWER_KEY_MPLS_BOS] = { .type = NLA_U8 },
  581. [TCA_FLOWER_KEY_MPLS_TC] = { .type = NLA_U8 },
  582. [TCA_FLOWER_KEY_MPLS_LABEL] = { .type = NLA_U32 },
  583. [TCA_FLOWER_KEY_MPLS_OPTS] = { .type = NLA_NESTED },
  584. [TCA_FLOWER_KEY_TCP_FLAGS] = { .type = NLA_U16 },
  585. [TCA_FLOWER_KEY_TCP_FLAGS_MASK] = { .type = NLA_U16 },
  586. [TCA_FLOWER_KEY_IP_TOS] = { .type = NLA_U8 },
  587. [TCA_FLOWER_KEY_IP_TOS_MASK] = { .type = NLA_U8 },
  588. [TCA_FLOWER_KEY_IP_TTL] = { .type = NLA_U8 },
  589. [TCA_FLOWER_KEY_IP_TTL_MASK] = { .type = NLA_U8 },
  590. [TCA_FLOWER_KEY_CVLAN_ID] = { .type = NLA_U16 },
  591. [TCA_FLOWER_KEY_CVLAN_PRIO] = { .type = NLA_U8 },
  592. [TCA_FLOWER_KEY_CVLAN_ETH_TYPE] = { .type = NLA_U16 },
  593. [TCA_FLOWER_KEY_ENC_IP_TOS] = { .type = NLA_U8 },
  594. [TCA_FLOWER_KEY_ENC_IP_TOS_MASK] = { .type = NLA_U8 },
  595. [TCA_FLOWER_KEY_ENC_IP_TTL] = { .type = NLA_U8 },
  596. [TCA_FLOWER_KEY_ENC_IP_TTL_MASK] = { .type = NLA_U8 },
  597. [TCA_FLOWER_KEY_ENC_OPTS] = { .type = NLA_NESTED },
  598. [TCA_FLOWER_KEY_ENC_OPTS_MASK] = { .type = NLA_NESTED },
  599. [TCA_FLOWER_KEY_CT_STATE] =
  600. NLA_POLICY_MASK(NLA_U16, TCA_FLOWER_KEY_CT_FLAGS_MASK),
  601. [TCA_FLOWER_KEY_CT_STATE_MASK] =
  602. NLA_POLICY_MASK(NLA_U16, TCA_FLOWER_KEY_CT_FLAGS_MASK),
  603. [TCA_FLOWER_KEY_CT_ZONE] = { .type = NLA_U16 },
  604. [TCA_FLOWER_KEY_CT_ZONE_MASK] = { .type = NLA_U16 },
  605. [TCA_FLOWER_KEY_CT_MARK] = { .type = NLA_U32 },
  606. [TCA_FLOWER_KEY_CT_MARK_MASK] = { .type = NLA_U32 },
  607. [TCA_FLOWER_KEY_CT_LABELS] = { .type = NLA_BINARY,
  608. .len = 128 / BITS_PER_BYTE },
  609. [TCA_FLOWER_KEY_CT_LABELS_MASK] = { .type = NLA_BINARY,
  610. .len = 128 / BITS_PER_BYTE },
  611. [TCA_FLOWER_FLAGS] = { .type = NLA_U32 },
  612. [TCA_FLOWER_KEY_HASH] = { .type = NLA_U32 },
  613. [TCA_FLOWER_KEY_HASH_MASK] = { .type = NLA_U32 },
  614. [TCA_FLOWER_KEY_NUM_OF_VLANS] = { .type = NLA_U8 },
  615. [TCA_FLOWER_KEY_PPPOE_SID] = { .type = NLA_U16 },
  616. [TCA_FLOWER_KEY_PPP_PROTO] = { .type = NLA_U16 },
  617. [TCA_FLOWER_KEY_L2TPV3_SID] = { .type = NLA_U32 },
  618. };
  619. static const struct nla_policy
  620. enc_opts_policy[TCA_FLOWER_KEY_ENC_OPTS_MAX + 1] = {
  621. [TCA_FLOWER_KEY_ENC_OPTS_UNSPEC] = {
  622. .strict_start_type = TCA_FLOWER_KEY_ENC_OPTS_VXLAN },
  623. [TCA_FLOWER_KEY_ENC_OPTS_GENEVE] = { .type = NLA_NESTED },
  624. [TCA_FLOWER_KEY_ENC_OPTS_VXLAN] = { .type = NLA_NESTED },
  625. [TCA_FLOWER_KEY_ENC_OPTS_ERSPAN] = { .type = NLA_NESTED },
  626. [TCA_FLOWER_KEY_ENC_OPTS_GTP] = { .type = NLA_NESTED },
  627. };
  628. static const struct nla_policy
  629. geneve_opt_policy[TCA_FLOWER_KEY_ENC_OPT_GENEVE_MAX + 1] = {
  630. [TCA_FLOWER_KEY_ENC_OPT_GENEVE_CLASS] = { .type = NLA_U16 },
  631. [TCA_FLOWER_KEY_ENC_OPT_GENEVE_TYPE] = { .type = NLA_U8 },
  632. [TCA_FLOWER_KEY_ENC_OPT_GENEVE_DATA] = { .type = NLA_BINARY,
  633. .len = 128 },
  634. };
  635. static const struct nla_policy
  636. vxlan_opt_policy[TCA_FLOWER_KEY_ENC_OPT_VXLAN_MAX + 1] = {
  637. [TCA_FLOWER_KEY_ENC_OPT_VXLAN_GBP] = { .type = NLA_U32 },
  638. };
  639. static const struct nla_policy
  640. erspan_opt_policy[TCA_FLOWER_KEY_ENC_OPT_ERSPAN_MAX + 1] = {
  641. [TCA_FLOWER_KEY_ENC_OPT_ERSPAN_VER] = { .type = NLA_U8 },
  642. [TCA_FLOWER_KEY_ENC_OPT_ERSPAN_INDEX] = { .type = NLA_U32 },
  643. [TCA_FLOWER_KEY_ENC_OPT_ERSPAN_DIR] = { .type = NLA_U8 },
  644. [TCA_FLOWER_KEY_ENC_OPT_ERSPAN_HWID] = { .type = NLA_U8 },
  645. };
  646. static const struct nla_policy
  647. gtp_opt_policy[TCA_FLOWER_KEY_ENC_OPT_GTP_MAX + 1] = {
  648. [TCA_FLOWER_KEY_ENC_OPT_GTP_PDU_TYPE] = { .type = NLA_U8 },
  649. [TCA_FLOWER_KEY_ENC_OPT_GTP_QFI] = { .type = NLA_U8 },
  650. };
  651. static const struct nla_policy
  652. mpls_stack_entry_policy[TCA_FLOWER_KEY_MPLS_OPT_LSE_MAX + 1] = {
  653. [TCA_FLOWER_KEY_MPLS_OPT_LSE_DEPTH] = { .type = NLA_U8 },
  654. [TCA_FLOWER_KEY_MPLS_OPT_LSE_TTL] = { .type = NLA_U8 },
  655. [TCA_FLOWER_KEY_MPLS_OPT_LSE_BOS] = { .type = NLA_U8 },
  656. [TCA_FLOWER_KEY_MPLS_OPT_LSE_TC] = { .type = NLA_U8 },
  657. [TCA_FLOWER_KEY_MPLS_OPT_LSE_LABEL] = { .type = NLA_U32 },
  658. };
  659. static void fl_set_key_val(struct nlattr **tb,
  660. void *val, int val_type,
  661. void *mask, int mask_type, int len)
  662. {
  663. if (!tb[val_type])
  664. return;
  665. nla_memcpy(val, tb[val_type], len);
  666. if (mask_type == TCA_FLOWER_UNSPEC || !tb[mask_type])
  667. memset(mask, 0xff, len);
  668. else
  669. nla_memcpy(mask, tb[mask_type], len);
  670. }
  671. static int fl_set_key_port_range(struct nlattr **tb, struct fl_flow_key *key,
  672. struct fl_flow_key *mask,
  673. struct netlink_ext_ack *extack)
  674. {
  675. fl_set_key_val(tb, &key->tp_range.tp_min.dst,
  676. TCA_FLOWER_KEY_PORT_DST_MIN, &mask->tp_range.tp_min.dst,
  677. TCA_FLOWER_UNSPEC, sizeof(key->tp_range.tp_min.dst));
  678. fl_set_key_val(tb, &key->tp_range.tp_max.dst,
  679. TCA_FLOWER_KEY_PORT_DST_MAX, &mask->tp_range.tp_max.dst,
  680. TCA_FLOWER_UNSPEC, sizeof(key->tp_range.tp_max.dst));
  681. fl_set_key_val(tb, &key->tp_range.tp_min.src,
  682. TCA_FLOWER_KEY_PORT_SRC_MIN, &mask->tp_range.tp_min.src,
  683. TCA_FLOWER_UNSPEC, sizeof(key->tp_range.tp_min.src));
  684. fl_set_key_val(tb, &key->tp_range.tp_max.src,
  685. TCA_FLOWER_KEY_PORT_SRC_MAX, &mask->tp_range.tp_max.src,
  686. TCA_FLOWER_UNSPEC, sizeof(key->tp_range.tp_max.src));
  687. if (mask->tp_range.tp_min.dst != mask->tp_range.tp_max.dst) {
  688. NL_SET_ERR_MSG(extack,
  689. "Both min and max destination ports must be specified");
  690. return -EINVAL;
  691. }
  692. if (mask->tp_range.tp_min.src != mask->tp_range.tp_max.src) {
  693. NL_SET_ERR_MSG(extack,
  694. "Both min and max source ports must be specified");
  695. return -EINVAL;
  696. }
  697. if (mask->tp_range.tp_min.dst && mask->tp_range.tp_max.dst &&
  698. ntohs(key->tp_range.tp_max.dst) <=
  699. ntohs(key->tp_range.tp_min.dst)) {
  700. NL_SET_ERR_MSG_ATTR(extack,
  701. tb[TCA_FLOWER_KEY_PORT_DST_MIN],
  702. "Invalid destination port range (min must be strictly smaller than max)");
  703. return -EINVAL;
  704. }
  705. if (mask->tp_range.tp_min.src && mask->tp_range.tp_max.src &&
  706. ntohs(key->tp_range.tp_max.src) <=
  707. ntohs(key->tp_range.tp_min.src)) {
  708. NL_SET_ERR_MSG_ATTR(extack,
  709. tb[TCA_FLOWER_KEY_PORT_SRC_MIN],
  710. "Invalid source port range (min must be strictly smaller than max)");
  711. return -EINVAL;
  712. }
  713. return 0;
  714. }
  715. static int fl_set_key_mpls_lse(const struct nlattr *nla_lse,
  716. struct flow_dissector_key_mpls *key_val,
  717. struct flow_dissector_key_mpls *key_mask,
  718. struct netlink_ext_ack *extack)
  719. {
  720. struct nlattr *tb[TCA_FLOWER_KEY_MPLS_OPT_LSE_MAX + 1];
  721. struct flow_dissector_mpls_lse *lse_mask;
  722. struct flow_dissector_mpls_lse *lse_val;
  723. u8 lse_index;
  724. u8 depth;
  725. int err;
  726. err = nla_parse_nested(tb, TCA_FLOWER_KEY_MPLS_OPT_LSE_MAX, nla_lse,
  727. mpls_stack_entry_policy, extack);
  728. if (err < 0)
  729. return err;
  730. if (!tb[TCA_FLOWER_KEY_MPLS_OPT_LSE_DEPTH]) {
  731. NL_SET_ERR_MSG(extack, "Missing MPLS option \"depth\"");
  732. return -EINVAL;
  733. }
  734. depth = nla_get_u8(tb[TCA_FLOWER_KEY_MPLS_OPT_LSE_DEPTH]);
  735. /* LSE depth starts at 1, for consistency with terminology used by
  736. * RFC 3031 (section 3.9), where depth 0 refers to unlabeled packets.
  737. */
  738. if (depth < 1 || depth > FLOW_DIS_MPLS_MAX) {
  739. NL_SET_ERR_MSG_ATTR(extack,
  740. tb[TCA_FLOWER_KEY_MPLS_OPT_LSE_DEPTH],
  741. "Invalid MPLS depth");
  742. return -EINVAL;
  743. }
  744. lse_index = depth - 1;
  745. dissector_set_mpls_lse(key_val, lse_index);
  746. dissector_set_mpls_lse(key_mask, lse_index);
  747. lse_val = &key_val->ls[lse_index];
  748. lse_mask = &key_mask->ls[lse_index];
  749. if (tb[TCA_FLOWER_KEY_MPLS_OPT_LSE_TTL]) {
  750. lse_val->mpls_ttl = nla_get_u8(tb[TCA_FLOWER_KEY_MPLS_OPT_LSE_TTL]);
  751. lse_mask->mpls_ttl = MPLS_TTL_MASK;
  752. }
  753. if (tb[TCA_FLOWER_KEY_MPLS_OPT_LSE_BOS]) {
  754. u8 bos = nla_get_u8(tb[TCA_FLOWER_KEY_MPLS_OPT_LSE_BOS]);
  755. if (bos & ~MPLS_BOS_MASK) {
  756. NL_SET_ERR_MSG_ATTR(extack,
  757. tb[TCA_FLOWER_KEY_MPLS_OPT_LSE_BOS],
  758. "Bottom Of Stack (BOS) must be 0 or 1");
  759. return -EINVAL;
  760. }
  761. lse_val->mpls_bos = bos;
  762. lse_mask->mpls_bos = MPLS_BOS_MASK;
  763. }
  764. if (tb[TCA_FLOWER_KEY_MPLS_OPT_LSE_TC]) {
  765. u8 tc = nla_get_u8(tb[TCA_FLOWER_KEY_MPLS_OPT_LSE_TC]);
  766. if (tc & ~MPLS_TC_MASK) {
  767. NL_SET_ERR_MSG_ATTR(extack,
  768. tb[TCA_FLOWER_KEY_MPLS_OPT_LSE_TC],
  769. "Traffic Class (TC) must be between 0 and 7");
  770. return -EINVAL;
  771. }
  772. lse_val->mpls_tc = tc;
  773. lse_mask->mpls_tc = MPLS_TC_MASK;
  774. }
  775. if (tb[TCA_FLOWER_KEY_MPLS_OPT_LSE_LABEL]) {
  776. u32 label = nla_get_u32(tb[TCA_FLOWER_KEY_MPLS_OPT_LSE_LABEL]);
  777. if (label & ~MPLS_LABEL_MASK) {
  778. NL_SET_ERR_MSG_ATTR(extack,
  779. tb[TCA_FLOWER_KEY_MPLS_OPT_LSE_LABEL],
  780. "Label must be between 0 and 1048575");
  781. return -EINVAL;
  782. }
  783. lse_val->mpls_label = label;
  784. lse_mask->mpls_label = MPLS_LABEL_MASK;
  785. }
  786. return 0;
  787. }
  788. static int fl_set_key_mpls_opts(const struct nlattr *nla_mpls_opts,
  789. struct flow_dissector_key_mpls *key_val,
  790. struct flow_dissector_key_mpls *key_mask,
  791. struct netlink_ext_ack *extack)
  792. {
  793. struct nlattr *nla_lse;
  794. int rem;
  795. int err;
  796. if (!(nla_mpls_opts->nla_type & NLA_F_NESTED)) {
  797. NL_SET_ERR_MSG_ATTR(extack, nla_mpls_opts,
  798. "NLA_F_NESTED is missing");
  799. return -EINVAL;
  800. }
  801. nla_for_each_nested(nla_lse, nla_mpls_opts, rem) {
  802. if (nla_type(nla_lse) != TCA_FLOWER_KEY_MPLS_OPTS_LSE) {
  803. NL_SET_ERR_MSG_ATTR(extack, nla_lse,
  804. "Invalid MPLS option type");
  805. return -EINVAL;
  806. }
  807. err = fl_set_key_mpls_lse(nla_lse, key_val, key_mask, extack);
  808. if (err < 0)
  809. return err;
  810. }
  811. if (rem) {
  812. NL_SET_ERR_MSG(extack,
  813. "Bytes leftover after parsing MPLS options");
  814. return -EINVAL;
  815. }
  816. return 0;
  817. }
  818. static int fl_set_key_mpls(struct nlattr **tb,
  819. struct flow_dissector_key_mpls *key_val,
  820. struct flow_dissector_key_mpls *key_mask,
  821. struct netlink_ext_ack *extack)
  822. {
  823. struct flow_dissector_mpls_lse *lse_mask;
  824. struct flow_dissector_mpls_lse *lse_val;
  825. if (tb[TCA_FLOWER_KEY_MPLS_OPTS]) {
  826. if (tb[TCA_FLOWER_KEY_MPLS_TTL] ||
  827. tb[TCA_FLOWER_KEY_MPLS_BOS] ||
  828. tb[TCA_FLOWER_KEY_MPLS_TC] ||
  829. tb[TCA_FLOWER_KEY_MPLS_LABEL]) {
  830. NL_SET_ERR_MSG_ATTR(extack,
  831. tb[TCA_FLOWER_KEY_MPLS_OPTS],
  832. "MPLS label, Traffic Class, Bottom Of Stack and Time To Live must be encapsulated in the MPLS options attribute");
  833. return -EBADMSG;
  834. }
  835. return fl_set_key_mpls_opts(tb[TCA_FLOWER_KEY_MPLS_OPTS],
  836. key_val, key_mask, extack);
  837. }
  838. lse_val = &key_val->ls[0];
  839. lse_mask = &key_mask->ls[0];
  840. if (tb[TCA_FLOWER_KEY_MPLS_TTL]) {
  841. lse_val->mpls_ttl = nla_get_u8(tb[TCA_FLOWER_KEY_MPLS_TTL]);
  842. lse_mask->mpls_ttl = MPLS_TTL_MASK;
  843. dissector_set_mpls_lse(key_val, 0);
  844. dissector_set_mpls_lse(key_mask, 0);
  845. }
  846. if (tb[TCA_FLOWER_KEY_MPLS_BOS]) {
  847. u8 bos = nla_get_u8(tb[TCA_FLOWER_KEY_MPLS_BOS]);
  848. if (bos & ~MPLS_BOS_MASK) {
  849. NL_SET_ERR_MSG_ATTR(extack,
  850. tb[TCA_FLOWER_KEY_MPLS_BOS],
  851. "Bottom Of Stack (BOS) must be 0 or 1");
  852. return -EINVAL;
  853. }
  854. lse_val->mpls_bos = bos;
  855. lse_mask->mpls_bos = MPLS_BOS_MASK;
  856. dissector_set_mpls_lse(key_val, 0);
  857. dissector_set_mpls_lse(key_mask, 0);
  858. }
  859. if (tb[TCA_FLOWER_KEY_MPLS_TC]) {
  860. u8 tc = nla_get_u8(tb[TCA_FLOWER_KEY_MPLS_TC]);
  861. if (tc & ~MPLS_TC_MASK) {
  862. NL_SET_ERR_MSG_ATTR(extack,
  863. tb[TCA_FLOWER_KEY_MPLS_TC],
  864. "Traffic Class (TC) must be between 0 and 7");
  865. return -EINVAL;
  866. }
  867. lse_val->mpls_tc = tc;
  868. lse_mask->mpls_tc = MPLS_TC_MASK;
  869. dissector_set_mpls_lse(key_val, 0);
  870. dissector_set_mpls_lse(key_mask, 0);
  871. }
  872. if (tb[TCA_FLOWER_KEY_MPLS_LABEL]) {
  873. u32 label = nla_get_u32(tb[TCA_FLOWER_KEY_MPLS_LABEL]);
  874. if (label & ~MPLS_LABEL_MASK) {
  875. NL_SET_ERR_MSG_ATTR(extack,
  876. tb[TCA_FLOWER_KEY_MPLS_LABEL],
  877. "Label must be between 0 and 1048575");
  878. return -EINVAL;
  879. }
  880. lse_val->mpls_label = label;
  881. lse_mask->mpls_label = MPLS_LABEL_MASK;
  882. dissector_set_mpls_lse(key_val, 0);
  883. dissector_set_mpls_lse(key_mask, 0);
  884. }
  885. return 0;
  886. }
  887. static void fl_set_key_vlan(struct nlattr **tb,
  888. __be16 ethertype,
  889. int vlan_id_key, int vlan_prio_key,
  890. int vlan_next_eth_type_key,
  891. struct flow_dissector_key_vlan *key_val,
  892. struct flow_dissector_key_vlan *key_mask)
  893. {
  894. #define VLAN_PRIORITY_MASK 0x7
  895. if (tb[vlan_id_key]) {
  896. key_val->vlan_id =
  897. nla_get_u16(tb[vlan_id_key]) & VLAN_VID_MASK;
  898. key_mask->vlan_id = VLAN_VID_MASK;
  899. }
  900. if (tb[vlan_prio_key]) {
  901. key_val->vlan_priority =
  902. nla_get_u8(tb[vlan_prio_key]) &
  903. VLAN_PRIORITY_MASK;
  904. key_mask->vlan_priority = VLAN_PRIORITY_MASK;
  905. }
  906. if (ethertype) {
  907. key_val->vlan_tpid = ethertype;
  908. key_mask->vlan_tpid = cpu_to_be16(~0);
  909. }
  910. if (tb[vlan_next_eth_type_key]) {
  911. key_val->vlan_eth_type =
  912. nla_get_be16(tb[vlan_next_eth_type_key]);
  913. key_mask->vlan_eth_type = cpu_to_be16(~0);
  914. }
  915. }
  916. static void fl_set_key_pppoe(struct nlattr **tb,
  917. struct flow_dissector_key_pppoe *key_val,
  918. struct flow_dissector_key_pppoe *key_mask,
  919. struct fl_flow_key *key,
  920. struct fl_flow_key *mask)
  921. {
  922. /* key_val::type must be set to ETH_P_PPP_SES
  923. * because ETH_P_PPP_SES was stored in basic.n_proto
  924. * which might get overwritten by ppp_proto
  925. * or might be set to 0, the role of key_val::type
  926. * is simmilar to vlan_key::tpid
  927. */
  928. key_val->type = htons(ETH_P_PPP_SES);
  929. key_mask->type = cpu_to_be16(~0);
  930. if (tb[TCA_FLOWER_KEY_PPPOE_SID]) {
  931. key_val->session_id =
  932. nla_get_be16(tb[TCA_FLOWER_KEY_PPPOE_SID]);
  933. key_mask->session_id = cpu_to_be16(~0);
  934. }
  935. if (tb[TCA_FLOWER_KEY_PPP_PROTO]) {
  936. key_val->ppp_proto =
  937. nla_get_be16(tb[TCA_FLOWER_KEY_PPP_PROTO]);
  938. key_mask->ppp_proto = cpu_to_be16(~0);
  939. if (key_val->ppp_proto == htons(PPP_IP)) {
  940. key->basic.n_proto = htons(ETH_P_IP);
  941. mask->basic.n_proto = cpu_to_be16(~0);
  942. } else if (key_val->ppp_proto == htons(PPP_IPV6)) {
  943. key->basic.n_proto = htons(ETH_P_IPV6);
  944. mask->basic.n_proto = cpu_to_be16(~0);
  945. } else if (key_val->ppp_proto == htons(PPP_MPLS_UC)) {
  946. key->basic.n_proto = htons(ETH_P_MPLS_UC);
  947. mask->basic.n_proto = cpu_to_be16(~0);
  948. } else if (key_val->ppp_proto == htons(PPP_MPLS_MC)) {
  949. key->basic.n_proto = htons(ETH_P_MPLS_MC);
  950. mask->basic.n_proto = cpu_to_be16(~0);
  951. }
  952. } else {
  953. key->basic.n_proto = 0;
  954. mask->basic.n_proto = cpu_to_be16(0);
  955. }
  956. }
  957. static void fl_set_key_flag(u32 flower_key, u32 flower_mask,
  958. u32 *dissector_key, u32 *dissector_mask,
  959. u32 flower_flag_bit, u32 dissector_flag_bit)
  960. {
  961. if (flower_mask & flower_flag_bit) {
  962. *dissector_mask |= dissector_flag_bit;
  963. if (flower_key & flower_flag_bit)
  964. *dissector_key |= dissector_flag_bit;
  965. }
  966. }
  967. static int fl_set_key_flags(struct nlattr **tb, u32 *flags_key,
  968. u32 *flags_mask, struct netlink_ext_ack *extack)
  969. {
  970. u32 key, mask;
  971. /* mask is mandatory for flags */
  972. if (!tb[TCA_FLOWER_KEY_FLAGS_MASK]) {
  973. NL_SET_ERR_MSG(extack, "Missing flags mask");
  974. return -EINVAL;
  975. }
  976. key = be32_to_cpu(nla_get_be32(tb[TCA_FLOWER_KEY_FLAGS]));
  977. mask = be32_to_cpu(nla_get_be32(tb[TCA_FLOWER_KEY_FLAGS_MASK]));
  978. *flags_key = 0;
  979. *flags_mask = 0;
  980. fl_set_key_flag(key, mask, flags_key, flags_mask,
  981. TCA_FLOWER_KEY_FLAGS_IS_FRAGMENT, FLOW_DIS_IS_FRAGMENT);
  982. fl_set_key_flag(key, mask, flags_key, flags_mask,
  983. TCA_FLOWER_KEY_FLAGS_FRAG_IS_FIRST,
  984. FLOW_DIS_FIRST_FRAG);
  985. return 0;
  986. }
  987. static void fl_set_key_ip(struct nlattr **tb, bool encap,
  988. struct flow_dissector_key_ip *key,
  989. struct flow_dissector_key_ip *mask)
  990. {
  991. int tos_key = encap ? TCA_FLOWER_KEY_ENC_IP_TOS : TCA_FLOWER_KEY_IP_TOS;
  992. int ttl_key = encap ? TCA_FLOWER_KEY_ENC_IP_TTL : TCA_FLOWER_KEY_IP_TTL;
  993. int tos_mask = encap ? TCA_FLOWER_KEY_ENC_IP_TOS_MASK : TCA_FLOWER_KEY_IP_TOS_MASK;
  994. int ttl_mask = encap ? TCA_FLOWER_KEY_ENC_IP_TTL_MASK : TCA_FLOWER_KEY_IP_TTL_MASK;
  995. fl_set_key_val(tb, &key->tos, tos_key, &mask->tos, tos_mask, sizeof(key->tos));
  996. fl_set_key_val(tb, &key->ttl, ttl_key, &mask->ttl, ttl_mask, sizeof(key->ttl));
  997. }
  998. static int fl_set_geneve_opt(const struct nlattr *nla, struct fl_flow_key *key,
  999. int depth, int option_len,
  1000. struct netlink_ext_ack *extack)
  1001. {
  1002. struct nlattr *tb[TCA_FLOWER_KEY_ENC_OPT_GENEVE_MAX + 1];
  1003. struct nlattr *class = NULL, *type = NULL, *data = NULL;
  1004. struct geneve_opt *opt;
  1005. int err, data_len = 0;
  1006. if (option_len > sizeof(struct geneve_opt))
  1007. data_len = option_len - sizeof(struct geneve_opt);
  1008. if (key->enc_opts.len > FLOW_DIS_TUN_OPTS_MAX - 4)
  1009. return -ERANGE;
  1010. opt = (struct geneve_opt *)&key->enc_opts.data[key->enc_opts.len];
  1011. memset(opt, 0xff, option_len);
  1012. opt->length = data_len / 4;
  1013. opt->r1 = 0;
  1014. opt->r2 = 0;
  1015. opt->r3 = 0;
  1016. /* If no mask has been prodived we assume an exact match. */
  1017. if (!depth)
  1018. return sizeof(struct geneve_opt) + data_len;
  1019. if (nla_type(nla) != TCA_FLOWER_KEY_ENC_OPTS_GENEVE) {
  1020. NL_SET_ERR_MSG(extack, "Non-geneve option type for mask");
  1021. return -EINVAL;
  1022. }
  1023. err = nla_parse_nested_deprecated(tb,
  1024. TCA_FLOWER_KEY_ENC_OPT_GENEVE_MAX,
  1025. nla, geneve_opt_policy, extack);
  1026. if (err < 0)
  1027. return err;
  1028. /* We are not allowed to omit any of CLASS, TYPE or DATA
  1029. * fields from the key.
  1030. */
  1031. if (!option_len &&
  1032. (!tb[TCA_FLOWER_KEY_ENC_OPT_GENEVE_CLASS] ||
  1033. !tb[TCA_FLOWER_KEY_ENC_OPT_GENEVE_TYPE] ||
  1034. !tb[TCA_FLOWER_KEY_ENC_OPT_GENEVE_DATA])) {
  1035. NL_SET_ERR_MSG(extack, "Missing tunnel key geneve option class, type or data");
  1036. return -EINVAL;
  1037. }
  1038. /* Omitting any of CLASS, TYPE or DATA fields is allowed
  1039. * for the mask.
  1040. */
  1041. if (tb[TCA_FLOWER_KEY_ENC_OPT_GENEVE_DATA]) {
  1042. int new_len = key->enc_opts.len;
  1043. data = tb[TCA_FLOWER_KEY_ENC_OPT_GENEVE_DATA];
  1044. data_len = nla_len(data);
  1045. if (data_len < 4) {
  1046. NL_SET_ERR_MSG(extack, "Tunnel key geneve option data is less than 4 bytes long");
  1047. return -ERANGE;
  1048. }
  1049. if (data_len % 4) {
  1050. NL_SET_ERR_MSG(extack, "Tunnel key geneve option data is not a multiple of 4 bytes long");
  1051. return -ERANGE;
  1052. }
  1053. new_len += sizeof(struct geneve_opt) + data_len;
  1054. BUILD_BUG_ON(FLOW_DIS_TUN_OPTS_MAX != IP_TUNNEL_OPTS_MAX);
  1055. if (new_len > FLOW_DIS_TUN_OPTS_MAX) {
  1056. NL_SET_ERR_MSG(extack, "Tunnel options exceeds max size");
  1057. return -ERANGE;
  1058. }
  1059. opt->length = data_len / 4;
  1060. memcpy(opt->opt_data, nla_data(data), data_len);
  1061. }
  1062. if (tb[TCA_FLOWER_KEY_ENC_OPT_GENEVE_CLASS]) {
  1063. class = tb[TCA_FLOWER_KEY_ENC_OPT_GENEVE_CLASS];
  1064. opt->opt_class = nla_get_be16(class);
  1065. }
  1066. if (tb[TCA_FLOWER_KEY_ENC_OPT_GENEVE_TYPE]) {
  1067. type = tb[TCA_FLOWER_KEY_ENC_OPT_GENEVE_TYPE];
  1068. opt->type = nla_get_u8(type);
  1069. }
  1070. return sizeof(struct geneve_opt) + data_len;
  1071. }
  1072. static int fl_set_vxlan_opt(const struct nlattr *nla, struct fl_flow_key *key,
  1073. int depth, int option_len,
  1074. struct netlink_ext_ack *extack)
  1075. {
  1076. struct nlattr *tb[TCA_FLOWER_KEY_ENC_OPT_VXLAN_MAX + 1];
  1077. struct vxlan_metadata *md;
  1078. int err;
  1079. md = (struct vxlan_metadata *)&key->enc_opts.data[key->enc_opts.len];
  1080. memset(md, 0xff, sizeof(*md));
  1081. if (!depth)
  1082. return sizeof(*md);
  1083. if (nla_type(nla) != TCA_FLOWER_KEY_ENC_OPTS_VXLAN) {
  1084. NL_SET_ERR_MSG(extack, "Non-vxlan option type for mask");
  1085. return -EINVAL;
  1086. }
  1087. err = nla_parse_nested(tb, TCA_FLOWER_KEY_ENC_OPT_VXLAN_MAX, nla,
  1088. vxlan_opt_policy, extack);
  1089. if (err < 0)
  1090. return err;
  1091. if (!option_len && !tb[TCA_FLOWER_KEY_ENC_OPT_VXLAN_GBP]) {
  1092. NL_SET_ERR_MSG(extack, "Missing tunnel key vxlan option gbp");
  1093. return -EINVAL;
  1094. }
  1095. if (tb[TCA_FLOWER_KEY_ENC_OPT_VXLAN_GBP]) {
  1096. md->gbp = nla_get_u32(tb[TCA_FLOWER_KEY_ENC_OPT_VXLAN_GBP]);
  1097. md->gbp &= VXLAN_GBP_MASK;
  1098. }
  1099. return sizeof(*md);
  1100. }
  1101. static int fl_set_erspan_opt(const struct nlattr *nla, struct fl_flow_key *key,
  1102. int depth, int option_len,
  1103. struct netlink_ext_ack *extack)
  1104. {
  1105. struct nlattr *tb[TCA_FLOWER_KEY_ENC_OPT_ERSPAN_MAX + 1];
  1106. struct erspan_metadata *md;
  1107. int err;
  1108. md = (struct erspan_metadata *)&key->enc_opts.data[key->enc_opts.len];
  1109. memset(md, 0xff, sizeof(*md));
  1110. md->version = 1;
  1111. if (!depth)
  1112. return sizeof(*md);
  1113. if (nla_type(nla) != TCA_FLOWER_KEY_ENC_OPTS_ERSPAN) {
  1114. NL_SET_ERR_MSG(extack, "Non-erspan option type for mask");
  1115. return -EINVAL;
  1116. }
  1117. err = nla_parse_nested(tb, TCA_FLOWER_KEY_ENC_OPT_ERSPAN_MAX, nla,
  1118. erspan_opt_policy, extack);
  1119. if (err < 0)
  1120. return err;
  1121. if (!option_len && !tb[TCA_FLOWER_KEY_ENC_OPT_ERSPAN_VER]) {
  1122. NL_SET_ERR_MSG(extack, "Missing tunnel key erspan option ver");
  1123. return -EINVAL;
  1124. }
  1125. if (tb[TCA_FLOWER_KEY_ENC_OPT_ERSPAN_VER])
  1126. md->version = nla_get_u8(tb[TCA_FLOWER_KEY_ENC_OPT_ERSPAN_VER]);
  1127. if (md->version == 1) {
  1128. if (!option_len && !tb[TCA_FLOWER_KEY_ENC_OPT_ERSPAN_INDEX]) {
  1129. NL_SET_ERR_MSG(extack, "Missing tunnel key erspan option index");
  1130. return -EINVAL;
  1131. }
  1132. if (tb[TCA_FLOWER_KEY_ENC_OPT_ERSPAN_INDEX]) {
  1133. nla = tb[TCA_FLOWER_KEY_ENC_OPT_ERSPAN_INDEX];
  1134. memset(&md->u, 0x00, sizeof(md->u));
  1135. md->u.index = nla_get_be32(nla);
  1136. }
  1137. } else if (md->version == 2) {
  1138. if (!option_len && (!tb[TCA_FLOWER_KEY_ENC_OPT_ERSPAN_DIR] ||
  1139. !tb[TCA_FLOWER_KEY_ENC_OPT_ERSPAN_HWID])) {
  1140. NL_SET_ERR_MSG(extack, "Missing tunnel key erspan option dir or hwid");
  1141. return -EINVAL;
  1142. }
  1143. if (tb[TCA_FLOWER_KEY_ENC_OPT_ERSPAN_DIR]) {
  1144. nla = tb[TCA_FLOWER_KEY_ENC_OPT_ERSPAN_DIR];
  1145. md->u.md2.dir = nla_get_u8(nla);
  1146. }
  1147. if (tb[TCA_FLOWER_KEY_ENC_OPT_ERSPAN_HWID]) {
  1148. nla = tb[TCA_FLOWER_KEY_ENC_OPT_ERSPAN_HWID];
  1149. set_hwid(&md->u.md2, nla_get_u8(nla));
  1150. }
  1151. } else {
  1152. NL_SET_ERR_MSG(extack, "Tunnel key erspan option ver is incorrect");
  1153. return -EINVAL;
  1154. }
  1155. return sizeof(*md);
  1156. }
  1157. static int fl_set_gtp_opt(const struct nlattr *nla, struct fl_flow_key *key,
  1158. int depth, int option_len,
  1159. struct netlink_ext_ack *extack)
  1160. {
  1161. struct nlattr *tb[TCA_FLOWER_KEY_ENC_OPT_GTP_MAX + 1];
  1162. struct gtp_pdu_session_info *sinfo;
  1163. u8 len = key->enc_opts.len;
  1164. int err;
  1165. sinfo = (struct gtp_pdu_session_info *)&key->enc_opts.data[len];
  1166. memset(sinfo, 0xff, option_len);
  1167. if (!depth)
  1168. return sizeof(*sinfo);
  1169. if (nla_type(nla) != TCA_FLOWER_KEY_ENC_OPTS_GTP) {
  1170. NL_SET_ERR_MSG_MOD(extack, "Non-gtp option type for mask");
  1171. return -EINVAL;
  1172. }
  1173. err = nla_parse_nested(tb, TCA_FLOWER_KEY_ENC_OPT_GTP_MAX, nla,
  1174. gtp_opt_policy, extack);
  1175. if (err < 0)
  1176. return err;
  1177. if (!option_len &&
  1178. (!tb[TCA_FLOWER_KEY_ENC_OPT_GTP_PDU_TYPE] ||
  1179. !tb[TCA_FLOWER_KEY_ENC_OPT_GTP_QFI])) {
  1180. NL_SET_ERR_MSG_MOD(extack,
  1181. "Missing tunnel key gtp option pdu type or qfi");
  1182. return -EINVAL;
  1183. }
  1184. if (tb[TCA_FLOWER_KEY_ENC_OPT_GTP_PDU_TYPE])
  1185. sinfo->pdu_type =
  1186. nla_get_u8(tb[TCA_FLOWER_KEY_ENC_OPT_GTP_PDU_TYPE]);
  1187. if (tb[TCA_FLOWER_KEY_ENC_OPT_GTP_QFI])
  1188. sinfo->qfi = nla_get_u8(tb[TCA_FLOWER_KEY_ENC_OPT_GTP_QFI]);
  1189. return sizeof(*sinfo);
  1190. }
  1191. static int fl_set_enc_opt(struct nlattr **tb, struct fl_flow_key *key,
  1192. struct fl_flow_key *mask,
  1193. struct netlink_ext_ack *extack)
  1194. {
  1195. const struct nlattr *nla_enc_key, *nla_opt_key, *nla_opt_msk = NULL;
  1196. int err, option_len, key_depth, msk_depth = 0;
  1197. err = nla_validate_nested_deprecated(tb[TCA_FLOWER_KEY_ENC_OPTS],
  1198. TCA_FLOWER_KEY_ENC_OPTS_MAX,
  1199. enc_opts_policy, extack);
  1200. if (err)
  1201. return err;
  1202. nla_enc_key = nla_data(tb[TCA_FLOWER_KEY_ENC_OPTS]);
  1203. if (tb[TCA_FLOWER_KEY_ENC_OPTS_MASK]) {
  1204. err = nla_validate_nested_deprecated(tb[TCA_FLOWER_KEY_ENC_OPTS_MASK],
  1205. TCA_FLOWER_KEY_ENC_OPTS_MAX,
  1206. enc_opts_policy, extack);
  1207. if (err)
  1208. return err;
  1209. nla_opt_msk = nla_data(tb[TCA_FLOWER_KEY_ENC_OPTS_MASK]);
  1210. msk_depth = nla_len(tb[TCA_FLOWER_KEY_ENC_OPTS_MASK]);
  1211. if (!nla_ok(nla_opt_msk, msk_depth)) {
  1212. NL_SET_ERR_MSG(extack, "Invalid nested attribute for masks");
  1213. return -EINVAL;
  1214. }
  1215. }
  1216. nla_for_each_attr(nla_opt_key, nla_enc_key,
  1217. nla_len(tb[TCA_FLOWER_KEY_ENC_OPTS]), key_depth) {
  1218. switch (nla_type(nla_opt_key)) {
  1219. case TCA_FLOWER_KEY_ENC_OPTS_GENEVE:
  1220. if (key->enc_opts.dst_opt_type &&
  1221. key->enc_opts.dst_opt_type != TUNNEL_GENEVE_OPT) {
  1222. NL_SET_ERR_MSG(extack, "Duplicate type for geneve options");
  1223. return -EINVAL;
  1224. }
  1225. option_len = 0;
  1226. key->enc_opts.dst_opt_type = TUNNEL_GENEVE_OPT;
  1227. option_len = fl_set_geneve_opt(nla_opt_key, key,
  1228. key_depth, option_len,
  1229. extack);
  1230. if (option_len < 0)
  1231. return option_len;
  1232. key->enc_opts.len += option_len;
  1233. /* At the same time we need to parse through the mask
  1234. * in order to verify exact and mask attribute lengths.
  1235. */
  1236. mask->enc_opts.dst_opt_type = TUNNEL_GENEVE_OPT;
  1237. option_len = fl_set_geneve_opt(nla_opt_msk, mask,
  1238. msk_depth, option_len,
  1239. extack);
  1240. if (option_len < 0)
  1241. return option_len;
  1242. mask->enc_opts.len += option_len;
  1243. if (key->enc_opts.len != mask->enc_opts.len) {
  1244. NL_SET_ERR_MSG(extack, "Key and mask miss aligned");
  1245. return -EINVAL;
  1246. }
  1247. break;
  1248. case TCA_FLOWER_KEY_ENC_OPTS_VXLAN:
  1249. if (key->enc_opts.dst_opt_type) {
  1250. NL_SET_ERR_MSG(extack, "Duplicate type for vxlan options");
  1251. return -EINVAL;
  1252. }
  1253. option_len = 0;
  1254. key->enc_opts.dst_opt_type = TUNNEL_VXLAN_OPT;
  1255. option_len = fl_set_vxlan_opt(nla_opt_key, key,
  1256. key_depth, option_len,
  1257. extack);
  1258. if (option_len < 0)
  1259. return option_len;
  1260. key->enc_opts.len += option_len;
  1261. /* At the same time we need to parse through the mask
  1262. * in order to verify exact and mask attribute lengths.
  1263. */
  1264. mask->enc_opts.dst_opt_type = TUNNEL_VXLAN_OPT;
  1265. option_len = fl_set_vxlan_opt(nla_opt_msk, mask,
  1266. msk_depth, option_len,
  1267. extack);
  1268. if (option_len < 0)
  1269. return option_len;
  1270. mask->enc_opts.len += option_len;
  1271. if (key->enc_opts.len != mask->enc_opts.len) {
  1272. NL_SET_ERR_MSG(extack, "Key and mask miss aligned");
  1273. return -EINVAL;
  1274. }
  1275. break;
  1276. case TCA_FLOWER_KEY_ENC_OPTS_ERSPAN:
  1277. if (key->enc_opts.dst_opt_type) {
  1278. NL_SET_ERR_MSG(extack, "Duplicate type for erspan options");
  1279. return -EINVAL;
  1280. }
  1281. option_len = 0;
  1282. key->enc_opts.dst_opt_type = TUNNEL_ERSPAN_OPT;
  1283. option_len = fl_set_erspan_opt(nla_opt_key, key,
  1284. key_depth, option_len,
  1285. extack);
  1286. if (option_len < 0)
  1287. return option_len;
  1288. key->enc_opts.len += option_len;
  1289. /* At the same time we need to parse through the mask
  1290. * in order to verify exact and mask attribute lengths.
  1291. */
  1292. mask->enc_opts.dst_opt_type = TUNNEL_ERSPAN_OPT;
  1293. option_len = fl_set_erspan_opt(nla_opt_msk, mask,
  1294. msk_depth, option_len,
  1295. extack);
  1296. if (option_len < 0)
  1297. return option_len;
  1298. mask->enc_opts.len += option_len;
  1299. if (key->enc_opts.len != mask->enc_opts.len) {
  1300. NL_SET_ERR_MSG(extack, "Key and mask miss aligned");
  1301. return -EINVAL;
  1302. }
  1303. break;
  1304. case TCA_FLOWER_KEY_ENC_OPTS_GTP:
  1305. if (key->enc_opts.dst_opt_type) {
  1306. NL_SET_ERR_MSG_MOD(extack,
  1307. "Duplicate type for gtp options");
  1308. return -EINVAL;
  1309. }
  1310. option_len = 0;
  1311. key->enc_opts.dst_opt_type = TUNNEL_GTP_OPT;
  1312. option_len = fl_set_gtp_opt(nla_opt_key, key,
  1313. key_depth, option_len,
  1314. extack);
  1315. if (option_len < 0)
  1316. return option_len;
  1317. key->enc_opts.len += option_len;
  1318. /* At the same time we need to parse through the mask
  1319. * in order to verify exact and mask attribute lengths.
  1320. */
  1321. mask->enc_opts.dst_opt_type = TUNNEL_GTP_OPT;
  1322. option_len = fl_set_gtp_opt(nla_opt_msk, mask,
  1323. msk_depth, option_len,
  1324. extack);
  1325. if (option_len < 0)
  1326. return option_len;
  1327. mask->enc_opts.len += option_len;
  1328. if (key->enc_opts.len != mask->enc_opts.len) {
  1329. NL_SET_ERR_MSG_MOD(extack,
  1330. "Key and mask miss aligned");
  1331. return -EINVAL;
  1332. }
  1333. break;
  1334. default:
  1335. NL_SET_ERR_MSG(extack, "Unknown tunnel option type");
  1336. return -EINVAL;
  1337. }
  1338. if (!msk_depth)
  1339. continue;
  1340. if (!nla_ok(nla_opt_msk, msk_depth)) {
  1341. NL_SET_ERR_MSG(extack, "A mask attribute is invalid");
  1342. return -EINVAL;
  1343. }
  1344. nla_opt_msk = nla_next(nla_opt_msk, &msk_depth);
  1345. }
  1346. return 0;
  1347. }
  1348. static int fl_validate_ct_state(u16 state, struct nlattr *tb,
  1349. struct netlink_ext_ack *extack)
  1350. {
  1351. if (state && !(state & TCA_FLOWER_KEY_CT_FLAGS_TRACKED)) {
  1352. NL_SET_ERR_MSG_ATTR(extack, tb,
  1353. "no trk, so no other flag can be set");
  1354. return -EINVAL;
  1355. }
  1356. if (state & TCA_FLOWER_KEY_CT_FLAGS_NEW &&
  1357. state & TCA_FLOWER_KEY_CT_FLAGS_ESTABLISHED) {
  1358. NL_SET_ERR_MSG_ATTR(extack, tb,
  1359. "new and est are mutually exclusive");
  1360. return -EINVAL;
  1361. }
  1362. if (state & TCA_FLOWER_KEY_CT_FLAGS_INVALID &&
  1363. state & ~(TCA_FLOWER_KEY_CT_FLAGS_TRACKED |
  1364. TCA_FLOWER_KEY_CT_FLAGS_INVALID)) {
  1365. NL_SET_ERR_MSG_ATTR(extack, tb,
  1366. "when inv is set, only trk may be set");
  1367. return -EINVAL;
  1368. }
  1369. if (state & TCA_FLOWER_KEY_CT_FLAGS_NEW &&
  1370. state & TCA_FLOWER_KEY_CT_FLAGS_REPLY) {
  1371. NL_SET_ERR_MSG_ATTR(extack, tb,
  1372. "new and rpl are mutually exclusive");
  1373. return -EINVAL;
  1374. }
  1375. return 0;
  1376. }
  1377. static int fl_set_key_ct(struct nlattr **tb,
  1378. struct flow_dissector_key_ct *key,
  1379. struct flow_dissector_key_ct *mask,
  1380. struct netlink_ext_ack *extack)
  1381. {
  1382. if (tb[TCA_FLOWER_KEY_CT_STATE]) {
  1383. int err;
  1384. if (!IS_ENABLED(CONFIG_NF_CONNTRACK)) {
  1385. NL_SET_ERR_MSG(extack, "Conntrack isn't enabled");
  1386. return -EOPNOTSUPP;
  1387. }
  1388. fl_set_key_val(tb, &key->ct_state, TCA_FLOWER_KEY_CT_STATE,
  1389. &mask->ct_state, TCA_FLOWER_KEY_CT_STATE_MASK,
  1390. sizeof(key->ct_state));
  1391. err = fl_validate_ct_state(key->ct_state & mask->ct_state,
  1392. tb[TCA_FLOWER_KEY_CT_STATE_MASK],
  1393. extack);
  1394. if (err)
  1395. return err;
  1396. }
  1397. if (tb[TCA_FLOWER_KEY_CT_ZONE]) {
  1398. if (!IS_ENABLED(CONFIG_NF_CONNTRACK_ZONES)) {
  1399. NL_SET_ERR_MSG(extack, "Conntrack zones isn't enabled");
  1400. return -EOPNOTSUPP;
  1401. }
  1402. fl_set_key_val(tb, &key->ct_zone, TCA_FLOWER_KEY_CT_ZONE,
  1403. &mask->ct_zone, TCA_FLOWER_KEY_CT_ZONE_MASK,
  1404. sizeof(key->ct_zone));
  1405. }
  1406. if (tb[TCA_FLOWER_KEY_CT_MARK]) {
  1407. if (!IS_ENABLED(CONFIG_NF_CONNTRACK_MARK)) {
  1408. NL_SET_ERR_MSG(extack, "Conntrack mark isn't enabled");
  1409. return -EOPNOTSUPP;
  1410. }
  1411. fl_set_key_val(tb, &key->ct_mark, TCA_FLOWER_KEY_CT_MARK,
  1412. &mask->ct_mark, TCA_FLOWER_KEY_CT_MARK_MASK,
  1413. sizeof(key->ct_mark));
  1414. }
  1415. if (tb[TCA_FLOWER_KEY_CT_LABELS]) {
  1416. if (!IS_ENABLED(CONFIG_NF_CONNTRACK_LABELS)) {
  1417. NL_SET_ERR_MSG(extack, "Conntrack labels aren't enabled");
  1418. return -EOPNOTSUPP;
  1419. }
  1420. fl_set_key_val(tb, key->ct_labels, TCA_FLOWER_KEY_CT_LABELS,
  1421. mask->ct_labels, TCA_FLOWER_KEY_CT_LABELS_MASK,
  1422. sizeof(key->ct_labels));
  1423. }
  1424. return 0;
  1425. }
  1426. static bool is_vlan_key(struct nlattr *tb, __be16 *ethertype,
  1427. struct fl_flow_key *key, struct fl_flow_key *mask,
  1428. int vthresh)
  1429. {
  1430. const bool good_num_of_vlans = key->num_of_vlans.num_of_vlans > vthresh;
  1431. if (!tb) {
  1432. *ethertype = 0;
  1433. return good_num_of_vlans;
  1434. }
  1435. *ethertype = nla_get_be16(tb);
  1436. if (good_num_of_vlans || eth_type_vlan(*ethertype))
  1437. return true;
  1438. key->basic.n_proto = *ethertype;
  1439. mask->basic.n_proto = cpu_to_be16(~0);
  1440. return false;
  1441. }
  1442. static int fl_set_key(struct net *net, struct nlattr **tb,
  1443. struct fl_flow_key *key, struct fl_flow_key *mask,
  1444. struct netlink_ext_ack *extack)
  1445. {
  1446. __be16 ethertype;
  1447. int ret = 0;
  1448. if (tb[TCA_FLOWER_INDEV]) {
  1449. int err = tcf_change_indev(net, tb[TCA_FLOWER_INDEV], extack);
  1450. if (err < 0)
  1451. return err;
  1452. key->meta.ingress_ifindex = err;
  1453. mask->meta.ingress_ifindex = 0xffffffff;
  1454. }
  1455. fl_set_key_val(tb, key->eth.dst, TCA_FLOWER_KEY_ETH_DST,
  1456. mask->eth.dst, TCA_FLOWER_KEY_ETH_DST_MASK,
  1457. sizeof(key->eth.dst));
  1458. fl_set_key_val(tb, key->eth.src, TCA_FLOWER_KEY_ETH_SRC,
  1459. mask->eth.src, TCA_FLOWER_KEY_ETH_SRC_MASK,
  1460. sizeof(key->eth.src));
  1461. fl_set_key_val(tb, &key->num_of_vlans,
  1462. TCA_FLOWER_KEY_NUM_OF_VLANS,
  1463. &mask->num_of_vlans,
  1464. TCA_FLOWER_UNSPEC,
  1465. sizeof(key->num_of_vlans));
  1466. if (is_vlan_key(tb[TCA_FLOWER_KEY_ETH_TYPE], &ethertype, key, mask, 0)) {
  1467. fl_set_key_vlan(tb, ethertype, TCA_FLOWER_KEY_VLAN_ID,
  1468. TCA_FLOWER_KEY_VLAN_PRIO,
  1469. TCA_FLOWER_KEY_VLAN_ETH_TYPE,
  1470. &key->vlan, &mask->vlan);
  1471. if (is_vlan_key(tb[TCA_FLOWER_KEY_VLAN_ETH_TYPE],
  1472. &ethertype, key, mask, 1)) {
  1473. fl_set_key_vlan(tb, ethertype,
  1474. TCA_FLOWER_KEY_CVLAN_ID,
  1475. TCA_FLOWER_KEY_CVLAN_PRIO,
  1476. TCA_FLOWER_KEY_CVLAN_ETH_TYPE,
  1477. &key->cvlan, &mask->cvlan);
  1478. fl_set_key_val(tb, &key->basic.n_proto,
  1479. TCA_FLOWER_KEY_CVLAN_ETH_TYPE,
  1480. &mask->basic.n_proto,
  1481. TCA_FLOWER_UNSPEC,
  1482. sizeof(key->basic.n_proto));
  1483. }
  1484. }
  1485. if (key->basic.n_proto == htons(ETH_P_PPP_SES))
  1486. fl_set_key_pppoe(tb, &key->pppoe, &mask->pppoe, key, mask);
  1487. if (key->basic.n_proto == htons(ETH_P_IP) ||
  1488. key->basic.n_proto == htons(ETH_P_IPV6)) {
  1489. fl_set_key_val(tb, &key->basic.ip_proto, TCA_FLOWER_KEY_IP_PROTO,
  1490. &mask->basic.ip_proto, TCA_FLOWER_UNSPEC,
  1491. sizeof(key->basic.ip_proto));
  1492. fl_set_key_ip(tb, false, &key->ip, &mask->ip);
  1493. }
  1494. if (tb[TCA_FLOWER_KEY_IPV4_SRC] || tb[TCA_FLOWER_KEY_IPV4_DST]) {
  1495. key->control.addr_type = FLOW_DISSECTOR_KEY_IPV4_ADDRS;
  1496. mask->control.addr_type = ~0;
  1497. fl_set_key_val(tb, &key->ipv4.src, TCA_FLOWER_KEY_IPV4_SRC,
  1498. &mask->ipv4.src, TCA_FLOWER_KEY_IPV4_SRC_MASK,
  1499. sizeof(key->ipv4.src));
  1500. fl_set_key_val(tb, &key->ipv4.dst, TCA_FLOWER_KEY_IPV4_DST,
  1501. &mask->ipv4.dst, TCA_FLOWER_KEY_IPV4_DST_MASK,
  1502. sizeof(key->ipv4.dst));
  1503. } else if (tb[TCA_FLOWER_KEY_IPV6_SRC] || tb[TCA_FLOWER_KEY_IPV6_DST]) {
  1504. key->control.addr_type = FLOW_DISSECTOR_KEY_IPV6_ADDRS;
  1505. mask->control.addr_type = ~0;
  1506. fl_set_key_val(tb, &key->ipv6.src, TCA_FLOWER_KEY_IPV6_SRC,
  1507. &mask->ipv6.src, TCA_FLOWER_KEY_IPV6_SRC_MASK,
  1508. sizeof(key->ipv6.src));
  1509. fl_set_key_val(tb, &key->ipv6.dst, TCA_FLOWER_KEY_IPV6_DST,
  1510. &mask->ipv6.dst, TCA_FLOWER_KEY_IPV6_DST_MASK,
  1511. sizeof(key->ipv6.dst));
  1512. }
  1513. if (key->basic.ip_proto == IPPROTO_TCP) {
  1514. fl_set_key_val(tb, &key->tp.src, TCA_FLOWER_KEY_TCP_SRC,
  1515. &mask->tp.src, TCA_FLOWER_KEY_TCP_SRC_MASK,
  1516. sizeof(key->tp.src));
  1517. fl_set_key_val(tb, &key->tp.dst, TCA_FLOWER_KEY_TCP_DST,
  1518. &mask->tp.dst, TCA_FLOWER_KEY_TCP_DST_MASK,
  1519. sizeof(key->tp.dst));
  1520. fl_set_key_val(tb, &key->tcp.flags, TCA_FLOWER_KEY_TCP_FLAGS,
  1521. &mask->tcp.flags, TCA_FLOWER_KEY_TCP_FLAGS_MASK,
  1522. sizeof(key->tcp.flags));
  1523. } else if (key->basic.ip_proto == IPPROTO_UDP) {
  1524. fl_set_key_val(tb, &key->tp.src, TCA_FLOWER_KEY_UDP_SRC,
  1525. &mask->tp.src, TCA_FLOWER_KEY_UDP_SRC_MASK,
  1526. sizeof(key->tp.src));
  1527. fl_set_key_val(tb, &key->tp.dst, TCA_FLOWER_KEY_UDP_DST,
  1528. &mask->tp.dst, TCA_FLOWER_KEY_UDP_DST_MASK,
  1529. sizeof(key->tp.dst));
  1530. } else if (key->basic.ip_proto == IPPROTO_SCTP) {
  1531. fl_set_key_val(tb, &key->tp.src, TCA_FLOWER_KEY_SCTP_SRC,
  1532. &mask->tp.src, TCA_FLOWER_KEY_SCTP_SRC_MASK,
  1533. sizeof(key->tp.src));
  1534. fl_set_key_val(tb, &key->tp.dst, TCA_FLOWER_KEY_SCTP_DST,
  1535. &mask->tp.dst, TCA_FLOWER_KEY_SCTP_DST_MASK,
  1536. sizeof(key->tp.dst));
  1537. } else if (key->basic.n_proto == htons(ETH_P_IP) &&
  1538. key->basic.ip_proto == IPPROTO_ICMP) {
  1539. fl_set_key_val(tb, &key->icmp.type, TCA_FLOWER_KEY_ICMPV4_TYPE,
  1540. &mask->icmp.type,
  1541. TCA_FLOWER_KEY_ICMPV4_TYPE_MASK,
  1542. sizeof(key->icmp.type));
  1543. fl_set_key_val(tb, &key->icmp.code, TCA_FLOWER_KEY_ICMPV4_CODE,
  1544. &mask->icmp.code,
  1545. TCA_FLOWER_KEY_ICMPV4_CODE_MASK,
  1546. sizeof(key->icmp.code));
  1547. } else if (key->basic.n_proto == htons(ETH_P_IPV6) &&
  1548. key->basic.ip_proto == IPPROTO_ICMPV6) {
  1549. fl_set_key_val(tb, &key->icmp.type, TCA_FLOWER_KEY_ICMPV6_TYPE,
  1550. &mask->icmp.type,
  1551. TCA_FLOWER_KEY_ICMPV6_TYPE_MASK,
  1552. sizeof(key->icmp.type));
  1553. fl_set_key_val(tb, &key->icmp.code, TCA_FLOWER_KEY_ICMPV6_CODE,
  1554. &mask->icmp.code,
  1555. TCA_FLOWER_KEY_ICMPV6_CODE_MASK,
  1556. sizeof(key->icmp.code));
  1557. } else if (key->basic.n_proto == htons(ETH_P_MPLS_UC) ||
  1558. key->basic.n_proto == htons(ETH_P_MPLS_MC)) {
  1559. ret = fl_set_key_mpls(tb, &key->mpls, &mask->mpls, extack);
  1560. if (ret)
  1561. return ret;
  1562. } else if (key->basic.n_proto == htons(ETH_P_ARP) ||
  1563. key->basic.n_proto == htons(ETH_P_RARP)) {
  1564. fl_set_key_val(tb, &key->arp.sip, TCA_FLOWER_KEY_ARP_SIP,
  1565. &mask->arp.sip, TCA_FLOWER_KEY_ARP_SIP_MASK,
  1566. sizeof(key->arp.sip));
  1567. fl_set_key_val(tb, &key->arp.tip, TCA_FLOWER_KEY_ARP_TIP,
  1568. &mask->arp.tip, TCA_FLOWER_KEY_ARP_TIP_MASK,
  1569. sizeof(key->arp.tip));
  1570. fl_set_key_val(tb, &key->arp.op, TCA_FLOWER_KEY_ARP_OP,
  1571. &mask->arp.op, TCA_FLOWER_KEY_ARP_OP_MASK,
  1572. sizeof(key->arp.op));
  1573. fl_set_key_val(tb, key->arp.sha, TCA_FLOWER_KEY_ARP_SHA,
  1574. mask->arp.sha, TCA_FLOWER_KEY_ARP_SHA_MASK,
  1575. sizeof(key->arp.sha));
  1576. fl_set_key_val(tb, key->arp.tha, TCA_FLOWER_KEY_ARP_THA,
  1577. mask->arp.tha, TCA_FLOWER_KEY_ARP_THA_MASK,
  1578. sizeof(key->arp.tha));
  1579. } else if (key->basic.ip_proto == IPPROTO_L2TP) {
  1580. fl_set_key_val(tb, &key->l2tpv3.session_id,
  1581. TCA_FLOWER_KEY_L2TPV3_SID,
  1582. &mask->l2tpv3.session_id, TCA_FLOWER_UNSPEC,
  1583. sizeof(key->l2tpv3.session_id));
  1584. }
  1585. if (key->basic.ip_proto == IPPROTO_TCP ||
  1586. key->basic.ip_proto == IPPROTO_UDP ||
  1587. key->basic.ip_proto == IPPROTO_SCTP) {
  1588. ret = fl_set_key_port_range(tb, key, mask, extack);
  1589. if (ret)
  1590. return ret;
  1591. }
  1592. if (tb[TCA_FLOWER_KEY_ENC_IPV4_SRC] ||
  1593. tb[TCA_FLOWER_KEY_ENC_IPV4_DST]) {
  1594. key->enc_control.addr_type = FLOW_DISSECTOR_KEY_IPV4_ADDRS;
  1595. mask->enc_control.addr_type = ~0;
  1596. fl_set_key_val(tb, &key->enc_ipv4.src,
  1597. TCA_FLOWER_KEY_ENC_IPV4_SRC,
  1598. &mask->enc_ipv4.src,
  1599. TCA_FLOWER_KEY_ENC_IPV4_SRC_MASK,
  1600. sizeof(key->enc_ipv4.src));
  1601. fl_set_key_val(tb, &key->enc_ipv4.dst,
  1602. TCA_FLOWER_KEY_ENC_IPV4_DST,
  1603. &mask->enc_ipv4.dst,
  1604. TCA_FLOWER_KEY_ENC_IPV4_DST_MASK,
  1605. sizeof(key->enc_ipv4.dst));
  1606. }
  1607. if (tb[TCA_FLOWER_KEY_ENC_IPV6_SRC] ||
  1608. tb[TCA_FLOWER_KEY_ENC_IPV6_DST]) {
  1609. key->enc_control.addr_type = FLOW_DISSECTOR_KEY_IPV6_ADDRS;
  1610. mask->enc_control.addr_type = ~0;
  1611. fl_set_key_val(tb, &key->enc_ipv6.src,
  1612. TCA_FLOWER_KEY_ENC_IPV6_SRC,
  1613. &mask->enc_ipv6.src,
  1614. TCA_FLOWER_KEY_ENC_IPV6_SRC_MASK,
  1615. sizeof(key->enc_ipv6.src));
  1616. fl_set_key_val(tb, &key->enc_ipv6.dst,
  1617. TCA_FLOWER_KEY_ENC_IPV6_DST,
  1618. &mask->enc_ipv6.dst,
  1619. TCA_FLOWER_KEY_ENC_IPV6_DST_MASK,
  1620. sizeof(key->enc_ipv6.dst));
  1621. }
  1622. fl_set_key_val(tb, &key->enc_key_id.keyid, TCA_FLOWER_KEY_ENC_KEY_ID,
  1623. &mask->enc_key_id.keyid, TCA_FLOWER_UNSPEC,
  1624. sizeof(key->enc_key_id.keyid));
  1625. fl_set_key_val(tb, &key->enc_tp.src, TCA_FLOWER_KEY_ENC_UDP_SRC_PORT,
  1626. &mask->enc_tp.src, TCA_FLOWER_KEY_ENC_UDP_SRC_PORT_MASK,
  1627. sizeof(key->enc_tp.src));
  1628. fl_set_key_val(tb, &key->enc_tp.dst, TCA_FLOWER_KEY_ENC_UDP_DST_PORT,
  1629. &mask->enc_tp.dst, TCA_FLOWER_KEY_ENC_UDP_DST_PORT_MASK,
  1630. sizeof(key->enc_tp.dst));
  1631. fl_set_key_ip(tb, true, &key->enc_ip, &mask->enc_ip);
  1632. fl_set_key_val(tb, &key->hash.hash, TCA_FLOWER_KEY_HASH,
  1633. &mask->hash.hash, TCA_FLOWER_KEY_HASH_MASK,
  1634. sizeof(key->hash.hash));
  1635. if (tb[TCA_FLOWER_KEY_ENC_OPTS]) {
  1636. ret = fl_set_enc_opt(tb, key, mask, extack);
  1637. if (ret)
  1638. return ret;
  1639. }
  1640. ret = fl_set_key_ct(tb, &key->ct, &mask->ct, extack);
  1641. if (ret)
  1642. return ret;
  1643. if (tb[TCA_FLOWER_KEY_FLAGS])
  1644. ret = fl_set_key_flags(tb, &key->control.flags,
  1645. &mask->control.flags, extack);
  1646. return ret;
  1647. }
  1648. static void fl_mask_copy(struct fl_flow_mask *dst,
  1649. struct fl_flow_mask *src)
  1650. {
  1651. const void *psrc = fl_key_get_start(&src->key, src);
  1652. void *pdst = fl_key_get_start(&dst->key, src);
  1653. memcpy(pdst, psrc, fl_mask_range(src));
  1654. dst->range = src->range;
  1655. }
  1656. static const struct rhashtable_params fl_ht_params = {
  1657. .key_offset = offsetof(struct cls_fl_filter, mkey), /* base offset */
  1658. .head_offset = offsetof(struct cls_fl_filter, ht_node),
  1659. .automatic_shrinking = true,
  1660. };
  1661. static int fl_init_mask_hashtable(struct fl_flow_mask *mask)
  1662. {
  1663. mask->filter_ht_params = fl_ht_params;
  1664. mask->filter_ht_params.key_len = fl_mask_range(mask);
  1665. mask->filter_ht_params.key_offset += mask->range.start;
  1666. return rhashtable_init(&mask->ht, &mask->filter_ht_params);
  1667. }
  1668. #define FL_KEY_MEMBER_OFFSET(member) offsetof(struct fl_flow_key, member)
  1669. #define FL_KEY_MEMBER_SIZE(member) sizeof_field(struct fl_flow_key, member)
  1670. #define FL_KEY_IS_MASKED(mask, member) \
  1671. memchr_inv(((char *)mask) + FL_KEY_MEMBER_OFFSET(member), \
  1672. 0, FL_KEY_MEMBER_SIZE(member)) \
  1673. #define FL_KEY_SET(keys, cnt, id, member) \
  1674. do { \
  1675. keys[cnt].key_id = id; \
  1676. keys[cnt].offset = FL_KEY_MEMBER_OFFSET(member); \
  1677. cnt++; \
  1678. } while(0);
  1679. #define FL_KEY_SET_IF_MASKED(mask, keys, cnt, id, member) \
  1680. do { \
  1681. if (FL_KEY_IS_MASKED(mask, member)) \
  1682. FL_KEY_SET(keys, cnt, id, member); \
  1683. } while(0);
  1684. static void fl_init_dissector(struct flow_dissector *dissector,
  1685. struct fl_flow_key *mask)
  1686. {
  1687. struct flow_dissector_key keys[FLOW_DISSECTOR_KEY_MAX];
  1688. size_t cnt = 0;
  1689. FL_KEY_SET_IF_MASKED(mask, keys, cnt,
  1690. FLOW_DISSECTOR_KEY_META, meta);
  1691. FL_KEY_SET(keys, cnt, FLOW_DISSECTOR_KEY_CONTROL, control);
  1692. FL_KEY_SET(keys, cnt, FLOW_DISSECTOR_KEY_BASIC, basic);
  1693. FL_KEY_SET_IF_MASKED(mask, keys, cnt,
  1694. FLOW_DISSECTOR_KEY_ETH_ADDRS, eth);
  1695. FL_KEY_SET_IF_MASKED(mask, keys, cnt,
  1696. FLOW_DISSECTOR_KEY_IPV4_ADDRS, ipv4);
  1697. FL_KEY_SET_IF_MASKED(mask, keys, cnt,
  1698. FLOW_DISSECTOR_KEY_IPV6_ADDRS, ipv6);
  1699. FL_KEY_SET_IF_MASKED(mask, keys, cnt,
  1700. FLOW_DISSECTOR_KEY_PORTS, tp);
  1701. FL_KEY_SET_IF_MASKED(mask, keys, cnt,
  1702. FLOW_DISSECTOR_KEY_PORTS_RANGE, tp_range);
  1703. FL_KEY_SET_IF_MASKED(mask, keys, cnt,
  1704. FLOW_DISSECTOR_KEY_IP, ip);
  1705. FL_KEY_SET_IF_MASKED(mask, keys, cnt,
  1706. FLOW_DISSECTOR_KEY_TCP, tcp);
  1707. FL_KEY_SET_IF_MASKED(mask, keys, cnt,
  1708. FLOW_DISSECTOR_KEY_ICMP, icmp);
  1709. FL_KEY_SET_IF_MASKED(mask, keys, cnt,
  1710. FLOW_DISSECTOR_KEY_ARP, arp);
  1711. FL_KEY_SET_IF_MASKED(mask, keys, cnt,
  1712. FLOW_DISSECTOR_KEY_MPLS, mpls);
  1713. FL_KEY_SET_IF_MASKED(mask, keys, cnt,
  1714. FLOW_DISSECTOR_KEY_VLAN, vlan);
  1715. FL_KEY_SET_IF_MASKED(mask, keys, cnt,
  1716. FLOW_DISSECTOR_KEY_CVLAN, cvlan);
  1717. FL_KEY_SET_IF_MASKED(mask, keys, cnt,
  1718. FLOW_DISSECTOR_KEY_ENC_KEYID, enc_key_id);
  1719. FL_KEY_SET_IF_MASKED(mask, keys, cnt,
  1720. FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS, enc_ipv4);
  1721. FL_KEY_SET_IF_MASKED(mask, keys, cnt,
  1722. FLOW_DISSECTOR_KEY_ENC_IPV6_ADDRS, enc_ipv6);
  1723. if (FL_KEY_IS_MASKED(mask, enc_ipv4) ||
  1724. FL_KEY_IS_MASKED(mask, enc_ipv6))
  1725. FL_KEY_SET(keys, cnt, FLOW_DISSECTOR_KEY_ENC_CONTROL,
  1726. enc_control);
  1727. FL_KEY_SET_IF_MASKED(mask, keys, cnt,
  1728. FLOW_DISSECTOR_KEY_ENC_PORTS, enc_tp);
  1729. FL_KEY_SET_IF_MASKED(mask, keys, cnt,
  1730. FLOW_DISSECTOR_KEY_ENC_IP, enc_ip);
  1731. FL_KEY_SET_IF_MASKED(mask, keys, cnt,
  1732. FLOW_DISSECTOR_KEY_ENC_OPTS, enc_opts);
  1733. FL_KEY_SET_IF_MASKED(mask, keys, cnt,
  1734. FLOW_DISSECTOR_KEY_CT, ct);
  1735. FL_KEY_SET_IF_MASKED(mask, keys, cnt,
  1736. FLOW_DISSECTOR_KEY_HASH, hash);
  1737. FL_KEY_SET_IF_MASKED(mask, keys, cnt,
  1738. FLOW_DISSECTOR_KEY_NUM_OF_VLANS, num_of_vlans);
  1739. FL_KEY_SET_IF_MASKED(mask, keys, cnt,
  1740. FLOW_DISSECTOR_KEY_PPPOE, pppoe);
  1741. FL_KEY_SET_IF_MASKED(mask, keys, cnt,
  1742. FLOW_DISSECTOR_KEY_L2TPV3, l2tpv3);
  1743. skb_flow_dissector_init(dissector, keys, cnt);
  1744. }
  1745. static struct fl_flow_mask *fl_create_new_mask(struct cls_fl_head *head,
  1746. struct fl_flow_mask *mask)
  1747. {
  1748. struct fl_flow_mask *newmask;
  1749. int err;
  1750. newmask = kzalloc(sizeof(*newmask), GFP_KERNEL);
  1751. if (!newmask)
  1752. return ERR_PTR(-ENOMEM);
  1753. fl_mask_copy(newmask, mask);
  1754. if ((newmask->key.tp_range.tp_min.dst &&
  1755. newmask->key.tp_range.tp_max.dst) ||
  1756. (newmask->key.tp_range.tp_min.src &&
  1757. newmask->key.tp_range.tp_max.src))
  1758. newmask->flags |= TCA_FLOWER_MASK_FLAGS_RANGE;
  1759. err = fl_init_mask_hashtable(newmask);
  1760. if (err)
  1761. goto errout_free;
  1762. fl_init_dissector(&newmask->dissector, &newmask->key);
  1763. INIT_LIST_HEAD_RCU(&newmask->filters);
  1764. refcount_set(&newmask->refcnt, 1);
  1765. err = rhashtable_replace_fast(&head->ht, &mask->ht_node,
  1766. &newmask->ht_node, mask_ht_params);
  1767. if (err)
  1768. goto errout_destroy;
  1769. spin_lock(&head->masks_lock);
  1770. list_add_tail_rcu(&newmask->list, &head->masks);
  1771. spin_unlock(&head->masks_lock);
  1772. return newmask;
  1773. errout_destroy:
  1774. rhashtable_destroy(&newmask->ht);
  1775. errout_free:
  1776. kfree(newmask);
  1777. return ERR_PTR(err);
  1778. }
  1779. static int fl_check_assign_mask(struct cls_fl_head *head,
  1780. struct cls_fl_filter *fnew,
  1781. struct cls_fl_filter *fold,
  1782. struct fl_flow_mask *mask)
  1783. {
  1784. struct fl_flow_mask *newmask;
  1785. int ret = 0;
  1786. rcu_read_lock();
  1787. /* Insert mask as temporary node to prevent concurrent creation of mask
  1788. * with same key. Any concurrent lookups with same key will return
  1789. * -EAGAIN because mask's refcnt is zero.
  1790. */
  1791. fnew->mask = rhashtable_lookup_get_insert_fast(&head->ht,
  1792. &mask->ht_node,
  1793. mask_ht_params);
  1794. if (!fnew->mask) {
  1795. rcu_read_unlock();
  1796. if (fold) {
  1797. ret = -EINVAL;
  1798. goto errout_cleanup;
  1799. }
  1800. newmask = fl_create_new_mask(head, mask);
  1801. if (IS_ERR(newmask)) {
  1802. ret = PTR_ERR(newmask);
  1803. goto errout_cleanup;
  1804. }
  1805. fnew->mask = newmask;
  1806. return 0;
  1807. } else if (IS_ERR(fnew->mask)) {
  1808. ret = PTR_ERR(fnew->mask);
  1809. } else if (fold && fold->mask != fnew->mask) {
  1810. ret = -EINVAL;
  1811. } else if (!refcount_inc_not_zero(&fnew->mask->refcnt)) {
  1812. /* Mask was deleted concurrently, try again */
  1813. ret = -EAGAIN;
  1814. }
  1815. rcu_read_unlock();
  1816. return ret;
  1817. errout_cleanup:
  1818. rhashtable_remove_fast(&head->ht, &mask->ht_node,
  1819. mask_ht_params);
  1820. return ret;
  1821. }
  1822. static int fl_set_parms(struct net *net, struct tcf_proto *tp,
  1823. struct cls_fl_filter *f, struct fl_flow_mask *mask,
  1824. unsigned long base, struct nlattr **tb,
  1825. struct nlattr *est,
  1826. struct fl_flow_tmplt *tmplt,
  1827. u32 flags, u32 fl_flags,
  1828. struct netlink_ext_ack *extack)
  1829. {
  1830. int err;
  1831. err = tcf_exts_validate_ex(net, tp, tb, est, &f->exts, flags,
  1832. fl_flags, extack);
  1833. if (err < 0)
  1834. return err;
  1835. if (tb[TCA_FLOWER_CLASSID]) {
  1836. f->res.classid = nla_get_u32(tb[TCA_FLOWER_CLASSID]);
  1837. if (flags & TCA_ACT_FLAGS_NO_RTNL)
  1838. rtnl_lock();
  1839. tcf_bind_filter(tp, &f->res, base);
  1840. if (flags & TCA_ACT_FLAGS_NO_RTNL)
  1841. rtnl_unlock();
  1842. }
  1843. err = fl_set_key(net, tb, &f->key, &mask->key, extack);
  1844. if (err)
  1845. return err;
  1846. fl_mask_update_range(mask);
  1847. fl_set_masked_key(&f->mkey, &f->key, mask);
  1848. if (!fl_mask_fits_tmplt(tmplt, mask)) {
  1849. NL_SET_ERR_MSG_MOD(extack, "Mask does not fit the template");
  1850. return -EINVAL;
  1851. }
  1852. return 0;
  1853. }
  1854. static int fl_ht_insert_unique(struct cls_fl_filter *fnew,
  1855. struct cls_fl_filter *fold,
  1856. bool *in_ht)
  1857. {
  1858. struct fl_flow_mask *mask = fnew->mask;
  1859. int err;
  1860. err = rhashtable_lookup_insert_fast(&mask->ht,
  1861. &fnew->ht_node,
  1862. mask->filter_ht_params);
  1863. if (err) {
  1864. *in_ht = false;
  1865. /* It is okay if filter with same key exists when
  1866. * overwriting.
  1867. */
  1868. return fold && err == -EEXIST ? 0 : err;
  1869. }
  1870. *in_ht = true;
  1871. return 0;
  1872. }
  1873. static int fl_change(struct net *net, struct sk_buff *in_skb,
  1874. struct tcf_proto *tp, unsigned long base,
  1875. u32 handle, struct nlattr **tca,
  1876. void **arg, u32 flags,
  1877. struct netlink_ext_ack *extack)
  1878. {
  1879. struct cls_fl_head *head = fl_head_dereference(tp);
  1880. bool rtnl_held = !(flags & TCA_ACT_FLAGS_NO_RTNL);
  1881. struct cls_fl_filter *fold = *arg;
  1882. struct cls_fl_filter *fnew;
  1883. struct fl_flow_mask *mask;
  1884. struct nlattr **tb;
  1885. bool in_ht;
  1886. int err;
  1887. if (!tca[TCA_OPTIONS]) {
  1888. err = -EINVAL;
  1889. goto errout_fold;
  1890. }
  1891. mask = kzalloc(sizeof(struct fl_flow_mask), GFP_KERNEL);
  1892. if (!mask) {
  1893. err = -ENOBUFS;
  1894. goto errout_fold;
  1895. }
  1896. tb = kcalloc(TCA_FLOWER_MAX + 1, sizeof(struct nlattr *), GFP_KERNEL);
  1897. if (!tb) {
  1898. err = -ENOBUFS;
  1899. goto errout_mask_alloc;
  1900. }
  1901. err = nla_parse_nested_deprecated(tb, TCA_FLOWER_MAX,
  1902. tca[TCA_OPTIONS], fl_policy, NULL);
  1903. if (err < 0)
  1904. goto errout_tb;
  1905. if (fold && handle && fold->handle != handle) {
  1906. err = -EINVAL;
  1907. goto errout_tb;
  1908. }
  1909. fnew = kzalloc(sizeof(*fnew), GFP_KERNEL);
  1910. if (!fnew) {
  1911. err = -ENOBUFS;
  1912. goto errout_tb;
  1913. }
  1914. INIT_LIST_HEAD(&fnew->hw_list);
  1915. refcount_set(&fnew->refcnt, 1);
  1916. err = tcf_exts_init(&fnew->exts, net, TCA_FLOWER_ACT, 0);
  1917. if (err < 0)
  1918. goto errout;
  1919. if (tb[TCA_FLOWER_FLAGS]) {
  1920. fnew->flags = nla_get_u32(tb[TCA_FLOWER_FLAGS]);
  1921. if (!tc_flags_valid(fnew->flags)) {
  1922. err = -EINVAL;
  1923. goto errout;
  1924. }
  1925. }
  1926. err = fl_set_parms(net, tp, fnew, mask, base, tb, tca[TCA_RATE],
  1927. tp->chain->tmplt_priv, flags, fnew->flags,
  1928. extack);
  1929. if (err)
  1930. goto errout;
  1931. err = fl_check_assign_mask(head, fnew, fold, mask);
  1932. if (err)
  1933. goto errout;
  1934. err = fl_ht_insert_unique(fnew, fold, &in_ht);
  1935. if (err)
  1936. goto errout_mask;
  1937. if (!tc_skip_hw(fnew->flags)) {
  1938. err = fl_hw_replace_filter(tp, fnew, rtnl_held, extack);
  1939. if (err)
  1940. goto errout_ht;
  1941. }
  1942. if (!tc_in_hw(fnew->flags))
  1943. fnew->flags |= TCA_CLS_FLAGS_NOT_IN_HW;
  1944. spin_lock(&tp->lock);
  1945. /* tp was deleted concurrently. -EAGAIN will cause caller to lookup
  1946. * proto again or create new one, if necessary.
  1947. */
  1948. if (tp->deleting) {
  1949. err = -EAGAIN;
  1950. goto errout_hw;
  1951. }
  1952. if (fold) {
  1953. /* Fold filter was deleted concurrently. Retry lookup. */
  1954. if (fold->deleted) {
  1955. err = -EAGAIN;
  1956. goto errout_hw;
  1957. }
  1958. fnew->handle = handle;
  1959. if (!in_ht) {
  1960. struct rhashtable_params params =
  1961. fnew->mask->filter_ht_params;
  1962. err = rhashtable_insert_fast(&fnew->mask->ht,
  1963. &fnew->ht_node,
  1964. params);
  1965. if (err)
  1966. goto errout_hw;
  1967. in_ht = true;
  1968. }
  1969. refcount_inc(&fnew->refcnt);
  1970. rhashtable_remove_fast(&fold->mask->ht,
  1971. &fold->ht_node,
  1972. fold->mask->filter_ht_params);
  1973. idr_replace(&head->handle_idr, fnew, fnew->handle);
  1974. list_replace_rcu(&fold->list, &fnew->list);
  1975. fold->deleted = true;
  1976. spin_unlock(&tp->lock);
  1977. fl_mask_put(head, fold->mask);
  1978. if (!tc_skip_hw(fold->flags))
  1979. fl_hw_destroy_filter(tp, fold, rtnl_held, NULL);
  1980. tcf_unbind_filter(tp, &fold->res);
  1981. /* Caller holds reference to fold, so refcnt is always > 0
  1982. * after this.
  1983. */
  1984. refcount_dec(&fold->refcnt);
  1985. __fl_put(fold);
  1986. } else {
  1987. if (handle) {
  1988. /* user specifies a handle and it doesn't exist */
  1989. err = idr_alloc_u32(&head->handle_idr, fnew, &handle,
  1990. handle, GFP_ATOMIC);
  1991. /* Filter with specified handle was concurrently
  1992. * inserted after initial check in cls_api. This is not
  1993. * necessarily an error if NLM_F_EXCL is not set in
  1994. * message flags. Returning EAGAIN will cause cls_api to
  1995. * try to update concurrently inserted rule.
  1996. */
  1997. if (err == -ENOSPC)
  1998. err = -EAGAIN;
  1999. } else {
  2000. handle = 1;
  2001. err = idr_alloc_u32(&head->handle_idr, fnew, &handle,
  2002. INT_MAX, GFP_ATOMIC);
  2003. }
  2004. if (err)
  2005. goto errout_hw;
  2006. refcount_inc(&fnew->refcnt);
  2007. fnew->handle = handle;
  2008. list_add_tail_rcu(&fnew->list, &fnew->mask->filters);
  2009. spin_unlock(&tp->lock);
  2010. }
  2011. *arg = fnew;
  2012. kfree(tb);
  2013. tcf_queue_work(&mask->rwork, fl_uninit_mask_free_work);
  2014. return 0;
  2015. errout_ht:
  2016. spin_lock(&tp->lock);
  2017. errout_hw:
  2018. fnew->deleted = true;
  2019. spin_unlock(&tp->lock);
  2020. if (!tc_skip_hw(fnew->flags))
  2021. fl_hw_destroy_filter(tp, fnew, rtnl_held, NULL);
  2022. if (in_ht)
  2023. rhashtable_remove_fast(&fnew->mask->ht, &fnew->ht_node,
  2024. fnew->mask->filter_ht_params);
  2025. errout_mask:
  2026. fl_mask_put(head, fnew->mask);
  2027. errout:
  2028. __fl_put(fnew);
  2029. errout_tb:
  2030. kfree(tb);
  2031. errout_mask_alloc:
  2032. tcf_queue_work(&mask->rwork, fl_uninit_mask_free_work);
  2033. errout_fold:
  2034. if (fold)
  2035. __fl_put(fold);
  2036. return err;
  2037. }
  2038. static int fl_delete(struct tcf_proto *tp, void *arg, bool *last,
  2039. bool rtnl_held, struct netlink_ext_ack *extack)
  2040. {
  2041. struct cls_fl_head *head = fl_head_dereference(tp);
  2042. struct cls_fl_filter *f = arg;
  2043. bool last_on_mask;
  2044. int err = 0;
  2045. err = __fl_delete(tp, f, &last_on_mask, rtnl_held, extack);
  2046. *last = list_empty(&head->masks);
  2047. __fl_put(f);
  2048. return err;
  2049. }
  2050. static void fl_walk(struct tcf_proto *tp, struct tcf_walker *arg,
  2051. bool rtnl_held)
  2052. {
  2053. struct cls_fl_head *head = fl_head_dereference(tp);
  2054. unsigned long id = arg->cookie, tmp;
  2055. struct cls_fl_filter *f;
  2056. arg->count = arg->skip;
  2057. rcu_read_lock();
  2058. idr_for_each_entry_continue_ul(&head->handle_idr, f, tmp, id) {
  2059. /* don't return filters that are being deleted */
  2060. if (!refcount_inc_not_zero(&f->refcnt))
  2061. continue;
  2062. rcu_read_unlock();
  2063. if (arg->fn(tp, f, arg) < 0) {
  2064. __fl_put(f);
  2065. arg->stop = 1;
  2066. rcu_read_lock();
  2067. break;
  2068. }
  2069. __fl_put(f);
  2070. arg->count++;
  2071. rcu_read_lock();
  2072. }
  2073. rcu_read_unlock();
  2074. arg->cookie = id;
  2075. }
  2076. static struct cls_fl_filter *
  2077. fl_get_next_hw_filter(struct tcf_proto *tp, struct cls_fl_filter *f, bool add)
  2078. {
  2079. struct cls_fl_head *head = fl_head_dereference(tp);
  2080. spin_lock(&tp->lock);
  2081. if (list_empty(&head->hw_filters)) {
  2082. spin_unlock(&tp->lock);
  2083. return NULL;
  2084. }
  2085. if (!f)
  2086. f = list_entry(&head->hw_filters, struct cls_fl_filter,
  2087. hw_list);
  2088. list_for_each_entry_continue(f, &head->hw_filters, hw_list) {
  2089. if (!(add && f->deleted) && refcount_inc_not_zero(&f->refcnt)) {
  2090. spin_unlock(&tp->lock);
  2091. return f;
  2092. }
  2093. }
  2094. spin_unlock(&tp->lock);
  2095. return NULL;
  2096. }
  2097. static int fl_reoffload(struct tcf_proto *tp, bool add, flow_setup_cb_t *cb,
  2098. void *cb_priv, struct netlink_ext_ack *extack)
  2099. {
  2100. struct tcf_block *block = tp->chain->block;
  2101. struct flow_cls_offload cls_flower = {};
  2102. struct cls_fl_filter *f = NULL;
  2103. int err;
  2104. /* hw_filters list can only be changed by hw offload functions after
  2105. * obtaining rtnl lock. Make sure it is not changed while reoffload is
  2106. * iterating it.
  2107. */
  2108. ASSERT_RTNL();
  2109. while ((f = fl_get_next_hw_filter(tp, f, add))) {
  2110. cls_flower.rule =
  2111. flow_rule_alloc(tcf_exts_num_actions(&f->exts));
  2112. if (!cls_flower.rule) {
  2113. __fl_put(f);
  2114. return -ENOMEM;
  2115. }
  2116. tc_cls_common_offload_init(&cls_flower.common, tp, f->flags,
  2117. extack);
  2118. cls_flower.command = add ?
  2119. FLOW_CLS_REPLACE : FLOW_CLS_DESTROY;
  2120. cls_flower.cookie = (unsigned long)f;
  2121. cls_flower.rule->match.dissector = &f->mask->dissector;
  2122. cls_flower.rule->match.mask = &f->mask->key;
  2123. cls_flower.rule->match.key = &f->mkey;
  2124. err = tc_setup_offload_action(&cls_flower.rule->action, &f->exts,
  2125. cls_flower.common.extack);
  2126. if (err) {
  2127. kfree(cls_flower.rule);
  2128. if (tc_skip_sw(f->flags)) {
  2129. __fl_put(f);
  2130. return err;
  2131. }
  2132. goto next_flow;
  2133. }
  2134. cls_flower.classid = f->res.classid;
  2135. err = tc_setup_cb_reoffload(block, tp, add, cb,
  2136. TC_SETUP_CLSFLOWER, &cls_flower,
  2137. cb_priv, &f->flags,
  2138. &f->in_hw_count);
  2139. tc_cleanup_offload_action(&cls_flower.rule->action);
  2140. kfree(cls_flower.rule);
  2141. if (err) {
  2142. __fl_put(f);
  2143. return err;
  2144. }
  2145. next_flow:
  2146. __fl_put(f);
  2147. }
  2148. return 0;
  2149. }
  2150. static void fl_hw_add(struct tcf_proto *tp, void *type_data)
  2151. {
  2152. struct flow_cls_offload *cls_flower = type_data;
  2153. struct cls_fl_filter *f =
  2154. (struct cls_fl_filter *) cls_flower->cookie;
  2155. struct cls_fl_head *head = fl_head_dereference(tp);
  2156. spin_lock(&tp->lock);
  2157. list_add(&f->hw_list, &head->hw_filters);
  2158. spin_unlock(&tp->lock);
  2159. }
  2160. static void fl_hw_del(struct tcf_proto *tp, void *type_data)
  2161. {
  2162. struct flow_cls_offload *cls_flower = type_data;
  2163. struct cls_fl_filter *f =
  2164. (struct cls_fl_filter *) cls_flower->cookie;
  2165. spin_lock(&tp->lock);
  2166. if (!list_empty(&f->hw_list))
  2167. list_del_init(&f->hw_list);
  2168. spin_unlock(&tp->lock);
  2169. }
  2170. static int fl_hw_create_tmplt(struct tcf_chain *chain,
  2171. struct fl_flow_tmplt *tmplt)
  2172. {
  2173. struct flow_cls_offload cls_flower = {};
  2174. struct tcf_block *block = chain->block;
  2175. cls_flower.rule = flow_rule_alloc(0);
  2176. if (!cls_flower.rule)
  2177. return -ENOMEM;
  2178. cls_flower.common.chain_index = chain->index;
  2179. cls_flower.command = FLOW_CLS_TMPLT_CREATE;
  2180. cls_flower.cookie = (unsigned long) tmplt;
  2181. cls_flower.rule->match.dissector = &tmplt->dissector;
  2182. cls_flower.rule->match.mask = &tmplt->mask;
  2183. cls_flower.rule->match.key = &tmplt->dummy_key;
  2184. /* We don't care if driver (any of them) fails to handle this
  2185. * call. It serves just as a hint for it.
  2186. */
  2187. tc_setup_cb_call(block, TC_SETUP_CLSFLOWER, &cls_flower, false, true);
  2188. kfree(cls_flower.rule);
  2189. return 0;
  2190. }
  2191. static void fl_hw_destroy_tmplt(struct tcf_chain *chain,
  2192. struct fl_flow_tmplt *tmplt)
  2193. {
  2194. struct flow_cls_offload cls_flower = {};
  2195. struct tcf_block *block = chain->block;
  2196. cls_flower.common.chain_index = chain->index;
  2197. cls_flower.command = FLOW_CLS_TMPLT_DESTROY;
  2198. cls_flower.cookie = (unsigned long) tmplt;
  2199. tc_setup_cb_call(block, TC_SETUP_CLSFLOWER, &cls_flower, false, true);
  2200. }
  2201. static void *fl_tmplt_create(struct net *net, struct tcf_chain *chain,
  2202. struct nlattr **tca,
  2203. struct netlink_ext_ack *extack)
  2204. {
  2205. struct fl_flow_tmplt *tmplt;
  2206. struct nlattr **tb;
  2207. int err;
  2208. if (!tca[TCA_OPTIONS])
  2209. return ERR_PTR(-EINVAL);
  2210. tb = kcalloc(TCA_FLOWER_MAX + 1, sizeof(struct nlattr *), GFP_KERNEL);
  2211. if (!tb)
  2212. return ERR_PTR(-ENOBUFS);
  2213. err = nla_parse_nested_deprecated(tb, TCA_FLOWER_MAX,
  2214. tca[TCA_OPTIONS], fl_policy, NULL);
  2215. if (err)
  2216. goto errout_tb;
  2217. tmplt = kzalloc(sizeof(*tmplt), GFP_KERNEL);
  2218. if (!tmplt) {
  2219. err = -ENOMEM;
  2220. goto errout_tb;
  2221. }
  2222. tmplt->chain = chain;
  2223. err = fl_set_key(net, tb, &tmplt->dummy_key, &tmplt->mask, extack);
  2224. if (err)
  2225. goto errout_tmplt;
  2226. fl_init_dissector(&tmplt->dissector, &tmplt->mask);
  2227. err = fl_hw_create_tmplt(chain, tmplt);
  2228. if (err)
  2229. goto errout_tmplt;
  2230. kfree(tb);
  2231. return tmplt;
  2232. errout_tmplt:
  2233. kfree(tmplt);
  2234. errout_tb:
  2235. kfree(tb);
  2236. return ERR_PTR(err);
  2237. }
  2238. static void fl_tmplt_destroy(void *tmplt_priv)
  2239. {
  2240. struct fl_flow_tmplt *tmplt = tmplt_priv;
  2241. fl_hw_destroy_tmplt(tmplt->chain, tmplt);
  2242. kfree(tmplt);
  2243. }
  2244. static int fl_dump_key_val(struct sk_buff *skb,
  2245. void *val, int val_type,
  2246. void *mask, int mask_type, int len)
  2247. {
  2248. int err;
  2249. if (!memchr_inv(mask, 0, len))
  2250. return 0;
  2251. err = nla_put(skb, val_type, len, val);
  2252. if (err)
  2253. return err;
  2254. if (mask_type != TCA_FLOWER_UNSPEC) {
  2255. err = nla_put(skb, mask_type, len, mask);
  2256. if (err)
  2257. return err;
  2258. }
  2259. return 0;
  2260. }
  2261. static int fl_dump_key_port_range(struct sk_buff *skb, struct fl_flow_key *key,
  2262. struct fl_flow_key *mask)
  2263. {
  2264. if (fl_dump_key_val(skb, &key->tp_range.tp_min.dst,
  2265. TCA_FLOWER_KEY_PORT_DST_MIN,
  2266. &mask->tp_range.tp_min.dst, TCA_FLOWER_UNSPEC,
  2267. sizeof(key->tp_range.tp_min.dst)) ||
  2268. fl_dump_key_val(skb, &key->tp_range.tp_max.dst,
  2269. TCA_FLOWER_KEY_PORT_DST_MAX,
  2270. &mask->tp_range.tp_max.dst, TCA_FLOWER_UNSPEC,
  2271. sizeof(key->tp_range.tp_max.dst)) ||
  2272. fl_dump_key_val(skb, &key->tp_range.tp_min.src,
  2273. TCA_FLOWER_KEY_PORT_SRC_MIN,
  2274. &mask->tp_range.tp_min.src, TCA_FLOWER_UNSPEC,
  2275. sizeof(key->tp_range.tp_min.src)) ||
  2276. fl_dump_key_val(skb, &key->tp_range.tp_max.src,
  2277. TCA_FLOWER_KEY_PORT_SRC_MAX,
  2278. &mask->tp_range.tp_max.src, TCA_FLOWER_UNSPEC,
  2279. sizeof(key->tp_range.tp_max.src)))
  2280. return -1;
  2281. return 0;
  2282. }
  2283. static int fl_dump_key_mpls_opt_lse(struct sk_buff *skb,
  2284. struct flow_dissector_key_mpls *mpls_key,
  2285. struct flow_dissector_key_mpls *mpls_mask,
  2286. u8 lse_index)
  2287. {
  2288. struct flow_dissector_mpls_lse *lse_mask = &mpls_mask->ls[lse_index];
  2289. struct flow_dissector_mpls_lse *lse_key = &mpls_key->ls[lse_index];
  2290. int err;
  2291. err = nla_put_u8(skb, TCA_FLOWER_KEY_MPLS_OPT_LSE_DEPTH,
  2292. lse_index + 1);
  2293. if (err)
  2294. return err;
  2295. if (lse_mask->mpls_ttl) {
  2296. err = nla_put_u8(skb, TCA_FLOWER_KEY_MPLS_OPT_LSE_TTL,
  2297. lse_key->mpls_ttl);
  2298. if (err)
  2299. return err;
  2300. }
  2301. if (lse_mask->mpls_bos) {
  2302. err = nla_put_u8(skb, TCA_FLOWER_KEY_MPLS_OPT_LSE_BOS,
  2303. lse_key->mpls_bos);
  2304. if (err)
  2305. return err;
  2306. }
  2307. if (lse_mask->mpls_tc) {
  2308. err = nla_put_u8(skb, TCA_FLOWER_KEY_MPLS_OPT_LSE_TC,
  2309. lse_key->mpls_tc);
  2310. if (err)
  2311. return err;
  2312. }
  2313. if (lse_mask->mpls_label) {
  2314. err = nla_put_u32(skb, TCA_FLOWER_KEY_MPLS_OPT_LSE_LABEL,
  2315. lse_key->mpls_label);
  2316. if (err)
  2317. return err;
  2318. }
  2319. return 0;
  2320. }
  2321. static int fl_dump_key_mpls_opts(struct sk_buff *skb,
  2322. struct flow_dissector_key_mpls *mpls_key,
  2323. struct flow_dissector_key_mpls *mpls_mask)
  2324. {
  2325. struct nlattr *opts;
  2326. struct nlattr *lse;
  2327. u8 lse_index;
  2328. int err;
  2329. opts = nla_nest_start(skb, TCA_FLOWER_KEY_MPLS_OPTS);
  2330. if (!opts)
  2331. return -EMSGSIZE;
  2332. for (lse_index = 0; lse_index < FLOW_DIS_MPLS_MAX; lse_index++) {
  2333. if (!(mpls_mask->used_lses & 1 << lse_index))
  2334. continue;
  2335. lse = nla_nest_start(skb, TCA_FLOWER_KEY_MPLS_OPTS_LSE);
  2336. if (!lse) {
  2337. err = -EMSGSIZE;
  2338. goto err_opts;
  2339. }
  2340. err = fl_dump_key_mpls_opt_lse(skb, mpls_key, mpls_mask,
  2341. lse_index);
  2342. if (err)
  2343. goto err_opts_lse;
  2344. nla_nest_end(skb, lse);
  2345. }
  2346. nla_nest_end(skb, opts);
  2347. return 0;
  2348. err_opts_lse:
  2349. nla_nest_cancel(skb, lse);
  2350. err_opts:
  2351. nla_nest_cancel(skb, opts);
  2352. return err;
  2353. }
  2354. static int fl_dump_key_mpls(struct sk_buff *skb,
  2355. struct flow_dissector_key_mpls *mpls_key,
  2356. struct flow_dissector_key_mpls *mpls_mask)
  2357. {
  2358. struct flow_dissector_mpls_lse *lse_mask;
  2359. struct flow_dissector_mpls_lse *lse_key;
  2360. int err;
  2361. if (!mpls_mask->used_lses)
  2362. return 0;
  2363. lse_mask = &mpls_mask->ls[0];
  2364. lse_key = &mpls_key->ls[0];
  2365. /* For backward compatibility, don't use the MPLS nested attributes if
  2366. * the rule can be expressed using the old attributes.
  2367. */
  2368. if (mpls_mask->used_lses & ~1 ||
  2369. (!lse_mask->mpls_ttl && !lse_mask->mpls_bos &&
  2370. !lse_mask->mpls_tc && !lse_mask->mpls_label))
  2371. return fl_dump_key_mpls_opts(skb, mpls_key, mpls_mask);
  2372. if (lse_mask->mpls_ttl) {
  2373. err = nla_put_u8(skb, TCA_FLOWER_KEY_MPLS_TTL,
  2374. lse_key->mpls_ttl);
  2375. if (err)
  2376. return err;
  2377. }
  2378. if (lse_mask->mpls_tc) {
  2379. err = nla_put_u8(skb, TCA_FLOWER_KEY_MPLS_TC,
  2380. lse_key->mpls_tc);
  2381. if (err)
  2382. return err;
  2383. }
  2384. if (lse_mask->mpls_label) {
  2385. err = nla_put_u32(skb, TCA_FLOWER_KEY_MPLS_LABEL,
  2386. lse_key->mpls_label);
  2387. if (err)
  2388. return err;
  2389. }
  2390. if (lse_mask->mpls_bos) {
  2391. err = nla_put_u8(skb, TCA_FLOWER_KEY_MPLS_BOS,
  2392. lse_key->mpls_bos);
  2393. if (err)
  2394. return err;
  2395. }
  2396. return 0;
  2397. }
  2398. static int fl_dump_key_ip(struct sk_buff *skb, bool encap,
  2399. struct flow_dissector_key_ip *key,
  2400. struct flow_dissector_key_ip *mask)
  2401. {
  2402. int tos_key = encap ? TCA_FLOWER_KEY_ENC_IP_TOS : TCA_FLOWER_KEY_IP_TOS;
  2403. int ttl_key = encap ? TCA_FLOWER_KEY_ENC_IP_TTL : TCA_FLOWER_KEY_IP_TTL;
  2404. int tos_mask = encap ? TCA_FLOWER_KEY_ENC_IP_TOS_MASK : TCA_FLOWER_KEY_IP_TOS_MASK;
  2405. int ttl_mask = encap ? TCA_FLOWER_KEY_ENC_IP_TTL_MASK : TCA_FLOWER_KEY_IP_TTL_MASK;
  2406. if (fl_dump_key_val(skb, &key->tos, tos_key, &mask->tos, tos_mask, sizeof(key->tos)) ||
  2407. fl_dump_key_val(skb, &key->ttl, ttl_key, &mask->ttl, ttl_mask, sizeof(key->ttl)))
  2408. return -1;
  2409. return 0;
  2410. }
  2411. static int fl_dump_key_vlan(struct sk_buff *skb,
  2412. int vlan_id_key, int vlan_prio_key,
  2413. struct flow_dissector_key_vlan *vlan_key,
  2414. struct flow_dissector_key_vlan *vlan_mask)
  2415. {
  2416. int err;
  2417. if (!memchr_inv(vlan_mask, 0, sizeof(*vlan_mask)))
  2418. return 0;
  2419. if (vlan_mask->vlan_id) {
  2420. err = nla_put_u16(skb, vlan_id_key,
  2421. vlan_key->vlan_id);
  2422. if (err)
  2423. return err;
  2424. }
  2425. if (vlan_mask->vlan_priority) {
  2426. err = nla_put_u8(skb, vlan_prio_key,
  2427. vlan_key->vlan_priority);
  2428. if (err)
  2429. return err;
  2430. }
  2431. return 0;
  2432. }
  2433. static void fl_get_key_flag(u32 dissector_key, u32 dissector_mask,
  2434. u32 *flower_key, u32 *flower_mask,
  2435. u32 flower_flag_bit, u32 dissector_flag_bit)
  2436. {
  2437. if (dissector_mask & dissector_flag_bit) {
  2438. *flower_mask |= flower_flag_bit;
  2439. if (dissector_key & dissector_flag_bit)
  2440. *flower_key |= flower_flag_bit;
  2441. }
  2442. }
  2443. static int fl_dump_key_flags(struct sk_buff *skb, u32 flags_key, u32 flags_mask)
  2444. {
  2445. u32 key, mask;
  2446. __be32 _key, _mask;
  2447. int err;
  2448. if (!memchr_inv(&flags_mask, 0, sizeof(flags_mask)))
  2449. return 0;
  2450. key = 0;
  2451. mask = 0;
  2452. fl_get_key_flag(flags_key, flags_mask, &key, &mask,
  2453. TCA_FLOWER_KEY_FLAGS_IS_FRAGMENT, FLOW_DIS_IS_FRAGMENT);
  2454. fl_get_key_flag(flags_key, flags_mask, &key, &mask,
  2455. TCA_FLOWER_KEY_FLAGS_FRAG_IS_FIRST,
  2456. FLOW_DIS_FIRST_FRAG);
  2457. _key = cpu_to_be32(key);
  2458. _mask = cpu_to_be32(mask);
  2459. err = nla_put(skb, TCA_FLOWER_KEY_FLAGS, 4, &_key);
  2460. if (err)
  2461. return err;
  2462. return nla_put(skb, TCA_FLOWER_KEY_FLAGS_MASK, 4, &_mask);
  2463. }
  2464. static int fl_dump_key_geneve_opt(struct sk_buff *skb,
  2465. struct flow_dissector_key_enc_opts *enc_opts)
  2466. {
  2467. struct geneve_opt *opt;
  2468. struct nlattr *nest;
  2469. int opt_off = 0;
  2470. nest = nla_nest_start_noflag(skb, TCA_FLOWER_KEY_ENC_OPTS_GENEVE);
  2471. if (!nest)
  2472. goto nla_put_failure;
  2473. while (enc_opts->len > opt_off) {
  2474. opt = (struct geneve_opt *)&enc_opts->data[opt_off];
  2475. if (nla_put_be16(skb, TCA_FLOWER_KEY_ENC_OPT_GENEVE_CLASS,
  2476. opt->opt_class))
  2477. goto nla_put_failure;
  2478. if (nla_put_u8(skb, TCA_FLOWER_KEY_ENC_OPT_GENEVE_TYPE,
  2479. opt->type))
  2480. goto nla_put_failure;
  2481. if (nla_put(skb, TCA_FLOWER_KEY_ENC_OPT_GENEVE_DATA,
  2482. opt->length * 4, opt->opt_data))
  2483. goto nla_put_failure;
  2484. opt_off += sizeof(struct geneve_opt) + opt->length * 4;
  2485. }
  2486. nla_nest_end(skb, nest);
  2487. return 0;
  2488. nla_put_failure:
  2489. nla_nest_cancel(skb, nest);
  2490. return -EMSGSIZE;
  2491. }
  2492. static int fl_dump_key_vxlan_opt(struct sk_buff *skb,
  2493. struct flow_dissector_key_enc_opts *enc_opts)
  2494. {
  2495. struct vxlan_metadata *md;
  2496. struct nlattr *nest;
  2497. nest = nla_nest_start_noflag(skb, TCA_FLOWER_KEY_ENC_OPTS_VXLAN);
  2498. if (!nest)
  2499. goto nla_put_failure;
  2500. md = (struct vxlan_metadata *)&enc_opts->data[0];
  2501. if (nla_put_u32(skb, TCA_FLOWER_KEY_ENC_OPT_VXLAN_GBP, md->gbp))
  2502. goto nla_put_failure;
  2503. nla_nest_end(skb, nest);
  2504. return 0;
  2505. nla_put_failure:
  2506. nla_nest_cancel(skb, nest);
  2507. return -EMSGSIZE;
  2508. }
  2509. static int fl_dump_key_erspan_opt(struct sk_buff *skb,
  2510. struct flow_dissector_key_enc_opts *enc_opts)
  2511. {
  2512. struct erspan_metadata *md;
  2513. struct nlattr *nest;
  2514. nest = nla_nest_start_noflag(skb, TCA_FLOWER_KEY_ENC_OPTS_ERSPAN);
  2515. if (!nest)
  2516. goto nla_put_failure;
  2517. md = (struct erspan_metadata *)&enc_opts->data[0];
  2518. if (nla_put_u8(skb, TCA_FLOWER_KEY_ENC_OPT_ERSPAN_VER, md->version))
  2519. goto nla_put_failure;
  2520. if (md->version == 1 &&
  2521. nla_put_be32(skb, TCA_FLOWER_KEY_ENC_OPT_ERSPAN_INDEX, md->u.index))
  2522. goto nla_put_failure;
  2523. if (md->version == 2 &&
  2524. (nla_put_u8(skb, TCA_FLOWER_KEY_ENC_OPT_ERSPAN_DIR,
  2525. md->u.md2.dir) ||
  2526. nla_put_u8(skb, TCA_FLOWER_KEY_ENC_OPT_ERSPAN_HWID,
  2527. get_hwid(&md->u.md2))))
  2528. goto nla_put_failure;
  2529. nla_nest_end(skb, nest);
  2530. return 0;
  2531. nla_put_failure:
  2532. nla_nest_cancel(skb, nest);
  2533. return -EMSGSIZE;
  2534. }
  2535. static int fl_dump_key_gtp_opt(struct sk_buff *skb,
  2536. struct flow_dissector_key_enc_opts *enc_opts)
  2537. {
  2538. struct gtp_pdu_session_info *session_info;
  2539. struct nlattr *nest;
  2540. nest = nla_nest_start_noflag(skb, TCA_FLOWER_KEY_ENC_OPTS_GTP);
  2541. if (!nest)
  2542. goto nla_put_failure;
  2543. session_info = (struct gtp_pdu_session_info *)&enc_opts->data[0];
  2544. if (nla_put_u8(skb, TCA_FLOWER_KEY_ENC_OPT_GTP_PDU_TYPE,
  2545. session_info->pdu_type))
  2546. goto nla_put_failure;
  2547. if (nla_put_u8(skb, TCA_FLOWER_KEY_ENC_OPT_GTP_QFI, session_info->qfi))
  2548. goto nla_put_failure;
  2549. nla_nest_end(skb, nest);
  2550. return 0;
  2551. nla_put_failure:
  2552. nla_nest_cancel(skb, nest);
  2553. return -EMSGSIZE;
  2554. }
  2555. static int fl_dump_key_ct(struct sk_buff *skb,
  2556. struct flow_dissector_key_ct *key,
  2557. struct flow_dissector_key_ct *mask)
  2558. {
  2559. if (IS_ENABLED(CONFIG_NF_CONNTRACK) &&
  2560. fl_dump_key_val(skb, &key->ct_state, TCA_FLOWER_KEY_CT_STATE,
  2561. &mask->ct_state, TCA_FLOWER_KEY_CT_STATE_MASK,
  2562. sizeof(key->ct_state)))
  2563. goto nla_put_failure;
  2564. if (IS_ENABLED(CONFIG_NF_CONNTRACK_ZONES) &&
  2565. fl_dump_key_val(skb, &key->ct_zone, TCA_FLOWER_KEY_CT_ZONE,
  2566. &mask->ct_zone, TCA_FLOWER_KEY_CT_ZONE_MASK,
  2567. sizeof(key->ct_zone)))
  2568. goto nla_put_failure;
  2569. if (IS_ENABLED(CONFIG_NF_CONNTRACK_MARK) &&
  2570. fl_dump_key_val(skb, &key->ct_mark, TCA_FLOWER_KEY_CT_MARK,
  2571. &mask->ct_mark, TCA_FLOWER_KEY_CT_MARK_MASK,
  2572. sizeof(key->ct_mark)))
  2573. goto nla_put_failure;
  2574. if (IS_ENABLED(CONFIG_NF_CONNTRACK_LABELS) &&
  2575. fl_dump_key_val(skb, &key->ct_labels, TCA_FLOWER_KEY_CT_LABELS,
  2576. &mask->ct_labels, TCA_FLOWER_KEY_CT_LABELS_MASK,
  2577. sizeof(key->ct_labels)))
  2578. goto nla_put_failure;
  2579. return 0;
  2580. nla_put_failure:
  2581. return -EMSGSIZE;
  2582. }
  2583. static int fl_dump_key_options(struct sk_buff *skb, int enc_opt_type,
  2584. struct flow_dissector_key_enc_opts *enc_opts)
  2585. {
  2586. struct nlattr *nest;
  2587. int err;
  2588. if (!enc_opts->len)
  2589. return 0;
  2590. nest = nla_nest_start_noflag(skb, enc_opt_type);
  2591. if (!nest)
  2592. goto nla_put_failure;
  2593. switch (enc_opts->dst_opt_type) {
  2594. case TUNNEL_GENEVE_OPT:
  2595. err = fl_dump_key_geneve_opt(skb, enc_opts);
  2596. if (err)
  2597. goto nla_put_failure;
  2598. break;
  2599. case TUNNEL_VXLAN_OPT:
  2600. err = fl_dump_key_vxlan_opt(skb, enc_opts);
  2601. if (err)
  2602. goto nla_put_failure;
  2603. break;
  2604. case TUNNEL_ERSPAN_OPT:
  2605. err = fl_dump_key_erspan_opt(skb, enc_opts);
  2606. if (err)
  2607. goto nla_put_failure;
  2608. break;
  2609. case TUNNEL_GTP_OPT:
  2610. err = fl_dump_key_gtp_opt(skb, enc_opts);
  2611. if (err)
  2612. goto nla_put_failure;
  2613. break;
  2614. default:
  2615. goto nla_put_failure;
  2616. }
  2617. nla_nest_end(skb, nest);
  2618. return 0;
  2619. nla_put_failure:
  2620. nla_nest_cancel(skb, nest);
  2621. return -EMSGSIZE;
  2622. }
  2623. static int fl_dump_key_enc_opt(struct sk_buff *skb,
  2624. struct flow_dissector_key_enc_opts *key_opts,
  2625. struct flow_dissector_key_enc_opts *msk_opts)
  2626. {
  2627. int err;
  2628. err = fl_dump_key_options(skb, TCA_FLOWER_KEY_ENC_OPTS, key_opts);
  2629. if (err)
  2630. return err;
  2631. return fl_dump_key_options(skb, TCA_FLOWER_KEY_ENC_OPTS_MASK, msk_opts);
  2632. }
  2633. static int fl_dump_key(struct sk_buff *skb, struct net *net,
  2634. struct fl_flow_key *key, struct fl_flow_key *mask)
  2635. {
  2636. if (mask->meta.ingress_ifindex) {
  2637. struct net_device *dev;
  2638. dev = __dev_get_by_index(net, key->meta.ingress_ifindex);
  2639. if (dev && nla_put_string(skb, TCA_FLOWER_INDEV, dev->name))
  2640. goto nla_put_failure;
  2641. }
  2642. if (fl_dump_key_val(skb, key->eth.dst, TCA_FLOWER_KEY_ETH_DST,
  2643. mask->eth.dst, TCA_FLOWER_KEY_ETH_DST_MASK,
  2644. sizeof(key->eth.dst)) ||
  2645. fl_dump_key_val(skb, key->eth.src, TCA_FLOWER_KEY_ETH_SRC,
  2646. mask->eth.src, TCA_FLOWER_KEY_ETH_SRC_MASK,
  2647. sizeof(key->eth.src)) ||
  2648. fl_dump_key_val(skb, &key->basic.n_proto, TCA_FLOWER_KEY_ETH_TYPE,
  2649. &mask->basic.n_proto, TCA_FLOWER_UNSPEC,
  2650. sizeof(key->basic.n_proto)))
  2651. goto nla_put_failure;
  2652. if (mask->num_of_vlans.num_of_vlans) {
  2653. if (nla_put_u8(skb, TCA_FLOWER_KEY_NUM_OF_VLANS, key->num_of_vlans.num_of_vlans))
  2654. goto nla_put_failure;
  2655. }
  2656. if (fl_dump_key_mpls(skb, &key->mpls, &mask->mpls))
  2657. goto nla_put_failure;
  2658. if (fl_dump_key_vlan(skb, TCA_FLOWER_KEY_VLAN_ID,
  2659. TCA_FLOWER_KEY_VLAN_PRIO, &key->vlan, &mask->vlan))
  2660. goto nla_put_failure;
  2661. if (fl_dump_key_vlan(skb, TCA_FLOWER_KEY_CVLAN_ID,
  2662. TCA_FLOWER_KEY_CVLAN_PRIO,
  2663. &key->cvlan, &mask->cvlan) ||
  2664. (mask->cvlan.vlan_tpid &&
  2665. nla_put_be16(skb, TCA_FLOWER_KEY_VLAN_ETH_TYPE,
  2666. key->cvlan.vlan_tpid)))
  2667. goto nla_put_failure;
  2668. if (mask->basic.n_proto) {
  2669. if (mask->cvlan.vlan_eth_type) {
  2670. if (nla_put_be16(skb, TCA_FLOWER_KEY_CVLAN_ETH_TYPE,
  2671. key->basic.n_proto))
  2672. goto nla_put_failure;
  2673. } else if (mask->vlan.vlan_eth_type) {
  2674. if (nla_put_be16(skb, TCA_FLOWER_KEY_VLAN_ETH_TYPE,
  2675. key->vlan.vlan_eth_type))
  2676. goto nla_put_failure;
  2677. }
  2678. }
  2679. if ((key->basic.n_proto == htons(ETH_P_IP) ||
  2680. key->basic.n_proto == htons(ETH_P_IPV6)) &&
  2681. (fl_dump_key_val(skb, &key->basic.ip_proto, TCA_FLOWER_KEY_IP_PROTO,
  2682. &mask->basic.ip_proto, TCA_FLOWER_UNSPEC,
  2683. sizeof(key->basic.ip_proto)) ||
  2684. fl_dump_key_ip(skb, false, &key->ip, &mask->ip)))
  2685. goto nla_put_failure;
  2686. if (mask->pppoe.session_id) {
  2687. if (nla_put_be16(skb, TCA_FLOWER_KEY_PPPOE_SID,
  2688. key->pppoe.session_id))
  2689. goto nla_put_failure;
  2690. }
  2691. if (mask->basic.n_proto && mask->pppoe.ppp_proto) {
  2692. if (nla_put_be16(skb, TCA_FLOWER_KEY_PPP_PROTO,
  2693. key->pppoe.ppp_proto))
  2694. goto nla_put_failure;
  2695. }
  2696. if (key->control.addr_type == FLOW_DISSECTOR_KEY_IPV4_ADDRS &&
  2697. (fl_dump_key_val(skb, &key->ipv4.src, TCA_FLOWER_KEY_IPV4_SRC,
  2698. &mask->ipv4.src, TCA_FLOWER_KEY_IPV4_SRC_MASK,
  2699. sizeof(key->ipv4.src)) ||
  2700. fl_dump_key_val(skb, &key->ipv4.dst, TCA_FLOWER_KEY_IPV4_DST,
  2701. &mask->ipv4.dst, TCA_FLOWER_KEY_IPV4_DST_MASK,
  2702. sizeof(key->ipv4.dst))))
  2703. goto nla_put_failure;
  2704. else if (key->control.addr_type == FLOW_DISSECTOR_KEY_IPV6_ADDRS &&
  2705. (fl_dump_key_val(skb, &key->ipv6.src, TCA_FLOWER_KEY_IPV6_SRC,
  2706. &mask->ipv6.src, TCA_FLOWER_KEY_IPV6_SRC_MASK,
  2707. sizeof(key->ipv6.src)) ||
  2708. fl_dump_key_val(skb, &key->ipv6.dst, TCA_FLOWER_KEY_IPV6_DST,
  2709. &mask->ipv6.dst, TCA_FLOWER_KEY_IPV6_DST_MASK,
  2710. sizeof(key->ipv6.dst))))
  2711. goto nla_put_failure;
  2712. if (key->basic.ip_proto == IPPROTO_TCP &&
  2713. (fl_dump_key_val(skb, &key->tp.src, TCA_FLOWER_KEY_TCP_SRC,
  2714. &mask->tp.src, TCA_FLOWER_KEY_TCP_SRC_MASK,
  2715. sizeof(key->tp.src)) ||
  2716. fl_dump_key_val(skb, &key->tp.dst, TCA_FLOWER_KEY_TCP_DST,
  2717. &mask->tp.dst, TCA_FLOWER_KEY_TCP_DST_MASK,
  2718. sizeof(key->tp.dst)) ||
  2719. fl_dump_key_val(skb, &key->tcp.flags, TCA_FLOWER_KEY_TCP_FLAGS,
  2720. &mask->tcp.flags, TCA_FLOWER_KEY_TCP_FLAGS_MASK,
  2721. sizeof(key->tcp.flags))))
  2722. goto nla_put_failure;
  2723. else if (key->basic.ip_proto == IPPROTO_UDP &&
  2724. (fl_dump_key_val(skb, &key->tp.src, TCA_FLOWER_KEY_UDP_SRC,
  2725. &mask->tp.src, TCA_FLOWER_KEY_UDP_SRC_MASK,
  2726. sizeof(key->tp.src)) ||
  2727. fl_dump_key_val(skb, &key->tp.dst, TCA_FLOWER_KEY_UDP_DST,
  2728. &mask->tp.dst, TCA_FLOWER_KEY_UDP_DST_MASK,
  2729. sizeof(key->tp.dst))))
  2730. goto nla_put_failure;
  2731. else if (key->basic.ip_proto == IPPROTO_SCTP &&
  2732. (fl_dump_key_val(skb, &key->tp.src, TCA_FLOWER_KEY_SCTP_SRC,
  2733. &mask->tp.src, TCA_FLOWER_KEY_SCTP_SRC_MASK,
  2734. sizeof(key->tp.src)) ||
  2735. fl_dump_key_val(skb, &key->tp.dst, TCA_FLOWER_KEY_SCTP_DST,
  2736. &mask->tp.dst, TCA_FLOWER_KEY_SCTP_DST_MASK,
  2737. sizeof(key->tp.dst))))
  2738. goto nla_put_failure;
  2739. else if (key->basic.n_proto == htons(ETH_P_IP) &&
  2740. key->basic.ip_proto == IPPROTO_ICMP &&
  2741. (fl_dump_key_val(skb, &key->icmp.type,
  2742. TCA_FLOWER_KEY_ICMPV4_TYPE, &mask->icmp.type,
  2743. TCA_FLOWER_KEY_ICMPV4_TYPE_MASK,
  2744. sizeof(key->icmp.type)) ||
  2745. fl_dump_key_val(skb, &key->icmp.code,
  2746. TCA_FLOWER_KEY_ICMPV4_CODE, &mask->icmp.code,
  2747. TCA_FLOWER_KEY_ICMPV4_CODE_MASK,
  2748. sizeof(key->icmp.code))))
  2749. goto nla_put_failure;
  2750. else if (key->basic.n_proto == htons(ETH_P_IPV6) &&
  2751. key->basic.ip_proto == IPPROTO_ICMPV6 &&
  2752. (fl_dump_key_val(skb, &key->icmp.type,
  2753. TCA_FLOWER_KEY_ICMPV6_TYPE, &mask->icmp.type,
  2754. TCA_FLOWER_KEY_ICMPV6_TYPE_MASK,
  2755. sizeof(key->icmp.type)) ||
  2756. fl_dump_key_val(skb, &key->icmp.code,
  2757. TCA_FLOWER_KEY_ICMPV6_CODE, &mask->icmp.code,
  2758. TCA_FLOWER_KEY_ICMPV6_CODE_MASK,
  2759. sizeof(key->icmp.code))))
  2760. goto nla_put_failure;
  2761. else if ((key->basic.n_proto == htons(ETH_P_ARP) ||
  2762. key->basic.n_proto == htons(ETH_P_RARP)) &&
  2763. (fl_dump_key_val(skb, &key->arp.sip,
  2764. TCA_FLOWER_KEY_ARP_SIP, &mask->arp.sip,
  2765. TCA_FLOWER_KEY_ARP_SIP_MASK,
  2766. sizeof(key->arp.sip)) ||
  2767. fl_dump_key_val(skb, &key->arp.tip,
  2768. TCA_FLOWER_KEY_ARP_TIP, &mask->arp.tip,
  2769. TCA_FLOWER_KEY_ARP_TIP_MASK,
  2770. sizeof(key->arp.tip)) ||
  2771. fl_dump_key_val(skb, &key->arp.op,
  2772. TCA_FLOWER_KEY_ARP_OP, &mask->arp.op,
  2773. TCA_FLOWER_KEY_ARP_OP_MASK,
  2774. sizeof(key->arp.op)) ||
  2775. fl_dump_key_val(skb, key->arp.sha, TCA_FLOWER_KEY_ARP_SHA,
  2776. mask->arp.sha, TCA_FLOWER_KEY_ARP_SHA_MASK,
  2777. sizeof(key->arp.sha)) ||
  2778. fl_dump_key_val(skb, key->arp.tha, TCA_FLOWER_KEY_ARP_THA,
  2779. mask->arp.tha, TCA_FLOWER_KEY_ARP_THA_MASK,
  2780. sizeof(key->arp.tha))))
  2781. goto nla_put_failure;
  2782. else if (key->basic.ip_proto == IPPROTO_L2TP &&
  2783. fl_dump_key_val(skb, &key->l2tpv3.session_id,
  2784. TCA_FLOWER_KEY_L2TPV3_SID,
  2785. &mask->l2tpv3.session_id,
  2786. TCA_FLOWER_UNSPEC,
  2787. sizeof(key->l2tpv3.session_id)))
  2788. goto nla_put_failure;
  2789. if ((key->basic.ip_proto == IPPROTO_TCP ||
  2790. key->basic.ip_proto == IPPROTO_UDP ||
  2791. key->basic.ip_proto == IPPROTO_SCTP) &&
  2792. fl_dump_key_port_range(skb, key, mask))
  2793. goto nla_put_failure;
  2794. if (key->enc_control.addr_type == FLOW_DISSECTOR_KEY_IPV4_ADDRS &&
  2795. (fl_dump_key_val(skb, &key->enc_ipv4.src,
  2796. TCA_FLOWER_KEY_ENC_IPV4_SRC, &mask->enc_ipv4.src,
  2797. TCA_FLOWER_KEY_ENC_IPV4_SRC_MASK,
  2798. sizeof(key->enc_ipv4.src)) ||
  2799. fl_dump_key_val(skb, &key->enc_ipv4.dst,
  2800. TCA_FLOWER_KEY_ENC_IPV4_DST, &mask->enc_ipv4.dst,
  2801. TCA_FLOWER_KEY_ENC_IPV4_DST_MASK,
  2802. sizeof(key->enc_ipv4.dst))))
  2803. goto nla_put_failure;
  2804. else if (key->enc_control.addr_type == FLOW_DISSECTOR_KEY_IPV6_ADDRS &&
  2805. (fl_dump_key_val(skb, &key->enc_ipv6.src,
  2806. TCA_FLOWER_KEY_ENC_IPV6_SRC, &mask->enc_ipv6.src,
  2807. TCA_FLOWER_KEY_ENC_IPV6_SRC_MASK,
  2808. sizeof(key->enc_ipv6.src)) ||
  2809. fl_dump_key_val(skb, &key->enc_ipv6.dst,
  2810. TCA_FLOWER_KEY_ENC_IPV6_DST,
  2811. &mask->enc_ipv6.dst,
  2812. TCA_FLOWER_KEY_ENC_IPV6_DST_MASK,
  2813. sizeof(key->enc_ipv6.dst))))
  2814. goto nla_put_failure;
  2815. if (fl_dump_key_val(skb, &key->enc_key_id, TCA_FLOWER_KEY_ENC_KEY_ID,
  2816. &mask->enc_key_id, TCA_FLOWER_UNSPEC,
  2817. sizeof(key->enc_key_id)) ||
  2818. fl_dump_key_val(skb, &key->enc_tp.src,
  2819. TCA_FLOWER_KEY_ENC_UDP_SRC_PORT,
  2820. &mask->enc_tp.src,
  2821. TCA_FLOWER_KEY_ENC_UDP_SRC_PORT_MASK,
  2822. sizeof(key->enc_tp.src)) ||
  2823. fl_dump_key_val(skb, &key->enc_tp.dst,
  2824. TCA_FLOWER_KEY_ENC_UDP_DST_PORT,
  2825. &mask->enc_tp.dst,
  2826. TCA_FLOWER_KEY_ENC_UDP_DST_PORT_MASK,
  2827. sizeof(key->enc_tp.dst)) ||
  2828. fl_dump_key_ip(skb, true, &key->enc_ip, &mask->enc_ip) ||
  2829. fl_dump_key_enc_opt(skb, &key->enc_opts, &mask->enc_opts))
  2830. goto nla_put_failure;
  2831. if (fl_dump_key_ct(skb, &key->ct, &mask->ct))
  2832. goto nla_put_failure;
  2833. if (fl_dump_key_flags(skb, key->control.flags, mask->control.flags))
  2834. goto nla_put_failure;
  2835. if (fl_dump_key_val(skb, &key->hash.hash, TCA_FLOWER_KEY_HASH,
  2836. &mask->hash.hash, TCA_FLOWER_KEY_HASH_MASK,
  2837. sizeof(key->hash.hash)))
  2838. goto nla_put_failure;
  2839. return 0;
  2840. nla_put_failure:
  2841. return -EMSGSIZE;
  2842. }
  2843. static int fl_dump(struct net *net, struct tcf_proto *tp, void *fh,
  2844. struct sk_buff *skb, struct tcmsg *t, bool rtnl_held)
  2845. {
  2846. struct cls_fl_filter *f = fh;
  2847. struct nlattr *nest;
  2848. struct fl_flow_key *key, *mask;
  2849. bool skip_hw;
  2850. if (!f)
  2851. return skb->len;
  2852. t->tcm_handle = f->handle;
  2853. nest = nla_nest_start_noflag(skb, TCA_OPTIONS);
  2854. if (!nest)
  2855. goto nla_put_failure;
  2856. spin_lock(&tp->lock);
  2857. if (f->res.classid &&
  2858. nla_put_u32(skb, TCA_FLOWER_CLASSID, f->res.classid))
  2859. goto nla_put_failure_locked;
  2860. key = &f->key;
  2861. mask = &f->mask->key;
  2862. skip_hw = tc_skip_hw(f->flags);
  2863. if (fl_dump_key(skb, net, key, mask))
  2864. goto nla_put_failure_locked;
  2865. if (f->flags && nla_put_u32(skb, TCA_FLOWER_FLAGS, f->flags))
  2866. goto nla_put_failure_locked;
  2867. spin_unlock(&tp->lock);
  2868. if (!skip_hw)
  2869. fl_hw_update_stats(tp, f, rtnl_held);
  2870. if (nla_put_u32(skb, TCA_FLOWER_IN_HW_COUNT, f->in_hw_count))
  2871. goto nla_put_failure;
  2872. if (tcf_exts_dump(skb, &f->exts))
  2873. goto nla_put_failure;
  2874. nla_nest_end(skb, nest);
  2875. if (tcf_exts_dump_stats(skb, &f->exts) < 0)
  2876. goto nla_put_failure;
  2877. return skb->len;
  2878. nla_put_failure_locked:
  2879. spin_unlock(&tp->lock);
  2880. nla_put_failure:
  2881. nla_nest_cancel(skb, nest);
  2882. return -1;
  2883. }
  2884. static int fl_terse_dump(struct net *net, struct tcf_proto *tp, void *fh,
  2885. struct sk_buff *skb, struct tcmsg *t, bool rtnl_held)
  2886. {
  2887. struct cls_fl_filter *f = fh;
  2888. struct nlattr *nest;
  2889. bool skip_hw;
  2890. if (!f)
  2891. return skb->len;
  2892. t->tcm_handle = f->handle;
  2893. nest = nla_nest_start_noflag(skb, TCA_OPTIONS);
  2894. if (!nest)
  2895. goto nla_put_failure;
  2896. spin_lock(&tp->lock);
  2897. skip_hw = tc_skip_hw(f->flags);
  2898. if (f->flags && nla_put_u32(skb, TCA_FLOWER_FLAGS, f->flags))
  2899. goto nla_put_failure_locked;
  2900. spin_unlock(&tp->lock);
  2901. if (!skip_hw)
  2902. fl_hw_update_stats(tp, f, rtnl_held);
  2903. if (tcf_exts_terse_dump(skb, &f->exts))
  2904. goto nla_put_failure;
  2905. nla_nest_end(skb, nest);
  2906. return skb->len;
  2907. nla_put_failure_locked:
  2908. spin_unlock(&tp->lock);
  2909. nla_put_failure:
  2910. nla_nest_cancel(skb, nest);
  2911. return -1;
  2912. }
  2913. static int fl_tmplt_dump(struct sk_buff *skb, struct net *net, void *tmplt_priv)
  2914. {
  2915. struct fl_flow_tmplt *tmplt = tmplt_priv;
  2916. struct fl_flow_key *key, *mask;
  2917. struct nlattr *nest;
  2918. nest = nla_nest_start_noflag(skb, TCA_OPTIONS);
  2919. if (!nest)
  2920. goto nla_put_failure;
  2921. key = &tmplt->dummy_key;
  2922. mask = &tmplt->mask;
  2923. if (fl_dump_key(skb, net, key, mask))
  2924. goto nla_put_failure;
  2925. nla_nest_end(skb, nest);
  2926. return skb->len;
  2927. nla_put_failure:
  2928. nla_nest_cancel(skb, nest);
  2929. return -EMSGSIZE;
  2930. }
  2931. static void fl_bind_class(void *fh, u32 classid, unsigned long cl, void *q,
  2932. unsigned long base)
  2933. {
  2934. struct cls_fl_filter *f = fh;
  2935. tc_cls_bind_class(classid, cl, q, &f->res, base);
  2936. }
  2937. static bool fl_delete_empty(struct tcf_proto *tp)
  2938. {
  2939. struct cls_fl_head *head = fl_head_dereference(tp);
  2940. spin_lock(&tp->lock);
  2941. tp->deleting = idr_is_empty(&head->handle_idr);
  2942. spin_unlock(&tp->lock);
  2943. return tp->deleting;
  2944. }
  2945. static struct tcf_proto_ops cls_fl_ops __read_mostly = {
  2946. .kind = "flower",
  2947. .classify = fl_classify,
  2948. .init = fl_init,
  2949. .destroy = fl_destroy,
  2950. .get = fl_get,
  2951. .put = fl_put,
  2952. .change = fl_change,
  2953. .delete = fl_delete,
  2954. .delete_empty = fl_delete_empty,
  2955. .walk = fl_walk,
  2956. .reoffload = fl_reoffload,
  2957. .hw_add = fl_hw_add,
  2958. .hw_del = fl_hw_del,
  2959. .dump = fl_dump,
  2960. .terse_dump = fl_terse_dump,
  2961. .bind_class = fl_bind_class,
  2962. .tmplt_create = fl_tmplt_create,
  2963. .tmplt_destroy = fl_tmplt_destroy,
  2964. .tmplt_dump = fl_tmplt_dump,
  2965. .owner = THIS_MODULE,
  2966. .flags = TCF_PROTO_OPS_DOIT_UNLOCKED,
  2967. };
  2968. static int __init cls_fl_init(void)
  2969. {
  2970. return register_tcf_proto_ops(&cls_fl_ops);
  2971. }
  2972. static void __exit cls_fl_exit(void)
  2973. {
  2974. unregister_tcf_proto_ops(&cls_fl_ops);
  2975. }
  2976. module_init(cls_fl_init);
  2977. module_exit(cls_fl_exit);
  2978. MODULE_AUTHOR("Jiri Pirko <[email protected]>");
  2979. MODULE_DESCRIPTION("Flower classifier");
  2980. MODULE_LICENSE("GPL v2");