[mirror_ubuntu-bionic-kernel.git] / net / netfilter / ipset / ip_set_hash_ipport.c

/* Copyright (C) 2003-2011 Jozsef Kadlecsik <kadlec@blackhole.kfki.hu>
 *
 * 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.
 */

/* Kernel module implementing an IP set type: the hash:ip,port type */

#include <linux/jhash.h>
#include <linux/module.h>
#include <linux/ip.h>
#include <linux/skbuff.h>
#include <linux/errno.h>
#include <linux/random.h>
#include <net/ip.h>
#include <net/ipv6.h>
#include <net/netlink.h>
#include <net/tcp.h>

#include <linux/netfilter.h>
#include <linux/netfilter/ipset/pfxlen.h>
#include <linux/netfilter/ipset/ip_set.h>
#include <linux/netfilter/ipset/ip_set_timeout.h>
#include <linux/netfilter/ipset/ip_set_getport.h>
#include <linux/netfilter/ipset/ip_set_hash.h>

#define REVISION_MIN	0
#define REVISION_MAX	1 /* SCTP and UDPLITE support added */

MODULE_LICENSE("GPL");
MODULE_AUTHOR("Jozsef Kadlecsik <kadlec@blackhole.kfki.hu>");
IP_SET_MODULE_DESC("hash:ip,port", REVISION_MIN, REVISION_MAX);
MODULE_ALIAS("ip_set_hash:ip,port");

/* Type specific function prefix */
#define TYPE		hash_ipport

static bool
hash_ipport_same_set(const struct ip_set *a, const struct ip_set *b);

#define hash_ipport4_same_set	hash_ipport_same_set
#define hash_ipport6_same_set	hash_ipport_same_set

/* The type variant functions: IPv4 */

/* Member elements without timeout */
struct hash_ipport4_elem {
	__be32 ip;
	__be16 port;
	u8 proto;
	u8 padding;
};

/* Member elements with timeout support */
struct hash_ipport4_telem {
	__be32 ip;
	__be16 port;
	u8 proto;
	u8 padding;
	unsigned long timeout;
};

static inline bool
hash_ipport4_data_equal(const struct hash_ipport4_elem *ip1,
			const struct hash_ipport4_elem *ip2,
			u32 *multi)
{
	return ip1->ip == ip2->ip &&
	       ip1->port == ip2->port &&
	       ip1->proto == ip2->proto;
}

static inline bool
hash_ipport4_data_isnull(const struct hash_ipport4_elem *elem)
{
	return elem->proto == 0;
}

static inline void
hash_ipport4_data_copy(struct hash_ipport4_elem *dst,
		       const struct hash_ipport4_elem *src)
{
	dst->ip = src->ip;
	dst->port = src->port;
	dst->proto = src->proto;
}

static inline void
hash_ipport4_data_zero_out(struct hash_ipport4_elem *elem)
{
	elem->proto = 0;
}

static bool
hash_ipport4_data_list(struct sk_buff *skb,
		       const struct hash_ipport4_elem *data)
{
	if (nla_put_ipaddr4(skb, IPSET_ATTR_IP, data->ip) ||
	    nla_put_net16(skb, IPSET_ATTR_PORT, data->port) ||
	    nla_put_u8(skb, IPSET_ATTR_PROTO, data->proto))
		goto nla_put_failure;
	return 0;

nla_put_failure:
	return 1;
}

static bool
hash_ipport4_data_tlist(struct sk_buff *skb,
			const struct hash_ipport4_elem *data)
{
	const struct hash_ipport4_telem *tdata =
		(const struct hash_ipport4_telem *)data;

	if (nla_put_ipaddr4(skb, IPSET_ATTR_IP, tdata->ip) ||
	    nla_put_net16(skb, IPSET_ATTR_PORT, tdata->port) ||
	    nla_put_u8(skb, IPSET_ATTR_PROTO, data->proto) ||
	    nla_put_net32(skb, IPSET_ATTR_TIMEOUT,
			  htonl(ip_set_timeout_get(tdata->timeout))))
		goto nla_put_failure;
	return 0;

nla_put_failure:
	return 1;
}

#define PF		4
#define HOST_MASK	32
#include <linux/netfilter/ipset/ip_set_ahash.h>

static inline void
hash_ipport4_data_next(struct ip_set_hash *h,
		       const struct hash_ipport4_elem *d)
{
	h->next.ip = d->ip;
	h->next.port = d->port;
}

static int
hash_ipport4_kadt(struct ip_set *set, const struct sk_buff *skb,
		  const struct xt_action_param *par,
		  enum ipset_adt adt, const struct ip_set_adt_opt *opt)
{
	const struct ip_set_hash *h = set->data;
	ipset_adtfn adtfn = set->variant->adt[adt];
	struct hash_ipport4_elem data = { };

	if (!ip_set_get_ip4_port(skb, opt->flags & IPSET_DIM_TWO_SRC,
				 &data.port, &data.proto))
		return -EINVAL;

	ip4addrptr(skb, opt->flags & IPSET_DIM_ONE_SRC, &data.ip);

	return adtfn(set, &data, opt_timeout(opt, h), opt->cmdflags);
}

static int
hash_ipport4_uadt(struct ip_set *set, struct nlattr *tb[],
		  enum ipset_adt adt, u32 *lineno, u32 flags, bool retried)
{
	const struct ip_set_hash *h = set->data;
	ipset_adtfn adtfn = set->variant->adt[adt];
	struct hash_ipport4_elem data = { };
	u32 ip, ip_to, p = 0, port, port_to;
	u32 timeout = h->timeout;
	bool with_ports = false;
	int ret;

	if (unlikely(!tb[IPSET_ATTR_IP] ||
		     !ip_set_attr_netorder(tb, IPSET_ATTR_PORT) ||
		     !ip_set_optattr_netorder(tb, IPSET_ATTR_PORT_TO) ||
		     !ip_set_optattr_netorder(tb, IPSET_ATTR_TIMEOUT)))
		return -IPSET_ERR_PROTOCOL;

	if (tb[IPSET_ATTR_LINENO])
		*lineno = nla_get_u32(tb[IPSET_ATTR_LINENO]);

	ret = ip_set_get_ipaddr4(tb[IPSET_ATTR_IP], &data.ip);
	if (ret)
		return ret;

	if (tb[IPSET_ATTR_PORT])
		data.port = nla_get_be16(tb[IPSET_ATTR_PORT]);
	else
		return -IPSET_ERR_PROTOCOL;

	if (tb[IPSET_ATTR_PROTO]) {
		data.proto = nla_get_u8(tb[IPSET_ATTR_PROTO]);
		with_ports = ip_set_proto_with_ports(data.proto);

		if (data.proto == 0)
			return -IPSET_ERR_INVALID_PROTO;
	} else
		return -IPSET_ERR_MISSING_PROTO;

	if (!(with_ports || data.proto == IPPROTO_ICMP))
		data.port = 0;

	if (tb[IPSET_ATTR_TIMEOUT]) {
		if (!with_timeout(h->timeout))
			return -IPSET_ERR_TIMEOUT;
		timeout = ip_set_timeout_uget(tb[IPSET_ATTR_TIMEOUT]);
	}

	if (adt == IPSET_TEST ||
	    !(tb[IPSET_ATTR_IP_TO] || tb[IPSET_ATTR_CIDR] ||
	      tb[IPSET_ATTR_PORT_TO])) {
		ret = adtfn(set, &data, timeout, flags);
		return ip_set_eexist(ret, flags) ? 0 : ret;
	}

	ip_to = ip = ntohl(data.ip);
	if (tb[IPSET_ATTR_IP_TO]) {
		ret = ip_set_get_hostipaddr4(tb[IPSET_ATTR_IP_TO], &ip_to);
		if (ret)
			return ret;
		if (ip > ip_to)
			swap(ip, ip_to);
	} else if (tb[IPSET_ATTR_CIDR]) {
		u8 cidr = nla_get_u8(tb[IPSET_ATTR_CIDR]);

		if (!cidr || cidr > 32)
			return -IPSET_ERR_INVALID_CIDR;
		ip_set_mask_from_to(ip, ip_to, cidr);
	}

	port_to = port = ntohs(data.port);
	if (with_ports && tb[IPSET_ATTR_PORT_TO]) {
		port_to = ip_set_get_h16(tb[IPSET_ATTR_PORT_TO]);
		if (port > port_to)
			swap(port, port_to);
	}

	if (retried)
		ip = ntohl(h->next.ip);
	for (; !before(ip_to, ip); ip++) {
		p = retried && ip == ntohl(h->next.ip) ? ntohs(h->next.port)
						       : port;
		for (; p <= port_to; p++) {
			data.ip = htonl(ip);
			data.port = htons(p);
			ret = adtfn(set, &data, timeout, flags);

			if (ret && !ip_set_eexist(ret, flags))
				return ret;
			else
				ret = 0;
		}
	}
	return ret;
}

static bool
hash_ipport_same_set(const struct ip_set *a, const struct ip_set *b)
{
	const struct ip_set_hash *x = a->data;
	const struct ip_set_hash *y = b->data;

	/* Resizing changes htable_bits, so we ignore it */
	return x->maxelem == y->maxelem &&
	       x->timeout == y->timeout;
}

/* The type variant functions: IPv6 */

struct hash_ipport6_elem {
	union nf_inet_addr ip;
	__be16 port;
	u8 proto;
	u8 padding;
};

struct hash_ipport6_telem {
	union nf_inet_addr ip;
	__be16 port;
	u8 proto;
	u8 padding;
	unsigned long timeout;
};

static inline bool
hash_ipport6_data_equal(const struct hash_ipport6_elem *ip1,
			const struct hash_ipport6_elem *ip2,
			u32 *multi)
{
	return ipv6_addr_equal(&ip1->ip.in6, &ip2->ip.in6) &&
	       ip1->port == ip2->port &&
	       ip1->proto == ip2->proto;
}

static inline bool
hash_ipport6_data_isnull(const struct hash_ipport6_elem *elem)
{
	return elem->proto == 0;
}

static inline void
hash_ipport6_data_copy(struct hash_ipport6_elem *dst,
		       const struct hash_ipport6_elem *src)
{
	memcpy(dst, src, sizeof(*dst));
}

static inline void
hash_ipport6_data_zero_out(struct hash_ipport6_elem *elem)
{
	elem->proto = 0;
}

static bool
hash_ipport6_data_list(struct sk_buff *skb,
		       const struct hash_ipport6_elem *data)
{
	if (nla_put_ipaddr6(skb, IPSET_ATTR_IP, &data->ip.in6) ||
	    nla_put_net16(skb, IPSET_ATTR_PORT, data->port) ||
	    nla_put_u8(skb, IPSET_ATTR_PROTO, data->proto))
		goto nla_put_failure;
	return 0;

nla_put_failure:
	return 1;
}

static bool
hash_ipport6_data_tlist(struct sk_buff *skb,
			const struct hash_ipport6_elem *data)
{
	const struct hash_ipport6_telem *e =
		(const struct hash_ipport6_telem *)data;

	if (nla_put_ipaddr6(skb, IPSET_ATTR_IP, &e->ip.in6) ||
	    nla_put_net16(skb, IPSET_ATTR_PORT, data->port) ||
	    nla_put_u8(skb, IPSET_ATTR_PROTO, data->proto) ||
	    nla_put_net32(skb, IPSET_ATTR_TIMEOUT,
			  htonl(ip_set_timeout_get(e->timeout))))
		goto nla_put_failure;
	return 0;

nla_put_failure:
	return 1;
}

#undef PF
#undef HOST_MASK

#define PF		6
#define HOST_MASK	128
#include <linux/netfilter/ipset/ip_set_ahash.h>

static inline void
hash_ipport6_data_next(struct ip_set_hash *h,
		       const struct hash_ipport6_elem *d)
{
	h->next.port = d->port;
}

static int
hash_ipport6_kadt(struct ip_set *set, const struct sk_buff *skb,
		  const struct xt_action_param *par,
		  enum ipset_adt adt, const struct ip_set_adt_opt *opt)
{
	const struct ip_set_hash *h = set->data;
	ipset_adtfn adtfn = set->variant->adt[adt];
	struct hash_ipport6_elem data = { };

	if (!ip_set_get_ip6_port(skb, opt->flags & IPSET_DIM_TWO_SRC,
				 &data.port, &data.proto))
		return -EINVAL;

	ip6addrptr(skb, opt->flags & IPSET_DIM_ONE_SRC, &data.ip.in6);

	return adtfn(set, &data, opt_timeout(opt, h), opt->cmdflags);
}

static int
hash_ipport6_uadt(struct ip_set *set, struct nlattr *tb[],
		  enum ipset_adt adt, u32 *lineno, u32 flags, bool retried)
{
	const struct ip_set_hash *h = set->data;
	ipset_adtfn adtfn = set->variant->adt[adt];
	struct hash_ipport6_elem data = { };
	u32 port, port_to;
	u32 timeout = h->timeout;
	bool with_ports = false;
	int ret;

	if (unlikely(!tb[IPSET_ATTR_IP] ||
		     !ip_set_attr_netorder(tb, IPSET_ATTR_PORT) ||
		     !ip_set_optattr_netorder(tb, IPSET_ATTR_PORT_TO) ||
		     !ip_set_optattr_netorder(tb, IPSET_ATTR_TIMEOUT) ||
		     tb[IPSET_ATTR_IP_TO] ||
		     tb[IPSET_ATTR_CIDR]))
		return -IPSET_ERR_PROTOCOL;

	if (tb[IPSET_ATTR_LINENO])
		*lineno = nla_get_u32(tb[IPSET_ATTR_LINENO]);

	ret = ip_set_get_ipaddr6(tb[IPSET_ATTR_IP], &data.ip);
	if (ret)
		return ret;

	if (tb[IPSET_ATTR_PORT])
		data.port = nla_get_be16(tb[IPSET_ATTR_PORT]);
	else
		return -IPSET_ERR_PROTOCOL;

	if (tb[IPSET_ATTR_PROTO]) {
		data.proto = nla_get_u8(tb[IPSET_ATTR_PROTO]);
		with_ports = ip_set_proto_with_ports(data.proto);

		if (data.proto == 0)
			return -IPSET_ERR_INVALID_PROTO;
	} else
		return -IPSET_ERR_MISSING_PROTO;

	if (!(with_ports || data.proto == IPPROTO_ICMPV6))
		data.port = 0;

	if (tb[IPSET_ATTR_TIMEOUT]) {
		if (!with_timeout(h->timeout))
			return -IPSET_ERR_TIMEOUT;
		timeout = ip_set_timeout_uget(tb[IPSET_ATTR_TIMEOUT]);
	}

	if (adt == IPSET_TEST || !with_ports || !tb[IPSET_ATTR_PORT_TO]) {
		ret = adtfn(set, &data, timeout, flags);
		return ip_set_eexist(ret, flags) ? 0 : ret;
	}

	port = ntohs(data.port);
	port_to = ip_set_get_h16(tb[IPSET_ATTR_PORT_TO]);
	if (port > port_to)
		swap(port, port_to);

	if (retried)
		port = ntohs(h->next.port);
	for (; port <= port_to; port++) {
		data.port = htons(port);
		ret = adtfn(set, &data, timeout, flags);

		if (ret && !ip_set_eexist(ret, flags))
			return ret;
		else
			ret = 0;
	}
	return ret;
}

/* Create hash:ip type of sets */

static int
hash_ipport_create(struct ip_set *set, struct nlattr *tb[], u32 flags)
{
	struct ip_set_hash *h;
	u32 hashsize = IPSET_DEFAULT_HASHSIZE, maxelem = IPSET_DEFAULT_MAXELEM;
	u8 hbits;
	size_t hsize;

	if (!(set->family == NFPROTO_IPV4 || set->family == NFPROTO_IPV6))
		return -IPSET_ERR_INVALID_FAMILY;

	if (unlikely(!ip_set_optattr_netorder(tb, IPSET_ATTR_HASHSIZE) ||
		     !ip_set_optattr_netorder(tb, IPSET_ATTR_MAXELEM) ||
		     !ip_set_optattr_netorder(tb, IPSET_ATTR_TIMEOUT)))
		return -IPSET_ERR_PROTOCOL;

	if (tb[IPSET_ATTR_HASHSIZE]) {
		hashsize = ip_set_get_h32(tb[IPSET_ATTR_HASHSIZE]);
		if (hashsize < IPSET_MIMINAL_HASHSIZE)
			hashsize = IPSET_MIMINAL_HASHSIZE;
	}

	if (tb[IPSET_ATTR_MAXELEM])
		maxelem = ip_set_get_h32(tb[IPSET_ATTR_MAXELEM]);

	h = kzalloc(sizeof(*h), GFP_KERNEL);
	if (!h)
		return -ENOMEM;

	h->maxelem = maxelem;
	get_random_bytes(&h->initval, sizeof(h->initval));
	h->timeout = IPSET_NO_TIMEOUT;

	hbits = htable_bits(hashsize);
	hsize = htable_size(hbits);
	if (hsize == 0) {
		kfree(h);
		return -ENOMEM;
	}
	h->table = ip_set_alloc(hsize);
	if (!h->table) {
		kfree(h);
		return -ENOMEM;
	}
	h->table->htable_bits = hbits;

	set->data = h;

	if (tb[IPSET_ATTR_TIMEOUT]) {
		h->timeout = ip_set_timeout_uget(tb[IPSET_ATTR_TIMEOUT]);

		set->variant = set->family == NFPROTO_IPV4
			? &hash_ipport4_tvariant : &hash_ipport6_tvariant;

		if (set->family == NFPROTO_IPV4)
			hash_ipport4_gc_init(set);
		else
			hash_ipport6_gc_init(set);
	} else {
		set->variant = set->family == NFPROTO_IPV4
			? &hash_ipport4_variant : &hash_ipport6_variant;
	}

	pr_debug("create %s hashsize %u (%u) maxelem %u: %p(%p)\n",
		 set->name, jhash_size(h->table->htable_bits),
		 h->table->htable_bits, h->maxelem, set->data, h->table);

	return 0;
}

static struct ip_set_type hash_ipport_type __read_mostly = {
	.name		= "hash:ip,port",
	.protocol	= IPSET_PROTOCOL,
	.features	= IPSET_TYPE_IP | IPSET_TYPE_PORT,
	.dimension	= IPSET_DIM_TWO,
	.family		= NFPROTO_UNSPEC,
	.revision_min	= REVISION_MIN,
	.revision_max	= REVISION_MAX,
	.create		= hash_ipport_create,
	.create_policy	= {
		[IPSET_ATTR_HASHSIZE]	= { .type = NLA_U32 },
		[IPSET_ATTR_MAXELEM]	= { .type = NLA_U32 },
		[IPSET_ATTR_PROBES]	= { .type = NLA_U8 },
		[IPSET_ATTR_RESIZE]	= { .type = NLA_U8  },
		[IPSET_ATTR_PROTO]	= { .type = NLA_U8 },
		[IPSET_ATTR_TIMEOUT]	= { .type = NLA_U32 },
	},
	.adt_policy	= {
		[IPSET_ATTR_IP]		= { .type = NLA_NESTED },
		[IPSET_ATTR_IP_TO]	= { .type = NLA_NESTED },
		[IPSET_ATTR_PORT]	= { .type = NLA_U16 },
		[IPSET_ATTR_PORT_TO]	= { .type = NLA_U16 },
		[IPSET_ATTR_CIDR]	= { .type = NLA_U8 },
		[IPSET_ATTR_PROTO]	= { .type = NLA_U8 },
		[IPSET_ATTR_TIMEOUT]	= { .type = NLA_U32 },
		[IPSET_ATTR_LINENO]	= { .type = NLA_U32 },
	},
	.me		= THIS_MODULE,
};

static int __init
hash_ipport_init(void)
{
	return ip_set_type_register(&hash_ipport_type);
}

static void __exit
hash_ipport_fini(void)
{
	ip_set_type_unregister(&hash_ipport_type);
}

module_init(hash_ipport_init);
module_exit(hash_ipport_fini);
Commit	Line	Data
07896ed3 JK	1	/* Copyright (C) 2003-2011 Jozsef Kadlecsik <kadlec@blackhole.kfki.hu>
	2	*
	3	* This program is free software; you can redistribute it and/or modify
	4	* it under the terms of the GNU General Public License version 2 as
	5	* published by the Free Software Foundation.
	6	*/
	7
	8	/* Kernel module implementing an IP set type: the hash:ip,port type */
	9
	10	#include <linux/jhash.h>
	11	#include <linux/module.h>
	12	#include <linux/ip.h>
	13	#include <linux/skbuff.h>
	14	#include <linux/errno.h>
07896ed3 JK	15	#include <linux/random.h>
	16	#include <net/ip.h>
	17	#include <net/ipv6.h>
	18	#include <net/netlink.h>
	19	#include <net/tcp.h>
	20
	21	#include <linux/netfilter.h>
	22	#include <linux/netfilter/ipset/pfxlen.h>
	23	#include <linux/netfilter/ipset/ip_set.h>
	24	#include <linux/netfilter/ipset/ip_set_timeout.h>
	25	#include <linux/netfilter/ipset/ip_set_getport.h>
	26	#include <linux/netfilter/ipset/ip_set_hash.h>
	27
10111a6e JK	28	#define REVISION_MIN 0
	29	#define REVISION_MAX 1 /* SCTP and UDPLITE support added */
	30
07896ed3 JK	31	MODULE_LICENSE("GPL");
07896ed3 JK	32	MODULE_AUTHOR("Jozsef Kadlecsik <kadlec@blackhole.kfki.hu>");
10111a6e	33	IP_SET_MODULE_DESC("hash:ip,port", REVISION_MIN, REVISION_MAX);
07896ed3 JK	34	MODULE_ALIAS("ip_set_hash:ip,port");
	35
	36	/* Type specific function prefix */
	37	#define TYPE hash_ipport
	38
	39	static bool
	40	hash_ipport_same_set(const struct ip_set a, const struct ip_set b);
	41
	42	#define hash_ipport4_same_set hash_ipport_same_set
	43	#define hash_ipport6_same_set hash_ipport_same_set
	44
	45	/* The type variant functions: IPv4 */
	46
	47	/* Member elements without timeout */
	48	struct hash_ipport4_elem {
	49	__be32 ip;
	50	__be16 port;
	51	u8 proto;
	52	u8 padding;
	53	};
	54
	55	/* Member elements with timeout support */
	56	struct hash_ipport4_telem {
	57	__be32 ip;
	58	__be16 port;
	59	u8 proto;
	60	u8 padding;
	61	unsigned long timeout;
	62	};
	63
	64	static inline bool
	65	hash_ipport4_data_equal(const struct hash_ipport4_elem *ip1,
89dc79b7 JK	66	const struct hash_ipport4_elem *ip2,
89dc79b7 JK	67	u32 *multi)
07896ed3 JK	68	{
	69	return ip1->ip == ip2->ip &&
	70	ip1->port == ip2->port &&
	71	ip1->proto == ip2->proto;
	72	}
	73
	74	static inline bool
	75	hash_ipport4_data_isnull(const struct hash_ipport4_elem *elem)
	76	{
	77	return elem->proto == 0;
	78	}
	79
	80	static inline void
	81	hash_ipport4_data_copy(struct hash_ipport4_elem *dst,
	82	const struct hash_ipport4_elem *src)
	83	{
	84	dst->ip = src->ip;
	85	dst->port = src->port;
	86	dst->proto = src->proto;
	87	}
	88
	89	static inline void
	90	hash_ipport4_data_zero_out(struct hash_ipport4_elem *elem)
	91	{
	92	elem->proto = 0;
	93	}
	94
	95	static bool
	96	hash_ipport4_data_list(struct sk_buff *skb,
	97	const struct hash_ipport4_elem *data)
	98	{
7cf7899d DM	99	if (nla_put_ipaddr4(skb, IPSET_ATTR_IP, data->ip) \|\|
	100	nla_put_net16(skb, IPSET_ATTR_PORT, data->port) \|\|
	101	nla_put_u8(skb, IPSET_ATTR_PROTO, data->proto))
	102	goto nla_put_failure;
07896ed3 JK	103	return 0;
	104
	105	nla_put_failure:
	106	return 1;
	107	}
	108
	109	static bool
	110	hash_ipport4_data_tlist(struct sk_buff *skb,
	111	const struct hash_ipport4_elem *data)
	112	{
	113	const struct hash_ipport4_telem *tdata =
	114	(const struct hash_ipport4_telem *)data;
	115
7cf7899d DM	116	if (nla_put_ipaddr4(skb, IPSET_ATTR_IP, tdata->ip) \|\|
	117	nla_put_net16(skb, IPSET_ATTR_PORT, tdata->port) \|\|
	118	nla_put_u8(skb, IPSET_ATTR_PROTO, data->proto) \|\|
	119	nla_put_net32(skb, IPSET_ATTR_TIMEOUT,
	120	htonl(ip_set_timeout_get(tdata->timeout))))
	121	goto nla_put_failure;
07896ed3 JK	122	return 0;
	123
	124	nla_put_failure:
	125	return 1;
	126	}
	127
	128	#define PF 4
	129	#define HOST_MASK 32
	130	#include <linux/netfilter/ipset/ip_set_ahash.h>
	131
3d14b171 JK	132	static inline void
	133	hash_ipport4_data_next(struct ip_set_hash *h,
	134	const struct hash_ipport4_elem *d)
	135	{
6e27c9b4 JK	136	h->next.ip = d->ip;
6e27c9b4 JK	137	h->next.port = d->port;
3d14b171 JK	138	}
3d14b171 JK	139
07896ed3 JK	140	static int
07896ed3 JK	141	hash_ipport4_kadt(struct ip_set set, const struct sk_buff skb,
b66554cf	142	const struct xt_action_param *par,
ac8cc925	143	enum ipset_adt adt, const struct ip_set_adt_opt *opt)
07896ed3 JK	144	{
	145	const struct ip_set_hash *h = set->data;
	146	ipset_adtfn adtfn = set->variant->adt[adt];
	147	struct hash_ipport4_elem data = { };
	148
ac8cc925	149	if (!ip_set_get_ip4_port(skb, opt->flags & IPSET_DIM_TWO_SRC,
07896ed3 JK	150	&data.port, &data.proto))
	151	return -EINVAL;
	152
ac8cc925	153	ip4addrptr(skb, opt->flags & IPSET_DIM_ONE_SRC, &data.ip);
07896ed3	154
ac8cc925	155	return adtfn(set, &data, opt_timeout(opt, h), opt->cmdflags);
07896ed3 JK	156	}
	157
	158	static int
	159	hash_ipport4_uadt(struct ip_set set, struct nlattr tb[],
3d14b171	160	enum ipset_adt adt, u32 *lineno, u32 flags, bool retried)
07896ed3 JK	161	{
	162	const struct ip_set_hash *h = set->data;
	163	ipset_adtfn adtfn = set->variant->adt[adt];
	164	struct hash_ipport4_elem data = { };
4fe198e6	165	u32 ip, ip_to, p = 0, port, port_to;
07896ed3	166	u32 timeout = h->timeout;
5e0c1eb7	167	bool with_ports = false;
07896ed3 JK	168	int ret;
	169
	170	if (unlikely(!tb[IPSET_ATTR_IP] \|\|
	171	!ip_set_attr_netorder(tb, IPSET_ATTR_PORT) \|\|
	172	!ip_set_optattr_netorder(tb, IPSET_ATTR_PORT_TO) \|\|
	173	!ip_set_optattr_netorder(tb, IPSET_ATTR_TIMEOUT)))
	174	return -IPSET_ERR_PROTOCOL;
	175
	176	if (tb[IPSET_ATTR_LINENO])
	177	*lineno = nla_get_u32(tb[IPSET_ATTR_LINENO]);
	178
	179	ret = ip_set_get_ipaddr4(tb[IPSET_ATTR_IP], &data.ip);
	180	if (ret)
	181	return ret;
	182
	183	if (tb[IPSET_ATTR_PORT])
	184	data.port = nla_get_be16(tb[IPSET_ATTR_PORT]);
	185	else
	186	return -IPSET_ERR_PROTOCOL;
	187
	188	if (tb[IPSET_ATTR_PROTO]) {
	189	data.proto = nla_get_u8(tb[IPSET_ATTR_PROTO]);
5e0c1eb7	190	with_ports = ip_set_proto_with_ports(data.proto);
07896ed3 JK	191
	192	if (data.proto == 0)
	193	return -IPSET_ERR_INVALID_PROTO;
	194	} else
	195	return -IPSET_ERR_MISSING_PROTO;
	196
5e0c1eb7	197	if (!(with_ports \|\| data.proto == IPPROTO_ICMP))
07896ed3	198	data.port = 0;
07896ed3 JK	199
	200	if (tb[IPSET_ATTR_TIMEOUT]) {
	201	if (!with_timeout(h->timeout))
	202	return -IPSET_ERR_TIMEOUT;
	203	timeout = ip_set_timeout_uget(tb[IPSET_ATTR_TIMEOUT]);
	204	}
	205
	206	if (adt == IPSET_TEST \|\|
07896ed3 JK	207	!(tb[IPSET_ATTR_IP_TO] \|\| tb[IPSET_ATTR_CIDR] \|\|
07896ed3 JK	208	tb[IPSET_ATTR_PORT_TO])) {
5416219e	209	ret = adtfn(set, &data, timeout, flags);
07896ed3 JK	210	return ip_set_eexist(ret, flags) ? 0 : ret;
	211	}
	212
4fe198e6	213	ip_to = ip = ntohl(data.ip);
07896ed3 JK	214	if (tb[IPSET_ATTR_IP_TO]) {
	215	ret = ip_set_get_hostipaddr4(tb[IPSET_ATTR_IP_TO], &ip_to);
	216	if (ret)
	217	return ret;
	218	if (ip > ip_to)
	219	swap(ip, ip_to);
	220	} else if (tb[IPSET_ATTR_CIDR]) {
	221	u8 cidr = nla_get_u8(tb[IPSET_ATTR_CIDR]);
	222
b9fed748	223	if (!cidr \|\| cidr > 32)
07896ed3	224	return -IPSET_ERR_INVALID_CIDR;
e6146e86	225	ip_set_mask_from_to(ip, ip_to, cidr);
4fe198e6	226	}
07896ed3	227
5e0c1eb7 JK	228	port_to = port = ntohs(data.port);
5e0c1eb7 JK	229	if (with_ports && tb[IPSET_ATTR_PORT_TO]) {
07896ed3 JK	230	port_to = ip_set_get_h16(tb[IPSET_ATTR_PORT_TO]);
	231	if (port > port_to)
	232	swap(port, port_to);
5e0c1eb7	233	}
07896ed3	234
3d14b171	235	if (retried)
6e27c9b4	236	ip = ntohl(h->next.ip);
3d14b171	237	for (; !before(ip_to, ip); ip++) {
6e27c9b4 JK	238	p = retried && ip == ntohl(h->next.ip) ? ntohs(h->next.port)
6e27c9b4 JK	239	: port;
3d14b171	240	for (; p <= port_to; p++) {
07896ed3 JK	241	data.ip = htonl(ip);
07896ed3 JK	242	data.port = htons(p);
5416219e	243	ret = adtfn(set, &data, timeout, flags);
07896ed3 JK	244
	245	if (ret && !ip_set_eexist(ret, flags))
	246	return ret;
	247	else
	248	ret = 0;
	249	}
3d14b171	250	}
07896ed3 JK	251	return ret;
	252	}
	253
	254	static bool
	255	hash_ipport_same_set(const struct ip_set a, const struct ip_set b)
	256	{
	257	const struct ip_set_hash *x = a->data;
	258	const struct ip_set_hash *y = b->data;
	259
	260	/* Resizing changes htable_bits, so we ignore it */
	261	return x->maxelem == y->maxelem &&
	262	x->timeout == y->timeout;
	263	}
	264
	265	/* The type variant functions: IPv6 */
	266
	267	struct hash_ipport6_elem {
	268	union nf_inet_addr ip;
	269	__be16 port;
	270	u8 proto;
	271	u8 padding;
	272	};
	273
	274	struct hash_ipport6_telem {
	275	union nf_inet_addr ip;
	276	__be16 port;
	277	u8 proto;
	278	u8 padding;
	279	unsigned long timeout;
	280	};
	281
	282	static inline bool
	283	hash_ipport6_data_equal(const struct hash_ipport6_elem *ip1,
89dc79b7 JK	284	const struct hash_ipport6_elem *ip2,
89dc79b7 JK	285	u32 *multi)
07896ed3	286	{
29e3b160	287	return ipv6_addr_equal(&ip1->ip.in6, &ip2->ip.in6) &&
07896ed3 JK	288	ip1->port == ip2->port &&
	289	ip1->proto == ip2->proto;
	290	}
	291
	292	static inline bool
	293	hash_ipport6_data_isnull(const struct hash_ipport6_elem *elem)
	294	{
	295	return elem->proto == 0;
	296	}
	297
	298	static inline void
	299	hash_ipport6_data_copy(struct hash_ipport6_elem *dst,
	300	const struct hash_ipport6_elem *src)
	301	{
	302	memcpy(dst, src, sizeof(*dst));
	303	}
	304
	305	static inline void
	306	hash_ipport6_data_zero_out(struct hash_ipport6_elem *elem)
	307	{
	308	elem->proto = 0;
	309	}
	310
	311	static bool
	312	hash_ipport6_data_list(struct sk_buff *skb,
	313	const struct hash_ipport6_elem *data)
	314	{
7cf7899d DM	315	if (nla_put_ipaddr6(skb, IPSET_ATTR_IP, &data->ip.in6) \|\|
	316	nla_put_net16(skb, IPSET_ATTR_PORT, data->port) \|\|
	317	nla_put_u8(skb, IPSET_ATTR_PROTO, data->proto))
	318	goto nla_put_failure;
07896ed3 JK	319	return 0;
	320
	321	nla_put_failure:
	322	return 1;
	323	}
	324
	325	static bool
	326	hash_ipport6_data_tlist(struct sk_buff *skb,
	327	const struct hash_ipport6_elem *data)
	328	{
	329	const struct hash_ipport6_telem *e =
	330	(const struct hash_ipport6_telem *)data;
	331
7cf7899d DM	332	if (nla_put_ipaddr6(skb, IPSET_ATTR_IP, &e->ip.in6) \|\|
	333	nla_put_net16(skb, IPSET_ATTR_PORT, data->port) \|\|
	334	nla_put_u8(skb, IPSET_ATTR_PROTO, data->proto) \|\|
	335	nla_put_net32(skb, IPSET_ATTR_TIMEOUT,
	336	htonl(ip_set_timeout_get(e->timeout))))
	337	goto nla_put_failure;
07896ed3 JK	338	return 0;
	339
	340	nla_put_failure:
	341	return 1;
	342	}
	343
	344	#undef PF
	345	#undef HOST_MASK
	346
	347	#define PF 6
	348	#define HOST_MASK 128
	349	#include <linux/netfilter/ipset/ip_set_ahash.h>
	350
3d14b171 JK	351	static inline void
	352	hash_ipport6_data_next(struct ip_set_hash *h,
	353	const struct hash_ipport6_elem *d)
	354	{
6e27c9b4	355	h->next.port = d->port;
3d14b171 JK	356	}
3d14b171 JK	357
07896ed3 JK	358	static int
07896ed3 JK	359	hash_ipport6_kadt(struct ip_set set, const struct sk_buff skb,
b66554cf	360	const struct xt_action_param *par,
ac8cc925	361	enum ipset_adt adt, const struct ip_set_adt_opt *opt)
07896ed3 JK	362	{
	363	const struct ip_set_hash *h = set->data;
	364	ipset_adtfn adtfn = set->variant->adt[adt];
	365	struct hash_ipport6_elem data = { };
	366
ac8cc925	367	if (!ip_set_get_ip6_port(skb, opt->flags & IPSET_DIM_TWO_SRC,
07896ed3 JK	368	&data.port, &data.proto))
	369	return -EINVAL;
	370
ac8cc925	371	ip6addrptr(skb, opt->flags & IPSET_DIM_ONE_SRC, &data.ip.in6);
07896ed3	372
ac8cc925	373	return adtfn(set, &data, opt_timeout(opt, h), opt->cmdflags);
07896ed3 JK	374	}
	375
	376	static int
	377	hash_ipport6_uadt(struct ip_set set, struct nlattr tb[],
3d14b171	378	enum ipset_adt adt, u32 *lineno, u32 flags, bool retried)
07896ed3 JK	379	{
	380	const struct ip_set_hash *h = set->data;
	381	ipset_adtfn adtfn = set->variant->adt[adt];
	382	struct hash_ipport6_elem data = { };
	383	u32 port, port_to;
	384	u32 timeout = h->timeout;
5e0c1eb7	385	bool with_ports = false;
07896ed3 JK	386	int ret;
	387
	388	if (unlikely(!tb[IPSET_ATTR_IP] \|\|
	389	!ip_set_attr_netorder(tb, IPSET_ATTR_PORT) \|\|
	390	!ip_set_optattr_netorder(tb, IPSET_ATTR_PORT_TO) \|\|
	391	!ip_set_optattr_netorder(tb, IPSET_ATTR_TIMEOUT) \|\|
	392	tb[IPSET_ATTR_IP_TO] \|\|
	393	tb[IPSET_ATTR_CIDR]))
	394	return -IPSET_ERR_PROTOCOL;
	395
	396	if (tb[IPSET_ATTR_LINENO])
	397	*lineno = nla_get_u32(tb[IPSET_ATTR_LINENO]);
	398
	399	ret = ip_set_get_ipaddr6(tb[IPSET_ATTR_IP], &data.ip);
	400	if (ret)
	401	return ret;
	402
	403	if (tb[IPSET_ATTR_PORT])
	404	data.port = nla_get_be16(tb[IPSET_ATTR_PORT]);
	405	else
	406	return -IPSET_ERR_PROTOCOL;
	407
	408	if (tb[IPSET_ATTR_PROTO]) {
	409	data.proto = nla_get_u8(tb[IPSET_ATTR_PROTO]);
5e0c1eb7	410	with_ports = ip_set_proto_with_ports(data.proto);
07896ed3 JK	411
	412	if (data.proto == 0)
	413	return -IPSET_ERR_INVALID_PROTO;
	414	} else
	415	return -IPSET_ERR_MISSING_PROTO;
	416
5e0c1eb7	417	if (!(with_ports \|\| data.proto == IPPROTO_ICMPV6))
07896ed3	418	data.port = 0;
07896ed3 JK	419
	420	if (tb[IPSET_ATTR_TIMEOUT]) {
	421	if (!with_timeout(h->timeout))
	422	return -IPSET_ERR_TIMEOUT;
	423	timeout = ip_set_timeout_uget(tb[IPSET_ATTR_TIMEOUT]);
	424	}
	425
5e0c1eb7	426	if (adt == IPSET_TEST \|\| !with_ports \|\| !tb[IPSET_ATTR_PORT_TO]) {
5416219e	427	ret = adtfn(set, &data, timeout, flags);
07896ed3 JK	428	return ip_set_eexist(ret, flags) ? 0 : ret;
	429	}
	430
	431	port = ntohs(data.port);
	432	port_to = ip_set_get_h16(tb[IPSET_ATTR_PORT_TO]);
	433	if (port > port_to)
	434	swap(port, port_to);
	435
3d14b171	436	if (retried)
6e27c9b4	437	port = ntohs(h->next.port);
07896ed3 JK	438	for (; port <= port_to; port++) {
07896ed3 JK	439	data.port = htons(port);
5416219e	440	ret = adtfn(set, &data, timeout, flags);
07896ed3 JK	441
	442	if (ret && !ip_set_eexist(ret, flags))
	443	return ret;
	444	else
	445	ret = 0;
	446	}
	447	return ret;
	448	}
	449
	450	/* Create hash:ip type of sets */
	451
	452	static int
	453	hash_ipport_create(struct ip_set set, struct nlattr tb[], u32 flags)
	454	{
	455	struct ip_set_hash *h;
	456	u32 hashsize = IPSET_DEFAULT_HASHSIZE, maxelem = IPSET_DEFAULT_MAXELEM;
	457	u8 hbits;
26a5d3cc	458	size_t hsize;
07896ed3	459
c15f1c83	460	if (!(set->family == NFPROTO_IPV4 \|\| set->family == NFPROTO_IPV6))
07896ed3 JK	461	return -IPSET_ERR_INVALID_FAMILY;
	462
	463	if (unlikely(!ip_set_optattr_netorder(tb, IPSET_ATTR_HASHSIZE) \|\|
	464	!ip_set_optattr_netorder(tb, IPSET_ATTR_MAXELEM) \|\|
	465	!ip_set_optattr_netorder(tb, IPSET_ATTR_TIMEOUT)))
	466	return -IPSET_ERR_PROTOCOL;
	467
	468	if (tb[IPSET_ATTR_HASHSIZE]) {
	469	hashsize = ip_set_get_h32(tb[IPSET_ATTR_HASHSIZE]);
	470	if (hashsize < IPSET_MIMINAL_HASHSIZE)
	471	hashsize = IPSET_MIMINAL_HASHSIZE;
	472	}
	473
	474	if (tb[IPSET_ATTR_MAXELEM])
	475	maxelem = ip_set_get_h32(tb[IPSET_ATTR_MAXELEM]);
	476
	477	h = kzalloc(sizeof(*h), GFP_KERNEL);
	478	if (!h)
	479	return -ENOMEM;
	480
	481	h->maxelem = maxelem;
	482	get_random_bytes(&h->initval, sizeof(h->initval));
	483	h->timeout = IPSET_NO_TIMEOUT;
	484
	485	hbits = htable_bits(hashsize);
26a5d3cc JK	486	hsize = htable_size(hbits);
	487	if (hsize == 0) {
	488	kfree(h);
	489	return -ENOMEM;
	490	}
	491	h->table = ip_set_alloc(hsize);
07896ed3 JK	492	if (!h->table) {
	493	kfree(h);
	494	return -ENOMEM;
	495	}
	496	h->table->htable_bits = hbits;
	497
	498	set->data = h;
	499
	500	if (tb[IPSET_ATTR_TIMEOUT]) {
	501	h->timeout = ip_set_timeout_uget(tb[IPSET_ATTR_TIMEOUT]);
	502
c15f1c83	503	set->variant = set->family == NFPROTO_IPV4
07896ed3 JK	504	? &hash_ipport4_tvariant : &hash_ipport6_tvariant;
07896ed3 JK	505
c15f1c83	506	if (set->family == NFPROTO_IPV4)
07896ed3 JK	507	hash_ipport4_gc_init(set);
	508	else
	509	hash_ipport6_gc_init(set);
	510	} else {
c15f1c83	511	set->variant = set->family == NFPROTO_IPV4
07896ed3 JK	512	? &hash_ipport4_variant : &hash_ipport6_variant;
	513	}
	514
	515	pr_debug("create %s hashsize %u (%u) maxelem %u: %p(%p)\n",
	516	set->name, jhash_size(h->table->htable_bits),
	517	h->table->htable_bits, h->maxelem, set->data, h->table);
	518
	519	return 0;
	520	}
	521
	522	static struct ip_set_type hash_ipport_type __read_mostly = {
	523	.name = "hash:ip,port",
	524	.protocol = IPSET_PROTOCOL,
	525	.features = IPSET_TYPE_IP \| IPSET_TYPE_PORT,
	526	.dimension = IPSET_DIM_TWO,
c15f1c83	527	.family = NFPROTO_UNSPEC,
10111a6e JK	528	.revision_min = REVISION_MIN,
10111a6e JK	529	.revision_max = REVISION_MAX,
07896ed3 JK	530	.create = hash_ipport_create,
	531	.create_policy = {
	532	[IPSET_ATTR_HASHSIZE] = { .type = NLA_U32 },
	533	[IPSET_ATTR_MAXELEM] = { .type = NLA_U32 },
	534	[IPSET_ATTR_PROBES] = { .type = NLA_U8 },
	535	[IPSET_ATTR_RESIZE] = { .type = NLA_U8 },
	536	[IPSET_ATTR_PROTO] = { .type = NLA_U8 },
	537	[IPSET_ATTR_TIMEOUT] = { .type = NLA_U32 },
	538	},
	539	.adt_policy = {
	540	[IPSET_ATTR_IP] = { .type = NLA_NESTED },
	541	[IPSET_ATTR_IP_TO] = { .type = NLA_NESTED },
	542	[IPSET_ATTR_PORT] = { .type = NLA_U16 },
	543	[IPSET_ATTR_PORT_TO] = { .type = NLA_U16 },
	544	[IPSET_ATTR_CIDR] = { .type = NLA_U8 },
	545	[IPSET_ATTR_PROTO] = { .type = NLA_U8 },
	546	[IPSET_ATTR_TIMEOUT] = { .type = NLA_U32 },
	547	[IPSET_ATTR_LINENO] = { .type = NLA_U32 },
	548	},
	549	.me = THIS_MODULE,
	550	};
	551
	552	static int __init
	553	hash_ipport_init(void)
	554	{
	555	return ip_set_type_register(&hash_ipport_type);
	556	}
	557
	558	static void __exit
	559	hash_ipport_fini(void)
	560	{
	561	ip_set_type_unregister(&hash_ipport_type);
	562	}
	563
	564	module_init(hash_ipport_init);
	565	module_exit(hash_ipport_fini);