1*0baf26b0SMartin KaFai Lau // SPDX-License-Identifier: GPL-2.0 2*0baf26b0SMartin KaFai Lau /* Copyright (c) 2019 Facebook */ 3*0baf26b0SMartin KaFai Lau 4*0baf26b0SMartin KaFai Lau #include <linux/types.h> 5*0baf26b0SMartin KaFai Lau #include <linux/bpf_verifier.h> 6*0baf26b0SMartin KaFai Lau #include <linux/bpf.h> 7*0baf26b0SMartin KaFai Lau #include <linux/btf.h> 8*0baf26b0SMartin KaFai Lau #include <linux/filter.h> 9*0baf26b0SMartin KaFai Lau #include <net/tcp.h> 10*0baf26b0SMartin KaFai Lau 11*0baf26b0SMartin KaFai Lau static u32 optional_ops[] = { 12*0baf26b0SMartin KaFai Lau offsetof(struct tcp_congestion_ops, init), 13*0baf26b0SMartin KaFai Lau offsetof(struct tcp_congestion_ops, release), 14*0baf26b0SMartin KaFai Lau offsetof(struct tcp_congestion_ops, set_state), 15*0baf26b0SMartin KaFai Lau offsetof(struct tcp_congestion_ops, cwnd_event), 16*0baf26b0SMartin KaFai Lau offsetof(struct tcp_congestion_ops, in_ack_event), 17*0baf26b0SMartin KaFai Lau offsetof(struct tcp_congestion_ops, pkts_acked), 18*0baf26b0SMartin KaFai Lau offsetof(struct tcp_congestion_ops, min_tso_segs), 19*0baf26b0SMartin KaFai Lau offsetof(struct tcp_congestion_ops, sndbuf_expand), 20*0baf26b0SMartin KaFai Lau offsetof(struct tcp_congestion_ops, cong_control), 21*0baf26b0SMartin KaFai Lau }; 22*0baf26b0SMartin KaFai Lau 23*0baf26b0SMartin KaFai Lau static u32 unsupported_ops[] = { 24*0baf26b0SMartin KaFai Lau offsetof(struct tcp_congestion_ops, get_info), 25*0baf26b0SMartin KaFai Lau }; 26*0baf26b0SMartin KaFai Lau 27*0baf26b0SMartin KaFai Lau static const struct btf_type *tcp_sock_type; 28*0baf26b0SMartin KaFai Lau static u32 tcp_sock_id, sock_id; 29*0baf26b0SMartin KaFai Lau 30*0baf26b0SMartin KaFai Lau static int bpf_tcp_ca_init(struct btf *btf) 31*0baf26b0SMartin KaFai Lau { 32*0baf26b0SMartin KaFai Lau s32 type_id; 33*0baf26b0SMartin KaFai Lau 34*0baf26b0SMartin KaFai Lau type_id = btf_find_by_name_kind(btf, "sock", BTF_KIND_STRUCT); 35*0baf26b0SMartin KaFai Lau if (type_id < 0) 36*0baf26b0SMartin KaFai Lau return -EINVAL; 37*0baf26b0SMartin KaFai Lau sock_id = type_id; 38*0baf26b0SMartin KaFai Lau 39*0baf26b0SMartin KaFai Lau type_id = btf_find_by_name_kind(btf, "tcp_sock", BTF_KIND_STRUCT); 40*0baf26b0SMartin KaFai Lau if (type_id < 0) 41*0baf26b0SMartin KaFai Lau return -EINVAL; 42*0baf26b0SMartin KaFai Lau tcp_sock_id = type_id; 43*0baf26b0SMartin KaFai Lau tcp_sock_type = btf_type_by_id(btf, tcp_sock_id); 44*0baf26b0SMartin KaFai Lau 45*0baf26b0SMartin KaFai Lau return 0; 46*0baf26b0SMartin KaFai Lau } 47*0baf26b0SMartin KaFai Lau 48*0baf26b0SMartin KaFai Lau static bool is_optional(u32 member_offset) 49*0baf26b0SMartin KaFai Lau { 50*0baf26b0SMartin KaFai Lau unsigned int i; 51*0baf26b0SMartin KaFai Lau 52*0baf26b0SMartin KaFai Lau for (i = 0; i < ARRAY_SIZE(optional_ops); i++) { 53*0baf26b0SMartin KaFai Lau if (member_offset == optional_ops[i]) 54*0baf26b0SMartin KaFai Lau return true; 55*0baf26b0SMartin KaFai Lau } 56*0baf26b0SMartin KaFai Lau 57*0baf26b0SMartin KaFai Lau return false; 58*0baf26b0SMartin KaFai Lau } 59*0baf26b0SMartin KaFai Lau 60*0baf26b0SMartin KaFai Lau static bool is_unsupported(u32 member_offset) 61*0baf26b0SMartin KaFai Lau { 62*0baf26b0SMartin KaFai Lau unsigned int i; 63*0baf26b0SMartin KaFai Lau 64*0baf26b0SMartin KaFai Lau for (i = 0; i < ARRAY_SIZE(unsupported_ops); i++) { 65*0baf26b0SMartin KaFai Lau if (member_offset == unsupported_ops[i]) 66*0baf26b0SMartin KaFai Lau return true; 67*0baf26b0SMartin KaFai Lau } 68*0baf26b0SMartin KaFai Lau 69*0baf26b0SMartin KaFai Lau return false; 70*0baf26b0SMartin KaFai Lau } 71*0baf26b0SMartin KaFai Lau 72*0baf26b0SMartin KaFai Lau extern struct btf *btf_vmlinux; 73*0baf26b0SMartin KaFai Lau 74*0baf26b0SMartin KaFai Lau static bool bpf_tcp_ca_is_valid_access(int off, int size, 75*0baf26b0SMartin KaFai Lau enum bpf_access_type type, 76*0baf26b0SMartin KaFai Lau const struct bpf_prog *prog, 77*0baf26b0SMartin KaFai Lau struct bpf_insn_access_aux *info) 78*0baf26b0SMartin KaFai Lau { 79*0baf26b0SMartin KaFai Lau if (off < 0 || off >= sizeof(__u64) * MAX_BPF_FUNC_ARGS) 80*0baf26b0SMartin KaFai Lau return false; 81*0baf26b0SMartin KaFai Lau if (type != BPF_READ) 82*0baf26b0SMartin KaFai Lau return false; 83*0baf26b0SMartin KaFai Lau if (off % size != 0) 84*0baf26b0SMartin KaFai Lau return false; 85*0baf26b0SMartin KaFai Lau 86*0baf26b0SMartin KaFai Lau if (!btf_ctx_access(off, size, type, prog, info)) 87*0baf26b0SMartin KaFai Lau return false; 88*0baf26b0SMartin KaFai Lau 89*0baf26b0SMartin KaFai Lau if (info->reg_type == PTR_TO_BTF_ID && info->btf_id == sock_id) 90*0baf26b0SMartin KaFai Lau /* promote it to tcp_sock */ 91*0baf26b0SMartin KaFai Lau info->btf_id = tcp_sock_id; 92*0baf26b0SMartin KaFai Lau 93*0baf26b0SMartin KaFai Lau return true; 94*0baf26b0SMartin KaFai Lau } 95*0baf26b0SMartin KaFai Lau 96*0baf26b0SMartin KaFai Lau static int bpf_tcp_ca_btf_struct_access(struct bpf_verifier_log *log, 97*0baf26b0SMartin KaFai Lau const struct btf_type *t, int off, 98*0baf26b0SMartin KaFai Lau int size, enum bpf_access_type atype, 99*0baf26b0SMartin KaFai Lau u32 *next_btf_id) 100*0baf26b0SMartin KaFai Lau { 101*0baf26b0SMartin KaFai Lau size_t end; 102*0baf26b0SMartin KaFai Lau 103*0baf26b0SMartin KaFai Lau if (atype == BPF_READ) 104*0baf26b0SMartin KaFai Lau return btf_struct_access(log, t, off, size, atype, next_btf_id); 105*0baf26b0SMartin KaFai Lau 106*0baf26b0SMartin KaFai Lau if (t != tcp_sock_type) { 107*0baf26b0SMartin KaFai Lau bpf_log(log, "only read is supported\n"); 108*0baf26b0SMartin KaFai Lau return -EACCES; 109*0baf26b0SMartin KaFai Lau } 110*0baf26b0SMartin KaFai Lau 111*0baf26b0SMartin KaFai Lau switch (off) { 112*0baf26b0SMartin KaFai Lau case bpf_ctx_range(struct inet_connection_sock, icsk_ca_priv): 113*0baf26b0SMartin KaFai Lau end = offsetofend(struct inet_connection_sock, icsk_ca_priv); 114*0baf26b0SMartin KaFai Lau break; 115*0baf26b0SMartin KaFai Lau case offsetof(struct inet_connection_sock, icsk_ack.pending): 116*0baf26b0SMartin KaFai Lau end = offsetofend(struct inet_connection_sock, 117*0baf26b0SMartin KaFai Lau icsk_ack.pending); 118*0baf26b0SMartin KaFai Lau break; 119*0baf26b0SMartin KaFai Lau case offsetof(struct tcp_sock, snd_cwnd): 120*0baf26b0SMartin KaFai Lau end = offsetofend(struct tcp_sock, snd_cwnd); 121*0baf26b0SMartin KaFai Lau break; 122*0baf26b0SMartin KaFai Lau case offsetof(struct tcp_sock, snd_cwnd_cnt): 123*0baf26b0SMartin KaFai Lau end = offsetofend(struct tcp_sock, snd_cwnd_cnt); 124*0baf26b0SMartin KaFai Lau break; 125*0baf26b0SMartin KaFai Lau case offsetof(struct tcp_sock, snd_ssthresh): 126*0baf26b0SMartin KaFai Lau end = offsetofend(struct tcp_sock, snd_ssthresh); 127*0baf26b0SMartin KaFai Lau break; 128*0baf26b0SMartin KaFai Lau case offsetof(struct tcp_sock, ecn_flags): 129*0baf26b0SMartin KaFai Lau end = offsetofend(struct tcp_sock, ecn_flags); 130*0baf26b0SMartin KaFai Lau break; 131*0baf26b0SMartin KaFai Lau default: 132*0baf26b0SMartin KaFai Lau bpf_log(log, "no write support to tcp_sock at off %d\n", off); 133*0baf26b0SMartin KaFai Lau return -EACCES; 134*0baf26b0SMartin KaFai Lau } 135*0baf26b0SMartin KaFai Lau 136*0baf26b0SMartin KaFai Lau if (off + size > end) { 137*0baf26b0SMartin KaFai Lau bpf_log(log, 138*0baf26b0SMartin KaFai Lau "write access at off %d with size %d beyond the member of tcp_sock ended at %zu\n", 139*0baf26b0SMartin KaFai Lau off, size, end); 140*0baf26b0SMartin KaFai Lau return -EACCES; 141*0baf26b0SMartin KaFai Lau } 142*0baf26b0SMartin KaFai Lau 143*0baf26b0SMartin KaFai Lau return NOT_INIT; 144*0baf26b0SMartin KaFai Lau } 145*0baf26b0SMartin KaFai Lau 146*0baf26b0SMartin KaFai Lau static const struct bpf_func_proto * 147*0baf26b0SMartin KaFai Lau bpf_tcp_ca_get_func_proto(enum bpf_func_id func_id, 148*0baf26b0SMartin KaFai Lau const struct bpf_prog *prog) 149*0baf26b0SMartin KaFai Lau { 150*0baf26b0SMartin KaFai Lau return bpf_base_func_proto(func_id); 151*0baf26b0SMartin KaFai Lau } 152*0baf26b0SMartin KaFai Lau 153*0baf26b0SMartin KaFai Lau static const struct bpf_verifier_ops bpf_tcp_ca_verifier_ops = { 154*0baf26b0SMartin KaFai Lau .get_func_proto = bpf_tcp_ca_get_func_proto, 155*0baf26b0SMartin KaFai Lau .is_valid_access = bpf_tcp_ca_is_valid_access, 156*0baf26b0SMartin KaFai Lau .btf_struct_access = bpf_tcp_ca_btf_struct_access, 157*0baf26b0SMartin KaFai Lau }; 158*0baf26b0SMartin KaFai Lau 159*0baf26b0SMartin KaFai Lau static int bpf_tcp_ca_init_member(const struct btf_type *t, 160*0baf26b0SMartin KaFai Lau const struct btf_member *member, 161*0baf26b0SMartin KaFai Lau void *kdata, const void *udata) 162*0baf26b0SMartin KaFai Lau { 163*0baf26b0SMartin KaFai Lau const struct tcp_congestion_ops *utcp_ca; 164*0baf26b0SMartin KaFai Lau struct tcp_congestion_ops *tcp_ca; 165*0baf26b0SMartin KaFai Lau size_t tcp_ca_name_len; 166*0baf26b0SMartin KaFai Lau int prog_fd; 167*0baf26b0SMartin KaFai Lau u32 moff; 168*0baf26b0SMartin KaFai Lau 169*0baf26b0SMartin KaFai Lau utcp_ca = (const struct tcp_congestion_ops *)udata; 170*0baf26b0SMartin KaFai Lau tcp_ca = (struct tcp_congestion_ops *)kdata; 171*0baf26b0SMartin KaFai Lau 172*0baf26b0SMartin KaFai Lau moff = btf_member_bit_offset(t, member) / 8; 173*0baf26b0SMartin KaFai Lau switch (moff) { 174*0baf26b0SMartin KaFai Lau case offsetof(struct tcp_congestion_ops, flags): 175*0baf26b0SMartin KaFai Lau if (utcp_ca->flags & ~TCP_CONG_MASK) 176*0baf26b0SMartin KaFai Lau return -EINVAL; 177*0baf26b0SMartin KaFai Lau tcp_ca->flags = utcp_ca->flags; 178*0baf26b0SMartin KaFai Lau return 1; 179*0baf26b0SMartin KaFai Lau case offsetof(struct tcp_congestion_ops, name): 180*0baf26b0SMartin KaFai Lau tcp_ca_name_len = strnlen(utcp_ca->name, sizeof(utcp_ca->name)); 181*0baf26b0SMartin KaFai Lau if (!tcp_ca_name_len || 182*0baf26b0SMartin KaFai Lau tcp_ca_name_len == sizeof(utcp_ca->name)) 183*0baf26b0SMartin KaFai Lau return -EINVAL; 184*0baf26b0SMartin KaFai Lau if (tcp_ca_find(utcp_ca->name)) 185*0baf26b0SMartin KaFai Lau return -EEXIST; 186*0baf26b0SMartin KaFai Lau memcpy(tcp_ca->name, utcp_ca->name, sizeof(tcp_ca->name)); 187*0baf26b0SMartin KaFai Lau return 1; 188*0baf26b0SMartin KaFai Lau } 189*0baf26b0SMartin KaFai Lau 190*0baf26b0SMartin KaFai Lau if (!btf_type_resolve_func_ptr(btf_vmlinux, member->type, NULL)) 191*0baf26b0SMartin KaFai Lau return 0; 192*0baf26b0SMartin KaFai Lau 193*0baf26b0SMartin KaFai Lau /* Ensure bpf_prog is provided for compulsory func ptr */ 194*0baf26b0SMartin KaFai Lau prog_fd = (int)(*(unsigned long *)(udata + moff)); 195*0baf26b0SMartin KaFai Lau if (!prog_fd && !is_optional(moff) && !is_unsupported(moff)) 196*0baf26b0SMartin KaFai Lau return -EINVAL; 197*0baf26b0SMartin KaFai Lau 198*0baf26b0SMartin KaFai Lau return 0; 199*0baf26b0SMartin KaFai Lau } 200*0baf26b0SMartin KaFai Lau 201*0baf26b0SMartin KaFai Lau static int bpf_tcp_ca_check_member(const struct btf_type *t, 202*0baf26b0SMartin KaFai Lau const struct btf_member *member) 203*0baf26b0SMartin KaFai Lau { 204*0baf26b0SMartin KaFai Lau if (is_unsupported(btf_member_bit_offset(t, member) / 8)) 205*0baf26b0SMartin KaFai Lau return -ENOTSUPP; 206*0baf26b0SMartin KaFai Lau return 0; 207*0baf26b0SMartin KaFai Lau } 208*0baf26b0SMartin KaFai Lau 209*0baf26b0SMartin KaFai Lau static int bpf_tcp_ca_reg(void *kdata) 210*0baf26b0SMartin KaFai Lau { 211*0baf26b0SMartin KaFai Lau return tcp_register_congestion_control(kdata); 212*0baf26b0SMartin KaFai Lau } 213*0baf26b0SMartin KaFai Lau 214*0baf26b0SMartin KaFai Lau static void bpf_tcp_ca_unreg(void *kdata) 215*0baf26b0SMartin KaFai Lau { 216*0baf26b0SMartin KaFai Lau tcp_unregister_congestion_control(kdata); 217*0baf26b0SMartin KaFai Lau } 218*0baf26b0SMartin KaFai Lau 219*0baf26b0SMartin KaFai Lau /* Avoid sparse warning. It is only used in bpf_struct_ops.c. */ 220*0baf26b0SMartin KaFai Lau extern struct bpf_struct_ops bpf_tcp_congestion_ops; 221*0baf26b0SMartin KaFai Lau 222*0baf26b0SMartin KaFai Lau struct bpf_struct_ops bpf_tcp_congestion_ops = { 223*0baf26b0SMartin KaFai Lau .verifier_ops = &bpf_tcp_ca_verifier_ops, 224*0baf26b0SMartin KaFai Lau .reg = bpf_tcp_ca_reg, 225*0baf26b0SMartin KaFai Lau .unreg = bpf_tcp_ca_unreg, 226*0baf26b0SMartin KaFai Lau .check_member = bpf_tcp_ca_check_member, 227*0baf26b0SMartin KaFai Lau .init_member = bpf_tcp_ca_init_member, 228*0baf26b0SMartin KaFai Lau .init = bpf_tcp_ca_init, 229*0baf26b0SMartin KaFai Lau .name = "tcp_congestion_ops", 230*0baf26b0SMartin KaFai Lau }; 231