em_meta.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855
  1. /*
  2. * net/sched/em_meta.c Metadata ematch
  3. *
  4. * This program is free software; you can redistribute it and/or
  5. * modify it under the terms of the GNU General Public License
  6. * as published by the Free Software Foundation; either version
  7. * 2 of the License, or (at your option) any later version.
  8. *
  9. * Authors: Thomas Graf <tgraf@suug.ch>
  10. *
  11. * ==========================================================================
  12. *
  13. * The metadata ematch compares two meta objects where each object
  14. * represents either a meta value stored in the kernel or a static
  15. * value provided by userspace. The objects are not provided by
  16. * userspace itself but rather a definition providing the information
  17. * to build them. Every object is of a certain type which must be
  18. * equal to the object it is being compared to.
  19. *
  20. * The definition of a objects conists of the type (meta type), a
  21. * identifier (meta id) and additional type specific information.
  22. * The meta id is either TCF_META_TYPE_VALUE for values provided by
  23. * userspace or a index to the meta operations table consisting of
  24. * function pointers to type specific meta data collectors returning
  25. * the value of the requested meta value.
  26. *
  27. * lvalue rvalue
  28. * +-----------+ +-----------+
  29. * | type: INT | | type: INT |
  30. * def | id: DEV | | id: VALUE |
  31. * | data: | | data: 3 |
  32. * +-----------+ +-----------+
  33. * | |
  34. * ---> meta_ops[INT][DEV](...) |
  35. * | |
  36. * ----------- |
  37. * V V
  38. * +-----------+ +-----------+
  39. * | type: INT | | type: INT |
  40. * obj | id: DEV | | id: VALUE |
  41. * | data: 2 |<--data got filled out | data: 3 |
  42. * +-----------+ +-----------+
  43. * | |
  44. * --------------> 2 equals 3 <--------------
  45. *
  46. * This is a simplified schema, the complexity varies depending
  47. * on the meta type. Obviously, the length of the data must also
  48. * be provided for non-numeric types.
  49. *
  50. * Additionaly, type dependant modifiers such as shift operators
  51. * or mask may be applied to extend the functionaliy. As of now,
  52. * the variable length type supports shifting the byte string to
  53. * the right, eating up any number of octets and thus supporting
  54. * wildcard interface name comparisons such as "ppp%" matching
  55. * ppp0..9.
  56. *
  57. * NOTE: Certain meta values depend on other subsystems and are
  58. * only available if that subsytem is enabled in the kernel.
  59. */
  60. #include <linux/module.h>
  61. #include <linux/types.h>
  62. #include <linux/kernel.h>
  63. #include <linux/sched.h>
  64. #include <linux/string.h>
  65. #include <linux/skbuff.h>
  66. #include <linux/random.h>
  67. #include <linux/tc_ematch/tc_em_meta.h>
  68. #include <net/dst.h>
  69. #include <net/route.h>
  70. #include <net/pkt_cls.h>
  71. #include <net/sock.h>
  72. struct meta_obj
  73. {
  74. unsigned long value;
  75. unsigned int len;
  76. };
  77. struct meta_value
  78. {
  79. struct tcf_meta_val hdr;
  80. unsigned long val;
  81. unsigned int len;
  82. };
  83. struct meta_match
  84. {
  85. struct meta_value lvalue;
  86. struct meta_value rvalue;
  87. };
  88. static inline int meta_id(struct meta_value *v)
  89. {
  90. return TCF_META_ID(v->hdr.kind);
  91. }
  92. static inline int meta_type(struct meta_value *v)
  93. {
  94. return TCF_META_TYPE(v->hdr.kind);
  95. }
  96. #define META_COLLECTOR(FUNC) static void meta_##FUNC(struct sk_buff *skb, \
  97. struct tcf_pkt_info *info, struct meta_value *v, \
  98. struct meta_obj *dst, int *err)
  99. /**************************************************************************
  100. * System status & misc
  101. **************************************************************************/
  102. META_COLLECTOR(int_random)
  103. {
  104. get_random_bytes(&dst->value, sizeof(dst->value));
  105. }
  106. static inline unsigned long fixed_loadavg(int load)
  107. {
  108. int rnd_load = load + (FIXED_1/200);
  109. int rnd_frac = ((rnd_load & (FIXED_1-1)) * 100) >> FSHIFT;
  110. return ((rnd_load >> FSHIFT) * 100) + rnd_frac;
  111. }
  112. META_COLLECTOR(int_loadavg_0)
  113. {
  114. dst->value = fixed_loadavg(avenrun[0]);
  115. }
  116. META_COLLECTOR(int_loadavg_1)
  117. {
  118. dst->value = fixed_loadavg(avenrun[1]);
  119. }
  120. META_COLLECTOR(int_loadavg_2)
  121. {
  122. dst->value = fixed_loadavg(avenrun[2]);
  123. }
  124. /**************************************************************************
  125. * Device names & indices
  126. **************************************************************************/
  127. static inline int int_dev(struct net_device *dev, struct meta_obj *dst)
  128. {
  129. if (unlikely(dev == NULL))
  130. return -1;
  131. dst->value = dev->ifindex;
  132. return 0;
  133. }
  134. static inline int var_dev(struct net_device *dev, struct meta_obj *dst)
  135. {
  136. if (unlikely(dev == NULL))
  137. return -1;
  138. dst->value = (unsigned long) dev->name;
  139. dst->len = strlen(dev->name);
  140. return 0;
  141. }
  142. META_COLLECTOR(int_dev)
  143. {
  144. *err = int_dev(skb->dev, dst);
  145. }
  146. META_COLLECTOR(var_dev)
  147. {
  148. *err = var_dev(skb->dev, dst);
  149. }
  150. /**************************************************************************
  151. * skb attributes
  152. **************************************************************************/
  153. META_COLLECTOR(int_priority)
  154. {
  155. dst->value = skb->priority;
  156. }
  157. META_COLLECTOR(int_protocol)
  158. {
  159. /* Let userspace take care of the byte ordering */
  160. dst->value = skb->protocol;
  161. }
  162. META_COLLECTOR(int_pkttype)
  163. {
  164. dst->value = skb->pkt_type;
  165. }
  166. META_COLLECTOR(int_pktlen)
  167. {
  168. dst->value = skb->len;
  169. }
  170. META_COLLECTOR(int_datalen)
  171. {
  172. dst->value = skb->data_len;
  173. }
  174. META_COLLECTOR(int_maclen)
  175. {
  176. dst->value = skb->mac_len;
  177. }
  178. /**************************************************************************
  179. * Netfilter
  180. **************************************************************************/
  181. META_COLLECTOR(int_nfmark)
  182. {
  183. #ifdef CONFIG_NETFILTER
  184. dst->value = skb->nfmark;
  185. #else
  186. dst->value = 0;
  187. #endif
  188. }
  189. /**************************************************************************
  190. * Traffic Control
  191. **************************************************************************/
  192. META_COLLECTOR(int_tcindex)
  193. {
  194. dst->value = skb->tc_index;
  195. }
  196. /**************************************************************************
  197. * Routing
  198. **************************************************************************/
  199. META_COLLECTOR(int_rtclassid)
  200. {
  201. if (unlikely(skb->dst == NULL))
  202. *err = -1;
  203. else
  204. #ifdef CONFIG_NET_CLS_ROUTE
  205. dst->value = skb->dst->tclassid;
  206. #else
  207. dst->value = 0;
  208. #endif
  209. }
  210. META_COLLECTOR(int_rtiif)
  211. {
  212. if (unlikely(skb->dst == NULL))
  213. *err = -1;
  214. else
  215. dst->value = ((struct rtable*) skb->dst)->fl.iif;
  216. }
  217. /**************************************************************************
  218. * Socket Attributes
  219. **************************************************************************/
  220. #define SKIP_NONLOCAL(skb) \
  221. if (unlikely(skb->sk == NULL)) { \
  222. *err = -1; \
  223. return; \
  224. }
  225. META_COLLECTOR(int_sk_family)
  226. {
  227. SKIP_NONLOCAL(skb);
  228. dst->value = skb->sk->sk_family;
  229. }
  230. META_COLLECTOR(int_sk_state)
  231. {
  232. SKIP_NONLOCAL(skb);
  233. dst->value = skb->sk->sk_state;
  234. }
  235. META_COLLECTOR(int_sk_reuse)
  236. {
  237. SKIP_NONLOCAL(skb);
  238. dst->value = skb->sk->sk_reuse;
  239. }
  240. META_COLLECTOR(int_sk_bound_if)
  241. {
  242. SKIP_NONLOCAL(skb);
  243. /* No error if bound_dev_if is 0, legal userspace check */
  244. dst->value = skb->sk->sk_bound_dev_if;
  245. }
  246. META_COLLECTOR(var_sk_bound_if)
  247. {
  248. SKIP_NONLOCAL(skb);
  249. if (skb->sk->sk_bound_dev_if == 0) {
  250. dst->value = (unsigned long) "any";
  251. dst->len = 3;
  252. } else {
  253. struct net_device *dev;
  254. dev = dev_get_by_index(skb->sk->sk_bound_dev_if);
  255. *err = var_dev(dev, dst);
  256. if (dev)
  257. dev_put(dev);
  258. }
  259. }
  260. META_COLLECTOR(int_sk_refcnt)
  261. {
  262. SKIP_NONLOCAL(skb);
  263. dst->value = atomic_read(&skb->sk->sk_refcnt);
  264. }
  265. META_COLLECTOR(int_sk_rcvbuf)
  266. {
  267. SKIP_NONLOCAL(skb);
  268. dst->value = skb->sk->sk_rcvbuf;
  269. }
  270. META_COLLECTOR(int_sk_shutdown)
  271. {
  272. SKIP_NONLOCAL(skb);
  273. dst->value = skb->sk->sk_shutdown;
  274. }
  275. META_COLLECTOR(int_sk_proto)
  276. {
  277. SKIP_NONLOCAL(skb);
  278. dst->value = skb->sk->sk_protocol;
  279. }
  280. META_COLLECTOR(int_sk_type)
  281. {
  282. SKIP_NONLOCAL(skb);
  283. dst->value = skb->sk->sk_type;
  284. }
  285. META_COLLECTOR(int_sk_rmem_alloc)
  286. {
  287. SKIP_NONLOCAL(skb);
  288. dst->value = atomic_read(&skb->sk->sk_rmem_alloc);
  289. }
  290. META_COLLECTOR(int_sk_wmem_alloc)
  291. {
  292. SKIP_NONLOCAL(skb);
  293. dst->value = atomic_read(&skb->sk->sk_wmem_alloc);
  294. }
  295. META_COLLECTOR(int_sk_omem_alloc)
  296. {
  297. SKIP_NONLOCAL(skb);
  298. dst->value = atomic_read(&skb->sk->sk_omem_alloc);
  299. }
  300. META_COLLECTOR(int_sk_rcv_qlen)
  301. {
  302. SKIP_NONLOCAL(skb);
  303. dst->value = skb->sk->sk_receive_queue.qlen;
  304. }
  305. META_COLLECTOR(int_sk_snd_qlen)
  306. {
  307. SKIP_NONLOCAL(skb);
  308. dst->value = skb->sk->sk_write_queue.qlen;
  309. }
  310. META_COLLECTOR(int_sk_wmem_queued)
  311. {
  312. SKIP_NONLOCAL(skb);
  313. dst->value = skb->sk->sk_wmem_queued;
  314. }
  315. META_COLLECTOR(int_sk_fwd_alloc)
  316. {
  317. SKIP_NONLOCAL(skb);
  318. dst->value = skb->sk->sk_forward_alloc;
  319. }
  320. META_COLLECTOR(int_sk_sndbuf)
  321. {
  322. SKIP_NONLOCAL(skb);
  323. dst->value = skb->sk->sk_sndbuf;
  324. }
  325. META_COLLECTOR(int_sk_alloc)
  326. {
  327. SKIP_NONLOCAL(skb);
  328. dst->value = skb->sk->sk_allocation;
  329. }
  330. META_COLLECTOR(int_sk_route_caps)
  331. {
  332. SKIP_NONLOCAL(skb);
  333. dst->value = skb->sk->sk_route_caps;
  334. }
  335. META_COLLECTOR(int_sk_hash)
  336. {
  337. SKIP_NONLOCAL(skb);
  338. dst->value = skb->sk->sk_hash;
  339. }
  340. META_COLLECTOR(int_sk_lingertime)
  341. {
  342. SKIP_NONLOCAL(skb);
  343. dst->value = skb->sk->sk_lingertime / HZ;
  344. }
  345. META_COLLECTOR(int_sk_err_qlen)
  346. {
  347. SKIP_NONLOCAL(skb);
  348. dst->value = skb->sk->sk_error_queue.qlen;
  349. }
  350. META_COLLECTOR(int_sk_ack_bl)
  351. {
  352. SKIP_NONLOCAL(skb);
  353. dst->value = skb->sk->sk_ack_backlog;
  354. }
  355. META_COLLECTOR(int_sk_max_ack_bl)
  356. {
  357. SKIP_NONLOCAL(skb);
  358. dst->value = skb->sk->sk_max_ack_backlog;
  359. }
  360. META_COLLECTOR(int_sk_prio)
  361. {
  362. SKIP_NONLOCAL(skb);
  363. dst->value = skb->sk->sk_priority;
  364. }
  365. META_COLLECTOR(int_sk_rcvlowat)
  366. {
  367. SKIP_NONLOCAL(skb);
  368. dst->value = skb->sk->sk_rcvlowat;
  369. }
  370. META_COLLECTOR(int_sk_rcvtimeo)
  371. {
  372. SKIP_NONLOCAL(skb);
  373. dst->value = skb->sk->sk_rcvtimeo / HZ;
  374. }
  375. META_COLLECTOR(int_sk_sndtimeo)
  376. {
  377. SKIP_NONLOCAL(skb);
  378. dst->value = skb->sk->sk_sndtimeo / HZ;
  379. }
  380. META_COLLECTOR(int_sk_sendmsg_off)
  381. {
  382. SKIP_NONLOCAL(skb);
  383. dst->value = skb->sk->sk_sndmsg_off;
  384. }
  385. META_COLLECTOR(int_sk_write_pend)
  386. {
  387. SKIP_NONLOCAL(skb);
  388. dst->value = skb->sk->sk_write_pending;
  389. }
  390. /**************************************************************************
  391. * Meta value collectors assignment table
  392. **************************************************************************/
  393. struct meta_ops
  394. {
  395. void (*get)(struct sk_buff *, struct tcf_pkt_info *,
  396. struct meta_value *, struct meta_obj *, int *);
  397. };
  398. #define META_ID(name) TCF_META_ID_##name
  399. #define META_FUNC(name) { .get = meta_##name }
  400. /* Meta value operations table listing all meta value collectors and
  401. * assigns them to a type and meta id. */
  402. static struct meta_ops __meta_ops[TCF_META_TYPE_MAX+1][TCF_META_ID_MAX+1] = {
  403. [TCF_META_TYPE_VAR] = {
  404. [META_ID(DEV)] = META_FUNC(var_dev),
  405. [META_ID(SK_BOUND_IF)] = META_FUNC(var_sk_bound_if),
  406. },
  407. [TCF_META_TYPE_INT] = {
  408. [META_ID(RANDOM)] = META_FUNC(int_random),
  409. [META_ID(LOADAVG_0)] = META_FUNC(int_loadavg_0),
  410. [META_ID(LOADAVG_1)] = META_FUNC(int_loadavg_1),
  411. [META_ID(LOADAVG_2)] = META_FUNC(int_loadavg_2),
  412. [META_ID(DEV)] = META_FUNC(int_dev),
  413. [META_ID(PRIORITY)] = META_FUNC(int_priority),
  414. [META_ID(PROTOCOL)] = META_FUNC(int_protocol),
  415. [META_ID(PKTTYPE)] = META_FUNC(int_pkttype),
  416. [META_ID(PKTLEN)] = META_FUNC(int_pktlen),
  417. [META_ID(DATALEN)] = META_FUNC(int_datalen),
  418. [META_ID(MACLEN)] = META_FUNC(int_maclen),
  419. [META_ID(NFMARK)] = META_FUNC(int_nfmark),
  420. [META_ID(TCINDEX)] = META_FUNC(int_tcindex),
  421. [META_ID(RTCLASSID)] = META_FUNC(int_rtclassid),
  422. [META_ID(RTIIF)] = META_FUNC(int_rtiif),
  423. [META_ID(SK_FAMILY)] = META_FUNC(int_sk_family),
  424. [META_ID(SK_STATE)] = META_FUNC(int_sk_state),
  425. [META_ID(SK_REUSE)] = META_FUNC(int_sk_reuse),
  426. [META_ID(SK_BOUND_IF)] = META_FUNC(int_sk_bound_if),
  427. [META_ID(SK_REFCNT)] = META_FUNC(int_sk_refcnt),
  428. [META_ID(SK_RCVBUF)] = META_FUNC(int_sk_rcvbuf),
  429. [META_ID(SK_SNDBUF)] = META_FUNC(int_sk_sndbuf),
  430. [META_ID(SK_SHUTDOWN)] = META_FUNC(int_sk_shutdown),
  431. [META_ID(SK_PROTO)] = META_FUNC(int_sk_proto),
  432. [META_ID(SK_TYPE)] = META_FUNC(int_sk_type),
  433. [META_ID(SK_RMEM_ALLOC)] = META_FUNC(int_sk_rmem_alloc),
  434. [META_ID(SK_WMEM_ALLOC)] = META_FUNC(int_sk_wmem_alloc),
  435. [META_ID(SK_OMEM_ALLOC)] = META_FUNC(int_sk_omem_alloc),
  436. [META_ID(SK_WMEM_QUEUED)] = META_FUNC(int_sk_wmem_queued),
  437. [META_ID(SK_RCV_QLEN)] = META_FUNC(int_sk_rcv_qlen),
  438. [META_ID(SK_SND_QLEN)] = META_FUNC(int_sk_snd_qlen),
  439. [META_ID(SK_ERR_QLEN)] = META_FUNC(int_sk_err_qlen),
  440. [META_ID(SK_FORWARD_ALLOCS)] = META_FUNC(int_sk_fwd_alloc),
  441. [META_ID(SK_ALLOCS)] = META_FUNC(int_sk_alloc),
  442. [META_ID(SK_ROUTE_CAPS)] = META_FUNC(int_sk_route_caps),
  443. [META_ID(SK_HASH)] = META_FUNC(int_sk_hash),
  444. [META_ID(SK_LINGERTIME)] = META_FUNC(int_sk_lingertime),
  445. [META_ID(SK_ACK_BACKLOG)] = META_FUNC(int_sk_ack_bl),
  446. [META_ID(SK_MAX_ACK_BACKLOG)] = META_FUNC(int_sk_max_ack_bl),
  447. [META_ID(SK_PRIO)] = META_FUNC(int_sk_prio),
  448. [META_ID(SK_RCVLOWAT)] = META_FUNC(int_sk_rcvlowat),
  449. [META_ID(SK_RCVTIMEO)] = META_FUNC(int_sk_rcvtimeo),
  450. [META_ID(SK_SNDTIMEO)] = META_FUNC(int_sk_sndtimeo),
  451. [META_ID(SK_SENDMSG_OFF)] = META_FUNC(int_sk_sendmsg_off),
  452. [META_ID(SK_WRITE_PENDING)] = META_FUNC(int_sk_write_pend),
  453. }
  454. };
  455. static inline struct meta_ops * meta_ops(struct meta_value *val)
  456. {
  457. return &__meta_ops[meta_type(val)][meta_id(val)];
  458. }
  459. /**************************************************************************
  460. * Type specific operations for TCF_META_TYPE_VAR
  461. **************************************************************************/
  462. static int meta_var_compare(struct meta_obj *a, struct meta_obj *b)
  463. {
  464. int r = a->len - b->len;
  465. if (r == 0)
  466. r = memcmp((void *) a->value, (void *) b->value, a->len);
  467. return r;
  468. }
  469. static int meta_var_change(struct meta_value *dst, struct rtattr *rta)
  470. {
  471. int len = RTA_PAYLOAD(rta);
  472. dst->val = (unsigned long) kmalloc(len, GFP_KERNEL);
  473. if (dst->val == 0UL)
  474. return -ENOMEM;
  475. memcpy((void *) dst->val, RTA_DATA(rta), len);
  476. dst->len = len;
  477. return 0;
  478. }
  479. static void meta_var_destroy(struct meta_value *v)
  480. {
  481. kfree((void *) v->val);
  482. }
  483. static void meta_var_apply_extras(struct meta_value *v,
  484. struct meta_obj *dst)
  485. {
  486. int shift = v->hdr.shift;
  487. if (shift && shift < dst->len)
  488. dst->len -= shift;
  489. }
  490. static int meta_var_dump(struct sk_buff *skb, struct meta_value *v, int tlv)
  491. {
  492. if (v->val && v->len)
  493. RTA_PUT(skb, tlv, v->len, (void *) v->val);
  494. return 0;
  495. rtattr_failure:
  496. return -1;
  497. }
  498. /**************************************************************************
  499. * Type specific operations for TCF_META_TYPE_INT
  500. **************************************************************************/
  501. static int meta_int_compare(struct meta_obj *a, struct meta_obj *b)
  502. {
  503. /* Let gcc optimize it, the unlikely is not really based on
  504. * some numbers but jump free code for mismatches seems
  505. * more logical. */
  506. if (unlikely(a->value == b->value))
  507. return 0;
  508. else if (a->value < b->value)
  509. return -1;
  510. else
  511. return 1;
  512. }
  513. static int meta_int_change(struct meta_value *dst, struct rtattr *rta)
  514. {
  515. if (RTA_PAYLOAD(rta) >= sizeof(unsigned long)) {
  516. dst->val = *(unsigned long *) RTA_DATA(rta);
  517. dst->len = sizeof(unsigned long);
  518. } else if (RTA_PAYLOAD(rta) == sizeof(u32)) {
  519. dst->val = *(u32 *) RTA_DATA(rta);
  520. dst->len = sizeof(u32);
  521. } else
  522. return -EINVAL;
  523. return 0;
  524. }
  525. static void meta_int_apply_extras(struct meta_value *v,
  526. struct meta_obj *dst)
  527. {
  528. if (v->hdr.shift)
  529. dst->value >>= v->hdr.shift;
  530. if (v->val)
  531. dst->value &= v->val;
  532. }
  533. static int meta_int_dump(struct sk_buff *skb, struct meta_value *v, int tlv)
  534. {
  535. if (v->len == sizeof(unsigned long))
  536. RTA_PUT(skb, tlv, sizeof(unsigned long), &v->val);
  537. else if (v->len == sizeof(u32)) {
  538. u32 d = v->val;
  539. RTA_PUT(skb, tlv, sizeof(d), &d);
  540. }
  541. return 0;
  542. rtattr_failure:
  543. return -1;
  544. }
  545. /**************************************************************************
  546. * Type specific operations table
  547. **************************************************************************/
  548. struct meta_type_ops
  549. {
  550. void (*destroy)(struct meta_value *);
  551. int (*compare)(struct meta_obj *, struct meta_obj *);
  552. int (*change)(struct meta_value *, struct rtattr *);
  553. void (*apply_extras)(struct meta_value *, struct meta_obj *);
  554. int (*dump)(struct sk_buff *, struct meta_value *, int);
  555. };
  556. static struct meta_type_ops __meta_type_ops[TCF_META_TYPE_MAX+1] = {
  557. [TCF_META_TYPE_VAR] = {
  558. .destroy = meta_var_destroy,
  559. .compare = meta_var_compare,
  560. .change = meta_var_change,
  561. .apply_extras = meta_var_apply_extras,
  562. .dump = meta_var_dump
  563. },
  564. [TCF_META_TYPE_INT] = {
  565. .compare = meta_int_compare,
  566. .change = meta_int_change,
  567. .apply_extras = meta_int_apply_extras,
  568. .dump = meta_int_dump
  569. }
  570. };
  571. static inline struct meta_type_ops * meta_type_ops(struct meta_value *v)
  572. {
  573. return &__meta_type_ops[meta_type(v)];
  574. }
  575. /**************************************************************************
  576. * Core
  577. **************************************************************************/
  578. static inline int meta_get(struct sk_buff *skb, struct tcf_pkt_info *info,
  579. struct meta_value *v, struct meta_obj *dst)
  580. {
  581. int err = 0;
  582. if (meta_id(v) == TCF_META_ID_VALUE) {
  583. dst->value = v->val;
  584. dst->len = v->len;
  585. return 0;
  586. }
  587. meta_ops(v)->get(skb, info, v, dst, &err);
  588. if (err < 0)
  589. return err;
  590. if (meta_type_ops(v)->apply_extras)
  591. meta_type_ops(v)->apply_extras(v, dst);
  592. return 0;
  593. }
  594. static int em_meta_match(struct sk_buff *skb, struct tcf_ematch *m,
  595. struct tcf_pkt_info *info)
  596. {
  597. int r;
  598. struct meta_match *meta = (struct meta_match *) m->data;
  599. struct meta_obj l_value, r_value;
  600. if (meta_get(skb, info, &meta->lvalue, &l_value) < 0 ||
  601. meta_get(skb, info, &meta->rvalue, &r_value) < 0)
  602. return 0;
  603. r = meta_type_ops(&meta->lvalue)->compare(&l_value, &r_value);
  604. switch (meta->lvalue.hdr.op) {
  605. case TCF_EM_OPND_EQ:
  606. return !r;
  607. case TCF_EM_OPND_LT:
  608. return r < 0;
  609. case TCF_EM_OPND_GT:
  610. return r > 0;
  611. }
  612. return 0;
  613. }
  614. static inline void meta_delete(struct meta_match *meta)
  615. {
  616. struct meta_type_ops *ops = meta_type_ops(&meta->lvalue);
  617. if (ops && ops->destroy) {
  618. ops->destroy(&meta->lvalue);
  619. ops->destroy(&meta->rvalue);
  620. }
  621. kfree(meta);
  622. }
  623. static inline int meta_change_data(struct meta_value *dst, struct rtattr *rta)
  624. {
  625. if (rta) {
  626. if (RTA_PAYLOAD(rta) == 0)
  627. return -EINVAL;
  628. return meta_type_ops(dst)->change(dst, rta);
  629. }
  630. return 0;
  631. }
  632. static inline int meta_is_supported(struct meta_value *val)
  633. {
  634. return (!meta_id(val) || meta_ops(val)->get);
  635. }
  636. static int em_meta_change(struct tcf_proto *tp, void *data, int len,
  637. struct tcf_ematch *m)
  638. {
  639. int err = -EINVAL;
  640. struct rtattr *tb[TCA_EM_META_MAX];
  641. struct tcf_meta_hdr *hdr;
  642. struct meta_match *meta = NULL;
  643. if (rtattr_parse(tb, TCA_EM_META_MAX, data, len) < 0)
  644. goto errout;
  645. if (tb[TCA_EM_META_HDR-1] == NULL ||
  646. RTA_PAYLOAD(tb[TCA_EM_META_HDR-1]) < sizeof(*hdr))
  647. goto errout;
  648. hdr = RTA_DATA(tb[TCA_EM_META_HDR-1]);
  649. if (TCF_META_TYPE(hdr->left.kind) != TCF_META_TYPE(hdr->right.kind) ||
  650. TCF_META_TYPE(hdr->left.kind) > TCF_META_TYPE_MAX ||
  651. TCF_META_ID(hdr->left.kind) > TCF_META_ID_MAX ||
  652. TCF_META_ID(hdr->right.kind) > TCF_META_ID_MAX)
  653. goto errout;
  654. meta = kzalloc(sizeof(*meta), GFP_KERNEL);
  655. if (meta == NULL)
  656. goto errout;
  657. memcpy(&meta->lvalue.hdr, &hdr->left, sizeof(hdr->left));
  658. memcpy(&meta->rvalue.hdr, &hdr->right, sizeof(hdr->right));
  659. if (!meta_is_supported(&meta->lvalue) ||
  660. !meta_is_supported(&meta->rvalue)) {
  661. err = -EOPNOTSUPP;
  662. goto errout;
  663. }
  664. if (meta_change_data(&meta->lvalue, tb[TCA_EM_META_LVALUE-1]) < 0 ||
  665. meta_change_data(&meta->rvalue, tb[TCA_EM_META_RVALUE-1]) < 0)
  666. goto errout;
  667. m->datalen = sizeof(*meta);
  668. m->data = (unsigned long) meta;
  669. err = 0;
  670. errout:
  671. if (err && meta)
  672. meta_delete(meta);
  673. return err;
  674. }
  675. static void em_meta_destroy(struct tcf_proto *tp, struct tcf_ematch *m)
  676. {
  677. if (m)
  678. meta_delete((struct meta_match *) m->data);
  679. }
  680. static int em_meta_dump(struct sk_buff *skb, struct tcf_ematch *em)
  681. {
  682. struct meta_match *meta = (struct meta_match *) em->data;
  683. struct tcf_meta_hdr hdr;
  684. struct meta_type_ops *ops;
  685. memset(&hdr, 0, sizeof(hdr));
  686. memcpy(&hdr.left, &meta->lvalue.hdr, sizeof(hdr.left));
  687. memcpy(&hdr.right, &meta->rvalue.hdr, sizeof(hdr.right));
  688. RTA_PUT(skb, TCA_EM_META_HDR, sizeof(hdr), &hdr);
  689. ops = meta_type_ops(&meta->lvalue);
  690. if (ops->dump(skb, &meta->lvalue, TCA_EM_META_LVALUE) < 0 ||
  691. ops->dump(skb, &meta->rvalue, TCA_EM_META_RVALUE) < 0)
  692. goto rtattr_failure;
  693. return 0;
  694. rtattr_failure:
  695. return -1;
  696. }
  697. static struct tcf_ematch_ops em_meta_ops = {
  698. .kind = TCF_EM_META,
  699. .change = em_meta_change,
  700. .match = em_meta_match,
  701. .destroy = em_meta_destroy,
  702. .dump = em_meta_dump,
  703. .owner = THIS_MODULE,
  704. .link = LIST_HEAD_INIT(em_meta_ops.link)
  705. };
  706. static int __init init_em_meta(void)
  707. {
  708. return tcf_em_register(&em_meta_ops);
  709. }
  710. static void __exit exit_em_meta(void)
  711. {
  712. tcf_em_unregister(&em_meta_ops);
  713. }
  714. MODULE_LICENSE("GPL");
  715. module_init(init_em_meta);
  716. module_exit(exit_em_meta);