affs: fix remount failure when there are no options changed
[linux-2.6-block.git] / net / sched / sch_fifo.c
CommitLineData
1da177e4
LT
1/*
2 * net/sched/sch_fifo.c The simplest FIFO queue.
3 *
4 * This program is free software; you can redistribute it and/or
5 * modify it under the terms of the GNU General Public License
6 * as published by the Free Software Foundation; either version
7 * 2 of the License, or (at your option) any later version.
8 *
9 * Authors: Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru>
10 */
11
1da177e4 12#include <linux/module.h>
5a0e3ad6 13#include <linux/slab.h>
1da177e4
LT
14#include <linux/types.h>
15#include <linux/kernel.h>
1da177e4 16#include <linux/errno.h>
1da177e4 17#include <linux/skbuff.h>
1da177e4
LT
18#include <net/pkt_sched.h>
19
20/* 1 band FIFO pseudo-"scheduler" */
21
cc7ec456 22static int bfifo_enqueue(struct sk_buff *skb, struct Qdisc *sch)
1da177e4 23{
d276055c 24 if (likely(sch->qstats.backlog + qdisc_pkt_len(skb) <= sch->limit))
aaae3013 25 return qdisc_enqueue_tail(skb, sch);
1da177e4 26
aaae3013 27 return qdisc_reshape_fail(skb, sch);
1da177e4
LT
28}
29
cc7ec456 30static int pfifo_enqueue(struct sk_buff *skb, struct Qdisc *sch)
1da177e4 31{
d276055c 32 if (likely(skb_queue_len(&sch->q) < sch->limit))
aaae3013 33 return qdisc_enqueue_tail(skb, sch);
1da177e4 34
aaae3013 35 return qdisc_reshape_fail(skb, sch);
1da177e4
LT
36}
37
cc7ec456 38static int pfifo_tail_enqueue(struct sk_buff *skb, struct Qdisc *sch)
57dbb2d8 39{
d276055c 40 if (likely(skb_queue_len(&sch->q) < sch->limit))
57dbb2d8
HPP
41 return qdisc_enqueue_tail(skb, sch);
42
43 /* queue full, remove one skb to fulfill the limit */
9190b3b3 44 __qdisc_queue_drop_head(sch, &sch->q);
25331d6c 45 qdisc_qstats_drop(sch);
57dbb2d8
HPP
46 qdisc_enqueue_tail(skb, sch);
47
48 return NET_XMIT_CN;
49}
50
1e90474c 51static int fifo_init(struct Qdisc *sch, struct nlattr *opt)
1da177e4 52{
23624935
ED
53 bool bypass;
54 bool is_bfifo = sch->ops == &bfifo_qdisc_ops;
1da177e4
LT
55
56 if (opt == NULL) {
348e3435 57 u32 limit = qdisc_dev(sch)->tx_queue_len;
1da177e4 58
23624935 59 if (is_bfifo)
6473990c 60 limit *= psched_mtu(qdisc_dev(sch));
6fc8e84f 61
d276055c 62 sch->limit = limit;
1da177e4 63 } else {
1e90474c 64 struct tc_fifo_qopt *ctl = nla_data(opt);
6fc8e84f 65
1e90474c 66 if (nla_len(opt) < sizeof(*ctl))
1da177e4 67 return -EINVAL;
6fc8e84f 68
d276055c 69 sch->limit = ctl->limit;
1da177e4 70 }
6fc8e84f 71
23624935 72 if (is_bfifo)
d276055c 73 bypass = sch->limit >= psched_mtu(qdisc_dev(sch));
23624935 74 else
d276055c 75 bypass = sch->limit >= 1;
23624935
ED
76
77 if (bypass)
78 sch->flags |= TCQ_F_CAN_BYPASS;
79 else
80 sch->flags &= ~TCQ_F_CAN_BYPASS;
1da177e4
LT
81 return 0;
82}
83
84static int fifo_dump(struct Qdisc *sch, struct sk_buff *skb)
85{
d276055c 86 struct tc_fifo_qopt opt = { .limit = sch->limit };
1da177e4 87
1b34ec43
DM
88 if (nla_put(skb, TCA_OPTIONS, sizeof(opt), &opt))
89 goto nla_put_failure;
1da177e4
LT
90 return skb->len;
91
1e90474c 92nla_put_failure:
1da177e4
LT
93 return -1;
94}
95
20fea08b 96struct Qdisc_ops pfifo_qdisc_ops __read_mostly = {
1da177e4 97 .id = "pfifo",
d276055c 98 .priv_size = 0,
1da177e4 99 .enqueue = pfifo_enqueue,
aaae3013 100 .dequeue = qdisc_dequeue_head,
48a8f519 101 .peek = qdisc_peek_head,
aaae3013 102 .drop = qdisc_queue_drop,
1da177e4 103 .init = fifo_init,
aaae3013 104 .reset = qdisc_reset_queue,
1da177e4
LT
105 .change = fifo_init,
106 .dump = fifo_dump,
107 .owner = THIS_MODULE,
108};
62e3ba1b 109EXPORT_SYMBOL(pfifo_qdisc_ops);
1da177e4 110
20fea08b 111struct Qdisc_ops bfifo_qdisc_ops __read_mostly = {
1da177e4 112 .id = "bfifo",
d276055c 113 .priv_size = 0,
1da177e4 114 .enqueue = bfifo_enqueue,
aaae3013 115 .dequeue = qdisc_dequeue_head,
48a8f519 116 .peek = qdisc_peek_head,
aaae3013 117 .drop = qdisc_queue_drop,
1da177e4 118 .init = fifo_init,
aaae3013 119 .reset = qdisc_reset_queue,
1da177e4
LT
120 .change = fifo_init,
121 .dump = fifo_dump,
122 .owner = THIS_MODULE,
123};
1da177e4 124EXPORT_SYMBOL(bfifo_qdisc_ops);
fb0305ce 125
57dbb2d8
HPP
126struct Qdisc_ops pfifo_head_drop_qdisc_ops __read_mostly = {
127 .id = "pfifo_head_drop",
d276055c 128 .priv_size = 0,
57dbb2d8
HPP
129 .enqueue = pfifo_tail_enqueue,
130 .dequeue = qdisc_dequeue_head,
131 .peek = qdisc_peek_head,
132 .drop = qdisc_queue_drop_head,
133 .init = fifo_init,
134 .reset = qdisc_reset_queue,
135 .change = fifo_init,
136 .dump = fifo_dump,
137 .owner = THIS_MODULE,
138};
139
fb0305ce
PM
140/* Pass size change message down to embedded FIFO */
141int fifo_set_limit(struct Qdisc *q, unsigned int limit)
142{
143 struct nlattr *nla;
144 int ret = -ENOMEM;
145
146 /* Hack to avoid sending change message to non-FIFO */
147 if (strncmp(q->ops->id + 1, "fifo", 4) != 0)
148 return 0;
149
150 nla = kmalloc(nla_attr_size(sizeof(struct tc_fifo_qopt)), GFP_KERNEL);
151 if (nla) {
152 nla->nla_type = RTM_NEWQDISC;
153 nla->nla_len = nla_attr_size(sizeof(struct tc_fifo_qopt));
154 ((struct tc_fifo_qopt *)nla_data(nla))->limit = limit;
155
156 ret = q->ops->change(q, nla);
157 kfree(nla);
158 }
159 return ret;
160}
161EXPORT_SYMBOL(fifo_set_limit);
162
163struct Qdisc *fifo_create_dflt(struct Qdisc *sch, struct Qdisc_ops *ops,
164 unsigned int limit)
165{
166 struct Qdisc *q;
167 int err = -ENOMEM;
168
3511c913 169 q = qdisc_create_dflt(sch->dev_queue, ops, TC_H_MAKE(sch->handle, 1));
fb0305ce
PM
170 if (q) {
171 err = fifo_set_limit(q, limit);
172 if (err < 0) {
173 qdisc_destroy(q);
174 q = NULL;
175 }
176 }
177
178 return q ? : ERR_PTR(err);
179}
180EXPORT_SYMBOL(fifo_create_dflt);