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