[GitHub/mt8127/android_kernel_alcatel_ttab.git] / net / ipv6 / netfilter / nf_conntrack_proto_icmpv6.c

/*
 * Copyright (C)2003,2004 USAGI/WIDE Project
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 *
 * 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_zones.h>
#include <net/netfilter/ipv6/nf_conntrack_icmpv6.h>
#include <net/netfilter/nf_log.h>

static unsigned int nf_ct_icmpv6_timeout __read_mostly = 30*HZ;

static bool icmpv6_pkt_to_tuple(const struct sk_buff *skb,
				unsigned int dataoff,
				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
};

static bool icmpv6_invert_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;
}

/* Print out the per-protocol part of the tuple. */
static int icmpv6_print_tuple(struct seq_file *s,
			      const struct nf_conntrack_tuple *tuple)
{
	return seq_printf(s, "type=%u code=%u id=%u ",
			  tuple->dst.u.icmp.type,
			  tuple->dst.u.icmp.code,
			  ntohs(tuple->src.u.icmp.id));
}

static unsigned int *icmpv6_get_timeouts(struct net *net)
{
	return &nf_ct_icmpv6_timeout;
}

/* Returns verdict for packet, or -1 for invalid. */
static int icmpv6_packet(struct nf_conn *ct,
		       const struct sk_buff *skb,
		       unsigned int dataoff,
		       enum ip_conntrack_info ctinfo,
		       u_int8_t pf,
		       unsigned int hooknum,
		       unsigned int *timeout)
{
	/* 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;
}

/* Called when a new connection for this protocol found. */
static bool icmpv6_new(struct nf_conn *ct, const struct sk_buff *skb,
		       unsigned int dataoff, unsigned int *timeouts)
{
	static const u_int8_t valid_new[] = {
		[ICMPV6_ECHO_REQUEST - 128] = 1,
		[ICMPV6_NI_QUERY - 128] = 1
	};
	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);
		if (LOG_INVALID(nf_ct_net(ct), IPPROTO_ICMPV6))
			nf_log_packet(PF_INET6, 0, skb, NULL, NULL, NULL,
				      "nf_ct_icmpv6: invalid new with type %d ",
				      type + 128);
		return false;
	}
	return true;
}

static int
icmpv6_error_message(struct net *net, struct nf_conn *tmpl,
		     struct sk_buff *skb,
		     unsigned int icmp6off,
		     enum ip_conntrack_info *ctinfo,
		     unsigned int hooknum)
{
	struct nf_conntrack_tuple intuple, origtuple;
	const struct nf_conntrack_tuple_hash *h;
	const struct nf_conntrack_l4proto *inproto;
	u16 zone = tmpl ? nf_ct_zone(tmpl) : NF_CT_DEFAULT_ZONE;

	NF_CT_ASSERT(skb->nfct == NULL);

	/* Are they talking about one of our connections? */
	if (!nf_ct_get_tuplepr(skb,
			       skb_network_offset(skb)
				+ sizeof(struct ipv6hdr)
				+ sizeof(struct icmp6hdr),
			       PF_INET6, &origtuple)) {
		pr_debug("icmpv6_error: Can't get tuple\n");
		return -NF_ACCEPT;
	}

	/* rcu_read_lock()ed by nf_hook_slow */
	inproto = __nf_ct_l4proto_find(PF_INET6, origtuple.dst.protonum);

	/* Ordinarily, we'd expect the inverted tupleproto, but it's
	   been preserved inside the ICMP. */
	if (!nf_ct_invert_tuple(&intuple, &origtuple,
				&nf_conntrack_l3proto_ipv6, inproto)) {
		pr_debug("icmpv6_error: Can't invert tuple\n");
		return -NF_ACCEPT;
	}

	*ctinfo = IP_CT_RELATED;

	h = nf_conntrack_find_get(net, zone, &intuple);
	if (!h) {
		pr_debug("icmpv6_error: no match\n");
		return -NF_ACCEPT;
	} else {
		if (NF_CT_DIRECTION(h) == IP_CT_DIR_REPLY)
			*ctinfo += IP_CT_IS_REPLY;
	}

	/* Update skb to refer to this connection */
	skb->nfct = &nf_ct_tuplehash_to_ctrack(h)->ct_general;
	skb->nfctinfo = *ctinfo;
	return NF_ACCEPT;
}

static int
icmpv6_error(struct net *net, struct nf_conn *tmpl,
	     struct sk_buff *skb, unsigned int dataoff,
	     enum ip_conntrack_info *ctinfo, u_int8_t pf, unsigned int hooknum)
{
	const struct icmp6hdr *icmp6h;
	struct icmp6hdr _ih;
	int type;

	icmp6h = skb_header_pointer(skb, dataoff, sizeof(_ih), &_ih);
	if (icmp6h == NULL) {
		if (LOG_INVALID(net, IPPROTO_ICMPV6))
		nf_log_packet(PF_INET6, 0, skb, NULL, NULL, NULL,
			      "nf_ct_icmpv6: short packet ");
		return -NF_ACCEPT;
	}

	if (net->ct.sysctl_checksum && hooknum == NF_INET_PRE_ROUTING &&
	    nf_ip6_checksum(skb, hooknum, dataoff, IPPROTO_ICMPV6)) {
		if (LOG_INVALID(net, IPPROTO_ICMPV6))
			nf_log_packet(PF_INET6, 0, skb, NULL, NULL, NULL,
				      "nf_ct_icmpv6: ICMPv6 checksum failed ");
		return -NF_ACCEPT;
	}

	type = icmp6h->icmp6_type - 130;
	if (type >= 0 && type < sizeof(noct_valid_new) &&
	    noct_valid_new[type]) {
		skb->nfct = &nf_ct_untracked_get()->ct_general;
		skb->nfctinfo = IP_CT_NEW;
		nf_conntrack_get(skb->nfct);
		return NF_ACCEPT;
	}

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

	return icmpv6_error_message(net, tmpl, skb, dataoff, ctinfo, hooknum);
}

#if defined(CONFIG_NF_CT_NETLINK) || defined(CONFIG_NF_CT_NETLINK_MODULE)

#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)
{
	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);

	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)
{
	if (!tb[CTA_PROTO_ICMPV6_TYPE] ||
	    !tb[CTA_PROTO_ICMPV6_CODE] ||
	    !tb[CTA_PROTO_ICMPV6_ID])
		return -EINVAL;

	tuple->dst.u.icmp.type = nla_get_u8(tb[CTA_PROTO_ICMPV6_TYPE]);
	tuple->dst.u.icmp.code = nla_get_u8(tb[CTA_PROTO_ICMPV6_CODE]);
	tuple->src.u.icmp.id = nla_get_be16(tb[CTA_PROTO_ICMPV6_ID]);

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

	return 0;
}

static int icmpv6_nlattr_tuple_size(void)
{
	return nla_policy_len(icmpv6_nla_policy, CTA_PROTO_MAX + 1);
}
#endif

#if IS_ENABLED(CONFIG_NF_CT_NETLINK_TIMEOUT)

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

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

	if (tb[CTA_TIMEOUT_ICMPV6_TIMEOUT]) {
		*timeout =
		    ntohl(nla_get_be32(tb[CTA_TIMEOUT_ICMPV6_TIMEOUT])) * HZ;
	} else {
		/* Set default ICMPv6 timeout. */
		*timeout = nf_ct_icmpv6_timeout;
	}
	return 0;
}

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

	NLA_PUT_BE32(skb, CTA_TIMEOUT_ICMPV6_TIMEOUT, htonl(*timeout / HZ));

	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_CT_NETLINK_TIMEOUT */

#ifdef CONFIG_SYSCTL
static struct ctl_table_header *icmpv6_sysctl_header;
static struct ctl_table icmpv6_sysctl_table[] = {
	{
		.procname	= "nf_conntrack_icmpv6_timeout",
		.data		= &nf_ct_icmpv6_timeout,
		.maxlen		= sizeof(unsigned int),
		.mode		= 0644,
		.proc_handler	= proc_dointvec_jiffies,
	},
	{ }
};
#endif /* CONFIG_SYSCTL */

struct nf_conntrack_l4proto nf_conntrack_l4proto_icmpv6 __read_mostly =
{
	.l3proto		= PF_INET6,
	.l4proto		= IPPROTO_ICMPV6,
	.name			= "icmpv6",
	.pkt_to_tuple		= icmpv6_pkt_to_tuple,
	.invert_tuple		= icmpv6_invert_tuple,
	.print_tuple		= icmpv6_print_tuple,
	.packet			= icmpv6_packet,
	.get_timeouts		= icmpv6_get_timeouts,
	.new			= icmpv6_new,
	.error			= icmpv6_error,
#if defined(CONFIG_NF_CT_NETLINK) || defined(CONFIG_NF_CT_NETLINK_MODULE)
	.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
#if IS_ENABLED(CONFIG_NF_CT_NETLINK_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_CT_NETLINK_TIMEOUT */
#ifdef CONFIG_SYSCTL
	.ctl_table_header	= &icmpv6_sysctl_header,
	.ctl_table		= icmpv6_sysctl_table,
#endif
};
Commit	Line	Data
9fb9cbb1 YK	1	/*
	2	* Copyright (C)2003,2004 USAGI/WIDE Project
	3	*
	4	* This program is free software; you can redistribute it and/or modify
	5	* it under the terms of the GNU General Public License version 2 as
	6	* published by the Free Software Foundation.
	7	*
	8	* Author:
	9	* Yasuyuki Kozakai @USAGI <yasuyuki.kozakai@toshiba.co.jp>
9fb9cbb1 YK	10	*/
	11
	12	#include <linux/types.h>
9fb9cbb1 YK	13	#include <linux/timer.h>
	14	#include <linux/module.h>
	15	#include <linux/netfilter.h>
	16	#include <linux/in6.h>
	17	#include <linux/icmpv6.h>
	18	#include <linux/ipv6.h>
	19	#include <net/ipv6.h>
	20	#include <net/ip6_checksum.h>
	21	#include <linux/seq_file.h>
	22	#include <linux/netfilter_ipv6.h>
	23	#include <net/netfilter/nf_conntrack_tuple.h>
605dcad6	24	#include <net/netfilter/nf_conntrack_l4proto.h>
9fb9cbb1	25	#include <net/netfilter/nf_conntrack_core.h>
5d0aa2cc	26	#include <net/netfilter/nf_conntrack_zones.h>
9fb9cbb1	27	#include <net/netfilter/ipv6/nf_conntrack_icmpv6.h>
f01ffbd6	28	#include <net/netfilter/nf_log.h>
9fb9cbb1	29
71320afc	30	static unsigned int nf_ct_icmpv6_timeout __read_mostly = 30*HZ;
9fb9cbb1	31
09f263cd JE	32	static bool icmpv6_pkt_to_tuple(const struct sk_buff *skb,
	33	unsigned int dataoff,
	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 EL	53	[ICMPV6_NI_QUERY - 128] = ICMPV6_NI_REPLY + 1,
a51f42f3 EL	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[] = {
	58	[ICMPV6_MGM_QUERY - 130] = 1,
	59	[ICMPV6_MGM_REPORT -130] = 1,
	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,
	65	[ICMPV6_MLD2_REPORT - 130] = 1
	66	};
	67
09f263cd JE	68	static bool icmpv6_invert_tuple(struct nf_conntrack_tuple *tuple,
09f263cd JE	69	const struct nf_conntrack_tuple *orig)
9fb9cbb1	70	{
f16c9107 YK	71	int type = orig->dst.u.icmp.type - 128;
f16c9107 YK	72	if (type < 0 \|\| type >= sizeof(invmap) \|\| !invmap[type])
09f263cd	73	return false;
9fb9cbb1 YK	74
	75	tuple->src.u.icmp.id = orig->src.u.icmp.id;
	76	tuple->dst.u.icmp.type = invmap[type] - 1;
	77	tuple->dst.u.icmp.code = orig->dst.u.icmp.code;
09f263cd	78	return true;
9fb9cbb1 YK	79	}
	80
	81	/* Print out the per-protocol part of the tuple. */
	82	static int icmpv6_print_tuple(struct seq_file *s,
	83	const struct nf_conntrack_tuple *tuple)
	84	{
	85	return seq_printf(s, "type=%u code=%u id=%u ",
	86	tuple->dst.u.icmp.type,
	87	tuple->dst.u.icmp.code,
	88	ntohs(tuple->src.u.icmp.id));
	89	}
	90
2c8503f5 PNA	91	static unsigned int icmpv6_get_timeouts(struct net net)
	92	{
	93	return &nf_ct_icmpv6_timeout;
	94	}
	95
9fb9cbb1 YK	96	/* Returns verdict for packet, or -1 for invalid. */
	97	static int icmpv6_packet(struct nf_conn *ct,
	98	const struct sk_buff *skb,
	99	unsigned int dataoff,
	100	enum ip_conntrack_info ctinfo,
76108cea	101	u_int8_t pf,
2c8503f5 PNA	102	unsigned int hooknum,
2c8503f5 PNA	103	unsigned int *timeout)
9fb9cbb1	104	{
f87fb666 JK	105	/* Do not immediately delete the connection after the first
	106	successful reply to avoid excessive conntrackd traffic
	107	and also to handle correctly ICMP echo reply duplicates. */
2c8503f5	108	nf_ct_refresh_acct(ct, ctinfo, skb, *timeout);
9fb9cbb1 YK	109
	110	return NF_ACCEPT;
	111	}
	112
	113	/* Called when a new connection for this protocol found. */
09f263cd	114	static bool icmpv6_new(struct nf_conn ct, const struct sk_buff skb,
2c8503f5	115	unsigned int dataoff, unsigned int *timeouts)
9fb9cbb1	116	{
7cc3864d	117	static const u_int8_t valid_new[] = {
9fb9cbb1 YK	118	[ICMPV6_ECHO_REQUEST - 128] = 1,
	119	[ICMPV6_NI_QUERY - 128] = 1
	120	};
c88130bc	121	int type = ct->tuplehash[0].tuple.dst.u.icmp.type - 128;
9fb9cbb1	122
f16c9107	123	if (type < 0 \|\| type >= sizeof(valid_new) \|\| !valid_new[type]) {
9fb9cbb1	124	/* Can't create a new ICMPv6 `conn' with this. */
0d53778e PM	125	pr_debug("icmpv6: can't create new conn with type %u\n",
0d53778e PM	126	type + 128);
3c9fba65	127	nf_ct_dump_tuple_ipv6(&ct->tuplehash[0].tuple);
55df4ac0 EL	128	if (LOG_INVALID(nf_ct_net(ct), IPPROTO_ICMPV6))
	129	nf_log_packet(PF_INET6, 0, skb, NULL, NULL, NULL,
	130	"nf_ct_icmpv6: invalid new with type %d ",
	131	type + 128);
09f263cd	132	return false;
9fb9cbb1	133	}
09f263cd	134	return true;
9fb9cbb1 YK	135	}
9fb9cbb1 YK	136
9fb9cbb1	137	static int
5d0aa2cc	138	icmpv6_error_message(struct net net, struct nf_conn tmpl,
74c51a14	139	struct sk_buff *skb,
9fb9cbb1 YK	140	unsigned int icmp6off,
	141	enum ip_conntrack_info *ctinfo,
	142	unsigned int hooknum)
	143	{
	144	struct nf_conntrack_tuple intuple, origtuple;
7cc3864d JE	145	const struct nf_conntrack_tuple_hash *h;
7cc3864d JE	146	const struct nf_conntrack_l4proto *inproto;
5d0aa2cc	147	u16 zone = tmpl ? nf_ct_zone(tmpl) : NF_CT_DEFAULT_ZONE;
9fb9cbb1 YK	148
	149	NF_CT_ASSERT(skb->nfct == NULL);
	150
9fb9cbb1	151	/* Are they talking about one of our connections? */
e2a3123f YK	152	if (!nf_ct_get_tuplepr(skb,
	153	skb_network_offset(skb)
	154	+ sizeof(struct ipv6hdr)
	155	+ sizeof(struct icmp6hdr),
	156	PF_INET6, &origtuple)) {
0d53778e	157	pr_debug("icmpv6_error: Can't get tuple\n");
9fb9cbb1 YK	158	return -NF_ACCEPT;
	159	}
	160
e2a3123f YK	161	/* rcu_read_lock()ed by nf_hook_slow */
	162	inproto = __nf_ct_l4proto_find(PF_INET6, origtuple.dst.protonum);
	163
9fb9cbb1 YK	164	/* Ordinarily, we'd expect the inverted tupleproto, but it's
	165	been preserved inside the ICMP. */
	166	if (!nf_ct_invert_tuple(&intuple, &origtuple,
	167	&nf_conntrack_l3proto_ipv6, inproto)) {
0d53778e	168	pr_debug("icmpv6_error: Can't invert tuple\n");
9fb9cbb1 YK	169	return -NF_ACCEPT;
	170	}
	171
	172	*ctinfo = IP_CT_RELATED;
	173
5d0aa2cc	174	h = nf_conntrack_find_get(net, zone, &intuple);
9fb9cbb1	175	if (!h) {
0d53778e	176	pr_debug("icmpv6_error: no match\n");
9fb9cbb1 YK	177	return -NF_ACCEPT;
	178	} else {
	179	if (NF_CT_DIRECTION(h) == IP_CT_DIR_REPLY)
	180	*ctinfo += IP_CT_IS_REPLY;
	181	}
	182
	183	/* Update skb to refer to this connection */
	184	skb->nfct = &nf_ct_tuplehash_to_ctrack(h)->ct_general;
	185	skb->nfctinfo = *ctinfo;
88ed01d1	186	return NF_ACCEPT;
9fb9cbb1 YK	187	}
	188
	189	static int
8fea97ec PM	190	icmpv6_error(struct net net, struct nf_conn tmpl,
8fea97ec PM	191	struct sk_buff *skb, unsigned int dataoff,
76108cea	192	enum ip_conntrack_info *ctinfo, u_int8_t pf, unsigned int hooknum)
9fb9cbb1	193	{
7cc3864d JE	194	const struct icmp6hdr *icmp6h;
7cc3864d JE	195	struct icmp6hdr _ih;
3f900713	196	int type;
9fb9cbb1 YK	197
	198	icmp6h = skb_header_pointer(skb, dataoff, sizeof(_ih), &_ih);
	199	if (icmp6h == NULL) {
c2a2c7e0	200	if (LOG_INVALID(net, IPPROTO_ICMPV6))
9fb9cbb1 YK	201	nf_log_packet(PF_INET6, 0, skb, NULL, NULL, NULL,
	202	"nf_ct_icmpv6: short packet ");
	203	return -NF_ACCEPT;
	204	}
	205
c04d0552	206	if (net->ct.sysctl_checksum && hooknum == NF_INET_PRE_ROUTING &&
96f6bf82	207	nf_ip6_checksum(skb, hooknum, dataoff, IPPROTO_ICMPV6)) {
4aa3b2ee EL	208	if (LOG_INVALID(net, IPPROTO_ICMPV6))
	209	nf_log_packet(PF_INET6, 0, skb, NULL, NULL, NULL,
	210	"nf_ct_icmpv6: ICMPv6 checksum failed ");
9fb9cbb1 YK	211	return -NF_ACCEPT;
	212	}
	213
3f900713 EL	214	type = icmp6h->icmp6_type - 130;
	215	if (type >= 0 && type < sizeof(noct_valid_new) &&
	216	noct_valid_new[type]) {
5bfddbd4	217	skb->nfct = &nf_ct_untracked_get()->ct_general;
3f900713 EL	218	skb->nfctinfo = IP_CT_NEW;
	219	nf_conntrack_get(skb->nfct);
	220	return NF_ACCEPT;
	221	}
	222
9fb9cbb1 YK	223	/* is not error message ? */
	224	if (icmp6h->icmp6_type >= 128)
	225	return NF_ACCEPT;
	226
5d0aa2cc	227	return icmpv6_error_message(net, tmpl, skb, dataoff, ctinfo, hooknum);
9fb9cbb1 YK	228	}
9fb9cbb1 YK	229
e281db5c	230	#if defined(CONFIG_NF_CT_NETLINK) \|\| defined(CONFIG_NF_CT_NETLINK_MODULE)
c1d10adb PNA	231
	232	#include <linux/netfilter/nfnetlink.h>
	233	#include <linux/netfilter/nfnetlink_conntrack.h>
fdf70832	234	static int icmpv6_tuple_to_nlattr(struct sk_buff *skb,
c1d10adb PNA	235	const struct nf_conntrack_tuple *t)
c1d10adb PNA	236	{
77236b6e PM	237	NLA_PUT_BE16(skb, CTA_PROTO_ICMPV6_ID, t->src.u.icmp.id);
	238	NLA_PUT_U8(skb, CTA_PROTO_ICMPV6_TYPE, t->dst.u.icmp.type);
	239	NLA_PUT_U8(skb, CTA_PROTO_ICMPV6_CODE, t->dst.u.icmp.code);
c1d10adb PNA	240
	241	return 0;
	242
df6fb868	243	nla_put_failure:
c1d10adb PNA	244	return -1;
	245	}
	246
f73e924c PM	247	static const struct nla_policy icmpv6_nla_policy[CTA_PROTO_MAX+1] = {
	248	[CTA_PROTO_ICMPV6_TYPE] = { .type = NLA_U8 },
	249	[CTA_PROTO_ICMPV6_CODE] = { .type = NLA_U8 },
	250	[CTA_PROTO_ICMPV6_ID] = { .type = NLA_U16 },
c1d10adb PNA	251	};
c1d10adb PNA	252
fdf70832	253	static int icmpv6_nlattr_to_tuple(struct nlattr *tb[],
c1d10adb PNA	254	struct nf_conntrack_tuple *tuple)
c1d10adb PNA	255	{
3666ed1c JP	256	if (!tb[CTA_PROTO_ICMPV6_TYPE] \|\|
	257	!tb[CTA_PROTO_ICMPV6_CODE] \|\|
	258	!tb[CTA_PROTO_ICMPV6_ID])
c1d10adb PNA	259	return -EINVAL;
c1d10adb PNA	260
77236b6e PM	261	tuple->dst.u.icmp.type = nla_get_u8(tb[CTA_PROTO_ICMPV6_TYPE]);
	262	tuple->dst.u.icmp.code = nla_get_u8(tb[CTA_PROTO_ICMPV6_CODE]);
	263	tuple->src.u.icmp.id = nla_get_be16(tb[CTA_PROTO_ICMPV6_ID]);
c1d10adb	264
3666ed1c JP	265	if (tuple->dst.u.icmp.type < 128 \|\|
	266	tuple->dst.u.icmp.type - 128 >= sizeof(invmap) \|\|
	267	!invmap[tuple->dst.u.icmp.type - 128])
c1d10adb PNA	268	return -EINVAL;
	269
	270	return 0;
	271	}
a400c30e HE	272
	273	static int icmpv6_nlattr_tuple_size(void)
	274	{
	275	return nla_policy_len(icmpv6_nla_policy, CTA_PROTO_MAX + 1);
	276	}
c1d10adb PNA	277	#endif
c1d10adb PNA	278
50978462 PNA	279	#if IS_ENABLED(CONFIG_NF_CT_NETLINK_TIMEOUT)
	280
	281	#include <linux/netfilter/nfnetlink.h>
	282	#include <linux/netfilter/nfnetlink_cttimeout.h>
	283
	284	static int icmpv6_timeout_nlattr_to_obj(struct nlattr tb[], void data)
	285	{
	286	unsigned int *timeout = data;
	287
	288	if (tb[CTA_TIMEOUT_ICMPV6_TIMEOUT]) {
	289	*timeout =
	290	ntohl(nla_get_be32(tb[CTA_TIMEOUT_ICMPV6_TIMEOUT])) * HZ;
	291	} else {
	292	/* Set default ICMPv6 timeout. */
	293	*timeout = nf_ct_icmpv6_timeout;
	294	}
	295	return 0;
	296	}
	297
	298	static int
	299	icmpv6_timeout_obj_to_nlattr(struct sk_buff skb, const void data)
	300	{
	301	const unsigned int *timeout = data;
	302
	303	NLA_PUT_BE32(skb, CTA_TIMEOUT_ICMPV6_TIMEOUT, htonl(*timeout / HZ));
	304
	305	return 0;
	306
	307	nla_put_failure:
	308	return -ENOSPC;
	309	}
	310
	311	static const struct nla_policy
	312	icmpv6_timeout_nla_policy[CTA_TIMEOUT_ICMPV6_MAX+1] = {
	313	[CTA_TIMEOUT_ICMPV6_TIMEOUT] = { .type = NLA_U32 },
	314	};
	315	#endif /* CONFIG_NF_CT_NETLINK_TIMEOUT */
	316
933a41e7 PM	317	#ifdef CONFIG_SYSCTL
	318	static struct ctl_table_header *icmpv6_sysctl_header;
	319	static struct ctl_table icmpv6_sysctl_table[] = {
	320	{
933a41e7 PM	321	.procname = "nf_conntrack_icmpv6_timeout",
	322	.data = &nf_ct_icmpv6_timeout,
	323	.maxlen = sizeof(unsigned int),
	324	.mode = 0644,
6d9f239a	325	.proc_handler = proc_dointvec_jiffies,
933a41e7	326	},
f8572d8f	327	{ }
933a41e7 PM	328	};
	329	#endif /* CONFIG_SYSCTL */
	330
61075af5	331	struct nf_conntrack_l4proto nf_conntrack_l4proto_icmpv6 __read_mostly =
9fb9cbb1 YK	332	{
9fb9cbb1 YK	333	.l3proto = PF_INET6,
605dcad6	334	.l4proto = IPPROTO_ICMPV6,
9fb9cbb1 YK	335	.name = "icmpv6",
	336	.pkt_to_tuple = icmpv6_pkt_to_tuple,
	337	.invert_tuple = icmpv6_invert_tuple,
	338	.print_tuple = icmpv6_print_tuple,
9fb9cbb1	339	.packet = icmpv6_packet,
2c8503f5	340	.get_timeouts = icmpv6_get_timeouts,
9fb9cbb1 YK	341	.new = icmpv6_new,
9fb9cbb1 YK	342	.error = icmpv6_error,
e281db5c	343	#if defined(CONFIG_NF_CT_NETLINK) \|\| defined(CONFIG_NF_CT_NETLINK_MODULE)
fdf70832	344	.tuple_to_nlattr = icmpv6_tuple_to_nlattr,
a400c30e	345	.nlattr_tuple_size = icmpv6_nlattr_tuple_size,
fdf70832	346	.nlattr_to_tuple = icmpv6_nlattr_to_tuple,
f73e924c	347	.nla_policy = icmpv6_nla_policy,
c1d10adb	348	#endif
50978462 PNA	349	#if IS_ENABLED(CONFIG_NF_CT_NETLINK_TIMEOUT)
	350	.ctnl_timeout = {
	351	.nlattr_to_obj = icmpv6_timeout_nlattr_to_obj,
	352	.obj_to_nlattr = icmpv6_timeout_obj_to_nlattr,
	353	.nlattr_max = CTA_TIMEOUT_ICMP_MAX,
	354	.obj_size = sizeof(unsigned int),
	355	.nla_policy = icmpv6_timeout_nla_policy,
	356	},
	357	#endif /* CONFIG_NF_CT_NETLINK_TIMEOUT */
933a41e7 PM	358	#ifdef CONFIG_SYSCTL
	359	.ctl_table_header = &icmpv6_sysctl_header,
	360	.ctl_table = icmpv6_sysctl_table,
	361	#endif
9fb9cbb1	362	};