[GitHub/exynos8895/android_kernel_samsung_universal8895.git] / net / netfilter / nf_conntrack_tftp.c

/* (C) 2001-2002 Magnus Boden <mb@ozaba.mine.nu>
 *
 * 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.
 */

#include <linux/module.h>
#include <linux/moduleparam.h>
#include <linux/in.h>
#include <linux/udp.h>
#include <linux/netfilter.h>

#include <net/netfilter/nf_conntrack.h>
#include <net/netfilter/nf_conntrack_tuple.h>
#include <net/netfilter/nf_conntrack_expect.h>
#include <net/netfilter/nf_conntrack_ecache.h>
#include <net/netfilter/nf_conntrack_helper.h>
#include <linux/netfilter/nf_conntrack_tftp.h>

MODULE_AUTHOR("Magnus Boden <mb@ozaba.mine.nu>");
MODULE_DESCRIPTION("TFTP connection tracking helper");
MODULE_LICENSE("GPL");
MODULE_ALIAS("ip_conntrack_tftp");
MODULE_ALIAS_NFCT_HELPER("tftp");

#define MAX_PORTS 8
static unsigned short ports[MAX_PORTS];
static unsigned int ports_c;
module_param_array(ports, ushort, &ports_c, 0400);
MODULE_PARM_DESC(ports, "Port numbers of TFTP servers");

unsigned int (*nf_nat_tftp_hook)(struct sk_buff *skb,
				 enum ip_conntrack_info ctinfo,
				 struct nf_conntrack_expect *exp) __read_mostly;
EXPORT_SYMBOL_GPL(nf_nat_tftp_hook);

static int tftp_help(struct sk_buff *skb,
		     unsigned int protoff,
		     struct nf_conn *ct,
		     enum ip_conntrack_info ctinfo)
{
	const struct tftphdr *tfh;
	struct tftphdr _tftph;
	struct nf_conntrack_expect *exp;
	struct nf_conntrack_tuple *tuple;
	unsigned int ret = NF_ACCEPT;
	typeof(nf_nat_tftp_hook) nf_nat_tftp;

	tfh = skb_header_pointer(skb, protoff + sizeof(struct udphdr),
				 sizeof(_tftph), &_tftph);
	if (tfh == NULL)
		return NF_ACCEPT;

	switch (ntohs(tfh->opcode)) {
	case TFTP_OPCODE_READ:
	case TFTP_OPCODE_WRITE:
		/* RRQ and WRQ works the same way */
		nf_ct_dump_tuple(&ct->tuplehash[IP_CT_DIR_ORIGINAL].tuple);
		nf_ct_dump_tuple(&ct->tuplehash[IP_CT_DIR_REPLY].tuple);

		exp = nf_ct_expect_alloc(ct);
		if (exp == NULL)
			return NF_DROP;
		tuple = &ct->tuplehash[IP_CT_DIR_REPLY].tuple;
		nf_ct_expect_init(exp, NF_CT_EXPECT_CLASS_DEFAULT,
				  nf_ct_l3num(ct),
				  &tuple->src.u3, &tuple->dst.u3,
				  IPPROTO_UDP, NULL, &tuple->dst.u.udp.port);

		pr_debug("expect: ");
		nf_ct_dump_tuple(&exp->tuple);

		nf_nat_tftp = rcu_dereference(nf_nat_tftp_hook);
		if (nf_nat_tftp && ct->status & IPS_NAT_MASK)
			ret = nf_nat_tftp(skb, ctinfo, exp);
		else if (nf_ct_expect_related(exp) != 0)
			ret = NF_DROP;
		nf_ct_expect_put(exp);
		break;
	case TFTP_OPCODE_DATA:
	case TFTP_OPCODE_ACK:
		pr_debug("Data/ACK opcode\n");
		break;
	case TFTP_OPCODE_ERROR:
		pr_debug("Error opcode\n");
		break;
	default:
		pr_debug("Unknown opcode\n");
	}
	return ret;
}

static struct nf_conntrack_helper tftp[MAX_PORTS][2] __read_mostly;

static const struct nf_conntrack_expect_policy tftp_exp_policy = {
	.max_expected	= 1,
	.timeout	= 5 * 60,
};

static void nf_conntrack_tftp_fini(void)
{
	int i, j;

	for (i = 0; i < ports_c; i++) {
		for (j = 0; j < 2; j++)
			nf_conntrack_helper_unregister(&tftp[i][j]);
	}
}

static int __init nf_conntrack_tftp_init(void)
{
	int i, j, ret;

	if (ports_c == 0)
		ports[ports_c++] = TFTP_PORT;

	for (i = 0; i < ports_c; i++) {
		memset(&tftp[i], 0, sizeof(tftp[i]));

		tftp[i][0].tuple.src.l3num = AF_INET;
		tftp[i][1].tuple.src.l3num = AF_INET6;
		for (j = 0; j < 2; j++) {
			tftp[i][j].tuple.dst.protonum = IPPROTO_UDP;
			tftp[i][j].tuple.src.u.udp.port = htons(ports[i]);
			tftp[i][j].expect_policy = &tftp_exp_policy;
			tftp[i][j].me = THIS_MODULE;
			tftp[i][j].help = tftp_help;

			if (ports[i] == TFTP_PORT)
				sprintf(tftp[i][j].name, "tftp");
			else
				sprintf(tftp[i][j].name, "tftp-%u", i);

			ret = nf_conntrack_helper_register(&tftp[i][j]);
			if (ret) {
				printk(KERN_ERR "nf_ct_tftp: failed to register"
				       " helper for pf: %u port: %u\n",
					tftp[i][j].tuple.src.l3num, ports[i]);
				nf_conntrack_tftp_fini();
				return ret;
			}
		}
	}
	return 0;
}

module_init(nf_conntrack_tftp_init);
module_exit(nf_conntrack_tftp_fini);
Commit	Line	Data
a536df35 PM	1	/* (C) 2001-2002 Magnus Boden <mb@ozaba.mine.nu>
	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	#include <linux/module.h>
	9	#include <linux/moduleparam.h>
	10	#include <linux/in.h>
	11	#include <linux/udp.h>
1863f096	12	#include <linux/netfilter.h>
a536df35 PM	13
	14	#include <net/netfilter/nf_conntrack.h>
	15	#include <net/netfilter/nf_conntrack_tuple.h>
	16	#include <net/netfilter/nf_conntrack_expect.h>
	17	#include <net/netfilter/nf_conntrack_ecache.h>
	18	#include <net/netfilter/nf_conntrack_helper.h>
	19	#include <linux/netfilter/nf_conntrack_tftp.h>
	20
	21	MODULE_AUTHOR("Magnus Boden <mb@ozaba.mine.nu>");
	22	MODULE_DESCRIPTION("TFTP connection tracking helper");
	23	MODULE_LICENSE("GPL");
	24	MODULE_ALIAS("ip_conntrack_tftp");
4dc06f96	25	MODULE_ALIAS_NFCT_HELPER("tftp");
a536df35 PM	26
	27	#define MAX_PORTS 8
	28	static unsigned short ports[MAX_PORTS];
2f0d2f10	29	static unsigned int ports_c;
a536df35 PM	30	module_param_array(ports, ushort, &ports_c, 0400);
	31	MODULE_PARM_DESC(ports, "Port numbers of TFTP servers");
	32
3db05fea	33	unsigned int (nf_nat_tftp_hook)(struct sk_buff skb,
a536df35 PM	34	enum ip_conntrack_info ctinfo,
	35	struct nf_conntrack_expect *exp) __read_mostly;
	36	EXPORT_SYMBOL_GPL(nf_nat_tftp_hook);
	37
3db05fea	38	static int tftp_help(struct sk_buff *skb,
a536df35 PM	39	unsigned int protoff,
	40	struct nf_conn *ct,
	41	enum ip_conntrack_info ctinfo)
	42	{
de24b4eb JE	43	const struct tftphdr *tfh;
de24b4eb JE	44	struct tftphdr _tftph;
a536df35 PM	45	struct nf_conntrack_expect *exp;
	46	struct nf_conntrack_tuple *tuple;
	47	unsigned int ret = NF_ACCEPT;
a536df35 PM	48	typeof(nf_nat_tftp_hook) nf_nat_tftp;
a536df35 PM	49
3db05fea	50	tfh = skb_header_pointer(skb, protoff + sizeof(struct udphdr),
a536df35 PM	51	sizeof(_tftph), &_tftph);
	52	if (tfh == NULL)
	53	return NF_ACCEPT;
	54
	55	switch (ntohs(tfh->opcode)) {
	56	case TFTP_OPCODE_READ:
	57	case TFTP_OPCODE_WRITE:
	58	/* RRQ and WRQ works the same way */
3c9fba65 JE	59	nf_ct_dump_tuple(&ct->tuplehash[IP_CT_DIR_ORIGINAL].tuple);
3c9fba65 JE	60	nf_ct_dump_tuple(&ct->tuplehash[IP_CT_DIR_REPLY].tuple);
a536df35	61
6823645d	62	exp = nf_ct_expect_alloc(ct);
a536df35 PM	63	if (exp == NULL)
	64	return NF_DROP;
	65	tuple = &ct->tuplehash[IP_CT_DIR_REPLY].tuple;
5e8fbe2a PM	66	nf_ct_expect_init(exp, NF_CT_EXPECT_CLASS_DEFAULT,
5e8fbe2a PM	67	nf_ct_l3num(ct),
6002f266	68	&tuple->src.u3, &tuple->dst.u3,
6823645d	69	IPPROTO_UDP, NULL, &tuple->dst.u.udp.port);
a536df35	70
0d53778e	71	pr_debug("expect: ");
3c9fba65	72	nf_ct_dump_tuple(&exp->tuple);
a536df35 PM	73
	74	nf_nat_tftp = rcu_dereference(nf_nat_tftp_hook);
	75	if (nf_nat_tftp && ct->status & IPS_NAT_MASK)
3db05fea	76	ret = nf_nat_tftp(skb, ctinfo, exp);
6823645d	77	else if (nf_ct_expect_related(exp) != 0)
a536df35	78	ret = NF_DROP;
6823645d	79	nf_ct_expect_put(exp);
a536df35 PM	80	break;
	81	case TFTP_OPCODE_DATA:
	82	case TFTP_OPCODE_ACK:
0d53778e	83	pr_debug("Data/ACK opcode\n");
a536df35 PM	84	break;
a536df35 PM	85	case TFTP_OPCODE_ERROR:
0d53778e	86	pr_debug("Error opcode\n");
a536df35 PM	87	break;
a536df35 PM	88	default:
0d53778e	89	pr_debug("Unknown opcode\n");
a536df35 PM	90	}
	91	return ret;
	92	}
	93
	94	static struct nf_conntrack_helper tftp[MAX_PORTS][2] __read_mostly;
a536df35	95
6002f266 PM	96	static const struct nf_conntrack_expect_policy tftp_exp_policy = {
	97	.max_expected = 1,
	98	.timeout = 5 * 60,
	99	};
	100
a536df35 PM	101	static void nf_conntrack_tftp_fini(void)
	102	{
	103	int i, j;
	104
	105	for (i = 0; i < ports_c; i++) {
	106	for (j = 0; j < 2; j++)
	107	nf_conntrack_helper_unregister(&tftp[i][j]);
	108	}
	109	}
	110
	111	static int __init nf_conntrack_tftp_init(void)
	112	{
	113	int i, j, ret;
a536df35 PM	114
	115	if (ports_c == 0)
	116	ports[ports_c++] = TFTP_PORT;
	117
	118	for (i = 0; i < ports_c; i++) {
	119	memset(&tftp[i], 0, sizeof(tftp[i]));
	120
	121	tftp[i][0].tuple.src.l3num = AF_INET;
	122	tftp[i][1].tuple.src.l3num = AF_INET6;
	123	for (j = 0; j < 2; j++) {
	124	tftp[i][j].tuple.dst.protonum = IPPROTO_UDP;
	125	tftp[i][j].tuple.src.u.udp.port = htons(ports[i]);
6002f266	126	tftp[i][j].expect_policy = &tftp_exp_policy;
a536df35 PM	127	tftp[i][j].me = THIS_MODULE;
	128	tftp[i][j].help = tftp_help;
	129
a536df35	130	if (ports[i] == TFTP_PORT)
3a8fc53a	131	sprintf(tftp[i][j].name, "tftp");
a536df35	132	else
3a8fc53a	133	sprintf(tftp[i][j].name, "tftp-%u", i);
a536df35 PM	134
	135	ret = nf_conntrack_helper_register(&tftp[i][j]);
	136	if (ret) {
654d0fbd SH	137	printk(KERN_ERR "nf_ct_tftp: failed to register"
654d0fbd SH	138	" helper for pf: %u port: %u\n",
a536df35 PM	139	tftp[i][j].tuple.src.l3num, ports[i]);
	140	nf_conntrack_tftp_fini();
	141	return ret;
	142	}
	143	}
	144	}
	145	return 0;
	146	}
	147
	148	module_init(nf_conntrack_tftp_init);
	149	module_exit(nf_conntrack_tftp_fini);