Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  1) /* SPDX-License-Identifier: GPL-2.0 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  2) #include <linux/ipv6.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  3) #include <net/dsfield.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4) #include <net/xfrm.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6) #ifndef XFRM_INOUT_H
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7) #define XFRM_INOUT_H 1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9) static inline void xfrm4_extract_header(struct sk_buff *skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) 	const struct iphdr *iph = ip_hdr(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) 	XFRM_MODE_SKB_CB(skb)->ihl = sizeof(*iph);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) 	XFRM_MODE_SKB_CB(skb)->id = iph->id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) 	XFRM_MODE_SKB_CB(skb)->frag_off = iph->frag_off;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) 	XFRM_MODE_SKB_CB(skb)->tos = iph->tos;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) 	XFRM_MODE_SKB_CB(skb)->ttl = iph->ttl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) 	XFRM_MODE_SKB_CB(skb)->optlen = iph->ihl * 4 - sizeof(*iph);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) 	memset(XFRM_MODE_SKB_CB(skb)->flow_lbl, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) 	       sizeof(XFRM_MODE_SKB_CB(skb)->flow_lbl));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) static inline void xfrm6_extract_header(struct sk_buff *skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) #if IS_ENABLED(CONFIG_IPV6)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) 	struct ipv6hdr *iph = ipv6_hdr(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) 	XFRM_MODE_SKB_CB(skb)->ihl = sizeof(*iph);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) 	XFRM_MODE_SKB_CB(skb)->id = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) 	XFRM_MODE_SKB_CB(skb)->frag_off = htons(IP_DF);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) 	XFRM_MODE_SKB_CB(skb)->tos = ipv6_get_dsfield(iph);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) 	XFRM_MODE_SKB_CB(skb)->ttl = iph->hop_limit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) 	XFRM_MODE_SKB_CB(skb)->optlen = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) 	memcpy(XFRM_MODE_SKB_CB(skb)->flow_lbl, iph->flow_lbl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) 	       sizeof(XFRM_MODE_SKB_CB(skb)->flow_lbl));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) #else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) 	WARN_ON_ONCE(1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) static inline void xfrm6_beet_make_header(struct sk_buff *skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) 	struct ipv6hdr *iph = ipv6_hdr(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) 	iph->version = 6;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) 	memcpy(iph->flow_lbl, XFRM_MODE_SKB_CB(skb)->flow_lbl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) 	       sizeof(iph->flow_lbl));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) 	iph->nexthdr = XFRM_MODE_SKB_CB(skb)->protocol;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) 	ipv6_change_dsfield(iph, 0, XFRM_MODE_SKB_CB(skb)->tos);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) 	iph->hop_limit = XFRM_MODE_SKB_CB(skb)->ttl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) static inline void xfrm4_beet_make_header(struct sk_buff *skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) 	struct iphdr *iph = ip_hdr(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) 	iph->ihl = 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) 	iph->version = 4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) 	iph->protocol = XFRM_MODE_SKB_CB(skb)->protocol;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) 	iph->tos = XFRM_MODE_SKB_CB(skb)->tos;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) 	iph->id = XFRM_MODE_SKB_CB(skb)->id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) 	iph->frag_off = XFRM_MODE_SKB_CB(skb)->frag_off;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) 	iph->ttl = XFRM_MODE_SKB_CB(skb)->ttl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) #endif