Linux Audio

Check our new training course

Loading...
v5.14.15
  1// SPDX-License-Identifier: GPL-2.0-or-later
  2/*
  3 * (C) 2012 Pablo Neira Ayuso <pablo@netfilter.org>
  4 *
 
 
 
 
  5 * This software has been sponsored by Vyatta Inc. <http://www.vyatta.com>
  6 */
  7#include <linux/init.h>
  8#include <linux/module.h>
  9#include <linux/kernel.h>
 10#include <linux/skbuff.h>
 11#include <linux/netlink.h>
 12#include <linux/rculist.h>
 13#include <linux/slab.h>
 14#include <linux/types.h>
 15#include <linux/list.h>
 16#include <linux/errno.h>
 17#include <linux/capability.h>
 18#include <net/netlink.h>
 19#include <net/sock.h>
 20
 21#include <net/netfilter/nf_conntrack_helper.h>
 22#include <net/netfilter/nf_conntrack_expect.h>
 23#include <net/netfilter/nf_conntrack_ecache.h>
 24
 25#include <linux/netfilter/nfnetlink.h>
 26#include <linux/netfilter/nfnetlink_conntrack.h>
 27#include <linux/netfilter/nfnetlink_cthelper.h>
 28
 29MODULE_LICENSE("GPL");
 30MODULE_AUTHOR("Pablo Neira Ayuso <pablo@netfilter.org>");
 31MODULE_DESCRIPTION("nfnl_cthelper: User-space connection tracking helpers");
 32
 33struct nfnl_cthelper {
 34	struct list_head		list;
 35	struct nf_conntrack_helper	helper;
 36};
 37
 38static LIST_HEAD(nfnl_cthelper_list);
 39
 40static int
 41nfnl_userspace_cthelper(struct sk_buff *skb, unsigned int protoff,
 42			struct nf_conn *ct, enum ip_conntrack_info ctinfo)
 43{
 44	const struct nf_conn_help *help;
 45	struct nf_conntrack_helper *helper;
 46
 47	help = nfct_help(ct);
 48	if (help == NULL)
 49		return NF_DROP;
 50
 51	/* rcu_read_lock()ed by nf_hook_thresh */
 52	helper = rcu_dereference(help->helper);
 53	if (helper == NULL)
 54		return NF_DROP;
 55
 56	/* This is a user-space helper not yet configured, skip. */
 57	if ((helper->flags &
 58	    (NF_CT_HELPER_F_USERSPACE | NF_CT_HELPER_F_CONFIGURED)) ==
 59	     NF_CT_HELPER_F_USERSPACE)
 60		return NF_ACCEPT;
 61
 62	/* If the user-space helper is not available, don't block traffic. */
 63	return NF_QUEUE_NR(helper->queue_num) | NF_VERDICT_FLAG_QUEUE_BYPASS;
 64}
 65
 66static const struct nla_policy nfnl_cthelper_tuple_pol[NFCTH_TUPLE_MAX+1] = {
 67	[NFCTH_TUPLE_L3PROTONUM] = { .type = NLA_U16, },
 68	[NFCTH_TUPLE_L4PROTONUM] = { .type = NLA_U8, },
 69};
 70
 71static int
 72nfnl_cthelper_parse_tuple(struct nf_conntrack_tuple *tuple,
 73			  const struct nlattr *attr)
 74{
 75	int err;
 76	struct nlattr *tb[NFCTH_TUPLE_MAX+1];
 77
 78	err = nla_parse_nested_deprecated(tb, NFCTH_TUPLE_MAX, attr,
 79					  nfnl_cthelper_tuple_pol, NULL);
 80	if (err < 0)
 81		return err;
 82
 83	if (!tb[NFCTH_TUPLE_L3PROTONUM] || !tb[NFCTH_TUPLE_L4PROTONUM])
 84		return -EINVAL;
 85
 86	/* Not all fields are initialized so first zero the tuple */
 87	memset(tuple, 0, sizeof(struct nf_conntrack_tuple));
 88
 89	tuple->src.l3num = ntohs(nla_get_be16(tb[NFCTH_TUPLE_L3PROTONUM]));
 90	tuple->dst.protonum = nla_get_u8(tb[NFCTH_TUPLE_L4PROTONUM]);
 91
 92	return 0;
 93}
 94
 95static int
 96nfnl_cthelper_from_nlattr(struct nlattr *attr, struct nf_conn *ct)
 97{
 98	struct nf_conn_help *help = nfct_help(ct);
 99
100	if (attr == NULL)
101		return -EINVAL;
102
103	if (help->helper->data_len == 0)
104		return -EINVAL;
105
106	nla_memcpy(help->data, attr, sizeof(help->data));
107	return 0;
108}
109
110static int
111nfnl_cthelper_to_nlattr(struct sk_buff *skb, const struct nf_conn *ct)
112{
113	const struct nf_conn_help *help = nfct_help(ct);
114
115	if (help->helper->data_len &&
116	    nla_put(skb, CTA_HELP_INFO, help->helper->data_len, &help->data))
117		goto nla_put_failure;
118
119	return 0;
120
121nla_put_failure:
122	return -ENOSPC;
123}
124
125static const struct nla_policy nfnl_cthelper_expect_pol[NFCTH_POLICY_MAX+1] = {
126	[NFCTH_POLICY_NAME] = { .type = NLA_NUL_STRING,
127				.len = NF_CT_HELPER_NAME_LEN-1 },
128	[NFCTH_POLICY_EXPECT_MAX] = { .type = NLA_U32, },
129	[NFCTH_POLICY_EXPECT_TIMEOUT] = { .type = NLA_U32, },
130};
131
132static int
133nfnl_cthelper_expect_policy(struct nf_conntrack_expect_policy *expect_policy,
134			    const struct nlattr *attr)
135{
136	int err;
137	struct nlattr *tb[NFCTH_POLICY_MAX+1];
138
139	err = nla_parse_nested_deprecated(tb, NFCTH_POLICY_MAX, attr,
140					  nfnl_cthelper_expect_pol, NULL);
141	if (err < 0)
142		return err;
143
144	if (!tb[NFCTH_POLICY_NAME] ||
145	    !tb[NFCTH_POLICY_EXPECT_MAX] ||
146	    !tb[NFCTH_POLICY_EXPECT_TIMEOUT])
147		return -EINVAL;
148
149	nla_strscpy(expect_policy->name,
150		    tb[NFCTH_POLICY_NAME], NF_CT_HELPER_NAME_LEN);
151	expect_policy->max_expected =
152		ntohl(nla_get_be32(tb[NFCTH_POLICY_EXPECT_MAX]));
153	if (expect_policy->max_expected > NF_CT_EXPECT_MAX_CNT)
154		return -EINVAL;
155
156	expect_policy->timeout =
157		ntohl(nla_get_be32(tb[NFCTH_POLICY_EXPECT_TIMEOUT]));
158
159	return 0;
160}
161
162static const struct nla_policy
163nfnl_cthelper_expect_policy_set[NFCTH_POLICY_SET_MAX+1] = {
164	[NFCTH_POLICY_SET_NUM] = { .type = NLA_U32, },
165};
166
167static int
168nfnl_cthelper_parse_expect_policy(struct nf_conntrack_helper *helper,
169				  const struct nlattr *attr)
170{
171	int i, ret;
172	struct nf_conntrack_expect_policy *expect_policy;
173	struct nlattr *tb[NFCTH_POLICY_SET_MAX+1];
174	unsigned int class_max;
175
176	ret = nla_parse_nested_deprecated(tb, NFCTH_POLICY_SET_MAX, attr,
177					  nfnl_cthelper_expect_policy_set,
178					  NULL);
179	if (ret < 0)
180		return ret;
181
182	if (!tb[NFCTH_POLICY_SET_NUM])
183		return -EINVAL;
184
185	class_max = ntohl(nla_get_be32(tb[NFCTH_POLICY_SET_NUM]));
186	if (class_max == 0)
187		return -EINVAL;
188	if (class_max > NF_CT_MAX_EXPECT_CLASSES)
189		return -EOVERFLOW;
190
191	expect_policy = kcalloc(class_max,
192				sizeof(struct nf_conntrack_expect_policy),
193				GFP_KERNEL);
194	if (expect_policy == NULL)
195		return -ENOMEM;
196
197	for (i = 0; i < class_max; i++) {
198		if (!tb[NFCTH_POLICY_SET+i])
199			goto err;
200
201		ret = nfnl_cthelper_expect_policy(&expect_policy[i],
202						  tb[NFCTH_POLICY_SET+i]);
203		if (ret < 0)
204			goto err;
205	}
206
207	helper->expect_class_max = class_max - 1;
208	helper->expect_policy = expect_policy;
209	return 0;
210err:
211	kfree(expect_policy);
212	return -EINVAL;
213}
214
215static int
216nfnl_cthelper_create(const struct nlattr * const tb[],
217		     struct nf_conntrack_tuple *tuple)
218{
219	struct nf_conntrack_helper *helper;
220	struct nfnl_cthelper *nfcth;
221	unsigned int size;
222	int ret;
223
224	if (!tb[NFCTH_TUPLE] || !tb[NFCTH_POLICY] || !tb[NFCTH_PRIV_DATA_LEN])
225		return -EINVAL;
226
227	nfcth = kzalloc(sizeof(*nfcth), GFP_KERNEL);
228	if (nfcth == NULL)
229		return -ENOMEM;
230	helper = &nfcth->helper;
231
232	ret = nfnl_cthelper_parse_expect_policy(helper, tb[NFCTH_POLICY]);
233	if (ret < 0)
234		goto err1;
235
236	nla_strscpy(helper->name,
237		    tb[NFCTH_NAME], NF_CT_HELPER_NAME_LEN);
238	size = ntohl(nla_get_be32(tb[NFCTH_PRIV_DATA_LEN]));
239	if (size > sizeof_field(struct nf_conn_help, data)) {
240		ret = -ENOMEM;
241		goto err2;
242	}
243	helper->data_len = size;
244
245	helper->flags |= NF_CT_HELPER_F_USERSPACE;
246	memcpy(&helper->tuple, tuple, sizeof(struct nf_conntrack_tuple));
247
248	helper->me = THIS_MODULE;
249	helper->help = nfnl_userspace_cthelper;
250	helper->from_nlattr = nfnl_cthelper_from_nlattr;
251	helper->to_nlattr = nfnl_cthelper_to_nlattr;
252
253	/* Default to queue number zero, this can be updated at any time. */
254	if (tb[NFCTH_QUEUE_NUM])
255		helper->queue_num = ntohl(nla_get_be32(tb[NFCTH_QUEUE_NUM]));
256
257	if (tb[NFCTH_STATUS]) {
258		int status = ntohl(nla_get_be32(tb[NFCTH_STATUS]));
259
260		switch(status) {
261		case NFCT_HELPER_STATUS_ENABLED:
262			helper->flags |= NF_CT_HELPER_F_CONFIGURED;
263			break;
264		case NFCT_HELPER_STATUS_DISABLED:
265			helper->flags &= ~NF_CT_HELPER_F_CONFIGURED;
266			break;
267		}
268	}
269
270	ret = nf_conntrack_helper_register(helper);
271	if (ret < 0)
272		goto err2;
273
274	list_add_tail(&nfcth->list, &nfnl_cthelper_list);
275	return 0;
276err2:
277	kfree(helper->expect_policy);
278err1:
279	kfree(nfcth);
280	return ret;
281}
282
283static int
284nfnl_cthelper_update_policy_one(const struct nf_conntrack_expect_policy *policy,
285				struct nf_conntrack_expect_policy *new_policy,
286				const struct nlattr *attr)
287{
288	struct nlattr *tb[NFCTH_POLICY_MAX + 1];
289	int err;
290
291	err = nla_parse_nested_deprecated(tb, NFCTH_POLICY_MAX, attr,
292					  nfnl_cthelper_expect_pol, NULL);
293	if (err < 0)
294		return err;
295
296	if (!tb[NFCTH_POLICY_NAME] ||
297	    !tb[NFCTH_POLICY_EXPECT_MAX] ||
298	    !tb[NFCTH_POLICY_EXPECT_TIMEOUT])
299		return -EINVAL;
300
301	if (nla_strcmp(tb[NFCTH_POLICY_NAME], policy->name))
302		return -EBUSY;
303
304	new_policy->max_expected =
305		ntohl(nla_get_be32(tb[NFCTH_POLICY_EXPECT_MAX]));
306	if (new_policy->max_expected > NF_CT_EXPECT_MAX_CNT)
307		return -EINVAL;
308
309	new_policy->timeout =
310		ntohl(nla_get_be32(tb[NFCTH_POLICY_EXPECT_TIMEOUT]));
311
312	return 0;
313}
314
315static int nfnl_cthelper_update_policy_all(struct nlattr *tb[],
316					   struct nf_conntrack_helper *helper)
317{
318	struct nf_conntrack_expect_policy *new_policy;
319	struct nf_conntrack_expect_policy *policy;
320	int i, ret = 0;
321
322	new_policy = kmalloc_array(helper->expect_class_max + 1,
323				   sizeof(*new_policy), GFP_KERNEL);
324	if (!new_policy)
325		return -ENOMEM;
326
327	/* Check first that all policy attributes are well-formed, so we don't
328	 * leave things in inconsistent state on errors.
329	 */
330	for (i = 0; i < helper->expect_class_max + 1; i++) {
331
332		if (!tb[NFCTH_POLICY_SET + i]) {
333			ret = -EINVAL;
334			goto err;
335		}
336
337		ret = nfnl_cthelper_update_policy_one(&helper->expect_policy[i],
338						      &new_policy[i],
339						      tb[NFCTH_POLICY_SET + i]);
340		if (ret < 0)
341			goto err;
342	}
343	/* Now we can safely update them. */
344	for (i = 0; i < helper->expect_class_max + 1; i++) {
345		policy = (struct nf_conntrack_expect_policy *)
346				&helper->expect_policy[i];
347		policy->max_expected = new_policy->max_expected;
348		policy->timeout	= new_policy->timeout;
349	}
350
351err:
352	kfree(new_policy);
353	return ret;
354}
355
356static int nfnl_cthelper_update_policy(struct nf_conntrack_helper *helper,
357				       const struct nlattr *attr)
358{
359	struct nlattr *tb[NFCTH_POLICY_SET_MAX + 1];
360	unsigned int class_max;
361	int err;
362
363	err = nla_parse_nested_deprecated(tb, NFCTH_POLICY_SET_MAX, attr,
364					  nfnl_cthelper_expect_policy_set,
365					  NULL);
366	if (err < 0)
367		return err;
368
369	if (!tb[NFCTH_POLICY_SET_NUM])
370		return -EINVAL;
371
372	class_max = ntohl(nla_get_be32(tb[NFCTH_POLICY_SET_NUM]));
373	if (helper->expect_class_max + 1 != class_max)
374		return -EBUSY;
375
376	return nfnl_cthelper_update_policy_all(tb, helper);
377}
378
379static int
380nfnl_cthelper_update(const struct nlattr * const tb[],
381		     struct nf_conntrack_helper *helper)
382{
383	u32 size;
384	int ret;
385
386	if (tb[NFCTH_PRIV_DATA_LEN]) {
387		size = ntohl(nla_get_be32(tb[NFCTH_PRIV_DATA_LEN]));
388		if (size != helper->data_len)
389			return -EBUSY;
390	}
391
392	if (tb[NFCTH_POLICY]) {
393		ret = nfnl_cthelper_update_policy(helper, tb[NFCTH_POLICY]);
394		if (ret < 0)
395			return ret;
396	}
397	if (tb[NFCTH_QUEUE_NUM])
398		helper->queue_num = ntohl(nla_get_be32(tb[NFCTH_QUEUE_NUM]));
399
400	if (tb[NFCTH_STATUS]) {
401		int status = ntohl(nla_get_be32(tb[NFCTH_STATUS]));
402
403		switch(status) {
404		case NFCT_HELPER_STATUS_ENABLED:
405			helper->flags |= NF_CT_HELPER_F_CONFIGURED;
406			break;
407		case NFCT_HELPER_STATUS_DISABLED:
408			helper->flags &= ~NF_CT_HELPER_F_CONFIGURED;
409			break;
410		}
411	}
412	return 0;
413}
414
415static int nfnl_cthelper_new(struct sk_buff *skb, const struct nfnl_info *info,
416			     const struct nlattr * const tb[])
 
 
417{
418	const char *helper_name;
419	struct nf_conntrack_helper *cur, *helper = NULL;
420	struct nf_conntrack_tuple tuple;
421	struct nfnl_cthelper *nlcth;
422	int ret = 0;
423
424	if (!capable(CAP_NET_ADMIN))
425		return -EPERM;
426
427	if (!tb[NFCTH_NAME] || !tb[NFCTH_TUPLE])
428		return -EINVAL;
429
430	helper_name = nla_data(tb[NFCTH_NAME]);
431
432	ret = nfnl_cthelper_parse_tuple(&tuple, tb[NFCTH_TUPLE]);
433	if (ret < 0)
434		return ret;
435
436	list_for_each_entry(nlcth, &nfnl_cthelper_list, list) {
437		cur = &nlcth->helper;
438
439		if (strncmp(cur->name, helper_name, NF_CT_HELPER_NAME_LEN))
440			continue;
441
442		if ((tuple.src.l3num != cur->tuple.src.l3num ||
443		     tuple.dst.protonum != cur->tuple.dst.protonum))
444			continue;
445
446		if (info->nlh->nlmsg_flags & NLM_F_EXCL)
447			return -EEXIST;
448
449		helper = cur;
450		break;
451	}
452
453	if (helper == NULL)
454		ret = nfnl_cthelper_create(tb, &tuple);
455	else
456		ret = nfnl_cthelper_update(tb, helper);
457
458	return ret;
459}
460
461static int
462nfnl_cthelper_dump_tuple(struct sk_buff *skb,
463			 struct nf_conntrack_helper *helper)
464{
465	struct nlattr *nest_parms;
466
467	nest_parms = nla_nest_start(skb, NFCTH_TUPLE);
468	if (nest_parms == NULL)
469		goto nla_put_failure;
470
471	if (nla_put_be16(skb, NFCTH_TUPLE_L3PROTONUM,
472			 htons(helper->tuple.src.l3num)))
473		goto nla_put_failure;
474
475	if (nla_put_u8(skb, NFCTH_TUPLE_L4PROTONUM, helper->tuple.dst.protonum))
476		goto nla_put_failure;
477
478	nla_nest_end(skb, nest_parms);
479	return 0;
480
481nla_put_failure:
482	return -1;
483}
484
485static int
486nfnl_cthelper_dump_policy(struct sk_buff *skb,
487			struct nf_conntrack_helper *helper)
488{
489	int i;
490	struct nlattr *nest_parms1, *nest_parms2;
491
492	nest_parms1 = nla_nest_start(skb, NFCTH_POLICY);
493	if (nest_parms1 == NULL)
494		goto nla_put_failure;
495
496	if (nla_put_be32(skb, NFCTH_POLICY_SET_NUM,
497			 htonl(helper->expect_class_max + 1)))
498		goto nla_put_failure;
499
500	for (i = 0; i < helper->expect_class_max + 1; i++) {
501		nest_parms2 = nla_nest_start(skb, (NFCTH_POLICY_SET + i));
 
502		if (nest_parms2 == NULL)
503			goto nla_put_failure;
504
505		if (nla_put_string(skb, NFCTH_POLICY_NAME,
506				   helper->expect_policy[i].name))
507			goto nla_put_failure;
508
509		if (nla_put_be32(skb, NFCTH_POLICY_EXPECT_MAX,
510				 htonl(helper->expect_policy[i].max_expected)))
511			goto nla_put_failure;
512
513		if (nla_put_be32(skb, NFCTH_POLICY_EXPECT_TIMEOUT,
514				 htonl(helper->expect_policy[i].timeout)))
515			goto nla_put_failure;
516
517		nla_nest_end(skb, nest_parms2);
518	}
519	nla_nest_end(skb, nest_parms1);
520	return 0;
521
522nla_put_failure:
523	return -1;
524}
525
526static int
527nfnl_cthelper_fill_info(struct sk_buff *skb, u32 portid, u32 seq, u32 type,
528			int event, struct nf_conntrack_helper *helper)
529{
530	struct nlmsghdr *nlh;
 
531	unsigned int flags = portid ? NLM_F_MULTI : 0;
532	int status;
533
534	event = nfnl_msg_type(NFNL_SUBSYS_CTHELPER, event);
535	nlh = nfnl_msg_put(skb, portid, seq, event, flags, AF_UNSPEC,
536			   NFNETLINK_V0, 0);
537	if (!nlh)
538		goto nlmsg_failure;
539
 
 
 
 
 
540	if (nla_put_string(skb, NFCTH_NAME, helper->name))
541		goto nla_put_failure;
542
543	if (nla_put_be32(skb, NFCTH_QUEUE_NUM, htonl(helper->queue_num)))
544		goto nla_put_failure;
545
546	if (nfnl_cthelper_dump_tuple(skb, helper) < 0)
547		goto nla_put_failure;
548
549	if (nfnl_cthelper_dump_policy(skb, helper) < 0)
550		goto nla_put_failure;
551
552	if (nla_put_be32(skb, NFCTH_PRIV_DATA_LEN, htonl(helper->data_len)))
553		goto nla_put_failure;
554
555	if (helper->flags & NF_CT_HELPER_F_CONFIGURED)
556		status = NFCT_HELPER_STATUS_ENABLED;
557	else
558		status = NFCT_HELPER_STATUS_DISABLED;
559
560	if (nla_put_be32(skb, NFCTH_STATUS, htonl(status)))
561		goto nla_put_failure;
562
563	nlmsg_end(skb, nlh);
564	return skb->len;
565
566nlmsg_failure:
567nla_put_failure:
568	nlmsg_cancel(skb, nlh);
569	return -1;
570}
571
572static int
573nfnl_cthelper_dump_table(struct sk_buff *skb, struct netlink_callback *cb)
574{
575	struct nf_conntrack_helper *cur, *last;
576
577	rcu_read_lock();
578	last = (struct nf_conntrack_helper *)cb->args[1];
579	for (; cb->args[0] < nf_ct_helper_hsize; cb->args[0]++) {
580restart:
581		hlist_for_each_entry_rcu(cur,
582				&nf_ct_helper_hash[cb->args[0]], hnode) {
583
584			/* skip non-userspace conntrack helpers. */
585			if (!(cur->flags & NF_CT_HELPER_F_USERSPACE))
586				continue;
587
588			if (cb->args[1]) {
589				if (cur != last)
590					continue;
591				cb->args[1] = 0;
592			}
593			if (nfnl_cthelper_fill_info(skb,
594					    NETLINK_CB(cb->skb).portid,
595					    cb->nlh->nlmsg_seq,
596					    NFNL_MSG_TYPE(cb->nlh->nlmsg_type),
597					    NFNL_MSG_CTHELPER_NEW, cur) < 0) {
598				cb->args[1] = (unsigned long)cur;
599				goto out;
600			}
601		}
602	}
603	if (cb->args[1]) {
604		cb->args[1] = 0;
605		goto restart;
606	}
607out:
608	rcu_read_unlock();
609	return skb->len;
610}
611
612static int nfnl_cthelper_get(struct sk_buff *skb, const struct nfnl_info *info,
613			     const struct nlattr * const tb[])
 
 
614{
615	int ret = -ENOENT;
616	struct nf_conntrack_helper *cur;
617	struct sk_buff *skb2;
618	char *helper_name = NULL;
619	struct nf_conntrack_tuple tuple;
620	struct nfnl_cthelper *nlcth;
621	bool tuple_set = false;
622
623	if (!capable(CAP_NET_ADMIN))
624		return -EPERM;
625
626	if (info->nlh->nlmsg_flags & NLM_F_DUMP) {
627		struct netlink_dump_control c = {
628			.dump = nfnl_cthelper_dump_table,
629		};
630		return netlink_dump_start(info->sk, skb, info->nlh, &c);
631	}
632
633	if (tb[NFCTH_NAME])
634		helper_name = nla_data(tb[NFCTH_NAME]);
635
636	if (tb[NFCTH_TUPLE]) {
637		ret = nfnl_cthelper_parse_tuple(&tuple, tb[NFCTH_TUPLE]);
638		if (ret < 0)
639			return ret;
640
641		tuple_set = true;
642	}
643
644	list_for_each_entry(nlcth, &nfnl_cthelper_list, list) {
645		cur = &nlcth->helper;
646		if (helper_name &&
647		    strncmp(cur->name, helper_name, NF_CT_HELPER_NAME_LEN))
648			continue;
649
650		if (tuple_set &&
651		    (tuple.src.l3num != cur->tuple.src.l3num ||
652		     tuple.dst.protonum != cur->tuple.dst.protonum))
653			continue;
654
655		skb2 = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
656		if (skb2 == NULL) {
657			ret = -ENOMEM;
658			break;
659		}
660
661		ret = nfnl_cthelper_fill_info(skb2, NETLINK_CB(skb).portid,
662					      info->nlh->nlmsg_seq,
663					      NFNL_MSG_TYPE(info->nlh->nlmsg_type),
664					      NFNL_MSG_CTHELPER_NEW, cur);
665		if (ret <= 0) {
666			kfree_skb(skb2);
667			break;
668		}
669
670		ret = nfnetlink_unicast(skb2, info->net, NETLINK_CB(skb).portid);
671		break;
672	}
 
673
 
 
 
674	return ret;
675}
676
677static int nfnl_cthelper_del(struct sk_buff *skb, const struct nfnl_info *info,
678			     const struct nlattr * const tb[])
 
 
679{
680	char *helper_name = NULL;
681	struct nf_conntrack_helper *cur;
682	struct nf_conntrack_tuple tuple;
683	bool tuple_set = false, found = false;
684	struct nfnl_cthelper *nlcth, *n;
685	int j = 0, ret;
686
687	if (!capable(CAP_NET_ADMIN))
688		return -EPERM;
689
690	if (tb[NFCTH_NAME])
691		helper_name = nla_data(tb[NFCTH_NAME]);
692
693	if (tb[NFCTH_TUPLE]) {
694		ret = nfnl_cthelper_parse_tuple(&tuple, tb[NFCTH_TUPLE]);
695		if (ret < 0)
696			return ret;
697
698		tuple_set = true;
699	}
700
701	ret = -ENOENT;
702	list_for_each_entry_safe(nlcth, n, &nfnl_cthelper_list, list) {
703		cur = &nlcth->helper;
704		j++;
705
706		if (helper_name &&
707		    strncmp(cur->name, helper_name, NF_CT_HELPER_NAME_LEN))
708			continue;
709
710		if (tuple_set &&
711		    (tuple.src.l3num != cur->tuple.src.l3num ||
712		     tuple.dst.protonum != cur->tuple.dst.protonum))
713			continue;
714
715		if (refcount_dec_if_one(&cur->refcnt)) {
716			found = true;
717			nf_conntrack_helper_unregister(cur);
718			kfree(cur->expect_policy);
719
720			list_del(&nlcth->list);
721			kfree(nlcth);
722		} else {
723			ret = -EBUSY;
724		}
725	}
726
727	/* Make sure we return success if we flush and there is no helpers */
728	return (found || j == 0) ? 0 : ret;
729}
730
731static const struct nla_policy nfnl_cthelper_policy[NFCTH_MAX+1] = {
732	[NFCTH_NAME] = { .type = NLA_NUL_STRING,
733			 .len = NF_CT_HELPER_NAME_LEN-1 },
734	[NFCTH_QUEUE_NUM] = { .type = NLA_U32, },
735	[NFCTH_PRIV_DATA_LEN] = { .type = NLA_U32, },
736	[NFCTH_STATUS] = { .type = NLA_U32, },
737};
738
739static const struct nfnl_callback nfnl_cthelper_cb[NFNL_MSG_CTHELPER_MAX] = {
740	[NFNL_MSG_CTHELPER_NEW]	= {
741		.call		= nfnl_cthelper_new,
742		.type		= NFNL_CB_MUTEX,
743		.attr_count	= NFCTH_MAX,
744		.policy		= nfnl_cthelper_policy
745	},
746	[NFNL_MSG_CTHELPER_GET] = {
747		.call		= nfnl_cthelper_get,
748		.type		= NFNL_CB_MUTEX,
749		.attr_count	= NFCTH_MAX,
750		.policy		= nfnl_cthelper_policy
751	},
752	[NFNL_MSG_CTHELPER_DEL]	= {
753		.call		= nfnl_cthelper_del,
754		.type		= NFNL_CB_MUTEX,
755		.attr_count	= NFCTH_MAX,
756		.policy		= nfnl_cthelper_policy
757	},
758};
759
760static const struct nfnetlink_subsystem nfnl_cthelper_subsys = {
761	.name				= "cthelper",
762	.subsys_id			= NFNL_SUBSYS_CTHELPER,
763	.cb_count			= NFNL_MSG_CTHELPER_MAX,
764	.cb				= nfnl_cthelper_cb,
765};
766
767MODULE_ALIAS_NFNL_SUBSYS(NFNL_SUBSYS_CTHELPER);
768
769static int __init nfnl_cthelper_init(void)
770{
771	int ret;
772
773	ret = nfnetlink_subsys_register(&nfnl_cthelper_subsys);
774	if (ret < 0) {
775		pr_err("nfnl_cthelper: cannot register with nfnetlink.\n");
776		goto err_out;
777	}
778	return 0;
779err_out:
780	return ret;
781}
782
783static void __exit nfnl_cthelper_exit(void)
784{
785	struct nf_conntrack_helper *cur;
786	struct nfnl_cthelper *nlcth, *n;
787
788	nfnetlink_subsys_unregister(&nfnl_cthelper_subsys);
789
790	list_for_each_entry_safe(nlcth, n, &nfnl_cthelper_list, list) {
791		cur = &nlcth->helper;
792
793		nf_conntrack_helper_unregister(cur);
794		kfree(cur->expect_policy);
795		kfree(nlcth);
796	}
797}
798
799module_init(nfnl_cthelper_init);
800module_exit(nfnl_cthelper_exit);
v4.17
 
  1/*
  2 * (C) 2012 Pablo Neira Ayuso <pablo@netfilter.org>
  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 (or any later at your option).
  7 *
  8 * This software has been sponsored by Vyatta Inc. <http://www.vyatta.com>
  9 */
 10#include <linux/init.h>
 11#include <linux/module.h>
 12#include <linux/kernel.h>
 13#include <linux/skbuff.h>
 14#include <linux/netlink.h>
 15#include <linux/rculist.h>
 16#include <linux/slab.h>
 17#include <linux/types.h>
 18#include <linux/list.h>
 19#include <linux/errno.h>
 20#include <linux/capability.h>
 21#include <net/netlink.h>
 22#include <net/sock.h>
 23
 24#include <net/netfilter/nf_conntrack_helper.h>
 25#include <net/netfilter/nf_conntrack_expect.h>
 26#include <net/netfilter/nf_conntrack_ecache.h>
 27
 28#include <linux/netfilter/nfnetlink.h>
 29#include <linux/netfilter/nfnetlink_conntrack.h>
 30#include <linux/netfilter/nfnetlink_cthelper.h>
 31
 32MODULE_LICENSE("GPL");
 33MODULE_AUTHOR("Pablo Neira Ayuso <pablo@netfilter.org>");
 34MODULE_DESCRIPTION("nfnl_cthelper: User-space connection tracking helpers");
 35
 36struct nfnl_cthelper {
 37	struct list_head		list;
 38	struct nf_conntrack_helper	helper;
 39};
 40
 41static LIST_HEAD(nfnl_cthelper_list);
 42
 43static int
 44nfnl_userspace_cthelper(struct sk_buff *skb, unsigned int protoff,
 45			struct nf_conn *ct, enum ip_conntrack_info ctinfo)
 46{
 47	const struct nf_conn_help *help;
 48	struct nf_conntrack_helper *helper;
 49
 50	help = nfct_help(ct);
 51	if (help == NULL)
 52		return NF_DROP;
 53
 54	/* rcu_read_lock()ed by nf_hook_thresh */
 55	helper = rcu_dereference(help->helper);
 56	if (helper == NULL)
 57		return NF_DROP;
 58
 59	/* This is a user-space helper not yet configured, skip. */
 60	if ((helper->flags &
 61	    (NF_CT_HELPER_F_USERSPACE | NF_CT_HELPER_F_CONFIGURED)) ==
 62	     NF_CT_HELPER_F_USERSPACE)
 63		return NF_ACCEPT;
 64
 65	/* If the user-space helper is not available, don't block traffic. */
 66	return NF_QUEUE_NR(helper->queue_num) | NF_VERDICT_FLAG_QUEUE_BYPASS;
 67}
 68
 69static const struct nla_policy nfnl_cthelper_tuple_pol[NFCTH_TUPLE_MAX+1] = {
 70	[NFCTH_TUPLE_L3PROTONUM] = { .type = NLA_U16, },
 71	[NFCTH_TUPLE_L4PROTONUM] = { .type = NLA_U8, },
 72};
 73
 74static int
 75nfnl_cthelper_parse_tuple(struct nf_conntrack_tuple *tuple,
 76			  const struct nlattr *attr)
 77{
 78	int err;
 79	struct nlattr *tb[NFCTH_TUPLE_MAX+1];
 80
 81	err = nla_parse_nested(tb, NFCTH_TUPLE_MAX, attr,
 82			       nfnl_cthelper_tuple_pol, NULL);
 83	if (err < 0)
 84		return err;
 85
 86	if (!tb[NFCTH_TUPLE_L3PROTONUM] || !tb[NFCTH_TUPLE_L4PROTONUM])
 87		return -EINVAL;
 88
 89	/* Not all fields are initialized so first zero the tuple */
 90	memset(tuple, 0, sizeof(struct nf_conntrack_tuple));
 91
 92	tuple->src.l3num = ntohs(nla_get_be16(tb[NFCTH_TUPLE_L3PROTONUM]));
 93	tuple->dst.protonum = nla_get_u8(tb[NFCTH_TUPLE_L4PROTONUM]);
 94
 95	return 0;
 96}
 97
 98static int
 99nfnl_cthelper_from_nlattr(struct nlattr *attr, struct nf_conn *ct)
100{
101	struct nf_conn_help *help = nfct_help(ct);
102
103	if (attr == NULL)
104		return -EINVAL;
105
106	if (help->helper->data_len == 0)
107		return -EINVAL;
108
109	nla_memcpy(help->data, nla_data(attr), sizeof(help->data));
110	return 0;
111}
112
113static int
114nfnl_cthelper_to_nlattr(struct sk_buff *skb, const struct nf_conn *ct)
115{
116	const struct nf_conn_help *help = nfct_help(ct);
117
118	if (help->helper->data_len &&
119	    nla_put(skb, CTA_HELP_INFO, help->helper->data_len, &help->data))
120		goto nla_put_failure;
121
122	return 0;
123
124nla_put_failure:
125	return -ENOSPC;
126}
127
128static const struct nla_policy nfnl_cthelper_expect_pol[NFCTH_POLICY_MAX+1] = {
129	[NFCTH_POLICY_NAME] = { .type = NLA_NUL_STRING,
130				.len = NF_CT_HELPER_NAME_LEN-1 },
131	[NFCTH_POLICY_EXPECT_MAX] = { .type = NLA_U32, },
132	[NFCTH_POLICY_EXPECT_TIMEOUT] = { .type = NLA_U32, },
133};
134
135static int
136nfnl_cthelper_expect_policy(struct nf_conntrack_expect_policy *expect_policy,
137			    const struct nlattr *attr)
138{
139	int err;
140	struct nlattr *tb[NFCTH_POLICY_MAX+1];
141
142	err = nla_parse_nested(tb, NFCTH_POLICY_MAX, attr,
143			       nfnl_cthelper_expect_pol, NULL);
144	if (err < 0)
145		return err;
146
147	if (!tb[NFCTH_POLICY_NAME] ||
148	    !tb[NFCTH_POLICY_EXPECT_MAX] ||
149	    !tb[NFCTH_POLICY_EXPECT_TIMEOUT])
150		return -EINVAL;
151
152	nla_strlcpy(expect_policy->name,
153		    tb[NFCTH_POLICY_NAME], NF_CT_HELPER_NAME_LEN);
154	expect_policy->max_expected =
155		ntohl(nla_get_be32(tb[NFCTH_POLICY_EXPECT_MAX]));
156	if (expect_policy->max_expected > NF_CT_EXPECT_MAX_CNT)
157		return -EINVAL;
158
159	expect_policy->timeout =
160		ntohl(nla_get_be32(tb[NFCTH_POLICY_EXPECT_TIMEOUT]));
161
162	return 0;
163}
164
165static const struct nla_policy
166nfnl_cthelper_expect_policy_set[NFCTH_POLICY_SET_MAX+1] = {
167	[NFCTH_POLICY_SET_NUM] = { .type = NLA_U32, },
168};
169
170static int
171nfnl_cthelper_parse_expect_policy(struct nf_conntrack_helper *helper,
172				  const struct nlattr *attr)
173{
174	int i, ret;
175	struct nf_conntrack_expect_policy *expect_policy;
176	struct nlattr *tb[NFCTH_POLICY_SET_MAX+1];
177	unsigned int class_max;
178
179	ret = nla_parse_nested(tb, NFCTH_POLICY_SET_MAX, attr,
180			       nfnl_cthelper_expect_policy_set, NULL);
 
181	if (ret < 0)
182		return ret;
183
184	if (!tb[NFCTH_POLICY_SET_NUM])
185		return -EINVAL;
186
187	class_max = ntohl(nla_get_be32(tb[NFCTH_POLICY_SET_NUM]));
188	if (class_max == 0)
189		return -EINVAL;
190	if (class_max > NF_CT_MAX_EXPECT_CLASSES)
191		return -EOVERFLOW;
192
193	expect_policy = kzalloc(sizeof(struct nf_conntrack_expect_policy) *
194				class_max, GFP_KERNEL);
 
195	if (expect_policy == NULL)
196		return -ENOMEM;
197
198	for (i = 0; i < class_max; i++) {
199		if (!tb[NFCTH_POLICY_SET+i])
200			goto err;
201
202		ret = nfnl_cthelper_expect_policy(&expect_policy[i],
203						  tb[NFCTH_POLICY_SET+i]);
204		if (ret < 0)
205			goto err;
206	}
207
208	helper->expect_class_max = class_max - 1;
209	helper->expect_policy = expect_policy;
210	return 0;
211err:
212	kfree(expect_policy);
213	return -EINVAL;
214}
215
216static int
217nfnl_cthelper_create(const struct nlattr * const tb[],
218		     struct nf_conntrack_tuple *tuple)
219{
220	struct nf_conntrack_helper *helper;
221	struct nfnl_cthelper *nfcth;
222	unsigned int size;
223	int ret;
224
225	if (!tb[NFCTH_TUPLE] || !tb[NFCTH_POLICY] || !tb[NFCTH_PRIV_DATA_LEN])
226		return -EINVAL;
227
228	nfcth = kzalloc(sizeof(*nfcth), GFP_KERNEL);
229	if (nfcth == NULL)
230		return -ENOMEM;
231	helper = &nfcth->helper;
232
233	ret = nfnl_cthelper_parse_expect_policy(helper, tb[NFCTH_POLICY]);
234	if (ret < 0)
235		goto err1;
236
237	nla_strlcpy(helper->name,
238		    tb[NFCTH_NAME], NF_CT_HELPER_NAME_LEN);
239	size = ntohl(nla_get_be32(tb[NFCTH_PRIV_DATA_LEN]));
240	if (size > FIELD_SIZEOF(struct nf_conn_help, data)) {
241		ret = -ENOMEM;
242		goto err2;
243	}
 
244
245	helper->flags |= NF_CT_HELPER_F_USERSPACE;
246	memcpy(&helper->tuple, tuple, sizeof(struct nf_conntrack_tuple));
247
248	helper->me = THIS_MODULE;
249	helper->help = nfnl_userspace_cthelper;
250	helper->from_nlattr = nfnl_cthelper_from_nlattr;
251	helper->to_nlattr = nfnl_cthelper_to_nlattr;
252
253	/* Default to queue number zero, this can be updated at any time. */
254	if (tb[NFCTH_QUEUE_NUM])
255		helper->queue_num = ntohl(nla_get_be32(tb[NFCTH_QUEUE_NUM]));
256
257	if (tb[NFCTH_STATUS]) {
258		int status = ntohl(nla_get_be32(tb[NFCTH_STATUS]));
259
260		switch(status) {
261		case NFCT_HELPER_STATUS_ENABLED:
262			helper->flags |= NF_CT_HELPER_F_CONFIGURED;
263			break;
264		case NFCT_HELPER_STATUS_DISABLED:
265			helper->flags &= ~NF_CT_HELPER_F_CONFIGURED;
266			break;
267		}
268	}
269
270	ret = nf_conntrack_helper_register(helper);
271	if (ret < 0)
272		goto err2;
273
274	list_add_tail(&nfcth->list, &nfnl_cthelper_list);
275	return 0;
276err2:
277	kfree(helper->expect_policy);
278err1:
279	kfree(nfcth);
280	return ret;
281}
282
283static int
284nfnl_cthelper_update_policy_one(const struct nf_conntrack_expect_policy *policy,
285				struct nf_conntrack_expect_policy *new_policy,
286				const struct nlattr *attr)
287{
288	struct nlattr *tb[NFCTH_POLICY_MAX + 1];
289	int err;
290
291	err = nla_parse_nested(tb, NFCTH_POLICY_MAX, attr,
292			       nfnl_cthelper_expect_pol, NULL);
293	if (err < 0)
294		return err;
295
296	if (!tb[NFCTH_POLICY_NAME] ||
297	    !tb[NFCTH_POLICY_EXPECT_MAX] ||
298	    !tb[NFCTH_POLICY_EXPECT_TIMEOUT])
299		return -EINVAL;
300
301	if (nla_strcmp(tb[NFCTH_POLICY_NAME], policy->name))
302		return -EBUSY;
303
304	new_policy->max_expected =
305		ntohl(nla_get_be32(tb[NFCTH_POLICY_EXPECT_MAX]));
306	if (new_policy->max_expected > NF_CT_EXPECT_MAX_CNT)
307		return -EINVAL;
308
309	new_policy->timeout =
310		ntohl(nla_get_be32(tb[NFCTH_POLICY_EXPECT_TIMEOUT]));
311
312	return 0;
313}
314
315static int nfnl_cthelper_update_policy_all(struct nlattr *tb[],
316					   struct nf_conntrack_helper *helper)
317{
318	struct nf_conntrack_expect_policy *new_policy;
319	struct nf_conntrack_expect_policy *policy;
320	int i, ret = 0;
321
322	new_policy = kmalloc_array(helper->expect_class_max + 1,
323				   sizeof(*new_policy), GFP_KERNEL);
324	if (!new_policy)
325		return -ENOMEM;
326
327	/* Check first that all policy attributes are well-formed, so we don't
328	 * leave things in inconsistent state on errors.
329	 */
330	for (i = 0; i < helper->expect_class_max + 1; i++) {
331
332		if (!tb[NFCTH_POLICY_SET + i]) {
333			ret = -EINVAL;
334			goto err;
335		}
336
337		ret = nfnl_cthelper_update_policy_one(&helper->expect_policy[i],
338						      &new_policy[i],
339						      tb[NFCTH_POLICY_SET + i]);
340		if (ret < 0)
341			goto err;
342	}
343	/* Now we can safely update them. */
344	for (i = 0; i < helper->expect_class_max + 1; i++) {
345		policy = (struct nf_conntrack_expect_policy *)
346				&helper->expect_policy[i];
347		policy->max_expected = new_policy->max_expected;
348		policy->timeout	= new_policy->timeout;
349	}
350
351err:
352	kfree(new_policy);
353	return ret;
354}
355
356static int nfnl_cthelper_update_policy(struct nf_conntrack_helper *helper,
357				       const struct nlattr *attr)
358{
359	struct nlattr *tb[NFCTH_POLICY_SET_MAX + 1];
360	unsigned int class_max;
361	int err;
362
363	err = nla_parse_nested(tb, NFCTH_POLICY_SET_MAX, attr,
364			       nfnl_cthelper_expect_policy_set, NULL);
 
365	if (err < 0)
366		return err;
367
368	if (!tb[NFCTH_POLICY_SET_NUM])
369		return -EINVAL;
370
371	class_max = ntohl(nla_get_be32(tb[NFCTH_POLICY_SET_NUM]));
372	if (helper->expect_class_max + 1 != class_max)
373		return -EBUSY;
374
375	return nfnl_cthelper_update_policy_all(tb, helper);
376}
377
378static int
379nfnl_cthelper_update(const struct nlattr * const tb[],
380		     struct nf_conntrack_helper *helper)
381{
 
382	int ret;
383
384	if (tb[NFCTH_PRIV_DATA_LEN])
385		return -EBUSY;
 
 
 
386
387	if (tb[NFCTH_POLICY]) {
388		ret = nfnl_cthelper_update_policy(helper, tb[NFCTH_POLICY]);
389		if (ret < 0)
390			return ret;
391	}
392	if (tb[NFCTH_QUEUE_NUM])
393		helper->queue_num = ntohl(nla_get_be32(tb[NFCTH_QUEUE_NUM]));
394
395	if (tb[NFCTH_STATUS]) {
396		int status = ntohl(nla_get_be32(tb[NFCTH_STATUS]));
397
398		switch(status) {
399		case NFCT_HELPER_STATUS_ENABLED:
400			helper->flags |= NF_CT_HELPER_F_CONFIGURED;
401			break;
402		case NFCT_HELPER_STATUS_DISABLED:
403			helper->flags &= ~NF_CT_HELPER_F_CONFIGURED;
404			break;
405		}
406	}
407	return 0;
408}
409
410static int nfnl_cthelper_new(struct net *net, struct sock *nfnl,
411			     struct sk_buff *skb, const struct nlmsghdr *nlh,
412			     const struct nlattr * const tb[],
413			     struct netlink_ext_ack *extack)
414{
415	const char *helper_name;
416	struct nf_conntrack_helper *cur, *helper = NULL;
417	struct nf_conntrack_tuple tuple;
418	struct nfnl_cthelper *nlcth;
419	int ret = 0;
420
421	if (!capable(CAP_NET_ADMIN))
422		return -EPERM;
423
424	if (!tb[NFCTH_NAME] || !tb[NFCTH_TUPLE])
425		return -EINVAL;
426
427	helper_name = nla_data(tb[NFCTH_NAME]);
428
429	ret = nfnl_cthelper_parse_tuple(&tuple, tb[NFCTH_TUPLE]);
430	if (ret < 0)
431		return ret;
432
433	list_for_each_entry(nlcth, &nfnl_cthelper_list, list) {
434		cur = &nlcth->helper;
435
436		if (strncmp(cur->name, helper_name, NF_CT_HELPER_NAME_LEN))
437			continue;
438
439		if ((tuple.src.l3num != cur->tuple.src.l3num ||
440		     tuple.dst.protonum != cur->tuple.dst.protonum))
441			continue;
442
443		if (nlh->nlmsg_flags & NLM_F_EXCL)
444			return -EEXIST;
445
446		helper = cur;
447		break;
448	}
449
450	if (helper == NULL)
451		ret = nfnl_cthelper_create(tb, &tuple);
452	else
453		ret = nfnl_cthelper_update(tb, helper);
454
455	return ret;
456}
457
458static int
459nfnl_cthelper_dump_tuple(struct sk_buff *skb,
460			 struct nf_conntrack_helper *helper)
461{
462	struct nlattr *nest_parms;
463
464	nest_parms = nla_nest_start(skb, NFCTH_TUPLE | NLA_F_NESTED);
465	if (nest_parms == NULL)
466		goto nla_put_failure;
467
468	if (nla_put_be16(skb, NFCTH_TUPLE_L3PROTONUM,
469			 htons(helper->tuple.src.l3num)))
470		goto nla_put_failure;
471
472	if (nla_put_u8(skb, NFCTH_TUPLE_L4PROTONUM, helper->tuple.dst.protonum))
473		goto nla_put_failure;
474
475	nla_nest_end(skb, nest_parms);
476	return 0;
477
478nla_put_failure:
479	return -1;
480}
481
482static int
483nfnl_cthelper_dump_policy(struct sk_buff *skb,
484			struct nf_conntrack_helper *helper)
485{
486	int i;
487	struct nlattr *nest_parms1, *nest_parms2;
488
489	nest_parms1 = nla_nest_start(skb, NFCTH_POLICY | NLA_F_NESTED);
490	if (nest_parms1 == NULL)
491		goto nla_put_failure;
492
493	if (nla_put_be32(skb, NFCTH_POLICY_SET_NUM,
494			 htonl(helper->expect_class_max + 1)))
495		goto nla_put_failure;
496
497	for (i = 0; i < helper->expect_class_max + 1; i++) {
498		nest_parms2 = nla_nest_start(skb,
499				(NFCTH_POLICY_SET+i) | NLA_F_NESTED);
500		if (nest_parms2 == NULL)
501			goto nla_put_failure;
502
503		if (nla_put_string(skb, NFCTH_POLICY_NAME,
504				   helper->expect_policy[i].name))
505			goto nla_put_failure;
506
507		if (nla_put_be32(skb, NFCTH_POLICY_EXPECT_MAX,
508				 htonl(helper->expect_policy[i].max_expected)))
509			goto nla_put_failure;
510
511		if (nla_put_be32(skb, NFCTH_POLICY_EXPECT_TIMEOUT,
512				 htonl(helper->expect_policy[i].timeout)))
513			goto nla_put_failure;
514
515		nla_nest_end(skb, nest_parms2);
516	}
517	nla_nest_end(skb, nest_parms1);
518	return 0;
519
520nla_put_failure:
521	return -1;
522}
523
524static int
525nfnl_cthelper_fill_info(struct sk_buff *skb, u32 portid, u32 seq, u32 type,
526			int event, struct nf_conntrack_helper *helper)
527{
528	struct nlmsghdr *nlh;
529	struct nfgenmsg *nfmsg;
530	unsigned int flags = portid ? NLM_F_MULTI : 0;
531	int status;
532
533	event = nfnl_msg_type(NFNL_SUBSYS_CTHELPER, event);
534	nlh = nlmsg_put(skb, portid, seq, event, sizeof(*nfmsg), flags);
535	if (nlh == NULL)
 
536		goto nlmsg_failure;
537
538	nfmsg = nlmsg_data(nlh);
539	nfmsg->nfgen_family = AF_UNSPEC;
540	nfmsg->version = NFNETLINK_V0;
541	nfmsg->res_id = 0;
542
543	if (nla_put_string(skb, NFCTH_NAME, helper->name))
544		goto nla_put_failure;
545
546	if (nla_put_be32(skb, NFCTH_QUEUE_NUM, htonl(helper->queue_num)))
547		goto nla_put_failure;
548
549	if (nfnl_cthelper_dump_tuple(skb, helper) < 0)
550		goto nla_put_failure;
551
552	if (nfnl_cthelper_dump_policy(skb, helper) < 0)
553		goto nla_put_failure;
554
555	if (nla_put_be32(skb, NFCTH_PRIV_DATA_LEN, htonl(helper->data_len)))
556		goto nla_put_failure;
557
558	if (helper->flags & NF_CT_HELPER_F_CONFIGURED)
559		status = NFCT_HELPER_STATUS_ENABLED;
560	else
561		status = NFCT_HELPER_STATUS_DISABLED;
562
563	if (nla_put_be32(skb, NFCTH_STATUS, htonl(status)))
564		goto nla_put_failure;
565
566	nlmsg_end(skb, nlh);
567	return skb->len;
568
569nlmsg_failure:
570nla_put_failure:
571	nlmsg_cancel(skb, nlh);
572	return -1;
573}
574
575static int
576nfnl_cthelper_dump_table(struct sk_buff *skb, struct netlink_callback *cb)
577{
578	struct nf_conntrack_helper *cur, *last;
579
580	rcu_read_lock();
581	last = (struct nf_conntrack_helper *)cb->args[1];
582	for (; cb->args[0] < nf_ct_helper_hsize; cb->args[0]++) {
583restart:
584		hlist_for_each_entry_rcu(cur,
585				&nf_ct_helper_hash[cb->args[0]], hnode) {
586
587			/* skip non-userspace conntrack helpers. */
588			if (!(cur->flags & NF_CT_HELPER_F_USERSPACE))
589				continue;
590
591			if (cb->args[1]) {
592				if (cur != last)
593					continue;
594				cb->args[1] = 0;
595			}
596			if (nfnl_cthelper_fill_info(skb,
597					    NETLINK_CB(cb->skb).portid,
598					    cb->nlh->nlmsg_seq,
599					    NFNL_MSG_TYPE(cb->nlh->nlmsg_type),
600					    NFNL_MSG_CTHELPER_NEW, cur) < 0) {
601				cb->args[1] = (unsigned long)cur;
602				goto out;
603			}
604		}
605	}
606	if (cb->args[1]) {
607		cb->args[1] = 0;
608		goto restart;
609	}
610out:
611	rcu_read_unlock();
612	return skb->len;
613}
614
615static int nfnl_cthelper_get(struct net *net, struct sock *nfnl,
616			     struct sk_buff *skb, const struct nlmsghdr *nlh,
617			     const struct nlattr * const tb[],
618			     struct netlink_ext_ack *extack)
619{
620	int ret = -ENOENT;
621	struct nf_conntrack_helper *cur;
622	struct sk_buff *skb2;
623	char *helper_name = NULL;
624	struct nf_conntrack_tuple tuple;
625	struct nfnl_cthelper *nlcth;
626	bool tuple_set = false;
627
628	if (!capable(CAP_NET_ADMIN))
629		return -EPERM;
630
631	if (nlh->nlmsg_flags & NLM_F_DUMP) {
632		struct netlink_dump_control c = {
633			.dump = nfnl_cthelper_dump_table,
634		};
635		return netlink_dump_start(nfnl, skb, nlh, &c);
636	}
637
638	if (tb[NFCTH_NAME])
639		helper_name = nla_data(tb[NFCTH_NAME]);
640
641	if (tb[NFCTH_TUPLE]) {
642		ret = nfnl_cthelper_parse_tuple(&tuple, tb[NFCTH_TUPLE]);
643		if (ret < 0)
644			return ret;
645
646		tuple_set = true;
647	}
648
649	list_for_each_entry(nlcth, &nfnl_cthelper_list, list) {
650		cur = &nlcth->helper;
651		if (helper_name &&
652		    strncmp(cur->name, helper_name, NF_CT_HELPER_NAME_LEN))
653			continue;
654
655		if (tuple_set &&
656		    (tuple.src.l3num != cur->tuple.src.l3num ||
657		     tuple.dst.protonum != cur->tuple.dst.protonum))
658			continue;
659
660		skb2 = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
661		if (skb2 == NULL) {
662			ret = -ENOMEM;
663			break;
664		}
665
666		ret = nfnl_cthelper_fill_info(skb2, NETLINK_CB(skb).portid,
667					      nlh->nlmsg_seq,
668					      NFNL_MSG_TYPE(nlh->nlmsg_type),
669					      NFNL_MSG_CTHELPER_NEW, cur);
670		if (ret <= 0) {
671			kfree_skb(skb2);
672			break;
673		}
674
675		ret = netlink_unicast(nfnl, skb2, NETLINK_CB(skb).portid,
676				      MSG_DONTWAIT);
677		if (ret > 0)
678			ret = 0;
679
680		/* this avoids a loop in nfnetlink. */
681		return ret == -EAGAIN ? -ENOBUFS : ret;
682	}
683	return ret;
684}
685
686static int nfnl_cthelper_del(struct net *net, struct sock *nfnl,
687			     struct sk_buff *skb, const struct nlmsghdr *nlh,
688			     const struct nlattr * const tb[],
689			     struct netlink_ext_ack *extack)
690{
691	char *helper_name = NULL;
692	struct nf_conntrack_helper *cur;
693	struct nf_conntrack_tuple tuple;
694	bool tuple_set = false, found = false;
695	struct nfnl_cthelper *nlcth, *n;
696	int j = 0, ret;
697
698	if (!capable(CAP_NET_ADMIN))
699		return -EPERM;
700
701	if (tb[NFCTH_NAME])
702		helper_name = nla_data(tb[NFCTH_NAME]);
703
704	if (tb[NFCTH_TUPLE]) {
705		ret = nfnl_cthelper_parse_tuple(&tuple, tb[NFCTH_TUPLE]);
706		if (ret < 0)
707			return ret;
708
709		tuple_set = true;
710	}
711
712	ret = -ENOENT;
713	list_for_each_entry_safe(nlcth, n, &nfnl_cthelper_list, list) {
714		cur = &nlcth->helper;
715		j++;
716
717		if (helper_name &&
718		    strncmp(cur->name, helper_name, NF_CT_HELPER_NAME_LEN))
719			continue;
720
721		if (tuple_set &&
722		    (tuple.src.l3num != cur->tuple.src.l3num ||
723		     tuple.dst.protonum != cur->tuple.dst.protonum))
724			continue;
725
726		if (refcount_dec_if_one(&cur->refcnt)) {
727			found = true;
728			nf_conntrack_helper_unregister(cur);
729			kfree(cur->expect_policy);
730
731			list_del(&nlcth->list);
732			kfree(nlcth);
733		} else {
734			ret = -EBUSY;
735		}
736	}
737
738	/* Make sure we return success if we flush and there is no helpers */
739	return (found || j == 0) ? 0 : ret;
740}
741
742static const struct nla_policy nfnl_cthelper_policy[NFCTH_MAX+1] = {
743	[NFCTH_NAME] = { .type = NLA_NUL_STRING,
744			 .len = NF_CT_HELPER_NAME_LEN-1 },
745	[NFCTH_QUEUE_NUM] = { .type = NLA_U32, },
 
 
746};
747
748static const struct nfnl_callback nfnl_cthelper_cb[NFNL_MSG_CTHELPER_MAX] = {
749	[NFNL_MSG_CTHELPER_NEW]		= { .call = nfnl_cthelper_new,
750					    .attr_count = NFCTH_MAX,
751					    .policy = nfnl_cthelper_policy },
752	[NFNL_MSG_CTHELPER_GET]		= { .call = nfnl_cthelper_get,
753					    .attr_count = NFCTH_MAX,
754					    .policy = nfnl_cthelper_policy },
755	[NFNL_MSG_CTHELPER_DEL]		= { .call = nfnl_cthelper_del,
756					    .attr_count = NFCTH_MAX,
757					    .policy = nfnl_cthelper_policy },
 
 
 
 
 
 
 
 
 
758};
759
760static const struct nfnetlink_subsystem nfnl_cthelper_subsys = {
761	.name				= "cthelper",
762	.subsys_id			= NFNL_SUBSYS_CTHELPER,
763	.cb_count			= NFNL_MSG_CTHELPER_MAX,
764	.cb				= nfnl_cthelper_cb,
765};
766
767MODULE_ALIAS_NFNL_SUBSYS(NFNL_SUBSYS_CTHELPER);
768
769static int __init nfnl_cthelper_init(void)
770{
771	int ret;
772
773	ret = nfnetlink_subsys_register(&nfnl_cthelper_subsys);
774	if (ret < 0) {
775		pr_err("nfnl_cthelper: cannot register with nfnetlink.\n");
776		goto err_out;
777	}
778	return 0;
779err_out:
780	return ret;
781}
782
783static void __exit nfnl_cthelper_exit(void)
784{
785	struct nf_conntrack_helper *cur;
786	struct nfnl_cthelper *nlcth, *n;
787
788	nfnetlink_subsys_unregister(&nfnl_cthelper_subsys);
789
790	list_for_each_entry_safe(nlcth, n, &nfnl_cthelper_list, list) {
791		cur = &nlcth->helper;
792
793		nf_conntrack_helper_unregister(cur);
794		kfree(cur->expect_policy);
795		kfree(nlcth);
796	}
797}
798
799module_init(nfnl_cthelper_init);
800module_exit(nfnl_cthelper_exit);