162306a36Sopenharmony_ci// SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause)
262306a36Sopenharmony_ci// Copyright (C) 2018 Facebook
362306a36Sopenharmony_ci
462306a36Sopenharmony_ci#include <stdlib.h>
562306a36Sopenharmony_ci#include <string.h>
662306a36Sopenharmony_ci#include <bpf/libbpf.h>
762306a36Sopenharmony_ci#include <linux/rtnetlink.h>
862306a36Sopenharmony_ci#include <linux/tc_act/tc_bpf.h>
962306a36Sopenharmony_ci
1062306a36Sopenharmony_ci#include "bpf/nlattr.h"
1162306a36Sopenharmony_ci#include "main.h"
1262306a36Sopenharmony_ci#include "netlink_dumper.h"
1362306a36Sopenharmony_ci
1462306a36Sopenharmony_cistatic void xdp_dump_prog_id(struct nlattr **tb, int attr,
1562306a36Sopenharmony_ci			     const char *mode,
1662306a36Sopenharmony_ci			     bool new_json_object)
1762306a36Sopenharmony_ci{
1862306a36Sopenharmony_ci	if (!tb[attr])
1962306a36Sopenharmony_ci		return;
2062306a36Sopenharmony_ci
2162306a36Sopenharmony_ci	if (new_json_object)
2262306a36Sopenharmony_ci		NET_START_OBJECT
2362306a36Sopenharmony_ci	NET_DUMP_STR("mode", " %s", mode);
2462306a36Sopenharmony_ci	NET_DUMP_UINT("id", " id %u", libbpf_nla_getattr_u32(tb[attr]))
2562306a36Sopenharmony_ci	if (new_json_object)
2662306a36Sopenharmony_ci		NET_END_OBJECT
2762306a36Sopenharmony_ci}
2862306a36Sopenharmony_ci
2962306a36Sopenharmony_cistatic int do_xdp_dump_one(struct nlattr *attr, unsigned int ifindex,
3062306a36Sopenharmony_ci			   const char *name)
3162306a36Sopenharmony_ci{
3262306a36Sopenharmony_ci	struct nlattr *tb[IFLA_XDP_MAX + 1];
3362306a36Sopenharmony_ci	unsigned char mode;
3462306a36Sopenharmony_ci
3562306a36Sopenharmony_ci	if (libbpf_nla_parse_nested(tb, IFLA_XDP_MAX, attr, NULL) < 0)
3662306a36Sopenharmony_ci		return -1;
3762306a36Sopenharmony_ci
3862306a36Sopenharmony_ci	if (!tb[IFLA_XDP_ATTACHED])
3962306a36Sopenharmony_ci		return 0;
4062306a36Sopenharmony_ci
4162306a36Sopenharmony_ci	mode = libbpf_nla_getattr_u8(tb[IFLA_XDP_ATTACHED]);
4262306a36Sopenharmony_ci	if (mode == XDP_ATTACHED_NONE)
4362306a36Sopenharmony_ci		return 0;
4462306a36Sopenharmony_ci
4562306a36Sopenharmony_ci	NET_START_OBJECT;
4662306a36Sopenharmony_ci	if (name)
4762306a36Sopenharmony_ci		NET_DUMP_STR("devname", "%s", name);
4862306a36Sopenharmony_ci	NET_DUMP_UINT("ifindex", "(%d)", ifindex);
4962306a36Sopenharmony_ci
5062306a36Sopenharmony_ci	if (mode == XDP_ATTACHED_MULTI) {
5162306a36Sopenharmony_ci		if (json_output) {
5262306a36Sopenharmony_ci			jsonw_name(json_wtr, "multi_attachments");
5362306a36Sopenharmony_ci			jsonw_start_array(json_wtr);
5462306a36Sopenharmony_ci		}
5562306a36Sopenharmony_ci		xdp_dump_prog_id(tb, IFLA_XDP_SKB_PROG_ID, "generic", true);
5662306a36Sopenharmony_ci		xdp_dump_prog_id(tb, IFLA_XDP_DRV_PROG_ID, "driver", true);
5762306a36Sopenharmony_ci		xdp_dump_prog_id(tb, IFLA_XDP_HW_PROG_ID, "offload", true);
5862306a36Sopenharmony_ci		if (json_output)
5962306a36Sopenharmony_ci			jsonw_end_array(json_wtr);
6062306a36Sopenharmony_ci	} else if (mode == XDP_ATTACHED_DRV) {
6162306a36Sopenharmony_ci		xdp_dump_prog_id(tb, IFLA_XDP_PROG_ID, "driver", false);
6262306a36Sopenharmony_ci	} else if (mode == XDP_ATTACHED_SKB) {
6362306a36Sopenharmony_ci		xdp_dump_prog_id(tb, IFLA_XDP_PROG_ID, "generic", false);
6462306a36Sopenharmony_ci	} else if (mode == XDP_ATTACHED_HW) {
6562306a36Sopenharmony_ci		xdp_dump_prog_id(tb, IFLA_XDP_PROG_ID, "offload", false);
6662306a36Sopenharmony_ci	}
6762306a36Sopenharmony_ci
6862306a36Sopenharmony_ci	NET_END_OBJECT_FINAL;
6962306a36Sopenharmony_ci	return 0;
7062306a36Sopenharmony_ci}
7162306a36Sopenharmony_ci
7262306a36Sopenharmony_ciint do_xdp_dump(struct ifinfomsg *ifinfo, struct nlattr **tb)
7362306a36Sopenharmony_ci{
7462306a36Sopenharmony_ci	if (!tb[IFLA_XDP])
7562306a36Sopenharmony_ci		return 0;
7662306a36Sopenharmony_ci
7762306a36Sopenharmony_ci	return do_xdp_dump_one(tb[IFLA_XDP], ifinfo->ifi_index,
7862306a36Sopenharmony_ci			       libbpf_nla_getattr_str(tb[IFLA_IFNAME]));
7962306a36Sopenharmony_ci}
8062306a36Sopenharmony_ci
8162306a36Sopenharmony_cistatic int do_bpf_dump_one_act(struct nlattr *attr)
8262306a36Sopenharmony_ci{
8362306a36Sopenharmony_ci	struct nlattr *tb[TCA_ACT_BPF_MAX + 1];
8462306a36Sopenharmony_ci
8562306a36Sopenharmony_ci	if (libbpf_nla_parse_nested(tb, TCA_ACT_BPF_MAX, attr, NULL) < 0)
8662306a36Sopenharmony_ci		return -LIBBPF_ERRNO__NLPARSE;
8762306a36Sopenharmony_ci
8862306a36Sopenharmony_ci	if (!tb[TCA_ACT_BPF_PARMS])
8962306a36Sopenharmony_ci		return -LIBBPF_ERRNO__NLPARSE;
9062306a36Sopenharmony_ci
9162306a36Sopenharmony_ci	NET_START_OBJECT_NESTED2;
9262306a36Sopenharmony_ci	if (tb[TCA_ACT_BPF_NAME])
9362306a36Sopenharmony_ci		NET_DUMP_STR("name", "%s",
9462306a36Sopenharmony_ci			     libbpf_nla_getattr_str(tb[TCA_ACT_BPF_NAME]));
9562306a36Sopenharmony_ci	if (tb[TCA_ACT_BPF_ID])
9662306a36Sopenharmony_ci		NET_DUMP_UINT("id", " id %u",
9762306a36Sopenharmony_ci			      libbpf_nla_getattr_u32(tb[TCA_ACT_BPF_ID]));
9862306a36Sopenharmony_ci	NET_END_OBJECT_NESTED;
9962306a36Sopenharmony_ci	return 0;
10062306a36Sopenharmony_ci}
10162306a36Sopenharmony_ci
10262306a36Sopenharmony_cistatic int do_dump_one_act(struct nlattr *attr)
10362306a36Sopenharmony_ci{
10462306a36Sopenharmony_ci	struct nlattr *tb[TCA_ACT_MAX + 1];
10562306a36Sopenharmony_ci
10662306a36Sopenharmony_ci	if (!attr)
10762306a36Sopenharmony_ci		return 0;
10862306a36Sopenharmony_ci
10962306a36Sopenharmony_ci	if (libbpf_nla_parse_nested(tb, TCA_ACT_MAX, attr, NULL) < 0)
11062306a36Sopenharmony_ci		return -LIBBPF_ERRNO__NLPARSE;
11162306a36Sopenharmony_ci
11262306a36Sopenharmony_ci	if (tb[TCA_ACT_KIND] &&
11362306a36Sopenharmony_ci	    strcmp(libbpf_nla_data(tb[TCA_ACT_KIND]), "bpf") == 0)
11462306a36Sopenharmony_ci		return do_bpf_dump_one_act(tb[TCA_ACT_OPTIONS]);
11562306a36Sopenharmony_ci
11662306a36Sopenharmony_ci	return 0;
11762306a36Sopenharmony_ci}
11862306a36Sopenharmony_ci
11962306a36Sopenharmony_cistatic int do_bpf_act_dump(struct nlattr *attr)
12062306a36Sopenharmony_ci{
12162306a36Sopenharmony_ci	struct nlattr *tb[TCA_ACT_MAX_PRIO + 1];
12262306a36Sopenharmony_ci	int act, ret;
12362306a36Sopenharmony_ci
12462306a36Sopenharmony_ci	if (libbpf_nla_parse_nested(tb, TCA_ACT_MAX_PRIO, attr, NULL) < 0)
12562306a36Sopenharmony_ci		return -LIBBPF_ERRNO__NLPARSE;
12662306a36Sopenharmony_ci
12762306a36Sopenharmony_ci	NET_START_ARRAY("act", " %s [");
12862306a36Sopenharmony_ci	for (act = 0; act <= TCA_ACT_MAX_PRIO; act++) {
12962306a36Sopenharmony_ci		ret = do_dump_one_act(tb[act]);
13062306a36Sopenharmony_ci		if (ret)
13162306a36Sopenharmony_ci			break;
13262306a36Sopenharmony_ci	}
13362306a36Sopenharmony_ci	NET_END_ARRAY("] ");
13462306a36Sopenharmony_ci
13562306a36Sopenharmony_ci	return ret;
13662306a36Sopenharmony_ci}
13762306a36Sopenharmony_ci
13862306a36Sopenharmony_cistatic int do_bpf_filter_dump(struct nlattr *attr)
13962306a36Sopenharmony_ci{
14062306a36Sopenharmony_ci	struct nlattr *tb[TCA_BPF_MAX + 1];
14162306a36Sopenharmony_ci	int ret;
14262306a36Sopenharmony_ci
14362306a36Sopenharmony_ci	if (libbpf_nla_parse_nested(tb, TCA_BPF_MAX, attr, NULL) < 0)
14462306a36Sopenharmony_ci		return -LIBBPF_ERRNO__NLPARSE;
14562306a36Sopenharmony_ci
14662306a36Sopenharmony_ci	if (tb[TCA_BPF_NAME])
14762306a36Sopenharmony_ci		NET_DUMP_STR("name", " %s",
14862306a36Sopenharmony_ci			     libbpf_nla_getattr_str(tb[TCA_BPF_NAME]));
14962306a36Sopenharmony_ci	if (tb[TCA_BPF_ID])
15062306a36Sopenharmony_ci		NET_DUMP_UINT("id", " id %u",
15162306a36Sopenharmony_ci			      libbpf_nla_getattr_u32(tb[TCA_BPF_ID]));
15262306a36Sopenharmony_ci	if (tb[TCA_BPF_ACT]) {
15362306a36Sopenharmony_ci		ret = do_bpf_act_dump(tb[TCA_BPF_ACT]);
15462306a36Sopenharmony_ci		if (ret)
15562306a36Sopenharmony_ci			return ret;
15662306a36Sopenharmony_ci	}
15762306a36Sopenharmony_ci
15862306a36Sopenharmony_ci	return 0;
15962306a36Sopenharmony_ci}
16062306a36Sopenharmony_ci
16162306a36Sopenharmony_ciint do_filter_dump(struct tcmsg *info, struct nlattr **tb, const char *kind,
16262306a36Sopenharmony_ci		   const char *devname, int ifindex)
16362306a36Sopenharmony_ci{
16462306a36Sopenharmony_ci	int ret = 0;
16562306a36Sopenharmony_ci
16662306a36Sopenharmony_ci	if (tb[TCA_OPTIONS] &&
16762306a36Sopenharmony_ci	    strcmp(libbpf_nla_data(tb[TCA_KIND]), "bpf") == 0) {
16862306a36Sopenharmony_ci		NET_START_OBJECT;
16962306a36Sopenharmony_ci		if (devname[0] != '\0')
17062306a36Sopenharmony_ci			NET_DUMP_STR("devname", "%s", devname);
17162306a36Sopenharmony_ci		NET_DUMP_UINT("ifindex", "(%u)", ifindex);
17262306a36Sopenharmony_ci		NET_DUMP_STR("kind", " %s", kind);
17362306a36Sopenharmony_ci		ret = do_bpf_filter_dump(tb[TCA_OPTIONS]);
17462306a36Sopenharmony_ci		NET_END_OBJECT_FINAL;
17562306a36Sopenharmony_ci	}
17662306a36Sopenharmony_ci
17762306a36Sopenharmony_ci	return ret;
17862306a36Sopenharmony_ci}
179