1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39 #ifndef _ALTQ_ALTQ_CLASSQ_H_
40 #define _ALTQ_ALTQ_CLASSQ_H_
41
42 #ifdef __cplusplus
43 extern "C" {
44 #endif
45
46
47
48
49 #define Q_DROPHEAD 0x00
50 #define Q_RED 0x01
51 #define Q_RIO 0x02
52 #define Q_DROPTAIL 0x03
53
54 #ifdef _KERNEL
55
56
57
58
59 struct _class_queue_ {
60 struct mbuf *tail_;
61 int qlen_;
62 int qlim_;
63 int qtype_;
64 };
65
66 typedef struct _class_queue_ class_queue_t;
67
68 #define qtype(q) (q)->qtype_
69 #define qlimit(q) (q)->qlim_
70 #define qlen(q) (q)->qlen_
71 #define qtail(q) (q)->tail_
72 #define qhead(q) ((q)->tail_ ? (q)->tail_->m_nextpkt : NULL)
73
74 #define qempty(q) ((q)->qlen_ == 0)
75 #define q_is_red(q) ((q)->qtype_ == Q_RED)
76 #define q_is_rio(q) ((q)->qtype_ == Q_RIO)
77 #define q_is_red_or_rio(q) ((q)->qtype_ == Q_RED || (q)->qtype_ == Q_RIO)
78
79 #if !defined(__GNUC__) || defined(ALTQ_DEBUG)
80
81 extern void _addq(class_queue_t *, struct mbuf *);
82 extern struct mbuf *_getq(class_queue_t *);
83 extern struct mbuf *_getq_tail(class_queue_t *);
84 extern struct mbuf *_getq_random(class_queue_t *);
85 extern void _removeq(class_queue_t *, struct mbuf *);
86 extern void _flushq(class_queue_t *);
87
88 #else
89
90
91
92 static __inline void
93 _addq(class_queue_t *q, struct mbuf *m)
94 {
95 struct mbuf *m0;
96
97 if ((m0 = qtail(q)) != NULL)
98 m->m_nextpkt = m0->m_nextpkt;
99 else
100 m0 = m;
101 m0->m_nextpkt = m;
102 qtail(q) = m;
103 qlen(q)++;
104 }
105
106 static __inline struct mbuf *
107 _getq(class_queue_t *q)
108 {
109 struct mbuf *m, *m0;
110
111 if ((m = qtail(q)) == NULL)
112 return (NULL);
113 if ((m0 = m->m_nextpkt) != m)
114 m->m_nextpkt = m0->m_nextpkt;
115 else
116 qtail(q) = NULL;
117 qlen(q)--;
118 m0->m_nextpkt = NULL;
119 return (m0);
120 }
121
122
123 static __inline struct mbuf *
124 _getq_tail(class_queue_t *q)
125 {
126 struct mbuf *m, *m0, *prev;
127
128 if ((m = m0 = qtail(q)) == NULL)
129 return NULL;
130 do {
131 prev = m0;
132 m0 = m0->m_nextpkt;
133 } while (m0 != m);
134 prev->m_nextpkt = m->m_nextpkt;
135 if (prev == m)
136 qtail(q) = NULL;
137 else
138 qtail(q) = prev;
139 qlen(q)--;
140 m->m_nextpkt = NULL;
141 return (m);
142 }
143
144
145 static __inline struct mbuf *
146 _getq_random(class_queue_t *q)
147 {
148 struct mbuf *m;
149 int i, n;
150
151 if ((m = qtail(q)) == NULL)
152 return NULL;
153 if (m->m_nextpkt == m)
154 qtail(q) = NULL;
155 else {
156 struct mbuf *prev = NULL;
157
158 n = random() % qlen(q) + 1;
159 for (i = 0; i < n; i++) {
160 prev = m;
161 m = m->m_nextpkt;
162 }
163 prev->m_nextpkt = m->m_nextpkt;
164 if (m == qtail(q))
165 qtail(q) = prev;
166 }
167 qlen(q)--;
168 m->m_nextpkt = NULL;
169 return (m);
170 }
171
172 static __inline void
173 _removeq(class_queue_t *q, struct mbuf *m)
174 {
175 struct mbuf *m0, *prev;
176
177 m0 = qtail(q);
178 do {
179 prev = m0;
180 m0 = m0->m_nextpkt;
181 } while (m0 != m);
182 prev->m_nextpkt = m->m_nextpkt;
183 if (prev == m)
184 qtail(q) = NULL;
185 else if (qtail(q) == m)
186 qtail(q) = prev;
187 qlen(q)--;
188 }
189
190 static __inline void
191 _flushq(class_queue_t *q)
192 {
193 struct mbuf *m;
194
195 while ((m = _getq(q)) != NULL)
196 m_freem(m);
197 }
198
199 #endif
200
201 #endif
202
203 #ifdef __cplusplus
204 }
205 #endif
206
207 #endif