[linux-block.git] / net / netfilter / nf_conntrack_proto_icmpv6.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 * Copyright (C)2003,2004 USAGI/WIDE Project
 *
 * Author:
 *	Yasuyuki Kozakai @USAGI <yasuyuki.kozakai@toshiba.co.jp>
 */

#include <linux/types.h>
#include <linux/timer.h>
#include <linux/module.h>
#include <linux/netfilter.h>
#include <linux/in6.h>
#include <linux/icmpv6.h>
#include <linux/ipv6.h>
#include <net/ipv6.h>
#include <net/ip6_checksum.h>
#include <linux/seq_file.h>
#include <linux/netfilter_ipv6.h>
#include <net/netfilter/nf_conntrack_tuple.h>
#include <net/netfilter/nf_conntrack_l4proto.h>
#include <net/netfilter/nf_conntrack_core.h>
#include <net/netfilter/nf_conntrack_timeout.h>
#include <net/netfilter/nf_conntrack_zones.h>
#include <net/netfilter/nf_log.h>

#include "nf_internals.h"

static const unsigned int nf_ct_icmpv6_timeout = 30*HZ;

bool icmpv6_pkt_to_tuple(const struct sk_buff *skb,
			 unsigned int dataoff,
			 struct net *net,
			 struct nf_conntrack_tuple *tuple)
{
	const struct icmp6hdr *hp;
	struct icmp6hdr _hdr;

	hp = skb_header_pointer(skb, dataoff, sizeof(_hdr), &_hdr);
	if (hp == NULL)
		return false;
	tuple->dst.u.icmp.type = hp->icmp6_type;
	tuple->src.u.icmp.id = hp->icmp6_identifier;
	tuple->dst.u.icmp.code = hp->icmp6_code;

	return true;
}

/* Add 1; spaces filled with 0. */
static const u_int8_t invmap[] = {
	[ICMPV6_ECHO_REQUEST - 128]	= ICMPV6_ECHO_REPLY + 1,
	[ICMPV6_ECHO_REPLY - 128]	= ICMPV6_ECHO_REQUEST + 1,
	[ICMPV6_NI_QUERY - 128]		= ICMPV6_NI_REPLY + 1,
	[ICMPV6_NI_REPLY - 128]		= ICMPV6_NI_QUERY + 1
};

static const u_int8_t noct_valid_new[] = {
	[ICMPV6_MGM_QUERY - 130] = 1,
	[ICMPV6_MGM_REPORT - 130] = 1,
	[ICMPV6_MGM_REDUCTION - 130] = 1,
	[NDISC_ROUTER_SOLICITATION - 130] = 1,
	[NDISC_ROUTER_ADVERTISEMENT - 130] = 1,
	[NDISC_NEIGHBOUR_SOLICITATION - 130] = 1,
	[NDISC_NEIGHBOUR_ADVERTISEMENT - 130] = 1,
	[ICMPV6_MLD2_REPORT - 130] = 1,
	[ICMPV6_MRDISC_ADV - 130] = 1,
	[ICMPV6_MRDISC_SOL - 130] = 1
};

bool nf_conntrack_invert_icmpv6_tuple(struct nf_conntrack_tuple *tuple,
				      const struct nf_conntrack_tuple *orig)
{
	int type = orig->dst.u.icmp.type - 128;
	if (type < 0 || type >= sizeof(invmap) || !invmap[type])
		return false;

	tuple->src.u.icmp.id   = orig->src.u.icmp.id;
	tuple->dst.u.icmp.type = invmap[type] - 1;
	tuple->dst.u.icmp.code = orig->dst.u.icmp.code;
	return true;
}

static unsigned int *icmpv6_get_timeouts(struct net *net)
{
	return &nf_icmpv6_pernet(net)->timeout;
}

/* Returns verdict for packet, or -1 for invalid. */
int nf_conntrack_icmpv6_packet(struct nf_conn *ct,
			       struct sk_buff *skb,
			       enum ip_conntrack_info ctinfo,
			       const struct nf_hook_state *state)
{
	unsigned int *timeout = nf_ct_timeout_lookup(ct);
	static const u8 valid_new[] = {
		[ICMPV6_ECHO_REQUEST - 128] = 1,
		[ICMPV6_NI_QUERY - 128] = 1
	};

	if (state->pf != NFPROTO_IPV6)
		return -NF_ACCEPT;

	if (!nf_ct_is_confirmed(ct)) {
		int type = ct->tuplehash[0].tuple.dst.u.icmp.type - 128;

		if (type < 0 || type >= sizeof(valid_new) || !valid_new[type]) {
			/* Can't create a new ICMPv6 `conn' with this. */
			pr_debug("icmpv6: can't create new conn with type %u\n",
				 type + 128);
			nf_ct_dump_tuple_ipv6(&ct->tuplehash[0].tuple);
			return -NF_ACCEPT;
		}
	}

	if (!timeout)
		timeout = icmpv6_get_timeouts(nf_ct_net(ct));

	/* Do not immediately delete the connection after the first
	   successful reply to avoid excessive conntrackd traffic
	   and also to handle correctly ICMP echo reply duplicates. */
	nf_ct_refresh_acct(ct, ctinfo, skb, *timeout);

	return NF_ACCEPT;
}


static void icmpv6_error_log(const struct sk_buff *skb,
			     const struct nf_hook_state *state,
			     const char *msg)
{
	nf_l4proto_log_invalid(skb, state, IPPROTO_ICMPV6, "%s", msg);
}

static noinline_for_stack int
nf_conntrack_icmpv6_redirect(struct nf_conn *tmpl, struct sk_buff *skb,
			     unsigned int dataoff,
			     const struct nf_hook_state *state)
{
	u8 hl = ipv6_hdr(skb)->hop_limit;
	union nf_inet_addr outer_daddr;
	union {
		struct nd_opt_hdr nd_opt;
		struct rd_msg rd_msg;
	} tmp;
	const struct nd_opt_hdr *nd_opt;
	const struct rd_msg *rd_msg;

	rd_msg = skb_header_pointer(skb, dataoff, sizeof(*rd_msg), &tmp.rd_msg);
	if (!rd_msg) {
		icmpv6_error_log(skb, state, "short redirect");
		return -NF_ACCEPT;
	}

	if (rd_msg->icmph.icmp6_code != 0)
		return NF_ACCEPT;

	if (hl != 255 || !(ipv6_addr_type(&ipv6_hdr(skb)->saddr) & IPV6_ADDR_LINKLOCAL)) {
		icmpv6_error_log(skb, state, "invalid saddr or hoplimit for redirect");
		return -NF_ACCEPT;
	}

	dataoff += sizeof(*rd_msg);

	/* warning: rd_msg no longer usable after this call */
	nd_opt = skb_header_pointer(skb, dataoff, sizeof(*nd_opt), &tmp.nd_opt);
	if (!nd_opt || nd_opt->nd_opt_len == 0) {
		icmpv6_error_log(skb, state, "redirect without options");
		return -NF_ACCEPT;
	}

	/* We could call ndisc_parse_options(), but it would need
	 * skb_linearize() and a bit more work.
	 */
	if (nd_opt->nd_opt_type != ND_OPT_REDIRECT_HDR)
		return NF_ACCEPT;

	memcpy(&outer_daddr.ip6, &ipv6_hdr(skb)->daddr,
	       sizeof(outer_daddr.ip6));
	dataoff += 8;
	return nf_conntrack_inet_error(tmpl, skb, dataoff, state,
				       IPPROTO_ICMPV6, &outer_daddr);
}

int nf_conntrack_icmpv6_error(struct nf_conn *tmpl,
			      struct sk_buff *skb,
			      unsigned int dataoff,
			      const struct nf_hook_state *state)
{
	union nf_inet_addr outer_daddr;
	const struct icmp6hdr *icmp6h;
	struct icmp6hdr _ih;
	int type;

	icmp6h = skb_header_pointer(skb, dataoff, sizeof(_ih), &_ih);
	if (icmp6h == NULL) {
		icmpv6_error_log(skb, state, "short packet");
		return -NF_ACCEPT;
	}

	if (state->hook == NF_INET_PRE_ROUTING &&
	    state->net->ct.sysctl_checksum &&
	    nf_ip6_checksum(skb, state->hook, dataoff, IPPROTO_ICMPV6)) {
		icmpv6_error_log(skb, state, "ICMPv6 checksum failed");
		return -NF_ACCEPT;
	}

	type = icmp6h->icmp6_type - 130;
	if (type >= 0 && type < sizeof(noct_valid_new) &&
	    noct_valid_new[type]) {
		nf_ct_set(skb, NULL, IP_CT_UNTRACKED);
		return NF_ACCEPT;
	}

	if (icmp6h->icmp6_type == NDISC_REDIRECT)
		return nf_conntrack_icmpv6_redirect(tmpl, skb, dataoff, state);

	/* is not error message ? */
	if (icmp6h->icmp6_type >= 128)
		return NF_ACCEPT;

	memcpy(&outer_daddr.ip6, &ipv6_hdr(skb)->daddr,
	       sizeof(outer_daddr.ip6));
	dataoff += sizeof(*icmp6h);
	return nf_conntrack_inet_error(tmpl, skb, dataoff, state,
				       IPPROTO_ICMPV6, &outer_daddr);
}

#if IS_ENABLED(CONFIG_NF_CT_NETLINK)

#include <linux/netfilter/nfnetlink.h>
#include <linux/netfilter/nfnetlink_conntrack.h>
static int icmpv6_tuple_to_nlattr(struct sk_buff *skb,
				  const struct nf_conntrack_tuple *t)
{
	if (nla_put_be16(skb, CTA_PROTO_ICMPV6_ID, t->src.u.icmp.id) ||
	    nla_put_u8(skb, CTA_PROTO_ICMPV6_TYPE, t->dst.u.icmp.type) ||
	    nla_put_u8(skb, CTA_PROTO_ICMPV6_CODE, t->dst.u.icmp.code))
		goto nla_put_failure;
	return 0;

nla_put_failure:
	return -1;
}

static const struct nla_policy icmpv6_nla_policy[CTA_PROTO_MAX+1] = {
	[CTA_PROTO_ICMPV6_TYPE]	= { .type = NLA_U8 },
	[CTA_PROTO_ICMPV6_CODE]	= { .type = NLA_U8 },
	[CTA_PROTO_ICMPV6_ID]	= { .type = NLA_U16 },
};

static int icmpv6_nlattr_to_tuple(struct nlattr *tb[],
				struct nf_conntrack_tuple *tuple,
				u_int32_t flags)
{
	if (flags & CTA_FILTER_FLAG(CTA_PROTO_ICMPV6_TYPE)) {
		if (!tb[CTA_PROTO_ICMPV6_TYPE])
			return -EINVAL;

		tuple->dst.u.icmp.type = nla_get_u8(tb[CTA_PROTO_ICMPV6_TYPE]);
		if (tuple->dst.u.icmp.type < 128 ||
		    tuple->dst.u.icmp.type - 128 >= sizeof(invmap) ||
		    !invmap[tuple->dst.u.icmp.type - 128])
			return -EINVAL;
	}

	if (flags & CTA_FILTER_FLAG(CTA_PROTO_ICMPV6_CODE)) {
		if (!tb[CTA_PROTO_ICMPV6_CODE])
			return -EINVAL;

		tuple->dst.u.icmp.code = nla_get_u8(tb[CTA_PROTO_ICMPV6_CODE]);
	}

	if (flags & CTA_FILTER_FLAG(CTA_PROTO_ICMPV6_ID)) {
		if (!tb[CTA_PROTO_ICMPV6_ID])
			return -EINVAL;

		tuple->src.u.icmp.id = nla_get_be16(tb[CTA_PROTO_ICMPV6_ID]);
	}

	return 0;
}

static unsigned int icmpv6_nlattr_tuple_size(void)
{
	static unsigned int size __read_mostly;

	if (!size)
		size = nla_policy_len(icmpv6_nla_policy, CTA_PROTO_MAX + 1);

	return size;
}
#endif

#ifdef CONFIG_NF_CONNTRACK_TIMEOUT

#include <linux/netfilter/nfnetlink.h>
#include <linux/netfilter/nfnetlink_cttimeout.h>

static int icmpv6_timeout_nlattr_to_obj(struct nlattr *tb[],
					struct net *net, void *data)
{
	unsigned int *timeout = data;
	struct nf_icmp_net *in = nf_icmpv6_pernet(net);

	if (!timeout)
		timeout = icmpv6_get_timeouts(net);
	if (tb[CTA_TIMEOUT_ICMPV6_TIMEOUT]) {
		*timeout =
		    ntohl(nla_get_be32(tb[CTA_TIMEOUT_ICMPV6_TIMEOUT])) * HZ;
	} else {
		/* Set default ICMPv6 timeout. */
		*timeout = in->timeout;
	}
	return 0;
}

static int
icmpv6_timeout_obj_to_nlattr(struct sk_buff *skb, const void *data)
{
	const unsigned int *timeout = data;

	if (nla_put_be32(skb, CTA_TIMEOUT_ICMPV6_TIMEOUT, htonl(*timeout / HZ)))
		goto nla_put_failure;
	return 0;

nla_put_failure:
	return -ENOSPC;
}

static const struct nla_policy
icmpv6_timeout_nla_policy[CTA_TIMEOUT_ICMPV6_MAX+1] = {
	[CTA_TIMEOUT_ICMPV6_TIMEOUT]	= { .type = NLA_U32 },
};
#endif /* CONFIG_NF_CONNTRACK_TIMEOUT */

void nf_conntrack_icmpv6_init_net(struct net *net)
{
	struct nf_icmp_net *in = nf_icmpv6_pernet(net);

	in->timeout = nf_ct_icmpv6_timeout;
}

const struct nf_conntrack_l4proto nf_conntrack_l4proto_icmpv6 =
{
	.l4proto		= IPPROTO_ICMPV6,
#if IS_ENABLED(CONFIG_NF_CT_NETLINK)
	.tuple_to_nlattr	= icmpv6_tuple_to_nlattr,
	.nlattr_tuple_size	= icmpv6_nlattr_tuple_size,
	.nlattr_to_tuple	= icmpv6_nlattr_to_tuple,
	.nla_policy		= icmpv6_nla_policy,
#endif
#ifdef CONFIG_NF_CONNTRACK_TIMEOUT
	.ctnl_timeout		= {
		.nlattr_to_obj	= icmpv6_timeout_nlattr_to_obj,
		.obj_to_nlattr	= icmpv6_timeout_obj_to_nlattr,
		.nlattr_max	= CTA_TIMEOUT_ICMP_MAX,
		.obj_size	= sizeof(unsigned int),
		.nla_policy	= icmpv6_timeout_nla_policy,
	},
#endif /* CONFIG_NF_CONNTRACK_TIMEOUT */
};
Commit	Line	Data
d2912cb1	1	// SPDX-License-Identifier: GPL-2.0-only
9fb9cbb1 YK	2	/*
	3	* Copyright (C)2003,2004 USAGI/WIDE Project
	4	*
9fb9cbb1 YK	5	* Author:
9fb9cbb1 YK	6	* Yasuyuki Kozakai @USAGI <yasuyuki.kozakai@toshiba.co.jp>
9fb9cbb1 YK	7	*/
	8
	9	#include <linux/types.h>
9fb9cbb1 YK	10	#include <linux/timer.h>
	11	#include <linux/module.h>
	12	#include <linux/netfilter.h>
	13	#include <linux/in6.h>
	14	#include <linux/icmpv6.h>
	15	#include <linux/ipv6.h>
	16	#include <net/ipv6.h>
	17	#include <net/ip6_checksum.h>
	18	#include <linux/seq_file.h>
	19	#include <linux/netfilter_ipv6.h>
	20	#include <net/netfilter/nf_conntrack_tuple.h>
605dcad6	21	#include <net/netfilter/nf_conntrack_l4proto.h>
9fb9cbb1	22	#include <net/netfilter/nf_conntrack_core.h>
c779e849	23	#include <net/netfilter/nf_conntrack_timeout.h>
5d0aa2cc	24	#include <net/netfilter/nf_conntrack_zones.h>
f01ffbd6	25	#include <net/netfilter/nf_log.h>
9fb9cbb1	26
cb8aa9a3 RB	27	#include "nf_internals.h"
cb8aa9a3 RB	28
2c9e8637	29	static const unsigned int nf_ct_icmpv6_timeout = 30*HZ;
9fb9cbb1	30
e2e48b47 FW	31	bool icmpv6_pkt_to_tuple(const struct sk_buff *skb,
	32	unsigned int dataoff,
	33	struct net *net,
	34	struct nf_conntrack_tuple *tuple)
9fb9cbb1	35	{
7cc3864d JE	36	const struct icmp6hdr *hp;
7cc3864d JE	37	struct icmp6hdr _hdr;
9fb9cbb1 YK	38
	39	hp = skb_header_pointer(skb, dataoff, sizeof(_hdr), &_hdr);
	40	if (hp == NULL)
09f263cd	41	return false;
9fb9cbb1 YK	42	tuple->dst.u.icmp.type = hp->icmp6_type;
	43	tuple->src.u.icmp.id = hp->icmp6_identifier;
	44	tuple->dst.u.icmp.code = hp->icmp6_code;
	45
09f263cd	46	return true;
9fb9cbb1 YK	47	}
9fb9cbb1 YK	48
c1d10adb	49	/* Add 1; spaces filled with 0. */
7cc3864d	50	static const u_int8_t invmap[] = {
c1d10adb PNA	51	[ICMPV6_ECHO_REQUEST - 128] = ICMPV6_ECHO_REPLY + 1,
c1d10adb PNA	52	[ICMPV6_ECHO_REPLY - 128] = ICMPV6_ECHO_REQUEST + 1,
a51f42f3	53	[ICMPV6_NI_QUERY - 128] = ICMPV6_NI_REPLY + 1,
f9527ea9	54	[ICMPV6_NI_REPLY - 128] = ICMPV6_NI_QUERY + 1
c1d10adb PNA	55	};
c1d10adb PNA	56
3f900713 EL	57	static const u_int8_t noct_valid_new[] = {
3f900713 EL	58	[ICMPV6_MGM_QUERY - 130] = 1,
f9527ea9	59	[ICMPV6_MGM_REPORT - 130] = 1,
3f900713 EL	60	[ICMPV6_MGM_REDUCTION - 130] = 1,
	61	[NDISC_ROUTER_SOLICITATION - 130] = 1,
	62	[NDISC_ROUTER_ADVERTISEMENT - 130] = 1,
	63	[NDISC_NEIGHBOUR_SOLICITATION - 130] = 1,
	64	[NDISC_NEIGHBOUR_ADVERTISEMENT - 130] = 1,
4a3540a8 LL	65	[ICMPV6_MLD2_REPORT - 130] = 1,
	66	[ICMPV6_MRDISC_ADV - 130] = 1,
	67	[ICMPV6_MRDISC_SOL - 130] = 1
3f900713 EL	68	};
3f900713 EL	69
197c4300 FW	70	bool nf_conntrack_invert_icmpv6_tuple(struct nf_conntrack_tuple *tuple,
197c4300 FW	71	const struct nf_conntrack_tuple *orig)
9fb9cbb1	72	{
f16c9107 YK	73	int type = orig->dst.u.icmp.type - 128;
f16c9107 YK	74	if (type < 0 \|\| type >= sizeof(invmap) \|\| !invmap[type])
09f263cd	75	return false;
9fb9cbb1 YK	76
	77	tuple->src.u.icmp.id = orig->src.u.icmp.id;
	78	tuple->dst.u.icmp.type = invmap[type] - 1;
	79	tuple->dst.u.icmp.code = orig->dst.u.icmp.code;
09f263cd	80	return true;
9fb9cbb1 YK	81	}
9fb9cbb1 YK	82
2c8503f5 PNA	83	static unsigned int icmpv6_get_timeouts(struct net net)
2c8503f5 PNA	84	{
a95a7774	85	return &nf_icmpv6_pernet(net)->timeout;
2c8503f5 PNA	86	}
2c8503f5 PNA	87
9fb9cbb1	88	/* Returns verdict for packet, or -1 for invalid. */
a47c5404 FW	89	int nf_conntrack_icmpv6_packet(struct nf_conn *ct,
	90	struct sk_buff *skb,
	91	enum ip_conntrack_info ctinfo,
	92	const struct nf_hook_state *state)
9fb9cbb1	93	{
c779e849	94	unsigned int *timeout = nf_ct_timeout_lookup(ct);
9976fc6e FW	95	static const u8 valid_new[] = {
	96	[ICMPV6_ECHO_REQUEST - 128] = 1,
	97	[ICMPV6_NI_QUERY - 128] = 1
	98	};
	99
dd2934a9 FW	100	if (state->pf != NFPROTO_IPV6)
	101	return -NF_ACCEPT;
	102
9976fc6e FW	103	if (!nf_ct_is_confirmed(ct)) {
	104	int type = ct->tuplehash[0].tuple.dst.u.icmp.type - 128;
	105
	106	if (type < 0 \|\| type >= sizeof(valid_new) \|\| !valid_new[type]) {
	107	/* Can't create a new ICMPv6 `conn' with this. */
	108	pr_debug("icmpv6: can't create new conn with type %u\n",
	109	type + 128);
	110	nf_ct_dump_tuple_ipv6(&ct->tuplehash[0].tuple);
	111	return -NF_ACCEPT;
	112	}
	113	}
c779e849 FW	114
	115	if (!timeout)
	116	timeout = icmpv6_get_timeouts(nf_ct_net(ct));
	117
f87fb666 JK	118	/* Do not immediately delete the connection after the first
	119	successful reply to avoid excessive conntrackd traffic
	120	and also to handle correctly ICMP echo reply duplicates. */
2c8503f5	121	nf_ct_refresh_acct(ct, ctinfo, skb, *timeout);
9fb9cbb1 YK	122
	123	return NF_ACCEPT;
	124	}
	125
9fb9cbb1	126
93e66024 FW	127	static void icmpv6_error_log(const struct sk_buff *skb,
	128	const struct nf_hook_state *state,
	129	const char *msg)
c4f3db15	130	{
62eec0d7	131	nf_l4proto_log_invalid(skb, state, IPPROTO_ICMPV6, "%s", msg);
c4f3db15 FW	132	}
c4f3db15 FW	133
7d7cfb48 FW	134	static noinline_for_stack int
	135	nf_conntrack_icmpv6_redirect(struct nf_conn tmpl, struct sk_buff skb,
	136	unsigned int dataoff,
	137	const struct nf_hook_state *state)
	138	{
	139	u8 hl = ipv6_hdr(skb)->hop_limit;
	140	union nf_inet_addr outer_daddr;
	141	union {
	142	struct nd_opt_hdr nd_opt;
	143	struct rd_msg rd_msg;
	144	} tmp;
	145	const struct nd_opt_hdr *nd_opt;
	146	const struct rd_msg *rd_msg;
	147
	148	rd_msg = skb_header_pointer(skb, dataoff, sizeof(*rd_msg), &tmp.rd_msg);
	149	if (!rd_msg) {
	150	icmpv6_error_log(skb, state, "short redirect");
	151	return -NF_ACCEPT;
	152	}
	153
	154	if (rd_msg->icmph.icmp6_code != 0)
	155	return NF_ACCEPT;
	156
	157	if (hl != 255 \|\| !(ipv6_addr_type(&ipv6_hdr(skb)->saddr) & IPV6_ADDR_LINKLOCAL)) {
	158	icmpv6_error_log(skb, state, "invalid saddr or hoplimit for redirect");
	159	return -NF_ACCEPT;
	160	}
	161
	162	dataoff += sizeof(*rd_msg);
	163
	164	/* warning: rd_msg no longer usable after this call */
	165	nd_opt = skb_header_pointer(skb, dataoff, sizeof(*nd_opt), &tmp.nd_opt);
	166	if (!nd_opt \|\| nd_opt->nd_opt_len == 0) {
	167	icmpv6_error_log(skb, state, "redirect without options");
	168	return -NF_ACCEPT;
	169	}
	170
	171	/* We could call ndisc_parse_options(), but it would need
	172	* skb_linearize() and a bit more work.
	173	*/
	174	if (nd_opt->nd_opt_type != ND_OPT_REDIRECT_HDR)
	175	return NF_ACCEPT;
	176
	177	memcpy(&outer_daddr.ip6, &ipv6_hdr(skb)->daddr,
	178	sizeof(outer_daddr.ip6));
	179	dataoff += 8;
	180	return nf_conntrack_inet_error(tmpl, skb, dataoff, state,
	181	IPPROTO_ICMPV6, &outer_daddr);
	182	}
	183
6fe78fa4 FW	184	int nf_conntrack_icmpv6_error(struct nf_conn *tmpl,
	185	struct sk_buff *skb,
	186	unsigned int dataoff,
	187	const struct nf_hook_state *state)
9fb9cbb1	188	{
1025ce75	189	union nf_inet_addr outer_daddr;
7cc3864d JE	190	const struct icmp6hdr *icmp6h;
7cc3864d JE	191	struct icmp6hdr _ih;
3f900713	192	int type;
9fb9cbb1 YK	193
	194	icmp6h = skb_header_pointer(skb, dataoff, sizeof(_ih), &_ih);
	195	if (icmp6h == NULL) {
93e66024	196	icmpv6_error_log(skb, state, "short packet");
9fb9cbb1 YK	197	return -NF_ACCEPT;
	198	}
	199
93e66024 FW	200	if (state->hook == NF_INET_PRE_ROUTING &&
	201	state->net->ct.sysctl_checksum &&
	202	nf_ip6_checksum(skb, state->hook, dataoff, IPPROTO_ICMPV6)) {
	203	icmpv6_error_log(skb, state, "ICMPv6 checksum failed");
9fb9cbb1 YK	204	return -NF_ACCEPT;
	205	}
	206
3f900713 EL	207	type = icmp6h->icmp6_type - 130;
	208	if (type >= 0 && type < sizeof(noct_valid_new) &&
	209	noct_valid_new[type]) {
cc41c84b	210	nf_ct_set(skb, NULL, IP_CT_UNTRACKED);
3f900713 EL	211	return NF_ACCEPT;
	212	}
	213
7d7cfb48 FW	214	if (icmp6h->icmp6_type == NDISC_REDIRECT)
	215	return nf_conntrack_icmpv6_redirect(tmpl, skb, dataoff, state);
	216
9fb9cbb1 YK	217	/* is not error message ? */
	218	if (icmp6h->icmp6_type >= 128)
	219	return NF_ACCEPT;
	220
1025ce75 FW	221	memcpy(&outer_daddr.ip6, &ipv6_hdr(skb)->daddr,
	222	sizeof(outer_daddr.ip6));
	223	dataoff += sizeof(*icmp6h);
	224	return nf_conntrack_inet_error(tmpl, skb, dataoff, state,
	225	IPPROTO_ICMPV6, &outer_daddr);
9fb9cbb1 YK	226	}
9fb9cbb1 YK	227
07a93626	228	#if IS_ENABLED(CONFIG_NF_CT_NETLINK)
c1d10adb PNA	229
	230	#include <linux/netfilter/nfnetlink.h>
	231	#include <linux/netfilter/nfnetlink_conntrack.h>
fdf70832	232	static int icmpv6_tuple_to_nlattr(struct sk_buff *skb,
c1d10adb PNA	233	const struct nf_conntrack_tuple *t)
c1d10adb PNA	234	{
e549a6b3 DM	235	if (nla_put_be16(skb, CTA_PROTO_ICMPV6_ID, t->src.u.icmp.id) \|\|
	236	nla_put_u8(skb, CTA_PROTO_ICMPV6_TYPE, t->dst.u.icmp.type) \|\|
	237	nla_put_u8(skb, CTA_PROTO_ICMPV6_CODE, t->dst.u.icmp.code))
	238	goto nla_put_failure;
c1d10adb PNA	239	return 0;
c1d10adb PNA	240
df6fb868	241	nla_put_failure:
c1d10adb PNA	242	return -1;
	243	}
	244
f73e924c PM	245	static const struct nla_policy icmpv6_nla_policy[CTA_PROTO_MAX+1] = {
	246	[CTA_PROTO_ICMPV6_TYPE] = { .type = NLA_U8 },
	247	[CTA_PROTO_ICMPV6_CODE] = { .type = NLA_U8 },
	248	[CTA_PROTO_ICMPV6_ID] = { .type = NLA_U16 },
c1d10adb PNA	249	};
c1d10adb PNA	250
fdf70832	251	static int icmpv6_nlattr_to_tuple(struct nlattr *tb[],
cb8aa9a3 RB	252	struct nf_conntrack_tuple *tuple,
cb8aa9a3 RB	253	u_int32_t flags)
c1d10adb	254	{
cb8aa9a3 RB	255	if (flags & CTA_FILTER_FLAG(CTA_PROTO_ICMPV6_TYPE)) {
	256	if (!tb[CTA_PROTO_ICMPV6_TYPE])
	257	return -EINVAL;
	258
	259	tuple->dst.u.icmp.type = nla_get_u8(tb[CTA_PROTO_ICMPV6_TYPE]);
	260	if (tuple->dst.u.icmp.type < 128 \|\|
	261	tuple->dst.u.icmp.type - 128 >= sizeof(invmap) \|\|
	262	!invmap[tuple->dst.u.icmp.type - 128])
	263	return -EINVAL;
	264	}
	265
	266	if (flags & CTA_FILTER_FLAG(CTA_PROTO_ICMPV6_CODE)) {
	267	if (!tb[CTA_PROTO_ICMPV6_CODE])
	268	return -EINVAL;
	269
	270	tuple->dst.u.icmp.code = nla_get_u8(tb[CTA_PROTO_ICMPV6_CODE]);
	271	}
	272
	273	if (flags & CTA_FILTER_FLAG(CTA_PROTO_ICMPV6_ID)) {
	274	if (!tb[CTA_PROTO_ICMPV6_ID])
	275	return -EINVAL;
	276
	277	tuple->src.u.icmp.id = nla_get_be16(tb[CTA_PROTO_ICMPV6_ID]);
	278	}
c1d10adb PNA	279
	280	return 0;
	281	}
a400c30e	282
5caaed15	283	static unsigned int icmpv6_nlattr_tuple_size(void)
a400c30e	284	{
5caaed15 FW	285	static unsigned int size __read_mostly;
	286
	287	if (!size)
	288	size = nla_policy_len(icmpv6_nla_policy, CTA_PROTO_MAX + 1);
	289
	290	return size;
a400c30e	291	}
c1d10adb PNA	292	#endif
c1d10adb PNA	293
a874752a	294	#ifdef CONFIG_NF_CONNTRACK_TIMEOUT
50978462 PNA	295
	296	#include <linux/netfilter/nfnetlink.h>
	297	#include <linux/netfilter/nfnetlink_cttimeout.h>
	298
8264deb8 G	299	static int icmpv6_timeout_nlattr_to_obj(struct nlattr *tb[],
8264deb8 G	300	struct net net, void data)
50978462 PNA	301	{
50978462 PNA	302	unsigned int *timeout = data;
a95a7774	303	struct nf_icmp_net *in = nf_icmpv6_pernet(net);
50978462	304
c779e849 FW	305	if (!timeout)
c779e849 FW	306	timeout = icmpv6_get_timeouts(net);
50978462 PNA	307	if (tb[CTA_TIMEOUT_ICMPV6_TIMEOUT]) {
	308	*timeout =
	309	ntohl(nla_get_be32(tb[CTA_TIMEOUT_ICMPV6_TIMEOUT])) * HZ;
	310	} else {
	311	/* Set default ICMPv6 timeout. */
8264deb8	312	*timeout = in->timeout;
50978462 PNA	313	}
	314	return 0;
	315	}
	316
	317	static int
	318	icmpv6_timeout_obj_to_nlattr(struct sk_buff skb, const void data)
	319	{
	320	const unsigned int *timeout = data;
	321
e549a6b3 DM	322	if (nla_put_be32(skb, CTA_TIMEOUT_ICMPV6_TIMEOUT, htonl(*timeout / HZ)))
e549a6b3 DM	323	goto nla_put_failure;
50978462 PNA	324	return 0;
	325
	326	nla_put_failure:
	327	return -ENOSPC;
	328	}
	329
	330	static const struct nla_policy
	331	icmpv6_timeout_nla_policy[CTA_TIMEOUT_ICMPV6_MAX+1] = {
	332	[CTA_TIMEOUT_ICMPV6_TIMEOUT] = { .type = NLA_U32 },
	333	};
a874752a	334	#endif /* CONFIG_NF_CONNTRACK_TIMEOUT */
50978462	335
2a389de8	336	void nf_conntrack_icmpv6_init_net(struct net *net)
8fc02781	337	{
a95a7774	338	struct nf_icmp_net *in = nf_icmpv6_pernet(net);
8fc02781 G	339
8fc02781 G	340	in->timeout = nf_ct_icmpv6_timeout;
08911475 PNA	341	}
08911475 PNA	342
9dae47ab	343	const struct nf_conntrack_l4proto nf_conntrack_l4proto_icmpv6 =
9fb9cbb1	344	{
605dcad6	345	.l4proto = IPPROTO_ICMPV6,
07a93626	346	#if IS_ENABLED(CONFIG_NF_CT_NETLINK)
fdf70832	347	.tuple_to_nlattr = icmpv6_tuple_to_nlattr,
a400c30e	348	.nlattr_tuple_size = icmpv6_nlattr_tuple_size,
fdf70832	349	.nlattr_to_tuple = icmpv6_nlattr_to_tuple,
f73e924c	350	.nla_policy = icmpv6_nla_policy,
c1d10adb	351	#endif
a874752a	352	#ifdef CONFIG_NF_CONNTRACK_TIMEOUT
50978462 PNA	353	.ctnl_timeout = {
	354	.nlattr_to_obj = icmpv6_timeout_nlattr_to_obj,
	355	.obj_to_nlattr = icmpv6_timeout_obj_to_nlattr,
	356	.nlattr_max = CTA_TIMEOUT_ICMP_MAX,
	357	.obj_size = sizeof(unsigned int),
	358	.nla_policy = icmpv6_timeout_nla_policy,
	359	},
a874752a	360	#endif /* CONFIG_NF_CONNTRACK_TIMEOUT */
9fb9cbb1	361	};