genetlink.c 21.5 KB
Newer Older
1
2
3
4
5
/*
 * NETLINK      Generic Netlink Family
 *
 * 		Authors:	Jamal Hadi Salim
 * 				Thomas Graf <tgraf@suug.ch>
6
 *				Johannes Berg <johannes@sipsolutions.net>
7
8
9
10
 */

#include <linux/module.h>
#include <linux/kernel.h>
11
#include <linux/slab.h>
12
13
14
15
16
#include <linux/errno.h>
#include <linux/types.h>
#include <linux/socket.h>
#include <linux/string.h>
#include <linux/skbuff.h>
17
#include <linux/mutex.h>
18
#include <linux/bitmap.h>
19
20
21
#include <net/sock.h>
#include <net/genetlink.h>

22
static DEFINE_MUTEX(genl_mutex); /* serialization of message processing */
23

24
void genl_lock(void)
25
{
26
	mutex_lock(&genl_mutex);
27
}
28
EXPORT_SYMBOL(genl_lock);
29

30
void genl_unlock(void)
31
{
32
	mutex_unlock(&genl_mutex);
33
}
34
EXPORT_SYMBOL(genl_unlock);
35
36
37
38
39

#define GENL_FAM_TAB_SIZE	16
#define GENL_FAM_TAB_MASK	(GENL_FAM_TAB_SIZE - 1)

static struct list_head family_ht[GENL_FAM_TAB_SIZE];
40
41
42
43
44
45
46
47
48
49
/*
 * Bitmap of multicast groups that are currently in use.
 *
 * To avoid an allocation at boot of just one unsigned long,
 * declare it global instead.
 * Bit 0 is marked as already used since group 0 is invalid.
 */
static unsigned long mc_group_start = 0x1;
static unsigned long *mc_groups = &mc_group_start;
static unsigned long mc_groups_longs = 1;
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102

static int genl_ctrl_event(int event, void *data);

static inline unsigned int genl_family_hash(unsigned int id)
{
	return id & GENL_FAM_TAB_MASK;
}

static inline struct list_head *genl_family_chain(unsigned int id)
{
	return &family_ht[genl_family_hash(id)];
}

static struct genl_family *genl_family_find_byid(unsigned int id)
{
	struct genl_family *f;

	list_for_each_entry(f, genl_family_chain(id), family_list)
		if (f->id == id)
			return f;

	return NULL;
}

static struct genl_family *genl_family_find_byname(char *name)
{
	struct genl_family *f;
	int i;

	for (i = 0; i < GENL_FAM_TAB_SIZE; i++)
		list_for_each_entry(f, genl_family_chain(i), family_list)
			if (strcmp(f->name, name) == 0)
				return f;

	return NULL;
}

static struct genl_ops *genl_get_cmd(u8 cmd, struct genl_family *family)
{
	struct genl_ops *ops;

	list_for_each_entry(ops, &family->ops_list, ops_list)
		if (ops->cmd == cmd)
			return ops;

	return NULL;
}

/* Of course we are going to have problems once we hit
 * 2^16 alive types, but that can only happen by year 2K
*/
static inline u16 genl_generate_id(void)
{
103
104
	static u16 id_gen_idx = GENL_MIN_ID;
	int i;
105

106
107
108
109
	for (i = 0; i <= GENL_MAX_ID - GENL_MIN_ID; i++) {
		if (!genl_family_find_byid(id_gen_idx))
			return id_gen_idx;
		if (++id_gen_idx > GENL_MAX_ID)
110
			id_gen_idx = GENL_MIN_ID;
111
	}
112

113
	return 0;
114
115
}

116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
static struct genl_multicast_group notify_grp;

/**
 * genl_register_mc_group - register a multicast group
 *
 * Registers the specified multicast group and notifies userspace
 * about the new group.
 *
 * Returns 0 on success or a negative error code.
 *
 * @family: The generic netlink family the group shall be registered for.
 * @grp: The group to register, must have a name.
 */
int genl_register_mc_group(struct genl_family *family,
			   struct genl_multicast_group *grp)
{
	int id;
	unsigned long *new_groups;
134
	int err = 0;
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170

	BUG_ON(grp->name[0] == '\0');

	genl_lock();

	/* special-case our own group */
	if (grp == &notify_grp)
		id = GENL_ID_CTRL;
	else
		id = find_first_zero_bit(mc_groups,
					 mc_groups_longs * BITS_PER_LONG);


	if (id >= mc_groups_longs * BITS_PER_LONG) {
		size_t nlen = (mc_groups_longs + 1) * sizeof(unsigned long);

		if (mc_groups == &mc_group_start) {
			new_groups = kzalloc(nlen, GFP_KERNEL);
			if (!new_groups) {
				err = -ENOMEM;
				goto out;
			}
			mc_groups = new_groups;
			*mc_groups = mc_group_start;
		} else {
			new_groups = krealloc(mc_groups, nlen, GFP_KERNEL);
			if (!new_groups) {
				err = -ENOMEM;
				goto out;
			}
			mc_groups = new_groups;
			mc_groups[mc_groups_longs] = 0;
		}
		mc_groups_longs++;
	}

Johannes Berg's avatar
Johannes Berg committed
171
172
173
	if (family->netnsok) {
		struct net *net;

174
		netlink_table_grab();
Johannes Berg's avatar
Johannes Berg committed
175
176
		rcu_read_lock();
		for_each_net_rcu(net) {
177
			err = __netlink_change_ngroups(net->genl_sock,
Johannes Berg's avatar
Johannes Berg committed
178
179
180
181
182
183
184
185
186
					mc_groups_longs * BITS_PER_LONG);
			if (err) {
				/*
				 * No need to roll back, can only fail if
				 * memory allocation fails and then the
				 * number of _possible_ groups has been
				 * increased on some sockets which is ok.
				 */
				rcu_read_unlock();
187
				netlink_table_ungrab();
Johannes Berg's avatar
Johannes Berg committed
188
189
190
191
				goto out;
			}
		}
		rcu_read_unlock();
192
		netlink_table_ungrab();
Johannes Berg's avatar
Johannes Berg committed
193
194
195
196
197
198
	} else {
		err = netlink_change_ngroups(init_net.genl_sock,
					     mc_groups_longs * BITS_PER_LONG);
		if (err)
			goto out;
	}
199
200
201
202
203
204
205
206
207

	grp->id = id;
	set_bit(id, mc_groups);
	list_add_tail(&grp->list, &family->mcast_groups);
	grp->family = family;

	genl_ctrl_event(CTRL_CMD_NEWMCAST_GRP, grp);
 out:
	genl_unlock();
208
	return err;
209
210
211
}
EXPORT_SYMBOL(genl_register_mc_group);

212
213
214
static void __genl_unregister_mc_group(struct genl_family *family,
				       struct genl_multicast_group *grp)
{
Johannes Berg's avatar
Johannes Berg committed
215
	struct net *net;
216
	BUG_ON(grp->family != family);
Johannes Berg's avatar
Johannes Berg committed
217

218
	netlink_table_grab();
Johannes Berg's avatar
Johannes Berg committed
219
220
	rcu_read_lock();
	for_each_net_rcu(net)
221
		__netlink_clear_multicast_users(net->genl_sock, grp->id);
Johannes Berg's avatar
Johannes Berg committed
222
	rcu_read_unlock();
223
	netlink_table_ungrab();
Johannes Berg's avatar
Johannes Berg committed
224

225
226
227
228
229
230
231
	clear_bit(grp->id, mc_groups);
	list_del(&grp->list);
	genl_ctrl_event(CTRL_CMD_DELMCAST_GRP, grp);
	grp->id = 0;
	grp->family = NULL;
}

232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
/**
 * genl_unregister_mc_group - unregister a multicast group
 *
 * Unregisters the specified multicast group and notifies userspace
 * about it. All current listeners on the group are removed.
 *
 * Note: It is not necessary to unregister all multicast groups before
 *       unregistering the family, unregistering the family will cause
 *       all assigned multicast groups to be unregistered automatically.
 *
 * @family: Generic netlink family the group belongs to.
 * @grp: The group to unregister, must have been registered successfully
 *	 previously.
 */
void genl_unregister_mc_group(struct genl_family *family,
			      struct genl_multicast_group *grp)
{
	genl_lock();
250
	__genl_unregister_mc_group(family, grp);
251
252
	genl_unlock();
}
253
EXPORT_SYMBOL(genl_unregister_mc_group);
254
255
256
257
258
259

static void genl_unregister_mc_groups(struct genl_family *family)
{
	struct genl_multicast_group *grp, *tmp;

	list_for_each_entry_safe(grp, tmp, &family->mcast_groups, list)
260
		__genl_unregister_mc_group(family, grp);
261
262
}

263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
/**
 * genl_register_ops - register generic netlink operations
 * @family: generic netlink family
 * @ops: operations to be registered
 *
 * Registers the specified operations and assigns them to the specified
 * family. Either a doit or dumpit callback must be specified or the
 * operation will fail. Only one operation structure per command
 * identifier may be registered.
 *
 * See include/net/genetlink.h for more documenation on the operations
 * structure.
 *
 * Returns 0 on success or a negative error code.
 */
int genl_register_ops(struct genl_family *family, struct genl_ops *ops)
{
	int err = -EINVAL;

	if (ops->dumpit == NULL && ops->doit == NULL)
		goto errout;

	if (genl_get_cmd(ops->cmd, family)) {
		err = -EEXIST;
		goto errout;
	}

290
291
	if (ops->dumpit)
		ops->flags |= GENL_CMD_CAP_DUMP;
292
293
	if (ops->doit)
		ops->flags |= GENL_CMD_CAP_DO;
294
295
296
	if (ops->policy)
		ops->flags |= GENL_CMD_CAP_HASPOL;

297
298
299
300
301
302
303
304
305
	genl_lock();
	list_add_tail(&ops->ops_list, &family->ops_list);
	genl_unlock();

	genl_ctrl_event(CTRL_CMD_NEWOPS, ops);
	err = 0;
errout:
	return err;
}
306
EXPORT_SYMBOL(genl_register_ops);
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340

/**
 * genl_unregister_ops - unregister generic netlink operations
 * @family: generic netlink family
 * @ops: operations to be unregistered
 *
 * Unregisters the specified operations and unassigns them from the
 * specified family. The operation blocks until the current message
 * processing has finished and doesn't start again until the
 * unregister process has finished.
 *
 * Note: It is not necessary to unregister all operations before
 *       unregistering the family, unregistering the family will cause
 *       all assigned operations to be unregistered automatically.
 *
 * Returns 0 on success or a negative error code.
 */
int genl_unregister_ops(struct genl_family *family, struct genl_ops *ops)
{
	struct genl_ops *rc;

	genl_lock();
	list_for_each_entry(rc, &family->ops_list, ops_list) {
		if (rc == ops) {
			list_del(&ops->ops_list);
			genl_unlock();
			genl_ctrl_event(CTRL_CMD_DELOPS, ops);
			return 0;
		}
	}
	genl_unlock();

	return -ENOENT;
}
341
EXPORT_SYMBOL(genl_unregister_ops);
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364

/**
 * genl_register_family - register a generic netlink family
 * @family: generic netlink family
 *
 * Registers the specified family after validating it first. Only one
 * family may be registered with the same family name or identifier.
 * The family id may equal GENL_ID_GENERATE causing an unique id to
 * be automatically generated and assigned.
 *
 * Return 0 on success or a negative error code.
 */
int genl_register_family(struct genl_family *family)
{
	int err = -EINVAL;

	if (family->id && family->id < GENL_MIN_ID)
		goto errout;

	if (family->id > GENL_MAX_ID)
		goto errout;

	INIT_LIST_HEAD(&family->ops_list);
365
	INIT_LIST_HEAD(&family->mcast_groups);
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382

	genl_lock();

	if (genl_family_find_byname(family->name)) {
		err = -EEXIST;
		goto errout_locked;
	}

	if (family->id == GENL_ID_GENERATE) {
		u16 newid = genl_generate_id();

		if (!newid) {
			err = -ENOMEM;
			goto errout_locked;
		}

		family->id = newid;
383
384
385
	} else if (genl_family_find_byid(family->id)) {
		err = -EEXIST;
		goto errout_locked;
386
387
388
389
390
391
392
	}

	if (family->maxattr) {
		family->attrbuf = kmalloc((family->maxattr+1) *
					sizeof(struct nlattr *), GFP_KERNEL);
		if (family->attrbuf == NULL) {
			err = -ENOMEM;
393
			goto errout_locked;
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
		}
	} else
		family->attrbuf = NULL;

	list_add_tail(&family->family_list, genl_family_chain(family->id));
	genl_unlock();

	genl_ctrl_event(CTRL_CMD_NEWFAMILY, family);

	return 0;

errout_locked:
	genl_unlock();
errout:
	return err;
}
410
EXPORT_SYMBOL(genl_register_family);
411

412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450
451
452
453
454
455
456
457
/**
 * genl_register_family_with_ops - register a generic netlink family
 * @family: generic netlink family
 * @ops: operations to be registered
 * @n_ops: number of elements to register
 *
 * Registers the specified family and operations from the specified table.
 * Only one family may be registered with the same family name or identifier.
 *
 * The family id may equal GENL_ID_GENERATE causing an unique id to
 * be automatically generated and assigned.
 *
 * Either a doit or dumpit callback must be specified for every registered
 * operation or the function will fail. Only one operation structure per
 * command identifier may be registered.
 *
 * See include/net/genetlink.h for more documenation on the operations
 * structure.
 *
 * This is equivalent to calling genl_register_family() followed by
 * genl_register_ops() for every operation entry in the table taking
 * care to unregister the family on error path.
 *
 * Return 0 on success or a negative error code.
 */
int genl_register_family_with_ops(struct genl_family *family,
	struct genl_ops *ops, size_t n_ops)
{
	int err, i;

	err = genl_register_family(family);
	if (err)
		return err;

	for (i = 0; i < n_ops; ++i, ++ops) {
		err = genl_register_ops(family, ops);
		if (err)
			goto err_out;
	}
	return 0;
err_out:
	genl_unregister_family(family);
	return err;
}
EXPORT_SYMBOL(genl_register_family_with_ops);

458
459
460
461
462
463
464
465
466
467
468
469
470
471
/**
 * genl_unregister_family - unregister generic netlink family
 * @family: generic netlink family
 *
 * Unregisters the specified family.
 *
 * Returns 0 on success or a negative error code.
 */
int genl_unregister_family(struct genl_family *family)
{
	struct genl_family *rc;

	genl_lock();

472
473
	genl_unregister_mc_groups(family);

474
475
476
477
478
479
480
481
482
483
484
485
486
487
488
489
490
	list_for_each_entry(rc, genl_family_chain(family->id), family_list) {
		if (family->id != rc->id || strcmp(rc->name, family->name))
			continue;

		list_del(&rc->family_list);
		INIT_LIST_HEAD(&family->ops_list);
		genl_unlock();

		kfree(family->attrbuf);
		genl_ctrl_event(CTRL_CMD_DELFAMILY, family);
		return 0;
	}

	genl_unlock();

	return -ENOENT;
}
491
EXPORT_SYMBOL(genl_unregister_family);
492

493
static int genl_rcv_msg(struct sk_buff *skb, struct nlmsghdr *nlh)
494
495
496
{
	struct genl_ops *ops;
	struct genl_family *family;
Johannes Berg's avatar
Johannes Berg committed
497
	struct net *net = sock_net(skb->sk);
498
499
	struct genl_info info;
	struct genlmsghdr *hdr = nlmsg_data(nlh);
500
	int hdrlen, err;
501

502
	family = genl_family_find_byid(nlh->nlmsg_type);
503
504
	if (family == NULL)
		return -ENOENT;
505

Johannes Berg's avatar
Johannes Berg committed
506
507
508
509
	/* this family doesn't exist in this netns */
	if (!family->netnsok && !net_eq(net, &init_net))
		return -ENOENT;

510
511
	hdrlen = GENL_HDRLEN + family->hdrsize;
	if (nlh->nlmsg_len < nlmsg_msg_size(hdrlen))
512
		return -EINVAL;
513
514

	ops = genl_get_cmd(hdr->cmd, family);
515
516
	if (ops == NULL)
		return -EOPNOTSUPP;
517

518
519
520
	if ((ops->flags & GENL_ADMIN_PERM) &&
	    security_netlink_recv(skb, CAP_NET_ADMIN))
		return -EPERM;
521

522
	if (nlh->nlmsg_flags & NLM_F_DUMP) {
523
524
		if (ops->dumpit == NULL)
			return -EOPNOTSUPP;
525

526
		genl_unlock();
Johannes Berg's avatar
Johannes Berg committed
527
		err = netlink_dump_start(net->genl_sock, skb, nlh,
528
529
530
					 ops->dumpit, ops->done);
		genl_lock();
		return err;
531
532
	}

533
534
	if (ops->doit == NULL)
		return -EOPNOTSUPP;
535
536
537
538
539

	if (family->attrbuf) {
		err = nlmsg_parse(nlh, hdrlen, family->attrbuf, family->maxattr,
				  ops->policy);
		if (err < 0)
540
			return err;
541
542
543
544
545
546
547
548
	}

	info.snd_seq = nlh->nlmsg_seq;
	info.snd_pid = NETLINK_CB(skb).pid;
	info.nlhdr = nlh;
	info.genlhdr = nlmsg_data(nlh);
	info.userhdr = nlmsg_data(nlh) + GENL_HDRLEN;
	info.attrs = family->attrbuf;
Johannes Berg's avatar
Johannes Berg committed
549
	genl_info_net_set(&info, net);
550
	memset(&info.user_ptr, 0, sizeof(info.user_ptr));
551

552
553
554
555
556
557
558
559
560
561
562
563
	if (family->pre_doit) {
		err = family->pre_doit(ops, skb, &info);
		if (err)
			return err;
	}

	err = ops->doit(skb, &info);

	if (family->post_doit)
		family->post_doit(ops, skb, &info);

	return err;
564
565
}

566
static void genl_rcv(struct sk_buff *skb)
567
{
568
569
570
	genl_lock();
	netlink_rcv_skb(skb, &genl_rcv_msg);
	genl_unlock();
571
572
573
574
575
576
}

/**************************************************************************
 * Controller
 **************************************************************************/

577
578
579
static struct genl_family genl_ctrl = {
	.id = GENL_ID_CTRL,
	.name = "nlctrl",
580
	.version = 0x2,
581
	.maxattr = CTRL_ATTR_MAX,
Johannes Berg's avatar
Johannes Berg committed
582
	.netnsok = true,
583
584
};

585
586
587
588
589
static int ctrl_fill_info(struct genl_family *family, u32 pid, u32 seq,
			  u32 flags, struct sk_buff *skb, u8 cmd)
{
	void *hdr;

590
	hdr = genlmsg_put(skb, pid, seq, &genl_ctrl, flags, cmd);
591
592
593
594
595
	if (hdr == NULL)
		return -1;

	NLA_PUT_STRING(skb, CTRL_ATTR_FAMILY_NAME, family->name);
	NLA_PUT_U16(skb, CTRL_ATTR_FAMILY_ID, family->id);
596
597
598
599
	NLA_PUT_U32(skb, CTRL_ATTR_VERSION, family->version);
	NLA_PUT_U32(skb, CTRL_ATTR_HDRSIZE, family->hdrsize);
	NLA_PUT_U32(skb, CTRL_ATTR_MAXATTR, family->maxattr);

600
601
602
603
	if (!list_empty(&family->ops_list)) {
		struct nlattr *nla_ops;
		struct genl_ops *ops;
		int idx = 1;
604

605
606
		nla_ops = nla_nest_start(skb, CTRL_ATTR_OPS);
		if (nla_ops == NULL)
607
608
			goto nla_put_failure;

609
610
		list_for_each_entry(ops, &family->ops_list, ops_list) {
			struct nlattr *nest;
611

612
613
614
			nest = nla_nest_start(skb, idx++);
			if (nest == NULL)
				goto nla_put_failure;
615

616
617
			NLA_PUT_U32(skb, CTRL_ATTR_OP_ID, ops->cmd);
			NLA_PUT_U32(skb, CTRL_ATTR_OP_FLAGS, ops->flags);
618

619
620
621
622
623
			nla_nest_end(skb, nest);
		}

		nla_nest_end(skb, nla_ops);
	}
624

625
626
627
628
629
630
631
632
633
634
635
636
637
638
639
640
641
642
643
644
645
646
647
648
649
650
651
652
	if (!list_empty(&family->mcast_groups)) {
		struct genl_multicast_group *grp;
		struct nlattr *nla_grps;
		int idx = 1;

		nla_grps = nla_nest_start(skb, CTRL_ATTR_MCAST_GROUPS);
		if (nla_grps == NULL)
			goto nla_put_failure;

		list_for_each_entry(grp, &family->mcast_groups, list) {
			struct nlattr *nest;

			nest = nla_nest_start(skb, idx++);
			if (nest == NULL)
				goto nla_put_failure;

			NLA_PUT_U32(skb, CTRL_ATTR_MCAST_GRP_ID, grp->id);
			NLA_PUT_STRING(skb, CTRL_ATTR_MCAST_GRP_NAME,
				       grp->name);

			nla_nest_end(skb, nest);
		}
		nla_nest_end(skb, nla_grps);
	}

	return genlmsg_end(skb, hdr);

nla_put_failure:
653
654
	genlmsg_cancel(skb, hdr);
	return -EMSGSIZE;
655
656
657
658
659
660
661
662
663
664
665
666
667
668
669
670
671
672
673
674
675
676
677
678
679
680
681
682
683
684
685
686
}

static int ctrl_fill_mcgrp_info(struct genl_multicast_group *grp, u32 pid,
				u32 seq, u32 flags, struct sk_buff *skb,
				u8 cmd)
{
	void *hdr;
	struct nlattr *nla_grps;
	struct nlattr *nest;

	hdr = genlmsg_put(skb, pid, seq, &genl_ctrl, flags, cmd);
	if (hdr == NULL)
		return -1;

	NLA_PUT_STRING(skb, CTRL_ATTR_FAMILY_NAME, grp->family->name);
	NLA_PUT_U16(skb, CTRL_ATTR_FAMILY_ID, grp->family->id);

	nla_grps = nla_nest_start(skb, CTRL_ATTR_MCAST_GROUPS);
	if (nla_grps == NULL)
		goto nla_put_failure;

	nest = nla_nest_start(skb, 1);
	if (nest == NULL)
		goto nla_put_failure;

	NLA_PUT_U32(skb, CTRL_ATTR_MCAST_GRP_ID, grp->id);
	NLA_PUT_STRING(skb, CTRL_ATTR_MCAST_GRP_NAME,
		       grp->name);

	nla_nest_end(skb, nest);
	nla_nest_end(skb, nla_grps);

687
688
689
	return genlmsg_end(skb, hdr);

nla_put_failure:
690
691
	genlmsg_cancel(skb, hdr);
	return -EMSGSIZE;
692
693
694
695
696
697
698
}

static int ctrl_dumpfamily(struct sk_buff *skb, struct netlink_callback *cb)
{

	int i, n = 0;
	struct genl_family *rt;
Johannes Berg's avatar
Johannes Berg committed
699
	struct net *net = sock_net(skb->sk);
700
701
702
	int chains_to_skip = cb->args[0];
	int fams_to_skip = cb->args[1];

703
	for (i = chains_to_skip; i < GENL_FAM_TAB_SIZE; i++) {
704
705
		n = 0;
		list_for_each_entry(rt, genl_family_chain(i), family_list) {
Johannes Berg's avatar
Johannes Berg committed
706
707
			if (!rt->netnsok && !net_eq(net, &init_net))
				continue;
708
709
710
711
712
713
714
715
716
717
718
719
720
721
722
723
724
725
			if (++n < fams_to_skip)
				continue;
			if (ctrl_fill_info(rt, NETLINK_CB(cb->skb).pid,
					   cb->nlh->nlmsg_seq, NLM_F_MULTI,
					   skb, CTRL_CMD_NEWFAMILY) < 0)
				goto errout;
		}

		fams_to_skip = 0;
	}

errout:
	cb->args[0] = i;
	cb->args[1] = n;

	return skb->len;
}

726
727
static struct sk_buff *ctrl_build_family_msg(struct genl_family *family,
					     u32 pid, int seq, u8 cmd)
728
729
730
731
{
	struct sk_buff *skb;
	int err;

732
	skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
733
734
735
736
737
738
739
740
741
742
743
744
	if (skb == NULL)
		return ERR_PTR(-ENOBUFS);

	err = ctrl_fill_info(family, pid, seq, 0, skb, cmd);
	if (err < 0) {
		nlmsg_free(skb);
		return ERR_PTR(err);
	}

	return skb;
}

745
746
747
748
749
750
751
752
753
754
755
756
757
758
759
760
761
762
763
static struct sk_buff *ctrl_build_mcgrp_msg(struct genl_multicast_group *grp,
					    u32 pid, int seq, u8 cmd)
{
	struct sk_buff *skb;
	int err;

	skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
	if (skb == NULL)
		return ERR_PTR(-ENOBUFS);

	err = ctrl_fill_mcgrp_info(grp, pid, seq, 0, skb, cmd);
	if (err < 0) {
		nlmsg_free(skb);
		return ERR_PTR(err);
	}

	return skb;
}

764
static const struct nla_policy ctrl_policy[CTRL_ATTR_MAX+1] = {
765
	[CTRL_ATTR_FAMILY_ID]	= { .type = NLA_U16 },
766
767
	[CTRL_ATTR_FAMILY_NAME]	= { .type = NLA_NUL_STRING,
				    .len = GENL_NAMSIZ - 1 },
768
769
770
771
772
773
774
775
776
777
778
};

static int ctrl_getfamily(struct sk_buff *skb, struct genl_info *info)
{
	struct sk_buff *msg;
	struct genl_family *res = NULL;
	int err = -EINVAL;

	if (info->attrs[CTRL_ATTR_FAMILY_ID]) {
		u16 id = nla_get_u16(info->attrs[CTRL_ATTR_FAMILY_ID]);
		res = genl_family_find_byid(id);
Johannes Berg's avatar
Johannes Berg committed
779
		err = -ENOENT;
780
781
782
	}

	if (info->attrs[CTRL_ATTR_FAMILY_NAME]) {
783
		char *name;
784

785
		name = nla_data(info->attrs[CTRL_ATTR_FAMILY_NAME]);
786
		res = genl_family_find_byname(name);
Johannes Berg's avatar
Johannes Berg committed
787
		err = -ENOENT;
788
789
	}

Johannes Berg's avatar
Johannes Berg committed
790
791
792
793
794
795
	if (res == NULL)
		return err;

	if (!res->netnsok && !net_eq(genl_info_net(info), &init_net)) {
		/* family doesn't exist here */
		return -ENOENT;
796
797
	}

798
799
	msg = ctrl_build_family_msg(res, info->snd_pid, info->snd_seq,
				    CTRL_CMD_NEWFAMILY);
Johannes Berg's avatar
Johannes Berg committed
800
801
	if (IS_ERR(msg))
		return PTR_ERR(msg);
802

Johannes Berg's avatar
Johannes Berg committed
803
	return genlmsg_reply(msg, info);
804
805
806
807
808
}

static int genl_ctrl_event(int event, void *data)
{
	struct sk_buff *msg;
Johannes Berg's avatar
Johannes Berg committed
809
810
	struct genl_family *family;
	struct genl_multicast_group *grp;
811

Johannes Berg's avatar
Johannes Berg committed
812
813
	/* genl is still initialising */
	if (!init_net.genl_sock)
814
815
816
817
818
		return 0;

	switch (event) {
	case CTRL_CMD_NEWFAMILY:
	case CTRL_CMD_DELFAMILY:
Johannes Berg's avatar
Johannes Berg committed
819
820
		family = data;
		msg = ctrl_build_family_msg(family, 0, 0, event);
821
822
823
		break;
	case CTRL_CMD_NEWMCAST_GRP:
	case CTRL_CMD_DELMCAST_GRP:
Johannes Berg's avatar
Johannes Berg committed
824
825
		grp = data;
		family = grp->family;
826
		msg = ctrl_build_mcgrp_msg(data, 0, 0, event);
827
		break;
Johannes Berg's avatar
Johannes Berg committed
828
829
830
831
832
833
834
835
836
837
838
839
840
841
	default:
		return -EINVAL;
	}

	if (IS_ERR(msg))
		return PTR_ERR(msg);

	if (!family->netnsok) {
		genlmsg_multicast_netns(&init_net, msg, 0,
					GENL_ID_CTRL, GFP_KERNEL);
	} else {
		rcu_read_lock();
		genlmsg_multicast_allns(msg, 0, GENL_ID_CTRL, GFP_ATOMIC);
		rcu_read_unlock();
842
843
844
845
846
847
848
849
850
851
852
853
	}

	return 0;
}

static struct genl_ops genl_ctrl_ops = {
	.cmd		= CTRL_CMD_GETFAMILY,
	.doit		= ctrl_getfamily,
	.dumpit		= ctrl_dumpfamily,
	.policy		= ctrl_policy,
};

854
855
856
857
static struct genl_multicast_group notify_grp = {
	.name		= "notify",
};

Johannes Berg's avatar
Johannes Berg committed
858
859
860
861
862
863
864
865
866
867
868
869
870
871
872
873
874
875
876
877
878
879
880
881
882
883
884
static int __net_init genl_pernet_init(struct net *net)
{
	/* we'll bump the group number right afterwards */
	net->genl_sock = netlink_kernel_create(net, NETLINK_GENERIC, 0,
					       genl_rcv, &genl_mutex,
					       THIS_MODULE);

	if (!net->genl_sock && net_eq(net, &init_net))
		panic("GENL: Cannot initialize generic netlink\n");

	if (!net->genl_sock)
		return -ENOMEM;

	return 0;
}

static void __net_exit genl_pernet_exit(struct net *net)
{
	netlink_kernel_release(net->genl_sock);
	net->genl_sock = NULL;
}

static struct pernet_operations genl_pernet_ops = {
	.init = genl_pernet_init,
	.exit = genl_pernet_exit,
};

885
886
887
888
889
890
891
static int __init genl_init(void)
{
	int i, err;

	for (i = 0; i < GENL_FAM_TAB_SIZE; i++)
		INIT_LIST_HEAD(&family_ht[i]);

892
	err = genl_register_family_with_ops(&genl_ctrl, &genl_ctrl_ops, 1);
893
	if (err < 0)
Johannes Berg's avatar
Johannes Berg committed
894
		goto problem;
895
896

	netlink_set_nonroot(NETLINK_GENERIC, NL_NONROOT_RECV);
897

Johannes Berg's avatar
Johannes Berg committed
898
899
900
	err = register_pernet_subsys(&genl_pernet_ops);
	if (err)
		goto problem;
901

902
903
	err = genl_register_mc_group(&genl_ctrl, &notify_grp);
	if (err < 0)
Johannes Berg's avatar
Johannes Berg committed
904
		goto problem;
905

906
907
	return 0;

Johannes Berg's avatar
Johannes Berg committed
908
problem:
909
910
911
912
913
	panic("GENL: Cannot register controller: %d\n", err);
}

subsys_initcall(genl_init);

Johannes Berg's avatar
Johannes Berg committed
914
915
916
917
918
919
920
921
922
923
924
925
926
927
928
929
930
931
932
933
934
935
936
937
938
939
940
941
942
943
944
945
946
947
948
static int genlmsg_mcast(struct sk_buff *skb, u32 pid, unsigned long group,
			 gfp_t flags)
{
	struct sk_buff *tmp;
	struct net *net, *prev = NULL;
	int err;

	for_each_net_rcu(net) {
		if (prev) {
			tmp = skb_clone(skb, flags);
			if (!tmp) {
				err = -ENOMEM;
				goto error;
			}
			err = nlmsg_multicast(prev->genl_sock, tmp,
					      pid, group, flags);
			if (err)
				goto error;
		}

		prev = net;
	}

	return nlmsg_multicast(prev->genl_sock, skb, pid, group, flags);
 error:
	kfree_skb(skb);
	return err;
}

int genlmsg_multicast_allns(struct sk_buff *skb, u32 pid, unsigned int group,
			    gfp_t flags)
{
	return genlmsg_mcast(skb, pid, group, flags);
}
EXPORT_SYMBOL(genlmsg_multicast_allns);