1
2
3
4
5
6
7
8
9
10#include <linux/module.h>
11#include <linux/types.h>
12#include <linux/list.h>
13#include <linux/skbuff.h>
14#include <linux/rtnetlink.h>
15#include <net/netlink.h>
16#include <net/pkt_sched.h>
17
18
19struct ingress_qdisc_data {
20 struct tcf_proto *filter_list;
21};
22
23
24
25static struct Qdisc *ingress_leaf(struct Qdisc *sch, unsigned long arg)
26{
27 return NULL;
28}
29
30static unsigned long ingress_get(struct Qdisc *sch, u32 classid)
31{
32 return TC_H_MIN(classid) + 1;
33}
34
35static unsigned long ingress_bind_filter(struct Qdisc *sch,
36 unsigned long parent, u32 classid)
37{
38 return ingress_get(sch, classid);
39}
40
41static void ingress_put(struct Qdisc *sch, unsigned long cl)
42{
43}
44
45static void ingress_walk(struct Qdisc *sch, struct qdisc_walker *walker)
46{
47}
48
49static struct tcf_proto **ingress_find_tcf(struct Qdisc *sch, unsigned long cl)
50{
51 struct ingress_qdisc_data *p = qdisc_priv(sch);
52
53 return &p->filter_list;
54}
55
56
57
58static int ingress_enqueue(struct sk_buff *skb, struct Qdisc *sch)
59{
60 struct ingress_qdisc_data *p = qdisc_priv(sch);
61 struct tcf_result res;
62 int result;
63
64 result = tc_classify(skb, p->filter_list, &res);
65
66 sch->bstats.packets++;
67 sch->bstats.bytes += qdisc_pkt_len(skb);
68 switch (result) {
69 case TC_ACT_SHOT:
70 result = TC_ACT_SHOT;
71 sch->qstats.drops++;
72 break;
73 case TC_ACT_STOLEN:
74 case TC_ACT_QUEUED:
75 result = TC_ACT_STOLEN;
76 break;
77 case TC_ACT_RECLASSIFY:
78 case TC_ACT_OK:
79 skb->tc_index = TC_H_MIN(res.classid);
80 default:
81 result = TC_ACT_OK;
82 break;
83 }
84
85 return result;
86}
87
88
89
90static void ingress_destroy(struct Qdisc *sch)
91{
92 struct ingress_qdisc_data *p = qdisc_priv(sch);
93
94 tcf_destroy_chain(&p->filter_list);
95}
96
97static int ingress_dump(struct Qdisc *sch, struct sk_buff *skb)
98{
99 struct nlattr *nest;
100
101 nest = nla_nest_start(skb, TCA_OPTIONS);
102 if (nest == NULL)
103 goto nla_put_failure;
104 nla_nest_end(skb, nest);
105 return skb->len;
106
107nla_put_failure:
108 nla_nest_cancel(skb, nest);
109 return -1;
110}
111
112static const struct Qdisc_class_ops ingress_class_ops = {
113 .leaf = ingress_leaf,
114 .get = ingress_get,
115 .put = ingress_put,
116 .walk = ingress_walk,
117 .tcf_chain = ingress_find_tcf,
118 .bind_tcf = ingress_bind_filter,
119 .unbind_tcf = ingress_put,
120};
121
122static struct Qdisc_ops ingress_qdisc_ops __read_mostly = {
123 .cl_ops = &ingress_class_ops,
124 .id = "ingress",
125 .priv_size = sizeof(struct ingress_qdisc_data),
126 .enqueue = ingress_enqueue,
127 .destroy = ingress_destroy,
128 .dump = ingress_dump,
129 .owner = THIS_MODULE,
130};
131
132static int __init ingress_module_init(void)
133{
134 return register_qdisc(&ingress_qdisc_ops);
135}
136
137static void __exit ingress_module_exit(void)
138{
139 unregister_qdisc(&ingress_qdisc_ops);
140}
141
142module_init(ingress_module_init)
143module_exit(ingress_module_exit)
144MODULE_LICENSE("GPL");
145
