blob: e8c9f97042163f0297f638a8ce87e2ba6ad00edf [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * NETLINK Kernel-user communication protocol.
3 *
Alan Cox113aa832008-10-13 19:01:08 -07004 * Authors: Alan Cox <alan@lxorguk.ukuu.org.uk>
Linus Torvalds1da177e2005-04-16 15:20:36 -07005 * Alexey Kuznetsov <kuznet@ms2.inr.ac.ru>
Patrick McHardycd1df522013-04-17 06:47:05 +00006 * Patrick McHardy <kaber@trash.net>
Linus Torvalds1da177e2005-04-16 15:20:36 -07007 *
8 * This program is free software; you can redistribute it and/or
9 * modify it under the terms of the GNU General Public License
10 * as published by the Free Software Foundation; either version
11 * 2 of the License, or (at your option) any later version.
YOSHIFUJI Hideaki746fac42007-02-09 23:25:07 +090012 *
Linus Torvalds1da177e2005-04-16 15:20:36 -070013 * Tue Jun 26 14:36:48 MEST 2001 Herbert "herp" Rosmanith
14 * added netlink_proto_exit
15 * Tue Jan 22 18:32:44 BRST 2002 Arnaldo C. de Melo <acme@conectiva.com.br>
16 * use nlk_sk, as sk->protinfo is on a diet 8)
Harald Welte4fdb3bb2005-08-09 19:40:55 -070017 * Fri Jul 22 19:51:12 MEST 2005 Harald Welte <laforge@gnumonks.org>
18 * - inc module use count of module that owns
19 * the kernel socket in case userspace opens
20 * socket of same protocol
21 * - remove all module support, since netlink is
22 * mandatory if CONFIG_NET=y these days
Linus Torvalds1da177e2005-04-16 15:20:36 -070023 */
24
Linus Torvalds1da177e2005-04-16 15:20:36 -070025#include <linux/module.h>
26
Randy Dunlap4fc268d2006-01-11 12:17:47 -080027#include <linux/capability.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070028#include <linux/kernel.h>
29#include <linux/init.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070030#include <linux/signal.h>
31#include <linux/sched.h>
32#include <linux/errno.h>
33#include <linux/string.h>
34#include <linux/stat.h>
35#include <linux/socket.h>
36#include <linux/un.h>
37#include <linux/fcntl.h>
38#include <linux/termios.h>
39#include <linux/sockios.h>
40#include <linux/net.h>
41#include <linux/fs.h>
42#include <linux/slab.h>
43#include <asm/uaccess.h>
44#include <linux/skbuff.h>
45#include <linux/netdevice.h>
46#include <linux/rtnetlink.h>
47#include <linux/proc_fs.h>
48#include <linux/seq_file.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070049#include <linux/notifier.h>
50#include <linux/security.h>
51#include <linux/jhash.h>
52#include <linux/jiffies.h>
53#include <linux/random.h>
54#include <linux/bitops.h>
55#include <linux/mm.h>
56#include <linux/types.h>
Andrew Morton54e0f522005-04-30 07:07:04 +010057#include <linux/audit.h>
Patrick McHardyaf65bdf2007-04-20 14:14:21 -070058#include <linux/mutex.h>
Patrick McHardyccdfcc32013-04-17 06:47:01 +000059#include <linux/vmalloc.h>
Daniel Borkmannbcbde0d2013-06-21 19:38:07 +020060#include <linux/if_arp.h>
Patrick McHardy9652e932013-04-17 06:47:02 +000061#include <asm/cacheflush.h>
Andrew Morton54e0f522005-04-30 07:07:04 +010062
Eric W. Biederman457c4cb2007-09-12 12:01:34 +020063#include <net/net_namespace.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070064#include <net/sock.h>
65#include <net/scm.h>
Thomas Graf82ace472005-11-10 02:25:53 +010066#include <net/netlink.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070067
Andrey Vagin0f29c762013-03-21 20:33:47 +040068#include "af_netlink.h"
Linus Torvalds1da177e2005-04-16 15:20:36 -070069
Eric Dumazet5c398dc2010-10-24 04:27:10 +000070struct listeners {
71 struct rcu_head rcu;
72 unsigned long masks[0];
Johannes Berg6c04bb12009-07-10 09:51:32 +000073};
74
Patrick McHardycd967e02013-04-17 06:46:56 +000075/* state bits */
76#define NETLINK_CONGESTED 0x0
77
78/* flags */
Patrick McHardy77247bb2005-08-14 19:27:13 -070079#define NETLINK_KERNEL_SOCKET 0x1
Patrick McHardy9a4595b2005-08-15 12:32:15 -070080#define NETLINK_RECV_PKTINFO 0x2
Pablo Neira Ayusobe0c22a2009-02-18 01:40:43 +000081#define NETLINK_BROADCAST_SEND_ERROR 0x4
Pablo Neira Ayuso38938bf2009-03-24 16:37:55 -070082#define NETLINK_RECV_NO_ENOBUFS 0x8
Patrick McHardy77247bb2005-08-14 19:27:13 -070083
David S. Miller035c4c12011-12-23 17:33:03 -050084static inline int netlink_is_kernel(struct sock *sk)
Denis V. Lunevaed81562007-10-10 21:14:32 -070085{
86 return nlk_sk(sk)->flags & NETLINK_KERNEL_SOCKET;
87}
88
Andrey Vagin0f29c762013-03-21 20:33:47 +040089struct netlink_table *nl_table;
90EXPORT_SYMBOL_GPL(nl_table);
Linus Torvalds1da177e2005-04-16 15:20:36 -070091
92static DECLARE_WAIT_QUEUE_HEAD(nl_table_wait);
93
94static int netlink_dump(struct sock *sk);
Patrick McHardy9652e932013-04-17 06:47:02 +000095static void netlink_skb_destructor(struct sk_buff *skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -070096
Andrey Vagin0f29c762013-03-21 20:33:47 +040097DEFINE_RWLOCK(nl_table_lock);
98EXPORT_SYMBOL_GPL(nl_table_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -070099static atomic_t nl_table_users = ATOMIC_INIT(0);
100
Eric Dumazet6d772ac2012-10-18 03:21:55 +0000101#define nl_deref_protected(X) rcu_dereference_protected(X, lockdep_is_held(&nl_table_lock));
102
Alan Sterne041c682006-03-27 01:16:30 -0800103static ATOMIC_NOTIFIER_HEAD(netlink_chain);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700104
Daniel Borkmannbcbde0d2013-06-21 19:38:07 +0200105static DEFINE_SPINLOCK(netlink_tap_lock);
106static struct list_head netlink_tap_all __read_mostly;
107
stephen hemmingerb57ef81f2011-12-22 08:52:02 +0000108static inline u32 netlink_group_mask(u32 group)
Patrick McHardyd629b832005-08-14 19:27:50 -0700109{
110 return group ? 1 << (group - 1) : 0;
111}
112
Eric W. Biederman15e47302012-09-07 20:12:54 +0000113static inline struct hlist_head *nl_portid_hashfn(struct nl_portid_hash *hash, u32 portid)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700114{
Eric W. Biederman15e47302012-09-07 20:12:54 +0000115 return &hash->table[jhash_1word(portid, hash->rnd) & hash->mask];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700116}
117
Daniel Borkmannbcbde0d2013-06-21 19:38:07 +0200118int netlink_add_tap(struct netlink_tap *nt)
119{
120 if (unlikely(nt->dev->type != ARPHRD_NETLINK))
121 return -EINVAL;
122
123 spin_lock(&netlink_tap_lock);
124 list_add_rcu(&nt->list, &netlink_tap_all);
125 spin_unlock(&netlink_tap_lock);
126
127 if (nt->module)
128 __module_get(nt->module);
129
130 return 0;
131}
132EXPORT_SYMBOL_GPL(netlink_add_tap);
133
stephen hemminger2173f8d2013-12-30 10:49:22 -0800134static int __netlink_remove_tap(struct netlink_tap *nt)
Daniel Borkmannbcbde0d2013-06-21 19:38:07 +0200135{
136 bool found = false;
137 struct netlink_tap *tmp;
138
139 spin_lock(&netlink_tap_lock);
140
141 list_for_each_entry(tmp, &netlink_tap_all, list) {
142 if (nt == tmp) {
143 list_del_rcu(&nt->list);
144 found = true;
145 goto out;
146 }
147 }
148
149 pr_warn("__netlink_remove_tap: %p not found\n", nt);
150out:
151 spin_unlock(&netlink_tap_lock);
152
153 if (found && nt->module)
154 module_put(nt->module);
155
156 return found ? 0 : -ENODEV;
157}
Daniel Borkmannbcbde0d2013-06-21 19:38:07 +0200158
159int netlink_remove_tap(struct netlink_tap *nt)
160{
161 int ret;
162
163 ret = __netlink_remove_tap(nt);
164 synchronize_net();
165
166 return ret;
167}
168EXPORT_SYMBOL_GPL(netlink_remove_tap);
169
Daniel Borkmann5ffd5cd2013-09-05 17:48:47 +0200170static bool netlink_filter_tap(const struct sk_buff *skb)
171{
172 struct sock *sk = skb->sk;
173 bool pass = false;
174
175 /* We take the more conservative approach and
176 * whitelist socket protocols that may pass.
177 */
178 switch (sk->sk_protocol) {
179 case NETLINK_ROUTE:
180 case NETLINK_USERSOCK:
181 case NETLINK_SOCK_DIAG:
182 case NETLINK_NFLOG:
183 case NETLINK_XFRM:
184 case NETLINK_FIB_LOOKUP:
185 case NETLINK_NETFILTER:
186 case NETLINK_GENERIC:
187 pass = true;
188 break;
189 }
190
191 return pass;
192}
193
Daniel Borkmannbcbde0d2013-06-21 19:38:07 +0200194static int __netlink_deliver_tap_skb(struct sk_buff *skb,
195 struct net_device *dev)
196{
197 struct sk_buff *nskb;
Daniel Borkmann5ffd5cd2013-09-05 17:48:47 +0200198 struct sock *sk = skb->sk;
Daniel Borkmannbcbde0d2013-06-21 19:38:07 +0200199 int ret = -ENOMEM;
200
201 dev_hold(dev);
202 nskb = skb_clone(skb, GFP_ATOMIC);
203 if (nskb) {
204 nskb->dev = dev;
Daniel Borkmann5ffd5cd2013-09-05 17:48:47 +0200205 nskb->protocol = htons((u16) sk->sk_protocol);
Daniel Borkmann604d13c2013-12-23 14:35:56 +0100206 nskb->pkt_type = netlink_is_kernel(sk) ?
207 PACKET_KERNEL : PACKET_USER;
Daniel Borkmann5ffd5cd2013-09-05 17:48:47 +0200208
Daniel Borkmannbcbde0d2013-06-21 19:38:07 +0200209 ret = dev_queue_xmit(nskb);
210 if (unlikely(ret > 0))
211 ret = net_xmit_errno(ret);
212 }
213
214 dev_put(dev);
215 return ret;
216}
217
218static void __netlink_deliver_tap(struct sk_buff *skb)
219{
220 int ret;
221 struct netlink_tap *tmp;
222
Daniel Borkmann5ffd5cd2013-09-05 17:48:47 +0200223 if (!netlink_filter_tap(skb))
224 return;
225
Daniel Borkmannbcbde0d2013-06-21 19:38:07 +0200226 list_for_each_entry_rcu(tmp, &netlink_tap_all, list) {
227 ret = __netlink_deliver_tap_skb(skb, tmp->dev);
228 if (unlikely(ret))
229 break;
230 }
231}
232
233static void netlink_deliver_tap(struct sk_buff *skb)
234{
235 rcu_read_lock();
236
237 if (unlikely(!list_empty(&netlink_tap_all)))
238 __netlink_deliver_tap(skb);
239
240 rcu_read_unlock();
241}
242
Daniel Borkmann73bfd372013-12-23 14:35:55 +0100243static void netlink_deliver_tap_kernel(struct sock *dst, struct sock *src,
244 struct sk_buff *skb)
245{
246 if (!(netlink_is_kernel(dst) && netlink_is_kernel(src)))
247 netlink_deliver_tap(skb);
248}
249
Patrick McHardycd1df522013-04-17 06:47:05 +0000250static void netlink_overrun(struct sock *sk)
251{
252 struct netlink_sock *nlk = nlk_sk(sk);
253
254 if (!(nlk->flags & NETLINK_RECV_NO_ENOBUFS)) {
255 if (!test_and_set_bit(NETLINK_CONGESTED, &nlk_sk(sk)->state)) {
256 sk->sk_err = ENOBUFS;
257 sk->sk_error_report(sk);
258 }
259 }
260 atomic_inc(&sk->sk_drops);
261}
262
263static void netlink_rcv_wake(struct sock *sk)
264{
265 struct netlink_sock *nlk = nlk_sk(sk);
266
267 if (skb_queue_empty(&sk->sk_receive_queue))
268 clear_bit(NETLINK_CONGESTED, &nlk->state);
269 if (!test_bit(NETLINK_CONGESTED, &nlk->state))
270 wake_up_interruptible(&nlk->wait);
271}
272
Patrick McHardyccdfcc32013-04-17 06:47:01 +0000273#ifdef CONFIG_NETLINK_MMAP
Patrick McHardy9652e932013-04-17 06:47:02 +0000274static bool netlink_skb_is_mmaped(const struct sk_buff *skb)
275{
276 return NETLINK_CB(skb).flags & NETLINK_SKB_MMAPED;
277}
278
Patrick McHardyf9c22882013-04-17 06:47:04 +0000279static bool netlink_rx_is_mmaped(struct sock *sk)
280{
281 return nlk_sk(sk)->rx_ring.pg_vec != NULL;
282}
283
Patrick McHardy5fd96122013-04-17 06:47:03 +0000284static bool netlink_tx_is_mmaped(struct sock *sk)
285{
286 return nlk_sk(sk)->tx_ring.pg_vec != NULL;
287}
288
Patrick McHardyccdfcc32013-04-17 06:47:01 +0000289static __pure struct page *pgvec_to_page(const void *addr)
290{
291 if (is_vmalloc_addr(addr))
292 return vmalloc_to_page(addr);
293 else
294 return virt_to_page(addr);
295}
296
297static void free_pg_vec(void **pg_vec, unsigned int order, unsigned int len)
298{
299 unsigned int i;
300
301 for (i = 0; i < len; i++) {
302 if (pg_vec[i] != NULL) {
303 if (is_vmalloc_addr(pg_vec[i]))
304 vfree(pg_vec[i]);
305 else
306 free_pages((unsigned long)pg_vec[i], order);
307 }
308 }
309 kfree(pg_vec);
310}
311
312static void *alloc_one_pg_vec_page(unsigned long order)
313{
314 void *buffer;
315 gfp_t gfp_flags = GFP_KERNEL | __GFP_COMP | __GFP_ZERO |
316 __GFP_NOWARN | __GFP_NORETRY;
317
318 buffer = (void *)__get_free_pages(gfp_flags, order);
319 if (buffer != NULL)
320 return buffer;
321
322 buffer = vzalloc((1 << order) * PAGE_SIZE);
323 if (buffer != NULL)
324 return buffer;
325
326 gfp_flags &= ~__GFP_NORETRY;
327 return (void *)__get_free_pages(gfp_flags, order);
328}
329
330static void **alloc_pg_vec(struct netlink_sock *nlk,
331 struct nl_mmap_req *req, unsigned int order)
332{
333 unsigned int block_nr = req->nm_block_nr;
334 unsigned int i;
Daniel Borkmann8a849bb2013-08-02 17:32:39 +0200335 void **pg_vec;
Patrick McHardyccdfcc32013-04-17 06:47:01 +0000336
337 pg_vec = kcalloc(block_nr, sizeof(void *), GFP_KERNEL);
338 if (pg_vec == NULL)
339 return NULL;
340
341 for (i = 0; i < block_nr; i++) {
Daniel Borkmann8a849bb2013-08-02 17:32:39 +0200342 pg_vec[i] = alloc_one_pg_vec_page(order);
Patrick McHardyccdfcc32013-04-17 06:47:01 +0000343 if (pg_vec[i] == NULL)
344 goto err1;
345 }
346
347 return pg_vec;
348err1:
349 free_pg_vec(pg_vec, order, block_nr);
350 return NULL;
351}
352
353static int netlink_set_ring(struct sock *sk, struct nl_mmap_req *req,
354 bool closing, bool tx_ring)
355{
356 struct netlink_sock *nlk = nlk_sk(sk);
357 struct netlink_ring *ring;
358 struct sk_buff_head *queue;
359 void **pg_vec = NULL;
360 unsigned int order = 0;
361 int err;
362
363 ring = tx_ring ? &nlk->tx_ring : &nlk->rx_ring;
364 queue = tx_ring ? &sk->sk_write_queue : &sk->sk_receive_queue;
365
366 if (!closing) {
367 if (atomic_read(&nlk->mapped))
368 return -EBUSY;
369 if (atomic_read(&ring->pending))
370 return -EBUSY;
371 }
372
373 if (req->nm_block_nr) {
374 if (ring->pg_vec != NULL)
375 return -EBUSY;
376
377 if ((int)req->nm_block_size <= 0)
378 return -EINVAL;
379 if (!IS_ALIGNED(req->nm_block_size, PAGE_SIZE))
380 return -EINVAL;
381 if (req->nm_frame_size < NL_MMAP_HDRLEN)
382 return -EINVAL;
383 if (!IS_ALIGNED(req->nm_frame_size, NL_MMAP_MSG_ALIGNMENT))
384 return -EINVAL;
385
386 ring->frames_per_block = req->nm_block_size /
387 req->nm_frame_size;
388 if (ring->frames_per_block == 0)
389 return -EINVAL;
390 if (ring->frames_per_block * req->nm_block_nr !=
391 req->nm_frame_nr)
392 return -EINVAL;
393
394 order = get_order(req->nm_block_size);
395 pg_vec = alloc_pg_vec(nlk, req, order);
396 if (pg_vec == NULL)
397 return -ENOMEM;
398 } else {
399 if (req->nm_frame_nr)
400 return -EINVAL;
401 }
402
403 err = -EBUSY;
404 mutex_lock(&nlk->pg_vec_lock);
405 if (closing || atomic_read(&nlk->mapped) == 0) {
406 err = 0;
407 spin_lock_bh(&queue->lock);
408
409 ring->frame_max = req->nm_frame_nr - 1;
410 ring->head = 0;
411 ring->frame_size = req->nm_frame_size;
412 ring->pg_vec_pages = req->nm_block_size / PAGE_SIZE;
413
414 swap(ring->pg_vec_len, req->nm_block_nr);
415 swap(ring->pg_vec_order, order);
416 swap(ring->pg_vec, pg_vec);
417
418 __skb_queue_purge(queue);
419 spin_unlock_bh(&queue->lock);
420
421 WARN_ON(atomic_read(&nlk->mapped));
422 }
423 mutex_unlock(&nlk->pg_vec_lock);
424
425 if (pg_vec)
426 free_pg_vec(pg_vec, order, req->nm_block_nr);
427 return err;
428}
429
430static void netlink_mm_open(struct vm_area_struct *vma)
431{
432 struct file *file = vma->vm_file;
433 struct socket *sock = file->private_data;
434 struct sock *sk = sock->sk;
435
436 if (sk)
437 atomic_inc(&nlk_sk(sk)->mapped);
438}
439
440static void netlink_mm_close(struct vm_area_struct *vma)
441{
442 struct file *file = vma->vm_file;
443 struct socket *sock = file->private_data;
444 struct sock *sk = sock->sk;
445
446 if (sk)
447 atomic_dec(&nlk_sk(sk)->mapped);
448}
449
450static const struct vm_operations_struct netlink_mmap_ops = {
451 .open = netlink_mm_open,
452 .close = netlink_mm_close,
453};
454
455static int netlink_mmap(struct file *file, struct socket *sock,
456 struct vm_area_struct *vma)
457{
458 struct sock *sk = sock->sk;
459 struct netlink_sock *nlk = nlk_sk(sk);
460 struct netlink_ring *ring;
461 unsigned long start, size, expected;
462 unsigned int i;
463 int err = -EINVAL;
464
465 if (vma->vm_pgoff)
466 return -EINVAL;
467
468 mutex_lock(&nlk->pg_vec_lock);
469
470 expected = 0;
471 for (ring = &nlk->rx_ring; ring <= &nlk->tx_ring; ring++) {
472 if (ring->pg_vec == NULL)
473 continue;
474 expected += ring->pg_vec_len * ring->pg_vec_pages * PAGE_SIZE;
475 }
476
477 if (expected == 0)
478 goto out;
479
480 size = vma->vm_end - vma->vm_start;
481 if (size != expected)
482 goto out;
483
484 start = vma->vm_start;
485 for (ring = &nlk->rx_ring; ring <= &nlk->tx_ring; ring++) {
486 if (ring->pg_vec == NULL)
487 continue;
488
489 for (i = 0; i < ring->pg_vec_len; i++) {
490 struct page *page;
491 void *kaddr = ring->pg_vec[i];
492 unsigned int pg_num;
493
494 for (pg_num = 0; pg_num < ring->pg_vec_pages; pg_num++) {
495 page = pgvec_to_page(kaddr);
496 err = vm_insert_page(vma, start, page);
497 if (err < 0)
498 goto out;
499 start += PAGE_SIZE;
500 kaddr += PAGE_SIZE;
501 }
502 }
503 }
504
505 atomic_inc(&nlk->mapped);
506 vma->vm_ops = &netlink_mmap_ops;
507 err = 0;
508out:
509 mutex_unlock(&nlk->pg_vec_lock);
Patrick McHardy7cdbac72013-06-11 02:52:47 -0700510 return err;
Patrick McHardyccdfcc32013-04-17 06:47:01 +0000511}
Patrick McHardy9652e932013-04-17 06:47:02 +0000512
513static void netlink_frame_flush_dcache(const struct nl_mmap_hdr *hdr)
514{
515#if ARCH_IMPLEMENTS_FLUSH_DCACHE_PAGE == 1
516 struct page *p_start, *p_end;
517
518 /* First page is flushed through netlink_{get,set}_status */
519 p_start = pgvec_to_page(hdr + PAGE_SIZE);
Stephen Rothwell1d5085c2013-04-23 17:40:35 +1000520 p_end = pgvec_to_page((void *)hdr + NL_MMAP_HDRLEN + hdr->nm_len - 1);
Patrick McHardy9652e932013-04-17 06:47:02 +0000521 while (p_start <= p_end) {
522 flush_dcache_page(p_start);
523 p_start++;
524 }
525#endif
526}
527
528static enum nl_mmap_status netlink_get_status(const struct nl_mmap_hdr *hdr)
529{
530 smp_rmb();
531 flush_dcache_page(pgvec_to_page(hdr));
532 return hdr->nm_status;
533}
534
535static void netlink_set_status(struct nl_mmap_hdr *hdr,
536 enum nl_mmap_status status)
537{
538 hdr->nm_status = status;
539 flush_dcache_page(pgvec_to_page(hdr));
540 smp_wmb();
541}
542
543static struct nl_mmap_hdr *
544__netlink_lookup_frame(const struct netlink_ring *ring, unsigned int pos)
545{
546 unsigned int pg_vec_pos, frame_off;
547
548 pg_vec_pos = pos / ring->frames_per_block;
549 frame_off = pos % ring->frames_per_block;
550
551 return ring->pg_vec[pg_vec_pos] + (frame_off * ring->frame_size);
552}
553
554static struct nl_mmap_hdr *
555netlink_lookup_frame(const struct netlink_ring *ring, unsigned int pos,
556 enum nl_mmap_status status)
557{
558 struct nl_mmap_hdr *hdr;
559
560 hdr = __netlink_lookup_frame(ring, pos);
561 if (netlink_get_status(hdr) != status)
562 return NULL;
563
564 return hdr;
565}
566
567static struct nl_mmap_hdr *
568netlink_current_frame(const struct netlink_ring *ring,
569 enum nl_mmap_status status)
570{
571 return netlink_lookup_frame(ring, ring->head, status);
572}
573
574static struct nl_mmap_hdr *
575netlink_previous_frame(const struct netlink_ring *ring,
576 enum nl_mmap_status status)
577{
578 unsigned int prev;
579
580 prev = ring->head ? ring->head - 1 : ring->frame_max;
581 return netlink_lookup_frame(ring, prev, status);
582}
583
584static void netlink_increment_head(struct netlink_ring *ring)
585{
586 ring->head = ring->head != ring->frame_max ? ring->head + 1 : 0;
587}
588
589static void netlink_forward_ring(struct netlink_ring *ring)
590{
591 unsigned int head = ring->head, pos = head;
592 const struct nl_mmap_hdr *hdr;
593
594 do {
595 hdr = __netlink_lookup_frame(ring, pos);
596 if (hdr->nm_status == NL_MMAP_STATUS_UNUSED)
597 break;
598 if (hdr->nm_status != NL_MMAP_STATUS_SKIP)
599 break;
600 netlink_increment_head(ring);
601 } while (ring->head != head);
602}
603
Patrick McHardycd1df522013-04-17 06:47:05 +0000604static bool netlink_dump_space(struct netlink_sock *nlk)
605{
606 struct netlink_ring *ring = &nlk->rx_ring;
607 struct nl_mmap_hdr *hdr;
608 unsigned int n;
609
610 hdr = netlink_current_frame(ring, NL_MMAP_STATUS_UNUSED);
611 if (hdr == NULL)
612 return false;
613
614 n = ring->head + ring->frame_max / 2;
615 if (n > ring->frame_max)
616 n -= ring->frame_max;
617
618 hdr = __netlink_lookup_frame(ring, n);
619
620 return hdr->nm_status == NL_MMAP_STATUS_UNUSED;
621}
622
Patrick McHardy9652e932013-04-17 06:47:02 +0000623static unsigned int netlink_poll(struct file *file, struct socket *sock,
624 poll_table *wait)
625{
626 struct sock *sk = sock->sk;
627 struct netlink_sock *nlk = nlk_sk(sk);
628 unsigned int mask;
Patrick McHardycd1df522013-04-17 06:47:05 +0000629 int err;
Patrick McHardy9652e932013-04-17 06:47:02 +0000630
Patrick McHardycd1df522013-04-17 06:47:05 +0000631 if (nlk->rx_ring.pg_vec != NULL) {
632 /* Memory mapped sockets don't call recvmsg(), so flow control
633 * for dumps is performed here. A dump is allowed to continue
634 * if at least half the ring is unused.
635 */
Pravin B Shelar16b304f2013-08-15 15:31:06 -0700636 while (nlk->cb_running && netlink_dump_space(nlk)) {
Patrick McHardycd1df522013-04-17 06:47:05 +0000637 err = netlink_dump(sk);
638 if (err < 0) {
639 sk->sk_err = err;
640 sk->sk_error_report(sk);
641 break;
642 }
643 }
644 netlink_rcv_wake(sk);
645 }
Patrick McHardy5fd96122013-04-17 06:47:03 +0000646
Patrick McHardy9652e932013-04-17 06:47:02 +0000647 mask = datagram_poll(file, sock, wait);
648
649 spin_lock_bh(&sk->sk_receive_queue.lock);
650 if (nlk->rx_ring.pg_vec) {
651 netlink_forward_ring(&nlk->rx_ring);
652 if (!netlink_previous_frame(&nlk->rx_ring, NL_MMAP_STATUS_UNUSED))
653 mask |= POLLIN | POLLRDNORM;
654 }
655 spin_unlock_bh(&sk->sk_receive_queue.lock);
656
657 spin_lock_bh(&sk->sk_write_queue.lock);
658 if (nlk->tx_ring.pg_vec) {
659 if (netlink_current_frame(&nlk->tx_ring, NL_MMAP_STATUS_UNUSED))
660 mask |= POLLOUT | POLLWRNORM;
661 }
662 spin_unlock_bh(&sk->sk_write_queue.lock);
663
664 return mask;
665}
666
667static struct nl_mmap_hdr *netlink_mmap_hdr(struct sk_buff *skb)
668{
669 return (struct nl_mmap_hdr *)(skb->head - NL_MMAP_HDRLEN);
670}
671
672static void netlink_ring_setup_skb(struct sk_buff *skb, struct sock *sk,
673 struct netlink_ring *ring,
674 struct nl_mmap_hdr *hdr)
675{
676 unsigned int size;
677 void *data;
678
679 size = ring->frame_size - NL_MMAP_HDRLEN;
680 data = (void *)hdr + NL_MMAP_HDRLEN;
681
682 skb->head = data;
683 skb->data = data;
684 skb_reset_tail_pointer(skb);
685 skb->end = skb->tail + size;
686 skb->len = 0;
687
688 skb->destructor = netlink_skb_destructor;
689 NETLINK_CB(skb).flags |= NETLINK_SKB_MMAPED;
690 NETLINK_CB(skb).sk = sk;
691}
Patrick McHardy5fd96122013-04-17 06:47:03 +0000692
693static int netlink_mmap_sendmsg(struct sock *sk, struct msghdr *msg,
694 u32 dst_portid, u32 dst_group,
695 struct sock_iocb *siocb)
696{
697 struct netlink_sock *nlk = nlk_sk(sk);
698 struct netlink_ring *ring;
699 struct nl_mmap_hdr *hdr;
700 struct sk_buff *skb;
701 unsigned int maxlen;
702 bool excl = true;
703 int err = 0, len = 0;
704
705 /* Netlink messages are validated by the receiver before processing.
706 * In order to avoid userspace changing the contents of the message
707 * after validation, the socket and the ring may only be used by a
708 * single process, otherwise we fall back to copying.
709 */
710 if (atomic_long_read(&sk->sk_socket->file->f_count) > 2 ||
711 atomic_read(&nlk->mapped) > 1)
712 excl = false;
713
714 mutex_lock(&nlk->pg_vec_lock);
715
716 ring = &nlk->tx_ring;
717 maxlen = ring->frame_size - NL_MMAP_HDRLEN;
718
719 do {
720 hdr = netlink_current_frame(ring, NL_MMAP_STATUS_VALID);
721 if (hdr == NULL) {
722 if (!(msg->msg_flags & MSG_DONTWAIT) &&
723 atomic_read(&nlk->tx_ring.pending))
724 schedule();
725 continue;
726 }
727 if (hdr->nm_len > maxlen) {
728 err = -EINVAL;
729 goto out;
730 }
731
732 netlink_frame_flush_dcache(hdr);
733
734 if (likely(dst_portid == 0 && dst_group == 0 && excl)) {
735 skb = alloc_skb_head(GFP_KERNEL);
736 if (skb == NULL) {
737 err = -ENOBUFS;
738 goto out;
739 }
740 sock_hold(sk);
741 netlink_ring_setup_skb(skb, sk, ring, hdr);
742 NETLINK_CB(skb).flags |= NETLINK_SKB_TX;
743 __skb_put(skb, hdr->nm_len);
744 netlink_set_status(hdr, NL_MMAP_STATUS_RESERVED);
745 atomic_inc(&ring->pending);
746 } else {
747 skb = alloc_skb(hdr->nm_len, GFP_KERNEL);
748 if (skb == NULL) {
749 err = -ENOBUFS;
750 goto out;
751 }
752 __skb_put(skb, hdr->nm_len);
753 memcpy(skb->data, (void *)hdr + NL_MMAP_HDRLEN, hdr->nm_len);
754 netlink_set_status(hdr, NL_MMAP_STATUS_UNUSED);
755 }
756
757 netlink_increment_head(ring);
758
759 NETLINK_CB(skb).portid = nlk->portid;
760 NETLINK_CB(skb).dst_group = dst_group;
761 NETLINK_CB(skb).creds = siocb->scm->creds;
762
763 err = security_netlink_send(sk, skb);
764 if (err) {
765 kfree_skb(skb);
766 goto out;
767 }
768
769 if (unlikely(dst_group)) {
770 atomic_inc(&skb->users);
771 netlink_broadcast(sk, skb, dst_portid, dst_group,
772 GFP_KERNEL);
773 }
774 err = netlink_unicast(sk, skb, dst_portid,
775 msg->msg_flags & MSG_DONTWAIT);
776 if (err < 0)
777 goto out;
778 len += err;
779
780 } while (hdr != NULL ||
781 (!(msg->msg_flags & MSG_DONTWAIT) &&
782 atomic_read(&nlk->tx_ring.pending)));
783
784 if (len > 0)
785 err = len;
786out:
787 mutex_unlock(&nlk->pg_vec_lock);
788 return err;
789}
Patrick McHardyf9c22882013-04-17 06:47:04 +0000790
791static void netlink_queue_mmaped_skb(struct sock *sk, struct sk_buff *skb)
792{
793 struct nl_mmap_hdr *hdr;
794
795 hdr = netlink_mmap_hdr(skb);
796 hdr->nm_len = skb->len;
797 hdr->nm_group = NETLINK_CB(skb).dst_group;
798 hdr->nm_pid = NETLINK_CB(skb).creds.pid;
Nicolas Dichtel1bf93102013-04-24 10:36:23 +0200799 hdr->nm_uid = from_kuid(sk_user_ns(sk), NETLINK_CB(skb).creds.uid);
800 hdr->nm_gid = from_kgid(sk_user_ns(sk), NETLINK_CB(skb).creds.gid);
Patrick McHardyf9c22882013-04-17 06:47:04 +0000801 netlink_frame_flush_dcache(hdr);
802 netlink_set_status(hdr, NL_MMAP_STATUS_VALID);
803
804 NETLINK_CB(skb).flags |= NETLINK_SKB_DELIVERED;
805 kfree_skb(skb);
806}
807
808static void netlink_ring_set_copied(struct sock *sk, struct sk_buff *skb)
809{
810 struct netlink_sock *nlk = nlk_sk(sk);
811 struct netlink_ring *ring = &nlk->rx_ring;
812 struct nl_mmap_hdr *hdr;
813
814 spin_lock_bh(&sk->sk_receive_queue.lock);
815 hdr = netlink_current_frame(ring, NL_MMAP_STATUS_UNUSED);
816 if (hdr == NULL) {
817 spin_unlock_bh(&sk->sk_receive_queue.lock);
818 kfree_skb(skb);
Patrick McHardycd1df522013-04-17 06:47:05 +0000819 netlink_overrun(sk);
Patrick McHardyf9c22882013-04-17 06:47:04 +0000820 return;
821 }
822 netlink_increment_head(ring);
823 __skb_queue_tail(&sk->sk_receive_queue, skb);
824 spin_unlock_bh(&sk->sk_receive_queue.lock);
825
826 hdr->nm_len = skb->len;
827 hdr->nm_group = NETLINK_CB(skb).dst_group;
828 hdr->nm_pid = NETLINK_CB(skb).creds.pid;
Nicolas Dichtel1bf93102013-04-24 10:36:23 +0200829 hdr->nm_uid = from_kuid(sk_user_ns(sk), NETLINK_CB(skb).creds.uid);
830 hdr->nm_gid = from_kgid(sk_user_ns(sk), NETLINK_CB(skb).creds.gid);
Patrick McHardyf9c22882013-04-17 06:47:04 +0000831 netlink_set_status(hdr, NL_MMAP_STATUS_COPY);
832}
833
Patrick McHardyccdfcc32013-04-17 06:47:01 +0000834#else /* CONFIG_NETLINK_MMAP */
Patrick McHardy9652e932013-04-17 06:47:02 +0000835#define netlink_skb_is_mmaped(skb) false
Patrick McHardyf9c22882013-04-17 06:47:04 +0000836#define netlink_rx_is_mmaped(sk) false
Patrick McHardy5fd96122013-04-17 06:47:03 +0000837#define netlink_tx_is_mmaped(sk) false
Patrick McHardyccdfcc32013-04-17 06:47:01 +0000838#define netlink_mmap sock_no_mmap
Patrick McHardy9652e932013-04-17 06:47:02 +0000839#define netlink_poll datagram_poll
Patrick McHardy5fd96122013-04-17 06:47:03 +0000840#define netlink_mmap_sendmsg(sk, msg, dst_portid, dst_group, siocb) 0
Patrick McHardyccdfcc32013-04-17 06:47:01 +0000841#endif /* CONFIG_NETLINK_MMAP */
842
Patrick McHardycf0a0182013-04-17 06:47:00 +0000843static void netlink_skb_destructor(struct sk_buff *skb)
844{
Patrick McHardy9652e932013-04-17 06:47:02 +0000845#ifdef CONFIG_NETLINK_MMAP
846 struct nl_mmap_hdr *hdr;
847 struct netlink_ring *ring;
848 struct sock *sk;
849
850 /* If a packet from the kernel to userspace was freed because of an
851 * error without being delivered to userspace, the kernel must reset
852 * the status. In the direction userspace to kernel, the status is
853 * always reset here after the packet was processed and freed.
854 */
855 if (netlink_skb_is_mmaped(skb)) {
856 hdr = netlink_mmap_hdr(skb);
857 sk = NETLINK_CB(skb).sk;
858
Patrick McHardy5fd96122013-04-17 06:47:03 +0000859 if (NETLINK_CB(skb).flags & NETLINK_SKB_TX) {
860 netlink_set_status(hdr, NL_MMAP_STATUS_UNUSED);
861 ring = &nlk_sk(sk)->tx_ring;
862 } else {
863 if (!(NETLINK_CB(skb).flags & NETLINK_SKB_DELIVERED)) {
864 hdr->nm_len = 0;
865 netlink_set_status(hdr, NL_MMAP_STATUS_VALID);
866 }
867 ring = &nlk_sk(sk)->rx_ring;
Patrick McHardy9652e932013-04-17 06:47:02 +0000868 }
Patrick McHardy9652e932013-04-17 06:47:02 +0000869
870 WARN_ON(atomic_read(&ring->pending) == 0);
871 atomic_dec(&ring->pending);
872 sock_put(sk);
873
Pablo Neira5e71d9d2013-06-03 09:28:43 +0000874 skb->head = NULL;
Patrick McHardy9652e932013-04-17 06:47:02 +0000875 }
876#endif
Pablo Neira Ayusoc05cdb12013-06-03 09:46:28 +0000877 if (is_vmalloc_addr(skb->head)) {
Pablo Neira3a365152013-06-28 03:04:23 +0200878 if (!skb->cloned ||
879 !atomic_dec_return(&(skb_shinfo(skb)->dataref)))
880 vfree(skb->head);
881
Pablo Neira Ayusoc05cdb12013-06-03 09:46:28 +0000882 skb->head = NULL;
883 }
Patrick McHardy9652e932013-04-17 06:47:02 +0000884 if (skb->sk != NULL)
885 sock_rfree(skb);
Patrick McHardycf0a0182013-04-17 06:47:00 +0000886}
887
888static void netlink_skb_set_owner_r(struct sk_buff *skb, struct sock *sk)
889{
890 WARN_ON(skb->sk != NULL);
891 skb->sk = sk;
892 skb->destructor = netlink_skb_destructor;
893 atomic_add(skb->truesize, &sk->sk_rmem_alloc);
894 sk_mem_charge(sk, skb->truesize);
895}
896
Linus Torvalds1da177e2005-04-16 15:20:36 -0700897static void netlink_sock_destruct(struct sock *sk)
898{
Herbert Xu3f660d62007-05-03 03:17:14 -0700899 struct netlink_sock *nlk = nlk_sk(sk);
900
Pravin B Shelar16b304f2013-08-15 15:31:06 -0700901 if (nlk->cb_running) {
902 if (nlk->cb.done)
903 nlk->cb.done(&nlk->cb);
Gao feng6dc878a2012-10-04 20:15:48 +0000904
Pravin B Shelar16b304f2013-08-15 15:31:06 -0700905 module_put(nlk->cb.module);
906 kfree_skb(nlk->cb.skb);
Herbert Xu3f660d62007-05-03 03:17:14 -0700907 }
908
Linus Torvalds1da177e2005-04-16 15:20:36 -0700909 skb_queue_purge(&sk->sk_receive_queue);
Patrick McHardyccdfcc32013-04-17 06:47:01 +0000910#ifdef CONFIG_NETLINK_MMAP
911 if (1) {
912 struct nl_mmap_req req;
913
914 memset(&req, 0, sizeof(req));
915 if (nlk->rx_ring.pg_vec)
916 netlink_set_ring(sk, &req, true, false);
917 memset(&req, 0, sizeof(req));
918 if (nlk->tx_ring.pg_vec)
919 netlink_set_ring(sk, &req, true, true);
920 }
921#endif /* CONFIG_NETLINK_MMAP */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700922
923 if (!sock_flag(sk, SOCK_DEAD)) {
Patrick McHardy6ac552f2007-12-04 00:19:38 -0800924 printk(KERN_ERR "Freeing alive netlink socket %p\n", sk);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700925 return;
926 }
Ilpo Järvinen547b7922008-07-25 21:43:18 -0700927
928 WARN_ON(atomic_read(&sk->sk_rmem_alloc));
929 WARN_ON(atomic_read(&sk->sk_wmem_alloc));
930 WARN_ON(nlk_sk(sk)->groups);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700931}
932
Patrick McHardy6ac552f2007-12-04 00:19:38 -0800933/* This lock without WQ_FLAG_EXCLUSIVE is good on UP and it is _very_ bad on
934 * SMP. Look, when several writers sleep and reader wakes them up, all but one
Linus Torvalds1da177e2005-04-16 15:20:36 -0700935 * immediately hit write lock and grab all the cpus. Exclusive sleep solves
936 * this, _but_ remember, it adds useless work on UP machines.
937 */
938
Johannes Bergd136f1b2009-09-12 03:03:15 +0000939void netlink_table_grab(void)
Eric Dumazet9a429c42008-01-01 21:58:02 -0800940 __acquires(nl_table_lock)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700941{
Johannes Bergd136f1b2009-09-12 03:03:15 +0000942 might_sleep();
943
Arjan van de Ven6abd2192006-07-03 00:24:07 -0700944 write_lock_irq(&nl_table_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700945
946 if (atomic_read(&nl_table_users)) {
947 DECLARE_WAITQUEUE(wait, current);
948
949 add_wait_queue_exclusive(&nl_table_wait, &wait);
Patrick McHardy6ac552f2007-12-04 00:19:38 -0800950 for (;;) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700951 set_current_state(TASK_UNINTERRUPTIBLE);
952 if (atomic_read(&nl_table_users) == 0)
953 break;
Arjan van de Ven6abd2192006-07-03 00:24:07 -0700954 write_unlock_irq(&nl_table_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700955 schedule();
Arjan van de Ven6abd2192006-07-03 00:24:07 -0700956 write_lock_irq(&nl_table_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700957 }
958
959 __set_current_state(TASK_RUNNING);
960 remove_wait_queue(&nl_table_wait, &wait);
961 }
962}
963
Johannes Bergd136f1b2009-09-12 03:03:15 +0000964void netlink_table_ungrab(void)
Eric Dumazet9a429c42008-01-01 21:58:02 -0800965 __releases(nl_table_lock)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700966{
Arjan van de Ven6abd2192006-07-03 00:24:07 -0700967 write_unlock_irq(&nl_table_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700968 wake_up(&nl_table_wait);
969}
970
Patrick McHardy6ac552f2007-12-04 00:19:38 -0800971static inline void
Linus Torvalds1da177e2005-04-16 15:20:36 -0700972netlink_lock_table(void)
973{
974 /* read_lock() synchronizes us to netlink_table_grab */
975
976 read_lock(&nl_table_lock);
977 atomic_inc(&nl_table_users);
978 read_unlock(&nl_table_lock);
979}
980
Patrick McHardy6ac552f2007-12-04 00:19:38 -0800981static inline void
Linus Torvalds1da177e2005-04-16 15:20:36 -0700982netlink_unlock_table(void)
983{
984 if (atomic_dec_and_test(&nl_table_users))
985 wake_up(&nl_table_wait);
986}
987
Gao fengda12c902013-06-06 14:49:11 +0800988static bool netlink_compare(struct net *net, struct sock *sk)
989{
990 return net_eq(sock_net(sk), net);
991}
992
Eric W. Biederman15e47302012-09-07 20:12:54 +0000993static struct sock *netlink_lookup(struct net *net, int protocol, u32 portid)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700994{
Gao fengda12c902013-06-06 14:49:11 +0800995 struct netlink_table *table = &nl_table[protocol];
996 struct nl_portid_hash *hash = &table->hash;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700997 struct hlist_head *head;
998 struct sock *sk;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700999
1000 read_lock(&nl_table_lock);
Eric W. Biederman15e47302012-09-07 20:12:54 +00001001 head = nl_portid_hashfn(hash, portid);
Sasha Levinb67bfe02013-02-27 17:06:00 -08001002 sk_for_each(sk, head) {
Gao fengda12c902013-06-06 14:49:11 +08001003 if (table->compare(net, sk) &&
1004 (nlk_sk(sk)->portid == portid)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001005 sock_hold(sk);
1006 goto found;
1007 }
1008 }
1009 sk = NULL;
1010found:
1011 read_unlock(&nl_table_lock);
1012 return sk;
1013}
1014
Eric W. Biederman15e47302012-09-07 20:12:54 +00001015static struct hlist_head *nl_portid_hash_zalloc(size_t size)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001016{
1017 if (size <= PAGE_SIZE)
Eric Dumazetea729122007-12-11 02:09:47 -08001018 return kzalloc(size, GFP_ATOMIC);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001019 else
1020 return (struct hlist_head *)
Eric Dumazetea729122007-12-11 02:09:47 -08001021 __get_free_pages(GFP_ATOMIC | __GFP_ZERO,
1022 get_order(size));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001023}
1024
Eric W. Biederman15e47302012-09-07 20:12:54 +00001025static void nl_portid_hash_free(struct hlist_head *table, size_t size)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001026{
1027 if (size <= PAGE_SIZE)
1028 kfree(table);
1029 else
1030 free_pages((unsigned long)table, get_order(size));
1031}
1032
Eric W. Biederman15e47302012-09-07 20:12:54 +00001033static int nl_portid_hash_rehash(struct nl_portid_hash *hash, int grow)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001034{
1035 unsigned int omask, mask, shift;
1036 size_t osize, size;
1037 struct hlist_head *otable, *table;
1038 int i;
1039
1040 omask = mask = hash->mask;
1041 osize = size = (mask + 1) * sizeof(*table);
1042 shift = hash->shift;
1043
1044 if (grow) {
1045 if (++shift > hash->max_shift)
1046 return 0;
1047 mask = mask * 2 + 1;
1048 size *= 2;
1049 }
1050
Eric W. Biederman15e47302012-09-07 20:12:54 +00001051 table = nl_portid_hash_zalloc(size);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001052 if (!table)
1053 return 0;
1054
Linus Torvalds1da177e2005-04-16 15:20:36 -07001055 otable = hash->table;
1056 hash->table = table;
1057 hash->mask = mask;
1058 hash->shift = shift;
1059 get_random_bytes(&hash->rnd, sizeof(hash->rnd));
1060
1061 for (i = 0; i <= omask; i++) {
1062 struct sock *sk;
Sasha Levinb67bfe02013-02-27 17:06:00 -08001063 struct hlist_node *tmp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001064
Sasha Levinb67bfe02013-02-27 17:06:00 -08001065 sk_for_each_safe(sk, tmp, &otable[i])
Eric W. Biederman15e47302012-09-07 20:12:54 +00001066 __sk_add_node(sk, nl_portid_hashfn(hash, nlk_sk(sk)->portid));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001067 }
1068
Eric W. Biederman15e47302012-09-07 20:12:54 +00001069 nl_portid_hash_free(otable, osize);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001070 hash->rehash_time = jiffies + 10 * 60 * HZ;
1071 return 1;
1072}
1073
Eric W. Biederman15e47302012-09-07 20:12:54 +00001074static inline int nl_portid_hash_dilute(struct nl_portid_hash *hash, int len)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001075{
1076 int avg = hash->entries >> hash->shift;
1077
Eric W. Biederman15e47302012-09-07 20:12:54 +00001078 if (unlikely(avg > 1) && nl_portid_hash_rehash(hash, 1))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001079 return 1;
1080
1081 if (unlikely(len > avg) && time_after(jiffies, hash->rehash_time)) {
Eric W. Biederman15e47302012-09-07 20:12:54 +00001082 nl_portid_hash_rehash(hash, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001083 return 1;
1084 }
1085
1086 return 0;
1087}
1088
Eric Dumazet90ddc4f2005-12-22 12:49:22 -08001089static const struct proto_ops netlink_ops;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001090
Patrick McHardy4277a082006-03-20 18:52:01 -08001091static void
1092netlink_update_listeners(struct sock *sk)
1093{
1094 struct netlink_table *tbl = &nl_table[sk->sk_protocol];
Patrick McHardy4277a082006-03-20 18:52:01 -08001095 unsigned long mask;
1096 unsigned int i;
Eric Dumazet6d772ac2012-10-18 03:21:55 +00001097 struct listeners *listeners;
1098
1099 listeners = nl_deref_protected(tbl->listeners);
1100 if (!listeners)
1101 return;
Patrick McHardy4277a082006-03-20 18:52:01 -08001102
Johannes Bergb4ff4f02007-07-18 15:46:06 -07001103 for (i = 0; i < NLGRPLONGS(tbl->groups); i++) {
Patrick McHardy4277a082006-03-20 18:52:01 -08001104 mask = 0;
Sasha Levinb67bfe02013-02-27 17:06:00 -08001105 sk_for_each_bound(sk, &tbl->mc_list) {
Johannes Bergb4ff4f02007-07-18 15:46:06 -07001106 if (i < NLGRPLONGS(nlk_sk(sk)->ngroups))
1107 mask |= nlk_sk(sk)->groups[i];
1108 }
Eric Dumazet6d772ac2012-10-18 03:21:55 +00001109 listeners->masks[i] = mask;
Patrick McHardy4277a082006-03-20 18:52:01 -08001110 }
1111 /* this function is only called with the netlink table "grabbed", which
1112 * makes sure updates are visible before bind or setsockopt return. */
1113}
1114
Eric W. Biederman15e47302012-09-07 20:12:54 +00001115static int netlink_insert(struct sock *sk, struct net *net, u32 portid)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001116{
Gao fengda12c902013-06-06 14:49:11 +08001117 struct netlink_table *table = &nl_table[sk->sk_protocol];
1118 struct nl_portid_hash *hash = &table->hash;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001119 struct hlist_head *head;
1120 int err = -EADDRINUSE;
1121 struct sock *osk;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001122 int len;
1123
1124 netlink_table_grab();
Eric W. Biederman15e47302012-09-07 20:12:54 +00001125 head = nl_portid_hashfn(hash, portid);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001126 len = 0;
Sasha Levinb67bfe02013-02-27 17:06:00 -08001127 sk_for_each(osk, head) {
Gao fengda12c902013-06-06 14:49:11 +08001128 if (table->compare(net, osk) &&
1129 (nlk_sk(osk)->portid == portid))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001130 break;
1131 len++;
1132 }
Sasha Levinb67bfe02013-02-27 17:06:00 -08001133 if (osk)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001134 goto err;
1135
1136 err = -EBUSY;
Eric W. Biederman15e47302012-09-07 20:12:54 +00001137 if (nlk_sk(sk)->portid)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001138 goto err;
1139
1140 err = -ENOMEM;
1141 if (BITS_PER_LONG > 32 && unlikely(hash->entries >= UINT_MAX))
1142 goto err;
1143
Eric W. Biederman15e47302012-09-07 20:12:54 +00001144 if (len && nl_portid_hash_dilute(hash, len))
1145 head = nl_portid_hashfn(hash, portid);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001146 hash->entries++;
Eric W. Biederman15e47302012-09-07 20:12:54 +00001147 nlk_sk(sk)->portid = portid;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001148 sk_add_node(sk, head);
1149 err = 0;
1150
1151err:
1152 netlink_table_ungrab();
1153 return err;
1154}
1155
1156static void netlink_remove(struct sock *sk)
1157{
1158 netlink_table_grab();
David S. Millerd470e3b2005-06-26 15:31:51 -07001159 if (sk_del_node_init(sk))
1160 nl_table[sk->sk_protocol].hash.entries--;
Patrick McHardyf7fa9b12005-08-15 12:29:13 -07001161 if (nlk_sk(sk)->subscriptions)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001162 __sk_del_bind_node(sk);
1163 netlink_table_ungrab();
1164}
1165
1166static struct proto netlink_proto = {
1167 .name = "NETLINK",
1168 .owner = THIS_MODULE,
1169 .obj_size = sizeof(struct netlink_sock),
1170};
1171
Eric W. Biederman1b8d7ae2007-10-08 23:24:22 -07001172static int __netlink_create(struct net *net, struct socket *sock,
1173 struct mutex *cb_mutex, int protocol)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001174{
1175 struct sock *sk;
1176 struct netlink_sock *nlk;
Patrick McHardyab33a172005-08-14 19:31:36 -07001177
1178 sock->ops = &netlink_ops;
1179
Pavel Emelyanov6257ff22007-11-01 00:39:31 -07001180 sk = sk_alloc(net, PF_NETLINK, GFP_KERNEL, &netlink_proto);
Patrick McHardyab33a172005-08-14 19:31:36 -07001181 if (!sk)
1182 return -ENOMEM;
1183
1184 sock_init_data(sock, sk);
1185
1186 nlk = nlk_sk(sk);
Eric Dumazet658cb352012-04-22 21:30:21 +00001187 if (cb_mutex) {
Patrick McHardyffa4d722007-04-25 14:01:17 -07001188 nlk->cb_mutex = cb_mutex;
Eric Dumazet658cb352012-04-22 21:30:21 +00001189 } else {
Patrick McHardyffa4d722007-04-25 14:01:17 -07001190 nlk->cb_mutex = &nlk->cb_def_mutex;
1191 mutex_init(nlk->cb_mutex);
1192 }
Patrick McHardyab33a172005-08-14 19:31:36 -07001193 init_waitqueue_head(&nlk->wait);
Patrick McHardyccdfcc32013-04-17 06:47:01 +00001194#ifdef CONFIG_NETLINK_MMAP
1195 mutex_init(&nlk->pg_vec_lock);
1196#endif
Patrick McHardyab33a172005-08-14 19:31:36 -07001197
1198 sk->sk_destruct = netlink_sock_destruct;
1199 sk->sk_protocol = protocol;
1200 return 0;
1201}
1202
Eric Paris3f378b62009-11-05 22:18:14 -08001203static int netlink_create(struct net *net, struct socket *sock, int protocol,
1204 int kern)
Patrick McHardyab33a172005-08-14 19:31:36 -07001205{
1206 struct module *module = NULL;
Patrick McHardyaf65bdf2007-04-20 14:14:21 -07001207 struct mutex *cb_mutex;
Patrick McHardyf7fa9b12005-08-15 12:29:13 -07001208 struct netlink_sock *nlk;
Richard Guy Briggs4f520902014-04-22 21:31:54 -04001209 int (*bind)(int group);
1210 void (*unbind)(int group);
Patrick McHardyab33a172005-08-14 19:31:36 -07001211 int err = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001212
1213 sock->state = SS_UNCONNECTED;
1214
1215 if (sock->type != SOCK_RAW && sock->type != SOCK_DGRAM)
1216 return -ESOCKTNOSUPPORT;
1217
Patrick McHardy6ac552f2007-12-04 00:19:38 -08001218 if (protocol < 0 || protocol >= MAX_LINKS)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001219 return -EPROTONOSUPPORT;
1220
Patrick McHardy77247bb2005-08-14 19:27:13 -07001221 netlink_lock_table();
Johannes Berg95a5afc2008-10-16 15:24:51 -07001222#ifdef CONFIG_MODULES
Patrick McHardyab33a172005-08-14 19:31:36 -07001223 if (!nl_table[protocol].registered) {
Patrick McHardy77247bb2005-08-14 19:27:13 -07001224 netlink_unlock_table();
Harald Welte4fdb3bb2005-08-09 19:40:55 -07001225 request_module("net-pf-%d-proto-%d", PF_NETLINK, protocol);
Patrick McHardy77247bb2005-08-14 19:27:13 -07001226 netlink_lock_table();
Harald Welte4fdb3bb2005-08-09 19:40:55 -07001227 }
Patrick McHardyab33a172005-08-14 19:31:36 -07001228#endif
1229 if (nl_table[protocol].registered &&
1230 try_module_get(nl_table[protocol].module))
1231 module = nl_table[protocol].module;
Alexey Dobriyan974c37e2010-01-30 10:05:05 +00001232 else
1233 err = -EPROTONOSUPPORT;
Patrick McHardyaf65bdf2007-04-20 14:14:21 -07001234 cb_mutex = nl_table[protocol].cb_mutex;
Pablo Neira Ayuso03292742012-06-29 06:15:22 +00001235 bind = nl_table[protocol].bind;
Richard Guy Briggs4f520902014-04-22 21:31:54 -04001236 unbind = nl_table[protocol].unbind;
Patrick McHardy77247bb2005-08-14 19:27:13 -07001237 netlink_unlock_table();
Harald Welte4fdb3bb2005-08-09 19:40:55 -07001238
Alexey Dobriyan974c37e2010-01-30 10:05:05 +00001239 if (err < 0)
1240 goto out;
1241
Patrick McHardy6ac552f2007-12-04 00:19:38 -08001242 err = __netlink_create(net, sock, cb_mutex, protocol);
1243 if (err < 0)
Patrick McHardyab33a172005-08-14 19:31:36 -07001244 goto out_module;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001245
David S. Miller6f756a82008-11-23 17:34:03 -08001246 local_bh_disable();
Eric Dumazetc1fd3b92008-11-23 15:48:22 -08001247 sock_prot_inuse_add(net, &netlink_proto, 1);
David S. Miller6f756a82008-11-23 17:34:03 -08001248 local_bh_enable();
1249
Patrick McHardyf7fa9b12005-08-15 12:29:13 -07001250 nlk = nlk_sk(sock->sk);
Patrick McHardyf7fa9b12005-08-15 12:29:13 -07001251 nlk->module = module;
Pablo Neira Ayuso03292742012-06-29 06:15:22 +00001252 nlk->netlink_bind = bind;
Richard Guy Briggs4f520902014-04-22 21:31:54 -04001253 nlk->netlink_unbind = unbind;
Patrick McHardyab33a172005-08-14 19:31:36 -07001254out:
1255 return err;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001256
Patrick McHardyab33a172005-08-14 19:31:36 -07001257out_module:
1258 module_put(module);
1259 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001260}
1261
1262static int netlink_release(struct socket *sock)
1263{
1264 struct sock *sk = sock->sk;
1265 struct netlink_sock *nlk;
1266
1267 if (!sk)
1268 return 0;
1269
1270 netlink_remove(sk);
Denis Lunevac57b3a2007-04-18 17:05:58 -07001271 sock_orphan(sk);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001272 nlk = nlk_sk(sk);
1273
Herbert Xu3f660d62007-05-03 03:17:14 -07001274 /*
1275 * OK. Socket is unlinked, any packets that arrive now
1276 * will be purged.
1277 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001278
Linus Torvalds1da177e2005-04-16 15:20:36 -07001279 sock->sk = NULL;
1280 wake_up_interruptible_all(&nlk->wait);
1281
1282 skb_queue_purge(&sk->sk_write_queue);
1283
Eric W. Biederman15e47302012-09-07 20:12:54 +00001284 if (nlk->portid) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001285 struct netlink_notify n = {
YOSHIFUJI Hideaki3b1e0a62008-03-26 02:26:21 +09001286 .net = sock_net(sk),
Linus Torvalds1da177e2005-04-16 15:20:36 -07001287 .protocol = sk->sk_protocol,
Eric W. Biederman15e47302012-09-07 20:12:54 +00001288 .portid = nlk->portid,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001289 };
Alan Sterne041c682006-03-27 01:16:30 -08001290 atomic_notifier_call_chain(&netlink_chain,
1291 NETLINK_URELEASE, &n);
YOSHIFUJI Hideaki746fac42007-02-09 23:25:07 +09001292 }
Harald Welte4fdb3bb2005-08-09 19:40:55 -07001293
Mariusz Kozlowski5e7c0012007-01-02 15:24:30 -08001294 module_put(nlk->module);
Harald Welte4fdb3bb2005-08-09 19:40:55 -07001295
Patrick McHardy4277a082006-03-20 18:52:01 -08001296 netlink_table_grab();
Denis V. Lunevaed81562007-10-10 21:14:32 -07001297 if (netlink_is_kernel(sk)) {
Denis V. Lunev869e58f2008-01-18 23:53:31 -08001298 BUG_ON(nl_table[sk->sk_protocol].registered == 0);
1299 if (--nl_table[sk->sk_protocol].registered == 0) {
Eric Dumazet6d772ac2012-10-18 03:21:55 +00001300 struct listeners *old;
1301
1302 old = nl_deref_protected(nl_table[sk->sk_protocol].listeners);
1303 RCU_INIT_POINTER(nl_table[sk->sk_protocol].listeners, NULL);
1304 kfree_rcu(old, rcu);
Denis V. Lunev869e58f2008-01-18 23:53:31 -08001305 nl_table[sk->sk_protocol].module = NULL;
Pablo Neira Ayuso9785e102012-09-08 02:53:53 +00001306 nl_table[sk->sk_protocol].bind = NULL;
Richard Guy Briggs4f520902014-04-22 21:31:54 -04001307 nl_table[sk->sk_protocol].unbind = NULL;
Pablo Neira Ayuso9785e102012-09-08 02:53:53 +00001308 nl_table[sk->sk_protocol].flags = 0;
Denis V. Lunev869e58f2008-01-18 23:53:31 -08001309 nl_table[sk->sk_protocol].registered = 0;
1310 }
Eric Dumazet658cb352012-04-22 21:30:21 +00001311 } else if (nlk->subscriptions) {
Patrick McHardy4277a082006-03-20 18:52:01 -08001312 netlink_update_listeners(sk);
Eric Dumazet658cb352012-04-22 21:30:21 +00001313 }
Patrick McHardy4277a082006-03-20 18:52:01 -08001314 netlink_table_ungrab();
Patrick McHardy77247bb2005-08-14 19:27:13 -07001315
Patrick McHardyf7fa9b12005-08-15 12:29:13 -07001316 kfree(nlk->groups);
1317 nlk->groups = NULL;
1318
Eric Dumazet37558102008-11-24 14:05:22 -08001319 local_bh_disable();
Eric Dumazetc1fd3b92008-11-23 15:48:22 -08001320 sock_prot_inuse_add(sock_net(sk), &netlink_proto, -1);
Eric Dumazet37558102008-11-24 14:05:22 -08001321 local_bh_enable();
Linus Torvalds1da177e2005-04-16 15:20:36 -07001322 sock_put(sk);
1323 return 0;
1324}
1325
1326static int netlink_autobind(struct socket *sock)
1327{
1328 struct sock *sk = sock->sk;
YOSHIFUJI Hideaki3b1e0a62008-03-26 02:26:21 +09001329 struct net *net = sock_net(sk);
Gao fengda12c902013-06-06 14:49:11 +08001330 struct netlink_table *table = &nl_table[sk->sk_protocol];
1331 struct nl_portid_hash *hash = &table->hash;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001332 struct hlist_head *head;
1333 struct sock *osk;
Eric W. Biederman15e47302012-09-07 20:12:54 +00001334 s32 portid = task_tgid_vnr(current);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001335 int err;
1336 static s32 rover = -4097;
1337
1338retry:
1339 cond_resched();
1340 netlink_table_grab();
Eric W. Biederman15e47302012-09-07 20:12:54 +00001341 head = nl_portid_hashfn(hash, portid);
Sasha Levinb67bfe02013-02-27 17:06:00 -08001342 sk_for_each(osk, head) {
Gao fengda12c902013-06-06 14:49:11 +08001343 if (!table->compare(net, osk))
Eric W. Biedermanb4b51022007-09-12 13:05:38 +02001344 continue;
Eric W. Biederman15e47302012-09-07 20:12:54 +00001345 if (nlk_sk(osk)->portid == portid) {
1346 /* Bind collision, search negative portid values. */
1347 portid = rover--;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001348 if (rover > -4097)
1349 rover = -4097;
1350 netlink_table_ungrab();
1351 goto retry;
1352 }
1353 }
1354 netlink_table_ungrab();
1355
Eric W. Biederman15e47302012-09-07 20:12:54 +00001356 err = netlink_insert(sk, net, portid);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001357 if (err == -EADDRINUSE)
1358 goto retry;
David S. Millerd470e3b2005-06-26 15:31:51 -07001359
1360 /* If 2 threads race to autobind, that is fine. */
1361 if (err == -EBUSY)
1362 err = 0;
1363
1364 return err;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001365}
1366
Eric W. Biedermanaa4cf942014-04-23 14:28:03 -07001367/**
1368 * __netlink_ns_capable - General netlink message capability test
1369 * @nsp: NETLINK_CB of the socket buffer holding a netlink command from userspace.
1370 * @user_ns: The user namespace of the capability to use
1371 * @cap: The capability to use
1372 *
1373 * Test to see if the opener of the socket we received the message
1374 * from had when the netlink socket was created and the sender of the
1375 * message has has the capability @cap in the user namespace @user_ns.
1376 */
1377bool __netlink_ns_capable(const struct netlink_skb_parms *nsp,
1378 struct user_namespace *user_ns, int cap)
1379{
Eric W. Biederman2d7a85f2014-05-30 11:04:00 -07001380 return ((nsp->flags & NETLINK_SKB_DST) ||
1381 file_ns_capable(nsp->sk->sk_socket->file, user_ns, cap)) &&
1382 ns_capable(user_ns, cap);
Eric W. Biedermanaa4cf942014-04-23 14:28:03 -07001383}
1384EXPORT_SYMBOL(__netlink_ns_capable);
1385
1386/**
1387 * netlink_ns_capable - General netlink message capability test
1388 * @skb: socket buffer holding a netlink command from userspace
1389 * @user_ns: The user namespace of the capability to use
1390 * @cap: The capability to use
1391 *
1392 * Test to see if the opener of the socket we received the message
1393 * from had when the netlink socket was created and the sender of the
1394 * message has has the capability @cap in the user namespace @user_ns.
1395 */
1396bool netlink_ns_capable(const struct sk_buff *skb,
1397 struct user_namespace *user_ns, int cap)
1398{
1399 return __netlink_ns_capable(&NETLINK_CB(skb), user_ns, cap);
1400}
1401EXPORT_SYMBOL(netlink_ns_capable);
1402
1403/**
1404 * netlink_capable - Netlink global message capability test
1405 * @skb: socket buffer holding a netlink command from userspace
1406 * @cap: The capability to use
1407 *
1408 * Test to see if the opener of the socket we received the message
1409 * from had when the netlink socket was created and the sender of the
1410 * message has has the capability @cap in all user namespaces.
1411 */
1412bool netlink_capable(const struct sk_buff *skb, int cap)
1413{
1414 return netlink_ns_capable(skb, &init_user_ns, cap);
1415}
1416EXPORT_SYMBOL(netlink_capable);
1417
1418/**
1419 * netlink_net_capable - Netlink network namespace message capability test
1420 * @skb: socket buffer holding a netlink command from userspace
1421 * @cap: The capability to use
1422 *
1423 * Test to see if the opener of the socket we received the message
1424 * from had when the netlink socket was created and the sender of the
1425 * message has has the capability @cap over the network namespace of
1426 * the socket we received the message from.
1427 */
1428bool netlink_net_capable(const struct sk_buff *skb, int cap)
1429{
1430 return netlink_ns_capable(skb, sock_net(skb->sk)->user_ns, cap);
1431}
1432EXPORT_SYMBOL(netlink_net_capable);
1433
Eric W. Biederman5187cd02014-04-23 14:25:48 -07001434static inline int netlink_allowed(const struct socket *sock, unsigned int flag)
YOSHIFUJI Hideaki746fac42007-02-09 23:25:07 +09001435{
Pablo Neira Ayuso9785e102012-09-08 02:53:53 +00001436 return (nl_table[sock->sk->sk_protocol].flags & flag) ||
Eric W. Biedermandf008c92012-11-16 03:03:07 +00001437 ns_capable(sock_net(sock->sk)->user_ns, CAP_NET_ADMIN);
YOSHIFUJI Hideaki746fac42007-02-09 23:25:07 +09001438}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001439
Patrick McHardyf7fa9b12005-08-15 12:29:13 -07001440static void
1441netlink_update_subscriptions(struct sock *sk, unsigned int subscriptions)
1442{
1443 struct netlink_sock *nlk = nlk_sk(sk);
1444
1445 if (nlk->subscriptions && !subscriptions)
1446 __sk_del_bind_node(sk);
1447 else if (!nlk->subscriptions && subscriptions)
1448 sk_add_bind_node(sk, &nl_table[sk->sk_protocol].mc_list);
1449 nlk->subscriptions = subscriptions;
1450}
1451
Johannes Bergb4ff4f02007-07-18 15:46:06 -07001452static int netlink_realloc_groups(struct sock *sk)
Patrick McHardy513c2502005-09-06 15:43:59 -07001453{
1454 struct netlink_sock *nlk = nlk_sk(sk);
1455 unsigned int groups;
Johannes Bergb4ff4f02007-07-18 15:46:06 -07001456 unsigned long *new_groups;
Patrick McHardy513c2502005-09-06 15:43:59 -07001457 int err = 0;
1458
Johannes Bergb4ff4f02007-07-18 15:46:06 -07001459 netlink_table_grab();
1460
Patrick McHardy513c2502005-09-06 15:43:59 -07001461 groups = nl_table[sk->sk_protocol].groups;
Johannes Bergb4ff4f02007-07-18 15:46:06 -07001462 if (!nl_table[sk->sk_protocol].registered) {
Patrick McHardy513c2502005-09-06 15:43:59 -07001463 err = -ENOENT;
Johannes Bergb4ff4f02007-07-18 15:46:06 -07001464 goto out_unlock;
1465 }
Patrick McHardy513c2502005-09-06 15:43:59 -07001466
Johannes Bergb4ff4f02007-07-18 15:46:06 -07001467 if (nlk->ngroups >= groups)
1468 goto out_unlock;
Patrick McHardy513c2502005-09-06 15:43:59 -07001469
Johannes Bergb4ff4f02007-07-18 15:46:06 -07001470 new_groups = krealloc(nlk->groups, NLGRPSZ(groups), GFP_ATOMIC);
1471 if (new_groups == NULL) {
1472 err = -ENOMEM;
1473 goto out_unlock;
1474 }
Patrick McHardy6ac552f2007-12-04 00:19:38 -08001475 memset((char *)new_groups + NLGRPSZ(nlk->ngroups), 0,
Johannes Bergb4ff4f02007-07-18 15:46:06 -07001476 NLGRPSZ(groups) - NLGRPSZ(nlk->ngroups));
1477
1478 nlk->groups = new_groups;
Patrick McHardy513c2502005-09-06 15:43:59 -07001479 nlk->ngroups = groups;
Johannes Bergb4ff4f02007-07-18 15:46:06 -07001480 out_unlock:
1481 netlink_table_ungrab();
1482 return err;
Patrick McHardy513c2502005-09-06 15:43:59 -07001483}
1484
Richard Guy Briggs4f520902014-04-22 21:31:54 -04001485static void netlink_unbind(int group, long unsigned int groups,
1486 struct netlink_sock *nlk)
1487{
1488 int undo;
1489
1490 if (!nlk->netlink_unbind)
1491 return;
1492
1493 for (undo = 0; undo < group; undo++)
1494 if (test_bit(group, &groups))
1495 nlk->netlink_unbind(undo);
1496}
1497
Patrick McHardy6ac552f2007-12-04 00:19:38 -08001498static int netlink_bind(struct socket *sock, struct sockaddr *addr,
1499 int addr_len)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001500{
1501 struct sock *sk = sock->sk;
YOSHIFUJI Hideaki3b1e0a62008-03-26 02:26:21 +09001502 struct net *net = sock_net(sk);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001503 struct netlink_sock *nlk = nlk_sk(sk);
1504 struct sockaddr_nl *nladdr = (struct sockaddr_nl *)addr;
1505 int err;
Richard Guy Briggs4f520902014-04-22 21:31:54 -04001506 long unsigned int groups = nladdr->nl_groups;
YOSHIFUJI Hideaki746fac42007-02-09 23:25:07 +09001507
Hannes Frederic Sowa4e4b5372012-12-15 15:42:19 +00001508 if (addr_len < sizeof(struct sockaddr_nl))
1509 return -EINVAL;
1510
Linus Torvalds1da177e2005-04-16 15:20:36 -07001511 if (nladdr->nl_family != AF_NETLINK)
1512 return -EINVAL;
1513
1514 /* Only superuser is allowed to listen multicasts */
Richard Guy Briggs4f520902014-04-22 21:31:54 -04001515 if (groups) {
Eric W. Biederman5187cd02014-04-23 14:25:48 -07001516 if (!netlink_allowed(sock, NL_CFG_F_NONROOT_RECV))
Patrick McHardy513c2502005-09-06 15:43:59 -07001517 return -EPERM;
Johannes Bergb4ff4f02007-07-18 15:46:06 -07001518 err = netlink_realloc_groups(sk);
1519 if (err)
1520 return err;
Patrick McHardy513c2502005-09-06 15:43:59 -07001521 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001522
Richard Guy Briggs4f520902014-04-22 21:31:54 -04001523 if (nlk->portid)
Eric W. Biederman15e47302012-09-07 20:12:54 +00001524 if (nladdr->nl_pid != nlk->portid)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001525 return -EINVAL;
Richard Guy Briggs4f520902014-04-22 21:31:54 -04001526
1527 if (nlk->netlink_bind && groups) {
1528 int group;
1529
1530 for (group = 0; group < nlk->ngroups; group++) {
1531 if (!test_bit(group, &groups))
1532 continue;
1533 err = nlk->netlink_bind(group);
1534 if (!err)
1535 continue;
1536 netlink_unbind(group, groups, nlk);
1537 return err;
1538 }
1539 }
1540
1541 if (!nlk->portid) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001542 err = nladdr->nl_pid ?
Eric W. Biedermanb4b51022007-09-12 13:05:38 +02001543 netlink_insert(sk, net, nladdr->nl_pid) :
Linus Torvalds1da177e2005-04-16 15:20:36 -07001544 netlink_autobind(sock);
Richard Guy Briggs4f520902014-04-22 21:31:54 -04001545 if (err) {
1546 netlink_unbind(nlk->ngroups - 1, groups, nlk);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001547 return err;
Richard Guy Briggs4f520902014-04-22 21:31:54 -04001548 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001549 }
1550
Richard Guy Briggs4f520902014-04-22 21:31:54 -04001551 if (!groups && (nlk->groups == NULL || !(u32)nlk->groups[0]))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001552 return 0;
1553
1554 netlink_table_grab();
Patrick McHardyf7fa9b12005-08-15 12:29:13 -07001555 netlink_update_subscriptions(sk, nlk->subscriptions +
Richard Guy Briggs4f520902014-04-22 21:31:54 -04001556 hweight32(groups) -
YOSHIFUJI Hideaki746fac42007-02-09 23:25:07 +09001557 hweight32(nlk->groups[0]));
Richard Guy Briggs4f520902014-04-22 21:31:54 -04001558 nlk->groups[0] = (nlk->groups[0] & ~0xffffffffUL) | groups;
Patrick McHardy4277a082006-03-20 18:52:01 -08001559 netlink_update_listeners(sk);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001560 netlink_table_ungrab();
1561
1562 return 0;
1563}
1564
1565static int netlink_connect(struct socket *sock, struct sockaddr *addr,
1566 int alen, int flags)
1567{
1568 int err = 0;
1569 struct sock *sk = sock->sk;
1570 struct netlink_sock *nlk = nlk_sk(sk);
Patrick McHardy6ac552f2007-12-04 00:19:38 -08001571 struct sockaddr_nl *nladdr = (struct sockaddr_nl *)addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001572
Changli Gao6503d962010-03-31 22:58:26 +00001573 if (alen < sizeof(addr->sa_family))
1574 return -EINVAL;
1575
Linus Torvalds1da177e2005-04-16 15:20:36 -07001576 if (addr->sa_family == AF_UNSPEC) {
1577 sk->sk_state = NETLINK_UNCONNECTED;
Eric W. Biederman15e47302012-09-07 20:12:54 +00001578 nlk->dst_portid = 0;
Patrick McHardyd629b832005-08-14 19:27:50 -07001579 nlk->dst_group = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001580 return 0;
1581 }
1582 if (addr->sa_family != AF_NETLINK)
1583 return -EINVAL;
1584
Mike Pecovnik46833a82014-02-24 21:11:16 +01001585 if ((nladdr->nl_groups || nladdr->nl_pid) &&
Eric W. Biederman5187cd02014-04-23 14:25:48 -07001586 !netlink_allowed(sock, NL_CFG_F_NONROOT_SEND))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001587 return -EPERM;
1588
Eric W. Biederman15e47302012-09-07 20:12:54 +00001589 if (!nlk->portid)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001590 err = netlink_autobind(sock);
1591
1592 if (err == 0) {
1593 sk->sk_state = NETLINK_CONNECTED;
Eric W. Biederman15e47302012-09-07 20:12:54 +00001594 nlk->dst_portid = nladdr->nl_pid;
Patrick McHardyd629b832005-08-14 19:27:50 -07001595 nlk->dst_group = ffs(nladdr->nl_groups);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001596 }
1597
1598 return err;
1599}
1600
Patrick McHardy6ac552f2007-12-04 00:19:38 -08001601static int netlink_getname(struct socket *sock, struct sockaddr *addr,
1602 int *addr_len, int peer)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001603{
1604 struct sock *sk = sock->sk;
1605 struct netlink_sock *nlk = nlk_sk(sk);
Cyrill Gorcunov13cfa972009-11-08 05:51:19 +00001606 DECLARE_SOCKADDR(struct sockaddr_nl *, nladdr, addr);
YOSHIFUJI Hideaki746fac42007-02-09 23:25:07 +09001607
Linus Torvalds1da177e2005-04-16 15:20:36 -07001608 nladdr->nl_family = AF_NETLINK;
1609 nladdr->nl_pad = 0;
1610 *addr_len = sizeof(*nladdr);
1611
1612 if (peer) {
Eric W. Biederman15e47302012-09-07 20:12:54 +00001613 nladdr->nl_pid = nlk->dst_portid;
Patrick McHardyd629b832005-08-14 19:27:50 -07001614 nladdr->nl_groups = netlink_group_mask(nlk->dst_group);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001615 } else {
Eric W. Biederman15e47302012-09-07 20:12:54 +00001616 nladdr->nl_pid = nlk->portid;
Patrick McHardy513c2502005-09-06 15:43:59 -07001617 nladdr->nl_groups = nlk->groups ? nlk->groups[0] : 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001618 }
1619 return 0;
1620}
1621
Eric W. Biederman15e47302012-09-07 20:12:54 +00001622static struct sock *netlink_getsockbyportid(struct sock *ssk, u32 portid)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001623{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001624 struct sock *sock;
1625 struct netlink_sock *nlk;
1626
Eric W. Biederman15e47302012-09-07 20:12:54 +00001627 sock = netlink_lookup(sock_net(ssk), ssk->sk_protocol, portid);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001628 if (!sock)
1629 return ERR_PTR(-ECONNREFUSED);
1630
1631 /* Don't bother queuing skb if kernel socket has no input function */
1632 nlk = nlk_sk(sock);
Denis V. Lunevcd40b7d2007-10-10 21:15:29 -07001633 if (sock->sk_state == NETLINK_CONNECTED &&
Eric W. Biederman15e47302012-09-07 20:12:54 +00001634 nlk->dst_portid != nlk_sk(ssk)->portid) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001635 sock_put(sock);
1636 return ERR_PTR(-ECONNREFUSED);
1637 }
1638 return sock;
1639}
1640
1641struct sock *netlink_getsockbyfilp(struct file *filp)
1642{
Al Viro496ad9a2013-01-23 17:07:38 -05001643 struct inode *inode = file_inode(filp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001644 struct sock *sock;
1645
1646 if (!S_ISSOCK(inode->i_mode))
1647 return ERR_PTR(-ENOTSOCK);
1648
1649 sock = SOCKET_I(inode)->sk;
1650 if (sock->sk_family != AF_NETLINK)
1651 return ERR_PTR(-EINVAL);
1652
1653 sock_hold(sock);
1654 return sock;
1655}
1656
Pablo Neira3a365152013-06-28 03:04:23 +02001657static struct sk_buff *netlink_alloc_large_skb(unsigned int size,
1658 int broadcast)
Pablo Neira Ayusoc05cdb12013-06-03 09:46:28 +00001659{
1660 struct sk_buff *skb;
1661 void *data;
1662
Pablo Neira3a365152013-06-28 03:04:23 +02001663 if (size <= NLMSG_GOODSIZE || broadcast)
Pablo Neira Ayusoc05cdb12013-06-03 09:46:28 +00001664 return alloc_skb(size, GFP_KERNEL);
1665
Pablo Neira3a365152013-06-28 03:04:23 +02001666 size = SKB_DATA_ALIGN(size) +
1667 SKB_DATA_ALIGN(sizeof(struct skb_shared_info));
Pablo Neira Ayusoc05cdb12013-06-03 09:46:28 +00001668
1669 data = vmalloc(size);
1670 if (data == NULL)
Pablo Neira3a365152013-06-28 03:04:23 +02001671 return NULL;
Pablo Neira Ayusoc05cdb12013-06-03 09:46:28 +00001672
Pablo Neira3a365152013-06-28 03:04:23 +02001673 skb = build_skb(data, size);
1674 if (skb == NULL)
1675 vfree(data);
1676 else {
1677 skb->head_frag = 0;
1678 skb->destructor = netlink_skb_destructor;
1679 }
Pablo Neira Ayusoc05cdb12013-06-03 09:46:28 +00001680
1681 return skb;
Pablo Neira Ayusoc05cdb12013-06-03 09:46:28 +00001682}
1683
Linus Torvalds1da177e2005-04-16 15:20:36 -07001684/*
1685 * Attach a skb to a netlink socket.
1686 * The caller must hold a reference to the destination socket. On error, the
1687 * reference is dropped. The skb is not send to the destination, just all
1688 * all error checks are performed and memory in the queue is reserved.
1689 * Return values:
1690 * < 0: error. skb freed, reference to sock dropped.
1691 * 0: continue
1692 * 1: repeat lookup - reference dropped while waiting for socket memory.
1693 */
Denis V. Lunev9457afe2008-06-05 11:23:39 -07001694int netlink_attachskb(struct sock *sk, struct sk_buff *skb,
Patrick McHardyc3d8d1e2007-11-07 02:42:09 -08001695 long *timeo, struct sock *ssk)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001696{
1697 struct netlink_sock *nlk;
1698
1699 nlk = nlk_sk(sk);
1700
Patrick McHardy5fd96122013-04-17 06:47:03 +00001701 if ((atomic_read(&sk->sk_rmem_alloc) > sk->sk_rcvbuf ||
1702 test_bit(NETLINK_CONGESTED, &nlk->state)) &&
1703 !netlink_skb_is_mmaped(skb)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001704 DECLARE_WAITQUEUE(wait, current);
Patrick McHardyc3d8d1e2007-11-07 02:42:09 -08001705 if (!*timeo) {
Denis V. Lunevaed81562007-10-10 21:14:32 -07001706 if (!ssk || netlink_is_kernel(ssk))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001707 netlink_overrun(sk);
1708 sock_put(sk);
1709 kfree_skb(skb);
1710 return -EAGAIN;
1711 }
1712
1713 __set_current_state(TASK_INTERRUPTIBLE);
1714 add_wait_queue(&nlk->wait, &wait);
1715
1716 if ((atomic_read(&sk->sk_rmem_alloc) > sk->sk_rcvbuf ||
Patrick McHardycd967e02013-04-17 06:46:56 +00001717 test_bit(NETLINK_CONGESTED, &nlk->state)) &&
Linus Torvalds1da177e2005-04-16 15:20:36 -07001718 !sock_flag(sk, SOCK_DEAD))
Patrick McHardyc3d8d1e2007-11-07 02:42:09 -08001719 *timeo = schedule_timeout(*timeo);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001720
1721 __set_current_state(TASK_RUNNING);
1722 remove_wait_queue(&nlk->wait, &wait);
1723 sock_put(sk);
1724
1725 if (signal_pending(current)) {
1726 kfree_skb(skb);
Patrick McHardyc3d8d1e2007-11-07 02:42:09 -08001727 return sock_intr_errno(*timeo);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001728 }
1729 return 1;
1730 }
Patrick McHardycf0a0182013-04-17 06:47:00 +00001731 netlink_skb_set_owner_r(skb, sk);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001732 return 0;
1733}
1734
Eric Dumazet4a7e7c22012-04-05 22:17:46 +00001735static int __netlink_sendskb(struct sock *sk, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001736{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001737 int len = skb->len;
1738
Daniel Borkmannbcbde0d2013-06-21 19:38:07 +02001739 netlink_deliver_tap(skb);
1740
Patrick McHardyf9c22882013-04-17 06:47:04 +00001741#ifdef CONFIG_NETLINK_MMAP
1742 if (netlink_skb_is_mmaped(skb))
1743 netlink_queue_mmaped_skb(sk, skb);
1744 else if (netlink_rx_is_mmaped(sk))
1745 netlink_ring_set_copied(sk, skb);
1746 else
1747#endif /* CONFIG_NETLINK_MMAP */
1748 skb_queue_tail(&sk->sk_receive_queue, skb);
David S. Miller676d2362014-04-11 16:15:36 -04001749 sk->sk_data_ready(sk);
Eric Dumazet4a7e7c22012-04-05 22:17:46 +00001750 return len;
1751}
1752
1753int netlink_sendskb(struct sock *sk, struct sk_buff *skb)
1754{
1755 int len = __netlink_sendskb(sk, skb);
1756
Linus Torvalds1da177e2005-04-16 15:20:36 -07001757 sock_put(sk);
1758 return len;
1759}
1760
1761void netlink_detachskb(struct sock *sk, struct sk_buff *skb)
1762{
1763 kfree_skb(skb);
1764 sock_put(sk);
1765}
1766
stephen hemmingerb57ef81f2011-12-22 08:52:02 +00001767static struct sk_buff *netlink_trim(struct sk_buff *skb, gfp_t allocation)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001768{
1769 int delta;
1770
Patrick McHardy1298ca42013-04-17 06:46:59 +00001771 WARN_ON(skb->sk != NULL);
Patrick McHardy5fd96122013-04-17 06:47:03 +00001772 if (netlink_skb_is_mmaped(skb))
1773 return skb;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001774
Arnaldo Carvalho de Melo4305b542007-04-19 20:43:29 -07001775 delta = skb->end - skb->tail;
Pablo Neira Ayusoc05cdb12013-06-03 09:46:28 +00001776 if (is_vmalloc_addr(skb->head) || delta * 2 < skb->truesize)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001777 return skb;
1778
1779 if (skb_shared(skb)) {
1780 struct sk_buff *nskb = skb_clone(skb, allocation);
1781 if (!nskb)
1782 return skb;
Eric Dumazet8460c002012-04-19 02:24:28 +00001783 consume_skb(skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001784 skb = nskb;
1785 }
1786
1787 if (!pskb_expand_head(skb, 0, -delta, allocation))
1788 skb->truesize -= delta;
1789
1790 return skb;
1791}
1792
Eric W. Biederman3fbc2902012-05-24 17:21:27 -06001793static int netlink_unicast_kernel(struct sock *sk, struct sk_buff *skb,
1794 struct sock *ssk)
Denis V. Lunevcd40b7d2007-10-10 21:15:29 -07001795{
1796 int ret;
1797 struct netlink_sock *nlk = nlk_sk(sk);
1798
1799 ret = -ECONNREFUSED;
1800 if (nlk->netlink_rcv != NULL) {
1801 ret = skb->len;
Patrick McHardycf0a0182013-04-17 06:47:00 +00001802 netlink_skb_set_owner_r(skb, sk);
Patrick McHardye32123e2013-04-17 06:46:57 +00001803 NETLINK_CB(skb).sk = ssk;
Daniel Borkmann73bfd372013-12-23 14:35:55 +01001804 netlink_deliver_tap_kernel(sk, ssk, skb);
Denis V. Lunevcd40b7d2007-10-10 21:15:29 -07001805 nlk->netlink_rcv(skb);
Eric Dumazetbfb253c2012-04-22 21:30:29 +00001806 consume_skb(skb);
1807 } else {
1808 kfree_skb(skb);
Denis V. Lunevcd40b7d2007-10-10 21:15:29 -07001809 }
Denis V. Lunevcd40b7d2007-10-10 21:15:29 -07001810 sock_put(sk);
1811 return ret;
1812}
1813
1814int netlink_unicast(struct sock *ssk, struct sk_buff *skb,
Eric W. Biederman15e47302012-09-07 20:12:54 +00001815 u32 portid, int nonblock)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001816{
1817 struct sock *sk;
1818 int err;
1819 long timeo;
1820
1821 skb = netlink_trim(skb, gfp_any());
1822
1823 timeo = sock_sndtimeo(ssk, nonblock);
1824retry:
Eric W. Biederman15e47302012-09-07 20:12:54 +00001825 sk = netlink_getsockbyportid(ssk, portid);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001826 if (IS_ERR(sk)) {
1827 kfree_skb(skb);
1828 return PTR_ERR(sk);
1829 }
Denis V. Lunevcd40b7d2007-10-10 21:15:29 -07001830 if (netlink_is_kernel(sk))
Eric W. Biederman3fbc2902012-05-24 17:21:27 -06001831 return netlink_unicast_kernel(sk, skb, ssk);
Denis V. Lunevcd40b7d2007-10-10 21:15:29 -07001832
Stephen Hemmingerb1153f22008-03-21 15:46:12 -07001833 if (sk_filter(sk, skb)) {
Wang Chen84874602008-07-01 19:55:09 -07001834 err = skb->len;
Stephen Hemmingerb1153f22008-03-21 15:46:12 -07001835 kfree_skb(skb);
1836 sock_put(sk);
1837 return err;
1838 }
1839
Denis V. Lunev9457afe2008-06-05 11:23:39 -07001840 err = netlink_attachskb(sk, skb, &timeo, ssk);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001841 if (err == 1)
1842 goto retry;
1843 if (err)
1844 return err;
1845
Denis V. Lunev7ee015e2007-10-10 21:14:03 -07001846 return netlink_sendskb(sk, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001847}
Patrick McHardy6ac552f2007-12-04 00:19:38 -08001848EXPORT_SYMBOL(netlink_unicast);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001849
Patrick McHardyf9c22882013-04-17 06:47:04 +00001850struct sk_buff *netlink_alloc_skb(struct sock *ssk, unsigned int size,
1851 u32 dst_portid, gfp_t gfp_mask)
1852{
1853#ifdef CONFIG_NETLINK_MMAP
1854 struct sock *sk = NULL;
1855 struct sk_buff *skb;
1856 struct netlink_ring *ring;
1857 struct nl_mmap_hdr *hdr;
1858 unsigned int maxlen;
1859
1860 sk = netlink_getsockbyportid(ssk, dst_portid);
1861 if (IS_ERR(sk))
1862 goto out;
1863
1864 ring = &nlk_sk(sk)->rx_ring;
1865 /* fast-path without atomic ops for common case: non-mmaped receiver */
1866 if (ring->pg_vec == NULL)
1867 goto out_put;
1868
Thomas Grafaae9f0e2013-11-30 13:21:31 +01001869 if (ring->frame_size - NL_MMAP_HDRLEN < size)
1870 goto out_put;
1871
Patrick McHardyf9c22882013-04-17 06:47:04 +00001872 skb = alloc_skb_head(gfp_mask);
1873 if (skb == NULL)
1874 goto err1;
1875
1876 spin_lock_bh(&sk->sk_receive_queue.lock);
1877 /* check again under lock */
1878 if (ring->pg_vec == NULL)
1879 goto out_free;
1880
Thomas Grafaae9f0e2013-11-30 13:21:31 +01001881 /* check again under lock */
Patrick McHardyf9c22882013-04-17 06:47:04 +00001882 maxlen = ring->frame_size - NL_MMAP_HDRLEN;
1883 if (maxlen < size)
1884 goto out_free;
1885
1886 netlink_forward_ring(ring);
1887 hdr = netlink_current_frame(ring, NL_MMAP_STATUS_UNUSED);
1888 if (hdr == NULL)
1889 goto err2;
1890 netlink_ring_setup_skb(skb, sk, ring, hdr);
1891 netlink_set_status(hdr, NL_MMAP_STATUS_RESERVED);
1892 atomic_inc(&ring->pending);
1893 netlink_increment_head(ring);
1894
1895 spin_unlock_bh(&sk->sk_receive_queue.lock);
1896 return skb;
1897
1898err2:
1899 kfree_skb(skb);
1900 spin_unlock_bh(&sk->sk_receive_queue.lock);
Patrick McHardycd1df522013-04-17 06:47:05 +00001901 netlink_overrun(sk);
Patrick McHardyf9c22882013-04-17 06:47:04 +00001902err1:
1903 sock_put(sk);
1904 return NULL;
1905
1906out_free:
1907 kfree_skb(skb);
1908 spin_unlock_bh(&sk->sk_receive_queue.lock);
1909out_put:
1910 sock_put(sk);
1911out:
1912#endif
1913 return alloc_skb(size, gfp_mask);
1914}
1915EXPORT_SYMBOL_GPL(netlink_alloc_skb);
1916
Patrick McHardy4277a082006-03-20 18:52:01 -08001917int netlink_has_listeners(struct sock *sk, unsigned int group)
1918{
1919 int res = 0;
Eric Dumazet5c398dc2010-10-24 04:27:10 +00001920 struct listeners *listeners;
Patrick McHardy4277a082006-03-20 18:52:01 -08001921
Denis V. Lunevaed81562007-10-10 21:14:32 -07001922 BUG_ON(!netlink_is_kernel(sk));
Johannes Bergb4ff4f02007-07-18 15:46:06 -07001923
1924 rcu_read_lock();
1925 listeners = rcu_dereference(nl_table[sk->sk_protocol].listeners);
1926
Eric Dumazet6d772ac2012-10-18 03:21:55 +00001927 if (listeners && group - 1 < nl_table[sk->sk_protocol].groups)
Eric Dumazet5c398dc2010-10-24 04:27:10 +00001928 res = test_bit(group - 1, listeners->masks);
Johannes Bergb4ff4f02007-07-18 15:46:06 -07001929
1930 rcu_read_unlock();
1931
Patrick McHardy4277a082006-03-20 18:52:01 -08001932 return res;
1933}
1934EXPORT_SYMBOL_GPL(netlink_has_listeners);
1935
stephen hemmingerb57ef81f2011-12-22 08:52:02 +00001936static int netlink_broadcast_deliver(struct sock *sk, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001937{
1938 struct netlink_sock *nlk = nlk_sk(sk);
1939
1940 if (atomic_read(&sk->sk_rmem_alloc) <= sk->sk_rcvbuf &&
Patrick McHardycd967e02013-04-17 06:46:56 +00001941 !test_bit(NETLINK_CONGESTED, &nlk->state)) {
Patrick McHardycf0a0182013-04-17 06:47:00 +00001942 netlink_skb_set_owner_r(skb, sk);
Eric Dumazet4a7e7c22012-04-05 22:17:46 +00001943 __netlink_sendskb(sk, skb);
stephen hemminger2c6458002011-12-22 08:52:03 +00001944 return atomic_read(&sk->sk_rmem_alloc) > (sk->sk_rcvbuf >> 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001945 }
1946 return -1;
1947}
1948
1949struct netlink_broadcast_data {
1950 struct sock *exclude_sk;
Eric W. Biedermanb4b51022007-09-12 13:05:38 +02001951 struct net *net;
Eric W. Biederman15e47302012-09-07 20:12:54 +00001952 u32 portid;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001953 u32 group;
1954 int failure;
Pablo Neira Ayusoff491a72009-02-05 23:56:36 -08001955 int delivery_failure;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001956 int congested;
1957 int delivered;
Al Viro7d877f32005-10-21 03:20:43 -04001958 gfp_t allocation;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001959 struct sk_buff *skb, *skb2;
Eric W. Biederman910a7e92010-05-04 17:36:46 -07001960 int (*tx_filter)(struct sock *dsk, struct sk_buff *skb, void *data);
1961 void *tx_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001962};
1963
Rami Rosen46c95212014-07-01 21:17:35 +03001964static void do_one_broadcast(struct sock *sk,
1965 struct netlink_broadcast_data *p)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001966{
1967 struct netlink_sock *nlk = nlk_sk(sk);
1968 int val;
1969
1970 if (p->exclude_sk == sk)
Rami Rosen46c95212014-07-01 21:17:35 +03001971 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001972
Eric W. Biederman15e47302012-09-07 20:12:54 +00001973 if (nlk->portid == p->portid || p->group - 1 >= nlk->ngroups ||
Patrick McHardyf7fa9b12005-08-15 12:29:13 -07001974 !test_bit(p->group - 1, nlk->groups))
Rami Rosen46c95212014-07-01 21:17:35 +03001975 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001976
YOSHIFUJI Hideaki878628f2008-03-26 03:57:35 +09001977 if (!net_eq(sock_net(sk), p->net))
Rami Rosen46c95212014-07-01 21:17:35 +03001978 return;
Eric W. Biedermanb4b51022007-09-12 13:05:38 +02001979
Linus Torvalds1da177e2005-04-16 15:20:36 -07001980 if (p->failure) {
1981 netlink_overrun(sk);
Rami Rosen46c95212014-07-01 21:17:35 +03001982 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001983 }
1984
1985 sock_hold(sk);
1986 if (p->skb2 == NULL) {
Tommy S. Christensen68acc022005-05-19 13:06:35 -07001987 if (skb_shared(p->skb)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001988 p->skb2 = skb_clone(p->skb, p->allocation);
1989 } else {
Tommy S. Christensen68acc022005-05-19 13:06:35 -07001990 p->skb2 = skb_get(p->skb);
1991 /*
1992 * skb ownership may have been set when
1993 * delivered to a previous socket.
1994 */
1995 skb_orphan(p->skb2);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001996 }
1997 }
1998 if (p->skb2 == NULL) {
1999 netlink_overrun(sk);
2000 /* Clone failed. Notify ALL listeners. */
2001 p->failure = 1;
Pablo Neira Ayusobe0c22a2009-02-18 01:40:43 +00002002 if (nlk->flags & NETLINK_BROADCAST_SEND_ERROR)
2003 p->delivery_failure = 1;
Eric W. Biederman910a7e92010-05-04 17:36:46 -07002004 } else if (p->tx_filter && p->tx_filter(sk, p->skb2, p->tx_data)) {
2005 kfree_skb(p->skb2);
2006 p->skb2 = NULL;
Stephen Hemmingerb1153f22008-03-21 15:46:12 -07002007 } else if (sk_filter(sk, p->skb2)) {
2008 kfree_skb(p->skb2);
2009 p->skb2 = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002010 } else if ((val = netlink_broadcast_deliver(sk, p->skb2)) < 0) {
2011 netlink_overrun(sk);
Pablo Neira Ayusobe0c22a2009-02-18 01:40:43 +00002012 if (nlk->flags & NETLINK_BROADCAST_SEND_ERROR)
2013 p->delivery_failure = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002014 } else {
2015 p->congested |= val;
2016 p->delivered = 1;
2017 p->skb2 = NULL;
2018 }
2019 sock_put(sk);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002020}
2021
Eric W. Biederman15e47302012-09-07 20:12:54 +00002022int netlink_broadcast_filtered(struct sock *ssk, struct sk_buff *skb, u32 portid,
Eric W. Biederman910a7e92010-05-04 17:36:46 -07002023 u32 group, gfp_t allocation,
2024 int (*filter)(struct sock *dsk, struct sk_buff *skb, void *data),
2025 void *filter_data)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002026{
YOSHIFUJI Hideaki3b1e0a62008-03-26 02:26:21 +09002027 struct net *net = sock_net(ssk);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002028 struct netlink_broadcast_data info;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002029 struct sock *sk;
2030
2031 skb = netlink_trim(skb, allocation);
2032
2033 info.exclude_sk = ssk;
Eric W. Biedermanb4b51022007-09-12 13:05:38 +02002034 info.net = net;
Eric W. Biederman15e47302012-09-07 20:12:54 +00002035 info.portid = portid;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002036 info.group = group;
2037 info.failure = 0;
Pablo Neira Ayusoff491a72009-02-05 23:56:36 -08002038 info.delivery_failure = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002039 info.congested = 0;
2040 info.delivered = 0;
2041 info.allocation = allocation;
2042 info.skb = skb;
2043 info.skb2 = NULL;
Eric W. Biederman910a7e92010-05-04 17:36:46 -07002044 info.tx_filter = filter;
2045 info.tx_data = filter_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002046
2047 /* While we sleep in clone, do not allow to change socket list */
2048
2049 netlink_lock_table();
2050
Sasha Levinb67bfe02013-02-27 17:06:00 -08002051 sk_for_each_bound(sk, &nl_table[ssk->sk_protocol].mc_list)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002052 do_one_broadcast(sk, &info);
2053
Neil Horman70d4bf62010-07-20 06:45:56 +00002054 consume_skb(skb);
Tommy S. Christensenaa1c6a62005-05-19 13:07:32 -07002055
Linus Torvalds1da177e2005-04-16 15:20:36 -07002056 netlink_unlock_table();
2057
Neil Horman70d4bf62010-07-20 06:45:56 +00002058 if (info.delivery_failure) {
2059 kfree_skb(info.skb2);
Pablo Neira Ayusoff491a72009-02-05 23:56:36 -08002060 return -ENOBUFS;
Eric Dumazet658cb352012-04-22 21:30:21 +00002061 }
2062 consume_skb(info.skb2);
Pablo Neira Ayusoff491a72009-02-05 23:56:36 -08002063
Linus Torvalds1da177e2005-04-16 15:20:36 -07002064 if (info.delivered) {
2065 if (info.congested && (allocation & __GFP_WAIT))
2066 yield();
2067 return 0;
2068 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002069 return -ESRCH;
2070}
Eric W. Biederman910a7e92010-05-04 17:36:46 -07002071EXPORT_SYMBOL(netlink_broadcast_filtered);
2072
Eric W. Biederman15e47302012-09-07 20:12:54 +00002073int netlink_broadcast(struct sock *ssk, struct sk_buff *skb, u32 portid,
Eric W. Biederman910a7e92010-05-04 17:36:46 -07002074 u32 group, gfp_t allocation)
2075{
Eric W. Biederman15e47302012-09-07 20:12:54 +00002076 return netlink_broadcast_filtered(ssk, skb, portid, group, allocation,
Eric W. Biederman910a7e92010-05-04 17:36:46 -07002077 NULL, NULL);
2078}
Patrick McHardy6ac552f2007-12-04 00:19:38 -08002079EXPORT_SYMBOL(netlink_broadcast);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002080
2081struct netlink_set_err_data {
2082 struct sock *exclude_sk;
Eric W. Biederman15e47302012-09-07 20:12:54 +00002083 u32 portid;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002084 u32 group;
2085 int code;
2086};
2087
stephen hemmingerb57ef81f2011-12-22 08:52:02 +00002088static int do_one_set_err(struct sock *sk, struct netlink_set_err_data *p)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002089{
2090 struct netlink_sock *nlk = nlk_sk(sk);
Pablo Neira Ayuso1a503072010-03-18 14:24:42 +00002091 int ret = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002092
2093 if (sk == p->exclude_sk)
2094 goto out;
2095
Octavian Purdila09ad9bc2009-11-25 15:14:13 -08002096 if (!net_eq(sock_net(sk), sock_net(p->exclude_sk)))
Eric W. Biedermanb4b51022007-09-12 13:05:38 +02002097 goto out;
2098
Eric W. Biederman15e47302012-09-07 20:12:54 +00002099 if (nlk->portid == p->portid || p->group - 1 >= nlk->ngroups ||
Patrick McHardyf7fa9b12005-08-15 12:29:13 -07002100 !test_bit(p->group - 1, nlk->groups))
Linus Torvalds1da177e2005-04-16 15:20:36 -07002101 goto out;
2102
Pablo Neira Ayuso1a503072010-03-18 14:24:42 +00002103 if (p->code == ENOBUFS && nlk->flags & NETLINK_RECV_NO_ENOBUFS) {
2104 ret = 1;
2105 goto out;
2106 }
2107
Linus Torvalds1da177e2005-04-16 15:20:36 -07002108 sk->sk_err = p->code;
2109 sk->sk_error_report(sk);
2110out:
Pablo Neira Ayuso1a503072010-03-18 14:24:42 +00002111 return ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002112}
2113
Pablo Neira Ayuso4843b932009-03-03 23:37:30 -08002114/**
2115 * netlink_set_err - report error to broadcast listeners
2116 * @ssk: the kernel netlink socket, as returned by netlink_kernel_create()
Eric W. Biederman15e47302012-09-07 20:12:54 +00002117 * @portid: the PORTID of a process that we want to skip (if any)
Johannes Berg840e93f22013-11-19 10:35:40 +01002118 * @group: the broadcast group that will notice the error
Pablo Neira Ayuso4843b932009-03-03 23:37:30 -08002119 * @code: error code, must be negative (as usual in kernelspace)
Pablo Neira Ayuso1a503072010-03-18 14:24:42 +00002120 *
2121 * This function returns the number of broadcast listeners that have set the
2122 * NETLINK_RECV_NO_ENOBUFS socket option.
Pablo Neira Ayuso4843b932009-03-03 23:37:30 -08002123 */
Eric W. Biederman15e47302012-09-07 20:12:54 +00002124int netlink_set_err(struct sock *ssk, u32 portid, u32 group, int code)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002125{
2126 struct netlink_set_err_data info;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002127 struct sock *sk;
Pablo Neira Ayuso1a503072010-03-18 14:24:42 +00002128 int ret = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002129
2130 info.exclude_sk = ssk;
Eric W. Biederman15e47302012-09-07 20:12:54 +00002131 info.portid = portid;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002132 info.group = group;
Pablo Neira Ayuso4843b932009-03-03 23:37:30 -08002133 /* sk->sk_err wants a positive error value */
2134 info.code = -code;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002135
2136 read_lock(&nl_table_lock);
2137
Sasha Levinb67bfe02013-02-27 17:06:00 -08002138 sk_for_each_bound(sk, &nl_table[ssk->sk_protocol].mc_list)
Pablo Neira Ayuso1a503072010-03-18 14:24:42 +00002139 ret += do_one_set_err(sk, &info);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002140
2141 read_unlock(&nl_table_lock);
Pablo Neira Ayuso1a503072010-03-18 14:24:42 +00002142 return ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002143}
Pablo Neira Ayusodd5b6ce2009-03-23 13:21:06 +01002144EXPORT_SYMBOL(netlink_set_err);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002145
Johannes Berg84659eb2007-07-18 15:47:05 -07002146/* must be called with netlink table grabbed */
2147static void netlink_update_socket_mc(struct netlink_sock *nlk,
2148 unsigned int group,
2149 int is_new)
2150{
2151 int old, new = !!is_new, subscriptions;
2152
2153 old = test_bit(group - 1, nlk->groups);
2154 subscriptions = nlk->subscriptions - old + new;
2155 if (new)
2156 __set_bit(group - 1, nlk->groups);
2157 else
2158 __clear_bit(group - 1, nlk->groups);
2159 netlink_update_subscriptions(&nlk->sk, subscriptions);
2160 netlink_update_listeners(&nlk->sk);
2161}
2162
Patrick McHardy9a4595b2005-08-15 12:32:15 -07002163static int netlink_setsockopt(struct socket *sock, int level, int optname,
David S. Millerb7058842009-09-30 16:12:20 -07002164 char __user *optval, unsigned int optlen)
Patrick McHardy9a4595b2005-08-15 12:32:15 -07002165{
2166 struct sock *sk = sock->sk;
2167 struct netlink_sock *nlk = nlk_sk(sk);
Johannes Bergeb496532007-07-18 02:07:51 -07002168 unsigned int val = 0;
2169 int err;
Patrick McHardy9a4595b2005-08-15 12:32:15 -07002170
2171 if (level != SOL_NETLINK)
2172 return -ENOPROTOOPT;
2173
Patrick McHardyccdfcc32013-04-17 06:47:01 +00002174 if (optname != NETLINK_RX_RING && optname != NETLINK_TX_RING &&
2175 optlen >= sizeof(int) &&
Johannes Bergeb496532007-07-18 02:07:51 -07002176 get_user(val, (unsigned int __user *)optval))
Patrick McHardy9a4595b2005-08-15 12:32:15 -07002177 return -EFAULT;
2178
2179 switch (optname) {
2180 case NETLINK_PKTINFO:
2181 if (val)
2182 nlk->flags |= NETLINK_RECV_PKTINFO;
2183 else
2184 nlk->flags &= ~NETLINK_RECV_PKTINFO;
2185 err = 0;
2186 break;
2187 case NETLINK_ADD_MEMBERSHIP:
2188 case NETLINK_DROP_MEMBERSHIP: {
Eric W. Biederman5187cd02014-04-23 14:25:48 -07002189 if (!netlink_allowed(sock, NL_CFG_F_NONROOT_RECV))
Patrick McHardy9a4595b2005-08-15 12:32:15 -07002190 return -EPERM;
Johannes Bergb4ff4f02007-07-18 15:46:06 -07002191 err = netlink_realloc_groups(sk);
2192 if (err)
2193 return err;
Patrick McHardy9a4595b2005-08-15 12:32:15 -07002194 if (!val || val - 1 >= nlk->ngroups)
2195 return -EINVAL;
Richard Guy Briggs7774d5e2014-04-22 21:31:55 -04002196 if (optname == NETLINK_ADD_MEMBERSHIP && nlk->netlink_bind) {
Richard Guy Briggs4f520902014-04-22 21:31:54 -04002197 err = nlk->netlink_bind(val);
2198 if (err)
2199 return err;
2200 }
Patrick McHardy9a4595b2005-08-15 12:32:15 -07002201 netlink_table_grab();
Johannes Berg84659eb2007-07-18 15:47:05 -07002202 netlink_update_socket_mc(nlk, val,
2203 optname == NETLINK_ADD_MEMBERSHIP);
Patrick McHardy9a4595b2005-08-15 12:32:15 -07002204 netlink_table_ungrab();
Richard Guy Briggs7774d5e2014-04-22 21:31:55 -04002205 if (optname == NETLINK_DROP_MEMBERSHIP && nlk->netlink_unbind)
2206 nlk->netlink_unbind(val);
Pablo Neira Ayuso03292742012-06-29 06:15:22 +00002207
Patrick McHardy9a4595b2005-08-15 12:32:15 -07002208 err = 0;
2209 break;
2210 }
Pablo Neira Ayusobe0c22a2009-02-18 01:40:43 +00002211 case NETLINK_BROADCAST_ERROR:
2212 if (val)
2213 nlk->flags |= NETLINK_BROADCAST_SEND_ERROR;
2214 else
2215 nlk->flags &= ~NETLINK_BROADCAST_SEND_ERROR;
2216 err = 0;
2217 break;
Pablo Neira Ayuso38938bf2009-03-24 16:37:55 -07002218 case NETLINK_NO_ENOBUFS:
2219 if (val) {
2220 nlk->flags |= NETLINK_RECV_NO_ENOBUFS;
Patrick McHardycd967e02013-04-17 06:46:56 +00002221 clear_bit(NETLINK_CONGESTED, &nlk->state);
Pablo Neira Ayuso38938bf2009-03-24 16:37:55 -07002222 wake_up_interruptible(&nlk->wait);
Eric Dumazet658cb352012-04-22 21:30:21 +00002223 } else {
Pablo Neira Ayuso38938bf2009-03-24 16:37:55 -07002224 nlk->flags &= ~NETLINK_RECV_NO_ENOBUFS;
Eric Dumazet658cb352012-04-22 21:30:21 +00002225 }
Pablo Neira Ayuso38938bf2009-03-24 16:37:55 -07002226 err = 0;
2227 break;
Patrick McHardyccdfcc32013-04-17 06:47:01 +00002228#ifdef CONFIG_NETLINK_MMAP
2229 case NETLINK_RX_RING:
2230 case NETLINK_TX_RING: {
2231 struct nl_mmap_req req;
2232
2233 /* Rings might consume more memory than queue limits, require
2234 * CAP_NET_ADMIN.
2235 */
2236 if (!capable(CAP_NET_ADMIN))
2237 return -EPERM;
2238 if (optlen < sizeof(req))
2239 return -EINVAL;
2240 if (copy_from_user(&req, optval, sizeof(req)))
2241 return -EFAULT;
2242 err = netlink_set_ring(sk, &req, false,
2243 optname == NETLINK_TX_RING);
2244 break;
2245 }
2246#endif /* CONFIG_NETLINK_MMAP */
Patrick McHardy9a4595b2005-08-15 12:32:15 -07002247 default:
2248 err = -ENOPROTOOPT;
2249 }
2250 return err;
2251}
2252
2253static int netlink_getsockopt(struct socket *sock, int level, int optname,
YOSHIFUJI Hideaki746fac42007-02-09 23:25:07 +09002254 char __user *optval, int __user *optlen)
Patrick McHardy9a4595b2005-08-15 12:32:15 -07002255{
2256 struct sock *sk = sock->sk;
2257 struct netlink_sock *nlk = nlk_sk(sk);
2258 int len, val, err;
2259
2260 if (level != SOL_NETLINK)
2261 return -ENOPROTOOPT;
2262
2263 if (get_user(len, optlen))
2264 return -EFAULT;
2265 if (len < 0)
2266 return -EINVAL;
2267
2268 switch (optname) {
2269 case NETLINK_PKTINFO:
2270 if (len < sizeof(int))
2271 return -EINVAL;
2272 len = sizeof(int);
2273 val = nlk->flags & NETLINK_RECV_PKTINFO ? 1 : 0;
Heiko Carstensa27b58f2006-10-30 15:06:12 -08002274 if (put_user(len, optlen) ||
2275 put_user(val, optval))
2276 return -EFAULT;
Patrick McHardy9a4595b2005-08-15 12:32:15 -07002277 err = 0;
2278 break;
Pablo Neira Ayusobe0c22a2009-02-18 01:40:43 +00002279 case NETLINK_BROADCAST_ERROR:
2280 if (len < sizeof(int))
2281 return -EINVAL;
2282 len = sizeof(int);
2283 val = nlk->flags & NETLINK_BROADCAST_SEND_ERROR ? 1 : 0;
2284 if (put_user(len, optlen) ||
2285 put_user(val, optval))
2286 return -EFAULT;
2287 err = 0;
2288 break;
Pablo Neira Ayuso38938bf2009-03-24 16:37:55 -07002289 case NETLINK_NO_ENOBUFS:
2290 if (len < sizeof(int))
2291 return -EINVAL;
2292 len = sizeof(int);
2293 val = nlk->flags & NETLINK_RECV_NO_ENOBUFS ? 1 : 0;
2294 if (put_user(len, optlen) ||
2295 put_user(val, optval))
2296 return -EFAULT;
2297 err = 0;
2298 break;
Patrick McHardy9a4595b2005-08-15 12:32:15 -07002299 default:
2300 err = -ENOPROTOOPT;
2301 }
2302 return err;
2303}
2304
2305static void netlink_cmsg_recv_pktinfo(struct msghdr *msg, struct sk_buff *skb)
2306{
2307 struct nl_pktinfo info;
2308
2309 info.group = NETLINK_CB(skb).dst_group;
2310 put_cmsg(msg, SOL_NETLINK, NETLINK_PKTINFO, sizeof(info), &info);
2311}
2312
Linus Torvalds1da177e2005-04-16 15:20:36 -07002313static int netlink_sendmsg(struct kiocb *kiocb, struct socket *sock,
2314 struct msghdr *msg, size_t len)
2315{
2316 struct sock_iocb *siocb = kiocb_to_siocb(kiocb);
2317 struct sock *sk = sock->sk;
2318 struct netlink_sock *nlk = nlk_sk(sk);
Steffen Hurrle342dfc32014-01-17 22:53:15 +01002319 DECLARE_SOCKADDR(struct sockaddr_nl *, addr, msg->msg_name);
Eric W. Biederman15e47302012-09-07 20:12:54 +00002320 u32 dst_portid;
Patrick McHardyd629b832005-08-14 19:27:50 -07002321 u32 dst_group;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002322 struct sk_buff *skb;
2323 int err;
2324 struct scm_cookie scm;
Eric W. Biederman2d7a85f2014-05-30 11:04:00 -07002325 u32 netlink_skb_flags = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002326
2327 if (msg->msg_flags&MSG_OOB)
2328 return -EOPNOTSUPP;
2329
Eric Dumazet16e57262011-09-19 05:52:27 +00002330 if (NULL == siocb->scm)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002331 siocb->scm = &scm;
Eric Dumazet16e57262011-09-19 05:52:27 +00002332
Eric Dumazete0e3cea2012-08-21 06:21:17 +00002333 err = scm_send(sock, msg, siocb->scm, true);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002334 if (err < 0)
2335 return err;
2336
2337 if (msg->msg_namelen) {
Eric W. Biedermanb47030c2010-06-13 03:31:06 +00002338 err = -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002339 if (addr->nl_family != AF_NETLINK)
Eric W. Biedermanb47030c2010-06-13 03:31:06 +00002340 goto out;
Eric W. Biederman15e47302012-09-07 20:12:54 +00002341 dst_portid = addr->nl_pid;
Patrick McHardyd629b832005-08-14 19:27:50 -07002342 dst_group = ffs(addr->nl_groups);
Eric W. Biedermanb47030c2010-06-13 03:31:06 +00002343 err = -EPERM;
Eric W. Biederman15e47302012-09-07 20:12:54 +00002344 if ((dst_group || dst_portid) &&
Eric W. Biederman5187cd02014-04-23 14:25:48 -07002345 !netlink_allowed(sock, NL_CFG_F_NONROOT_SEND))
Eric W. Biedermanb47030c2010-06-13 03:31:06 +00002346 goto out;
Eric W. Biederman2d7a85f2014-05-30 11:04:00 -07002347 netlink_skb_flags |= NETLINK_SKB_DST;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002348 } else {
Eric W. Biederman15e47302012-09-07 20:12:54 +00002349 dst_portid = nlk->dst_portid;
Patrick McHardyd629b832005-08-14 19:27:50 -07002350 dst_group = nlk->dst_group;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002351 }
2352
Eric W. Biederman15e47302012-09-07 20:12:54 +00002353 if (!nlk->portid) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002354 err = netlink_autobind(sock);
2355 if (err)
2356 goto out;
2357 }
2358
Patrick McHardy5fd96122013-04-17 06:47:03 +00002359 if (netlink_tx_is_mmaped(sk) &&
2360 msg->msg_iov->iov_base == NULL) {
2361 err = netlink_mmap_sendmsg(sk, msg, dst_portid, dst_group,
2362 siocb);
2363 goto out;
2364 }
2365
Linus Torvalds1da177e2005-04-16 15:20:36 -07002366 err = -EMSGSIZE;
2367 if (len > sk->sk_sndbuf - 32)
2368 goto out;
2369 err = -ENOBUFS;
Pablo Neira3a365152013-06-28 03:04:23 +02002370 skb = netlink_alloc_large_skb(len, dst_group);
Patrick McHardy6ac552f2007-12-04 00:19:38 -08002371 if (skb == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002372 goto out;
2373
Eric W. Biederman15e47302012-09-07 20:12:54 +00002374 NETLINK_CB(skb).portid = nlk->portid;
Patrick McHardyd629b832005-08-14 19:27:50 -07002375 NETLINK_CB(skb).dst_group = dst_group;
Eric W. Biedermandbe9a412012-09-06 18:20:01 +00002376 NETLINK_CB(skb).creds = siocb->scm->creds;
Eric W. Biederman2d7a85f2014-05-30 11:04:00 -07002377 NETLINK_CB(skb).flags = netlink_skb_flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002378
Linus Torvalds1da177e2005-04-16 15:20:36 -07002379 err = -EFAULT;
Patrick McHardy6ac552f2007-12-04 00:19:38 -08002380 if (memcpy_fromiovec(skb_put(skb, len), msg->msg_iov, len)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002381 kfree_skb(skb);
2382 goto out;
2383 }
2384
2385 err = security_netlink_send(sk, skb);
2386 if (err) {
2387 kfree_skb(skb);
2388 goto out;
2389 }
2390
Patrick McHardyd629b832005-08-14 19:27:50 -07002391 if (dst_group) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002392 atomic_inc(&skb->users);
Eric W. Biederman15e47302012-09-07 20:12:54 +00002393 netlink_broadcast(sk, skb, dst_portid, dst_group, GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002394 }
Eric W. Biederman15e47302012-09-07 20:12:54 +00002395 err = netlink_unicast(sk, skb, dst_portid, msg->msg_flags&MSG_DONTWAIT);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002396
2397out:
Eric W. Biedermanb47030c2010-06-13 03:31:06 +00002398 scm_destroy(siocb->scm);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002399 return err;
2400}
2401
2402static int netlink_recvmsg(struct kiocb *kiocb, struct socket *sock,
2403 struct msghdr *msg, size_t len,
2404 int flags)
2405{
2406 struct sock_iocb *siocb = kiocb_to_siocb(kiocb);
2407 struct scm_cookie scm;
2408 struct sock *sk = sock->sk;
2409 struct netlink_sock *nlk = nlk_sk(sk);
2410 int noblock = flags&MSG_DONTWAIT;
2411 size_t copied;
Johannes Berg68d6ac62010-08-15 21:20:44 +00002412 struct sk_buff *skb, *data_skb;
Andrey Vaginb44d2112011-02-21 02:40:47 +00002413 int err, ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002414
2415 if (flags&MSG_OOB)
2416 return -EOPNOTSUPP;
2417
2418 copied = 0;
2419
Patrick McHardy6ac552f2007-12-04 00:19:38 -08002420 skb = skb_recv_datagram(sk, flags, noblock, &err);
2421 if (skb == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002422 goto out;
2423
Johannes Berg68d6ac62010-08-15 21:20:44 +00002424 data_skb = skb;
2425
Johannes Berg1dacc762009-07-01 11:26:02 +00002426#ifdef CONFIG_COMPAT_NETLINK_MESSAGES
2427 if (unlikely(skb_shinfo(skb)->frag_list)) {
Johannes Berg1dacc762009-07-01 11:26:02 +00002428 /*
Johannes Berg68d6ac62010-08-15 21:20:44 +00002429 * If this skb has a frag_list, then here that means that we
2430 * will have to use the frag_list skb's data for compat tasks
2431 * and the regular skb's data for normal (non-compat) tasks.
Johannes Berg1dacc762009-07-01 11:26:02 +00002432 *
Johannes Berg68d6ac62010-08-15 21:20:44 +00002433 * If we need to send the compat skb, assign it to the
2434 * 'data_skb' variable so that it will be used below for data
2435 * copying. We keep 'skb' for everything else, including
2436 * freeing both later.
Johannes Berg1dacc762009-07-01 11:26:02 +00002437 */
Johannes Berg68d6ac62010-08-15 21:20:44 +00002438 if (flags & MSG_CMSG_COMPAT)
2439 data_skb = skb_shinfo(skb)->frag_list;
Johannes Berg1dacc762009-07-01 11:26:02 +00002440 }
2441#endif
2442
Eric Dumazet9063e212014-03-07 12:02:33 -08002443 /* Record the max length of recvmsg() calls for future allocations */
2444 nlk->max_recvmsg_len = max(nlk->max_recvmsg_len, len);
2445 nlk->max_recvmsg_len = min_t(size_t, nlk->max_recvmsg_len,
2446 16384);
2447
Johannes Berg68d6ac62010-08-15 21:20:44 +00002448 copied = data_skb->len;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002449 if (len < copied) {
2450 msg->msg_flags |= MSG_TRUNC;
2451 copied = len;
2452 }
2453
Johannes Berg68d6ac62010-08-15 21:20:44 +00002454 skb_reset_transport_header(data_skb);
2455 err = skb_copy_datagram_iovec(data_skb, 0, msg->msg_iov, copied);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002456
2457 if (msg->msg_name) {
Steffen Hurrle342dfc32014-01-17 22:53:15 +01002458 DECLARE_SOCKADDR(struct sockaddr_nl *, addr, msg->msg_name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002459 addr->nl_family = AF_NETLINK;
2460 addr->nl_pad = 0;
Eric W. Biederman15e47302012-09-07 20:12:54 +00002461 addr->nl_pid = NETLINK_CB(skb).portid;
Patrick McHardyd629b832005-08-14 19:27:50 -07002462 addr->nl_groups = netlink_group_mask(NETLINK_CB(skb).dst_group);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002463 msg->msg_namelen = sizeof(*addr);
2464 }
2465
Patrick McHardycc9a06c2006-03-12 20:34:27 -08002466 if (nlk->flags & NETLINK_RECV_PKTINFO)
2467 netlink_cmsg_recv_pktinfo(msg, skb);
2468
Linus Torvalds1da177e2005-04-16 15:20:36 -07002469 if (NULL == siocb->scm) {
2470 memset(&scm, 0, sizeof(scm));
2471 siocb->scm = &scm;
2472 }
2473 siocb->scm->creds = *NETLINK_CREDS(skb);
Patrick McHardy188ccb52007-05-03 03:27:01 -07002474 if (flags & MSG_TRUNC)
Johannes Berg68d6ac62010-08-15 21:20:44 +00002475 copied = data_skb->len;
David S. Millerdaa37662010-08-15 23:21:50 -07002476
Linus Torvalds1da177e2005-04-16 15:20:36 -07002477 skb_free_datagram(sk, skb);
2478
Pravin B Shelar16b304f2013-08-15 15:31:06 -07002479 if (nlk->cb_running &&
2480 atomic_read(&sk->sk_rmem_alloc) <= sk->sk_rcvbuf / 2) {
Andrey Vaginb44d2112011-02-21 02:40:47 +00002481 ret = netlink_dump(sk);
2482 if (ret) {
2483 sk->sk_err = ret;
2484 sk->sk_error_report(sk);
2485 }
2486 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002487
2488 scm_recv(sock, msg, siocb->scm, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002489out:
2490 netlink_rcv_wake(sk);
2491 return err ? : copied;
2492}
2493
David S. Miller676d2362014-04-11 16:15:36 -04002494static void netlink_data_ready(struct sock *sk)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002495{
Denis V. Lunevcd40b7d2007-10-10 21:15:29 -07002496 BUG();
Linus Torvalds1da177e2005-04-16 15:20:36 -07002497}
2498
2499/*
YOSHIFUJI Hideaki746fac42007-02-09 23:25:07 +09002500 * We export these functions to other modules. They provide a
Linus Torvalds1da177e2005-04-16 15:20:36 -07002501 * complete set of kernel non-blocking support for message
2502 * queueing.
2503 */
2504
2505struct sock *
Pablo Neira Ayuso9f00d972012-09-08 02:53:54 +00002506__netlink_kernel_create(struct net *net, int unit, struct module *module,
2507 struct netlink_kernel_cfg *cfg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002508{
2509 struct socket *sock;
2510 struct sock *sk;
Patrick McHardy77247bb2005-08-14 19:27:13 -07002511 struct netlink_sock *nlk;
Eric Dumazet5c398dc2010-10-24 04:27:10 +00002512 struct listeners *listeners = NULL;
Pablo Neira Ayusoa31f2d12012-06-29 06:15:21 +00002513 struct mutex *cb_mutex = cfg ? cfg->cb_mutex : NULL;
2514 unsigned int groups;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002515
Akinobu Mitafab2caf2006-08-29 02:15:24 -07002516 BUG_ON(!nl_table);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002517
Patrick McHardy6ac552f2007-12-04 00:19:38 -08002518 if (unit < 0 || unit >= MAX_LINKS)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002519 return NULL;
2520
2521 if (sock_create_lite(PF_NETLINK, SOCK_DGRAM, unit, &sock))
2522 return NULL;
2523
Pavel Emelyanov23fe1862008-01-30 19:31:06 -08002524 /*
2525 * We have to just have a reference on the net from sk, but don't
2526 * get_net it. Besides, we cannot get and then put the net here.
2527 * So we create one inside init_net and the move it to net.
2528 */
2529
2530 if (__netlink_create(&init_net, sock, cb_mutex, unit) < 0)
2531 goto out_sock_release_nosk;
2532
2533 sk = sock->sk;
Denis V. Lunevedf02082008-02-29 11:18:32 -08002534 sk_change_net(sk, net);
Harald Welte4fdb3bb2005-08-09 19:40:55 -07002535
Pablo Neira Ayusoa31f2d12012-06-29 06:15:21 +00002536 if (!cfg || cfg->groups < 32)
Patrick McHardy4277a082006-03-20 18:52:01 -08002537 groups = 32;
Pablo Neira Ayusoa31f2d12012-06-29 06:15:21 +00002538 else
2539 groups = cfg->groups;
Patrick McHardy4277a082006-03-20 18:52:01 -08002540
Eric Dumazet5c398dc2010-10-24 04:27:10 +00002541 listeners = kzalloc(sizeof(*listeners) + NLGRPSZ(groups), GFP_KERNEL);
Patrick McHardy4277a082006-03-20 18:52:01 -08002542 if (!listeners)
2543 goto out_sock_release;
2544
Linus Torvalds1da177e2005-04-16 15:20:36 -07002545 sk->sk_data_ready = netlink_data_ready;
Pablo Neira Ayusoa31f2d12012-06-29 06:15:21 +00002546 if (cfg && cfg->input)
2547 nlk_sk(sk)->netlink_rcv = cfg->input;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002548
Eric W. Biedermanb4b51022007-09-12 13:05:38 +02002549 if (netlink_insert(sk, net, 0))
Patrick McHardy77247bb2005-08-14 19:27:13 -07002550 goto out_sock_release;
2551
2552 nlk = nlk_sk(sk);
2553 nlk->flags |= NETLINK_KERNEL_SOCKET;
2554
2555 netlink_table_grab();
Eric W. Biedermanb4b51022007-09-12 13:05:38 +02002556 if (!nl_table[unit].registered) {
2557 nl_table[unit].groups = groups;
Eric Dumazet5c398dc2010-10-24 04:27:10 +00002558 rcu_assign_pointer(nl_table[unit].listeners, listeners);
Eric W. Biedermanb4b51022007-09-12 13:05:38 +02002559 nl_table[unit].cb_mutex = cb_mutex;
2560 nl_table[unit].module = module;
Pablo Neira Ayuso9785e102012-09-08 02:53:53 +00002561 if (cfg) {
2562 nl_table[unit].bind = cfg->bind;
2563 nl_table[unit].flags = cfg->flags;
Gao fengda12c902013-06-06 14:49:11 +08002564 if (cfg->compare)
2565 nl_table[unit].compare = cfg->compare;
Pablo Neira Ayuso9785e102012-09-08 02:53:53 +00002566 }
Eric W. Biedermanb4b51022007-09-12 13:05:38 +02002567 nl_table[unit].registered = 1;
Jesper Juhlf937f1f462007-10-15 01:39:12 -07002568 } else {
2569 kfree(listeners);
Denis V. Lunev869e58f2008-01-18 23:53:31 -08002570 nl_table[unit].registered++;
Eric W. Biedermanb4b51022007-09-12 13:05:38 +02002571 }
Patrick McHardy77247bb2005-08-14 19:27:13 -07002572 netlink_table_ungrab();
Harald Welte4fdb3bb2005-08-09 19:40:55 -07002573 return sk;
2574
Harald Welte4fdb3bb2005-08-09 19:40:55 -07002575out_sock_release:
Patrick McHardy4277a082006-03-20 18:52:01 -08002576 kfree(listeners);
Denis V. Lunev9dfbec12008-02-29 11:17:56 -08002577 netlink_kernel_release(sk);
Pavel Emelyanov23fe1862008-01-30 19:31:06 -08002578 return NULL;
2579
2580out_sock_release_nosk:
Harald Welte4fdb3bb2005-08-09 19:40:55 -07002581 sock_release(sock);
Patrick McHardy77247bb2005-08-14 19:27:13 -07002582 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002583}
Pablo Neira Ayuso9f00d972012-09-08 02:53:54 +00002584EXPORT_SYMBOL(__netlink_kernel_create);
Denis V. Lunevb7c6ba62008-01-28 14:41:19 -08002585
2586void
2587netlink_kernel_release(struct sock *sk)
2588{
Denis V. Lunevedf02082008-02-29 11:18:32 -08002589 sk_release_kernel(sk);
Denis V. Lunevb7c6ba62008-01-28 14:41:19 -08002590}
2591EXPORT_SYMBOL(netlink_kernel_release);
2592
Johannes Bergd136f1b2009-09-12 03:03:15 +00002593int __netlink_change_ngroups(struct sock *sk, unsigned int groups)
Johannes Bergb4ff4f02007-07-18 15:46:06 -07002594{
Eric Dumazet5c398dc2010-10-24 04:27:10 +00002595 struct listeners *new, *old;
Johannes Bergb4ff4f02007-07-18 15:46:06 -07002596 struct netlink_table *tbl = &nl_table[sk->sk_protocol];
Johannes Bergb4ff4f02007-07-18 15:46:06 -07002597
2598 if (groups < 32)
2599 groups = 32;
2600
Johannes Bergb4ff4f02007-07-18 15:46:06 -07002601 if (NLGRPSZ(tbl->groups) < NLGRPSZ(groups)) {
Eric Dumazet5c398dc2010-10-24 04:27:10 +00002602 new = kzalloc(sizeof(*new) + NLGRPSZ(groups), GFP_ATOMIC);
2603 if (!new)
Johannes Bergd136f1b2009-09-12 03:03:15 +00002604 return -ENOMEM;
Eric Dumazet6d772ac2012-10-18 03:21:55 +00002605 old = nl_deref_protected(tbl->listeners);
Eric Dumazet5c398dc2010-10-24 04:27:10 +00002606 memcpy(new->masks, old->masks, NLGRPSZ(tbl->groups));
2607 rcu_assign_pointer(tbl->listeners, new);
2608
Lai Jiangshan37b6b932011-03-15 18:01:42 +08002609 kfree_rcu(old, rcu);
Johannes Bergb4ff4f02007-07-18 15:46:06 -07002610 }
2611 tbl->groups = groups;
2612
Johannes Bergd136f1b2009-09-12 03:03:15 +00002613 return 0;
2614}
2615
2616/**
2617 * netlink_change_ngroups - change number of multicast groups
2618 *
2619 * This changes the number of multicast groups that are available
2620 * on a certain netlink family. Note that it is not possible to
2621 * change the number of groups to below 32. Also note that it does
2622 * not implicitly call netlink_clear_multicast_users() when the
2623 * number of groups is reduced.
2624 *
2625 * @sk: The kernel netlink socket, as returned by netlink_kernel_create().
2626 * @groups: The new number of groups.
2627 */
2628int netlink_change_ngroups(struct sock *sk, unsigned int groups)
2629{
2630 int err;
2631
2632 netlink_table_grab();
2633 err = __netlink_change_ngroups(sk, groups);
Johannes Bergb4ff4f02007-07-18 15:46:06 -07002634 netlink_table_ungrab();
Johannes Bergd136f1b2009-09-12 03:03:15 +00002635
Johannes Bergb4ff4f02007-07-18 15:46:06 -07002636 return err;
2637}
Johannes Bergb4ff4f02007-07-18 15:46:06 -07002638
Johannes Bergb8273572009-09-24 15:44:05 -07002639void __netlink_clear_multicast_users(struct sock *ksk, unsigned int group)
2640{
2641 struct sock *sk;
Johannes Bergb8273572009-09-24 15:44:05 -07002642 struct netlink_table *tbl = &nl_table[ksk->sk_protocol];
2643
Sasha Levinb67bfe02013-02-27 17:06:00 -08002644 sk_for_each_bound(sk, &tbl->mc_list)
Johannes Bergb8273572009-09-24 15:44:05 -07002645 netlink_update_socket_mc(nlk_sk(sk), group, 0);
2646}
2647
Denys Vlasenkoa46621a2012-01-30 15:22:06 -05002648struct nlmsghdr *
Eric W. Biederman15e47302012-09-07 20:12:54 +00002649__nlmsg_put(struct sk_buff *skb, u32 portid, u32 seq, int type, int len, int flags)
Denys Vlasenkoa46621a2012-01-30 15:22:06 -05002650{
2651 struct nlmsghdr *nlh;
Hong zhi guo573ce262013-03-27 06:47:04 +00002652 int size = nlmsg_msg_size(len);
Denys Vlasenkoa46621a2012-01-30 15:22:06 -05002653
Wang Yufen23b45672014-02-17 16:53:32 +08002654 nlh = (struct nlmsghdr *)skb_put(skb, NLMSG_ALIGN(size));
Denys Vlasenkoa46621a2012-01-30 15:22:06 -05002655 nlh->nlmsg_type = type;
2656 nlh->nlmsg_len = size;
2657 nlh->nlmsg_flags = flags;
Eric W. Biederman15e47302012-09-07 20:12:54 +00002658 nlh->nlmsg_pid = portid;
Denys Vlasenkoa46621a2012-01-30 15:22:06 -05002659 nlh->nlmsg_seq = seq;
2660 if (!__builtin_constant_p(size) || NLMSG_ALIGN(size) - size != 0)
Hong zhi guo573ce262013-03-27 06:47:04 +00002661 memset(nlmsg_data(nlh) + len, 0, NLMSG_ALIGN(size) - size);
Denys Vlasenkoa46621a2012-01-30 15:22:06 -05002662 return nlh;
2663}
2664EXPORT_SYMBOL(__nlmsg_put);
2665
Linus Torvalds1da177e2005-04-16 15:20:36 -07002666/*
2667 * It looks a bit ugly.
2668 * It would be better to create kernel thread.
2669 */
2670
2671static int netlink_dump(struct sock *sk)
2672{
2673 struct netlink_sock *nlk = nlk_sk(sk);
2674 struct netlink_callback *cb;
Greg Rosec7ac8672011-06-10 01:27:09 +00002675 struct sk_buff *skb = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002676 struct nlmsghdr *nlh;
Thomas Grafbf8b79e2006-08-04 23:03:29 -07002677 int len, err = -ENOBUFS;
Greg Rosec7ac8672011-06-10 01:27:09 +00002678 int alloc_size;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002679
Patrick McHardyaf65bdf2007-04-20 14:14:21 -07002680 mutex_lock(nlk->cb_mutex);
Pravin B Shelar16b304f2013-08-15 15:31:06 -07002681 if (!nlk->cb_running) {
Thomas Grafbf8b79e2006-08-04 23:03:29 -07002682 err = -EINVAL;
2683 goto errout_skb;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002684 }
2685
Pravin B Shelar16b304f2013-08-15 15:31:06 -07002686 cb = &nlk->cb;
Greg Rosec7ac8672011-06-10 01:27:09 +00002687 alloc_size = max_t(int, cb->min_dump_alloc, NLMSG_GOODSIZE);
2688
Patrick McHardyf9c22882013-04-17 06:47:04 +00002689 if (!netlink_rx_is_mmaped(sk) &&
2690 atomic_read(&sk->sk_rmem_alloc) >= sk->sk_rcvbuf)
2691 goto errout_skb;
Eric Dumazet9063e212014-03-07 12:02:33 -08002692
2693 /* NLMSG_GOODSIZE is small to avoid high order allocations being
2694 * required, but it makes sense to _attempt_ a 16K bytes allocation
2695 * to reduce number of system calls on dump operations, if user
2696 * ever provided a big enough buffer.
2697 */
2698 if (alloc_size < nlk->max_recvmsg_len) {
2699 skb = netlink_alloc_skb(sk,
2700 nlk->max_recvmsg_len,
2701 nlk->portid,
2702 GFP_KERNEL |
2703 __GFP_NOWARN |
2704 __GFP_NORETRY);
2705 /* available room should be exact amount to avoid MSG_TRUNC */
2706 if (skb)
2707 skb_reserve(skb, skb_tailroom(skb) -
2708 nlk->max_recvmsg_len);
2709 }
2710 if (!skb)
2711 skb = netlink_alloc_skb(sk, alloc_size, nlk->portid,
2712 GFP_KERNEL);
Greg Rosec7ac8672011-06-10 01:27:09 +00002713 if (!skb)
Dan Carpenterc63d6ea2011-06-15 03:11:42 +00002714 goto errout_skb;
Patrick McHardyf9c22882013-04-17 06:47:04 +00002715 netlink_skb_set_owner_r(skb, sk);
Greg Rosec7ac8672011-06-10 01:27:09 +00002716
Linus Torvalds1da177e2005-04-16 15:20:36 -07002717 len = cb->dump(skb, cb);
2718
2719 if (len > 0) {
Patrick McHardyaf65bdf2007-04-20 14:14:21 -07002720 mutex_unlock(nlk->cb_mutex);
Stephen Hemmingerb1153f22008-03-21 15:46:12 -07002721
2722 if (sk_filter(sk, skb))
2723 kfree_skb(skb);
Eric Dumazet4a7e7c22012-04-05 22:17:46 +00002724 else
2725 __netlink_sendskb(sk, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002726 return 0;
2727 }
2728
Thomas Grafbf8b79e2006-08-04 23:03:29 -07002729 nlh = nlmsg_put_answer(skb, cb, NLMSG_DONE, sizeof(len), NLM_F_MULTI);
2730 if (!nlh)
2731 goto errout_skb;
2732
Johannes Berg670dc282011-06-20 13:40:46 +02002733 nl_dump_check_consistent(cb, nlh);
2734
Thomas Grafbf8b79e2006-08-04 23:03:29 -07002735 memcpy(nlmsg_data(nlh), &len, sizeof(len));
2736
Stephen Hemmingerb1153f22008-03-21 15:46:12 -07002737 if (sk_filter(sk, skb))
2738 kfree_skb(skb);
Eric Dumazet4a7e7c22012-04-05 22:17:46 +00002739 else
2740 __netlink_sendskb(sk, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002741
Thomas Grafa8f74b22005-11-10 02:25:52 +01002742 if (cb->done)
2743 cb->done(cb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002744
Pravin B Shelar16b304f2013-08-15 15:31:06 -07002745 nlk->cb_running = false;
2746 mutex_unlock(nlk->cb_mutex);
Gao feng6dc878a2012-10-04 20:15:48 +00002747 module_put(cb->module);
Pravin B Shelar16b304f2013-08-15 15:31:06 -07002748 consume_skb(cb->skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002749 return 0;
Thomas Graf17977542005-06-18 22:53:48 -07002750
Thomas Grafbf8b79e2006-08-04 23:03:29 -07002751errout_skb:
Patrick McHardyaf65bdf2007-04-20 14:14:21 -07002752 mutex_unlock(nlk->cb_mutex);
Thomas Grafbf8b79e2006-08-04 23:03:29 -07002753 kfree_skb(skb);
Thomas Grafbf8b79e2006-08-04 23:03:29 -07002754 return err;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002755}
2756
Gao feng6dc878a2012-10-04 20:15:48 +00002757int __netlink_dump_start(struct sock *ssk, struct sk_buff *skb,
2758 const struct nlmsghdr *nlh,
2759 struct netlink_dump_control *control)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002760{
2761 struct netlink_callback *cb;
2762 struct sock *sk;
2763 struct netlink_sock *nlk;
Andrey Vaginb44d2112011-02-21 02:40:47 +00002764 int ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002765
Patrick McHardyf9c22882013-04-17 06:47:04 +00002766 /* Memory mapped dump requests need to be copied to avoid looping
2767 * on the pending state in netlink_mmap_sendmsg() while the CB hold
2768 * a reference to the skb.
2769 */
2770 if (netlink_skb_is_mmaped(skb)) {
2771 skb = skb_copy(skb, GFP_KERNEL);
Pravin B Shelar16b304f2013-08-15 15:31:06 -07002772 if (skb == NULL)
Patrick McHardyf9c22882013-04-17 06:47:04 +00002773 return -ENOBUFS;
Patrick McHardyf9c22882013-04-17 06:47:04 +00002774 } else
2775 atomic_inc(&skb->users);
2776
Pravin B Shelar16b304f2013-08-15 15:31:06 -07002777 sk = netlink_lookup(sock_net(ssk), ssk->sk_protocol, NETLINK_CB(skb).portid);
2778 if (sk == NULL) {
2779 ret = -ECONNREFUSED;
2780 goto error_free;
2781 }
2782
2783 nlk = nlk_sk(sk);
2784 mutex_lock(nlk->cb_mutex);
2785 /* A dump is in progress... */
2786 if (nlk->cb_running) {
2787 ret = -EBUSY;
2788 goto error_unlock;
2789 }
2790 /* add reference of module which cb->dump belongs to */
2791 if (!try_module_get(control->module)) {
2792 ret = -EPROTONOSUPPORT;
2793 goto error_unlock;
2794 }
2795
2796 cb = &nlk->cb;
2797 memset(cb, 0, sizeof(*cb));
Pablo Neira Ayuso80d326f2012-02-24 14:30:15 +00002798 cb->dump = control->dump;
2799 cb->done = control->done;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002800 cb->nlh = nlh;
Pablo Neira Ayuso7175c882012-02-24 14:30:16 +00002801 cb->data = control->data;
Gao feng6dc878a2012-10-04 20:15:48 +00002802 cb->module = control->module;
Pablo Neira Ayuso80d326f2012-02-24 14:30:15 +00002803 cb->min_dump_alloc = control->min_dump_alloc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002804 cb->skb = skb;
2805
Pravin B Shelar16b304f2013-08-15 15:31:06 -07002806 nlk->cb_running = true;
Gao feng6dc878a2012-10-04 20:15:48 +00002807
Patrick McHardyaf65bdf2007-04-20 14:14:21 -07002808 mutex_unlock(nlk->cb_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002809
Andrey Vaginb44d2112011-02-21 02:40:47 +00002810 ret = netlink_dump(sk);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002811 sock_put(sk);
Denis V. Lunev5c582982007-10-23 20:29:25 -07002812
Andrey Vaginb44d2112011-02-21 02:40:47 +00002813 if (ret)
2814 return ret;
2815
Denis V. Lunev5c582982007-10-23 20:29:25 -07002816 /* We successfully started a dump, by returning -EINTR we
2817 * signal not to send ACK even if it was requested.
2818 */
2819 return -EINTR;
Pravin B Shelar16b304f2013-08-15 15:31:06 -07002820
2821error_unlock:
2822 sock_put(sk);
2823 mutex_unlock(nlk->cb_mutex);
2824error_free:
2825 kfree_skb(skb);
2826 return ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002827}
Gao feng6dc878a2012-10-04 20:15:48 +00002828EXPORT_SYMBOL(__netlink_dump_start);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002829
2830void netlink_ack(struct sk_buff *in_skb, struct nlmsghdr *nlh, int err)
2831{
2832 struct sk_buff *skb;
2833 struct nlmsghdr *rep;
2834 struct nlmsgerr *errmsg;
Thomas Graf339bf982006-11-10 14:10:15 -08002835 size_t payload = sizeof(*errmsg);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002836
Thomas Graf339bf982006-11-10 14:10:15 -08002837 /* error messages get the original request appened */
2838 if (err)
2839 payload += nlmsg_len(nlh);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002840
Patrick McHardyf9c22882013-04-17 06:47:04 +00002841 skb = netlink_alloc_skb(in_skb->sk, nlmsg_total_size(payload),
2842 NETLINK_CB(in_skb).portid, GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002843 if (!skb) {
2844 struct sock *sk;
2845
YOSHIFUJI Hideaki3b1e0a62008-03-26 02:26:21 +09002846 sk = netlink_lookup(sock_net(in_skb->sk),
Eric W. Biedermanb4b51022007-09-12 13:05:38 +02002847 in_skb->sk->sk_protocol,
Eric W. Biederman15e47302012-09-07 20:12:54 +00002848 NETLINK_CB(in_skb).portid);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002849 if (sk) {
2850 sk->sk_err = ENOBUFS;
2851 sk->sk_error_report(sk);
2852 sock_put(sk);
2853 }
2854 return;
2855 }
2856
Eric W. Biederman15e47302012-09-07 20:12:54 +00002857 rep = __nlmsg_put(skb, NETLINK_CB(in_skb).portid, nlh->nlmsg_seq,
John Fastabend5dba93a2009-09-25 13:11:44 +00002858 NLMSG_ERROR, payload, 0);
Thomas Grafbf8b79e2006-08-04 23:03:29 -07002859 errmsg = nlmsg_data(rep);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002860 errmsg->error = err;
Thomas Grafbf8b79e2006-08-04 23:03:29 -07002861 memcpy(&errmsg->msg, nlh, err ? nlh->nlmsg_len : sizeof(*nlh));
Eric W. Biederman15e47302012-09-07 20:12:54 +00002862 netlink_unicast(in_skb->sk, skb, NETLINK_CB(in_skb).portid, MSG_DONTWAIT);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002863}
Patrick McHardy6ac552f2007-12-04 00:19:38 -08002864EXPORT_SYMBOL(netlink_ack);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002865
Denis V. Lunevcd40b7d2007-10-10 21:15:29 -07002866int netlink_rcv_skb(struct sk_buff *skb, int (*cb)(struct sk_buff *,
Thomas Graf1d00a4e2007-03-22 23:30:12 -07002867 struct nlmsghdr *))
Thomas Graf82ace472005-11-10 02:25:53 +01002868{
Thomas Graf82ace472005-11-10 02:25:53 +01002869 struct nlmsghdr *nlh;
2870 int err;
2871
2872 while (skb->len >= nlmsg_total_size(0)) {
Denis V. Lunevcd40b7d2007-10-10 21:15:29 -07002873 int msglen;
2874
Arnaldo Carvalho de Melob529ccf2007-04-25 19:08:35 -07002875 nlh = nlmsg_hdr(skb);
Thomas Grafd35b6852007-03-22 23:28:46 -07002876 err = 0;
Thomas Graf82ace472005-11-10 02:25:53 +01002877
Martin Murrayad8e4b72006-01-10 13:02:29 -08002878 if (nlh->nlmsg_len < NLMSG_HDRLEN || skb->len < nlh->nlmsg_len)
Thomas Graf82ace472005-11-10 02:25:53 +01002879 return 0;
2880
Thomas Grafd35b6852007-03-22 23:28:46 -07002881 /* Only requests are handled by the kernel */
2882 if (!(nlh->nlmsg_flags & NLM_F_REQUEST))
Denis V. Lunev5c582982007-10-23 20:29:25 -07002883 goto ack;
Thomas Grafd35b6852007-03-22 23:28:46 -07002884
Thomas Graf45e7ae72007-03-22 23:29:10 -07002885 /* Skip control messages */
2886 if (nlh->nlmsg_type < NLMSG_MIN_TYPE)
Denis V. Lunev5c582982007-10-23 20:29:25 -07002887 goto ack;
Thomas Graf45e7ae72007-03-22 23:29:10 -07002888
Thomas Graf1d00a4e2007-03-22 23:30:12 -07002889 err = cb(skb, nlh);
Denis V. Lunev5c582982007-10-23 20:29:25 -07002890 if (err == -EINTR)
2891 goto skip;
2892
2893ack:
Thomas Grafd35b6852007-03-22 23:28:46 -07002894 if (nlh->nlmsg_flags & NLM_F_ACK || err)
Thomas Graf82ace472005-11-10 02:25:53 +01002895 netlink_ack(skb, nlh, err);
Thomas Graf82ace472005-11-10 02:25:53 +01002896
Denis V. Lunev5c582982007-10-23 20:29:25 -07002897skip:
Patrick McHardy6ac552f2007-12-04 00:19:38 -08002898 msglen = NLMSG_ALIGN(nlh->nlmsg_len);
Denis V. Lunevcd40b7d2007-10-10 21:15:29 -07002899 if (msglen > skb->len)
2900 msglen = skb->len;
2901 skb_pull(skb, msglen);
Thomas Graf82ace472005-11-10 02:25:53 +01002902 }
2903
2904 return 0;
2905}
Patrick McHardy6ac552f2007-12-04 00:19:38 -08002906EXPORT_SYMBOL(netlink_rcv_skb);
Thomas Graf82ace472005-11-10 02:25:53 +01002907
2908/**
Thomas Grafd387f6a2006-08-15 00:31:06 -07002909 * nlmsg_notify - send a notification netlink message
2910 * @sk: netlink socket to use
2911 * @skb: notification message
Eric W. Biederman15e47302012-09-07 20:12:54 +00002912 * @portid: destination netlink portid for reports or 0
Thomas Grafd387f6a2006-08-15 00:31:06 -07002913 * @group: destination multicast group or 0
2914 * @report: 1 to report back, 0 to disable
2915 * @flags: allocation flags
2916 */
Eric W. Biederman15e47302012-09-07 20:12:54 +00002917int nlmsg_notify(struct sock *sk, struct sk_buff *skb, u32 portid,
Thomas Grafd387f6a2006-08-15 00:31:06 -07002918 unsigned int group, int report, gfp_t flags)
2919{
2920 int err = 0;
2921
2922 if (group) {
Eric W. Biederman15e47302012-09-07 20:12:54 +00002923 int exclude_portid = 0;
Thomas Grafd387f6a2006-08-15 00:31:06 -07002924
2925 if (report) {
2926 atomic_inc(&skb->users);
Eric W. Biederman15e47302012-09-07 20:12:54 +00002927 exclude_portid = portid;
Thomas Grafd387f6a2006-08-15 00:31:06 -07002928 }
2929
Pablo Neira Ayuso1ce85fe2009-02-24 23:18:28 -08002930 /* errors reported via destination sk->sk_err, but propagate
2931 * delivery errors if NETLINK_BROADCAST_ERROR flag is set */
Eric W. Biederman15e47302012-09-07 20:12:54 +00002932 err = nlmsg_multicast(sk, skb, exclude_portid, group, flags);
Thomas Grafd387f6a2006-08-15 00:31:06 -07002933 }
2934
Pablo Neira Ayuso1ce85fe2009-02-24 23:18:28 -08002935 if (report) {
2936 int err2;
2937
Eric W. Biederman15e47302012-09-07 20:12:54 +00002938 err2 = nlmsg_unicast(sk, skb, portid);
Pablo Neira Ayuso1ce85fe2009-02-24 23:18:28 -08002939 if (!err || err == -ESRCH)
2940 err = err2;
2941 }
Thomas Grafd387f6a2006-08-15 00:31:06 -07002942
2943 return err;
2944}
Patrick McHardy6ac552f2007-12-04 00:19:38 -08002945EXPORT_SYMBOL(nlmsg_notify);
Thomas Grafd387f6a2006-08-15 00:31:06 -07002946
Linus Torvalds1da177e2005-04-16 15:20:36 -07002947#ifdef CONFIG_PROC_FS
2948struct nl_seq_iter {
Denis V. Luneve372c412007-11-19 22:31:54 -08002949 struct seq_net_private p;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002950 int link;
2951 int hash_idx;
2952};
2953
2954static struct sock *netlink_seq_socket_idx(struct seq_file *seq, loff_t pos)
2955{
2956 struct nl_seq_iter *iter = seq->private;
2957 int i, j;
2958 struct sock *s;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002959 loff_t off = 0;
2960
Patrick McHardy6ac552f2007-12-04 00:19:38 -08002961 for (i = 0; i < MAX_LINKS; i++) {
Eric W. Biederman15e47302012-09-07 20:12:54 +00002962 struct nl_portid_hash *hash = &nl_table[i].hash;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002963
2964 for (j = 0; j <= hash->mask; j++) {
Sasha Levinb67bfe02013-02-27 17:06:00 -08002965 sk_for_each(s, &hash->table[j]) {
YOSHIFUJI Hideaki12188542008-03-26 02:36:06 +09002966 if (sock_net(s) != seq_file_net(seq))
Eric W. Biedermanb4b51022007-09-12 13:05:38 +02002967 continue;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002968 if (off == pos) {
2969 iter->link = i;
2970 iter->hash_idx = j;
2971 return s;
2972 }
2973 ++off;
2974 }
2975 }
2976 }
2977 return NULL;
2978}
2979
2980static void *netlink_seq_start(struct seq_file *seq, loff_t *pos)
Eric Dumazet9a429c42008-01-01 21:58:02 -08002981 __acquires(nl_table_lock)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002982{
2983 read_lock(&nl_table_lock);
2984 return *pos ? netlink_seq_socket_idx(seq, *pos - 1) : SEQ_START_TOKEN;
2985}
2986
2987static void *netlink_seq_next(struct seq_file *seq, void *v, loff_t *pos)
2988{
2989 struct sock *s;
2990 struct nl_seq_iter *iter;
Gao fengda12c902013-06-06 14:49:11 +08002991 struct net *net;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002992 int i, j;
2993
2994 ++*pos;
2995
2996 if (v == SEQ_START_TOKEN)
2997 return netlink_seq_socket_idx(seq, 0);
YOSHIFUJI Hideaki746fac42007-02-09 23:25:07 +09002998
Gao fengda12c902013-06-06 14:49:11 +08002999 net = seq_file_net(seq);
Eric W. Biedermanb4b51022007-09-12 13:05:38 +02003000 iter = seq->private;
3001 s = v;
3002 do {
3003 s = sk_next(s);
Gao fengda12c902013-06-06 14:49:11 +08003004 } while (s && !nl_table[s->sk_protocol].compare(net, s));
Linus Torvalds1da177e2005-04-16 15:20:36 -07003005 if (s)
3006 return s;
3007
Linus Torvalds1da177e2005-04-16 15:20:36 -07003008 i = iter->link;
3009 j = iter->hash_idx + 1;
3010
3011 do {
Eric W. Biederman15e47302012-09-07 20:12:54 +00003012 struct nl_portid_hash *hash = &nl_table[i].hash;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003013
3014 for (; j <= hash->mask; j++) {
3015 s = sk_head(&hash->table[j]);
Gao fengda12c902013-06-06 14:49:11 +08003016
3017 while (s && !nl_table[s->sk_protocol].compare(net, s))
Eric W. Biedermanb4b51022007-09-12 13:05:38 +02003018 s = sk_next(s);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003019 if (s) {
3020 iter->link = i;
3021 iter->hash_idx = j;
3022 return s;
3023 }
3024 }
3025
3026 j = 0;
3027 } while (++i < MAX_LINKS);
3028
3029 return NULL;
3030}
3031
3032static void netlink_seq_stop(struct seq_file *seq, void *v)
Eric Dumazet9a429c42008-01-01 21:58:02 -08003033 __releases(nl_table_lock)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003034{
3035 read_unlock(&nl_table_lock);
3036}
3037
3038
3039static int netlink_seq_show(struct seq_file *seq, void *v)
3040{
Eric Dumazet658cb352012-04-22 21:30:21 +00003041 if (v == SEQ_START_TOKEN) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003042 seq_puts(seq,
3043 "sk Eth Pid Groups "
Masatake YAMATOcf0aa4e2010-02-27 19:45:37 +00003044 "Rmem Wmem Dump Locks Drops Inode\n");
Eric Dumazet658cb352012-04-22 21:30:21 +00003045 } else {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003046 struct sock *s = v;
3047 struct netlink_sock *nlk = nlk_sk(s);
3048
Pravin B Shelar16b304f2013-08-15 15:31:06 -07003049 seq_printf(seq, "%pK %-3d %-6u %08x %-8d %-8d %d %-8d %-8d %-8lu\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -07003050 s,
3051 s->sk_protocol,
Eric W. Biederman15e47302012-09-07 20:12:54 +00003052 nlk->portid,
Patrick McHardy513c2502005-09-06 15:43:59 -07003053 nlk->groups ? (u32)nlk->groups[0] : 0,
Eric Dumazet31e6d362009-06-17 19:05:41 -07003054 sk_rmem_alloc_get(s),
3055 sk_wmem_alloc_get(s),
Pravin B Shelar16b304f2013-08-15 15:31:06 -07003056 nlk->cb_running,
Pablo Neira Ayuso38938bf2009-03-24 16:37:55 -07003057 atomic_read(&s->sk_refcnt),
Masatake YAMATOcf0aa4e2010-02-27 19:45:37 +00003058 atomic_read(&s->sk_drops),
3059 sock_i_ino(s)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003060 );
3061
3062 }
3063 return 0;
3064}
3065
Philippe De Muyter56b3d972007-07-10 23:07:31 -07003066static const struct seq_operations netlink_seq_ops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003067 .start = netlink_seq_start,
3068 .next = netlink_seq_next,
3069 .stop = netlink_seq_stop,
3070 .show = netlink_seq_show,
3071};
3072
3073
3074static int netlink_seq_open(struct inode *inode, struct file *file)
3075{
Denis V. Luneve372c412007-11-19 22:31:54 -08003076 return seq_open_net(inode, file, &netlink_seq_ops,
3077 sizeof(struct nl_seq_iter));
Eric W. Biedermanb4b51022007-09-12 13:05:38 +02003078}
3079
Arjan van de Venda7071d2007-02-12 00:55:36 -08003080static const struct file_operations netlink_seq_fops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003081 .owner = THIS_MODULE,
3082 .open = netlink_seq_open,
3083 .read = seq_read,
3084 .llseek = seq_lseek,
Denis V. Luneve372c412007-11-19 22:31:54 -08003085 .release = seq_release_net,
Linus Torvalds1da177e2005-04-16 15:20:36 -07003086};
3087
3088#endif
3089
3090int netlink_register_notifier(struct notifier_block *nb)
3091{
Alan Sterne041c682006-03-27 01:16:30 -08003092 return atomic_notifier_chain_register(&netlink_chain, nb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003093}
Patrick McHardy6ac552f2007-12-04 00:19:38 -08003094EXPORT_SYMBOL(netlink_register_notifier);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003095
3096int netlink_unregister_notifier(struct notifier_block *nb)
3097{
Alan Sterne041c682006-03-27 01:16:30 -08003098 return atomic_notifier_chain_unregister(&netlink_chain, nb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003099}
Patrick McHardy6ac552f2007-12-04 00:19:38 -08003100EXPORT_SYMBOL(netlink_unregister_notifier);
YOSHIFUJI Hideaki746fac42007-02-09 23:25:07 +09003101
Eric Dumazet90ddc4f2005-12-22 12:49:22 -08003102static const struct proto_ops netlink_ops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003103 .family = PF_NETLINK,
3104 .owner = THIS_MODULE,
3105 .release = netlink_release,
3106 .bind = netlink_bind,
3107 .connect = netlink_connect,
3108 .socketpair = sock_no_socketpair,
3109 .accept = sock_no_accept,
3110 .getname = netlink_getname,
Patrick McHardy9652e932013-04-17 06:47:02 +00003111 .poll = netlink_poll,
Linus Torvalds1da177e2005-04-16 15:20:36 -07003112 .ioctl = sock_no_ioctl,
3113 .listen = sock_no_listen,
3114 .shutdown = sock_no_shutdown,
Patrick McHardy9a4595b2005-08-15 12:32:15 -07003115 .setsockopt = netlink_setsockopt,
3116 .getsockopt = netlink_getsockopt,
Linus Torvalds1da177e2005-04-16 15:20:36 -07003117 .sendmsg = netlink_sendmsg,
3118 .recvmsg = netlink_recvmsg,
Patrick McHardyccdfcc32013-04-17 06:47:01 +00003119 .mmap = netlink_mmap,
Linus Torvalds1da177e2005-04-16 15:20:36 -07003120 .sendpage = sock_no_sendpage,
3121};
3122
Stephen Hemmingerec1b4cf2009-10-05 05:58:39 +00003123static const struct net_proto_family netlink_family_ops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003124 .family = PF_NETLINK,
3125 .create = netlink_create,
3126 .owner = THIS_MODULE, /* for consistency 8) */
3127};
3128
Pavel Emelyanov46650792007-10-08 20:38:39 -07003129static int __net_init netlink_net_init(struct net *net)
Eric W. Biedermanb4b51022007-09-12 13:05:38 +02003130{
3131#ifdef CONFIG_PROC_FS
Gao fengd4beaa62013-02-18 01:34:54 +00003132 if (!proc_create("netlink", 0, net->proc_net, &netlink_seq_fops))
Eric W. Biedermanb4b51022007-09-12 13:05:38 +02003133 return -ENOMEM;
3134#endif
3135 return 0;
3136}
3137
Pavel Emelyanov46650792007-10-08 20:38:39 -07003138static void __net_exit netlink_net_exit(struct net *net)
Eric W. Biedermanb4b51022007-09-12 13:05:38 +02003139{
3140#ifdef CONFIG_PROC_FS
Gao fengece31ff2013-02-18 01:34:56 +00003141 remove_proc_entry("netlink", net->proc_net);
Eric W. Biedermanb4b51022007-09-12 13:05:38 +02003142#endif
3143}
3144
David S. Millerb963ea82010-08-30 19:08:01 -07003145static void __init netlink_add_usersock_entry(void)
3146{
Eric Dumazet5c398dc2010-10-24 04:27:10 +00003147 struct listeners *listeners;
David S. Millerb963ea82010-08-30 19:08:01 -07003148 int groups = 32;
3149
Eric Dumazet5c398dc2010-10-24 04:27:10 +00003150 listeners = kzalloc(sizeof(*listeners) + NLGRPSZ(groups), GFP_KERNEL);
David S. Millerb963ea82010-08-30 19:08:01 -07003151 if (!listeners)
Eric Dumazet5c398dc2010-10-24 04:27:10 +00003152 panic("netlink_add_usersock_entry: Cannot allocate listeners\n");
David S. Millerb963ea82010-08-30 19:08:01 -07003153
3154 netlink_table_grab();
3155
3156 nl_table[NETLINK_USERSOCK].groups = groups;
Eric Dumazet5c398dc2010-10-24 04:27:10 +00003157 rcu_assign_pointer(nl_table[NETLINK_USERSOCK].listeners, listeners);
David S. Millerb963ea82010-08-30 19:08:01 -07003158 nl_table[NETLINK_USERSOCK].module = THIS_MODULE;
3159 nl_table[NETLINK_USERSOCK].registered = 1;
Pablo Neira Ayuso9785e102012-09-08 02:53:53 +00003160 nl_table[NETLINK_USERSOCK].flags = NL_CFG_F_NONROOT_SEND;
David S. Millerb963ea82010-08-30 19:08:01 -07003161
3162 netlink_table_ungrab();
3163}
3164
Denis V. Lunev022cbae2007-11-13 03:23:50 -08003165static struct pernet_operations __net_initdata netlink_net_ops = {
Eric W. Biedermanb4b51022007-09-12 13:05:38 +02003166 .init = netlink_net_init,
3167 .exit = netlink_net_exit,
3168};
3169
Linus Torvalds1da177e2005-04-16 15:20:36 -07003170static int __init netlink_proto_init(void)
3171{
Linus Torvalds1da177e2005-04-16 15:20:36 -07003172 int i;
Denis Cheng26ff5dd2007-09-16 16:36:02 -07003173 unsigned long limit;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003174 unsigned int order;
3175 int err = proto_register(&netlink_proto, 0);
3176
3177 if (err != 0)
3178 goto out;
3179
YOSHIFUJI Hideaki / 吉藤英明fab25742013-01-09 07:19:48 +00003180 BUILD_BUG_ON(sizeof(struct netlink_skb_parms) > FIELD_SIZEOF(struct sk_buff, cb));
Linus Torvalds1da177e2005-04-16 15:20:36 -07003181
Panagiotis Issaris0da974f2006-07-21 14:51:30 -07003182 nl_table = kcalloc(MAX_LINKS, sizeof(*nl_table), GFP_KERNEL);
Akinobu Mitafab2caf2006-08-29 02:15:24 -07003183 if (!nl_table)
3184 goto panic;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003185
Jan Beulich44813742009-09-21 17:03:05 -07003186 if (totalram_pages >= (128 * 1024))
3187 limit = totalram_pages >> (21 - PAGE_SHIFT);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003188 else
Jan Beulich44813742009-09-21 17:03:05 -07003189 limit = totalram_pages >> (23 - PAGE_SHIFT);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003190
Denis Cheng26ff5dd2007-09-16 16:36:02 -07003191 order = get_bitmask_order(limit) - 1 + PAGE_SHIFT;
3192 limit = (1UL << order) / sizeof(struct hlist_head);
3193 order = get_bitmask_order(min(limit, (unsigned long)UINT_MAX)) - 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003194
3195 for (i = 0; i < MAX_LINKS; i++) {
Eric W. Biederman15e47302012-09-07 20:12:54 +00003196 struct nl_portid_hash *hash = &nl_table[i].hash;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003197
Eric W. Biederman15e47302012-09-07 20:12:54 +00003198 hash->table = nl_portid_hash_zalloc(1 * sizeof(*hash->table));
Linus Torvalds1da177e2005-04-16 15:20:36 -07003199 if (!hash->table) {
3200 while (i-- > 0)
Eric W. Biederman15e47302012-09-07 20:12:54 +00003201 nl_portid_hash_free(nl_table[i].hash.table,
Linus Torvalds1da177e2005-04-16 15:20:36 -07003202 1 * sizeof(*hash->table));
3203 kfree(nl_table);
Akinobu Mitafab2caf2006-08-29 02:15:24 -07003204 goto panic;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003205 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003206 hash->max_shift = order;
3207 hash->shift = 0;
3208 hash->mask = 0;
3209 hash->rehash_time = jiffies;
Gao fengca15feb2013-06-13 10:05:38 +08003210
3211 nl_table[i].compare = netlink_compare;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003212 }
3213
Daniel Borkmannbcbde0d2013-06-21 19:38:07 +02003214 INIT_LIST_HEAD(&netlink_tap_all);
3215
David S. Millerb963ea82010-08-30 19:08:01 -07003216 netlink_add_usersock_entry();
3217
Linus Torvalds1da177e2005-04-16 15:20:36 -07003218 sock_register(&netlink_family_ops);
Eric W. Biedermanb4b51022007-09-12 13:05:38 +02003219 register_pernet_subsys(&netlink_net_ops);
YOSHIFUJI Hideaki746fac42007-02-09 23:25:07 +09003220 /* The netlink device handler may be needed early. */
Linus Torvalds1da177e2005-04-16 15:20:36 -07003221 rtnetlink_init();
3222out:
3223 return err;
Akinobu Mitafab2caf2006-08-29 02:15:24 -07003224panic:
3225 panic("netlink_init: Cannot allocate nl_table\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07003226}
3227
Linus Torvalds1da177e2005-04-16 15:20:36 -07003228core_initcall(netlink_proto_init);