11da177e4SLinus Torvalds /* 21da177e4SLinus Torvalds * net/sched/em_meta.c Metadata ematch 31da177e4SLinus Torvalds * 41da177e4SLinus Torvalds * This program is free software; you can redistribute it and/or 51da177e4SLinus Torvalds * modify it under the terms of the GNU General Public License 61da177e4SLinus Torvalds * as published by the Free Software Foundation; either version 71da177e4SLinus Torvalds * 2 of the License, or (at your option) any later version. 81da177e4SLinus Torvalds * 91da177e4SLinus Torvalds * Authors: Thomas Graf <tgraf@suug.ch> 101da177e4SLinus Torvalds * 111da177e4SLinus Torvalds * ========================================================================== 121da177e4SLinus Torvalds * 131da177e4SLinus Torvalds * The metadata ematch compares two meta objects where each object 141da177e4SLinus Torvalds * represents either a meta value stored in the kernel or a static 151da177e4SLinus Torvalds * value provided by userspace. The objects are not provided by 161da177e4SLinus Torvalds * userspace itself but rather a definition providing the information 171da177e4SLinus Torvalds * to build them. Every object is of a certain type which must be 181da177e4SLinus Torvalds * equal to the object it is being compared to. 191da177e4SLinus Torvalds * 201da177e4SLinus Torvalds * The definition of a objects conists of the type (meta type), a 211da177e4SLinus Torvalds * identifier (meta id) and additional type specific information. 221da177e4SLinus Torvalds * The meta id is either TCF_META_TYPE_VALUE for values provided by 231da177e4SLinus Torvalds * userspace or a index to the meta operations table consisting of 241da177e4SLinus Torvalds * function pointers to type specific meta data collectors returning 251da177e4SLinus Torvalds * the value of the requested meta value. 261da177e4SLinus Torvalds * 271da177e4SLinus Torvalds * lvalue rvalue 281da177e4SLinus Torvalds * +-----------+ +-----------+ 291da177e4SLinus Torvalds * | type: INT | | type: INT | 30261688d0SDavid S. Miller * def | id: DEV | | id: VALUE | 311da177e4SLinus Torvalds * | data: | | data: 3 | 321da177e4SLinus Torvalds * +-----------+ +-----------+ 331da177e4SLinus Torvalds * | | 34261688d0SDavid S. Miller * ---> meta_ops[INT][DEV](...) | 351da177e4SLinus Torvalds * | | 361da177e4SLinus Torvalds * ----------- | 371da177e4SLinus Torvalds * V V 381da177e4SLinus Torvalds * +-----------+ +-----------+ 391da177e4SLinus Torvalds * | type: INT | | type: INT | 40261688d0SDavid S. Miller * obj | id: DEV | | id: VALUE | 411da177e4SLinus Torvalds * | data: 2 |<--data got filled out | data: 3 | 421da177e4SLinus Torvalds * +-----------+ +-----------+ 431da177e4SLinus Torvalds * | | 441da177e4SLinus Torvalds * --------------> 2 equals 3 <-------------- 451da177e4SLinus Torvalds * 461da177e4SLinus Torvalds * This is a simplified schema, the complexity varies depending 471da177e4SLinus Torvalds * on the meta type. Obviously, the length of the data must also 481da177e4SLinus Torvalds * be provided for non-numeric types. 491da177e4SLinus Torvalds * 5025985edcSLucas De Marchi * Additionally, type dependent modifiers such as shift operators 511da177e4SLinus Torvalds * or mask may be applied to extend the functionaliy. As of now, 521da177e4SLinus Torvalds * the variable length type supports shifting the byte string to 531da177e4SLinus Torvalds * the right, eating up any number of octets and thus supporting 541da177e4SLinus Torvalds * wildcard interface name comparisons such as "ppp%" matching 551da177e4SLinus Torvalds * ppp0..9. 561da177e4SLinus Torvalds * 571da177e4SLinus Torvalds * NOTE: Certain meta values depend on other subsystems and are 583a4fa0a2SRobert P. J. Day * only available if that subsystem is enabled in the kernel. 591da177e4SLinus Torvalds */ 601da177e4SLinus Torvalds 615a0e3ad6STejun Heo #include <linux/slab.h> 621da177e4SLinus Torvalds #include <linux/module.h> 631da177e4SLinus Torvalds #include <linux/types.h> 641da177e4SLinus Torvalds #include <linux/kernel.h> 651da177e4SLinus Torvalds #include <linux/sched.h> 661da177e4SLinus Torvalds #include <linux/string.h> 671da177e4SLinus Torvalds #include <linux/skbuff.h> 681da177e4SLinus Torvalds #include <linux/random.h> 693113e88cSStephen Hemminger #include <linux/if_vlan.h> 701da177e4SLinus Torvalds #include <linux/tc_ematch/tc_em_meta.h> 711da177e4SLinus Torvalds #include <net/dst.h> 721da177e4SLinus Torvalds #include <net/route.h> 731da177e4SLinus Torvalds #include <net/pkt_cls.h> 7448900629SThomas Graf #include <net/sock.h> 751da177e4SLinus Torvalds 76cc7ec456SEric Dumazet struct meta_obj { 771da177e4SLinus Torvalds unsigned long value; 781da177e4SLinus Torvalds unsigned int len; 791da177e4SLinus Torvalds }; 801da177e4SLinus Torvalds 81cc7ec456SEric Dumazet struct meta_value { 821da177e4SLinus Torvalds struct tcf_meta_val hdr; 831da177e4SLinus Torvalds unsigned long val; 841da177e4SLinus Torvalds unsigned int len; 851da177e4SLinus Torvalds }; 861da177e4SLinus Torvalds 87cc7ec456SEric Dumazet struct meta_match { 881da177e4SLinus Torvalds struct meta_value lvalue; 891da177e4SLinus Torvalds struct meta_value rvalue; 901da177e4SLinus Torvalds }; 911da177e4SLinus Torvalds 921da177e4SLinus Torvalds static inline int meta_id(struct meta_value *v) 931da177e4SLinus Torvalds { 941da177e4SLinus Torvalds return TCF_META_ID(v->hdr.kind); 951da177e4SLinus Torvalds } 961da177e4SLinus Torvalds 971da177e4SLinus Torvalds static inline int meta_type(struct meta_value *v) 981da177e4SLinus Torvalds { 991da177e4SLinus Torvalds return TCF_META_TYPE(v->hdr.kind); 1001da177e4SLinus Torvalds } 1011da177e4SLinus Torvalds 1021da177e4SLinus Torvalds #define META_COLLECTOR(FUNC) static void meta_##FUNC(struct sk_buff *skb, \ 1031da177e4SLinus Torvalds struct tcf_pkt_info *info, struct meta_value *v, \ 1041da177e4SLinus Torvalds struct meta_obj *dst, int *err) 1051da177e4SLinus Torvalds 1061da177e4SLinus Torvalds /************************************************************************** 1071da177e4SLinus Torvalds * System status & misc 1081da177e4SLinus Torvalds **************************************************************************/ 1091da177e4SLinus Torvalds 1101da177e4SLinus Torvalds META_COLLECTOR(int_random) 1111da177e4SLinus Torvalds { 1121da177e4SLinus Torvalds get_random_bytes(&dst->value, sizeof(dst->value)); 1131da177e4SLinus Torvalds } 1141da177e4SLinus Torvalds 1151da177e4SLinus Torvalds static inline unsigned long fixed_loadavg(int load) 1161da177e4SLinus Torvalds { 1171da177e4SLinus Torvalds int rnd_load = load + (FIXED_1/200); 1181da177e4SLinus Torvalds int rnd_frac = ((rnd_load & (FIXED_1-1)) * 100) >> FSHIFT; 1191da177e4SLinus Torvalds 1201da177e4SLinus Torvalds return ((rnd_load >> FSHIFT) * 100) + rnd_frac; 1211da177e4SLinus Torvalds } 1221da177e4SLinus Torvalds 1231da177e4SLinus Torvalds META_COLLECTOR(int_loadavg_0) 1241da177e4SLinus Torvalds { 1251da177e4SLinus Torvalds dst->value = fixed_loadavg(avenrun[0]); 1261da177e4SLinus Torvalds } 1271da177e4SLinus Torvalds 1281da177e4SLinus Torvalds META_COLLECTOR(int_loadavg_1) 1291da177e4SLinus Torvalds { 1301da177e4SLinus Torvalds dst->value = fixed_loadavg(avenrun[1]); 1311da177e4SLinus Torvalds } 1321da177e4SLinus Torvalds 1331da177e4SLinus Torvalds META_COLLECTOR(int_loadavg_2) 1341da177e4SLinus Torvalds { 1351da177e4SLinus Torvalds dst->value = fixed_loadavg(avenrun[2]); 1361da177e4SLinus Torvalds } 1371da177e4SLinus Torvalds 1381da177e4SLinus Torvalds /************************************************************************** 1391da177e4SLinus Torvalds * Device names & indices 1401da177e4SLinus Torvalds **************************************************************************/ 1411da177e4SLinus Torvalds 1421da177e4SLinus Torvalds static inline int int_dev(struct net_device *dev, struct meta_obj *dst) 1431da177e4SLinus Torvalds { 1441da177e4SLinus Torvalds if (unlikely(dev == NULL)) 1451da177e4SLinus Torvalds return -1; 1461da177e4SLinus Torvalds 1471da177e4SLinus Torvalds dst->value = dev->ifindex; 1481da177e4SLinus Torvalds return 0; 1491da177e4SLinus Torvalds } 1501da177e4SLinus Torvalds 1511da177e4SLinus Torvalds static inline int var_dev(struct net_device *dev, struct meta_obj *dst) 1521da177e4SLinus Torvalds { 1531da177e4SLinus Torvalds if (unlikely(dev == NULL)) 1541da177e4SLinus Torvalds return -1; 1551da177e4SLinus Torvalds 1561da177e4SLinus Torvalds dst->value = (unsigned long) dev->name; 1571da177e4SLinus Torvalds dst->len = strlen(dev->name); 1581da177e4SLinus Torvalds return 0; 1591da177e4SLinus Torvalds } 1601da177e4SLinus Torvalds 1611da177e4SLinus Torvalds META_COLLECTOR(int_dev) 1621da177e4SLinus Torvalds { 1631da177e4SLinus Torvalds *err = int_dev(skb->dev, dst); 1641da177e4SLinus Torvalds } 1651da177e4SLinus Torvalds 1661da177e4SLinus Torvalds META_COLLECTOR(var_dev) 1671da177e4SLinus Torvalds { 1681da177e4SLinus Torvalds *err = var_dev(skb->dev, dst); 1691da177e4SLinus Torvalds } 1701da177e4SLinus Torvalds 1711da177e4SLinus Torvalds /************************************************************************** 1723113e88cSStephen Hemminger * vlan tag 1733113e88cSStephen Hemminger **************************************************************************/ 1743113e88cSStephen Hemminger 1753113e88cSStephen Hemminger META_COLLECTOR(int_vlan_tag) 1763113e88cSStephen Hemminger { 1771a31f204SStephen Hemminger unsigned short tag; 1781a31f204SStephen Hemminger 1791a31f204SStephen Hemminger tag = vlan_tx_tag_get(skb); 1801a31f204SStephen Hemminger if (!tag && __vlan_get_tag(skb, &tag)) 1813113e88cSStephen Hemminger *err = -1; 1823113e88cSStephen Hemminger else 1833113e88cSStephen Hemminger dst->value = tag; 1843113e88cSStephen Hemminger } 1853113e88cSStephen Hemminger 1863113e88cSStephen Hemminger 1873113e88cSStephen Hemminger 1883113e88cSStephen Hemminger /************************************************************************** 1891da177e4SLinus Torvalds * skb attributes 1901da177e4SLinus Torvalds **************************************************************************/ 1911da177e4SLinus Torvalds 1921da177e4SLinus Torvalds META_COLLECTOR(int_priority) 1931da177e4SLinus Torvalds { 1941da177e4SLinus Torvalds dst->value = skb->priority; 1951da177e4SLinus Torvalds } 1961da177e4SLinus Torvalds 1971da177e4SLinus Torvalds META_COLLECTOR(int_protocol) 1981da177e4SLinus Torvalds { 1991da177e4SLinus Torvalds /* Let userspace take care of the byte ordering */ 2001da177e4SLinus Torvalds dst->value = skb->protocol; 2011da177e4SLinus Torvalds } 2021da177e4SLinus Torvalds 2031da177e4SLinus Torvalds META_COLLECTOR(int_pkttype) 2041da177e4SLinus Torvalds { 2051da177e4SLinus Torvalds dst->value = skb->pkt_type; 2061da177e4SLinus Torvalds } 2071da177e4SLinus Torvalds 2081da177e4SLinus Torvalds META_COLLECTOR(int_pktlen) 2091da177e4SLinus Torvalds { 2101da177e4SLinus Torvalds dst->value = skb->len; 2111da177e4SLinus Torvalds } 2121da177e4SLinus Torvalds 2131da177e4SLinus Torvalds META_COLLECTOR(int_datalen) 2141da177e4SLinus Torvalds { 2151da177e4SLinus Torvalds dst->value = skb->data_len; 2161da177e4SLinus Torvalds } 2171da177e4SLinus Torvalds 2181da177e4SLinus Torvalds META_COLLECTOR(int_maclen) 2191da177e4SLinus Torvalds { 2201da177e4SLinus Torvalds dst->value = skb->mac_len; 2211da177e4SLinus Torvalds } 2221da177e4SLinus Torvalds 223c2e3143eSStephen Hemminger META_COLLECTOR(int_rxhash) 224c2e3143eSStephen Hemminger { 225c2e3143eSStephen Hemminger dst->value = skb_get_rxhash(skb); 226c2e3143eSStephen Hemminger } 227c2e3143eSStephen Hemminger 2281da177e4SLinus Torvalds /************************************************************************** 2291da177e4SLinus Torvalds * Netfilter 2301da177e4SLinus Torvalds **************************************************************************/ 2311da177e4SLinus Torvalds 23282e91ffeSThomas Graf META_COLLECTOR(int_mark) 2331da177e4SLinus Torvalds { 23482e91ffeSThomas Graf dst->value = skb->mark; 2357686ee1aSPatrick McHardy } 2361da177e4SLinus Torvalds 2371da177e4SLinus Torvalds /************************************************************************** 2381da177e4SLinus Torvalds * Traffic Control 2391da177e4SLinus Torvalds **************************************************************************/ 2401da177e4SLinus Torvalds 2411da177e4SLinus Torvalds META_COLLECTOR(int_tcindex) 2421da177e4SLinus Torvalds { 2431da177e4SLinus Torvalds dst->value = skb->tc_index; 2441da177e4SLinus Torvalds } 2451da177e4SLinus Torvalds 2461da177e4SLinus Torvalds /************************************************************************** 2471da177e4SLinus Torvalds * Routing 2481da177e4SLinus Torvalds **************************************************************************/ 2491da177e4SLinus Torvalds 2501da177e4SLinus Torvalds META_COLLECTOR(int_rtclassid) 2511da177e4SLinus Torvalds { 252adf30907SEric Dumazet if (unlikely(skb_dst(skb) == NULL)) 2531da177e4SLinus Torvalds *err = -1; 2541da177e4SLinus Torvalds else 255c7066f70SPatrick McHardy #ifdef CONFIG_IP_ROUTE_CLASSID 256adf30907SEric Dumazet dst->value = skb_dst(skb)->tclassid; 2577686ee1aSPatrick McHardy #else 2587686ee1aSPatrick McHardy dst->value = 0; 2591da177e4SLinus Torvalds #endif 2607686ee1aSPatrick McHardy } 2611da177e4SLinus Torvalds 2621da177e4SLinus Torvalds META_COLLECTOR(int_rtiif) 2631da177e4SLinus Torvalds { 264511c3f92SEric Dumazet if (unlikely(skb_rtable(skb) == NULL)) 2651da177e4SLinus Torvalds *err = -1; 2661da177e4SLinus Torvalds else 26792101b3bSDavid S. Miller dst->value = inet_iif(skb); 2681da177e4SLinus Torvalds } 2691da177e4SLinus Torvalds 2701da177e4SLinus Torvalds /************************************************************************** 27148900629SThomas Graf * Socket Attributes 27248900629SThomas Graf **************************************************************************/ 27348900629SThomas Graf 27448900629SThomas Graf #define SKIP_NONLOCAL(skb) \ 27548900629SThomas Graf if (unlikely(skb->sk == NULL)) { \ 27648900629SThomas Graf *err = -1; \ 27748900629SThomas Graf return; \ 27848900629SThomas Graf } 27948900629SThomas Graf 28048900629SThomas Graf META_COLLECTOR(int_sk_family) 28148900629SThomas Graf { 28248900629SThomas Graf SKIP_NONLOCAL(skb); 28348900629SThomas Graf dst->value = skb->sk->sk_family; 28448900629SThomas Graf } 28548900629SThomas Graf 28648900629SThomas Graf META_COLLECTOR(int_sk_state) 28748900629SThomas Graf { 28848900629SThomas Graf SKIP_NONLOCAL(skb); 28948900629SThomas Graf dst->value = skb->sk->sk_state; 29048900629SThomas Graf } 29148900629SThomas Graf 29248900629SThomas Graf META_COLLECTOR(int_sk_reuse) 29348900629SThomas Graf { 29448900629SThomas Graf SKIP_NONLOCAL(skb); 29548900629SThomas Graf dst->value = skb->sk->sk_reuse; 29648900629SThomas Graf } 29748900629SThomas Graf 29848900629SThomas Graf META_COLLECTOR(int_sk_bound_if) 29948900629SThomas Graf { 30048900629SThomas Graf SKIP_NONLOCAL(skb); 30148900629SThomas Graf /* No error if bound_dev_if is 0, legal userspace check */ 30248900629SThomas Graf dst->value = skb->sk->sk_bound_dev_if; 30348900629SThomas Graf } 30448900629SThomas Graf 30548900629SThomas Graf META_COLLECTOR(var_sk_bound_if) 30648900629SThomas Graf { 30748900629SThomas Graf SKIP_NONLOCAL(skb); 30848900629SThomas Graf 30948900629SThomas Graf if (skb->sk->sk_bound_dev_if == 0) { 31048900629SThomas Graf dst->value = (unsigned long) "any"; 31148900629SThomas Graf dst->len = 3; 31248900629SThomas Graf } else { 31348900629SThomas Graf struct net_device *dev; 31448900629SThomas Graf 315d0075634SEric Dumazet rcu_read_lock(); 3162939e275SEric Dumazet dev = dev_get_by_index_rcu(sock_net(skb->sk), 3172939e275SEric Dumazet skb->sk->sk_bound_dev_if); 31848900629SThomas Graf *err = var_dev(dev, dst); 319d0075634SEric Dumazet rcu_read_unlock(); 32048900629SThomas Graf } 32148900629SThomas Graf } 32248900629SThomas Graf 32348900629SThomas Graf META_COLLECTOR(int_sk_refcnt) 32448900629SThomas Graf { 32548900629SThomas Graf SKIP_NONLOCAL(skb); 32648900629SThomas Graf dst->value = atomic_read(&skb->sk->sk_refcnt); 32748900629SThomas Graf } 32848900629SThomas Graf 32948900629SThomas Graf META_COLLECTOR(int_sk_rcvbuf) 33048900629SThomas Graf { 33148900629SThomas Graf SKIP_NONLOCAL(skb); 33248900629SThomas Graf dst->value = skb->sk->sk_rcvbuf; 33348900629SThomas Graf } 33448900629SThomas Graf 33548900629SThomas Graf META_COLLECTOR(int_sk_shutdown) 33648900629SThomas Graf { 33748900629SThomas Graf SKIP_NONLOCAL(skb); 33848900629SThomas Graf dst->value = skb->sk->sk_shutdown; 33948900629SThomas Graf } 34048900629SThomas Graf 34148900629SThomas Graf META_COLLECTOR(int_sk_proto) 34248900629SThomas Graf { 34348900629SThomas Graf SKIP_NONLOCAL(skb); 34448900629SThomas Graf dst->value = skb->sk->sk_protocol; 34548900629SThomas Graf } 34648900629SThomas Graf 34748900629SThomas Graf META_COLLECTOR(int_sk_type) 34848900629SThomas Graf { 34948900629SThomas Graf SKIP_NONLOCAL(skb); 35048900629SThomas Graf dst->value = skb->sk->sk_type; 35148900629SThomas Graf } 35248900629SThomas Graf 35348900629SThomas Graf META_COLLECTOR(int_sk_rmem_alloc) 35448900629SThomas Graf { 35548900629SThomas Graf SKIP_NONLOCAL(skb); 35631e6d363SEric Dumazet dst->value = sk_rmem_alloc_get(skb->sk); 35748900629SThomas Graf } 35848900629SThomas Graf 35948900629SThomas Graf META_COLLECTOR(int_sk_wmem_alloc) 36048900629SThomas Graf { 36148900629SThomas Graf SKIP_NONLOCAL(skb); 36231e6d363SEric Dumazet dst->value = sk_wmem_alloc_get(skb->sk); 36348900629SThomas Graf } 36448900629SThomas Graf 36548900629SThomas Graf META_COLLECTOR(int_sk_omem_alloc) 36648900629SThomas Graf { 36748900629SThomas Graf SKIP_NONLOCAL(skb); 36848900629SThomas Graf dst->value = atomic_read(&skb->sk->sk_omem_alloc); 36948900629SThomas Graf } 37048900629SThomas Graf 37148900629SThomas Graf META_COLLECTOR(int_sk_rcv_qlen) 37248900629SThomas Graf { 37348900629SThomas Graf SKIP_NONLOCAL(skb); 37448900629SThomas Graf dst->value = skb->sk->sk_receive_queue.qlen; 37548900629SThomas Graf } 37648900629SThomas Graf 37748900629SThomas Graf META_COLLECTOR(int_sk_snd_qlen) 37848900629SThomas Graf { 37948900629SThomas Graf SKIP_NONLOCAL(skb); 38048900629SThomas Graf dst->value = skb->sk->sk_write_queue.qlen; 38148900629SThomas Graf } 38248900629SThomas Graf 38348900629SThomas Graf META_COLLECTOR(int_sk_wmem_queued) 38448900629SThomas Graf { 38548900629SThomas Graf SKIP_NONLOCAL(skb); 38648900629SThomas Graf dst->value = skb->sk->sk_wmem_queued; 38748900629SThomas Graf } 38848900629SThomas Graf 38948900629SThomas Graf META_COLLECTOR(int_sk_fwd_alloc) 39048900629SThomas Graf { 39148900629SThomas Graf SKIP_NONLOCAL(skb); 39248900629SThomas Graf dst->value = skb->sk->sk_forward_alloc; 39348900629SThomas Graf } 39448900629SThomas Graf 39548900629SThomas Graf META_COLLECTOR(int_sk_sndbuf) 39648900629SThomas Graf { 39748900629SThomas Graf SKIP_NONLOCAL(skb); 39848900629SThomas Graf dst->value = skb->sk->sk_sndbuf; 39948900629SThomas Graf } 40048900629SThomas Graf 40148900629SThomas Graf META_COLLECTOR(int_sk_alloc) 40248900629SThomas Graf { 40348900629SThomas Graf SKIP_NONLOCAL(skb); 404e0c56310Sstephen hemminger dst->value = (__force int) skb->sk->sk_allocation; 40548900629SThomas Graf } 40648900629SThomas Graf 40781c3d547SEric Dumazet META_COLLECTOR(int_sk_hash) 40848900629SThomas Graf { 40948900629SThomas Graf SKIP_NONLOCAL(skb); 41081c3d547SEric Dumazet dst->value = skb->sk->sk_hash; 41148900629SThomas Graf } 41248900629SThomas Graf 41348900629SThomas Graf META_COLLECTOR(int_sk_lingertime) 41448900629SThomas Graf { 41548900629SThomas Graf SKIP_NONLOCAL(skb); 41648900629SThomas Graf dst->value = skb->sk->sk_lingertime / HZ; 41748900629SThomas Graf } 41848900629SThomas Graf 41948900629SThomas Graf META_COLLECTOR(int_sk_err_qlen) 42048900629SThomas Graf { 42148900629SThomas Graf SKIP_NONLOCAL(skb); 42248900629SThomas Graf dst->value = skb->sk->sk_error_queue.qlen; 42348900629SThomas Graf } 42448900629SThomas Graf 42548900629SThomas Graf META_COLLECTOR(int_sk_ack_bl) 42648900629SThomas Graf { 42748900629SThomas Graf SKIP_NONLOCAL(skb); 42848900629SThomas Graf dst->value = skb->sk->sk_ack_backlog; 42948900629SThomas Graf } 43048900629SThomas Graf 43148900629SThomas Graf META_COLLECTOR(int_sk_max_ack_bl) 43248900629SThomas Graf { 43348900629SThomas Graf SKIP_NONLOCAL(skb); 43448900629SThomas Graf dst->value = skb->sk->sk_max_ack_backlog; 43548900629SThomas Graf } 43648900629SThomas Graf 43748900629SThomas Graf META_COLLECTOR(int_sk_prio) 43848900629SThomas Graf { 43948900629SThomas Graf SKIP_NONLOCAL(skb); 44048900629SThomas Graf dst->value = skb->sk->sk_priority; 44148900629SThomas Graf } 44248900629SThomas Graf 44348900629SThomas Graf META_COLLECTOR(int_sk_rcvlowat) 44448900629SThomas Graf { 44548900629SThomas Graf SKIP_NONLOCAL(skb); 44648900629SThomas Graf dst->value = skb->sk->sk_rcvlowat; 44748900629SThomas Graf } 44848900629SThomas Graf 44948900629SThomas Graf META_COLLECTOR(int_sk_rcvtimeo) 45048900629SThomas Graf { 45148900629SThomas Graf SKIP_NONLOCAL(skb); 45248900629SThomas Graf dst->value = skb->sk->sk_rcvtimeo / HZ; 45348900629SThomas Graf } 45448900629SThomas Graf 45548900629SThomas Graf META_COLLECTOR(int_sk_sndtimeo) 45648900629SThomas Graf { 45748900629SThomas Graf SKIP_NONLOCAL(skb); 45848900629SThomas Graf dst->value = skb->sk->sk_sndtimeo / HZ; 45948900629SThomas Graf } 46048900629SThomas Graf 46148900629SThomas Graf META_COLLECTOR(int_sk_sendmsg_off) 46248900629SThomas Graf { 46348900629SThomas Graf SKIP_NONLOCAL(skb); 4645640f768SEric Dumazet dst->value = skb->sk->sk_frag.offset; 46548900629SThomas Graf } 46648900629SThomas Graf 46748900629SThomas Graf META_COLLECTOR(int_sk_write_pend) 46848900629SThomas Graf { 46948900629SThomas Graf SKIP_NONLOCAL(skb); 47048900629SThomas Graf dst->value = skb->sk->sk_write_pending; 47148900629SThomas Graf } 47248900629SThomas Graf 47348900629SThomas Graf /************************************************************************** 4741da177e4SLinus Torvalds * Meta value collectors assignment table 4751da177e4SLinus Torvalds **************************************************************************/ 4761da177e4SLinus Torvalds 477cc7ec456SEric Dumazet struct meta_ops { 4781da177e4SLinus Torvalds void (*get)(struct sk_buff *, struct tcf_pkt_info *, 4791da177e4SLinus Torvalds struct meta_value *, struct meta_obj *, int *); 4801da177e4SLinus Torvalds }; 4811da177e4SLinus Torvalds 48248900629SThomas Graf #define META_ID(name) TCF_META_ID_##name 48348900629SThomas Graf #define META_FUNC(name) { .get = meta_##name } 48448900629SThomas Graf 4851da177e4SLinus Torvalds /* Meta value operations table listing all meta value collectors and 4861da177e4SLinus Torvalds * assigns them to a type and meta id. */ 4871da177e4SLinus Torvalds static struct meta_ops __meta_ops[TCF_META_TYPE_MAX + 1][TCF_META_ID_MAX + 1] = { 4881da177e4SLinus Torvalds [TCF_META_TYPE_VAR] = { 48948900629SThomas Graf [META_ID(DEV)] = META_FUNC(var_dev), 49048900629SThomas Graf [META_ID(SK_BOUND_IF)] = META_FUNC(var_sk_bound_if), 4911da177e4SLinus Torvalds }, 4921da177e4SLinus Torvalds [TCF_META_TYPE_INT] = { 49348900629SThomas Graf [META_ID(RANDOM)] = META_FUNC(int_random), 49448900629SThomas Graf [META_ID(LOADAVG_0)] = META_FUNC(int_loadavg_0), 49548900629SThomas Graf [META_ID(LOADAVG_1)] = META_FUNC(int_loadavg_1), 49648900629SThomas Graf [META_ID(LOADAVG_2)] = META_FUNC(int_loadavg_2), 49748900629SThomas Graf [META_ID(DEV)] = META_FUNC(int_dev), 49848900629SThomas Graf [META_ID(PRIORITY)] = META_FUNC(int_priority), 49948900629SThomas Graf [META_ID(PROTOCOL)] = META_FUNC(int_protocol), 50048900629SThomas Graf [META_ID(PKTTYPE)] = META_FUNC(int_pkttype), 50148900629SThomas Graf [META_ID(PKTLEN)] = META_FUNC(int_pktlen), 50248900629SThomas Graf [META_ID(DATALEN)] = META_FUNC(int_datalen), 50348900629SThomas Graf [META_ID(MACLEN)] = META_FUNC(int_maclen), 50482e91ffeSThomas Graf [META_ID(NFMARK)] = META_FUNC(int_mark), 50548900629SThomas Graf [META_ID(TCINDEX)] = META_FUNC(int_tcindex), 50648900629SThomas Graf [META_ID(RTCLASSID)] = META_FUNC(int_rtclassid), 50748900629SThomas Graf [META_ID(RTIIF)] = META_FUNC(int_rtiif), 50848900629SThomas Graf [META_ID(SK_FAMILY)] = META_FUNC(int_sk_family), 50948900629SThomas Graf [META_ID(SK_STATE)] = META_FUNC(int_sk_state), 51048900629SThomas Graf [META_ID(SK_REUSE)] = META_FUNC(int_sk_reuse), 51148900629SThomas Graf [META_ID(SK_BOUND_IF)] = META_FUNC(int_sk_bound_if), 51248900629SThomas Graf [META_ID(SK_REFCNT)] = META_FUNC(int_sk_refcnt), 51348900629SThomas Graf [META_ID(SK_RCVBUF)] = META_FUNC(int_sk_rcvbuf), 51448900629SThomas Graf [META_ID(SK_SNDBUF)] = META_FUNC(int_sk_sndbuf), 51548900629SThomas Graf [META_ID(SK_SHUTDOWN)] = META_FUNC(int_sk_shutdown), 51648900629SThomas Graf [META_ID(SK_PROTO)] = META_FUNC(int_sk_proto), 51748900629SThomas Graf [META_ID(SK_TYPE)] = META_FUNC(int_sk_type), 51848900629SThomas Graf [META_ID(SK_RMEM_ALLOC)] = META_FUNC(int_sk_rmem_alloc), 51948900629SThomas Graf [META_ID(SK_WMEM_ALLOC)] = META_FUNC(int_sk_wmem_alloc), 52048900629SThomas Graf [META_ID(SK_OMEM_ALLOC)] = META_FUNC(int_sk_omem_alloc), 52148900629SThomas Graf [META_ID(SK_WMEM_QUEUED)] = META_FUNC(int_sk_wmem_queued), 52248900629SThomas Graf [META_ID(SK_RCV_QLEN)] = META_FUNC(int_sk_rcv_qlen), 52348900629SThomas Graf [META_ID(SK_SND_QLEN)] = META_FUNC(int_sk_snd_qlen), 52448900629SThomas Graf [META_ID(SK_ERR_QLEN)] = META_FUNC(int_sk_err_qlen), 52548900629SThomas Graf [META_ID(SK_FORWARD_ALLOCS)] = META_FUNC(int_sk_fwd_alloc), 52648900629SThomas Graf [META_ID(SK_ALLOCS)] = META_FUNC(int_sk_alloc), 52781c3d547SEric Dumazet [META_ID(SK_HASH)] = META_FUNC(int_sk_hash), 52848900629SThomas Graf [META_ID(SK_LINGERTIME)] = META_FUNC(int_sk_lingertime), 52948900629SThomas Graf [META_ID(SK_ACK_BACKLOG)] = META_FUNC(int_sk_ack_bl), 53048900629SThomas Graf [META_ID(SK_MAX_ACK_BACKLOG)] = META_FUNC(int_sk_max_ack_bl), 53148900629SThomas Graf [META_ID(SK_PRIO)] = META_FUNC(int_sk_prio), 53248900629SThomas Graf [META_ID(SK_RCVLOWAT)] = META_FUNC(int_sk_rcvlowat), 53348900629SThomas Graf [META_ID(SK_RCVTIMEO)] = META_FUNC(int_sk_rcvtimeo), 53448900629SThomas Graf [META_ID(SK_SNDTIMEO)] = META_FUNC(int_sk_sndtimeo), 53548900629SThomas Graf [META_ID(SK_SENDMSG_OFF)] = META_FUNC(int_sk_sendmsg_off), 53648900629SThomas Graf [META_ID(SK_WRITE_PENDING)] = META_FUNC(int_sk_write_pend), 5373113e88cSStephen Hemminger [META_ID(VLAN_TAG)] = META_FUNC(int_vlan_tag), 538c2e3143eSStephen Hemminger [META_ID(RXHASH)] = META_FUNC(int_rxhash), 5391da177e4SLinus Torvalds } 5401da177e4SLinus Torvalds }; 5411da177e4SLinus Torvalds 5421da177e4SLinus Torvalds static inline struct meta_ops *meta_ops(struct meta_value *val) 5431da177e4SLinus Torvalds { 5441da177e4SLinus Torvalds return &__meta_ops[meta_type(val)][meta_id(val)]; 5451da177e4SLinus Torvalds } 5461da177e4SLinus Torvalds 5471da177e4SLinus Torvalds /************************************************************************** 5481da177e4SLinus Torvalds * Type specific operations for TCF_META_TYPE_VAR 5491da177e4SLinus Torvalds **************************************************************************/ 5501da177e4SLinus Torvalds 5511da177e4SLinus Torvalds static int meta_var_compare(struct meta_obj *a, struct meta_obj *b) 5521da177e4SLinus Torvalds { 5531da177e4SLinus Torvalds int r = a->len - b->len; 5541da177e4SLinus Torvalds 5551da177e4SLinus Torvalds if (r == 0) 5561da177e4SLinus Torvalds r = memcmp((void *) a->value, (void *) b->value, a->len); 5571da177e4SLinus Torvalds 5581da177e4SLinus Torvalds return r; 5591da177e4SLinus Torvalds } 5601da177e4SLinus Torvalds 561add93b61SPatrick McHardy static int meta_var_change(struct meta_value *dst, struct nlattr *nla) 5621da177e4SLinus Torvalds { 563add93b61SPatrick McHardy int len = nla_len(nla); 5641da177e4SLinus Torvalds 565add93b61SPatrick McHardy dst->val = (unsigned long)kmemdup(nla_data(nla), len, GFP_KERNEL); 5661da177e4SLinus Torvalds if (dst->val == 0UL) 5671da177e4SLinus Torvalds return -ENOMEM; 5681da177e4SLinus Torvalds dst->len = len; 5691da177e4SLinus Torvalds return 0; 5701da177e4SLinus Torvalds } 5711da177e4SLinus Torvalds 5721da177e4SLinus Torvalds static void meta_var_destroy(struct meta_value *v) 5731da177e4SLinus Torvalds { 5741da177e4SLinus Torvalds kfree((void *) v->val); 5751da177e4SLinus Torvalds } 5761da177e4SLinus Torvalds 5771da177e4SLinus Torvalds static void meta_var_apply_extras(struct meta_value *v, 5781da177e4SLinus Torvalds struct meta_obj *dst) 5791da177e4SLinus Torvalds { 5801da177e4SLinus Torvalds int shift = v->hdr.shift; 5811da177e4SLinus Torvalds 5821da177e4SLinus Torvalds if (shift && shift < dst->len) 5831da177e4SLinus Torvalds dst->len -= shift; 5841da177e4SLinus Torvalds } 5851da177e4SLinus Torvalds 5861da177e4SLinus Torvalds static int meta_var_dump(struct sk_buff *skb, struct meta_value *v, int tlv) 5871da177e4SLinus Torvalds { 5881b34ec43SDavid S. Miller if (v->val && v->len && 5891b34ec43SDavid S. Miller nla_put(skb, tlv, v->len, (void *) v->val)) 5901b34ec43SDavid S. Miller goto nla_put_failure; 5911da177e4SLinus Torvalds return 0; 5921da177e4SLinus Torvalds 593add93b61SPatrick McHardy nla_put_failure: 5941da177e4SLinus Torvalds return -1; 5951da177e4SLinus Torvalds } 5961da177e4SLinus Torvalds 5971da177e4SLinus Torvalds /************************************************************************** 5981da177e4SLinus Torvalds * Type specific operations for TCF_META_TYPE_INT 5991da177e4SLinus Torvalds **************************************************************************/ 6001da177e4SLinus Torvalds 6011da177e4SLinus Torvalds static int meta_int_compare(struct meta_obj *a, struct meta_obj *b) 6021da177e4SLinus Torvalds { 6031da177e4SLinus Torvalds /* Let gcc optimize it, the unlikely is not really based on 6041da177e4SLinus Torvalds * some numbers but jump free code for mismatches seems 6051da177e4SLinus Torvalds * more logical. */ 60698e56405SThomas Graf if (unlikely(a->value == b->value)) 6071da177e4SLinus Torvalds return 0; 60898e56405SThomas Graf else if (a->value < b->value) 6091da177e4SLinus Torvalds return -1; 6101da177e4SLinus Torvalds else 6111da177e4SLinus Torvalds return 1; 6121da177e4SLinus Torvalds } 6131da177e4SLinus Torvalds 614add93b61SPatrick McHardy static int meta_int_change(struct meta_value *dst, struct nlattr *nla) 6151da177e4SLinus Torvalds { 616add93b61SPatrick McHardy if (nla_len(nla) >= sizeof(unsigned long)) { 617add93b61SPatrick McHardy dst->val = *(unsigned long *) nla_data(nla); 6181da177e4SLinus Torvalds dst->len = sizeof(unsigned long); 619add93b61SPatrick McHardy } else if (nla_len(nla) == sizeof(u32)) { 6201587bac4SPatrick McHardy dst->val = nla_get_u32(nla); 6211da177e4SLinus Torvalds dst->len = sizeof(u32); 6221da177e4SLinus Torvalds } else 6231da177e4SLinus Torvalds return -EINVAL; 6241da177e4SLinus Torvalds 6251da177e4SLinus Torvalds return 0; 6261da177e4SLinus Torvalds } 6271da177e4SLinus Torvalds 6281da177e4SLinus Torvalds static void meta_int_apply_extras(struct meta_value *v, 6291da177e4SLinus Torvalds struct meta_obj *dst) 6301da177e4SLinus Torvalds { 6311da177e4SLinus Torvalds if (v->hdr.shift) 6321da177e4SLinus Torvalds dst->value >>= v->hdr.shift; 6331da177e4SLinus Torvalds 6341da177e4SLinus Torvalds if (v->val) 6351da177e4SLinus Torvalds dst->value &= v->val; 6361da177e4SLinus Torvalds } 6371da177e4SLinus Torvalds 6381da177e4SLinus Torvalds static int meta_int_dump(struct sk_buff *skb, struct meta_value *v, int tlv) 6391da177e4SLinus Torvalds { 6401b34ec43SDavid S. Miller if (v->len == sizeof(unsigned long)) { 6411b34ec43SDavid S. Miller if (nla_put(skb, tlv, sizeof(unsigned long), &v->val)) 6421b34ec43SDavid S. Miller goto nla_put_failure; 6431b34ec43SDavid S. Miller } else if (v->len == sizeof(u32)) { 6441b34ec43SDavid S. Miller if (nla_put_u32(skb, tlv, v->val)) 6451b34ec43SDavid S. Miller goto nla_put_failure; 6461b34ec43SDavid S. Miller } 6471da177e4SLinus Torvalds 6481da177e4SLinus Torvalds return 0; 6491da177e4SLinus Torvalds 650add93b61SPatrick McHardy nla_put_failure: 6511da177e4SLinus Torvalds return -1; 6521da177e4SLinus Torvalds } 6531da177e4SLinus Torvalds 6541da177e4SLinus Torvalds /************************************************************************** 6551da177e4SLinus Torvalds * Type specific operations table 6561da177e4SLinus Torvalds **************************************************************************/ 6571da177e4SLinus Torvalds 658cc7ec456SEric Dumazet struct meta_type_ops { 6591da177e4SLinus Torvalds void (*destroy)(struct meta_value *); 6601da177e4SLinus Torvalds int (*compare)(struct meta_obj *, struct meta_obj *); 661add93b61SPatrick McHardy int (*change)(struct meta_value *, struct nlattr *); 6621da177e4SLinus Torvalds void (*apply_extras)(struct meta_value *, struct meta_obj *); 6631da177e4SLinus Torvalds int (*dump)(struct sk_buff *, struct meta_value *, int); 6641da177e4SLinus Torvalds }; 6651da177e4SLinus Torvalds 6661da177e4SLinus Torvalds static struct meta_type_ops __meta_type_ops[TCF_META_TYPE_MAX + 1] = { 6671da177e4SLinus Torvalds [TCF_META_TYPE_VAR] = { 6681da177e4SLinus Torvalds .destroy = meta_var_destroy, 6691da177e4SLinus Torvalds .compare = meta_var_compare, 6701da177e4SLinus Torvalds .change = meta_var_change, 6711da177e4SLinus Torvalds .apply_extras = meta_var_apply_extras, 6721da177e4SLinus Torvalds .dump = meta_var_dump 6731da177e4SLinus Torvalds }, 6741da177e4SLinus Torvalds [TCF_META_TYPE_INT] = { 6751da177e4SLinus Torvalds .compare = meta_int_compare, 6761da177e4SLinus Torvalds .change = meta_int_change, 6771da177e4SLinus Torvalds .apply_extras = meta_int_apply_extras, 6781da177e4SLinus Torvalds .dump = meta_int_dump 6791da177e4SLinus Torvalds } 6801da177e4SLinus Torvalds }; 6811da177e4SLinus Torvalds 6821da177e4SLinus Torvalds static inline struct meta_type_ops *meta_type_ops(struct meta_value *v) 6831da177e4SLinus Torvalds { 6841da177e4SLinus Torvalds return &__meta_type_ops[meta_type(v)]; 6851da177e4SLinus Torvalds } 6861da177e4SLinus Torvalds 6871da177e4SLinus Torvalds /************************************************************************** 6881da177e4SLinus Torvalds * Core 6891da177e4SLinus Torvalds **************************************************************************/ 6901da177e4SLinus Torvalds 691ed7af3b3SStephen Hemminger static int meta_get(struct sk_buff *skb, struct tcf_pkt_info *info, 6921da177e4SLinus Torvalds struct meta_value *v, struct meta_obj *dst) 6931da177e4SLinus Torvalds { 6941da177e4SLinus Torvalds int err = 0; 6951da177e4SLinus Torvalds 6961da177e4SLinus Torvalds if (meta_id(v) == TCF_META_ID_VALUE) { 6971da177e4SLinus Torvalds dst->value = v->val; 6981da177e4SLinus Torvalds dst->len = v->len; 6991da177e4SLinus Torvalds return 0; 7001da177e4SLinus Torvalds } 7011da177e4SLinus Torvalds 7021da177e4SLinus Torvalds meta_ops(v)->get(skb, info, v, dst, &err); 7031da177e4SLinus Torvalds if (err < 0) 7041da177e4SLinus Torvalds return err; 7051da177e4SLinus Torvalds 7061da177e4SLinus Torvalds if (meta_type_ops(v)->apply_extras) 7071da177e4SLinus Torvalds meta_type_ops(v)->apply_extras(v, dst); 7081da177e4SLinus Torvalds 7091da177e4SLinus Torvalds return 0; 7101da177e4SLinus Torvalds } 7111da177e4SLinus Torvalds 7121da177e4SLinus Torvalds static int em_meta_match(struct sk_buff *skb, struct tcf_ematch *m, 7131da177e4SLinus Torvalds struct tcf_pkt_info *info) 7141da177e4SLinus Torvalds { 7151da177e4SLinus Torvalds int r; 7161da177e4SLinus Torvalds struct meta_match *meta = (struct meta_match *) m->data; 7171da177e4SLinus Torvalds struct meta_obj l_value, r_value; 7181da177e4SLinus Torvalds 7191da177e4SLinus Torvalds if (meta_get(skb, info, &meta->lvalue, &l_value) < 0 || 7201da177e4SLinus Torvalds meta_get(skb, info, &meta->rvalue, &r_value) < 0) 7211da177e4SLinus Torvalds return 0; 7221da177e4SLinus Torvalds 7231da177e4SLinus Torvalds r = meta_type_ops(&meta->lvalue)->compare(&l_value, &r_value); 7241da177e4SLinus Torvalds 7251da177e4SLinus Torvalds switch (meta->lvalue.hdr.op) { 7261da177e4SLinus Torvalds case TCF_EM_OPND_EQ: 7271da177e4SLinus Torvalds return !r; 7281da177e4SLinus Torvalds case TCF_EM_OPND_LT: 7291da177e4SLinus Torvalds return r < 0; 7301da177e4SLinus Torvalds case TCF_EM_OPND_GT: 7311da177e4SLinus Torvalds return r > 0; 7321da177e4SLinus Torvalds } 7331da177e4SLinus Torvalds 7341da177e4SLinus Torvalds return 0; 7351da177e4SLinus Torvalds } 7361da177e4SLinus Torvalds 737ed7af3b3SStephen Hemminger static void meta_delete(struct meta_match *meta) 7381da177e4SLinus Torvalds { 73904f217acSStephen Hemminger if (meta) { 7401da177e4SLinus Torvalds struct meta_type_ops *ops = meta_type_ops(&meta->lvalue); 7411da177e4SLinus Torvalds 7421da177e4SLinus Torvalds if (ops && ops->destroy) { 7431da177e4SLinus Torvalds ops->destroy(&meta->lvalue); 7441da177e4SLinus Torvalds ops->destroy(&meta->rvalue); 7451da177e4SLinus Torvalds } 74604f217acSStephen Hemminger } 7471da177e4SLinus Torvalds 7481da177e4SLinus Torvalds kfree(meta); 7491da177e4SLinus Torvalds } 7501da177e4SLinus Torvalds 751add93b61SPatrick McHardy static inline int meta_change_data(struct meta_value *dst, struct nlattr *nla) 7521da177e4SLinus Torvalds { 753add93b61SPatrick McHardy if (nla) { 754add93b61SPatrick McHardy if (nla_len(nla) == 0) 7551da177e4SLinus Torvalds return -EINVAL; 7561da177e4SLinus Torvalds 757add93b61SPatrick McHardy return meta_type_ops(dst)->change(dst, nla); 7581da177e4SLinus Torvalds } 7591da177e4SLinus Torvalds 7601da177e4SLinus Torvalds return 0; 7611da177e4SLinus Torvalds } 7621da177e4SLinus Torvalds 7631da177e4SLinus Torvalds static inline int meta_is_supported(struct meta_value *val) 7641da177e4SLinus Torvalds { 765cc7ec456SEric Dumazet return !meta_id(val) || meta_ops(val)->get; 7661da177e4SLinus Torvalds } 7671da177e4SLinus Torvalds 7687a9c1bd4SPatrick McHardy static const struct nla_policy meta_policy[TCA_EM_META_MAX + 1] = { 7697a9c1bd4SPatrick McHardy [TCA_EM_META_HDR] = { .len = sizeof(struct tcf_meta_hdr) }, 7707a9c1bd4SPatrick McHardy }; 7717a9c1bd4SPatrick McHardy 7721da177e4SLinus Torvalds static int em_meta_change(struct tcf_proto *tp, void *data, int len, 7731da177e4SLinus Torvalds struct tcf_ematch *m) 7741da177e4SLinus Torvalds { 775cee63723SPatrick McHardy int err; 776add93b61SPatrick McHardy struct nlattr *tb[TCA_EM_META_MAX + 1]; 7771da177e4SLinus Torvalds struct tcf_meta_hdr *hdr; 7781da177e4SLinus Torvalds struct meta_match *meta = NULL; 7791da177e4SLinus Torvalds 7807a9c1bd4SPatrick McHardy err = nla_parse(tb, TCA_EM_META_MAX, data, len, meta_policy); 781cee63723SPatrick McHardy if (err < 0) 7821da177e4SLinus Torvalds goto errout; 7831da177e4SLinus Torvalds 784cee63723SPatrick McHardy err = -EINVAL; 7857a9c1bd4SPatrick McHardy if (tb[TCA_EM_META_HDR] == NULL) 7861da177e4SLinus Torvalds goto errout; 787add93b61SPatrick McHardy hdr = nla_data(tb[TCA_EM_META_HDR]); 7881da177e4SLinus Torvalds 7891da177e4SLinus Torvalds if (TCF_META_TYPE(hdr->left.kind) != TCF_META_TYPE(hdr->right.kind) || 7901da177e4SLinus Torvalds TCF_META_TYPE(hdr->left.kind) > TCF_META_TYPE_MAX || 7911da177e4SLinus Torvalds TCF_META_ID(hdr->left.kind) > TCF_META_ID_MAX || 7921da177e4SLinus Torvalds TCF_META_ID(hdr->right.kind) > TCF_META_ID_MAX) 7931da177e4SLinus Torvalds goto errout; 7941da177e4SLinus Torvalds 7950da974f4SPanagiotis Issaris meta = kzalloc(sizeof(*meta), GFP_KERNEL); 7960c4e4020Sstephen hemminger if (meta == NULL) { 7970c4e4020Sstephen hemminger err = -ENOMEM; 7981da177e4SLinus Torvalds goto errout; 7990c4e4020Sstephen hemminger } 8001da177e4SLinus Torvalds 8011da177e4SLinus Torvalds memcpy(&meta->lvalue.hdr, &hdr->left, sizeof(hdr->left)); 8021da177e4SLinus Torvalds memcpy(&meta->rvalue.hdr, &hdr->right, sizeof(hdr->right)); 8031da177e4SLinus Torvalds 8041da177e4SLinus Torvalds if (!meta_is_supported(&meta->lvalue) || 8051da177e4SLinus Torvalds !meta_is_supported(&meta->rvalue)) { 8061da177e4SLinus Torvalds err = -EOPNOTSUPP; 8071da177e4SLinus Torvalds goto errout; 8081da177e4SLinus Torvalds } 8091da177e4SLinus Torvalds 810add93b61SPatrick McHardy if (meta_change_data(&meta->lvalue, tb[TCA_EM_META_LVALUE]) < 0 || 811add93b61SPatrick McHardy meta_change_data(&meta->rvalue, tb[TCA_EM_META_RVALUE]) < 0) 8121da177e4SLinus Torvalds goto errout; 8131da177e4SLinus Torvalds 8141da177e4SLinus Torvalds m->datalen = sizeof(*meta); 8151da177e4SLinus Torvalds m->data = (unsigned long) meta; 8161da177e4SLinus Torvalds 8171da177e4SLinus Torvalds err = 0; 8181da177e4SLinus Torvalds errout: 8191da177e4SLinus Torvalds if (err && meta) 8201da177e4SLinus Torvalds meta_delete(meta); 8211da177e4SLinus Torvalds return err; 8221da177e4SLinus Torvalds } 8231da177e4SLinus Torvalds 8241da177e4SLinus Torvalds static void em_meta_destroy(struct tcf_proto *tp, struct tcf_ematch *m) 8251da177e4SLinus Torvalds { 8261da177e4SLinus Torvalds if (m) 8271da177e4SLinus Torvalds meta_delete((struct meta_match *) m->data); 8281da177e4SLinus Torvalds } 8291da177e4SLinus Torvalds 8301da177e4SLinus Torvalds static int em_meta_dump(struct sk_buff *skb, struct tcf_ematch *em) 8311da177e4SLinus Torvalds { 8321da177e4SLinus Torvalds struct meta_match *meta = (struct meta_match *) em->data; 8331da177e4SLinus Torvalds struct tcf_meta_hdr hdr; 8341da177e4SLinus Torvalds struct meta_type_ops *ops; 8351da177e4SLinus Torvalds 8361da177e4SLinus Torvalds memset(&hdr, 0, sizeof(hdr)); 8371da177e4SLinus Torvalds memcpy(&hdr.left, &meta->lvalue.hdr, sizeof(hdr.left)); 8381da177e4SLinus Torvalds memcpy(&hdr.right, &meta->rvalue.hdr, sizeof(hdr.right)); 8391da177e4SLinus Torvalds 8401b34ec43SDavid S. Miller if (nla_put(skb, TCA_EM_META_HDR, sizeof(hdr), &hdr)) 8411b34ec43SDavid S. Miller goto nla_put_failure; 8421da177e4SLinus Torvalds 8431da177e4SLinus Torvalds ops = meta_type_ops(&meta->lvalue); 8441da177e4SLinus Torvalds if (ops->dump(skb, &meta->lvalue, TCA_EM_META_LVALUE) < 0 || 8451da177e4SLinus Torvalds ops->dump(skb, &meta->rvalue, TCA_EM_META_RVALUE) < 0) 846add93b61SPatrick McHardy goto nla_put_failure; 8471da177e4SLinus Torvalds 8481da177e4SLinus Torvalds return 0; 8491da177e4SLinus Torvalds 850add93b61SPatrick McHardy nla_put_failure: 8511da177e4SLinus Torvalds return -1; 8521da177e4SLinus Torvalds } 8531da177e4SLinus Torvalds 8541da177e4SLinus Torvalds static struct tcf_ematch_ops em_meta_ops = { 8551da177e4SLinus Torvalds .kind = TCF_EM_META, 8561da177e4SLinus Torvalds .change = em_meta_change, 8571da177e4SLinus Torvalds .match = em_meta_match, 8581da177e4SLinus Torvalds .destroy = em_meta_destroy, 8591da177e4SLinus Torvalds .dump = em_meta_dump, 8601da177e4SLinus Torvalds .owner = THIS_MODULE, 8611da177e4SLinus Torvalds .link = LIST_HEAD_INIT(em_meta_ops.link) 8621da177e4SLinus Torvalds }; 8631da177e4SLinus Torvalds 8641da177e4SLinus Torvalds static int __init init_em_meta(void) 8651da177e4SLinus Torvalds { 8661da177e4SLinus Torvalds return tcf_em_register(&em_meta_ops); 8671da177e4SLinus Torvalds } 8681da177e4SLinus Torvalds 8691da177e4SLinus Torvalds static void __exit exit_em_meta(void) 8701da177e4SLinus Torvalds { 8711da177e4SLinus Torvalds tcf_em_unregister(&em_meta_ops); 8721da177e4SLinus Torvalds } 8731da177e4SLinus Torvalds 8741da177e4SLinus Torvalds MODULE_LICENSE("GPL"); 8751da177e4SLinus Torvalds 8761da177e4SLinus Torvalds module_init(init_em_meta); 8771da177e4SLinus Torvalds module_exit(exit_em_meta); 878db3d99c0SPatrick McHardy 879db3d99c0SPatrick McHardy MODULE_ALIAS_TCF_EMATCH(TCF_EM_META); 880