Home | History | Annotate | Line # | Download | only in pfctl
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