Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  1) /* Copyright (c) 2017 Facebook
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  2)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  3)  * This program is free software; you can redistribute it and/or
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4)  * modify it under the terms of version 2 of the GNU General Public
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5)  * License as published by the Free Software Foundation.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7)  * BPF program to set base_rtt to 80us when host is running TCP-NV and
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8)  * both hosts are in the same datacenter (as determined by IPv6 prefix).
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10)  * Use "bpftool cgroup attach $cg sock_ops $prog" to load this BPF program.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <uapi/linux/bpf.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <uapi/linux/tcp.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <uapi/linux/if_ether.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <uapi/linux/if_packet.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <uapi/linux/ip.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include <linux/socket.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include <bpf/bpf_helpers.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #include <bpf/bpf_endian.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #define DEBUG 1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) SEC("sockops")
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) int bpf_basertt(struct bpf_sock_ops *skops)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) 	char cong[20];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) 	char nv[] = "nv";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) 	int rv = 0, n;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) 	int op;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) 	op = (int) skops->op;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) #ifdef DEBUG
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) 	bpf_printk("BPF command: %d\n", op);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) 	/* Check if both hosts are in the same datacenter. For this
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) 	 * example they are if the 1st 5.5 bytes in the IPv6 address
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) 	 * are the same.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) 	if (skops->family == AF_INET6 &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) 	    skops->local_ip6[0] == skops->remote_ip6[0] &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) 	    (bpf_ntohl(skops->local_ip6[1]) & 0xfff00000) ==
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) 	    (bpf_ntohl(skops->remote_ip6[1]) & 0xfff00000)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) 		switch (op) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) 		case BPF_SOCK_OPS_BASE_RTT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) 			n = bpf_getsockopt(skops, SOL_TCP, TCP_CONGESTION,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) 					   cong, sizeof(cong));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) 			if (!n && !__builtin_memcmp(cong, nv, sizeof(nv)+1)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) 				/* Set base_rtt to 80us */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) 				rv = 80;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) 			} else if (n) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) 				rv = n;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) 			} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) 				rv = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) 		default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) 			rv = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) 	} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) 		rv = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) #ifdef DEBUG
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) 	bpf_printk("Returning %d\n", rv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) 	skops->reply = rv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) 	return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) char _license[] SEC("license") = "GPL";