Linux Audio

Check our new training course

Loading...
v4.6
  1#ifndef __NET_SCHED_GENERIC_H
  2#define __NET_SCHED_GENERIC_H
  3
  4#include <linux/netdevice.h>
  5#include <linux/types.h>
  6#include <linux/rcupdate.h>
  7#include <linux/pkt_sched.h>
  8#include <linux/pkt_cls.h>
  9#include <linux/percpu.h>
 10#include <linux/dynamic_queue_limits.h>
 11#include <net/gen_stats.h>
 12#include <net/rtnetlink.h>
 13
 14struct Qdisc_ops;
 15struct qdisc_walker;
 16struct tcf_walker;
 17struct module;
 18
 19struct qdisc_rate_table {
 20	struct tc_ratespec rate;
 21	u32		data[256];
 22	struct qdisc_rate_table *next;
 23	int		refcnt;
 24};
 25
 26enum qdisc_state_t {
 27	__QDISC_STATE_SCHED,
 28	__QDISC_STATE_DEACTIVATED,
 29	__QDISC_STATE_THROTTLED,
 30};
 31
 32/*
 33 * following bits are only changed while qdisc lock is held
 34 */
 35enum qdisc___state_t {
 36	__QDISC___STATE_RUNNING = 1,
 37};
 38
 39struct qdisc_size_table {
 40	struct rcu_head		rcu;
 41	struct list_head	list;
 42	struct tc_sizespec	szopts;
 43	int			refcnt;
 44	u16			data[];
 45};
 46
 
 
 
 
 
 
 
 
 47struct Qdisc {
 48	int 			(*enqueue)(struct sk_buff *skb, struct Qdisc *dev);
 49	struct sk_buff *	(*dequeue)(struct Qdisc *dev);
 
 
 50	unsigned int		flags;
 51#define TCQ_F_BUILTIN		1
 52#define TCQ_F_INGRESS		2
 53#define TCQ_F_CAN_BYPASS	4
 54#define TCQ_F_MQROOT		8
 55#define TCQ_F_ONETXQUEUE	0x10 /* dequeue_skb() can assume all skbs are for
 56				      * q->dev_queue : It can test
 57				      * netif_xmit_frozen_or_stopped() before
 58				      * dequeueing next packet.
 59				      * Its true for MQ/MQPRIO slaves, or non
 60				      * multiqueue device.
 61				      */
 62#define TCQ_F_WARN_NONWC	(1 << 16)
 63#define TCQ_F_CPUSTATS		0x20 /* run using percpu statistics */
 64#define TCQ_F_NOPARENT		0x40 /* root of its hierarchy :
 65				      * qdisc_tree_decrease_qlen() should stop.
 66				      */
 67	u32			limit;
 68	const struct Qdisc_ops	*ops;
 69	struct qdisc_size_table	__rcu *stab;
 70	struct list_head	list;
 71	u32			handle;
 72	u32			parent;
 73	int			(*reshape_fail)(struct sk_buff *skb,
 74					struct Qdisc *q);
 75
 76	void			*u32_node;
 77
 78	/* This field is deprecated, but it is still used by CBQ
 79	 * and it will live until better solution will be invented.
 80	 */
 81	struct Qdisc		*__parent;
 82	struct netdev_queue	*dev_queue;
 83
 84	struct gnet_stats_rate_est64	rate_est;
 85	struct gnet_stats_basic_cpu __percpu *cpu_bstats;
 86	struct gnet_stats_queue	__percpu *cpu_qstats;
 87
 88	struct Qdisc		*next_sched;
 89	struct sk_buff		*gso_skb;
 90	/*
 91	 * For performance sake on SMP, we put highly modified fields at the end
 92	 */
 93	unsigned long		state;
 94	struct sk_buff_head	q;
 95	struct gnet_stats_basic_packed bstats;
 96	unsigned int		__state;
 97	struct gnet_stats_queue	qstats;
 
 
 
 98	struct rcu_head		rcu_head;
 99	int			padded;
100	atomic_t		refcnt;
101
102	spinlock_t		busylock ____cacheline_aligned_in_smp;
103};
104
105static inline bool qdisc_is_running(const struct Qdisc *qdisc)
106{
107	return (qdisc->__state & __QDISC___STATE_RUNNING) ? true : false;
108}
109
110static inline bool qdisc_run_begin(struct Qdisc *qdisc)
111{
112	if (qdisc_is_running(qdisc))
113		return false;
114	qdisc->__state |= __QDISC___STATE_RUNNING;
 
 
 
 
115	return true;
116}
117
118static inline void qdisc_run_end(struct Qdisc *qdisc)
119{
120	qdisc->__state &= ~__QDISC___STATE_RUNNING;
121}
122
123static inline bool qdisc_may_bulk(const struct Qdisc *qdisc)
124{
125	return qdisc->flags & TCQ_F_ONETXQUEUE;
126}
127
128static inline int qdisc_avail_bulklimit(const struct netdev_queue *txq)
129{
130#ifdef CONFIG_BQL
131	/* Non-BQL migrated drivers will return 0, too. */
132	return dql_avail(&txq->dql);
133#else
134	return 0;
135#endif
136}
137
138static inline bool qdisc_is_throttled(const struct Qdisc *qdisc)
139{
140	return test_bit(__QDISC_STATE_THROTTLED, &qdisc->state) ? true : false;
141}
142
143static inline void qdisc_throttled(struct Qdisc *qdisc)
144{
145	set_bit(__QDISC_STATE_THROTTLED, &qdisc->state);
146}
147
148static inline void qdisc_unthrottled(struct Qdisc *qdisc)
149{
150	clear_bit(__QDISC_STATE_THROTTLED, &qdisc->state);
151}
152
153struct Qdisc_class_ops {
154	/* Child qdisc manipulation */
155	struct netdev_queue *	(*select_queue)(struct Qdisc *, struct tcmsg *);
156	int			(*graft)(struct Qdisc *, unsigned long cl,
157					struct Qdisc *, struct Qdisc **);
158	struct Qdisc *		(*leaf)(struct Qdisc *, unsigned long cl);
159	void			(*qlen_notify)(struct Qdisc *, unsigned long);
160
161	/* Class manipulation routines */
162	unsigned long		(*get)(struct Qdisc *, u32 classid);
163	void			(*put)(struct Qdisc *, unsigned long);
164	int			(*change)(struct Qdisc *, u32, u32,
165					struct nlattr **, unsigned long *);
166	int			(*delete)(struct Qdisc *, unsigned long);
167	void			(*walk)(struct Qdisc *, struct qdisc_walker * arg);
168
169	/* Filter manipulation */
170	struct tcf_proto __rcu ** (*tcf_chain)(struct Qdisc *, unsigned long);
 
171	unsigned long		(*bind_tcf)(struct Qdisc *, unsigned long,
172					u32 classid);
173	void			(*unbind_tcf)(struct Qdisc *, unsigned long);
174
175	/* rtnetlink specific */
176	int			(*dump)(struct Qdisc *, unsigned long,
177					struct sk_buff *skb, struct tcmsg*);
178	int			(*dump_stats)(struct Qdisc *, unsigned long,
179					struct gnet_dump *);
180};
181
182struct Qdisc_ops {
183	struct Qdisc_ops	*next;
184	const struct Qdisc_class_ops	*cl_ops;
185	char			id[IFNAMSIZ];
186	int			priv_size;
187
188	int 			(*enqueue)(struct sk_buff *, struct Qdisc *);
 
 
189	struct sk_buff *	(*dequeue)(struct Qdisc *);
190	struct sk_buff *	(*peek)(struct Qdisc *);
191	unsigned int		(*drop)(struct Qdisc *);
192
193	int			(*init)(struct Qdisc *, struct nlattr *arg);
194	void			(*reset)(struct Qdisc *);
195	void			(*destroy)(struct Qdisc *);
196	int			(*change)(struct Qdisc *, struct nlattr *arg);
197	void			(*attach)(struct Qdisc *);
198
199	int			(*dump)(struct Qdisc *, struct sk_buff *);
200	int			(*dump_stats)(struct Qdisc *, struct gnet_dump *);
201
202	struct module		*owner;
203};
204
205
206struct tcf_result {
207	unsigned long	class;
208	u32		classid;
209};
210
211struct tcf_proto_ops {
212	struct list_head	head;
213	char			kind[IFNAMSIZ];
214
215	int			(*classify)(struct sk_buff *,
216					    const struct tcf_proto *,
217					    struct tcf_result *);
218	int			(*init)(struct tcf_proto*);
219	bool			(*destroy)(struct tcf_proto*, bool);
220
221	unsigned long		(*get)(struct tcf_proto*, u32 handle);
222	int			(*change)(struct net *net, struct sk_buff *,
223					struct tcf_proto*, unsigned long,
224					u32 handle, struct nlattr **,
225					unsigned long *, bool);
226	int			(*delete)(struct tcf_proto*, unsigned long);
227	void			(*walk)(struct tcf_proto*, struct tcf_walker *arg);
228
229	/* rtnetlink specific */
230	int			(*dump)(struct net*, struct tcf_proto*, unsigned long,
231					struct sk_buff *skb, struct tcmsg*);
232
233	struct module		*owner;
234};
235
236struct tcf_proto {
237	/* Fast access part */
238	struct tcf_proto __rcu	*next;
239	void __rcu		*root;
240	int			(*classify)(struct sk_buff *,
241					    const struct tcf_proto *,
242					    struct tcf_result *);
243	__be16			protocol;
244
245	/* All the rest */
246	u32			prio;
247	u32			classid;
248	struct Qdisc		*q;
249	void			*data;
250	const struct tcf_proto_ops	*ops;
251	struct rcu_head		rcu;
252};
253
254struct qdisc_skb_cb {
255	unsigned int		pkt_len;
256	u16			slave_dev_queue_mapping;
257	u16			tc_classid;
258#define QDISC_CB_PRIV_LEN 20
259	unsigned char		data[QDISC_CB_PRIV_LEN];
260};
261
262static inline void qdisc_cb_private_validate(const struct sk_buff *skb, int sz)
263{
264	struct qdisc_skb_cb *qcb;
265
266	BUILD_BUG_ON(sizeof(skb->cb) < offsetof(struct qdisc_skb_cb, data) + sz);
267	BUILD_BUG_ON(sizeof(qcb->data) < sz);
268}
269
270static inline int qdisc_qlen(const struct Qdisc *q)
271{
272	return q->q.qlen;
273}
274
275static inline struct qdisc_skb_cb *qdisc_skb_cb(const struct sk_buff *skb)
276{
277	return (struct qdisc_skb_cb *)skb->cb;
278}
279
280static inline spinlock_t *qdisc_lock(struct Qdisc *qdisc)
281{
282	return &qdisc->q.lock;
283}
284
285static inline struct Qdisc *qdisc_root(const struct Qdisc *qdisc)
286{
287	struct Qdisc *q = rcu_dereference_rtnl(qdisc->dev_queue->qdisc);
288
289	return q;
290}
291
292static inline struct Qdisc *qdisc_root_sleeping(const struct Qdisc *qdisc)
293{
294	return qdisc->dev_queue->qdisc_sleeping;
295}
296
297/* The qdisc root lock is a mechanism by which to top level
298 * of a qdisc tree can be locked from any qdisc node in the
299 * forest.  This allows changing the configuration of some
300 * aspect of the qdisc tree while blocking out asynchronous
301 * qdisc access in the packet processing paths.
302 *
303 * It is only legal to do this when the root will not change
304 * on us.  Otherwise we'll potentially lock the wrong qdisc
305 * root.  This is enforced by holding the RTNL semaphore, which
306 * all users of this lock accessor must do.
307 */
308static inline spinlock_t *qdisc_root_lock(const struct Qdisc *qdisc)
309{
310	struct Qdisc *root = qdisc_root(qdisc);
311
312	ASSERT_RTNL();
313	return qdisc_lock(root);
314}
315
316static inline spinlock_t *qdisc_root_sleeping_lock(const struct Qdisc *qdisc)
317{
318	struct Qdisc *root = qdisc_root_sleeping(qdisc);
319
320	ASSERT_RTNL();
321	return qdisc_lock(root);
322}
323
 
 
 
 
 
 
 
 
324static inline struct net_device *qdisc_dev(const struct Qdisc *qdisc)
325{
326	return qdisc->dev_queue->dev;
327}
328
329static inline void sch_tree_lock(const struct Qdisc *q)
330{
331	spin_lock_bh(qdisc_root_sleeping_lock(q));
332}
333
334static inline void sch_tree_unlock(const struct Qdisc *q)
335{
336	spin_unlock_bh(qdisc_root_sleeping_lock(q));
337}
338
339#define tcf_tree_lock(tp)	sch_tree_lock((tp)->q)
340#define tcf_tree_unlock(tp)	sch_tree_unlock((tp)->q)
341
342extern struct Qdisc noop_qdisc;
343extern struct Qdisc_ops noop_qdisc_ops;
344extern struct Qdisc_ops pfifo_fast_ops;
345extern struct Qdisc_ops mq_qdisc_ops;
346extern struct Qdisc_ops noqueue_qdisc_ops;
347extern const struct Qdisc_ops *default_qdisc_ops;
348static inline const struct Qdisc_ops *
349get_default_qdisc_ops(const struct net_device *dev, int ntx)
350{
351	return ntx < dev->real_num_tx_queues ?
352			default_qdisc_ops : &pfifo_fast_ops;
353}
354
355struct Qdisc_class_common {
356	u32			classid;
357	struct hlist_node	hnode;
358};
359
360struct Qdisc_class_hash {
361	struct hlist_head	*hash;
362	unsigned int		hashsize;
363	unsigned int		hashmask;
364	unsigned int		hashelems;
365};
366
367static inline unsigned int qdisc_class_hash(u32 id, u32 mask)
368{
369	id ^= id >> 8;
370	id ^= id >> 4;
371	return id & mask;
372}
373
374static inline struct Qdisc_class_common *
375qdisc_class_find(const struct Qdisc_class_hash *hash, u32 id)
376{
377	struct Qdisc_class_common *cl;
378	unsigned int h;
379
380	h = qdisc_class_hash(id, hash->hashmask);
381	hlist_for_each_entry(cl, &hash->hash[h], hnode) {
382		if (cl->classid == id)
383			return cl;
384	}
385	return NULL;
386}
387
388int qdisc_class_hash_init(struct Qdisc_class_hash *);
389void qdisc_class_hash_insert(struct Qdisc_class_hash *,
390			     struct Qdisc_class_common *);
391void qdisc_class_hash_remove(struct Qdisc_class_hash *,
392			     struct Qdisc_class_common *);
393void qdisc_class_hash_grow(struct Qdisc *, struct Qdisc_class_hash *);
394void qdisc_class_hash_destroy(struct Qdisc_class_hash *);
395
396void dev_init_scheduler(struct net_device *dev);
397void dev_shutdown(struct net_device *dev);
398void dev_activate(struct net_device *dev);
399void dev_deactivate(struct net_device *dev);
400void dev_deactivate_many(struct list_head *head);
401struct Qdisc *dev_graft_qdisc(struct netdev_queue *dev_queue,
402			      struct Qdisc *qdisc);
403void qdisc_reset(struct Qdisc *qdisc);
404void qdisc_destroy(struct Qdisc *qdisc);
405void qdisc_tree_reduce_backlog(struct Qdisc *qdisc, unsigned int n,
406			       unsigned int len);
407struct Qdisc *qdisc_alloc(struct netdev_queue *dev_queue,
408			  const struct Qdisc_ops *ops);
409struct Qdisc *qdisc_create_dflt(struct netdev_queue *dev_queue,
410				const struct Qdisc_ops *ops, u32 parentid);
411void __qdisc_calculate_pkt_len(struct sk_buff *skb,
412			       const struct qdisc_size_table *stab);
413bool tcf_destroy(struct tcf_proto *tp, bool force);
414void tcf_destroy_chain(struct tcf_proto __rcu **fl);
415int skb_do_redirect(struct sk_buff *);
416
417static inline bool skb_at_tc_ingress(const struct sk_buff *skb)
418{
419#ifdef CONFIG_NET_CLS_ACT
420	return G_TC_AT(skb->tc_verd) & AT_INGRESS;
421#else
422	return false;
423#endif
424}
425
426/* Reset all TX qdiscs greater then index of a device.  */
427static inline void qdisc_reset_all_tx_gt(struct net_device *dev, unsigned int i)
428{
429	struct Qdisc *qdisc;
430
431	for (; i < dev->num_tx_queues; i++) {
432		qdisc = rtnl_dereference(netdev_get_tx_queue(dev, i)->qdisc);
433		if (qdisc) {
434			spin_lock_bh(qdisc_lock(qdisc));
435			qdisc_reset(qdisc);
436			spin_unlock_bh(qdisc_lock(qdisc));
437		}
438	}
439}
440
441static inline void qdisc_reset_all_tx(struct net_device *dev)
442{
443	qdisc_reset_all_tx_gt(dev, 0);
444}
445
446/* Are all TX queues of the device empty?  */
447static inline bool qdisc_all_tx_empty(const struct net_device *dev)
448{
449	unsigned int i;
450
451	rcu_read_lock();
452	for (i = 0; i < dev->num_tx_queues; i++) {
453		struct netdev_queue *txq = netdev_get_tx_queue(dev, i);
454		const struct Qdisc *q = rcu_dereference(txq->qdisc);
455
456		if (q->q.qlen) {
457			rcu_read_unlock();
458			return false;
459		}
460	}
461	rcu_read_unlock();
462	return true;
463}
464
465/* Are any of the TX qdiscs changing?  */
466static inline bool qdisc_tx_changing(const struct net_device *dev)
467{
468	unsigned int i;
469
470	for (i = 0; i < dev->num_tx_queues; i++) {
471		struct netdev_queue *txq = netdev_get_tx_queue(dev, i);
472		if (rcu_access_pointer(txq->qdisc) != txq->qdisc_sleeping)
473			return true;
474	}
475	return false;
476}
477
478/* Is the device using the noop qdisc on all queues?  */
479static inline bool qdisc_tx_is_noop(const struct net_device *dev)
480{
481	unsigned int i;
482
483	for (i = 0; i < dev->num_tx_queues; i++) {
484		struct netdev_queue *txq = netdev_get_tx_queue(dev, i);
485		if (rcu_access_pointer(txq->qdisc) != &noop_qdisc)
486			return false;
487	}
488	return true;
489}
490
491static inline unsigned int qdisc_pkt_len(const struct sk_buff *skb)
492{
493	return qdisc_skb_cb(skb)->pkt_len;
494}
495
496/* additional qdisc xmit flags (NET_XMIT_MASK in linux/netdevice.h) */
497enum net_xmit_qdisc_t {
498	__NET_XMIT_STOLEN = 0x00010000,
499	__NET_XMIT_BYPASS = 0x00020000,
500};
501
502#ifdef CONFIG_NET_CLS_ACT
503#define net_xmit_drop_count(e)	((e) & __NET_XMIT_STOLEN ? 0 : 1)
504#else
505#define net_xmit_drop_count(e)	(1)
506#endif
507
508static inline void qdisc_calculate_pkt_len(struct sk_buff *skb,
509					   const struct Qdisc *sch)
510{
511#ifdef CONFIG_NET_SCHED
512	struct qdisc_size_table *stab = rcu_dereference_bh(sch->stab);
513
514	if (stab)
515		__qdisc_calculate_pkt_len(skb, stab);
516#endif
517}
518
519static inline int qdisc_enqueue(struct sk_buff *skb, struct Qdisc *sch)
 
520{
521	qdisc_calculate_pkt_len(skb, sch);
522	return sch->enqueue(skb, sch);
523}
524
525static inline bool qdisc_is_percpu_stats(const struct Qdisc *q)
526{
527	return q->flags & TCQ_F_CPUSTATS;
528}
529
 
 
 
 
 
 
 
530static inline void bstats_update(struct gnet_stats_basic_packed *bstats,
531				 const struct sk_buff *skb)
532{
533	bstats->bytes += qdisc_pkt_len(skb);
534	bstats->packets += skb_is_gso(skb) ? skb_shinfo(skb)->gso_segs : 1;
 
 
 
 
 
 
 
 
 
535}
536
537static inline void bstats_cpu_update(struct gnet_stats_basic_cpu *bstats,
538				     const struct sk_buff *skb)
539{
540	u64_stats_update_begin(&bstats->syncp);
541	bstats_update(&bstats->bstats, skb);
542	u64_stats_update_end(&bstats->syncp);
543}
544
545static inline void qdisc_bstats_cpu_update(struct Qdisc *sch,
546					   const struct sk_buff *skb)
547{
548	bstats_cpu_update(this_cpu_ptr(sch->cpu_bstats), skb);
549}
550
551static inline void qdisc_bstats_update(struct Qdisc *sch,
552				       const struct sk_buff *skb)
553{
554	bstats_update(&sch->bstats, skb);
555}
556
557static inline void qdisc_qstats_backlog_dec(struct Qdisc *sch,
558					    const struct sk_buff *skb)
559{
560	sch->qstats.backlog -= qdisc_pkt_len(skb);
561}
562
563static inline void qdisc_qstats_backlog_inc(struct Qdisc *sch,
564					    const struct sk_buff *skb)
565{
566	sch->qstats.backlog += qdisc_pkt_len(skb);
567}
568
569static inline void __qdisc_qstats_drop(struct Qdisc *sch, int count)
570{
571	sch->qstats.drops += count;
572}
573
574static inline void qstats_drop_inc(struct gnet_stats_queue *qstats)
575{
576	qstats->drops++;
577}
578
579static inline void qstats_overlimit_inc(struct gnet_stats_queue *qstats)
580{
581	qstats->overlimits++;
582}
583
584static inline void qdisc_qstats_drop(struct Qdisc *sch)
585{
586	qstats_drop_inc(&sch->qstats);
587}
588
589static inline void qdisc_qstats_cpu_drop(struct Qdisc *sch)
590{
591	qstats_drop_inc(this_cpu_ptr(sch->cpu_qstats));
592}
593
594static inline void qdisc_qstats_overlimit(struct Qdisc *sch)
595{
596	sch->qstats.overlimits++;
597}
598
 
 
 
 
 
 
 
599static inline int __qdisc_enqueue_tail(struct sk_buff *skb, struct Qdisc *sch,
600				       struct sk_buff_head *list)
601{
602	__skb_queue_tail(list, skb);
 
 
 
 
 
 
 
 
 
 
603	qdisc_qstats_backlog_inc(sch, skb);
604
605	return NET_XMIT_SUCCESS;
606}
607
608static inline int qdisc_enqueue_tail(struct sk_buff *skb, struct Qdisc *sch)
609{
610	return __qdisc_enqueue_tail(skb, sch, &sch->q);
611}
612
613static inline struct sk_buff *__qdisc_dequeue_head(struct Qdisc *sch,
614						   struct sk_buff_head *list)
615{
616	struct sk_buff *skb = __skb_dequeue(list);
617
618	if (likely(skb != NULL)) {
619		qdisc_qstats_backlog_dec(sch, skb);
620		qdisc_bstats_update(sch, skb);
 
 
 
621	}
622
623	return skb;
624}
625
626static inline struct sk_buff *qdisc_dequeue_head(struct Qdisc *sch)
627{
628	return __qdisc_dequeue_head(sch, &sch->q);
629}
630
631static inline unsigned int __qdisc_queue_drop_head(struct Qdisc *sch,
632					      struct sk_buff_head *list)
633{
634	struct sk_buff *skb = __skb_dequeue(list);
635
636	if (likely(skb != NULL)) {
637		unsigned int len = qdisc_pkt_len(skb);
638		qdisc_qstats_backlog_dec(sch, skb);
639		kfree_skb(skb);
640		return len;
641	}
642
643	return 0;
644}
645
646static inline unsigned int qdisc_queue_drop_head(struct Qdisc *sch)
 
 
 
647{
648	return __qdisc_queue_drop_head(sch, &sch->q);
 
649}
650
651static inline struct sk_buff *__qdisc_dequeue_tail(struct Qdisc *sch,
652						   struct sk_buff_head *list)
 
653{
654	struct sk_buff *skb = __skb_dequeue_tail(list);
 
 
 
655
656	if (likely(skb != NULL))
657		qdisc_qstats_backlog_dec(sch, skb);
 
 
 
658
659	return skb;
660}
661
662static inline struct sk_buff *qdisc_dequeue_tail(struct Qdisc *sch)
 
663{
664	return __qdisc_dequeue_tail(sch, &sch->q);
665}
666
667static inline struct sk_buff *qdisc_peek_head(struct Qdisc *sch)
668{
669	return skb_peek(&sch->q);
 
 
670}
671
672/* generic pseudo peek method for non-work-conserving qdisc */
673static inline struct sk_buff *qdisc_peek_dequeued(struct Qdisc *sch)
674{
675	/* we can reuse ->gso_skb because peek isn't called for root qdiscs */
676	if (!sch->gso_skb) {
677		sch->gso_skb = sch->dequeue(sch);
678		if (sch->gso_skb)
679			/* it's still part of the queue */
 
680			sch->q.qlen++;
 
681	}
682
683	return sch->gso_skb;
684}
685
686/* use instead of qdisc->dequeue() for all qdiscs queried with ->peek() */
687static inline struct sk_buff *qdisc_dequeue_peeked(struct Qdisc *sch)
688{
689	struct sk_buff *skb = sch->gso_skb;
690
691	if (skb) {
692		sch->gso_skb = NULL;
 
693		sch->q.qlen--;
694	} else {
695		skb = sch->dequeue(sch);
696	}
697
698	return skb;
699}
700
701static inline void __qdisc_reset_queue(struct Qdisc *sch,
702				       struct sk_buff_head *list)
703{
704	/*
705	 * We do not know the backlog in bytes of this list, it
706	 * is up to the caller to correct it
707	 */
708	__skb_queue_purge(list);
 
 
 
 
 
 
 
709}
710
711static inline void qdisc_reset_queue(struct Qdisc *sch)
712{
713	__qdisc_reset_queue(sch, &sch->q);
714	sch->qstats.backlog = 0;
715}
716
717static inline struct Qdisc *qdisc_replace(struct Qdisc *sch, struct Qdisc *new,
718					  struct Qdisc **pold)
719{
720	struct Qdisc *old;
721
722	sch_tree_lock(sch);
723	old = *pold;
724	*pold = new;
725	if (old != NULL) {
726		qdisc_tree_reduce_backlog(old, old->q.qlen, old->qstats.backlog);
727		qdisc_reset(old);
728	}
729	sch_tree_unlock(sch);
730
731	return old;
732}
733
734static inline unsigned int __qdisc_queue_drop(struct Qdisc *sch,
735					      struct sk_buff_head *list)
736{
737	struct sk_buff *skb = __qdisc_dequeue_tail(sch, list);
738
739	if (likely(skb != NULL)) {
740		unsigned int len = qdisc_pkt_len(skb);
741		kfree_skb(skb);
742		return len;
743	}
744
745	return 0;
746}
747
748static inline unsigned int qdisc_queue_drop(struct Qdisc *sch)
749{
750	return __qdisc_queue_drop(sch, &sch->q);
751}
752
753static inline int qdisc_drop(struct sk_buff *skb, struct Qdisc *sch)
754{
755	kfree_skb(skb);
756	qdisc_qstats_drop(sch);
757
758	return NET_XMIT_DROP;
759}
760
761static inline int qdisc_reshape_fail(struct sk_buff *skb, struct Qdisc *sch)
 
 
762{
 
763	qdisc_qstats_drop(sch);
764
765#ifdef CONFIG_NET_CLS_ACT
766	if (sch->reshape_fail == NULL || sch->reshape_fail(skb, sch))
767		goto drop;
768
769	return NET_XMIT_SUCCESS;
770
771drop:
772#endif
773	kfree_skb(skb);
774	return NET_XMIT_DROP;
775}
776
777/* Length to Time (L2T) lookup in a qdisc_rate_table, to determine how
778   long it will take to send a packet given its size.
779 */
780static inline u32 qdisc_l2t(struct qdisc_rate_table* rtab, unsigned int pktlen)
781{
782	int slot = pktlen + rtab->rate.cell_align + rtab->rate.overhead;
783	if (slot < 0)
784		slot = 0;
785	slot >>= rtab->rate.cell_log;
786	if (slot > 255)
787		return rtab->data[255]*(slot >> 8) + rtab->data[slot & 0xFF];
788	return rtab->data[slot];
789}
790
791struct psched_ratecfg {
792	u64	rate_bytes_ps; /* bytes per second */
793	u32	mult;
794	u16	overhead;
795	u8	linklayer;
796	u8	shift;
797};
798
799static inline u64 psched_l2t_ns(const struct psched_ratecfg *r,
800				unsigned int len)
801{
802	len += r->overhead;
803
804	if (unlikely(r->linklayer == TC_LINKLAYER_ATM))
805		return ((u64)(DIV_ROUND_UP(len,48)*53) * r->mult) >> r->shift;
806
807	return ((u64)len * r->mult) >> r->shift;
808}
809
810void psched_ratecfg_precompute(struct psched_ratecfg *r,
811			       const struct tc_ratespec *conf,
812			       u64 rate64);
813
814static inline void psched_ratecfg_getrate(struct tc_ratespec *res,
815					  const struct psched_ratecfg *r)
816{
817	memset(res, 0, sizeof(*res));
818
819	/* legacy struct tc_ratespec has a 32bit @rate field
820	 * Qdisc using 64bit rate should add new attributes
821	 * in order to maintain compatibility.
822	 */
823	res->rate = min_t(u64, r->rate_bytes_ps, ~0U);
824
825	res->overhead = r->overhead;
826	res->linklayer = (r->linklayer & TC_LINKLAYER_MASK);
827}
828
829#endif
v4.10.11
  1#ifndef __NET_SCHED_GENERIC_H
  2#define __NET_SCHED_GENERIC_H
  3
  4#include <linux/netdevice.h>
  5#include <linux/types.h>
  6#include <linux/rcupdate.h>
  7#include <linux/pkt_sched.h>
  8#include <linux/pkt_cls.h>
  9#include <linux/percpu.h>
 10#include <linux/dynamic_queue_limits.h>
 11#include <net/gen_stats.h>
 12#include <net/rtnetlink.h>
 13
 14struct Qdisc_ops;
 15struct qdisc_walker;
 16struct tcf_walker;
 17struct module;
 18
 19struct qdisc_rate_table {
 20	struct tc_ratespec rate;
 21	u32		data[256];
 22	struct qdisc_rate_table *next;
 23	int		refcnt;
 24};
 25
 26enum qdisc_state_t {
 27	__QDISC_STATE_SCHED,
 28	__QDISC_STATE_DEACTIVATED,
 
 
 
 
 
 
 
 
 29};
 30
 31struct qdisc_size_table {
 32	struct rcu_head		rcu;
 33	struct list_head	list;
 34	struct tc_sizespec	szopts;
 35	int			refcnt;
 36	u16			data[];
 37};
 38
 39/* similar to sk_buff_head, but skb->prev pointer is undefined. */
 40struct qdisc_skb_head {
 41	struct sk_buff	*head;
 42	struct sk_buff	*tail;
 43	__u32		qlen;
 44	spinlock_t	lock;
 45};
 46
 47struct Qdisc {
 48	int 			(*enqueue)(struct sk_buff *skb,
 49					   struct Qdisc *sch,
 50					   struct sk_buff **to_free);
 51	struct sk_buff *	(*dequeue)(struct Qdisc *sch);
 52	unsigned int		flags;
 53#define TCQ_F_BUILTIN		1
 54#define TCQ_F_INGRESS		2
 55#define TCQ_F_CAN_BYPASS	4
 56#define TCQ_F_MQROOT		8
 57#define TCQ_F_ONETXQUEUE	0x10 /* dequeue_skb() can assume all skbs are for
 58				      * q->dev_queue : It can test
 59				      * netif_xmit_frozen_or_stopped() before
 60				      * dequeueing next packet.
 61				      * Its true for MQ/MQPRIO slaves, or non
 62				      * multiqueue device.
 63				      */
 64#define TCQ_F_WARN_NONWC	(1 << 16)
 65#define TCQ_F_CPUSTATS		0x20 /* run using percpu statistics */
 66#define TCQ_F_NOPARENT		0x40 /* root of its hierarchy :
 67				      * qdisc_tree_decrease_qlen() should stop.
 68				      */
 69	u32			limit;
 70	const struct Qdisc_ops	*ops;
 71	struct qdisc_size_table	__rcu *stab;
 72	struct hlist_node       hash;
 73	u32			handle;
 74	u32			parent;
 
 
 
 75	void			*u32_node;
 76
 
 
 
 
 77	struct netdev_queue	*dev_queue;
 78
 79	struct net_rate_estimator __rcu *rate_est;
 80	struct gnet_stats_basic_cpu __percpu *cpu_bstats;
 81	struct gnet_stats_queue	__percpu *cpu_qstats;
 82
 
 
 83	/*
 84	 * For performance sake on SMP, we put highly modified fields at the end
 85	 */
 86	struct sk_buff		*gso_skb ____cacheline_aligned_in_smp;
 87	struct qdisc_skb_head	q;
 88	struct gnet_stats_basic_packed bstats;
 89	seqcount_t		running;
 90	struct gnet_stats_queue	qstats;
 91	unsigned long		state;
 92	struct Qdisc            *next_sched;
 93	struct sk_buff		*skb_bad_txq;
 94	struct rcu_head		rcu_head;
 95	int			padded;
 96	atomic_t		refcnt;
 97
 98	spinlock_t		busylock ____cacheline_aligned_in_smp;
 99};
100
101static inline bool qdisc_is_running(const struct Qdisc *qdisc)
102{
103	return (raw_read_seqcount(&qdisc->running) & 1) ? true : false;
104}
105
106static inline bool qdisc_run_begin(struct Qdisc *qdisc)
107{
108	if (qdisc_is_running(qdisc))
109		return false;
110	/* Variant of write_seqcount_begin() telling lockdep a trylock
111	 * was attempted.
112	 */
113	raw_write_seqcount_begin(&qdisc->running);
114	seqcount_acquire(&qdisc->running.dep_map, 0, 1, _RET_IP_);
115	return true;
116}
117
118static inline void qdisc_run_end(struct Qdisc *qdisc)
119{
120	write_seqcount_end(&qdisc->running);
121}
122
123static inline bool qdisc_may_bulk(const struct Qdisc *qdisc)
124{
125	return qdisc->flags & TCQ_F_ONETXQUEUE;
126}
127
128static inline int qdisc_avail_bulklimit(const struct netdev_queue *txq)
129{
130#ifdef CONFIG_BQL
131	/* Non-BQL migrated drivers will return 0, too. */
132	return dql_avail(&txq->dql);
133#else
134	return 0;
135#endif
136}
137
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
138struct Qdisc_class_ops {
139	/* Child qdisc manipulation */
140	struct netdev_queue *	(*select_queue)(struct Qdisc *, struct tcmsg *);
141	int			(*graft)(struct Qdisc *, unsigned long cl,
142					struct Qdisc *, struct Qdisc **);
143	struct Qdisc *		(*leaf)(struct Qdisc *, unsigned long cl);
144	void			(*qlen_notify)(struct Qdisc *, unsigned long);
145
146	/* Class manipulation routines */
147	unsigned long		(*get)(struct Qdisc *, u32 classid);
148	void			(*put)(struct Qdisc *, unsigned long);
149	int			(*change)(struct Qdisc *, u32, u32,
150					struct nlattr **, unsigned long *);
151	int			(*delete)(struct Qdisc *, unsigned long);
152	void			(*walk)(struct Qdisc *, struct qdisc_walker * arg);
153
154	/* Filter manipulation */
155	struct tcf_proto __rcu ** (*tcf_chain)(struct Qdisc *, unsigned long);
156	bool			(*tcf_cl_offload)(u32 classid);
157	unsigned long		(*bind_tcf)(struct Qdisc *, unsigned long,
158					u32 classid);
159	void			(*unbind_tcf)(struct Qdisc *, unsigned long);
160
161	/* rtnetlink specific */
162	int			(*dump)(struct Qdisc *, unsigned long,
163					struct sk_buff *skb, struct tcmsg*);
164	int			(*dump_stats)(struct Qdisc *, unsigned long,
165					struct gnet_dump *);
166};
167
168struct Qdisc_ops {
169	struct Qdisc_ops	*next;
170	const struct Qdisc_class_ops	*cl_ops;
171	char			id[IFNAMSIZ];
172	int			priv_size;
173
174	int 			(*enqueue)(struct sk_buff *skb,
175					   struct Qdisc *sch,
176					   struct sk_buff **to_free);
177	struct sk_buff *	(*dequeue)(struct Qdisc *);
178	struct sk_buff *	(*peek)(struct Qdisc *);
 
179
180	int			(*init)(struct Qdisc *, struct nlattr *arg);
181	void			(*reset)(struct Qdisc *);
182	void			(*destroy)(struct Qdisc *);
183	int			(*change)(struct Qdisc *, struct nlattr *arg);
184	void			(*attach)(struct Qdisc *);
185
186	int			(*dump)(struct Qdisc *, struct sk_buff *);
187	int			(*dump_stats)(struct Qdisc *, struct gnet_dump *);
188
189	struct module		*owner;
190};
191
192
193struct tcf_result {
194	unsigned long	class;
195	u32		classid;
196};
197
198struct tcf_proto_ops {
199	struct list_head	head;
200	char			kind[IFNAMSIZ];
201
202	int			(*classify)(struct sk_buff *,
203					    const struct tcf_proto *,
204					    struct tcf_result *);
205	int			(*init)(struct tcf_proto*);
206	bool			(*destroy)(struct tcf_proto*, bool);
207
208	unsigned long		(*get)(struct tcf_proto*, u32 handle);
209	int			(*change)(struct net *net, struct sk_buff *,
210					struct tcf_proto*, unsigned long,
211					u32 handle, struct nlattr **,
212					unsigned long *, bool);
213	int			(*delete)(struct tcf_proto*, unsigned long);
214	void			(*walk)(struct tcf_proto*, struct tcf_walker *arg);
215
216	/* rtnetlink specific */
217	int			(*dump)(struct net*, struct tcf_proto*, unsigned long,
218					struct sk_buff *skb, struct tcmsg*);
219
220	struct module		*owner;
221};
222
223struct tcf_proto {
224	/* Fast access part */
225	struct tcf_proto __rcu	*next;
226	void __rcu		*root;
227	int			(*classify)(struct sk_buff *,
228					    const struct tcf_proto *,
229					    struct tcf_result *);
230	__be16			protocol;
231
232	/* All the rest */
233	u32			prio;
234	u32			classid;
235	struct Qdisc		*q;
236	void			*data;
237	const struct tcf_proto_ops	*ops;
238	struct rcu_head		rcu;
239};
240
241struct qdisc_skb_cb {
242	unsigned int		pkt_len;
243	u16			slave_dev_queue_mapping;
244	u16			tc_classid;
245#define QDISC_CB_PRIV_LEN 20
246	unsigned char		data[QDISC_CB_PRIV_LEN];
247};
248
249static inline void qdisc_cb_private_validate(const struct sk_buff *skb, int sz)
250{
251	struct qdisc_skb_cb *qcb;
252
253	BUILD_BUG_ON(sizeof(skb->cb) < offsetof(struct qdisc_skb_cb, data) + sz);
254	BUILD_BUG_ON(sizeof(qcb->data) < sz);
255}
256
257static inline int qdisc_qlen(const struct Qdisc *q)
258{
259	return q->q.qlen;
260}
261
262static inline struct qdisc_skb_cb *qdisc_skb_cb(const struct sk_buff *skb)
263{
264	return (struct qdisc_skb_cb *)skb->cb;
265}
266
267static inline spinlock_t *qdisc_lock(struct Qdisc *qdisc)
268{
269	return &qdisc->q.lock;
270}
271
272static inline struct Qdisc *qdisc_root(const struct Qdisc *qdisc)
273{
274	struct Qdisc *q = rcu_dereference_rtnl(qdisc->dev_queue->qdisc);
275
276	return q;
277}
278
279static inline struct Qdisc *qdisc_root_sleeping(const struct Qdisc *qdisc)
280{
281	return qdisc->dev_queue->qdisc_sleeping;
282}
283
284/* The qdisc root lock is a mechanism by which to top level
285 * of a qdisc tree can be locked from any qdisc node in the
286 * forest.  This allows changing the configuration of some
287 * aspect of the qdisc tree while blocking out asynchronous
288 * qdisc access in the packet processing paths.
289 *
290 * It is only legal to do this when the root will not change
291 * on us.  Otherwise we'll potentially lock the wrong qdisc
292 * root.  This is enforced by holding the RTNL semaphore, which
293 * all users of this lock accessor must do.
294 */
295static inline spinlock_t *qdisc_root_lock(const struct Qdisc *qdisc)
296{
297	struct Qdisc *root = qdisc_root(qdisc);
298
299	ASSERT_RTNL();
300	return qdisc_lock(root);
301}
302
303static inline spinlock_t *qdisc_root_sleeping_lock(const struct Qdisc *qdisc)
304{
305	struct Qdisc *root = qdisc_root_sleeping(qdisc);
306
307	ASSERT_RTNL();
308	return qdisc_lock(root);
309}
310
311static inline seqcount_t *qdisc_root_sleeping_running(const struct Qdisc *qdisc)
312{
313	struct Qdisc *root = qdisc_root_sleeping(qdisc);
314
315	ASSERT_RTNL();
316	return &root->running;
317}
318
319static inline struct net_device *qdisc_dev(const struct Qdisc *qdisc)
320{
321	return qdisc->dev_queue->dev;
322}
323
324static inline void sch_tree_lock(const struct Qdisc *q)
325{
326	spin_lock_bh(qdisc_root_sleeping_lock(q));
327}
328
329static inline void sch_tree_unlock(const struct Qdisc *q)
330{
331	spin_unlock_bh(qdisc_root_sleeping_lock(q));
332}
333
334#define tcf_tree_lock(tp)	sch_tree_lock((tp)->q)
335#define tcf_tree_unlock(tp)	sch_tree_unlock((tp)->q)
336
337extern struct Qdisc noop_qdisc;
338extern struct Qdisc_ops noop_qdisc_ops;
339extern struct Qdisc_ops pfifo_fast_ops;
340extern struct Qdisc_ops mq_qdisc_ops;
341extern struct Qdisc_ops noqueue_qdisc_ops;
342extern const struct Qdisc_ops *default_qdisc_ops;
343static inline const struct Qdisc_ops *
344get_default_qdisc_ops(const struct net_device *dev, int ntx)
345{
346	return ntx < dev->real_num_tx_queues ?
347			default_qdisc_ops : &pfifo_fast_ops;
348}
349
350struct Qdisc_class_common {
351	u32			classid;
352	struct hlist_node	hnode;
353};
354
355struct Qdisc_class_hash {
356	struct hlist_head	*hash;
357	unsigned int		hashsize;
358	unsigned int		hashmask;
359	unsigned int		hashelems;
360};
361
362static inline unsigned int qdisc_class_hash(u32 id, u32 mask)
363{
364	id ^= id >> 8;
365	id ^= id >> 4;
366	return id & mask;
367}
368
369static inline struct Qdisc_class_common *
370qdisc_class_find(const struct Qdisc_class_hash *hash, u32 id)
371{
372	struct Qdisc_class_common *cl;
373	unsigned int h;
374
375	h = qdisc_class_hash(id, hash->hashmask);
376	hlist_for_each_entry(cl, &hash->hash[h], hnode) {
377		if (cl->classid == id)
378			return cl;
379	}
380	return NULL;
381}
382
383int qdisc_class_hash_init(struct Qdisc_class_hash *);
384void qdisc_class_hash_insert(struct Qdisc_class_hash *,
385			     struct Qdisc_class_common *);
386void qdisc_class_hash_remove(struct Qdisc_class_hash *,
387			     struct Qdisc_class_common *);
388void qdisc_class_hash_grow(struct Qdisc *, struct Qdisc_class_hash *);
389void qdisc_class_hash_destroy(struct Qdisc_class_hash *);
390
391void dev_init_scheduler(struct net_device *dev);
392void dev_shutdown(struct net_device *dev);
393void dev_activate(struct net_device *dev);
394void dev_deactivate(struct net_device *dev);
395void dev_deactivate_many(struct list_head *head);
396struct Qdisc *dev_graft_qdisc(struct netdev_queue *dev_queue,
397			      struct Qdisc *qdisc);
398void qdisc_reset(struct Qdisc *qdisc);
399void qdisc_destroy(struct Qdisc *qdisc);
400void qdisc_tree_reduce_backlog(struct Qdisc *qdisc, unsigned int n,
401			       unsigned int len);
402struct Qdisc *qdisc_alloc(struct netdev_queue *dev_queue,
403			  const struct Qdisc_ops *ops);
404struct Qdisc *qdisc_create_dflt(struct netdev_queue *dev_queue,
405				const struct Qdisc_ops *ops, u32 parentid);
406void __qdisc_calculate_pkt_len(struct sk_buff *skb,
407			       const struct qdisc_size_table *stab);
408bool tcf_destroy(struct tcf_proto *tp, bool force);
409void tcf_destroy_chain(struct tcf_proto __rcu **fl);
410int skb_do_redirect(struct sk_buff *);
411
412static inline bool skb_at_tc_ingress(const struct sk_buff *skb)
413{
414#ifdef CONFIG_NET_CLS_ACT
415	return G_TC_AT(skb->tc_verd) & AT_INGRESS;
416#else
417	return false;
418#endif
419}
420
421/* Reset all TX qdiscs greater then index of a device.  */
422static inline void qdisc_reset_all_tx_gt(struct net_device *dev, unsigned int i)
423{
424	struct Qdisc *qdisc;
425
426	for (; i < dev->num_tx_queues; i++) {
427		qdisc = rtnl_dereference(netdev_get_tx_queue(dev, i)->qdisc);
428		if (qdisc) {
429			spin_lock_bh(qdisc_lock(qdisc));
430			qdisc_reset(qdisc);
431			spin_unlock_bh(qdisc_lock(qdisc));
432		}
433	}
434}
435
436static inline void qdisc_reset_all_tx(struct net_device *dev)
437{
438	qdisc_reset_all_tx_gt(dev, 0);
439}
440
441/* Are all TX queues of the device empty?  */
442static inline bool qdisc_all_tx_empty(const struct net_device *dev)
443{
444	unsigned int i;
445
446	rcu_read_lock();
447	for (i = 0; i < dev->num_tx_queues; i++) {
448		struct netdev_queue *txq = netdev_get_tx_queue(dev, i);
449		const struct Qdisc *q = rcu_dereference(txq->qdisc);
450
451		if (q->q.qlen) {
452			rcu_read_unlock();
453			return false;
454		}
455	}
456	rcu_read_unlock();
457	return true;
458}
459
460/* Are any of the TX qdiscs changing?  */
461static inline bool qdisc_tx_changing(const struct net_device *dev)
462{
463	unsigned int i;
464
465	for (i = 0; i < dev->num_tx_queues; i++) {
466		struct netdev_queue *txq = netdev_get_tx_queue(dev, i);
467		if (rcu_access_pointer(txq->qdisc) != txq->qdisc_sleeping)
468			return true;
469	}
470	return false;
471}
472
473/* Is the device using the noop qdisc on all queues?  */
474static inline bool qdisc_tx_is_noop(const struct net_device *dev)
475{
476	unsigned int i;
477
478	for (i = 0; i < dev->num_tx_queues; i++) {
479		struct netdev_queue *txq = netdev_get_tx_queue(dev, i);
480		if (rcu_access_pointer(txq->qdisc) != &noop_qdisc)
481			return false;
482	}
483	return true;
484}
485
486static inline unsigned int qdisc_pkt_len(const struct sk_buff *skb)
487{
488	return qdisc_skb_cb(skb)->pkt_len;
489}
490
491/* additional qdisc xmit flags (NET_XMIT_MASK in linux/netdevice.h) */
492enum net_xmit_qdisc_t {
493	__NET_XMIT_STOLEN = 0x00010000,
494	__NET_XMIT_BYPASS = 0x00020000,
495};
496
497#ifdef CONFIG_NET_CLS_ACT
498#define net_xmit_drop_count(e)	((e) & __NET_XMIT_STOLEN ? 0 : 1)
499#else
500#define net_xmit_drop_count(e)	(1)
501#endif
502
503static inline void qdisc_calculate_pkt_len(struct sk_buff *skb,
504					   const struct Qdisc *sch)
505{
506#ifdef CONFIG_NET_SCHED
507	struct qdisc_size_table *stab = rcu_dereference_bh(sch->stab);
508
509	if (stab)
510		__qdisc_calculate_pkt_len(skb, stab);
511#endif
512}
513
514static inline int qdisc_enqueue(struct sk_buff *skb, struct Qdisc *sch,
515				struct sk_buff **to_free)
516{
517	qdisc_calculate_pkt_len(skb, sch);
518	return sch->enqueue(skb, sch, to_free);
519}
520
521static inline bool qdisc_is_percpu_stats(const struct Qdisc *q)
522{
523	return q->flags & TCQ_F_CPUSTATS;
524}
525
526static inline void _bstats_update(struct gnet_stats_basic_packed *bstats,
527				  __u64 bytes, __u32 packets)
528{
529	bstats->bytes += bytes;
530	bstats->packets += packets;
531}
532
533static inline void bstats_update(struct gnet_stats_basic_packed *bstats,
534				 const struct sk_buff *skb)
535{
536	_bstats_update(bstats,
537		       qdisc_pkt_len(skb),
538		       skb_is_gso(skb) ? skb_shinfo(skb)->gso_segs : 1);
539}
540
541static inline void _bstats_cpu_update(struct gnet_stats_basic_cpu *bstats,
542				      __u64 bytes, __u32 packets)
543{
544	u64_stats_update_begin(&bstats->syncp);
545	_bstats_update(&bstats->bstats, bytes, packets);
546	u64_stats_update_end(&bstats->syncp);
547}
548
549static inline void bstats_cpu_update(struct gnet_stats_basic_cpu *bstats,
550				     const struct sk_buff *skb)
551{
552	u64_stats_update_begin(&bstats->syncp);
553	bstats_update(&bstats->bstats, skb);
554	u64_stats_update_end(&bstats->syncp);
555}
556
557static inline void qdisc_bstats_cpu_update(struct Qdisc *sch,
558					   const struct sk_buff *skb)
559{
560	bstats_cpu_update(this_cpu_ptr(sch->cpu_bstats), skb);
561}
562
563static inline void qdisc_bstats_update(struct Qdisc *sch,
564				       const struct sk_buff *skb)
565{
566	bstats_update(&sch->bstats, skb);
567}
568
569static inline void qdisc_qstats_backlog_dec(struct Qdisc *sch,
570					    const struct sk_buff *skb)
571{
572	sch->qstats.backlog -= qdisc_pkt_len(skb);
573}
574
575static inline void qdisc_qstats_backlog_inc(struct Qdisc *sch,
576					    const struct sk_buff *skb)
577{
578	sch->qstats.backlog += qdisc_pkt_len(skb);
579}
580
581static inline void __qdisc_qstats_drop(struct Qdisc *sch, int count)
582{
583	sch->qstats.drops += count;
584}
585
586static inline void qstats_drop_inc(struct gnet_stats_queue *qstats)
587{
588	qstats->drops++;
589}
590
591static inline void qstats_overlimit_inc(struct gnet_stats_queue *qstats)
592{
593	qstats->overlimits++;
594}
595
596static inline void qdisc_qstats_drop(struct Qdisc *sch)
597{
598	qstats_drop_inc(&sch->qstats);
599}
600
601static inline void qdisc_qstats_cpu_drop(struct Qdisc *sch)
602{
603	this_cpu_inc(sch->cpu_qstats->drops);
604}
605
606static inline void qdisc_qstats_overlimit(struct Qdisc *sch)
607{
608	sch->qstats.overlimits++;
609}
610
611static inline void qdisc_skb_head_init(struct qdisc_skb_head *qh)
612{
613	qh->head = NULL;
614	qh->tail = NULL;
615	qh->qlen = 0;
616}
617
618static inline int __qdisc_enqueue_tail(struct sk_buff *skb, struct Qdisc *sch,
619				       struct qdisc_skb_head *qh)
620{
621	struct sk_buff *last = qh->tail;
622
623	if (last) {
624		skb->next = NULL;
625		last->next = skb;
626		qh->tail = skb;
627	} else {
628		qh->tail = skb;
629		qh->head = skb;
630	}
631	qh->qlen++;
632	qdisc_qstats_backlog_inc(sch, skb);
633
634	return NET_XMIT_SUCCESS;
635}
636
637static inline int qdisc_enqueue_tail(struct sk_buff *skb, struct Qdisc *sch)
638{
639	return __qdisc_enqueue_tail(skb, sch, &sch->q);
640}
641
642static inline struct sk_buff *__qdisc_dequeue_head(struct qdisc_skb_head *qh)
 
643{
644	struct sk_buff *skb = qh->head;
645
646	if (likely(skb != NULL)) {
647		qh->head = skb->next;
648		qh->qlen--;
649		if (qh->head == NULL)
650			qh->tail = NULL;
651		skb->next = NULL;
652	}
653
654	return skb;
655}
656
657static inline struct sk_buff *qdisc_dequeue_head(struct Qdisc *sch)
658{
659	struct sk_buff *skb = __qdisc_dequeue_head(&sch->q);
 
 
 
 
 
 
660
661	if (likely(skb != NULL)) {
 
662		qdisc_qstats_backlog_dec(sch, skb);
663		qdisc_bstats_update(sch, skb);
 
664	}
665
666	return skb;
667}
668
669/* Instead of calling kfree_skb() while root qdisc lock is held,
670 * queue the skb for future freeing at end of __dev_xmit_skb()
671 */
672static inline void __qdisc_drop(struct sk_buff *skb, struct sk_buff **to_free)
673{
674	skb->next = *to_free;
675	*to_free = skb;
676}
677
678static inline unsigned int __qdisc_queue_drop_head(struct Qdisc *sch,
679						   struct qdisc_skb_head *qh,
680						   struct sk_buff **to_free)
681{
682	struct sk_buff *skb = __qdisc_dequeue_head(qh);
683
684	if (likely(skb != NULL)) {
685		unsigned int len = qdisc_pkt_len(skb);
686
 
687		qdisc_qstats_backlog_dec(sch, skb);
688		__qdisc_drop(skb, to_free);
689		return len;
690	}
691
692	return 0;
693}
694
695static inline unsigned int qdisc_queue_drop_head(struct Qdisc *sch,
696						 struct sk_buff **to_free)
697{
698	return __qdisc_queue_drop_head(sch, &sch->q, to_free);
699}
700
701static inline struct sk_buff *qdisc_peek_head(struct Qdisc *sch)
702{
703	const struct qdisc_skb_head *qh = &sch->q;
704
705	return qh->head;
706}
707
708/* generic pseudo peek method for non-work-conserving qdisc */
709static inline struct sk_buff *qdisc_peek_dequeued(struct Qdisc *sch)
710{
711	/* we can reuse ->gso_skb because peek isn't called for root qdiscs */
712	if (!sch->gso_skb) {
713		sch->gso_skb = sch->dequeue(sch);
714		if (sch->gso_skb) {
715			/* it's still part of the queue */
716			qdisc_qstats_backlog_inc(sch, sch->gso_skb);
717			sch->q.qlen++;
718		}
719	}
720
721	return sch->gso_skb;
722}
723
724/* use instead of qdisc->dequeue() for all qdiscs queried with ->peek() */
725static inline struct sk_buff *qdisc_dequeue_peeked(struct Qdisc *sch)
726{
727	struct sk_buff *skb = sch->gso_skb;
728
729	if (skb) {
730		sch->gso_skb = NULL;
731		qdisc_qstats_backlog_dec(sch, skb);
732		sch->q.qlen--;
733	} else {
734		skb = sch->dequeue(sch);
735	}
736
737	return skb;
738}
739
740static inline void __qdisc_reset_queue(struct qdisc_skb_head *qh)
 
741{
742	/*
743	 * We do not know the backlog in bytes of this list, it
744	 * is up to the caller to correct it
745	 */
746	ASSERT_RTNL();
747	if (qh->qlen) {
748		rtnl_kfree_skbs(qh->head, qh->tail);
749
750		qh->head = NULL;
751		qh->tail = NULL;
752		qh->qlen = 0;
753	}
754}
755
756static inline void qdisc_reset_queue(struct Qdisc *sch)
757{
758	__qdisc_reset_queue(&sch->q);
759	sch->qstats.backlog = 0;
760}
761
762static inline struct Qdisc *qdisc_replace(struct Qdisc *sch, struct Qdisc *new,
763					  struct Qdisc **pold)
764{
765	struct Qdisc *old;
766
767	sch_tree_lock(sch);
768	old = *pold;
769	*pold = new;
770	if (old != NULL) {
771		qdisc_tree_reduce_backlog(old, old->q.qlen, old->qstats.backlog);
772		qdisc_reset(old);
773	}
774	sch_tree_unlock(sch);
775
776	return old;
777}
778
779static inline void rtnl_qdisc_drop(struct sk_buff *skb, struct Qdisc *sch)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
780{
781	rtnl_kfree_skbs(skb, skb);
 
 
 
 
 
782	qdisc_qstats_drop(sch);
 
 
783}
784
785
786static inline int qdisc_drop(struct sk_buff *skb, struct Qdisc *sch,
787			     struct sk_buff **to_free)
788{
789	__qdisc_drop(skb, to_free);
790	qdisc_qstats_drop(sch);
791
 
 
 
 
 
 
 
 
 
792	return NET_XMIT_DROP;
793}
794
795/* Length to Time (L2T) lookup in a qdisc_rate_table, to determine how
796   long it will take to send a packet given its size.
797 */
798static inline u32 qdisc_l2t(struct qdisc_rate_table* rtab, unsigned int pktlen)
799{
800	int slot = pktlen + rtab->rate.cell_align + rtab->rate.overhead;
801	if (slot < 0)
802		slot = 0;
803	slot >>= rtab->rate.cell_log;
804	if (slot > 255)
805		return rtab->data[255]*(slot >> 8) + rtab->data[slot & 0xFF];
806	return rtab->data[slot];
807}
808
809struct psched_ratecfg {
810	u64	rate_bytes_ps; /* bytes per second */
811	u32	mult;
812	u16	overhead;
813	u8	linklayer;
814	u8	shift;
815};
816
817static inline u64 psched_l2t_ns(const struct psched_ratecfg *r,
818				unsigned int len)
819{
820	len += r->overhead;
821
822	if (unlikely(r->linklayer == TC_LINKLAYER_ATM))
823		return ((u64)(DIV_ROUND_UP(len,48)*53) * r->mult) >> r->shift;
824
825	return ((u64)len * r->mult) >> r->shift;
826}
827
828void psched_ratecfg_precompute(struct psched_ratecfg *r,
829			       const struct tc_ratespec *conf,
830			       u64 rate64);
831
832static inline void psched_ratecfg_getrate(struct tc_ratespec *res,
833					  const struct psched_ratecfg *r)
834{
835	memset(res, 0, sizeof(*res));
836
837	/* legacy struct tc_ratespec has a 32bit @rate field
838	 * Qdisc using 64bit rate should add new attributes
839	 * in order to maintain compatibility.
840	 */
841	res->rate = min_t(u64, r->rate_bytes_ps, ~0U);
842
843	res->overhead = r->overhead;
844	res->linklayer = (r->linklayer & TC_LINKLAYER_MASK);
845}
846
847#endif