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 2744f8f61ebSYang Yingliang #define skip_nonlocal(skb) \ 2754f8f61ebSYang Yingliang (unlikely(skb->sk == NULL)) 27648900629SThomas Graf 27748900629SThomas Graf META_COLLECTOR(int_sk_family) 27848900629SThomas Graf { 2794f8f61ebSYang Yingliang if (skip_nonlocal(skb)) { 2804f8f61ebSYang Yingliang *err = -1; 2814f8f61ebSYang Yingliang return; 2824f8f61ebSYang Yingliang } 28348900629SThomas Graf dst->value = skb->sk->sk_family; 28448900629SThomas Graf } 28548900629SThomas Graf 28648900629SThomas Graf META_COLLECTOR(int_sk_state) 28748900629SThomas Graf { 2884f8f61ebSYang Yingliang if (skip_nonlocal(skb)) { 2894f8f61ebSYang Yingliang *err = -1; 2904f8f61ebSYang Yingliang return; 2914f8f61ebSYang Yingliang } 29248900629SThomas Graf dst->value = skb->sk->sk_state; 29348900629SThomas Graf } 29448900629SThomas Graf 29548900629SThomas Graf META_COLLECTOR(int_sk_reuse) 29648900629SThomas Graf { 2974f8f61ebSYang Yingliang if (skip_nonlocal(skb)) { 2984f8f61ebSYang Yingliang *err = -1; 2994f8f61ebSYang Yingliang return; 3004f8f61ebSYang Yingliang } 30148900629SThomas Graf dst->value = skb->sk->sk_reuse; 30248900629SThomas Graf } 30348900629SThomas Graf 30448900629SThomas Graf META_COLLECTOR(int_sk_bound_if) 30548900629SThomas Graf { 3064f8f61ebSYang Yingliang if (skip_nonlocal(skb)) { 3074f8f61ebSYang Yingliang *err = -1; 3084f8f61ebSYang Yingliang return; 3094f8f61ebSYang Yingliang } 31048900629SThomas Graf /* No error if bound_dev_if is 0, legal userspace check */ 31148900629SThomas Graf dst->value = skb->sk->sk_bound_dev_if; 31248900629SThomas Graf } 31348900629SThomas Graf 31448900629SThomas Graf META_COLLECTOR(var_sk_bound_if) 31548900629SThomas Graf { 3164f8f61ebSYang Yingliang if (skip_nonlocal(skb)) { 3174f8f61ebSYang Yingliang *err = -1; 3184f8f61ebSYang Yingliang return; 3194f8f61ebSYang Yingliang } 32048900629SThomas Graf 32148900629SThomas Graf if (skb->sk->sk_bound_dev_if == 0) { 32248900629SThomas Graf dst->value = (unsigned long) "any"; 32348900629SThomas Graf dst->len = 3; 32448900629SThomas Graf } else { 32548900629SThomas Graf struct net_device *dev; 32648900629SThomas Graf 327d0075634SEric Dumazet rcu_read_lock(); 3282939e275SEric Dumazet dev = dev_get_by_index_rcu(sock_net(skb->sk), 3292939e275SEric Dumazet skb->sk->sk_bound_dev_if); 33048900629SThomas Graf *err = var_dev(dev, dst); 331d0075634SEric Dumazet rcu_read_unlock(); 33248900629SThomas Graf } 33348900629SThomas Graf } 33448900629SThomas Graf 33548900629SThomas Graf META_COLLECTOR(int_sk_refcnt) 33648900629SThomas Graf { 3374f8f61ebSYang Yingliang if (skip_nonlocal(skb)) { 3384f8f61ebSYang Yingliang *err = -1; 3394f8f61ebSYang Yingliang return; 3404f8f61ebSYang Yingliang } 34148900629SThomas Graf dst->value = atomic_read(&skb->sk->sk_refcnt); 34248900629SThomas Graf } 34348900629SThomas Graf 34448900629SThomas Graf META_COLLECTOR(int_sk_rcvbuf) 34548900629SThomas Graf { 3464f8f61ebSYang Yingliang if (skip_nonlocal(skb)) { 3474f8f61ebSYang Yingliang *err = -1; 3484f8f61ebSYang Yingliang return; 3494f8f61ebSYang Yingliang } 35048900629SThomas Graf dst->value = skb->sk->sk_rcvbuf; 35148900629SThomas Graf } 35248900629SThomas Graf 35348900629SThomas Graf META_COLLECTOR(int_sk_shutdown) 35448900629SThomas Graf { 3554f8f61ebSYang Yingliang if (skip_nonlocal(skb)) { 3564f8f61ebSYang Yingliang *err = -1; 3574f8f61ebSYang Yingliang return; 3584f8f61ebSYang Yingliang } 35948900629SThomas Graf dst->value = skb->sk->sk_shutdown; 36048900629SThomas Graf } 36148900629SThomas Graf 36248900629SThomas Graf META_COLLECTOR(int_sk_proto) 36348900629SThomas Graf { 3644f8f61ebSYang Yingliang if (skip_nonlocal(skb)) { 3654f8f61ebSYang Yingliang *err = -1; 3664f8f61ebSYang Yingliang return; 3674f8f61ebSYang Yingliang } 36848900629SThomas Graf dst->value = skb->sk->sk_protocol; 36948900629SThomas Graf } 37048900629SThomas Graf 37148900629SThomas Graf META_COLLECTOR(int_sk_type) 37248900629SThomas Graf { 3734f8f61ebSYang Yingliang if (skip_nonlocal(skb)) { 3744f8f61ebSYang Yingliang *err = -1; 3754f8f61ebSYang Yingliang return; 3764f8f61ebSYang Yingliang } 37748900629SThomas Graf dst->value = skb->sk->sk_type; 37848900629SThomas Graf } 37948900629SThomas Graf 38048900629SThomas Graf META_COLLECTOR(int_sk_rmem_alloc) 38148900629SThomas Graf { 3824f8f61ebSYang Yingliang if (skip_nonlocal(skb)) { 3834f8f61ebSYang Yingliang *err = -1; 3844f8f61ebSYang Yingliang return; 3854f8f61ebSYang Yingliang } 38631e6d363SEric Dumazet dst->value = sk_rmem_alloc_get(skb->sk); 38748900629SThomas Graf } 38848900629SThomas Graf 38948900629SThomas Graf META_COLLECTOR(int_sk_wmem_alloc) 39048900629SThomas Graf { 3914f8f61ebSYang Yingliang if (skip_nonlocal(skb)) { 3924f8f61ebSYang Yingliang *err = -1; 3934f8f61ebSYang Yingliang return; 3944f8f61ebSYang Yingliang } 39531e6d363SEric Dumazet dst->value = sk_wmem_alloc_get(skb->sk); 39648900629SThomas Graf } 39748900629SThomas Graf 39848900629SThomas Graf META_COLLECTOR(int_sk_omem_alloc) 39948900629SThomas Graf { 4004f8f61ebSYang Yingliang if (skip_nonlocal(skb)) { 4014f8f61ebSYang Yingliang *err = -1; 4024f8f61ebSYang Yingliang return; 4034f8f61ebSYang Yingliang } 40448900629SThomas Graf dst->value = atomic_read(&skb->sk->sk_omem_alloc); 40548900629SThomas Graf } 40648900629SThomas Graf 40748900629SThomas Graf META_COLLECTOR(int_sk_rcv_qlen) 40848900629SThomas Graf { 4094f8f61ebSYang Yingliang if (skip_nonlocal(skb)) { 4104f8f61ebSYang Yingliang *err = -1; 4114f8f61ebSYang Yingliang return; 4124f8f61ebSYang Yingliang } 41348900629SThomas Graf dst->value = skb->sk->sk_receive_queue.qlen; 41448900629SThomas Graf } 41548900629SThomas Graf 41648900629SThomas Graf META_COLLECTOR(int_sk_snd_qlen) 41748900629SThomas Graf { 4184f8f61ebSYang Yingliang if (skip_nonlocal(skb)) { 4194f8f61ebSYang Yingliang *err = -1; 4204f8f61ebSYang Yingliang return; 4214f8f61ebSYang Yingliang } 42248900629SThomas Graf dst->value = skb->sk->sk_write_queue.qlen; 42348900629SThomas Graf } 42448900629SThomas Graf 42548900629SThomas Graf META_COLLECTOR(int_sk_wmem_queued) 42648900629SThomas Graf { 4274f8f61ebSYang Yingliang if (skip_nonlocal(skb)) { 4284f8f61ebSYang Yingliang *err = -1; 4294f8f61ebSYang Yingliang return; 4304f8f61ebSYang Yingliang } 43148900629SThomas Graf dst->value = skb->sk->sk_wmem_queued; 43248900629SThomas Graf } 43348900629SThomas Graf 43448900629SThomas Graf META_COLLECTOR(int_sk_fwd_alloc) 43548900629SThomas Graf { 4364f8f61ebSYang Yingliang if (skip_nonlocal(skb)) { 4374f8f61ebSYang Yingliang *err = -1; 4384f8f61ebSYang Yingliang return; 4394f8f61ebSYang Yingliang } 44048900629SThomas Graf dst->value = skb->sk->sk_forward_alloc; 44148900629SThomas Graf } 44248900629SThomas Graf 44348900629SThomas Graf META_COLLECTOR(int_sk_sndbuf) 44448900629SThomas Graf { 4454f8f61ebSYang Yingliang if (skip_nonlocal(skb)) { 4464f8f61ebSYang Yingliang *err = -1; 4474f8f61ebSYang Yingliang return; 4484f8f61ebSYang Yingliang } 44948900629SThomas Graf dst->value = skb->sk->sk_sndbuf; 45048900629SThomas Graf } 45148900629SThomas Graf 45248900629SThomas Graf META_COLLECTOR(int_sk_alloc) 45348900629SThomas Graf { 4544f8f61ebSYang Yingliang if (skip_nonlocal(skb)) { 4554f8f61ebSYang Yingliang *err = -1; 4564f8f61ebSYang Yingliang return; 4574f8f61ebSYang Yingliang } 458e0c56310Sstephen hemminger dst->value = (__force int) skb->sk->sk_allocation; 45948900629SThomas Graf } 46048900629SThomas Graf 46181c3d547SEric Dumazet META_COLLECTOR(int_sk_hash) 46248900629SThomas Graf { 4634f8f61ebSYang Yingliang if (skip_nonlocal(skb)) { 4644f8f61ebSYang Yingliang *err = -1; 4654f8f61ebSYang Yingliang return; 4664f8f61ebSYang Yingliang } 46781c3d547SEric Dumazet dst->value = skb->sk->sk_hash; 46848900629SThomas Graf } 46948900629SThomas Graf 47048900629SThomas Graf META_COLLECTOR(int_sk_lingertime) 47148900629SThomas Graf { 4724f8f61ebSYang Yingliang if (skip_nonlocal(skb)) { 4734f8f61ebSYang Yingliang *err = -1; 4744f8f61ebSYang Yingliang return; 4754f8f61ebSYang Yingliang } 47648900629SThomas Graf dst->value = skb->sk->sk_lingertime / HZ; 47748900629SThomas Graf } 47848900629SThomas Graf 47948900629SThomas Graf META_COLLECTOR(int_sk_err_qlen) 48048900629SThomas Graf { 4814f8f61ebSYang Yingliang if (skip_nonlocal(skb)) { 4824f8f61ebSYang Yingliang *err = -1; 4834f8f61ebSYang Yingliang return; 4844f8f61ebSYang Yingliang } 48548900629SThomas Graf dst->value = skb->sk->sk_error_queue.qlen; 48648900629SThomas Graf } 48748900629SThomas Graf 48848900629SThomas Graf META_COLLECTOR(int_sk_ack_bl) 48948900629SThomas Graf { 4904f8f61ebSYang Yingliang if (skip_nonlocal(skb)) { 4914f8f61ebSYang Yingliang *err = -1; 4924f8f61ebSYang Yingliang return; 4934f8f61ebSYang Yingliang } 49448900629SThomas Graf dst->value = skb->sk->sk_ack_backlog; 49548900629SThomas Graf } 49648900629SThomas Graf 49748900629SThomas Graf META_COLLECTOR(int_sk_max_ack_bl) 49848900629SThomas Graf { 4994f8f61ebSYang Yingliang if (skip_nonlocal(skb)) { 5004f8f61ebSYang Yingliang *err = -1; 5014f8f61ebSYang Yingliang return; 5024f8f61ebSYang Yingliang } 50348900629SThomas Graf dst->value = skb->sk->sk_max_ack_backlog; 50448900629SThomas Graf } 50548900629SThomas Graf 50648900629SThomas Graf META_COLLECTOR(int_sk_prio) 50748900629SThomas Graf { 5084f8f61ebSYang Yingliang if (skip_nonlocal(skb)) { 5094f8f61ebSYang Yingliang *err = -1; 5104f8f61ebSYang Yingliang return; 5114f8f61ebSYang Yingliang } 51248900629SThomas Graf dst->value = skb->sk->sk_priority; 51348900629SThomas Graf } 51448900629SThomas Graf 51548900629SThomas Graf META_COLLECTOR(int_sk_rcvlowat) 51648900629SThomas Graf { 5174f8f61ebSYang Yingliang if (skip_nonlocal(skb)) { 5184f8f61ebSYang Yingliang *err = -1; 5194f8f61ebSYang Yingliang return; 5204f8f61ebSYang Yingliang } 52148900629SThomas Graf dst->value = skb->sk->sk_rcvlowat; 52248900629SThomas Graf } 52348900629SThomas Graf 52448900629SThomas Graf META_COLLECTOR(int_sk_rcvtimeo) 52548900629SThomas Graf { 5264f8f61ebSYang Yingliang if (skip_nonlocal(skb)) { 5274f8f61ebSYang Yingliang *err = -1; 5284f8f61ebSYang Yingliang return; 5294f8f61ebSYang Yingliang } 53048900629SThomas Graf dst->value = skb->sk->sk_rcvtimeo / HZ; 53148900629SThomas Graf } 53248900629SThomas Graf 53348900629SThomas Graf META_COLLECTOR(int_sk_sndtimeo) 53448900629SThomas Graf { 5354f8f61ebSYang Yingliang if (skip_nonlocal(skb)) { 5364f8f61ebSYang Yingliang *err = -1; 5374f8f61ebSYang Yingliang return; 5384f8f61ebSYang Yingliang } 53948900629SThomas Graf dst->value = skb->sk->sk_sndtimeo / HZ; 54048900629SThomas Graf } 54148900629SThomas Graf 54248900629SThomas Graf META_COLLECTOR(int_sk_sendmsg_off) 54348900629SThomas Graf { 5444f8f61ebSYang Yingliang if (skip_nonlocal(skb)) { 5454f8f61ebSYang Yingliang *err = -1; 5464f8f61ebSYang Yingliang return; 5474f8f61ebSYang Yingliang } 5485640f768SEric Dumazet dst->value = skb->sk->sk_frag.offset; 54948900629SThomas Graf } 55048900629SThomas Graf 55148900629SThomas Graf META_COLLECTOR(int_sk_write_pend) 55248900629SThomas Graf { 5534f8f61ebSYang Yingliang if (skip_nonlocal(skb)) { 5544f8f61ebSYang Yingliang *err = -1; 5554f8f61ebSYang Yingliang return; 5564f8f61ebSYang Yingliang } 55748900629SThomas Graf dst->value = skb->sk->sk_write_pending; 55848900629SThomas Graf } 55948900629SThomas Graf 56048900629SThomas Graf /************************************************************************** 5611da177e4SLinus Torvalds * Meta value collectors assignment table 5621da177e4SLinus Torvalds **************************************************************************/ 5631da177e4SLinus Torvalds 564cc7ec456SEric Dumazet struct meta_ops { 5651da177e4SLinus Torvalds void (*get)(struct sk_buff *, struct tcf_pkt_info *, 5661da177e4SLinus Torvalds struct meta_value *, struct meta_obj *, int *); 5671da177e4SLinus Torvalds }; 5681da177e4SLinus Torvalds 56948900629SThomas Graf #define META_ID(name) TCF_META_ID_##name 57048900629SThomas Graf #define META_FUNC(name) { .get = meta_##name } 57148900629SThomas Graf 5721da177e4SLinus Torvalds /* Meta value operations table listing all meta value collectors and 5731da177e4SLinus Torvalds * assigns them to a type and meta id. */ 5741da177e4SLinus Torvalds static struct meta_ops __meta_ops[TCF_META_TYPE_MAX + 1][TCF_META_ID_MAX + 1] = { 5751da177e4SLinus Torvalds [TCF_META_TYPE_VAR] = { 57648900629SThomas Graf [META_ID(DEV)] = META_FUNC(var_dev), 57748900629SThomas Graf [META_ID(SK_BOUND_IF)] = META_FUNC(var_sk_bound_if), 5781da177e4SLinus Torvalds }, 5791da177e4SLinus Torvalds [TCF_META_TYPE_INT] = { 58048900629SThomas Graf [META_ID(RANDOM)] = META_FUNC(int_random), 58148900629SThomas Graf [META_ID(LOADAVG_0)] = META_FUNC(int_loadavg_0), 58248900629SThomas Graf [META_ID(LOADAVG_1)] = META_FUNC(int_loadavg_1), 58348900629SThomas Graf [META_ID(LOADAVG_2)] = META_FUNC(int_loadavg_2), 58448900629SThomas Graf [META_ID(DEV)] = META_FUNC(int_dev), 58548900629SThomas Graf [META_ID(PRIORITY)] = META_FUNC(int_priority), 58648900629SThomas Graf [META_ID(PROTOCOL)] = META_FUNC(int_protocol), 58748900629SThomas Graf [META_ID(PKTTYPE)] = META_FUNC(int_pkttype), 58848900629SThomas Graf [META_ID(PKTLEN)] = META_FUNC(int_pktlen), 58948900629SThomas Graf [META_ID(DATALEN)] = META_FUNC(int_datalen), 59048900629SThomas Graf [META_ID(MACLEN)] = META_FUNC(int_maclen), 59182e91ffeSThomas Graf [META_ID(NFMARK)] = META_FUNC(int_mark), 59248900629SThomas Graf [META_ID(TCINDEX)] = META_FUNC(int_tcindex), 59348900629SThomas Graf [META_ID(RTCLASSID)] = META_FUNC(int_rtclassid), 59448900629SThomas Graf [META_ID(RTIIF)] = META_FUNC(int_rtiif), 59548900629SThomas Graf [META_ID(SK_FAMILY)] = META_FUNC(int_sk_family), 59648900629SThomas Graf [META_ID(SK_STATE)] = META_FUNC(int_sk_state), 59748900629SThomas Graf [META_ID(SK_REUSE)] = META_FUNC(int_sk_reuse), 59848900629SThomas Graf [META_ID(SK_BOUND_IF)] = META_FUNC(int_sk_bound_if), 59948900629SThomas Graf [META_ID(SK_REFCNT)] = META_FUNC(int_sk_refcnt), 60048900629SThomas Graf [META_ID(SK_RCVBUF)] = META_FUNC(int_sk_rcvbuf), 60148900629SThomas Graf [META_ID(SK_SNDBUF)] = META_FUNC(int_sk_sndbuf), 60248900629SThomas Graf [META_ID(SK_SHUTDOWN)] = META_FUNC(int_sk_shutdown), 60348900629SThomas Graf [META_ID(SK_PROTO)] = META_FUNC(int_sk_proto), 60448900629SThomas Graf [META_ID(SK_TYPE)] = META_FUNC(int_sk_type), 60548900629SThomas Graf [META_ID(SK_RMEM_ALLOC)] = META_FUNC(int_sk_rmem_alloc), 60648900629SThomas Graf [META_ID(SK_WMEM_ALLOC)] = META_FUNC(int_sk_wmem_alloc), 60748900629SThomas Graf [META_ID(SK_OMEM_ALLOC)] = META_FUNC(int_sk_omem_alloc), 60848900629SThomas Graf [META_ID(SK_WMEM_QUEUED)] = META_FUNC(int_sk_wmem_queued), 60948900629SThomas Graf [META_ID(SK_RCV_QLEN)] = META_FUNC(int_sk_rcv_qlen), 61048900629SThomas Graf [META_ID(SK_SND_QLEN)] = META_FUNC(int_sk_snd_qlen), 61148900629SThomas Graf [META_ID(SK_ERR_QLEN)] = META_FUNC(int_sk_err_qlen), 61248900629SThomas Graf [META_ID(SK_FORWARD_ALLOCS)] = META_FUNC(int_sk_fwd_alloc), 61348900629SThomas Graf [META_ID(SK_ALLOCS)] = META_FUNC(int_sk_alloc), 61481c3d547SEric Dumazet [META_ID(SK_HASH)] = META_FUNC(int_sk_hash), 61548900629SThomas Graf [META_ID(SK_LINGERTIME)] = META_FUNC(int_sk_lingertime), 61648900629SThomas Graf [META_ID(SK_ACK_BACKLOG)] = META_FUNC(int_sk_ack_bl), 61748900629SThomas Graf [META_ID(SK_MAX_ACK_BACKLOG)] = META_FUNC(int_sk_max_ack_bl), 61848900629SThomas Graf [META_ID(SK_PRIO)] = META_FUNC(int_sk_prio), 61948900629SThomas Graf [META_ID(SK_RCVLOWAT)] = META_FUNC(int_sk_rcvlowat), 62048900629SThomas Graf [META_ID(SK_RCVTIMEO)] = META_FUNC(int_sk_rcvtimeo), 62148900629SThomas Graf [META_ID(SK_SNDTIMEO)] = META_FUNC(int_sk_sndtimeo), 62248900629SThomas Graf [META_ID(SK_SENDMSG_OFF)] = META_FUNC(int_sk_sendmsg_off), 62348900629SThomas Graf [META_ID(SK_WRITE_PENDING)] = META_FUNC(int_sk_write_pend), 6243113e88cSStephen Hemminger [META_ID(VLAN_TAG)] = META_FUNC(int_vlan_tag), 625c2e3143eSStephen Hemminger [META_ID(RXHASH)] = META_FUNC(int_rxhash), 6261da177e4SLinus Torvalds } 6271da177e4SLinus Torvalds }; 6281da177e4SLinus Torvalds 6291da177e4SLinus Torvalds static inline struct meta_ops *meta_ops(struct meta_value *val) 6301da177e4SLinus Torvalds { 6311da177e4SLinus Torvalds return &__meta_ops[meta_type(val)][meta_id(val)]; 6321da177e4SLinus Torvalds } 6331da177e4SLinus Torvalds 6341da177e4SLinus Torvalds /************************************************************************** 6351da177e4SLinus Torvalds * Type specific operations for TCF_META_TYPE_VAR 6361da177e4SLinus Torvalds **************************************************************************/ 6371da177e4SLinus Torvalds 6381da177e4SLinus Torvalds static int meta_var_compare(struct meta_obj *a, struct meta_obj *b) 6391da177e4SLinus Torvalds { 6401da177e4SLinus Torvalds int r = a->len - b->len; 6411da177e4SLinus Torvalds 6421da177e4SLinus Torvalds if (r == 0) 6431da177e4SLinus Torvalds r = memcmp((void *) a->value, (void *) b->value, a->len); 6441da177e4SLinus Torvalds 6451da177e4SLinus Torvalds return r; 6461da177e4SLinus Torvalds } 6471da177e4SLinus Torvalds 648add93b61SPatrick McHardy static int meta_var_change(struct meta_value *dst, struct nlattr *nla) 6491da177e4SLinus Torvalds { 650add93b61SPatrick McHardy int len = nla_len(nla); 6511da177e4SLinus Torvalds 652add93b61SPatrick McHardy dst->val = (unsigned long)kmemdup(nla_data(nla), len, GFP_KERNEL); 6531da177e4SLinus Torvalds if (dst->val == 0UL) 6541da177e4SLinus Torvalds return -ENOMEM; 6551da177e4SLinus Torvalds dst->len = len; 6561da177e4SLinus Torvalds return 0; 6571da177e4SLinus Torvalds } 6581da177e4SLinus Torvalds 6591da177e4SLinus Torvalds static void meta_var_destroy(struct meta_value *v) 6601da177e4SLinus Torvalds { 6611da177e4SLinus Torvalds kfree((void *) v->val); 6621da177e4SLinus Torvalds } 6631da177e4SLinus Torvalds 6641da177e4SLinus Torvalds static void meta_var_apply_extras(struct meta_value *v, 6651da177e4SLinus Torvalds struct meta_obj *dst) 6661da177e4SLinus Torvalds { 6671da177e4SLinus Torvalds int shift = v->hdr.shift; 6681da177e4SLinus Torvalds 6691da177e4SLinus Torvalds if (shift && shift < dst->len) 6701da177e4SLinus Torvalds dst->len -= shift; 6711da177e4SLinus Torvalds } 6721da177e4SLinus Torvalds 6731da177e4SLinus Torvalds static int meta_var_dump(struct sk_buff *skb, struct meta_value *v, int tlv) 6741da177e4SLinus Torvalds { 6751b34ec43SDavid S. Miller if (v->val && v->len && 6761b34ec43SDavid S. Miller nla_put(skb, tlv, v->len, (void *) v->val)) 6771b34ec43SDavid S. Miller goto nla_put_failure; 6781da177e4SLinus Torvalds return 0; 6791da177e4SLinus Torvalds 680add93b61SPatrick McHardy nla_put_failure: 6811da177e4SLinus Torvalds return -1; 6821da177e4SLinus Torvalds } 6831da177e4SLinus Torvalds 6841da177e4SLinus Torvalds /************************************************************************** 6851da177e4SLinus Torvalds * Type specific operations for TCF_META_TYPE_INT 6861da177e4SLinus Torvalds **************************************************************************/ 6871da177e4SLinus Torvalds 6881da177e4SLinus Torvalds static int meta_int_compare(struct meta_obj *a, struct meta_obj *b) 6891da177e4SLinus Torvalds { 6901da177e4SLinus Torvalds /* Let gcc optimize it, the unlikely is not really based on 6911da177e4SLinus Torvalds * some numbers but jump free code for mismatches seems 6921da177e4SLinus Torvalds * more logical. */ 69398e56405SThomas Graf if (unlikely(a->value == b->value)) 6941da177e4SLinus Torvalds return 0; 69598e56405SThomas Graf else if (a->value < b->value) 6961da177e4SLinus Torvalds return -1; 6971da177e4SLinus Torvalds else 6981da177e4SLinus Torvalds return 1; 6991da177e4SLinus Torvalds } 7001da177e4SLinus Torvalds 701add93b61SPatrick McHardy static int meta_int_change(struct meta_value *dst, struct nlattr *nla) 7021da177e4SLinus Torvalds { 703add93b61SPatrick McHardy if (nla_len(nla) >= sizeof(unsigned long)) { 704add93b61SPatrick McHardy dst->val = *(unsigned long *) nla_data(nla); 7051da177e4SLinus Torvalds dst->len = sizeof(unsigned long); 706add93b61SPatrick McHardy } else if (nla_len(nla) == sizeof(u32)) { 7071587bac4SPatrick McHardy dst->val = nla_get_u32(nla); 7081da177e4SLinus Torvalds dst->len = sizeof(u32); 7091da177e4SLinus Torvalds } else 7101da177e4SLinus Torvalds return -EINVAL; 7111da177e4SLinus Torvalds 7121da177e4SLinus Torvalds return 0; 7131da177e4SLinus Torvalds } 7141da177e4SLinus Torvalds 7151da177e4SLinus Torvalds static void meta_int_apply_extras(struct meta_value *v, 7161da177e4SLinus Torvalds struct meta_obj *dst) 7171da177e4SLinus Torvalds { 7181da177e4SLinus Torvalds if (v->hdr.shift) 7191da177e4SLinus Torvalds dst->value >>= v->hdr.shift; 7201da177e4SLinus Torvalds 7211da177e4SLinus Torvalds if (v->val) 7221da177e4SLinus Torvalds dst->value &= v->val; 7231da177e4SLinus Torvalds } 7241da177e4SLinus Torvalds 7251da177e4SLinus Torvalds static int meta_int_dump(struct sk_buff *skb, struct meta_value *v, int tlv) 7261da177e4SLinus Torvalds { 7271b34ec43SDavid S. Miller if (v->len == sizeof(unsigned long)) { 7281b34ec43SDavid S. Miller if (nla_put(skb, tlv, sizeof(unsigned long), &v->val)) 7291b34ec43SDavid S. Miller goto nla_put_failure; 7301b34ec43SDavid S. Miller } else if (v->len == sizeof(u32)) { 7311b34ec43SDavid S. Miller if (nla_put_u32(skb, tlv, v->val)) 7321b34ec43SDavid S. Miller goto nla_put_failure; 7331b34ec43SDavid S. Miller } 7341da177e4SLinus Torvalds 7351da177e4SLinus Torvalds return 0; 7361da177e4SLinus Torvalds 737add93b61SPatrick McHardy nla_put_failure: 7381da177e4SLinus Torvalds return -1; 7391da177e4SLinus Torvalds } 7401da177e4SLinus Torvalds 7411da177e4SLinus Torvalds /************************************************************************** 7421da177e4SLinus Torvalds * Type specific operations table 7431da177e4SLinus Torvalds **************************************************************************/ 7441da177e4SLinus Torvalds 745cc7ec456SEric Dumazet struct meta_type_ops { 7461da177e4SLinus Torvalds void (*destroy)(struct meta_value *); 7471da177e4SLinus Torvalds int (*compare)(struct meta_obj *, struct meta_obj *); 748add93b61SPatrick McHardy int (*change)(struct meta_value *, struct nlattr *); 7491da177e4SLinus Torvalds void (*apply_extras)(struct meta_value *, struct meta_obj *); 7501da177e4SLinus Torvalds int (*dump)(struct sk_buff *, struct meta_value *, int); 7511da177e4SLinus Torvalds }; 7521da177e4SLinus Torvalds 7531da177e4SLinus Torvalds static struct meta_type_ops __meta_type_ops[TCF_META_TYPE_MAX + 1] = { 7541da177e4SLinus Torvalds [TCF_META_TYPE_VAR] = { 7551da177e4SLinus Torvalds .destroy = meta_var_destroy, 7561da177e4SLinus Torvalds .compare = meta_var_compare, 7571da177e4SLinus Torvalds .change = meta_var_change, 7581da177e4SLinus Torvalds .apply_extras = meta_var_apply_extras, 7591da177e4SLinus Torvalds .dump = meta_var_dump 7601da177e4SLinus Torvalds }, 7611da177e4SLinus Torvalds [TCF_META_TYPE_INT] = { 7621da177e4SLinus Torvalds .compare = meta_int_compare, 7631da177e4SLinus Torvalds .change = meta_int_change, 7641da177e4SLinus Torvalds .apply_extras = meta_int_apply_extras, 7651da177e4SLinus Torvalds .dump = meta_int_dump 7661da177e4SLinus Torvalds } 7671da177e4SLinus Torvalds }; 7681da177e4SLinus Torvalds 7691da177e4SLinus Torvalds static inline struct meta_type_ops *meta_type_ops(struct meta_value *v) 7701da177e4SLinus Torvalds { 7711da177e4SLinus Torvalds return &__meta_type_ops[meta_type(v)]; 7721da177e4SLinus Torvalds } 7731da177e4SLinus Torvalds 7741da177e4SLinus Torvalds /************************************************************************** 7751da177e4SLinus Torvalds * Core 7761da177e4SLinus Torvalds **************************************************************************/ 7771da177e4SLinus Torvalds 778ed7af3b3SStephen Hemminger static int meta_get(struct sk_buff *skb, struct tcf_pkt_info *info, 7791da177e4SLinus Torvalds struct meta_value *v, struct meta_obj *dst) 7801da177e4SLinus Torvalds { 7811da177e4SLinus Torvalds int err = 0; 7821da177e4SLinus Torvalds 7831da177e4SLinus Torvalds if (meta_id(v) == TCF_META_ID_VALUE) { 7841da177e4SLinus Torvalds dst->value = v->val; 7851da177e4SLinus Torvalds dst->len = v->len; 7861da177e4SLinus Torvalds return 0; 7871da177e4SLinus Torvalds } 7881da177e4SLinus Torvalds 7891da177e4SLinus Torvalds meta_ops(v)->get(skb, info, v, dst, &err); 7901da177e4SLinus Torvalds if (err < 0) 7911da177e4SLinus Torvalds return err; 7921da177e4SLinus Torvalds 7931da177e4SLinus Torvalds if (meta_type_ops(v)->apply_extras) 7941da177e4SLinus Torvalds meta_type_ops(v)->apply_extras(v, dst); 7951da177e4SLinus Torvalds 7961da177e4SLinus Torvalds return 0; 7971da177e4SLinus Torvalds } 7981da177e4SLinus Torvalds 7991da177e4SLinus Torvalds static int em_meta_match(struct sk_buff *skb, struct tcf_ematch *m, 8001da177e4SLinus Torvalds struct tcf_pkt_info *info) 8011da177e4SLinus Torvalds { 8021da177e4SLinus Torvalds int r; 8031da177e4SLinus Torvalds struct meta_match *meta = (struct meta_match *) m->data; 8041da177e4SLinus Torvalds struct meta_obj l_value, r_value; 8051da177e4SLinus Torvalds 8061da177e4SLinus Torvalds if (meta_get(skb, info, &meta->lvalue, &l_value) < 0 || 8071da177e4SLinus Torvalds meta_get(skb, info, &meta->rvalue, &r_value) < 0) 8081da177e4SLinus Torvalds return 0; 8091da177e4SLinus Torvalds 8101da177e4SLinus Torvalds r = meta_type_ops(&meta->lvalue)->compare(&l_value, &r_value); 8111da177e4SLinus Torvalds 8121da177e4SLinus Torvalds switch (meta->lvalue.hdr.op) { 8131da177e4SLinus Torvalds case TCF_EM_OPND_EQ: 8141da177e4SLinus Torvalds return !r; 8151da177e4SLinus Torvalds case TCF_EM_OPND_LT: 8161da177e4SLinus Torvalds return r < 0; 8171da177e4SLinus Torvalds case TCF_EM_OPND_GT: 8181da177e4SLinus Torvalds return r > 0; 8191da177e4SLinus Torvalds } 8201da177e4SLinus Torvalds 8211da177e4SLinus Torvalds return 0; 8221da177e4SLinus Torvalds } 8231da177e4SLinus Torvalds 824ed7af3b3SStephen Hemminger static void meta_delete(struct meta_match *meta) 8251da177e4SLinus Torvalds { 82604f217acSStephen Hemminger if (meta) { 8271da177e4SLinus Torvalds struct meta_type_ops *ops = meta_type_ops(&meta->lvalue); 8281da177e4SLinus Torvalds 8291da177e4SLinus Torvalds if (ops && ops->destroy) { 8301da177e4SLinus Torvalds ops->destroy(&meta->lvalue); 8311da177e4SLinus Torvalds ops->destroy(&meta->rvalue); 8321da177e4SLinus Torvalds } 83304f217acSStephen Hemminger } 8341da177e4SLinus Torvalds 8351da177e4SLinus Torvalds kfree(meta); 8361da177e4SLinus Torvalds } 8371da177e4SLinus Torvalds 838add93b61SPatrick McHardy static inline int meta_change_data(struct meta_value *dst, struct nlattr *nla) 8391da177e4SLinus Torvalds { 840add93b61SPatrick McHardy if (nla) { 841add93b61SPatrick McHardy if (nla_len(nla) == 0) 8421da177e4SLinus Torvalds return -EINVAL; 8431da177e4SLinus Torvalds 844add93b61SPatrick McHardy return meta_type_ops(dst)->change(dst, nla); 8451da177e4SLinus Torvalds } 8461da177e4SLinus Torvalds 8471da177e4SLinus Torvalds return 0; 8481da177e4SLinus Torvalds } 8491da177e4SLinus Torvalds 8501da177e4SLinus Torvalds static inline int meta_is_supported(struct meta_value *val) 8511da177e4SLinus Torvalds { 852cc7ec456SEric Dumazet return !meta_id(val) || meta_ops(val)->get; 8531da177e4SLinus Torvalds } 8541da177e4SLinus Torvalds 8557a9c1bd4SPatrick McHardy static const struct nla_policy meta_policy[TCA_EM_META_MAX + 1] = { 8567a9c1bd4SPatrick McHardy [TCA_EM_META_HDR] = { .len = sizeof(struct tcf_meta_hdr) }, 8577a9c1bd4SPatrick McHardy }; 8587a9c1bd4SPatrick McHardy 8591da177e4SLinus Torvalds static int em_meta_change(struct tcf_proto *tp, void *data, int len, 8601da177e4SLinus Torvalds struct tcf_ematch *m) 8611da177e4SLinus Torvalds { 862cee63723SPatrick McHardy int err; 863add93b61SPatrick McHardy struct nlattr *tb[TCA_EM_META_MAX + 1]; 8641da177e4SLinus Torvalds struct tcf_meta_hdr *hdr; 8651da177e4SLinus Torvalds struct meta_match *meta = NULL; 8661da177e4SLinus Torvalds 8677a9c1bd4SPatrick McHardy err = nla_parse(tb, TCA_EM_META_MAX, data, len, meta_policy); 868cee63723SPatrick McHardy if (err < 0) 8691da177e4SLinus Torvalds goto errout; 8701da177e4SLinus Torvalds 871cee63723SPatrick McHardy err = -EINVAL; 8727a9c1bd4SPatrick McHardy if (tb[TCA_EM_META_HDR] == NULL) 8731da177e4SLinus Torvalds goto errout; 874add93b61SPatrick McHardy hdr = nla_data(tb[TCA_EM_META_HDR]); 8751da177e4SLinus Torvalds 8761da177e4SLinus Torvalds if (TCF_META_TYPE(hdr->left.kind) != TCF_META_TYPE(hdr->right.kind) || 8771da177e4SLinus Torvalds TCF_META_TYPE(hdr->left.kind) > TCF_META_TYPE_MAX || 8781da177e4SLinus Torvalds TCF_META_ID(hdr->left.kind) > TCF_META_ID_MAX || 8791da177e4SLinus Torvalds TCF_META_ID(hdr->right.kind) > TCF_META_ID_MAX) 8801da177e4SLinus Torvalds goto errout; 8811da177e4SLinus Torvalds 8820da974f4SPanagiotis Issaris meta = kzalloc(sizeof(*meta), GFP_KERNEL); 8830c4e4020Sstephen hemminger if (meta == NULL) { 8840c4e4020Sstephen hemminger err = -ENOMEM; 8851da177e4SLinus Torvalds goto errout; 8860c4e4020Sstephen hemminger } 8871da177e4SLinus Torvalds 8881da177e4SLinus Torvalds memcpy(&meta->lvalue.hdr, &hdr->left, sizeof(hdr->left)); 8891da177e4SLinus Torvalds memcpy(&meta->rvalue.hdr, &hdr->right, sizeof(hdr->right)); 8901da177e4SLinus Torvalds 8911da177e4SLinus Torvalds if (!meta_is_supported(&meta->lvalue) || 8921da177e4SLinus Torvalds !meta_is_supported(&meta->rvalue)) { 8931da177e4SLinus Torvalds err = -EOPNOTSUPP; 8941da177e4SLinus Torvalds goto errout; 8951da177e4SLinus Torvalds } 8961da177e4SLinus Torvalds 897add93b61SPatrick McHardy if (meta_change_data(&meta->lvalue, tb[TCA_EM_META_LVALUE]) < 0 || 898add93b61SPatrick McHardy meta_change_data(&meta->rvalue, tb[TCA_EM_META_RVALUE]) < 0) 8991da177e4SLinus Torvalds goto errout; 9001da177e4SLinus Torvalds 9011da177e4SLinus Torvalds m->datalen = sizeof(*meta); 9021da177e4SLinus Torvalds m->data = (unsigned long) meta; 9031da177e4SLinus Torvalds 9041da177e4SLinus Torvalds err = 0; 9051da177e4SLinus Torvalds errout: 9061da177e4SLinus Torvalds if (err && meta) 9071da177e4SLinus Torvalds meta_delete(meta); 9081da177e4SLinus Torvalds return err; 9091da177e4SLinus Torvalds } 9101da177e4SLinus Torvalds 9111da177e4SLinus Torvalds static void em_meta_destroy(struct tcf_proto *tp, struct tcf_ematch *m) 9121da177e4SLinus Torvalds { 9131da177e4SLinus Torvalds if (m) 9141da177e4SLinus Torvalds meta_delete((struct meta_match *) m->data); 9151da177e4SLinus Torvalds } 9161da177e4SLinus Torvalds 9171da177e4SLinus Torvalds static int em_meta_dump(struct sk_buff *skb, struct tcf_ematch *em) 9181da177e4SLinus Torvalds { 9191da177e4SLinus Torvalds struct meta_match *meta = (struct meta_match *) em->data; 9201da177e4SLinus Torvalds struct tcf_meta_hdr hdr; 9211da177e4SLinus Torvalds struct meta_type_ops *ops; 9221da177e4SLinus Torvalds 9231da177e4SLinus Torvalds memset(&hdr, 0, sizeof(hdr)); 9241da177e4SLinus Torvalds memcpy(&hdr.left, &meta->lvalue.hdr, sizeof(hdr.left)); 9251da177e4SLinus Torvalds memcpy(&hdr.right, &meta->rvalue.hdr, sizeof(hdr.right)); 9261da177e4SLinus Torvalds 9271b34ec43SDavid S. Miller if (nla_put(skb, TCA_EM_META_HDR, sizeof(hdr), &hdr)) 9281b34ec43SDavid S. Miller goto nla_put_failure; 9291da177e4SLinus Torvalds 9301da177e4SLinus Torvalds ops = meta_type_ops(&meta->lvalue); 9311da177e4SLinus Torvalds if (ops->dump(skb, &meta->lvalue, TCA_EM_META_LVALUE) < 0 || 9321da177e4SLinus Torvalds ops->dump(skb, &meta->rvalue, TCA_EM_META_RVALUE) < 0) 933add93b61SPatrick McHardy goto nla_put_failure; 9341da177e4SLinus Torvalds 9351da177e4SLinus Torvalds return 0; 9361da177e4SLinus Torvalds 937add93b61SPatrick McHardy nla_put_failure: 9381da177e4SLinus Torvalds return -1; 9391da177e4SLinus Torvalds } 9401da177e4SLinus Torvalds 9411da177e4SLinus Torvalds static struct tcf_ematch_ops em_meta_ops = { 9421da177e4SLinus Torvalds .kind = TCF_EM_META, 9431da177e4SLinus Torvalds .change = em_meta_change, 9441da177e4SLinus Torvalds .match = em_meta_match, 9451da177e4SLinus Torvalds .destroy = em_meta_destroy, 9461da177e4SLinus Torvalds .dump = em_meta_dump, 9471da177e4SLinus Torvalds .owner = THIS_MODULE, 9481da177e4SLinus Torvalds .link = LIST_HEAD_INIT(em_meta_ops.link) 9491da177e4SLinus Torvalds }; 9501da177e4SLinus Torvalds 9511da177e4SLinus Torvalds static int __init init_em_meta(void) 9521da177e4SLinus Torvalds { 9531da177e4SLinus Torvalds return tcf_em_register(&em_meta_ops); 9541da177e4SLinus Torvalds } 9551da177e4SLinus Torvalds 9561da177e4SLinus Torvalds static void __exit exit_em_meta(void) 9571da177e4SLinus Torvalds { 9581da177e4SLinus Torvalds tcf_em_unregister(&em_meta_ops); 9591da177e4SLinus Torvalds } 9601da177e4SLinus Torvalds 9611da177e4SLinus Torvalds MODULE_LICENSE("GPL"); 9621da177e4SLinus Torvalds 9631da177e4SLinus Torvalds module_init(init_em_meta); 9641da177e4SLinus Torvalds module_exit(exit_em_meta); 965db3d99c0SPatrick McHardy 966db3d99c0SPatrick McHardy MODULE_ALIAS_TCF_EMATCH(TCF_EM_META); 967