xref: /openbmc/linux/samples/bpf/hbm.c (revision fe0a5788)
1 // SPDX-License-Identifier: GPL-2.0
2 /* Copyright (c) 2019 Facebook
3  *
4  * This program is free software; you can redistribute it and/or
5  * modify it under the terms of version 2 of the GNU General Public
6  * License as published by the Free Software Foundation.
7  *
8  * Example program for Host Bandwidth Managment
9  *
10  * This program loads a cgroup skb BPF program to enforce cgroup output
11  * (egress) or input (ingress) bandwidth limits.
12  *
13  * USAGE: hbm [-d] [-l] [-n <id>] [-r <rate>] [-s] [-t <secs>] [-w] [-h] [prog]
14  *   Where:
15  *    -d	Print BPF trace debug buffer
16  *    -l	Also limit flows doing loopback
17  *    -n <#>	To create cgroup \"/hbm#\" and attach prog
18  *		Default is /hbm1
19  *    --no_cn   Do not return cn notifications
20  *    -r <rate>	Rate limit in Mbps
21  *    -s	Get HBM stats (marked, dropped, etc.)
22  *    -t <time>	Exit after specified seconds (default is 0)
23  *    -w	Work conserving flag. cgroup can increase its bandwidth
24  *		beyond the rate limit specified while there is available
25  *		bandwidth. Current implementation assumes there is only
26  *		NIC (eth0), but can be extended to support multiple NICs.
27  *		Currrently only supported for egress.
28  *    -h	Print this info
29  *    prog	BPF program file name. Name defaults to hbm_out_kern.o
30  */
31 
32 #define _GNU_SOURCE
33 
34 #include <stdio.h>
35 #include <stdlib.h>
36 #include <assert.h>
37 #include <sys/resource.h>
38 #include <sys/time.h>
39 #include <unistd.h>
40 #include <errno.h>
41 #include <fcntl.h>
42 #include <linux/unistd.h>
43 #include <linux/compiler.h>
44 
45 #include <linux/bpf.h>
46 #include <bpf/bpf.h>
47 #include <getopt.h>
48 
49 #include "bpf_load.h"
50 #include "bpf_rlimit.h"
51 #include "cgroup_helpers.h"
52 #include "hbm.h"
53 #include "bpf_util.h"
54 #include <bpf/bpf.h>
55 #include <bpf/libbpf.h>
56 
57 bool outFlag = true;
58 int minRate = 1000;		/* cgroup rate limit in Mbps */
59 int rate = 1000;		/* can grow if rate conserving is enabled */
60 int dur = 1;
61 bool stats_flag;
62 bool loopback_flag;
63 bool debugFlag;
64 bool work_conserving_flag;
65 bool no_cn_flag;
66 bool edt_flag;
67 
68 static void Usage(void);
69 static void read_trace_pipe2(void);
70 static void do_error(char *msg, bool errno_flag);
71 
72 #define DEBUGFS "/sys/kernel/debug/tracing/"
73 
74 struct bpf_object *obj;
75 int bpfprog_fd;
76 int cgroup_storage_fd;
77 
78 static void read_trace_pipe2(void)
79 {
80 	int trace_fd;
81 	FILE *outf;
82 	char *outFname = "hbm_out.log";
83 
84 	trace_fd = open(DEBUGFS "trace_pipe", O_RDONLY, 0);
85 	if (trace_fd < 0) {
86 		printf("Error opening trace_pipe\n");
87 		return;
88 	}
89 
90 //	Future support of ingress
91 //	if (!outFlag)
92 //		outFname = "hbm_in.log";
93 	outf = fopen(outFname, "w");
94 
95 	if (outf == NULL)
96 		printf("Error creating %s\n", outFname);
97 
98 	while (1) {
99 		static char buf[4097];
100 		ssize_t sz;
101 
102 		sz = read(trace_fd, buf, sizeof(buf) - 1);
103 		if (sz > 0) {
104 			buf[sz] = 0;
105 			puts(buf);
106 			if (outf != NULL) {
107 				fprintf(outf, "%s\n", buf);
108 				fflush(outf);
109 			}
110 		}
111 	}
112 }
113 
114 static void do_error(char *msg, bool errno_flag)
115 {
116 	if (errno_flag)
117 		printf("ERROR: %s, errno: %d\n", msg, errno);
118 	else
119 		printf("ERROR: %s\n", msg);
120 	exit(1);
121 }
122 
123 static int prog_load(char *prog)
124 {
125 	struct bpf_prog_load_attr prog_load_attr = {
126 		.prog_type = BPF_PROG_TYPE_CGROUP_SKB,
127 		.file = prog,
128 		.expected_attach_type = BPF_CGROUP_INET_EGRESS,
129 	};
130 	int map_fd;
131 	struct bpf_map *map;
132 
133 	int ret = 0;
134 
135 	if (access(prog, O_RDONLY) < 0) {
136 		printf("Error accessing file %s: %s\n", prog, strerror(errno));
137 		return 1;
138 	}
139 	if (bpf_prog_load_xattr(&prog_load_attr, &obj, &bpfprog_fd))
140 		ret = 1;
141 	if (!ret) {
142 		map = bpf_object__find_map_by_name(obj, "queue_stats");
143 		map_fd = bpf_map__fd(map);
144 		if (map_fd < 0) {
145 			printf("Map not found: %s\n", strerror(map_fd));
146 			ret = 1;
147 		}
148 	}
149 
150 	if (ret) {
151 		printf("ERROR: bpf_prog_load_xattr failed for: %s\n", prog);
152 		printf("  Output from verifier:\n%s\n------\n", bpf_log_buf);
153 		ret = -1;
154 	} else {
155 		ret = map_fd;
156 	}
157 
158 	return ret;
159 }
160 
161 static int run_bpf_prog(char *prog, int cg_id)
162 {
163 	int map_fd;
164 	int rc = 0;
165 	int key = 0;
166 	int cg1 = 0;
167 	int type = BPF_CGROUP_INET_EGRESS;
168 	char cg_dir[100];
169 	struct hbm_queue_stats qstats = {0};
170 
171 	sprintf(cg_dir, "/hbm%d", cg_id);
172 	map_fd = prog_load(prog);
173 	if (map_fd  == -1)
174 		return 1;
175 
176 	if (setup_cgroup_environment()) {
177 		printf("ERROR: setting cgroup environment\n");
178 		goto err;
179 	}
180 	cg1 = create_and_get_cgroup(cg_dir);
181 	if (!cg1) {
182 		printf("ERROR: create_and_get_cgroup\n");
183 		goto err;
184 	}
185 	if (join_cgroup(cg_dir)) {
186 		printf("ERROR: join_cgroup\n");
187 		goto err;
188 	}
189 
190 	qstats.rate = rate;
191 	qstats.stats = stats_flag ? 1 : 0;
192 	qstats.loopback = loopback_flag ? 1 : 0;
193 	qstats.no_cn = no_cn_flag ? 1 : 0;
194 	if (bpf_map_update_elem(map_fd, &key, &qstats, BPF_ANY)) {
195 		printf("ERROR: Could not update map element\n");
196 		goto err;
197 	}
198 
199 	if (!outFlag)
200 		type = BPF_CGROUP_INET_INGRESS;
201 	if (bpf_prog_attach(bpfprog_fd, cg1, type, 0)) {
202 		printf("ERROR: bpf_prog_attach fails!\n");
203 		log_err("Attaching prog");
204 		goto err;
205 	}
206 
207 	if (work_conserving_flag) {
208 		struct timeval t0, t_last, t_new;
209 		FILE *fin;
210 		unsigned long long last_eth_tx_bytes, new_eth_tx_bytes;
211 		signed long long last_cg_tx_bytes, new_cg_tx_bytes;
212 		signed long long delta_time, delta_bytes, delta_rate;
213 		int delta_ms;
214 #define DELTA_RATE_CHECK 10000		/* in us */
215 #define RATE_THRESHOLD 9500000000	/* 9.5 Gbps */
216 
217 		bpf_map_lookup_elem(map_fd, &key, &qstats);
218 		if (gettimeofday(&t0, NULL) < 0)
219 			do_error("gettimeofday failed", true);
220 		t_last = t0;
221 		fin = fopen("/sys/class/net/eth0/statistics/tx_bytes", "r");
222 		if (fscanf(fin, "%llu", &last_eth_tx_bytes) != 1)
223 			do_error("fscanf fails", false);
224 		fclose(fin);
225 		last_cg_tx_bytes = qstats.bytes_total;
226 		while (true) {
227 			usleep(DELTA_RATE_CHECK);
228 			if (gettimeofday(&t_new, NULL) < 0)
229 				do_error("gettimeofday failed", true);
230 			delta_ms = (t_new.tv_sec - t0.tv_sec) * 1000 +
231 				(t_new.tv_usec - t0.tv_usec)/1000;
232 			if (delta_ms > dur * 1000)
233 				break;
234 			delta_time = (t_new.tv_sec - t_last.tv_sec) * 1000000 +
235 				(t_new.tv_usec - t_last.tv_usec);
236 			if (delta_time == 0)
237 				continue;
238 			t_last = t_new;
239 			fin = fopen("/sys/class/net/eth0/statistics/tx_bytes",
240 				    "r");
241 			if (fscanf(fin, "%llu", &new_eth_tx_bytes) != 1)
242 				do_error("fscanf fails", false);
243 			fclose(fin);
244 			printf("  new_eth_tx_bytes:%llu\n",
245 			       new_eth_tx_bytes);
246 			bpf_map_lookup_elem(map_fd, &key, &qstats);
247 			new_cg_tx_bytes = qstats.bytes_total;
248 			delta_bytes = new_eth_tx_bytes - last_eth_tx_bytes;
249 			last_eth_tx_bytes = new_eth_tx_bytes;
250 			delta_rate = (delta_bytes * 8000000) / delta_time;
251 			printf("%5d - eth_rate:%.1fGbps cg_rate:%.3fGbps",
252 			       delta_ms, delta_rate/1000000000.0,
253 			       rate/1000.0);
254 			if (delta_rate < RATE_THRESHOLD) {
255 				/* can increase cgroup rate limit, but first
256 				 * check if we are using the current limit.
257 				 * Currently increasing by 6.25%, unknown
258 				 * if that is the optimal rate.
259 				 */
260 				int rate_diff100;
261 
262 				delta_bytes = new_cg_tx_bytes -
263 					last_cg_tx_bytes;
264 				last_cg_tx_bytes = new_cg_tx_bytes;
265 				delta_rate = (delta_bytes * 8000000) /
266 					delta_time;
267 				printf(" rate:%.3fGbps",
268 				       delta_rate/1000000000.0);
269 				rate_diff100 = (((long long)rate)*1000000 -
270 						     delta_rate) * 100 /
271 					(((long long) rate) * 1000000);
272 				printf("  rdiff:%d", rate_diff100);
273 				if (rate_diff100  <= 3) {
274 					rate += (rate >> 4);
275 					if (rate > RATE_THRESHOLD / 1000000)
276 						rate = RATE_THRESHOLD / 1000000;
277 					qstats.rate = rate;
278 					printf(" INC\n");
279 				} else {
280 					printf("\n");
281 				}
282 			} else {
283 				/* Need to decrease cgroup rate limit.
284 				 * Currently decreasing by 12.5%, unknown
285 				 * if that is optimal
286 				 */
287 				printf(" DEC\n");
288 				rate -= (rate >> 3);
289 				if (rate < minRate)
290 					rate = minRate;
291 				qstats.rate = rate;
292 			}
293 			if (bpf_map_update_elem(map_fd, &key, &qstats, BPF_ANY))
294 				do_error("update map element fails", false);
295 		}
296 	} else {
297 		sleep(dur);
298 	}
299 	// Get stats!
300 	if (stats_flag && bpf_map_lookup_elem(map_fd, &key, &qstats)) {
301 		char fname[100];
302 		FILE *fout;
303 
304 		if (!outFlag)
305 			sprintf(fname, "hbm.%d.in", cg_id);
306 		else
307 			sprintf(fname, "hbm.%d.out", cg_id);
308 		fout = fopen(fname, "w");
309 		fprintf(fout, "id:%d\n", cg_id);
310 		fprintf(fout, "ERROR: Could not lookup queue_stats\n");
311 	} else if (stats_flag && qstats.lastPacketTime >
312 		   qstats.firstPacketTime) {
313 		long long delta_us = (qstats.lastPacketTime -
314 				      qstats.firstPacketTime)/1000;
315 		unsigned int rate_mbps = ((qstats.bytes_total -
316 					   qstats.bytes_dropped) * 8 /
317 					  delta_us);
318 		double percent_pkts, percent_bytes;
319 		char fname[100];
320 		FILE *fout;
321 		int k;
322 		static const char *returnValNames[] = {
323 			"DROP_PKT",
324 			"ALLOW_PKT",
325 			"DROP_PKT_CWR",
326 			"ALLOW_PKT_CWR"
327 		};
328 #define RET_VAL_COUNT 4
329 
330 // Future support of ingress
331 //		if (!outFlag)
332 //			sprintf(fname, "hbm.%d.in", cg_id);
333 //		else
334 		sprintf(fname, "hbm.%d.out", cg_id);
335 		fout = fopen(fname, "w");
336 		fprintf(fout, "id:%d\n", cg_id);
337 		fprintf(fout, "rate_mbps:%d\n", rate_mbps);
338 		fprintf(fout, "duration:%.1f secs\n",
339 			(qstats.lastPacketTime - qstats.firstPacketTime) /
340 			1000000000.0);
341 		fprintf(fout, "packets:%d\n", (int)qstats.pkts_total);
342 		fprintf(fout, "bytes_MB:%d\n", (int)(qstats.bytes_total /
343 						     1000000));
344 		fprintf(fout, "pkts_dropped:%d\n", (int)qstats.pkts_dropped);
345 		fprintf(fout, "bytes_dropped_MB:%d\n",
346 			(int)(qstats.bytes_dropped /
347 						       1000000));
348 		// Marked Pkts and Bytes
349 		percent_pkts = (qstats.pkts_marked * 100.0) /
350 			(qstats.pkts_total + 1);
351 		percent_bytes = (qstats.bytes_marked * 100.0) /
352 			(qstats.bytes_total + 1);
353 		fprintf(fout, "pkts_marked_percent:%6.2f\n", percent_pkts);
354 		fprintf(fout, "bytes_marked_percent:%6.2f\n", percent_bytes);
355 
356 		// Dropped Pkts and Bytes
357 		percent_pkts = (qstats.pkts_dropped * 100.0) /
358 			(qstats.pkts_total + 1);
359 		percent_bytes = (qstats.bytes_dropped * 100.0) /
360 			(qstats.bytes_total + 1);
361 		fprintf(fout, "pkts_dropped_percent:%6.2f\n", percent_pkts);
362 		fprintf(fout, "bytes_dropped_percent:%6.2f\n", percent_bytes);
363 
364 		// ECN CE markings
365 		percent_pkts = (qstats.pkts_ecn_ce * 100.0) /
366 			(qstats.pkts_total + 1);
367 		fprintf(fout, "pkts_ecn_ce:%6.2f (%d)\n", percent_pkts,
368 			(int)qstats.pkts_ecn_ce);
369 
370 		// Average cwnd
371 		fprintf(fout, "avg cwnd:%d\n",
372 			(int)(qstats.sum_cwnd / (qstats.sum_cwnd_cnt + 1)));
373 		// Average rtt
374 		fprintf(fout, "avg rtt:%d\n",
375 			(int)(qstats.sum_rtt / (qstats.pkts_total + 1)));
376 		// Average credit
377 		if (edt_flag)
378 			fprintf(fout, "avg credit_ms:%.03f\n",
379 				(qstats.sum_credit /
380 				 (qstats.pkts_total + 1.0)) / 1000000.0);
381 		else
382 			fprintf(fout, "avg credit:%d\n",
383 				(int)(qstats.sum_credit /
384 				      (1500 * ((int)qstats.pkts_total ) + 1)));
385 
386 		// Return values stats
387 		for (k = 0; k < RET_VAL_COUNT; k++) {
388 			percent_pkts = (qstats.returnValCount[k] * 100.0) /
389 				(qstats.pkts_total + 1);
390 			fprintf(fout, "%s:%6.2f (%d)\n", returnValNames[k],
391 				percent_pkts, (int)qstats.returnValCount[k]);
392 		}
393 		fclose(fout);
394 	}
395 
396 	if (debugFlag)
397 		read_trace_pipe2();
398 	return rc;
399 err:
400 	rc = 1;
401 
402 	if (cg1)
403 		close(cg1);
404 	cleanup_cgroup_environment();
405 
406 	return rc;
407 }
408 
409 static void Usage(void)
410 {
411 	printf("This program loads a cgroup skb BPF program to enforce\n"
412 	       "cgroup output (egress) bandwidth limits.\n\n"
413 	       "USAGE: hbm [-o] [-d]  [-l] [-n <id>] [--no_cn] [-r <rate>]\n"
414 	       "           [-s] [-t <secs>] [-w] [-h] [prog]\n"
415 	       "  Where:\n"
416 	       "    -o         indicates egress direction (default)\n"
417 	       "    -d         print BPF trace debug buffer\n"
418 	       "    --edt      use fq's Earliest Departure Time\n"
419 	       "    -l         also limit flows using loopback\n"
420 	       "    -n <#>     to create cgroup \"/hbm#\" and attach prog\n"
421 	       "               Default is /hbm1\n"
422 	       "    --no_cn    disable CN notifications\n"
423 	       "    -r <rate>  Rate in Mbps\n"
424 	       "    -s         Update HBM stats\n"
425 	       "    -t <time>  Exit after specified seconds (default is 0)\n"
426 	       "    -w	       Work conserving flag. cgroup can increase\n"
427 	       "               bandwidth beyond the rate limit specified\n"
428 	       "               while there is available bandwidth. Current\n"
429 	       "               implementation assumes there is only eth0\n"
430 	       "               but can be extended to support multiple NICs\n"
431 	       "    -h         print this info\n"
432 	       "    prog       BPF program file name. Name defaults to\n"
433 	       "                 hbm_out_kern.o\n");
434 }
435 
436 int main(int argc, char **argv)
437 {
438 	char *prog = "hbm_out_kern.o";
439 	int  k;
440 	int cg_id = 1;
441 	char *optstring = "iodln:r:st:wh";
442 	struct option loptions[] = {
443 		{"no_cn", 0, NULL, 1},
444 		{"edt", 0, NULL, 2},
445 		{NULL, 0, NULL, 0}
446 	};
447 
448 	while ((k = getopt_long(argc, argv, optstring, loptions, NULL)) != -1) {
449 		switch (k) {
450 		case 1:
451 			no_cn_flag = true;
452 			break;
453 		case 2:
454 			prog = "hbm_edt_kern.o";
455 			edt_flag = true;
456 			break;
457 		case'o':
458 			break;
459 		case 'd':
460 			debugFlag = true;
461 			break;
462 		case 'l':
463 			loopback_flag = true;
464 			break;
465 		case 'n':
466 			cg_id = atoi(optarg);
467 			break;
468 		case 'r':
469 			minRate = atoi(optarg) * 1.024;
470 			rate = minRate;
471 			break;
472 		case 's':
473 			stats_flag = true;
474 			break;
475 		case 't':
476 			dur = atoi(optarg);
477 			break;
478 		case 'w':
479 			work_conserving_flag = true;
480 			break;
481 		case '?':
482 			if (optopt == 'n' || optopt == 'r' || optopt == 't')
483 				fprintf(stderr,
484 					"Option -%c requires an argument.\n\n",
485 					optopt);
486 		case 'h':
487 			__fallthrough;
488 		default:
489 			Usage();
490 			return 0;
491 		}
492 	}
493 
494 	if (optind < argc)
495 		prog = argv[optind];
496 	printf("HBM prog: %s\n", prog != NULL ? prog : "NULL");
497 
498 	return run_bpf_prog(prog, cg_id);
499 }
500