| YOSHIFUJI Hideaki | 10297b9 | 2007-02-09 23:25:16 +0900 | [diff] [blame] | 1 | /* net/sched/sch_ingress.c - Ingress qdisc | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2 |  *              This program is free software; you can redistribute it and/or | 
 | 3 |  *              modify it under the terms of the GNU General Public License | 
 | 4 |  *              as published by the Free Software Foundation; either version | 
 | 5 |  *              2 of the License, or (at your option) any later version. | 
 | 6 |  * | 
 | 7 |  * Authors:     Jamal Hadi Salim 1999 | 
 | 8 |  */ | 
 | 9 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 10 | #include <linux/module.h> | 
 | 11 | #include <linux/types.h> | 
| Patrick McHardy | 0ba4805 | 2007-07-02 22:49:07 -0700 | [diff] [blame] | 12 | #include <linux/list.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 13 | #include <linux/skbuff.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 14 | #include <linux/rtnetlink.h> | 
| Arnaldo Carvalho de Melo | dc5fc57 | 2007-03-25 23:06:12 -0700 | [diff] [blame] | 15 | #include <net/netlink.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 16 | #include <net/pkt_sched.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 17 |  | 
 | 18 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 19 | struct ingress_qdisc_data { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 20 | 	struct tcf_proto	*filter_list; | 
 | 21 | }; | 
 | 22 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 23 | /* ------------------------- Class/flow operations ------------------------- */ | 
 | 24 |  | 
| Patrick McHardy | 58f4df4 | 2008-01-21 00:11:01 -0800 | [diff] [blame] | 25 | static int ingress_graft(struct Qdisc *sch, unsigned long arg, | 
 | 26 | 			 struct Qdisc *new, struct Qdisc **old) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 27 | { | 
| Patrick McHardy | e037834 | 2008-01-21 00:12:32 -0800 | [diff] [blame] | 28 | 	return -EOPNOTSUPP; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 29 | } | 
 | 30 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 31 | static struct Qdisc *ingress_leaf(struct Qdisc *sch, unsigned long arg) | 
 | 32 | { | 
 | 33 | 	return NULL; | 
 | 34 | } | 
 | 35 |  | 
| Patrick McHardy | 58f4df4 | 2008-01-21 00:11:01 -0800 | [diff] [blame] | 36 | static unsigned long ingress_get(struct Qdisc *sch, u32 classid) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 37 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 38 | 	return TC_H_MIN(classid) + 1; | 
 | 39 | } | 
 | 40 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 41 | static unsigned long ingress_bind_filter(struct Qdisc *sch, | 
| Patrick McHardy | 58f4df4 | 2008-01-21 00:11:01 -0800 | [diff] [blame] | 42 | 					 unsigned long parent, u32 classid) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 43 | { | 
 | 44 | 	return ingress_get(sch, classid); | 
 | 45 | } | 
 | 46 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 47 | static void ingress_put(struct Qdisc *sch, unsigned long cl) | 
 | 48 | { | 
 | 49 | } | 
 | 50 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 51 | static int ingress_change(struct Qdisc *sch, u32 classid, u32 parent, | 
| Patrick McHardy | 1e90474 | 2008-01-22 22:11:17 -0800 | [diff] [blame] | 52 | 			  struct nlattr **tca, unsigned long *arg) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 53 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 54 | 	return 0; | 
 | 55 | } | 
 | 56 |  | 
| Patrick McHardy | 58f4df4 | 2008-01-21 00:11:01 -0800 | [diff] [blame] | 57 | static void ingress_walk(struct Qdisc *sch, struct qdisc_walker *walker) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 58 | { | 
| Patrick McHardy | a478122 | 2008-01-21 00:11:21 -0800 | [diff] [blame] | 59 | 	return; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 60 | } | 
 | 61 |  | 
| Patrick McHardy | 58f4df4 | 2008-01-21 00:11:01 -0800 | [diff] [blame] | 62 | static struct tcf_proto **ingress_find_tcf(struct Qdisc *sch, unsigned long cl) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 63 | { | 
| Patrick McHardy | cb53c04 | 2008-01-21 00:11:48 -0800 | [diff] [blame] | 64 | 	struct ingress_qdisc_data *p = qdisc_priv(sch); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 65 |  | 
 | 66 | 	return &p->filter_list; | 
 | 67 | } | 
 | 68 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 69 | /* --------------------------- Qdisc operations ---------------------------- */ | 
 | 70 |  | 
| Patrick McHardy | 58f4df4 | 2008-01-21 00:11:01 -0800 | [diff] [blame] | 71 | static int ingress_enqueue(struct sk_buff *skb, struct Qdisc *sch) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 72 | { | 
| Patrick McHardy | cb53c04 | 2008-01-21 00:11:48 -0800 | [diff] [blame] | 73 | 	struct ingress_qdisc_data *p = qdisc_priv(sch); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 74 | 	struct tcf_result res; | 
 | 75 | 	int result; | 
 | 76 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 77 | 	result = tc_classify(skb, p->filter_list, &res); | 
| Patrick McHardy | a478122 | 2008-01-21 00:11:21 -0800 | [diff] [blame] | 78 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 79 | 	sch->bstats.packets++; | 
 | 80 | 	sch->bstats.bytes += skb->len; | 
 | 81 | 	switch (result) { | 
| Patrick McHardy | 58f4df4 | 2008-01-21 00:11:01 -0800 | [diff] [blame] | 82 | 	case TC_ACT_SHOT: | 
 | 83 | 		result = TC_ACT_SHOT; | 
 | 84 | 		sch->qstats.drops++; | 
 | 85 | 		break; | 
 | 86 | 	case TC_ACT_STOLEN: | 
 | 87 | 	case TC_ACT_QUEUED: | 
 | 88 | 		result = TC_ACT_STOLEN; | 
 | 89 | 		break; | 
 | 90 | 	case TC_ACT_RECLASSIFY: | 
 | 91 | 	case TC_ACT_OK: | 
 | 92 | 		skb->tc_index = TC_H_MIN(res.classid); | 
 | 93 | 	default: | 
 | 94 | 		result = TC_ACT_OK; | 
 | 95 | 		break; | 
| Stephen Hemminger | 3ff50b7 | 2007-04-20 17:09:22 -0700 | [diff] [blame] | 96 | 	} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 97 |  | 
 | 98 | 	return result; | 
 | 99 | } | 
 | 100 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 101 | /* ------------------------------------------------------------- */ | 
 | 102 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 103 | static void ingress_destroy(struct Qdisc *sch) | 
 | 104 | { | 
| Patrick McHardy | cb53c04 | 2008-01-21 00:11:48 -0800 | [diff] [blame] | 105 | 	struct ingress_qdisc_data *p = qdisc_priv(sch); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 106 |  | 
| Patrick McHardy | a48b5a6 | 2007-03-23 11:29:43 -0700 | [diff] [blame] | 107 | 	tcf_destroy_chain(p->filter_list); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 108 | } | 
 | 109 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 110 | static int ingress_dump(struct Qdisc *sch, struct sk_buff *skb) | 
 | 111 | { | 
| Patrick McHardy | 4b3550ef | 2008-01-23 20:34:11 -0800 | [diff] [blame] | 112 | 	struct nlattr *nest; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 113 |  | 
| Patrick McHardy | 4b3550ef | 2008-01-23 20:34:11 -0800 | [diff] [blame] | 114 | 	nest = nla_nest_start(skb, TCA_OPTIONS); | 
 | 115 | 	if (nest == NULL) | 
 | 116 | 		goto nla_put_failure; | 
 | 117 | 	nla_nest_end(skb, nest); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 118 | 	return skb->len; | 
 | 119 |  | 
| Patrick McHardy | 1e90474 | 2008-01-22 22:11:17 -0800 | [diff] [blame] | 120 | nla_put_failure: | 
| Patrick McHardy | 4b3550ef | 2008-01-23 20:34:11 -0800 | [diff] [blame] | 121 | 	nla_nest_cancel(skb, nest); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 122 | 	return -1; | 
 | 123 | } | 
 | 124 |  | 
| Eric Dumazet | 20fea08 | 2007-11-14 01:44:41 -0800 | [diff] [blame] | 125 | static const struct Qdisc_class_ops ingress_class_ops = { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 126 | 	.graft		=	ingress_graft, | 
 | 127 | 	.leaf		=	ingress_leaf, | 
 | 128 | 	.get		=	ingress_get, | 
 | 129 | 	.put		=	ingress_put, | 
 | 130 | 	.change		=	ingress_change, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 131 | 	.walk		=	ingress_walk, | 
 | 132 | 	.tcf_chain	=	ingress_find_tcf, | 
 | 133 | 	.bind_tcf	=	ingress_bind_filter, | 
 | 134 | 	.unbind_tcf	=	ingress_put, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 135 | }; | 
 | 136 |  | 
| Eric Dumazet | 20fea08 | 2007-11-14 01:44:41 -0800 | [diff] [blame] | 137 | static struct Qdisc_ops ingress_qdisc_ops __read_mostly = { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 138 | 	.cl_ops		=	&ingress_class_ops, | 
 | 139 | 	.id		=	"ingress", | 
 | 140 | 	.priv_size	=	sizeof(struct ingress_qdisc_data), | 
 | 141 | 	.enqueue	=	ingress_enqueue, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 142 | 	.destroy	=	ingress_destroy, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 143 | 	.dump		=	ingress_dump, | 
 | 144 | 	.owner		=	THIS_MODULE, | 
 | 145 | }; | 
 | 146 |  | 
 | 147 | static int __init ingress_module_init(void) | 
 | 148 | { | 
| Patrick McHardy | 8916876 | 2008-01-21 00:14:05 -0800 | [diff] [blame] | 149 | 	return register_qdisc(&ingress_qdisc_ops); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 150 | } | 
| Patrick McHardy | 58f4df4 | 2008-01-21 00:11:01 -0800 | [diff] [blame] | 151 |  | 
| YOSHIFUJI Hideaki | 10297b9 | 2007-02-09 23:25:16 +0900 | [diff] [blame] | 152 | static void __exit ingress_module_exit(void) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 153 | { | 
 | 154 | 	unregister_qdisc(&ingress_qdisc_ops); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 155 | } | 
| Patrick McHardy | 58f4df4 | 2008-01-21 00:11:01 -0800 | [diff] [blame] | 156 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 157 | module_init(ingress_module_init) | 
 | 158 | module_exit(ingress_module_exit) | 
 | 159 | MODULE_LICENSE("GPL"); |