nf_tables_ipv4.h

 1/* SPDX-License-Identifier: GPL-2.0 */
 2#ifndef _NF_TABLES_IPV4_H_
 3#define _NF_TABLES_IPV4_H_
 4
 5#include <net/netfilter/nf_tables.h>
 6#include <net/ip.h>
 7
 8static inline void nft_set_pktinfo_ipv4(struct nft_pktinfo *pkt)
 9{
10	struct iphdr *ip;
11
12	ip = ip_hdr(pkt->skb);
13	pkt->flags = NFT_PKTINFO_L4PROTO;
14	pkt->tprot = ip->protocol;
15	pkt->thoff = ip_hdrlen(pkt->skb);
16	pkt->fragoff = ntohs(ip->frag_off) & IP_OFFSET;
17}
18
19static inline int __nft_set_pktinfo_ipv4_validate(struct nft_pktinfo *pkt)
20{
21	struct iphdr *iph, _iph;
22	u32 len, thoff, skb_len;
23
24	iph = skb_header_pointer(pkt->skb, skb_network_offset(pkt->skb),
25				 sizeof(*iph), &_iph);
26	if (!iph)
27		return -1;
28
29	if (iph->ihl < 5 || iph->version != 4)
30		return -1;
31
32	len = iph_totlen(pkt->skb, iph);
33	thoff = iph->ihl * 4;
34	skb_len = pkt->skb->len - skb_network_offset(pkt->skb);
35
36	if (skb_len < len)
37		return -1;
38	else if (len < thoff)
39		return -1;
40	else if (thoff < sizeof(*iph))
41		return -1;
42
43	pkt->flags = NFT_PKTINFO_L4PROTO;
44	pkt->tprot = iph->protocol;
45	pkt->thoff = skb_network_offset(pkt->skb) + thoff;
46	pkt->fragoff = ntohs(iph->frag_off) & IP_OFFSET;
47
48	return 0;
49}
50
51static inline void nft_set_pktinfo_ipv4_validate(struct nft_pktinfo *pkt)
52{
53	if (__nft_set_pktinfo_ipv4_validate(pkt) < 0)
54		nft_set_pktinfo_unspec(pkt);
55}
56
57static inline int nft_set_pktinfo_ipv4_ingress(struct nft_pktinfo *pkt)
58{
59	struct iphdr *iph;
60	u32 len, thoff;
61
62	if (!pskb_may_pull(pkt->skb, sizeof(*iph)))
63		return -1;
64
65	iph = ip_hdr(pkt->skb);
66	if (iph->ihl < 5 || iph->version != 4)
67		goto inhdr_error;
68
69	len = iph_totlen(pkt->skb, iph);
70	thoff = iph->ihl * 4;
71	if (pkt->skb->len < len) {
72		__IP_INC_STATS(nft_net(pkt), IPSTATS_MIB_INTRUNCATEDPKTS);
73		return -1;
74	} else if (len < thoff) {
75		goto inhdr_error;
76	} else if (thoff < sizeof(*iph)) {
77		return -1;
78	}
79
80	pkt->flags = NFT_PKTINFO_L4PROTO;
81	pkt->tprot = iph->protocol;
82	pkt->thoff = thoff;
83	pkt->fragoff = ntohs(iph->frag_off) & IP_OFFSET;
84
85	return 0;
86
87inhdr_error:
88	__IP_INC_STATS(nft_net(pkt), IPSTATS_MIB_INHDRERRORS);
89	return -1;
90}
91
92#endif