pfctl_qstats.c revision 1.3 1 /* $NetBSD: pfctl_qstats.c,v 1.3 2004/06/23 04:38:43 itojun Exp $ */
2 /* $OpenBSD: pfctl_qstats.c,v 1.29 2004/03/15 15:25:44 dhartmei Exp $ */
3
4 /*
5 * Copyright (c) Henning Brauer <henning (at) openbsd.org>
6 *
7 * Permission to use, copy, modify, and distribute this software for any
8 * purpose with or without fee is hereby granted, provided that the above
9 * copyright notice and this permission notice appear in all copies.
10 *
11 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
12 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
13 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
14 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
15 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
16 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
17 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
18 */
19
20 #include <sys/types.h>
21 #include <sys/ioctl.h>
22 #include <sys/socket.h>
23
24 #include <net/if.h>
25 #include <netinet/in.h>
26 #include <net/pfvar.h>
27 #include <arpa/inet.h>
28
29 #include <err.h>
30 #include <stdio.h>
31 #include <stdlib.h>
32 #include <string.h>
33 #include <unistd.h>
34
35 #include <altq/altq.h>
36 #include <altq/altq_cbq.h>
37 #include <altq/altq_priq.h>
38 #include <altq/altq_hfsc.h>
39
40 #include "pfctl.h"
41 #include "pfctl_parser.h"
42
43 union class_stats {
44 class_stats_t cbq_stats;
45 #ifdef __OpenBSD__
46 struct priq_classstats priq_stats;
47 struct hfsc_classstats hfsc_stats;
48 #endif
49 };
50
51 #define AVGN_MAX 8
52 #define STAT_INTERVAL 5
53
54 struct queue_stats {
55 union class_stats data;
56 int avgn;
57 double avg_bytes;
58 double avg_packets;
59 u_int64_t prev_bytes;
60 u_int64_t prev_packets;
61 };
62
63 struct pf_altq_node {
64 struct pf_altq altq;
65 struct pf_altq_node *next;
66 struct pf_altq_node *children;
67 struct queue_stats qstats;
68 };
69
70 int pfctl_update_qstats(int, struct pf_altq_node **);
71 void pfctl_insert_altq_node(struct pf_altq_node **,
72 const struct pf_altq, const struct queue_stats);
73 struct pf_altq_node *pfctl_find_altq_node(struct pf_altq_node *,
74 const char *, const char *);
75 void pfctl_print_altq_node(int, const struct pf_altq_node *,
76 unsigned, int);
77 void print_cbqstats(struct queue_stats);
78 void print_priqstats(struct queue_stats);
79 void print_hfscstats(struct queue_stats);
80 void pfctl_free_altq_node(struct pf_altq_node *);
81 void pfctl_print_altq_nodestat(int,
82 const struct pf_altq_node *);
83
84 void update_avg(struct pf_altq_node *);
85
86 int
87 pfctl_show_altq(int dev, const char *iface, int opts, int verbose2)
88 {
89 struct pf_altq_node *root = NULL, *node;
90 int nodes, dotitle = (opts & PF_OPT_SHOWALL);
91
92
93 if ((nodes = pfctl_update_qstats(dev, &root)) < 0)
94 return (-1);
95
96 for (node = root; node != NULL; node = node->next) {
97 if (iface != NULL && strcmp(node->altq.ifname, iface))
98 continue;
99 if (dotitle) {
100 pfctl_print_title("ALTQ:");
101 dotitle = 0;
102 }
103 pfctl_print_altq_node(dev, node, 0, opts);
104 }
105
106 while (verbose2) {
107 printf("\n");
108 fflush(stdout);
109 sleep(STAT_INTERVAL);
110 if (pfctl_update_qstats(dev, &root) == -1)
111 return (-1);
112 for (node = root; node != NULL; node = node->next) {
113 if (iface != NULL && strcmp(node->altq.ifname, iface))
114 continue;
115 pfctl_print_altq_node(dev, node, 0, opts);
116 }
117 }
118 pfctl_free_altq_node(root);
119 return (0);
120 }
121
122 int
123 pfctl_update_qstats(int dev, struct pf_altq_node **root)
124 {
125 struct pf_altq_node *node;
126 struct pfioc_altq pa;
127 struct pfioc_qstats pq;
128 u_int32_t mnr, nr;
129 struct queue_stats qstats;
130 static u_int32_t last_ticket;
131
132 memset(&pa, 0, sizeof(pa));
133 memset(&pq, 0, sizeof(pq));
134 memset(&qstats, 0, sizeof(qstats));
135 if (ioctl(dev, DIOCGETALTQS, &pa)) {
136 warn("DIOCGETALTQS");
137 return (-1);
138 }
139
140 /* if a new set is found, start over */
141 if (pa.ticket != last_ticket && *root != NULL) {
142 pfctl_free_altq_node(*root);
143 *root = NULL;
144 }
145 last_ticket = pa.ticket;
146
147 mnr = pa.nr;
148 for (nr = 0; nr < mnr; ++nr) {
149 pa.nr = nr;
150 if (ioctl(dev, DIOCGETALTQ, &pa)) {
151 warn("DIOCGETALTQ");
152 return (-1);
153 }
154 if (pa.altq.qid > 0) {
155 pq.nr = nr;
156 pq.ticket = pa.ticket;
157 pq.buf = &qstats.data;
158 pq.nbytes = sizeof(qstats.data);
159 if (ioctl(dev, DIOCGETQSTATS, &pq)) {
160 warn("DIOCGETQSTATS");
161 return (-1);
162 }
163 if ((node = pfctl_find_altq_node(*root, pa.altq.qname,
164 pa.altq.ifname)) != NULL) {
165 memcpy(&node->qstats.data, &qstats.data,
166 sizeof(qstats.data));
167 update_avg(node);
168 } else {
169 pfctl_insert_altq_node(root, pa.altq, qstats);
170 }
171 }
172 }
173 return (mnr);
174 }
175
176 void
177 pfctl_insert_altq_node(struct pf_altq_node **root,
178 const struct pf_altq altq, const struct queue_stats qstats)
179 {
180 struct pf_altq_node *node;
181
182 node = calloc(1, sizeof(struct pf_altq_node));
183 if (node == NULL)
184 err(1, "pfctl_insert_altq_node: calloc");
185 memcpy(&node->altq, &altq, sizeof(struct pf_altq));
186 memcpy(&node->qstats, &qstats, sizeof(qstats));
187 node->next = node->children = NULL;
188
189 if (*root == NULL)
190 *root = node;
191 else if (!altq.parent[0]) {
192 struct pf_altq_node *prev = *root;
193
194 while (prev->next != NULL)
195 prev = prev->next;
196 prev->next = node;
197 } else {
198 struct pf_altq_node *parent;
199
200 parent = pfctl_find_altq_node(*root, altq.parent, altq.ifname);
201 if (parent == NULL)
202 errx(1, "parent %s not found", altq.parent);
203 if (parent->children == NULL)
204 parent->children = node;
205 else {
206 struct pf_altq_node *prev = parent->children;
207
208 while (prev->next != NULL)
209 prev = prev->next;
210 prev->next = node;
211 }
212 }
213 update_avg(node);
214 }
215
216 struct pf_altq_node *
217 pfctl_find_altq_node(struct pf_altq_node *root, const char *qname,
218 const char *ifname)
219 {
220 struct pf_altq_node *node, *child;
221
222 for (node = root; node != NULL; node = node->next) {
223 if (!strcmp(node->altq.qname, qname)
224 && !(strcmp(node->altq.ifname, ifname)))
225 return (node);
226 if (node->children != NULL) {
227 child = pfctl_find_altq_node(node->children, qname,
228 ifname);
229 if (child != NULL)
230 return (child);
231 }
232 }
233 return (NULL);
234 }
235
236 void
237 pfctl_print_altq_node(int dev, const struct pf_altq_node *node, unsigned level,
238 int opts)
239 {
240 const struct pf_altq_node *child;
241
242 if (node == NULL)
243 return;
244
245 print_altq(&node->altq, level, NULL, NULL);
246
247 if (node->children != NULL) {
248 printf("{");
249 for (child = node->children; child != NULL;
250 child = child->next) {
251 printf("%s", child->altq.qname);
252 if (child->next != NULL)
253 printf(", ");
254 }
255 printf("}");
256 }
257 printf("\n");
258
259 if (opts & PF_OPT_VERBOSE)
260 pfctl_print_altq_nodestat(dev, node);
261
262 if (opts & PF_OPT_DEBUG)
263 printf(" [ qid=%u ifname=%s ifbandwidth=%s ]\n",
264 node->altq.qid, node->altq.ifname,
265 rate2str((double)(node->altq.ifbandwidth)));
266
267 for (child = node->children; child != NULL;
268 child = child->next)
269 pfctl_print_altq_node(dev, child, level + 1, opts);
270 }
271
272 void
273 pfctl_print_altq_nodestat(int dev, const struct pf_altq_node *a)
274 {
275 if (a->altq.qid == 0)
276 return;
277
278 switch (a->altq.scheduler) {
279 case ALTQT_CBQ:
280 print_cbqstats(a->qstats);
281 break;
282 case ALTQT_PRIQ:
283 print_priqstats(a->qstats);
284 break;
285 case ALTQT_HFSC:
286 print_hfscstats(a->qstats);
287 break;
288 }
289 }
290
291 void
292 print_cbqstats(struct queue_stats cur)
293 {
294 printf(" [ pkts: %10llu bytes: %10llu "
295 "dropped pkts: %6llu bytes: %6llu ]\n",
296 (unsigned long long)cur.data.cbq_stats.xmit_cnt.packets,
297 (unsigned long long)cur.data.cbq_stats.xmit_cnt.bytes,
298 (unsigned long long)cur.data.cbq_stats.drop_cnt.packets,
299 (unsigned long long)cur.data.cbq_stats.drop_cnt.bytes);
300 printf(" [ qlength: %3d/%3d borrows: %6u suspends: %6u ]\n",
301 cur.data.cbq_stats.qcnt, cur.data.cbq_stats.qmax,
302 cur.data.cbq_stats.borrows, cur.data.cbq_stats.delays);
303
304 if (cur.avgn < 2)
305 return;
306
307 printf(" [ measured: %7.1f packets/s, %s/s ]\n",
308 cur.avg_packets / STAT_INTERVAL,
309 rate2str((8 * cur.avg_bytes) / STAT_INTERVAL));
310 }
311
312 void
313 print_priqstats(struct queue_stats cur)
314 {
315 #ifdef __OpenBSD__
316 printf(" [ pkts: %10llu bytes: %10llu "
317 "dropped pkts: %6llu bytes: %6llu ]\n",
318 (unsigned long long)cur.data.priq_stats.xmitcnt.packets,
319 (unsigned long long)cur.data.priq_stats.xmitcnt.bytes,
320 (unsigned long long)cur.data.priq_stats.dropcnt.packets,
321 (unsigned long long)cur.data.priq_stats.dropcnt.bytes);
322 printf(" [ qlength: %3d/%3d ]\n",
323 cur.data.priq_stats.qlength, cur.data.priq_stats.qlimit);
324
325 if (cur.avgn < 2)
326 return;
327
328 printf(" [ measured: %7.1f packets/s, %s/s ]\n",
329 cur.avg_packets / STAT_INTERVAL,
330 rate2str((8 * cur.avg_bytes) / STAT_INTERVAL));
331 #endif
332 }
333
334 void
335 print_hfscstats(struct queue_stats cur)
336 {
337 #ifdef __OpenBSD__
338 printf(" [ pkts: %10llu bytes: %10llu "
339 "dropped pkts: %6llu bytes: %6llu ]\n",
340 (unsigned long long)cur.data.hfsc_stats.xmit_cnt.packets,
341 (unsigned long long)cur.data.hfsc_stats.xmit_cnt.bytes,
342 (unsigned long long)cur.data.hfsc_stats.drop_cnt.packets,
343 (unsigned long long)cur.data.hfsc_stats.drop_cnt.bytes);
344 printf(" [ qlength: %3d/%3d ]\n",
345 cur.data.hfsc_stats.qlength, cur.data.hfsc_stats.qlimit);
346
347 if (cur.avgn < 2)
348 return;
349
350 printf(" [ measured: %7.1f packets/s, %s/s ]\n",
351 cur.avg_packets / STAT_INTERVAL,
352 rate2str((8 * cur.avg_bytes) / STAT_INTERVAL));
353 #endif
354 }
355
356 void
357 pfctl_free_altq_node(struct pf_altq_node *node)
358 {
359 while (node != NULL) {
360 struct pf_altq_node *prev;
361
362 if (node->children != NULL)
363 pfctl_free_altq_node(node->children);
364 prev = node;
365 node = node->next;
366 free(prev);
367 }
368 }
369
370 void
371 update_avg(struct pf_altq_node *a)
372 {
373 struct queue_stats *qs;
374 u_int64_t b, p;
375 int n;
376
377 if (a->altq.qid == 0)
378 return;
379
380 qs = &a->qstats;
381 n = qs->avgn;
382
383 switch (a->altq.scheduler) {
384 case ALTQT_CBQ:
385 b = qs->data.cbq_stats.xmit_cnt.bytes;
386 p = qs->data.cbq_stats.xmit_cnt.packets;
387 break;
388 #ifdef __OpenBSD__
389 case ALTQT_PRIQ:
390 b = qs->data.priq_stats.xmitcnt.bytes;
391 p = qs->data.priq_stats.xmitcnt.packets;
392 break;
393 case ALTQT_HFSC:
394 b = qs->data.hfsc_stats.xmit_cnt.bytes;
395 p = qs->data.hfsc_stats.xmit_cnt.packets;
396 break;
397 #endif
398 default:
399 b = 0;
400 p = 0;
401 break;
402 }
403
404 if (n == 0) {
405 qs->prev_bytes = b;
406 qs->prev_packets = p;
407 qs->avgn++;
408 return;
409 }
410
411 if (b >= qs->prev_bytes)
412 qs->avg_bytes = ((qs->avg_bytes * (n - 1)) +
413 (b - qs->prev_bytes)) / n;
414
415 if (p >= qs->prev_packets)
416 qs->avg_packets = ((qs->avg_packets * (n - 1)) +
417 (p - qs->prev_packets)) / n;
418
419 qs->prev_bytes = b;
420 qs->prev_packets = p;
421 if (n < AVGN_MAX)
422 qs->avgn++;
423 }
424