10baf26b0SMartin KaFai Lau // SPDX-License-Identifier: GPL-2.0 20baf26b0SMartin KaFai Lau /* Copyright (c) 2019 Facebook */ 30baf26b0SMartin KaFai Lau 40baf26b0SMartin KaFai Lau #include <linux/types.h> 50baf26b0SMartin KaFai Lau #include <linux/bpf_verifier.h> 60baf26b0SMartin KaFai Lau #include <linux/bpf.h> 70baf26b0SMartin KaFai Lau #include <linux/btf.h> 80baf26b0SMartin KaFai Lau #include <linux/filter.h> 90baf26b0SMartin KaFai Lau #include <net/tcp.h> 10*ab14fd4eSMartin KaFai Lau #include <net/bpf_sk_storage.h> 110baf26b0SMartin KaFai Lau 120baf26b0SMartin KaFai Lau static u32 optional_ops[] = { 130baf26b0SMartin KaFai Lau offsetof(struct tcp_congestion_ops, init), 140baf26b0SMartin KaFai Lau offsetof(struct tcp_congestion_ops, release), 150baf26b0SMartin KaFai Lau offsetof(struct tcp_congestion_ops, set_state), 160baf26b0SMartin KaFai Lau offsetof(struct tcp_congestion_ops, cwnd_event), 170baf26b0SMartin KaFai Lau offsetof(struct tcp_congestion_ops, in_ack_event), 180baf26b0SMartin KaFai Lau offsetof(struct tcp_congestion_ops, pkts_acked), 190baf26b0SMartin KaFai Lau offsetof(struct tcp_congestion_ops, min_tso_segs), 200baf26b0SMartin KaFai Lau offsetof(struct tcp_congestion_ops, sndbuf_expand), 210baf26b0SMartin KaFai Lau offsetof(struct tcp_congestion_ops, cong_control), 220baf26b0SMartin KaFai Lau }; 230baf26b0SMartin KaFai Lau 240baf26b0SMartin KaFai Lau static u32 unsupported_ops[] = { 250baf26b0SMartin KaFai Lau offsetof(struct tcp_congestion_ops, get_info), 260baf26b0SMartin KaFai Lau }; 270baf26b0SMartin KaFai Lau 280baf26b0SMartin KaFai Lau static const struct btf_type *tcp_sock_type; 290baf26b0SMartin KaFai Lau static u32 tcp_sock_id, sock_id; 300baf26b0SMartin KaFai Lau 31*ab14fd4eSMartin KaFai Lau static int btf_sk_storage_get_ids[5]; 32*ab14fd4eSMartin KaFai Lau static struct bpf_func_proto btf_sk_storage_get_proto __read_mostly; 33*ab14fd4eSMartin KaFai Lau 34*ab14fd4eSMartin KaFai Lau static int btf_sk_storage_delete_ids[5]; 35*ab14fd4eSMartin KaFai Lau static struct bpf_func_proto btf_sk_storage_delete_proto __read_mostly; 36*ab14fd4eSMartin KaFai Lau 37*ab14fd4eSMartin KaFai Lau static void convert_sk_func_proto(struct bpf_func_proto *to, int *to_btf_ids, 38*ab14fd4eSMartin KaFai Lau const struct bpf_func_proto *from) 39*ab14fd4eSMartin KaFai Lau { 40*ab14fd4eSMartin KaFai Lau int i; 41*ab14fd4eSMartin KaFai Lau 42*ab14fd4eSMartin KaFai Lau *to = *from; 43*ab14fd4eSMartin KaFai Lau to->btf_id = to_btf_ids; 44*ab14fd4eSMartin KaFai Lau for (i = 0; i < ARRAY_SIZE(to->arg_type); i++) { 45*ab14fd4eSMartin KaFai Lau if (to->arg_type[i] == ARG_PTR_TO_SOCKET) { 46*ab14fd4eSMartin KaFai Lau to->arg_type[i] = ARG_PTR_TO_BTF_ID; 47*ab14fd4eSMartin KaFai Lau to->btf_id[i] = tcp_sock_id; 48*ab14fd4eSMartin KaFai Lau } 49*ab14fd4eSMartin KaFai Lau } 50*ab14fd4eSMartin KaFai Lau } 51*ab14fd4eSMartin KaFai Lau 520baf26b0SMartin KaFai Lau static int bpf_tcp_ca_init(struct btf *btf) 530baf26b0SMartin KaFai Lau { 540baf26b0SMartin KaFai Lau s32 type_id; 550baf26b0SMartin KaFai Lau 560baf26b0SMartin KaFai Lau type_id = btf_find_by_name_kind(btf, "sock", BTF_KIND_STRUCT); 570baf26b0SMartin KaFai Lau if (type_id < 0) 580baf26b0SMartin KaFai Lau return -EINVAL; 590baf26b0SMartin KaFai Lau sock_id = type_id; 600baf26b0SMartin KaFai Lau 610baf26b0SMartin KaFai Lau type_id = btf_find_by_name_kind(btf, "tcp_sock", BTF_KIND_STRUCT); 620baf26b0SMartin KaFai Lau if (type_id < 0) 630baf26b0SMartin KaFai Lau return -EINVAL; 640baf26b0SMartin KaFai Lau tcp_sock_id = type_id; 650baf26b0SMartin KaFai Lau tcp_sock_type = btf_type_by_id(btf, tcp_sock_id); 660baf26b0SMartin KaFai Lau 67*ab14fd4eSMartin KaFai Lau convert_sk_func_proto(&btf_sk_storage_get_proto, 68*ab14fd4eSMartin KaFai Lau btf_sk_storage_get_ids, 69*ab14fd4eSMartin KaFai Lau &bpf_sk_storage_get_proto); 70*ab14fd4eSMartin KaFai Lau convert_sk_func_proto(&btf_sk_storage_delete_proto, 71*ab14fd4eSMartin KaFai Lau btf_sk_storage_delete_ids, 72*ab14fd4eSMartin KaFai Lau &bpf_sk_storage_delete_proto); 73*ab14fd4eSMartin KaFai Lau 740baf26b0SMartin KaFai Lau return 0; 750baf26b0SMartin KaFai Lau } 760baf26b0SMartin KaFai Lau 770baf26b0SMartin KaFai Lau static bool is_optional(u32 member_offset) 780baf26b0SMartin KaFai Lau { 790baf26b0SMartin KaFai Lau unsigned int i; 800baf26b0SMartin KaFai Lau 810baf26b0SMartin KaFai Lau for (i = 0; i < ARRAY_SIZE(optional_ops); i++) { 820baf26b0SMartin KaFai Lau if (member_offset == optional_ops[i]) 830baf26b0SMartin KaFai Lau return true; 840baf26b0SMartin KaFai Lau } 850baf26b0SMartin KaFai Lau 860baf26b0SMartin KaFai Lau return false; 870baf26b0SMartin KaFai Lau } 880baf26b0SMartin KaFai Lau 890baf26b0SMartin KaFai Lau static bool is_unsupported(u32 member_offset) 900baf26b0SMartin KaFai Lau { 910baf26b0SMartin KaFai Lau unsigned int i; 920baf26b0SMartin KaFai Lau 930baf26b0SMartin KaFai Lau for (i = 0; i < ARRAY_SIZE(unsupported_ops); i++) { 940baf26b0SMartin KaFai Lau if (member_offset == unsupported_ops[i]) 950baf26b0SMartin KaFai Lau return true; 960baf26b0SMartin KaFai Lau } 970baf26b0SMartin KaFai Lau 980baf26b0SMartin KaFai Lau return false; 990baf26b0SMartin KaFai Lau } 1000baf26b0SMartin KaFai Lau 1010baf26b0SMartin KaFai Lau extern struct btf *btf_vmlinux; 1020baf26b0SMartin KaFai Lau 1030baf26b0SMartin KaFai Lau static bool bpf_tcp_ca_is_valid_access(int off, int size, 1040baf26b0SMartin KaFai Lau enum bpf_access_type type, 1050baf26b0SMartin KaFai Lau const struct bpf_prog *prog, 1060baf26b0SMartin KaFai Lau struct bpf_insn_access_aux *info) 1070baf26b0SMartin KaFai Lau { 1080baf26b0SMartin KaFai Lau if (off < 0 || off >= sizeof(__u64) * MAX_BPF_FUNC_ARGS) 1090baf26b0SMartin KaFai Lau return false; 1100baf26b0SMartin KaFai Lau if (type != BPF_READ) 1110baf26b0SMartin KaFai Lau return false; 1120baf26b0SMartin KaFai Lau if (off % size != 0) 1130baf26b0SMartin KaFai Lau return false; 1140baf26b0SMartin KaFai Lau 1150baf26b0SMartin KaFai Lau if (!btf_ctx_access(off, size, type, prog, info)) 1160baf26b0SMartin KaFai Lau return false; 1170baf26b0SMartin KaFai Lau 1180baf26b0SMartin KaFai Lau if (info->reg_type == PTR_TO_BTF_ID && info->btf_id == sock_id) 1190baf26b0SMartin KaFai Lau /* promote it to tcp_sock */ 1200baf26b0SMartin KaFai Lau info->btf_id = tcp_sock_id; 1210baf26b0SMartin KaFai Lau 1220baf26b0SMartin KaFai Lau return true; 1230baf26b0SMartin KaFai Lau } 1240baf26b0SMartin KaFai Lau 1250baf26b0SMartin KaFai Lau static int bpf_tcp_ca_btf_struct_access(struct bpf_verifier_log *log, 1260baf26b0SMartin KaFai Lau const struct btf_type *t, int off, 1270baf26b0SMartin KaFai Lau int size, enum bpf_access_type atype, 1280baf26b0SMartin KaFai Lau u32 *next_btf_id) 1290baf26b0SMartin KaFai Lau { 1300baf26b0SMartin KaFai Lau size_t end; 1310baf26b0SMartin KaFai Lau 1320baf26b0SMartin KaFai Lau if (atype == BPF_READ) 1330baf26b0SMartin KaFai Lau return btf_struct_access(log, t, off, size, atype, next_btf_id); 1340baf26b0SMartin KaFai Lau 1350baf26b0SMartin KaFai Lau if (t != tcp_sock_type) { 1360baf26b0SMartin KaFai Lau bpf_log(log, "only read is supported\n"); 1370baf26b0SMartin KaFai Lau return -EACCES; 1380baf26b0SMartin KaFai Lau } 1390baf26b0SMartin KaFai Lau 1400baf26b0SMartin KaFai Lau switch (off) { 1410baf26b0SMartin KaFai Lau case bpf_ctx_range(struct inet_connection_sock, icsk_ca_priv): 1420baf26b0SMartin KaFai Lau end = offsetofend(struct inet_connection_sock, icsk_ca_priv); 1430baf26b0SMartin KaFai Lau break; 1440baf26b0SMartin KaFai Lau case offsetof(struct inet_connection_sock, icsk_ack.pending): 1450baf26b0SMartin KaFai Lau end = offsetofend(struct inet_connection_sock, 1460baf26b0SMartin KaFai Lau icsk_ack.pending); 1470baf26b0SMartin KaFai Lau break; 1480baf26b0SMartin KaFai Lau case offsetof(struct tcp_sock, snd_cwnd): 1490baf26b0SMartin KaFai Lau end = offsetofend(struct tcp_sock, snd_cwnd); 1500baf26b0SMartin KaFai Lau break; 1510baf26b0SMartin KaFai Lau case offsetof(struct tcp_sock, snd_cwnd_cnt): 1520baf26b0SMartin KaFai Lau end = offsetofend(struct tcp_sock, snd_cwnd_cnt); 1530baf26b0SMartin KaFai Lau break; 1540baf26b0SMartin KaFai Lau case offsetof(struct tcp_sock, snd_ssthresh): 1550baf26b0SMartin KaFai Lau end = offsetofend(struct tcp_sock, snd_ssthresh); 1560baf26b0SMartin KaFai Lau break; 1570baf26b0SMartin KaFai Lau case offsetof(struct tcp_sock, ecn_flags): 1580baf26b0SMartin KaFai Lau end = offsetofend(struct tcp_sock, ecn_flags); 1590baf26b0SMartin KaFai Lau break; 1600baf26b0SMartin KaFai Lau default: 1610baf26b0SMartin KaFai Lau bpf_log(log, "no write support to tcp_sock at off %d\n", off); 1620baf26b0SMartin KaFai Lau return -EACCES; 1630baf26b0SMartin KaFai Lau } 1640baf26b0SMartin KaFai Lau 1650baf26b0SMartin KaFai Lau if (off + size > end) { 1660baf26b0SMartin KaFai Lau bpf_log(log, 1670baf26b0SMartin KaFai Lau "write access at off %d with size %d beyond the member of tcp_sock ended at %zu\n", 1680baf26b0SMartin KaFai Lau off, size, end); 1690baf26b0SMartin KaFai Lau return -EACCES; 1700baf26b0SMartin KaFai Lau } 1710baf26b0SMartin KaFai Lau 1720baf26b0SMartin KaFai Lau return NOT_INIT; 1730baf26b0SMartin KaFai Lau } 1740baf26b0SMartin KaFai Lau 175206057feSMartin KaFai Lau BPF_CALL_2(bpf_tcp_send_ack, struct tcp_sock *, tp, u32, rcv_nxt) 176206057feSMartin KaFai Lau { 177206057feSMartin KaFai Lau /* bpf_tcp_ca prog cannot have NULL tp */ 178206057feSMartin KaFai Lau __tcp_send_ack((struct sock *)tp, rcv_nxt); 179206057feSMartin KaFai Lau return 0; 180206057feSMartin KaFai Lau } 181206057feSMartin KaFai Lau 182206057feSMartin KaFai Lau static const struct bpf_func_proto bpf_tcp_send_ack_proto = { 183206057feSMartin KaFai Lau .func = bpf_tcp_send_ack, 184206057feSMartin KaFai Lau .gpl_only = false, 185206057feSMartin KaFai Lau /* In case we want to report error later */ 186206057feSMartin KaFai Lau .ret_type = RET_INTEGER, 187206057feSMartin KaFai Lau .arg1_type = ARG_PTR_TO_BTF_ID, 188206057feSMartin KaFai Lau .arg2_type = ARG_ANYTHING, 189206057feSMartin KaFai Lau .btf_id = &tcp_sock_id, 190206057feSMartin KaFai Lau }; 191206057feSMartin KaFai Lau 1920baf26b0SMartin KaFai Lau static const struct bpf_func_proto * 1930baf26b0SMartin KaFai Lau bpf_tcp_ca_get_func_proto(enum bpf_func_id func_id, 1940baf26b0SMartin KaFai Lau const struct bpf_prog *prog) 1950baf26b0SMartin KaFai Lau { 196206057feSMartin KaFai Lau switch (func_id) { 197206057feSMartin KaFai Lau case BPF_FUNC_tcp_send_ack: 198206057feSMartin KaFai Lau return &bpf_tcp_send_ack_proto; 199*ab14fd4eSMartin KaFai Lau case BPF_FUNC_sk_storage_get: 200*ab14fd4eSMartin KaFai Lau return &btf_sk_storage_get_proto; 201*ab14fd4eSMartin KaFai Lau case BPF_FUNC_sk_storage_delete: 202*ab14fd4eSMartin KaFai Lau return &btf_sk_storage_delete_proto; 203206057feSMartin KaFai Lau default: 2040baf26b0SMartin KaFai Lau return bpf_base_func_proto(func_id); 2050baf26b0SMartin KaFai Lau } 206206057feSMartin KaFai Lau } 2070baf26b0SMartin KaFai Lau 2080baf26b0SMartin KaFai Lau static const struct bpf_verifier_ops bpf_tcp_ca_verifier_ops = { 2090baf26b0SMartin KaFai Lau .get_func_proto = bpf_tcp_ca_get_func_proto, 2100baf26b0SMartin KaFai Lau .is_valid_access = bpf_tcp_ca_is_valid_access, 2110baf26b0SMartin KaFai Lau .btf_struct_access = bpf_tcp_ca_btf_struct_access, 2120baf26b0SMartin KaFai Lau }; 2130baf26b0SMartin KaFai Lau 2140baf26b0SMartin KaFai Lau static int bpf_tcp_ca_init_member(const struct btf_type *t, 2150baf26b0SMartin KaFai Lau const struct btf_member *member, 2160baf26b0SMartin KaFai Lau void *kdata, const void *udata) 2170baf26b0SMartin KaFai Lau { 2180baf26b0SMartin KaFai Lau const struct tcp_congestion_ops *utcp_ca; 2190baf26b0SMartin KaFai Lau struct tcp_congestion_ops *tcp_ca; 2200baf26b0SMartin KaFai Lau size_t tcp_ca_name_len; 2210baf26b0SMartin KaFai Lau int prog_fd; 2220baf26b0SMartin KaFai Lau u32 moff; 2230baf26b0SMartin KaFai Lau 2240baf26b0SMartin KaFai Lau utcp_ca = (const struct tcp_congestion_ops *)udata; 2250baf26b0SMartin KaFai Lau tcp_ca = (struct tcp_congestion_ops *)kdata; 2260baf26b0SMartin KaFai Lau 2270baf26b0SMartin KaFai Lau moff = btf_member_bit_offset(t, member) / 8; 2280baf26b0SMartin KaFai Lau switch (moff) { 2290baf26b0SMartin KaFai Lau case offsetof(struct tcp_congestion_ops, flags): 2300baf26b0SMartin KaFai Lau if (utcp_ca->flags & ~TCP_CONG_MASK) 2310baf26b0SMartin KaFai Lau return -EINVAL; 2320baf26b0SMartin KaFai Lau tcp_ca->flags = utcp_ca->flags; 2330baf26b0SMartin KaFai Lau return 1; 2340baf26b0SMartin KaFai Lau case offsetof(struct tcp_congestion_ops, name): 2350baf26b0SMartin KaFai Lau tcp_ca_name_len = strnlen(utcp_ca->name, sizeof(utcp_ca->name)); 2360baf26b0SMartin KaFai Lau if (!tcp_ca_name_len || 2370baf26b0SMartin KaFai Lau tcp_ca_name_len == sizeof(utcp_ca->name)) 2380baf26b0SMartin KaFai Lau return -EINVAL; 2390baf26b0SMartin KaFai Lau if (tcp_ca_find(utcp_ca->name)) 2400baf26b0SMartin KaFai Lau return -EEXIST; 2410baf26b0SMartin KaFai Lau memcpy(tcp_ca->name, utcp_ca->name, sizeof(tcp_ca->name)); 2420baf26b0SMartin KaFai Lau return 1; 2430baf26b0SMartin KaFai Lau } 2440baf26b0SMartin KaFai Lau 2450baf26b0SMartin KaFai Lau if (!btf_type_resolve_func_ptr(btf_vmlinux, member->type, NULL)) 2460baf26b0SMartin KaFai Lau return 0; 2470baf26b0SMartin KaFai Lau 2480baf26b0SMartin KaFai Lau /* Ensure bpf_prog is provided for compulsory func ptr */ 2490baf26b0SMartin KaFai Lau prog_fd = (int)(*(unsigned long *)(udata + moff)); 2500baf26b0SMartin KaFai Lau if (!prog_fd && !is_optional(moff) && !is_unsupported(moff)) 2510baf26b0SMartin KaFai Lau return -EINVAL; 2520baf26b0SMartin KaFai Lau 2530baf26b0SMartin KaFai Lau return 0; 2540baf26b0SMartin KaFai Lau } 2550baf26b0SMartin KaFai Lau 2560baf26b0SMartin KaFai Lau static int bpf_tcp_ca_check_member(const struct btf_type *t, 2570baf26b0SMartin KaFai Lau const struct btf_member *member) 2580baf26b0SMartin KaFai Lau { 2590baf26b0SMartin KaFai Lau if (is_unsupported(btf_member_bit_offset(t, member) / 8)) 2600baf26b0SMartin KaFai Lau return -ENOTSUPP; 2610baf26b0SMartin KaFai Lau return 0; 2620baf26b0SMartin KaFai Lau } 2630baf26b0SMartin KaFai Lau 2640baf26b0SMartin KaFai Lau static int bpf_tcp_ca_reg(void *kdata) 2650baf26b0SMartin KaFai Lau { 2660baf26b0SMartin KaFai Lau return tcp_register_congestion_control(kdata); 2670baf26b0SMartin KaFai Lau } 2680baf26b0SMartin KaFai Lau 2690baf26b0SMartin KaFai Lau static void bpf_tcp_ca_unreg(void *kdata) 2700baf26b0SMartin KaFai Lau { 2710baf26b0SMartin KaFai Lau tcp_unregister_congestion_control(kdata); 2720baf26b0SMartin KaFai Lau } 2730baf26b0SMartin KaFai Lau 2740baf26b0SMartin KaFai Lau /* Avoid sparse warning. It is only used in bpf_struct_ops.c. */ 2750baf26b0SMartin KaFai Lau extern struct bpf_struct_ops bpf_tcp_congestion_ops; 2760baf26b0SMartin KaFai Lau 2770baf26b0SMartin KaFai Lau struct bpf_struct_ops bpf_tcp_congestion_ops = { 2780baf26b0SMartin KaFai Lau .verifier_ops = &bpf_tcp_ca_verifier_ops, 2790baf26b0SMartin KaFai Lau .reg = bpf_tcp_ca_reg, 2800baf26b0SMartin KaFai Lau .unreg = bpf_tcp_ca_unreg, 2810baf26b0SMartin KaFai Lau .check_member = bpf_tcp_ca_check_member, 2820baf26b0SMartin KaFai Lau .init_member = bpf_tcp_ca_init_member, 2830baf26b0SMartin KaFai Lau .init = bpf_tcp_ca_init, 2840baf26b0SMartin KaFai Lau .name = "tcp_congestion_ops", 2850baf26b0SMartin KaFai Lau }; 286