sock_diag: fetch source port from inet_sock
[linux-2.6-block.git] / net / netlink / af_netlink.c
CommitLineData
1da177e4
LT
1/*
2 * NETLINK Kernel-user communication protocol.
3 *
113aa838 4 * Authors: Alan Cox <alan@lxorguk.ukuu.org.uk>
1da177e4 5 * Alexey Kuznetsov <kuznet@ms2.inr.ac.ru>
cd1df525 6 * Patrick McHardy <kaber@trash.net>
1da177e4
LT
7 *
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.
746fac4d 12 *
1da177e4
LT
13 * 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)
4fdb3bb7
HW
17 * 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
1da177e4
LT
23 */
24
1da177e4
LT
25#include <linux/module.h>
26
4fc268d2 27#include <linux/capability.h>
1da177e4
LT
28#include <linux/kernel.h>
29#include <linux/init.h>
1da177e4
LT
30#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>
1da177e4
LT
49#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>
54e0f520 57#include <linux/audit.h>
af65bdfc 58#include <linux/mutex.h>
ccdfcc39 59#include <linux/vmalloc.h>
bcbde0d4 60#include <linux/if_arp.h>
e341694e 61#include <linux/rhashtable.h>
9652e931 62#include <asm/cacheflush.h>
e341694e 63#include <linux/hash.h>
ee1c2442 64#include <linux/genetlink.h>
54e0f520 65
457c4cbc 66#include <net/net_namespace.h>
1da177e4
LT
67#include <net/sock.h>
68#include <net/scm.h>
82ace47a 69#include <net/netlink.h>
1da177e4 70
0f29c768 71#include "af_netlink.h"
1da177e4 72
5c398dc8
ED
73struct listeners {
74 struct rcu_head rcu;
75 unsigned long masks[0];
6c04bb18
JB
76};
77
cd967e05 78/* state bits */
cc3a572f 79#define NETLINK_S_CONGESTED 0x0
cd967e05
PM
80
81/* flags */
cc3a572f
ND
82#define NETLINK_F_KERNEL_SOCKET 0x1
83#define NETLINK_F_RECV_PKTINFO 0x2
84#define NETLINK_F_BROADCAST_SEND_ERROR 0x4
85#define NETLINK_F_RECV_NO_ENOBUFS 0x8
59324cf3 86#define NETLINK_F_LISTEN_ALL_NSID 0x10
77247bbb 87
035c4c16 88static inline int netlink_is_kernel(struct sock *sk)
aed81560 89{
cc3a572f 90 return nlk_sk(sk)->flags & NETLINK_F_KERNEL_SOCKET;
aed81560
DL
91}
92
91dd93f9 93struct netlink_table *nl_table __read_mostly;
0f29c768 94EXPORT_SYMBOL_GPL(nl_table);
1da177e4
LT
95
96static DECLARE_WAIT_QUEUE_HEAD(nl_table_wait);
97
98static int netlink_dump(struct sock *sk);
9652e931 99static void netlink_skb_destructor(struct sk_buff *skb);
1da177e4 100
78fd1d0a 101/* nl_table locking explained:
21e4902a 102 * Lookup and traversal are protected with an RCU read-side lock. Insertion
c5adde94 103 * and removal are protected with per bucket lock while using RCU list
21e4902a
TG
104 * modification primitives and may run in parallel to RCU protected lookups.
105 * Destruction of the Netlink socket may only occur *after* nl_table_lock has
106 * been acquired * either during or after the socket has been removed from
107 * the list and after an RCU grace period.
78fd1d0a 108 */
0f29c768
AV
109DEFINE_RWLOCK(nl_table_lock);
110EXPORT_SYMBOL_GPL(nl_table_lock);
1da177e4
LT
111static atomic_t nl_table_users = ATOMIC_INIT(0);
112
6d772ac5
ED
113#define nl_deref_protected(X) rcu_dereference_protected(X, lockdep_is_held(&nl_table_lock));
114
e041c683 115static ATOMIC_NOTIFIER_HEAD(netlink_chain);
1da177e4 116
bcbde0d4
DB
117static DEFINE_SPINLOCK(netlink_tap_lock);
118static struct list_head netlink_tap_all __read_mostly;
119
c428ecd1
HX
120static const struct rhashtable_params netlink_rhashtable_params;
121
b57ef81f 122static inline u32 netlink_group_mask(u32 group)
d629b836
PM
123{
124 return group ? 1 << (group - 1) : 0;
125}
126
bcbde0d4
DB
127int netlink_add_tap(struct netlink_tap *nt)
128{
129 if (unlikely(nt->dev->type != ARPHRD_NETLINK))
130 return -EINVAL;
131
132 spin_lock(&netlink_tap_lock);
133 list_add_rcu(&nt->list, &netlink_tap_all);
134 spin_unlock(&netlink_tap_lock);
135
fcd4d35e 136 __module_get(nt->module);
bcbde0d4
DB
137
138 return 0;
139}
140EXPORT_SYMBOL_GPL(netlink_add_tap);
141
2173f8d9 142static int __netlink_remove_tap(struct netlink_tap *nt)
bcbde0d4
DB
143{
144 bool found = false;
145 struct netlink_tap *tmp;
146
147 spin_lock(&netlink_tap_lock);
148
149 list_for_each_entry(tmp, &netlink_tap_all, list) {
150 if (nt == tmp) {
151 list_del_rcu(&nt->list);
152 found = true;
153 goto out;
154 }
155 }
156
157 pr_warn("__netlink_remove_tap: %p not found\n", nt);
158out:
159 spin_unlock(&netlink_tap_lock);
160
161 if (found && nt->module)
162 module_put(nt->module);
163
164 return found ? 0 : -ENODEV;
165}
bcbde0d4
DB
166
167int netlink_remove_tap(struct netlink_tap *nt)
168{
169 int ret;
170
171 ret = __netlink_remove_tap(nt);
172 synchronize_net();
173
174 return ret;
175}
176EXPORT_SYMBOL_GPL(netlink_remove_tap);
177
5ffd5cdd
DB
178static bool netlink_filter_tap(const struct sk_buff *skb)
179{
180 struct sock *sk = skb->sk;
5ffd5cdd
DB
181
182 /* We take the more conservative approach and
183 * whitelist socket protocols that may pass.
184 */
185 switch (sk->sk_protocol) {
186 case NETLINK_ROUTE:
187 case NETLINK_USERSOCK:
188 case NETLINK_SOCK_DIAG:
189 case NETLINK_NFLOG:
190 case NETLINK_XFRM:
191 case NETLINK_FIB_LOOKUP:
192 case NETLINK_NETFILTER:
193 case NETLINK_GENERIC:
498044bb 194 return true;
5ffd5cdd
DB
195 }
196
498044bb 197 return false;
5ffd5cdd
DB
198}
199
bcbde0d4
DB
200static int __netlink_deliver_tap_skb(struct sk_buff *skb,
201 struct net_device *dev)
202{
203 struct sk_buff *nskb;
5ffd5cdd 204 struct sock *sk = skb->sk;
bcbde0d4
DB
205 int ret = -ENOMEM;
206
207 dev_hold(dev);
208 nskb = skb_clone(skb, GFP_ATOMIC);
209 if (nskb) {
210 nskb->dev = dev;
5ffd5cdd 211 nskb->protocol = htons((u16) sk->sk_protocol);
604d13c9
DB
212 nskb->pkt_type = netlink_is_kernel(sk) ?
213 PACKET_KERNEL : PACKET_USER;
4e48ed88 214 skb_reset_network_header(nskb);
bcbde0d4
DB
215 ret = dev_queue_xmit(nskb);
216 if (unlikely(ret > 0))
217 ret = net_xmit_errno(ret);
218 }
219
220 dev_put(dev);
221 return ret;
222}
223
224static void __netlink_deliver_tap(struct sk_buff *skb)
225{
226 int ret;
227 struct netlink_tap *tmp;
228
5ffd5cdd
DB
229 if (!netlink_filter_tap(skb))
230 return;
231
bcbde0d4
DB
232 list_for_each_entry_rcu(tmp, &netlink_tap_all, list) {
233 ret = __netlink_deliver_tap_skb(skb, tmp->dev);
234 if (unlikely(ret))
235 break;
236 }
237}
238
239static void netlink_deliver_tap(struct sk_buff *skb)
240{
241 rcu_read_lock();
242
243 if (unlikely(!list_empty(&netlink_tap_all)))
244 __netlink_deliver_tap(skb);
245
246 rcu_read_unlock();
247}
248
73bfd370
DB
249static void netlink_deliver_tap_kernel(struct sock *dst, struct sock *src,
250 struct sk_buff *skb)
251{
252 if (!(netlink_is_kernel(dst) && netlink_is_kernel(src)))
253 netlink_deliver_tap(skb);
254}
255
cd1df525
PM
256static void netlink_overrun(struct sock *sk)
257{
258 struct netlink_sock *nlk = nlk_sk(sk);
259
cc3a572f
ND
260 if (!(nlk->flags & NETLINK_F_RECV_NO_ENOBUFS)) {
261 if (!test_and_set_bit(NETLINK_S_CONGESTED,
262 &nlk_sk(sk)->state)) {
cd1df525
PM
263 sk->sk_err = ENOBUFS;
264 sk->sk_error_report(sk);
265 }
266 }
267 atomic_inc(&sk->sk_drops);
268}
269
270static void netlink_rcv_wake(struct sock *sk)
271{
272 struct netlink_sock *nlk = nlk_sk(sk);
273
274 if (skb_queue_empty(&sk->sk_receive_queue))
cc3a572f
ND
275 clear_bit(NETLINK_S_CONGESTED, &nlk->state);
276 if (!test_bit(NETLINK_S_CONGESTED, &nlk->state))
cd1df525
PM
277 wake_up_interruptible(&nlk->wait);
278}
279
ccdfcc39 280#ifdef CONFIG_NETLINK_MMAP
9652e931
PM
281static bool netlink_skb_is_mmaped(const struct sk_buff *skb)
282{
283 return NETLINK_CB(skb).flags & NETLINK_SKB_MMAPED;
284}
285
f9c22888
PM
286static bool netlink_rx_is_mmaped(struct sock *sk)
287{
288 return nlk_sk(sk)->rx_ring.pg_vec != NULL;
289}
290
5fd96123
PM
291static bool netlink_tx_is_mmaped(struct sock *sk)
292{
293 return nlk_sk(sk)->tx_ring.pg_vec != NULL;
294}
295
ccdfcc39
PM
296static __pure struct page *pgvec_to_page(const void *addr)
297{
298 if (is_vmalloc_addr(addr))
299 return vmalloc_to_page(addr);
300 else
301 return virt_to_page(addr);
302}
303
304static void free_pg_vec(void **pg_vec, unsigned int order, unsigned int len)
305{
306 unsigned int i;
307
308 for (i = 0; i < len; i++) {
309 if (pg_vec[i] != NULL) {
310 if (is_vmalloc_addr(pg_vec[i]))
311 vfree(pg_vec[i]);
312 else
313 free_pages((unsigned long)pg_vec[i], order);
314 }
315 }
316 kfree(pg_vec);
317}
318
319static void *alloc_one_pg_vec_page(unsigned long order)
320{
321 void *buffer;
322 gfp_t gfp_flags = GFP_KERNEL | __GFP_COMP | __GFP_ZERO |
323 __GFP_NOWARN | __GFP_NORETRY;
324
325 buffer = (void *)__get_free_pages(gfp_flags, order);
326 if (buffer != NULL)
327 return buffer;
328
329 buffer = vzalloc((1 << order) * PAGE_SIZE);
330 if (buffer != NULL)
331 return buffer;
332
333 gfp_flags &= ~__GFP_NORETRY;
334 return (void *)__get_free_pages(gfp_flags, order);
335}
336
337static void **alloc_pg_vec(struct netlink_sock *nlk,
338 struct nl_mmap_req *req, unsigned int order)
339{
340 unsigned int block_nr = req->nm_block_nr;
341 unsigned int i;
8a849bb7 342 void **pg_vec;
ccdfcc39
PM
343
344 pg_vec = kcalloc(block_nr, sizeof(void *), GFP_KERNEL);
345 if (pg_vec == NULL)
346 return NULL;
347
348 for (i = 0; i < block_nr; i++) {
8a849bb7 349 pg_vec[i] = alloc_one_pg_vec_page(order);
ccdfcc39
PM
350 if (pg_vec[i] == NULL)
351 goto err1;
352 }
353
354 return pg_vec;
355err1:
356 free_pg_vec(pg_vec, order, block_nr);
357 return NULL;
358}
359
360static int netlink_set_ring(struct sock *sk, struct nl_mmap_req *req,
361 bool closing, bool tx_ring)
362{
363 struct netlink_sock *nlk = nlk_sk(sk);
364 struct netlink_ring *ring;
365 struct sk_buff_head *queue;
366 void **pg_vec = NULL;
367 unsigned int order = 0;
368 int err;
369
370 ring = tx_ring ? &nlk->tx_ring : &nlk->rx_ring;
371 queue = tx_ring ? &sk->sk_write_queue : &sk->sk_receive_queue;
372
373 if (!closing) {
374 if (atomic_read(&nlk->mapped))
375 return -EBUSY;
376 if (atomic_read(&ring->pending))
377 return -EBUSY;
378 }
379
380 if (req->nm_block_nr) {
381 if (ring->pg_vec != NULL)
382 return -EBUSY;
383
384 if ((int)req->nm_block_size <= 0)
385 return -EINVAL;
74e83b23 386 if (!PAGE_ALIGNED(req->nm_block_size))
ccdfcc39
PM
387 return -EINVAL;
388 if (req->nm_frame_size < NL_MMAP_HDRLEN)
389 return -EINVAL;
390 if (!IS_ALIGNED(req->nm_frame_size, NL_MMAP_MSG_ALIGNMENT))
391 return -EINVAL;
392
393 ring->frames_per_block = req->nm_block_size /
394 req->nm_frame_size;
395 if (ring->frames_per_block == 0)
396 return -EINVAL;
397 if (ring->frames_per_block * req->nm_block_nr !=
398 req->nm_frame_nr)
399 return -EINVAL;
400
401 order = get_order(req->nm_block_size);
402 pg_vec = alloc_pg_vec(nlk, req, order);
403 if (pg_vec == NULL)
404 return -ENOMEM;
405 } else {
406 if (req->nm_frame_nr)
407 return -EINVAL;
408 }
409
410 err = -EBUSY;
411 mutex_lock(&nlk->pg_vec_lock);
412 if (closing || atomic_read(&nlk->mapped) == 0) {
413 err = 0;
414 spin_lock_bh(&queue->lock);
415
416 ring->frame_max = req->nm_frame_nr - 1;
417 ring->head = 0;
418 ring->frame_size = req->nm_frame_size;
419 ring->pg_vec_pages = req->nm_block_size / PAGE_SIZE;
420
421 swap(ring->pg_vec_len, req->nm_block_nr);
422 swap(ring->pg_vec_order, order);
423 swap(ring->pg_vec, pg_vec);
424
425 __skb_queue_purge(queue);
426 spin_unlock_bh(&queue->lock);
427
428 WARN_ON(atomic_read(&nlk->mapped));
429 }
430 mutex_unlock(&nlk->pg_vec_lock);
431
432 if (pg_vec)
433 free_pg_vec(pg_vec, order, req->nm_block_nr);
434 return err;
435}
436
437static void netlink_mm_open(struct vm_area_struct *vma)
438{
439 struct file *file = vma->vm_file;
440 struct socket *sock = file->private_data;
441 struct sock *sk = sock->sk;
442
443 if (sk)
444 atomic_inc(&nlk_sk(sk)->mapped);
445}
446
447static void netlink_mm_close(struct vm_area_struct *vma)
448{
449 struct file *file = vma->vm_file;
450 struct socket *sock = file->private_data;
451 struct sock *sk = sock->sk;
452
453 if (sk)
454 atomic_dec(&nlk_sk(sk)->mapped);
455}
456
457static const struct vm_operations_struct netlink_mmap_ops = {
458 .open = netlink_mm_open,
459 .close = netlink_mm_close,
460};
461
462static int netlink_mmap(struct file *file, struct socket *sock,
463 struct vm_area_struct *vma)
464{
465 struct sock *sk = sock->sk;
466 struct netlink_sock *nlk = nlk_sk(sk);
467 struct netlink_ring *ring;
468 unsigned long start, size, expected;
469 unsigned int i;
470 int err = -EINVAL;
471
472 if (vma->vm_pgoff)
473 return -EINVAL;
474
475 mutex_lock(&nlk->pg_vec_lock);
476
477 expected = 0;
478 for (ring = &nlk->rx_ring; ring <= &nlk->tx_ring; ring++) {
479 if (ring->pg_vec == NULL)
480 continue;
481 expected += ring->pg_vec_len * ring->pg_vec_pages * PAGE_SIZE;
482 }
483
484 if (expected == 0)
485 goto out;
486
487 size = vma->vm_end - vma->vm_start;
488 if (size != expected)
489 goto out;
490
491 start = vma->vm_start;
492 for (ring = &nlk->rx_ring; ring <= &nlk->tx_ring; ring++) {
493 if (ring->pg_vec == NULL)
494 continue;
495
496 for (i = 0; i < ring->pg_vec_len; i++) {
497 struct page *page;
498 void *kaddr = ring->pg_vec[i];
499 unsigned int pg_num;
500
501 for (pg_num = 0; pg_num < ring->pg_vec_pages; pg_num++) {
502 page = pgvec_to_page(kaddr);
503 err = vm_insert_page(vma, start, page);
504 if (err < 0)
505 goto out;
506 start += PAGE_SIZE;
507 kaddr += PAGE_SIZE;
508 }
509 }
510 }
511
512 atomic_inc(&nlk->mapped);
513 vma->vm_ops = &netlink_mmap_ops;
514 err = 0;
515out:
516 mutex_unlock(&nlk->pg_vec_lock);
7cdbac71 517 return err;
ccdfcc39 518}
9652e931 519
4682a035 520static void netlink_frame_flush_dcache(const struct nl_mmap_hdr *hdr, unsigned int nm_len)
9652e931
PM
521{
522#if ARCH_IMPLEMENTS_FLUSH_DCACHE_PAGE == 1
523 struct page *p_start, *p_end;
524
525 /* First page is flushed through netlink_{get,set}_status */
526 p_start = pgvec_to_page(hdr + PAGE_SIZE);
4682a035 527 p_end = pgvec_to_page((void *)hdr + NL_MMAP_HDRLEN + nm_len - 1);
9652e931
PM
528 while (p_start <= p_end) {
529 flush_dcache_page(p_start);
530 p_start++;
531 }
532#endif
533}
534
535static enum nl_mmap_status netlink_get_status(const struct nl_mmap_hdr *hdr)
536{
537 smp_rmb();
538 flush_dcache_page(pgvec_to_page(hdr));
539 return hdr->nm_status;
540}
541
542static void netlink_set_status(struct nl_mmap_hdr *hdr,
543 enum nl_mmap_status status)
544{
a18e6a18 545 smp_mb();
9652e931
PM
546 hdr->nm_status = status;
547 flush_dcache_page(pgvec_to_page(hdr));
9652e931
PM
548}
549
550static struct nl_mmap_hdr *
551__netlink_lookup_frame(const struct netlink_ring *ring, unsigned int pos)
552{
553 unsigned int pg_vec_pos, frame_off;
554
555 pg_vec_pos = pos / ring->frames_per_block;
556 frame_off = pos % ring->frames_per_block;
557
558 return ring->pg_vec[pg_vec_pos] + (frame_off * ring->frame_size);
559}
560
561static struct nl_mmap_hdr *
562netlink_lookup_frame(const struct netlink_ring *ring, unsigned int pos,
563 enum nl_mmap_status status)
564{
565 struct nl_mmap_hdr *hdr;
566
567 hdr = __netlink_lookup_frame(ring, pos);
568 if (netlink_get_status(hdr) != status)
569 return NULL;
570
571 return hdr;
572}
573
574static struct nl_mmap_hdr *
575netlink_current_frame(const struct netlink_ring *ring,
576 enum nl_mmap_status status)
577{
578 return netlink_lookup_frame(ring, ring->head, status);
579}
580
581static struct nl_mmap_hdr *
582netlink_previous_frame(const struct netlink_ring *ring,
583 enum nl_mmap_status status)
584{
585 unsigned int prev;
586
587 prev = ring->head ? ring->head - 1 : ring->frame_max;
588 return netlink_lookup_frame(ring, prev, status);
589}
590
591static void netlink_increment_head(struct netlink_ring *ring)
592{
593 ring->head = ring->head != ring->frame_max ? ring->head + 1 : 0;
594}
595
596static void netlink_forward_ring(struct netlink_ring *ring)
597{
598 unsigned int head = ring->head, pos = head;
599 const struct nl_mmap_hdr *hdr;
600
601 do {
602 hdr = __netlink_lookup_frame(ring, pos);
603 if (hdr->nm_status == NL_MMAP_STATUS_UNUSED)
604 break;
605 if (hdr->nm_status != NL_MMAP_STATUS_SKIP)
606 break;
607 netlink_increment_head(ring);
608 } while (ring->head != head);
609}
610
cd1df525
PM
611static bool netlink_dump_space(struct netlink_sock *nlk)
612{
613 struct netlink_ring *ring = &nlk->rx_ring;
614 struct nl_mmap_hdr *hdr;
615 unsigned int n;
616
617 hdr = netlink_current_frame(ring, NL_MMAP_STATUS_UNUSED);
618 if (hdr == NULL)
619 return false;
620
621 n = ring->head + ring->frame_max / 2;
622 if (n > ring->frame_max)
623 n -= ring->frame_max;
624
625 hdr = __netlink_lookup_frame(ring, n);
626
627 return hdr->nm_status == NL_MMAP_STATUS_UNUSED;
628}
629
9652e931
PM
630static unsigned int netlink_poll(struct file *file, struct socket *sock,
631 poll_table *wait)
632{
633 struct sock *sk = sock->sk;
634 struct netlink_sock *nlk = nlk_sk(sk);
635 unsigned int mask;
cd1df525 636 int err;
9652e931 637
cd1df525
PM
638 if (nlk->rx_ring.pg_vec != NULL) {
639 /* Memory mapped sockets don't call recvmsg(), so flow control
640 * for dumps is performed here. A dump is allowed to continue
641 * if at least half the ring is unused.
642 */
16b304f3 643 while (nlk->cb_running && netlink_dump_space(nlk)) {
cd1df525
PM
644 err = netlink_dump(sk);
645 if (err < 0) {
ac30ef83 646 sk->sk_err = -err;
cd1df525
PM
647 sk->sk_error_report(sk);
648 break;
649 }
650 }
651 netlink_rcv_wake(sk);
652 }
5fd96123 653
9652e931
PM
654 mask = datagram_poll(file, sock, wait);
655
656 spin_lock_bh(&sk->sk_receive_queue.lock);
657 if (nlk->rx_ring.pg_vec) {
658 netlink_forward_ring(&nlk->rx_ring);
659 if (!netlink_previous_frame(&nlk->rx_ring, NL_MMAP_STATUS_UNUSED))
660 mask |= POLLIN | POLLRDNORM;
661 }
662 spin_unlock_bh(&sk->sk_receive_queue.lock);
663
664 spin_lock_bh(&sk->sk_write_queue.lock);
665 if (nlk->tx_ring.pg_vec) {
666 if (netlink_current_frame(&nlk->tx_ring, NL_MMAP_STATUS_UNUSED))
667 mask |= POLLOUT | POLLWRNORM;
668 }
669 spin_unlock_bh(&sk->sk_write_queue.lock);
670
671 return mask;
672}
673
674static struct nl_mmap_hdr *netlink_mmap_hdr(struct sk_buff *skb)
675{
676 return (struct nl_mmap_hdr *)(skb->head - NL_MMAP_HDRLEN);
677}
678
679static void netlink_ring_setup_skb(struct sk_buff *skb, struct sock *sk,
680 struct netlink_ring *ring,
681 struct nl_mmap_hdr *hdr)
682{
683 unsigned int size;
684 void *data;
685
686 size = ring->frame_size - NL_MMAP_HDRLEN;
687 data = (void *)hdr + NL_MMAP_HDRLEN;
688
689 skb->head = data;
690 skb->data = data;
691 skb_reset_tail_pointer(skb);
692 skb->end = skb->tail + size;
693 skb->len = 0;
694
695 skb->destructor = netlink_skb_destructor;
696 NETLINK_CB(skb).flags |= NETLINK_SKB_MMAPED;
697 NETLINK_CB(skb).sk = sk;
698}
5fd96123
PM
699
700static int netlink_mmap_sendmsg(struct sock *sk, struct msghdr *msg,
701 u32 dst_portid, u32 dst_group,
7cc05662 702 struct scm_cookie *scm)
5fd96123
PM
703{
704 struct netlink_sock *nlk = nlk_sk(sk);
705 struct netlink_ring *ring;
706 struct nl_mmap_hdr *hdr;
707 struct sk_buff *skb;
708 unsigned int maxlen;
5fd96123
PM
709 int err = 0, len = 0;
710
5fd96123
PM
711 mutex_lock(&nlk->pg_vec_lock);
712
713 ring = &nlk->tx_ring;
714 maxlen = ring->frame_size - NL_MMAP_HDRLEN;
715
716 do {
4682a035
DM
717 unsigned int nm_len;
718
5fd96123
PM
719 hdr = netlink_current_frame(ring, NL_MMAP_STATUS_VALID);
720 if (hdr == NULL) {
721 if (!(msg->msg_flags & MSG_DONTWAIT) &&
722 atomic_read(&nlk->tx_ring.pending))
723 schedule();
724 continue;
725 }
4682a035
DM
726
727 nm_len = ACCESS_ONCE(hdr->nm_len);
728 if (nm_len > maxlen) {
5fd96123
PM
729 err = -EINVAL;
730 goto out;
731 }
732
4682a035 733 netlink_frame_flush_dcache(hdr, nm_len);
5fd96123 734
4682a035
DM
735 skb = alloc_skb(nm_len, GFP_KERNEL);
736 if (skb == NULL) {
737 err = -ENOBUFS;
738 goto out;
5fd96123 739 }
4682a035
DM
740 __skb_put(skb, nm_len);
741 memcpy(skb->data, (void *)hdr + NL_MMAP_HDRLEN, nm_len);
742 netlink_set_status(hdr, NL_MMAP_STATUS_UNUSED);
5fd96123
PM
743
744 netlink_increment_head(ring);
745
746 NETLINK_CB(skb).portid = nlk->portid;
747 NETLINK_CB(skb).dst_group = dst_group;
7cc05662 748 NETLINK_CB(skb).creds = scm->creds;
5fd96123
PM
749
750 err = security_netlink_send(sk, skb);
751 if (err) {
752 kfree_skb(skb);
753 goto out;
754 }
755
756 if (unlikely(dst_group)) {
757 atomic_inc(&skb->users);
758 netlink_broadcast(sk, skb, dst_portid, dst_group,
759 GFP_KERNEL);
760 }
761 err = netlink_unicast(sk, skb, dst_portid,
762 msg->msg_flags & MSG_DONTWAIT);
763 if (err < 0)
764 goto out;
765 len += err;
766
767 } while (hdr != NULL ||
768 (!(msg->msg_flags & MSG_DONTWAIT) &&
769 atomic_read(&nlk->tx_ring.pending)));
770
771 if (len > 0)
772 err = len;
773out:
774 mutex_unlock(&nlk->pg_vec_lock);
775 return err;
776}
f9c22888
PM
777
778static void netlink_queue_mmaped_skb(struct sock *sk, struct sk_buff *skb)
779{
780 struct nl_mmap_hdr *hdr;
781
782 hdr = netlink_mmap_hdr(skb);
783 hdr->nm_len = skb->len;
784 hdr->nm_group = NETLINK_CB(skb).dst_group;
785 hdr->nm_pid = NETLINK_CB(skb).creds.pid;
1bf9310a
ND
786 hdr->nm_uid = from_kuid(sk_user_ns(sk), NETLINK_CB(skb).creds.uid);
787 hdr->nm_gid = from_kgid(sk_user_ns(sk), NETLINK_CB(skb).creds.gid);
4682a035 788 netlink_frame_flush_dcache(hdr, hdr->nm_len);
f9c22888
PM
789 netlink_set_status(hdr, NL_MMAP_STATUS_VALID);
790
791 NETLINK_CB(skb).flags |= NETLINK_SKB_DELIVERED;
792 kfree_skb(skb);
793}
794
795static void netlink_ring_set_copied(struct sock *sk, struct sk_buff *skb)
796{
797 struct netlink_sock *nlk = nlk_sk(sk);
798 struct netlink_ring *ring = &nlk->rx_ring;
799 struct nl_mmap_hdr *hdr;
800
801 spin_lock_bh(&sk->sk_receive_queue.lock);
802 hdr = netlink_current_frame(ring, NL_MMAP_STATUS_UNUSED);
803 if (hdr == NULL) {
804 spin_unlock_bh(&sk->sk_receive_queue.lock);
805 kfree_skb(skb);
cd1df525 806 netlink_overrun(sk);
f9c22888
PM
807 return;
808 }
809 netlink_increment_head(ring);
810 __skb_queue_tail(&sk->sk_receive_queue, skb);
811 spin_unlock_bh(&sk->sk_receive_queue.lock);
812
813 hdr->nm_len = skb->len;
814 hdr->nm_group = NETLINK_CB(skb).dst_group;
815 hdr->nm_pid = NETLINK_CB(skb).creds.pid;
1bf9310a
ND
816 hdr->nm_uid = from_kuid(sk_user_ns(sk), NETLINK_CB(skb).creds.uid);
817 hdr->nm_gid = from_kgid(sk_user_ns(sk), NETLINK_CB(skb).creds.gid);
f9c22888
PM
818 netlink_set_status(hdr, NL_MMAP_STATUS_COPY);
819}
820
ccdfcc39 821#else /* CONFIG_NETLINK_MMAP */
9652e931 822#define netlink_skb_is_mmaped(skb) false
f9c22888 823#define netlink_rx_is_mmaped(sk) false
5fd96123 824#define netlink_tx_is_mmaped(sk) false
ccdfcc39 825#define netlink_mmap sock_no_mmap
9652e931 826#define netlink_poll datagram_poll
7cc05662 827#define netlink_mmap_sendmsg(sk, msg, dst_portid, dst_group, scm) 0
ccdfcc39
PM
828#endif /* CONFIG_NETLINK_MMAP */
829
cf0a018a
PM
830static void netlink_skb_destructor(struct sk_buff *skb)
831{
9652e931
PM
832#ifdef CONFIG_NETLINK_MMAP
833 struct nl_mmap_hdr *hdr;
834 struct netlink_ring *ring;
835 struct sock *sk;
836
837 /* If a packet from the kernel to userspace was freed because of an
838 * error without being delivered to userspace, the kernel must reset
839 * the status. In the direction userspace to kernel, the status is
840 * always reset here after the packet was processed and freed.
841 */
842 if (netlink_skb_is_mmaped(skb)) {
843 hdr = netlink_mmap_hdr(skb);
844 sk = NETLINK_CB(skb).sk;
845
5fd96123
PM
846 if (NETLINK_CB(skb).flags & NETLINK_SKB_TX) {
847 netlink_set_status(hdr, NL_MMAP_STATUS_UNUSED);
848 ring = &nlk_sk(sk)->tx_ring;
849 } else {
850 if (!(NETLINK_CB(skb).flags & NETLINK_SKB_DELIVERED)) {
851 hdr->nm_len = 0;
852 netlink_set_status(hdr, NL_MMAP_STATUS_VALID);
853 }
854 ring = &nlk_sk(sk)->rx_ring;
9652e931 855 }
9652e931
PM
856
857 WARN_ON(atomic_read(&ring->pending) == 0);
858 atomic_dec(&ring->pending);
859 sock_put(sk);
860
5e71d9d7 861 skb->head = NULL;
9652e931
PM
862 }
863#endif
c05cdb1b 864 if (is_vmalloc_addr(skb->head)) {
3a36515f
PN
865 if (!skb->cloned ||
866 !atomic_dec_return(&(skb_shinfo(skb)->dataref)))
867 vfree(skb->head);
868
c05cdb1b
PNA
869 skb->head = NULL;
870 }
9652e931
PM
871 if (skb->sk != NULL)
872 sock_rfree(skb);
cf0a018a
PM
873}
874
875static void netlink_skb_set_owner_r(struct sk_buff *skb, struct sock *sk)
876{
877 WARN_ON(skb->sk != NULL);
878 skb->sk = sk;
879 skb->destructor = netlink_skb_destructor;
880 atomic_add(skb->truesize, &sk->sk_rmem_alloc);
881 sk_mem_charge(sk, skb->truesize);
882}
883
1da177e4
LT
884static void netlink_sock_destruct(struct sock *sk)
885{
3f660d66
HX
886 struct netlink_sock *nlk = nlk_sk(sk);
887
16b304f3
PS
888 if (nlk->cb_running) {
889 if (nlk->cb.done)
890 nlk->cb.done(&nlk->cb);
6dc878a8 891
16b304f3
PS
892 module_put(nlk->cb.module);
893 kfree_skb(nlk->cb.skb);
3f660d66
HX
894 }
895
1da177e4 896 skb_queue_purge(&sk->sk_receive_queue);
ccdfcc39
PM
897#ifdef CONFIG_NETLINK_MMAP
898 if (1) {
899 struct nl_mmap_req req;
900
901 memset(&req, 0, sizeof(req));
902 if (nlk->rx_ring.pg_vec)
903 netlink_set_ring(sk, &req, true, false);
904 memset(&req, 0, sizeof(req));
905 if (nlk->tx_ring.pg_vec)
906 netlink_set_ring(sk, &req, true, true);
907 }
908#endif /* CONFIG_NETLINK_MMAP */
1da177e4
LT
909
910 if (!sock_flag(sk, SOCK_DEAD)) {
6ac552fd 911 printk(KERN_ERR "Freeing alive netlink socket %p\n", sk);
1da177e4
LT
912 return;
913 }
547b792c
IJ
914
915 WARN_ON(atomic_read(&sk->sk_rmem_alloc));
916 WARN_ON(atomic_read(&sk->sk_wmem_alloc));
917 WARN_ON(nlk_sk(sk)->groups);
1da177e4
LT
918}
919
6ac552fd
PM
920/* This lock without WQ_FLAG_EXCLUSIVE is good on UP and it is _very_ bad on
921 * SMP. Look, when several writers sleep and reader wakes them up, all but one
1da177e4
LT
922 * immediately hit write lock and grab all the cpus. Exclusive sleep solves
923 * this, _but_ remember, it adds useless work on UP machines.
924 */
925
d136f1bd 926void netlink_table_grab(void)
9a429c49 927 __acquires(nl_table_lock)
1da177e4 928{
d136f1bd
JB
929 might_sleep();
930
6abd219c 931 write_lock_irq(&nl_table_lock);
1da177e4
LT
932
933 if (atomic_read(&nl_table_users)) {
934 DECLARE_WAITQUEUE(wait, current);
935
936 add_wait_queue_exclusive(&nl_table_wait, &wait);
6ac552fd 937 for (;;) {
1da177e4
LT
938 set_current_state(TASK_UNINTERRUPTIBLE);
939 if (atomic_read(&nl_table_users) == 0)
940 break;
6abd219c 941 write_unlock_irq(&nl_table_lock);
1da177e4 942 schedule();
6abd219c 943 write_lock_irq(&nl_table_lock);
1da177e4
LT
944 }
945
946 __set_current_state(TASK_RUNNING);
947 remove_wait_queue(&nl_table_wait, &wait);
948 }
949}
950
d136f1bd 951void netlink_table_ungrab(void)
9a429c49 952 __releases(nl_table_lock)
1da177e4 953{
6abd219c 954 write_unlock_irq(&nl_table_lock);
1da177e4
LT
955 wake_up(&nl_table_wait);
956}
957
6ac552fd 958static inline void
1da177e4
LT
959netlink_lock_table(void)
960{
961 /* read_lock() synchronizes us to netlink_table_grab */
962
963 read_lock(&nl_table_lock);
964 atomic_inc(&nl_table_users);
965 read_unlock(&nl_table_lock);
966}
967
6ac552fd 968static inline void
1da177e4
LT
969netlink_unlock_table(void)
970{
971 if (atomic_dec_and_test(&nl_table_users))
972 wake_up(&nl_table_wait);
973}
974
e341694e 975struct netlink_compare_arg
1da177e4 976{
c428ecd1 977 possible_net_t pnet;
e341694e
TG
978 u32 portid;
979};
1da177e4 980
8f2ddaac
HX
981/* Doing sizeof directly may yield 4 extra bytes on 64-bit. */
982#define netlink_compare_arg_len \
983 (offsetof(struct netlink_compare_arg, portid) + sizeof(u32))
c428ecd1
HX
984
985static inline int netlink_compare(struct rhashtable_compare_arg *arg,
986 const void *ptr)
1da177e4 987{
c428ecd1
HX
988 const struct netlink_compare_arg *x = arg->key;
989 const struct netlink_sock *nlk = ptr;
1da177e4 990
c428ecd1
HX
991 return nlk->portid != x->portid ||
992 !net_eq(sock_net(&nlk->sk), read_pnet(&x->pnet));
993}
994
995static void netlink_compare_arg_init(struct netlink_compare_arg *arg,
996 struct net *net, u32 portid)
997{
998 memset(arg, 0, sizeof(*arg));
999 write_pnet(&arg->pnet, net);
1000 arg->portid = portid;
1da177e4
LT
1001}
1002
e341694e
TG
1003static struct sock *__netlink_lookup(struct netlink_table *table, u32 portid,
1004 struct net *net)
1da177e4 1005{
c428ecd1 1006 struct netlink_compare_arg arg;
1da177e4 1007
c428ecd1
HX
1008 netlink_compare_arg_init(&arg, net, portid);
1009 return rhashtable_lookup_fast(&table->hash, &arg,
1010 netlink_rhashtable_params);
1da177e4
LT
1011}
1012
c428ecd1 1013static int __netlink_insert(struct netlink_table *table, struct sock *sk)
c5adde94 1014{
c428ecd1 1015 struct netlink_compare_arg arg;
c5adde94 1016
c428ecd1
HX
1017 netlink_compare_arg_init(&arg, sock_net(sk), nlk_sk(sk)->portid);
1018 return rhashtable_lookup_insert_key(&table->hash, &arg,
1019 &nlk_sk(sk)->node,
1020 netlink_rhashtable_params);
c5adde94
YX
1021}
1022
e341694e 1023static struct sock *netlink_lookup(struct net *net, int protocol, u32 portid)
1da177e4 1024{
e341694e
TG
1025 struct netlink_table *table = &nl_table[protocol];
1026 struct sock *sk;
1da177e4 1027
e341694e
TG
1028 rcu_read_lock();
1029 sk = __netlink_lookup(table, portid, net);
1030 if (sk)
1031 sock_hold(sk);
1032 rcu_read_unlock();
1da177e4 1033
e341694e 1034 return sk;
1da177e4
LT
1035}
1036
90ddc4f0 1037static const struct proto_ops netlink_ops;
1da177e4 1038
4277a083
PM
1039static void
1040netlink_update_listeners(struct sock *sk)
1041{
1042 struct netlink_table *tbl = &nl_table[sk->sk_protocol];
4277a083
PM
1043 unsigned long mask;
1044 unsigned int i;
6d772ac5
ED
1045 struct listeners *listeners;
1046
1047 listeners = nl_deref_protected(tbl->listeners);
1048 if (!listeners)
1049 return;
4277a083 1050
b4ff4f04 1051 for (i = 0; i < NLGRPLONGS(tbl->groups); i++) {
4277a083 1052 mask = 0;
b67bfe0d 1053 sk_for_each_bound(sk, &tbl->mc_list) {
b4ff4f04
JB
1054 if (i < NLGRPLONGS(nlk_sk(sk)->ngroups))
1055 mask |= nlk_sk(sk)->groups[i];
1056 }
6d772ac5 1057 listeners->masks[i] = mask;
4277a083
PM
1058 }
1059 /* this function is only called with the netlink table "grabbed", which
1060 * makes sure updates are visible before bind or setsockopt return. */
1061}
1062
8ea65f4a 1063static int netlink_insert(struct sock *sk, u32 portid)
1da177e4 1064{
da12c90e 1065 struct netlink_table *table = &nl_table[sk->sk_protocol];
919d9db9 1066 int err;
1da177e4 1067
c5adde94 1068 lock_sock(sk);
1da177e4
LT
1069
1070 err = -EBUSY;
15e47304 1071 if (nlk_sk(sk)->portid)
1da177e4
LT
1072 goto err;
1073
1074 err = -ENOMEM;
97defe1e
TG
1075 if (BITS_PER_LONG > 32 &&
1076 unlikely(atomic_read(&table->hash.nelems) >= UINT_MAX))
1da177e4
LT
1077 goto err;
1078
15e47304 1079 nlk_sk(sk)->portid = portid;
e341694e 1080 sock_hold(sk);
919d9db9 1081
c428ecd1
HX
1082 err = __netlink_insert(table, sk);
1083 if (err) {
1084 if (err == -EEXIST)
1085 err = -EADDRINUSE;
c0bb07df 1086 nlk_sk(sk)->portid = 0;
c5adde94 1087 sock_put(sk);
919d9db9
HX
1088 }
1089
1da177e4 1090err:
c5adde94 1091 release_sock(sk);
1da177e4
LT
1092 return err;
1093}
1094
1095static void netlink_remove(struct sock *sk)
1096{
e341694e
TG
1097 struct netlink_table *table;
1098
e341694e 1099 table = &nl_table[sk->sk_protocol];
c428ecd1
HX
1100 if (!rhashtable_remove_fast(&table->hash, &nlk_sk(sk)->node,
1101 netlink_rhashtable_params)) {
e341694e
TG
1102 WARN_ON(atomic_read(&sk->sk_refcnt) == 1);
1103 __sock_put(sk);
1104 }
e341694e 1105
1da177e4 1106 netlink_table_grab();
b10dcb3b 1107 if (nlk_sk(sk)->subscriptions) {
1da177e4 1108 __sk_del_bind_node(sk);
b10dcb3b
JB
1109 netlink_update_listeners(sk);
1110 }
ee1c2442
JB
1111 if (sk->sk_protocol == NETLINK_GENERIC)
1112 atomic_inc(&genl_sk_destructing_cnt);
1da177e4
LT
1113 netlink_table_ungrab();
1114}
1115
1116static struct proto netlink_proto = {
1117 .name = "NETLINK",
1118 .owner = THIS_MODULE,
1119 .obj_size = sizeof(struct netlink_sock),
1120};
1121
1b8d7ae4 1122static int __netlink_create(struct net *net, struct socket *sock,
11aa9c28
EB
1123 struct mutex *cb_mutex, int protocol,
1124 int kern)
1da177e4
LT
1125{
1126 struct sock *sk;
1127 struct netlink_sock *nlk;
ab33a171
PM
1128
1129 sock->ops = &netlink_ops;
1130
11aa9c28 1131 sk = sk_alloc(net, PF_NETLINK, GFP_KERNEL, &netlink_proto, kern);
ab33a171
PM
1132 if (!sk)
1133 return -ENOMEM;
1134
1135 sock_init_data(sock, sk);
1136
1137 nlk = nlk_sk(sk);
658cb354 1138 if (cb_mutex) {
ffa4d721 1139 nlk->cb_mutex = cb_mutex;
658cb354 1140 } else {
ffa4d721
PM
1141 nlk->cb_mutex = &nlk->cb_def_mutex;
1142 mutex_init(nlk->cb_mutex);
1143 }
ab33a171 1144 init_waitqueue_head(&nlk->wait);
ccdfcc39
PM
1145#ifdef CONFIG_NETLINK_MMAP
1146 mutex_init(&nlk->pg_vec_lock);
1147#endif
ab33a171
PM
1148
1149 sk->sk_destruct = netlink_sock_destruct;
1150 sk->sk_protocol = protocol;
1151 return 0;
1152}
1153
3f378b68
EP
1154static int netlink_create(struct net *net, struct socket *sock, int protocol,
1155 int kern)
ab33a171
PM
1156{
1157 struct module *module = NULL;
af65bdfc 1158 struct mutex *cb_mutex;
f7fa9b10 1159 struct netlink_sock *nlk;
023e2cfa
JB
1160 int (*bind)(struct net *net, int group);
1161 void (*unbind)(struct net *net, int group);
ab33a171 1162 int err = 0;
1da177e4
LT
1163
1164 sock->state = SS_UNCONNECTED;
1165
1166 if (sock->type != SOCK_RAW && sock->type != SOCK_DGRAM)
1167 return -ESOCKTNOSUPPORT;
1168
6ac552fd 1169 if (protocol < 0 || protocol >= MAX_LINKS)
1da177e4
LT
1170 return -EPROTONOSUPPORT;
1171
77247bbb 1172 netlink_lock_table();
95a5afca 1173#ifdef CONFIG_MODULES
ab33a171 1174 if (!nl_table[protocol].registered) {
77247bbb 1175 netlink_unlock_table();
4fdb3bb7 1176 request_module("net-pf-%d-proto-%d", PF_NETLINK, protocol);
77247bbb 1177 netlink_lock_table();
4fdb3bb7 1178 }
ab33a171
PM
1179#endif
1180 if (nl_table[protocol].registered &&
1181 try_module_get(nl_table[protocol].module))
1182 module = nl_table[protocol].module;
974c37e9
AD
1183 else
1184 err = -EPROTONOSUPPORT;
af65bdfc 1185 cb_mutex = nl_table[protocol].cb_mutex;
03292745 1186 bind = nl_table[protocol].bind;
4f520900 1187 unbind = nl_table[protocol].unbind;
77247bbb 1188 netlink_unlock_table();
4fdb3bb7 1189
974c37e9
AD
1190 if (err < 0)
1191 goto out;
1192
11aa9c28 1193 err = __netlink_create(net, sock, cb_mutex, protocol, kern);
6ac552fd 1194 if (err < 0)
f7fa9b10
PM
1195 goto out_module;
1196
6f756a8c 1197 local_bh_disable();
c1fd3b94 1198 sock_prot_inuse_add(net, &netlink_proto, 1);
6f756a8c
DM
1199 local_bh_enable();
1200
f7fa9b10 1201 nlk = nlk_sk(sock->sk);
f7fa9b10 1202 nlk->module = module;
03292745 1203 nlk->netlink_bind = bind;
4f520900 1204 nlk->netlink_unbind = unbind;
ab33a171
PM
1205out:
1206 return err;
1da177e4 1207
ab33a171
PM
1208out_module:
1209 module_put(module);
1210 goto out;
1da177e4
LT
1211}
1212
21e4902a
TG
1213static void deferred_put_nlk_sk(struct rcu_head *head)
1214{
1215 struct netlink_sock *nlk = container_of(head, struct netlink_sock, rcu);
1216
1217 sock_put(&nlk->sk);
1218}
1219
1da177e4
LT
1220static int netlink_release(struct socket *sock)
1221{
1222 struct sock *sk = sock->sk;
1223 struct netlink_sock *nlk;
1224
1225 if (!sk)
1226 return 0;
1227
1228 netlink_remove(sk);
ac57b3a9 1229 sock_orphan(sk);
1da177e4
LT
1230 nlk = nlk_sk(sk);
1231
3f660d66
HX
1232 /*
1233 * OK. Socket is unlinked, any packets that arrive now
1234 * will be purged.
1235 */
1da177e4 1236
ee1c2442
JB
1237 /* must not acquire netlink_table_lock in any way again before unbind
1238 * and notifying genetlink is done as otherwise it might deadlock
1239 */
1240 if (nlk->netlink_unbind) {
1241 int i;
1242
1243 for (i = 0; i < nlk->ngroups; i++)
1244 if (test_bit(i, nlk->groups))
1245 nlk->netlink_unbind(sock_net(sk), i + 1);
1246 }
1247 if (sk->sk_protocol == NETLINK_GENERIC &&
1248 atomic_dec_return(&genl_sk_destructing_cnt) == 0)
1249 wake_up(&genl_sk_destructing_waitq);
1250
1da177e4
LT
1251 sock->sk = NULL;
1252 wake_up_interruptible_all(&nlk->wait);
1253
1254 skb_queue_purge(&sk->sk_write_queue);
1255
15e47304 1256 if (nlk->portid) {
1da177e4 1257 struct netlink_notify n = {
3b1e0a65 1258 .net = sock_net(sk),
1da177e4 1259 .protocol = sk->sk_protocol,
15e47304 1260 .portid = nlk->portid,
1da177e4 1261 };
e041c683
AS
1262 atomic_notifier_call_chain(&netlink_chain,
1263 NETLINK_URELEASE, &n);
746fac4d 1264 }
4fdb3bb7 1265
5e7c001c 1266 module_put(nlk->module);
4fdb3bb7 1267
aed81560 1268 if (netlink_is_kernel(sk)) {
b10dcb3b 1269 netlink_table_grab();
869e58f8
DL
1270 BUG_ON(nl_table[sk->sk_protocol].registered == 0);
1271 if (--nl_table[sk->sk_protocol].registered == 0) {
6d772ac5
ED
1272 struct listeners *old;
1273
1274 old = nl_deref_protected(nl_table[sk->sk_protocol].listeners);
1275 RCU_INIT_POINTER(nl_table[sk->sk_protocol].listeners, NULL);
1276 kfree_rcu(old, rcu);
869e58f8 1277 nl_table[sk->sk_protocol].module = NULL;
9785e10a 1278 nl_table[sk->sk_protocol].bind = NULL;
4f520900 1279 nl_table[sk->sk_protocol].unbind = NULL;
9785e10a 1280 nl_table[sk->sk_protocol].flags = 0;
869e58f8
DL
1281 nl_table[sk->sk_protocol].registered = 0;
1282 }
b10dcb3b 1283 netlink_table_ungrab();
658cb354 1284 }
77247bbb 1285
f7fa9b10
PM
1286 kfree(nlk->groups);
1287 nlk->groups = NULL;
1288
3755810c 1289 local_bh_disable();
c1fd3b94 1290 sock_prot_inuse_add(sock_net(sk), &netlink_proto, -1);
3755810c 1291 local_bh_enable();
21e4902a 1292 call_rcu(&nlk->rcu, deferred_put_nlk_sk);
1da177e4
LT
1293 return 0;
1294}
1295
1296static int netlink_autobind(struct socket *sock)
1297{
1298 struct sock *sk = sock->sk;
3b1e0a65 1299 struct net *net = sock_net(sk);
da12c90e 1300 struct netlink_table *table = &nl_table[sk->sk_protocol];
15e47304 1301 s32 portid = task_tgid_vnr(current);
1da177e4 1302 int err;
b9fbe709
HX
1303 s32 rover = -4096;
1304 bool ok;
1da177e4
LT
1305
1306retry:
1307 cond_resched();
e341694e 1308 rcu_read_lock();
b9fbe709
HX
1309 ok = !__netlink_lookup(table, portid, net);
1310 rcu_read_unlock();
1311 if (!ok) {
e341694e 1312 /* Bind collision, search negative portid values. */
b9fbe709
HX
1313 if (rover == -4096)
1314 /* rover will be in range [S32_MIN, -4097] */
1315 rover = S32_MIN + prandom_u32_max(-4096 - S32_MIN);
1316 else if (rover >= -4096)
e341694e 1317 rover = -4097;
b9fbe709 1318 portid = rover--;
e341694e 1319 goto retry;
1da177e4 1320 }
1da177e4 1321
8ea65f4a 1322 err = netlink_insert(sk, portid);
1da177e4
LT
1323 if (err == -EADDRINUSE)
1324 goto retry;
d470e3b4
DM
1325
1326 /* If 2 threads race to autobind, that is fine. */
1327 if (err == -EBUSY)
1328 err = 0;
1329
1330 return err;
1da177e4
LT
1331}
1332
aa4cf945
EB
1333/**
1334 * __netlink_ns_capable - General netlink message capability test
1335 * @nsp: NETLINK_CB of the socket buffer holding a netlink command from userspace.
1336 * @user_ns: The user namespace of the capability to use
1337 * @cap: The capability to use
1338 *
1339 * Test to see if the opener of the socket we received the message
1340 * from had when the netlink socket was created and the sender of the
1341 * message has has the capability @cap in the user namespace @user_ns.
1342 */
1343bool __netlink_ns_capable(const struct netlink_skb_parms *nsp,
1344 struct user_namespace *user_ns, int cap)
1345{
2d7a85f4
EB
1346 return ((nsp->flags & NETLINK_SKB_DST) ||
1347 file_ns_capable(nsp->sk->sk_socket->file, user_ns, cap)) &&
1348 ns_capable(user_ns, cap);
aa4cf945
EB
1349}
1350EXPORT_SYMBOL(__netlink_ns_capable);
1351
1352/**
1353 * netlink_ns_capable - General netlink message capability test
1354 * @skb: socket buffer holding a netlink command from userspace
1355 * @user_ns: The user namespace of the capability to use
1356 * @cap: The capability to use
1357 *
1358 * Test to see if the opener of the socket we received the message
1359 * from had when the netlink socket was created and the sender of the
1360 * message has has the capability @cap in the user namespace @user_ns.
1361 */
1362bool netlink_ns_capable(const struct sk_buff *skb,
1363 struct user_namespace *user_ns, int cap)
1364{
1365 return __netlink_ns_capable(&NETLINK_CB(skb), user_ns, cap);
1366}
1367EXPORT_SYMBOL(netlink_ns_capable);
1368
1369/**
1370 * netlink_capable - Netlink global message capability test
1371 * @skb: socket buffer holding a netlink command from userspace
1372 * @cap: The capability to use
1373 *
1374 * Test to see if the opener of the socket we received the message
1375 * from had when the netlink socket was created and the sender of the
1376 * message has has the capability @cap in all user namespaces.
1377 */
1378bool netlink_capable(const struct sk_buff *skb, int cap)
1379{
1380 return netlink_ns_capable(skb, &init_user_ns, cap);
1381}
1382EXPORT_SYMBOL(netlink_capable);
1383
1384/**
1385 * netlink_net_capable - Netlink network namespace message capability test
1386 * @skb: socket buffer holding a netlink command from userspace
1387 * @cap: The capability to use
1388 *
1389 * Test to see if the opener of the socket we received the message
1390 * from had when the netlink socket was created and the sender of the
1391 * message has has the capability @cap over the network namespace of
1392 * the socket we received the message from.
1393 */
1394bool netlink_net_capable(const struct sk_buff *skb, int cap)
1395{
1396 return netlink_ns_capable(skb, sock_net(skb->sk)->user_ns, cap);
1397}
1398EXPORT_SYMBOL(netlink_net_capable);
1399
5187cd05 1400static inline int netlink_allowed(const struct socket *sock, unsigned int flag)
746fac4d 1401{
9785e10a 1402 return (nl_table[sock->sk->sk_protocol].flags & flag) ||
df008c91 1403 ns_capable(sock_net(sock->sk)->user_ns, CAP_NET_ADMIN);
746fac4d 1404}
1da177e4 1405
f7fa9b10
PM
1406static void
1407netlink_update_subscriptions(struct sock *sk, unsigned int subscriptions)
1408{
1409 struct netlink_sock *nlk = nlk_sk(sk);
1410
1411 if (nlk->subscriptions && !subscriptions)
1412 __sk_del_bind_node(sk);
1413 else if (!nlk->subscriptions && subscriptions)
1414 sk_add_bind_node(sk, &nl_table[sk->sk_protocol].mc_list);
1415 nlk->subscriptions = subscriptions;
1416}
1417
b4ff4f04 1418static int netlink_realloc_groups(struct sock *sk)
513c2500
PM
1419{
1420 struct netlink_sock *nlk = nlk_sk(sk);
1421 unsigned int groups;
b4ff4f04 1422 unsigned long *new_groups;
513c2500
PM
1423 int err = 0;
1424
b4ff4f04
JB
1425 netlink_table_grab();
1426
513c2500 1427 groups = nl_table[sk->sk_protocol].groups;
b4ff4f04 1428 if (!nl_table[sk->sk_protocol].registered) {
513c2500 1429 err = -ENOENT;
b4ff4f04
JB
1430 goto out_unlock;
1431 }
513c2500 1432
b4ff4f04
JB
1433 if (nlk->ngroups >= groups)
1434 goto out_unlock;
513c2500 1435
b4ff4f04
JB
1436 new_groups = krealloc(nlk->groups, NLGRPSZ(groups), GFP_ATOMIC);
1437 if (new_groups == NULL) {
1438 err = -ENOMEM;
1439 goto out_unlock;
1440 }
6ac552fd 1441 memset((char *)new_groups + NLGRPSZ(nlk->ngroups), 0,
b4ff4f04
JB
1442 NLGRPSZ(groups) - NLGRPSZ(nlk->ngroups));
1443
1444 nlk->groups = new_groups;
513c2500 1445 nlk->ngroups = groups;
b4ff4f04
JB
1446 out_unlock:
1447 netlink_table_ungrab();
1448 return err;
513c2500
PM
1449}
1450
02c81ab9 1451static void netlink_undo_bind(int group, long unsigned int groups,
023e2cfa 1452 struct sock *sk)
4f520900 1453{
023e2cfa 1454 struct netlink_sock *nlk = nlk_sk(sk);
4f520900
RGB
1455 int undo;
1456
1457 if (!nlk->netlink_unbind)
1458 return;
1459
1460 for (undo = 0; undo < group; undo++)
6251edd9 1461 if (test_bit(undo, &groups))
8b7c36d8 1462 nlk->netlink_unbind(sock_net(sk), undo + 1);
4f520900
RGB
1463}
1464
6ac552fd
PM
1465static int netlink_bind(struct socket *sock, struct sockaddr *addr,
1466 int addr_len)
1da177e4
LT
1467{
1468 struct sock *sk = sock->sk;
3b1e0a65 1469 struct net *net = sock_net(sk);
1da177e4
LT
1470 struct netlink_sock *nlk = nlk_sk(sk);
1471 struct sockaddr_nl *nladdr = (struct sockaddr_nl *)addr;
1472 int err;
4f520900 1473 long unsigned int groups = nladdr->nl_groups;
746fac4d 1474
4e4b5376
HFS
1475 if (addr_len < sizeof(struct sockaddr_nl))
1476 return -EINVAL;
1477
1da177e4
LT
1478 if (nladdr->nl_family != AF_NETLINK)
1479 return -EINVAL;
1480
1481 /* Only superuser is allowed to listen multicasts */
4f520900 1482 if (groups) {
5187cd05 1483 if (!netlink_allowed(sock, NL_CFG_F_NONROOT_RECV))
513c2500 1484 return -EPERM;
b4ff4f04
JB
1485 err = netlink_realloc_groups(sk);
1486 if (err)
1487 return err;
513c2500 1488 }
1da177e4 1489
4f520900 1490 if (nlk->portid)
15e47304 1491 if (nladdr->nl_pid != nlk->portid)
1da177e4 1492 return -EINVAL;
4f520900
RGB
1493
1494 if (nlk->netlink_bind && groups) {
1495 int group;
1496
1497 for (group = 0; group < nlk->ngroups; group++) {
1498 if (!test_bit(group, &groups))
1499 continue;
8b7c36d8 1500 err = nlk->netlink_bind(net, group + 1);
4f520900
RGB
1501 if (!err)
1502 continue;
023e2cfa 1503 netlink_undo_bind(group, groups, sk);
4f520900
RGB
1504 return err;
1505 }
1506 }
1507
1508 if (!nlk->portid) {
1da177e4 1509 err = nladdr->nl_pid ?
8ea65f4a 1510 netlink_insert(sk, nladdr->nl_pid) :
1da177e4 1511 netlink_autobind(sock);
4f520900 1512 if (err) {
023e2cfa 1513 netlink_undo_bind(nlk->ngroups, groups, sk);
1da177e4 1514 return err;
4f520900 1515 }
1da177e4
LT
1516 }
1517
4f520900 1518 if (!groups && (nlk->groups == NULL || !(u32)nlk->groups[0]))
1da177e4
LT
1519 return 0;
1520
1521 netlink_table_grab();
f7fa9b10 1522 netlink_update_subscriptions(sk, nlk->subscriptions +
4f520900 1523 hweight32(groups) -
746fac4d 1524 hweight32(nlk->groups[0]));
4f520900 1525 nlk->groups[0] = (nlk->groups[0] & ~0xffffffffUL) | groups;
4277a083 1526 netlink_update_listeners(sk);
1da177e4
LT
1527 netlink_table_ungrab();
1528
1529 return 0;
1530}
1531
1532static int netlink_connect(struct socket *sock, struct sockaddr *addr,
1533 int alen, int flags)
1534{
1535 int err = 0;
1536 struct sock *sk = sock->sk;
1537 struct netlink_sock *nlk = nlk_sk(sk);
6ac552fd 1538 struct sockaddr_nl *nladdr = (struct sockaddr_nl *)addr;
1da177e4 1539
6503d961
CG
1540 if (alen < sizeof(addr->sa_family))
1541 return -EINVAL;
1542
1da177e4
LT
1543 if (addr->sa_family == AF_UNSPEC) {
1544 sk->sk_state = NETLINK_UNCONNECTED;
15e47304 1545 nlk->dst_portid = 0;
d629b836 1546 nlk->dst_group = 0;
1da177e4
LT
1547 return 0;
1548 }
1549 if (addr->sa_family != AF_NETLINK)
1550 return -EINVAL;
1551
46833a86 1552 if ((nladdr->nl_groups || nladdr->nl_pid) &&
5187cd05 1553 !netlink_allowed(sock, NL_CFG_F_NONROOT_SEND))
1da177e4
LT
1554 return -EPERM;
1555
15e47304 1556 if (!nlk->portid)
1da177e4
LT
1557 err = netlink_autobind(sock);
1558
1559 if (err == 0) {
1560 sk->sk_state = NETLINK_CONNECTED;
15e47304 1561 nlk->dst_portid = nladdr->nl_pid;
d629b836 1562 nlk->dst_group = ffs(nladdr->nl_groups);
1da177e4
LT
1563 }
1564
1565 return err;
1566}
1567
6ac552fd
PM
1568static int netlink_getname(struct socket *sock, struct sockaddr *addr,
1569 int *addr_len, int peer)
1da177e4
LT
1570{
1571 struct sock *sk = sock->sk;
1572 struct netlink_sock *nlk = nlk_sk(sk);
13cfa97b 1573 DECLARE_SOCKADDR(struct sockaddr_nl *, nladdr, addr);
746fac4d 1574
1da177e4
LT
1575 nladdr->nl_family = AF_NETLINK;
1576 nladdr->nl_pad = 0;
1577 *addr_len = sizeof(*nladdr);
1578
1579 if (peer) {
15e47304 1580 nladdr->nl_pid = nlk->dst_portid;
d629b836 1581 nladdr->nl_groups = netlink_group_mask(nlk->dst_group);
1da177e4 1582 } else {
15e47304 1583 nladdr->nl_pid = nlk->portid;
513c2500 1584 nladdr->nl_groups = nlk->groups ? nlk->groups[0] : 0;
1da177e4
LT
1585 }
1586 return 0;
1587}
1588
15e47304 1589static struct sock *netlink_getsockbyportid(struct sock *ssk, u32 portid)
1da177e4 1590{
1da177e4
LT
1591 struct sock *sock;
1592 struct netlink_sock *nlk;
1593
15e47304 1594 sock = netlink_lookup(sock_net(ssk), ssk->sk_protocol, portid);
1da177e4
LT
1595 if (!sock)
1596 return ERR_PTR(-ECONNREFUSED);
1597
1598 /* Don't bother queuing skb if kernel socket has no input function */
1599 nlk = nlk_sk(sock);
cd40b7d3 1600 if (sock->sk_state == NETLINK_CONNECTED &&
15e47304 1601 nlk->dst_portid != nlk_sk(ssk)->portid) {
1da177e4
LT
1602 sock_put(sock);
1603 return ERR_PTR(-ECONNREFUSED);
1604 }
1605 return sock;
1606}
1607
1608struct sock *netlink_getsockbyfilp(struct file *filp)
1609{
496ad9aa 1610 struct inode *inode = file_inode(filp);
1da177e4
LT
1611 struct sock *sock;
1612
1613 if (!S_ISSOCK(inode->i_mode))
1614 return ERR_PTR(-ENOTSOCK);
1615
1616 sock = SOCKET_I(inode)->sk;
1617 if (sock->sk_family != AF_NETLINK)
1618 return ERR_PTR(-EINVAL);
1619
1620 sock_hold(sock);
1621 return sock;
1622}
1623
3a36515f
PN
1624static struct sk_buff *netlink_alloc_large_skb(unsigned int size,
1625 int broadcast)
c05cdb1b
PNA
1626{
1627 struct sk_buff *skb;
1628 void *data;
1629
3a36515f 1630 if (size <= NLMSG_GOODSIZE || broadcast)
c05cdb1b
PNA
1631 return alloc_skb(size, GFP_KERNEL);
1632
3a36515f
PN
1633 size = SKB_DATA_ALIGN(size) +
1634 SKB_DATA_ALIGN(sizeof(struct skb_shared_info));
c05cdb1b
PNA
1635
1636 data = vmalloc(size);
1637 if (data == NULL)
3a36515f 1638 return NULL;
c05cdb1b 1639
2ea2f62c 1640 skb = __build_skb(data, size);
3a36515f
PN
1641 if (skb == NULL)
1642 vfree(data);
2ea2f62c 1643 else
3a36515f 1644 skb->destructor = netlink_skb_destructor;
c05cdb1b
PNA
1645
1646 return skb;
c05cdb1b
PNA
1647}
1648
1da177e4
LT
1649/*
1650 * Attach a skb to a netlink socket.
1651 * The caller must hold a reference to the destination socket. On error, the
1652 * reference is dropped. The skb is not send to the destination, just all
1653 * all error checks are performed and memory in the queue is reserved.
1654 * Return values:
1655 * < 0: error. skb freed, reference to sock dropped.
1656 * 0: continue
1657 * 1: repeat lookup - reference dropped while waiting for socket memory.
1658 */
9457afee 1659int netlink_attachskb(struct sock *sk, struct sk_buff *skb,
c3d8d1e3 1660 long *timeo, struct sock *ssk)
1da177e4
LT
1661{
1662 struct netlink_sock *nlk;
1663
1664 nlk = nlk_sk(sk);
1665
5fd96123 1666 if ((atomic_read(&sk->sk_rmem_alloc) > sk->sk_rcvbuf ||
cc3a572f 1667 test_bit(NETLINK_S_CONGESTED, &nlk->state)) &&
5fd96123 1668 !netlink_skb_is_mmaped(skb)) {
1da177e4 1669 DECLARE_WAITQUEUE(wait, current);
c3d8d1e3 1670 if (!*timeo) {
aed81560 1671 if (!ssk || netlink_is_kernel(ssk))
1da177e4
LT
1672 netlink_overrun(sk);
1673 sock_put(sk);
1674 kfree_skb(skb);
1675 return -EAGAIN;
1676 }
1677
1678 __set_current_state(TASK_INTERRUPTIBLE);
1679 add_wait_queue(&nlk->wait, &wait);
1680
1681 if ((atomic_read(&sk->sk_rmem_alloc) > sk->sk_rcvbuf ||
cc3a572f 1682 test_bit(NETLINK_S_CONGESTED, &nlk->state)) &&
1da177e4 1683 !sock_flag(sk, SOCK_DEAD))
c3d8d1e3 1684 *timeo = schedule_timeout(*timeo);
1da177e4
LT
1685
1686 __set_current_state(TASK_RUNNING);
1687 remove_wait_queue(&nlk->wait, &wait);
1688 sock_put(sk);
1689
1690 if (signal_pending(current)) {
1691 kfree_skb(skb);
c3d8d1e3 1692 return sock_intr_errno(*timeo);
1da177e4
LT
1693 }
1694 return 1;
1695 }
cf0a018a 1696 netlink_skb_set_owner_r(skb, sk);
1da177e4
LT
1697 return 0;
1698}
1699
4a7e7c2a 1700static int __netlink_sendskb(struct sock *sk, struct sk_buff *skb)
1da177e4 1701{
1da177e4
LT
1702 int len = skb->len;
1703
bcbde0d4
DB
1704 netlink_deliver_tap(skb);
1705
f9c22888
PM
1706#ifdef CONFIG_NETLINK_MMAP
1707 if (netlink_skb_is_mmaped(skb))
1708 netlink_queue_mmaped_skb(sk, skb);
1709 else if (netlink_rx_is_mmaped(sk))
1710 netlink_ring_set_copied(sk, skb);
1711 else
1712#endif /* CONFIG_NETLINK_MMAP */
1713 skb_queue_tail(&sk->sk_receive_queue, skb);
676d2369 1714 sk->sk_data_ready(sk);
4a7e7c2a
ED
1715 return len;
1716}
1717
1718int netlink_sendskb(struct sock *sk, struct sk_buff *skb)
1719{
1720 int len = __netlink_sendskb(sk, skb);
1721
1da177e4
LT
1722 sock_put(sk);
1723 return len;
1724}
1725
1726void netlink_detachskb(struct sock *sk, struct sk_buff *skb)
1727{
1728 kfree_skb(skb);
1729 sock_put(sk);
1730}
1731
b57ef81f 1732static struct sk_buff *netlink_trim(struct sk_buff *skb, gfp_t allocation)
1da177e4
LT
1733{
1734 int delta;
1735
1298ca46 1736 WARN_ON(skb->sk != NULL);
5fd96123
PM
1737 if (netlink_skb_is_mmaped(skb))
1738 return skb;
1da177e4 1739
4305b541 1740 delta = skb->end - skb->tail;
c05cdb1b 1741 if (is_vmalloc_addr(skb->head) || delta * 2 < skb->truesize)
1da177e4
LT
1742 return skb;
1743
1744 if (skb_shared(skb)) {
1745 struct sk_buff *nskb = skb_clone(skb, allocation);
1746 if (!nskb)
1747 return skb;
8460c00f 1748 consume_skb(skb);
1da177e4
LT
1749 skb = nskb;
1750 }
1751
1752 if (!pskb_expand_head(skb, 0, -delta, allocation))
1753 skb->truesize -= delta;
1754
1755 return skb;
1756}
1757
3fbc2905
EB
1758static int netlink_unicast_kernel(struct sock *sk, struct sk_buff *skb,
1759 struct sock *ssk)
cd40b7d3
DL
1760{
1761 int ret;
1762 struct netlink_sock *nlk = nlk_sk(sk);
1763
1764 ret = -ECONNREFUSED;
1765 if (nlk->netlink_rcv != NULL) {
1766 ret = skb->len;
cf0a018a 1767 netlink_skb_set_owner_r(skb, sk);
e32123e5 1768 NETLINK_CB(skb).sk = ssk;
73bfd370 1769 netlink_deliver_tap_kernel(sk, ssk, skb);
cd40b7d3 1770 nlk->netlink_rcv(skb);
bfb253c9
ED
1771 consume_skb(skb);
1772 } else {
1773 kfree_skb(skb);
cd40b7d3 1774 }
cd40b7d3
DL
1775 sock_put(sk);
1776 return ret;
1777}
1778
1779int netlink_unicast(struct sock *ssk, struct sk_buff *skb,
15e47304 1780 u32 portid, int nonblock)
1da177e4
LT
1781{
1782 struct sock *sk;
1783 int err;
1784 long timeo;
1785
1786 skb = netlink_trim(skb, gfp_any());
1787
1788 timeo = sock_sndtimeo(ssk, nonblock);
1789retry:
15e47304 1790 sk = netlink_getsockbyportid(ssk, portid);
1da177e4
LT
1791 if (IS_ERR(sk)) {
1792 kfree_skb(skb);
1793 return PTR_ERR(sk);
1794 }
cd40b7d3 1795 if (netlink_is_kernel(sk))
3fbc2905 1796 return netlink_unicast_kernel(sk, skb, ssk);
cd40b7d3 1797
b1153f29 1798 if (sk_filter(sk, skb)) {
84874607 1799 err = skb->len;
b1153f29
SH
1800 kfree_skb(skb);
1801 sock_put(sk);
1802 return err;
1803 }
1804
9457afee 1805 err = netlink_attachskb(sk, skb, &timeo, ssk);
1da177e4
LT
1806 if (err == 1)
1807 goto retry;
1808 if (err)
1809 return err;
1810
7ee015e0 1811 return netlink_sendskb(sk, skb);
1da177e4 1812}
6ac552fd 1813EXPORT_SYMBOL(netlink_unicast);
1da177e4 1814
f9c22888
PM
1815struct sk_buff *netlink_alloc_skb(struct sock *ssk, unsigned int size,
1816 u32 dst_portid, gfp_t gfp_mask)
1817{
1818#ifdef CONFIG_NETLINK_MMAP
1819 struct sock *sk = NULL;
1820 struct sk_buff *skb;
1821 struct netlink_ring *ring;
1822 struct nl_mmap_hdr *hdr;
1823 unsigned int maxlen;
1824
1825 sk = netlink_getsockbyportid(ssk, dst_portid);
1826 if (IS_ERR(sk))
1827 goto out;
1828
1829 ring = &nlk_sk(sk)->rx_ring;
1830 /* fast-path without atomic ops for common case: non-mmaped receiver */
1831 if (ring->pg_vec == NULL)
1832 goto out_put;
1833
aae9f0e2
TG
1834 if (ring->frame_size - NL_MMAP_HDRLEN < size)
1835 goto out_put;
1836
f9c22888
PM
1837 skb = alloc_skb_head(gfp_mask);
1838 if (skb == NULL)
1839 goto err1;
1840
1841 spin_lock_bh(&sk->sk_receive_queue.lock);
1842 /* check again under lock */
1843 if (ring->pg_vec == NULL)
1844 goto out_free;
1845
aae9f0e2 1846 /* check again under lock */
f9c22888
PM
1847 maxlen = ring->frame_size - NL_MMAP_HDRLEN;
1848 if (maxlen < size)
1849 goto out_free;
1850
1851 netlink_forward_ring(ring);
1852 hdr = netlink_current_frame(ring, NL_MMAP_STATUS_UNUSED);
1853 if (hdr == NULL)
1854 goto err2;
1855 netlink_ring_setup_skb(skb, sk, ring, hdr);
1856 netlink_set_status(hdr, NL_MMAP_STATUS_RESERVED);
1857 atomic_inc(&ring->pending);
1858 netlink_increment_head(ring);
1859
1860 spin_unlock_bh(&sk->sk_receive_queue.lock);
1861 return skb;
1862
1863err2:
1864 kfree_skb(skb);
1865 spin_unlock_bh(&sk->sk_receive_queue.lock);
cd1df525 1866 netlink_overrun(sk);
f9c22888
PM
1867err1:
1868 sock_put(sk);
1869 return NULL;
1870
1871out_free:
1872 kfree_skb(skb);
1873 spin_unlock_bh(&sk->sk_receive_queue.lock);
1874out_put:
1875 sock_put(sk);
1876out:
1877#endif
1878 return alloc_skb(size, gfp_mask);
1879}
1880EXPORT_SYMBOL_GPL(netlink_alloc_skb);
1881
4277a083
PM
1882int netlink_has_listeners(struct sock *sk, unsigned int group)
1883{
1884 int res = 0;
5c398dc8 1885 struct listeners *listeners;
4277a083 1886
aed81560 1887 BUG_ON(!netlink_is_kernel(sk));
b4ff4f04
JB
1888
1889 rcu_read_lock();
1890 listeners = rcu_dereference(nl_table[sk->sk_protocol].listeners);
1891
6d772ac5 1892 if (listeners && group - 1 < nl_table[sk->sk_protocol].groups)
5c398dc8 1893 res = test_bit(group - 1, listeners->masks);
b4ff4f04
JB
1894
1895 rcu_read_unlock();
1896
4277a083
PM
1897 return res;
1898}
1899EXPORT_SYMBOL_GPL(netlink_has_listeners);
1900
b57ef81f 1901static int netlink_broadcast_deliver(struct sock *sk, struct sk_buff *skb)
1da177e4
LT
1902{
1903 struct netlink_sock *nlk = nlk_sk(sk);
1904
1905 if (atomic_read(&sk->sk_rmem_alloc) <= sk->sk_rcvbuf &&
cc3a572f 1906 !test_bit(NETLINK_S_CONGESTED, &nlk->state)) {
cf0a018a 1907 netlink_skb_set_owner_r(skb, sk);
4a7e7c2a 1908 __netlink_sendskb(sk, skb);
2c645800 1909 return atomic_read(&sk->sk_rmem_alloc) > (sk->sk_rcvbuf >> 1);
1da177e4
LT
1910 }
1911 return -1;
1912}
1913
1914struct netlink_broadcast_data {
1915 struct sock *exclude_sk;
b4b51029 1916 struct net *net;
15e47304 1917 u32 portid;
1da177e4
LT
1918 u32 group;
1919 int failure;
ff491a73 1920 int delivery_failure;
1da177e4
LT
1921 int congested;
1922 int delivered;
7d877f3b 1923 gfp_t allocation;
1da177e4 1924 struct sk_buff *skb, *skb2;
910a7e90
EB
1925 int (*tx_filter)(struct sock *dsk, struct sk_buff *skb, void *data);
1926 void *tx_data;
1da177e4
LT
1927};
1928
46c9521f
RR
1929static void do_one_broadcast(struct sock *sk,
1930 struct netlink_broadcast_data *p)
1da177e4
LT
1931{
1932 struct netlink_sock *nlk = nlk_sk(sk);
1933 int val;
1934
1935 if (p->exclude_sk == sk)
46c9521f 1936 return;
1da177e4 1937
15e47304 1938 if (nlk->portid == p->portid || p->group - 1 >= nlk->ngroups ||
f7fa9b10 1939 !test_bit(p->group - 1, nlk->groups))
46c9521f 1940 return;
1da177e4 1941
59324cf3
ND
1942 if (!net_eq(sock_net(sk), p->net)) {
1943 if (!(nlk->flags & NETLINK_F_LISTEN_ALL_NSID))
1944 return;
1945
1946 if (!peernet_has_id(sock_net(sk), p->net))
1947 return;
1948
1949 if (!file_ns_capable(sk->sk_socket->file, p->net->user_ns,
1950 CAP_NET_BROADCAST))
1951 return;
1952 }
b4b51029 1953
1da177e4
LT
1954 if (p->failure) {
1955 netlink_overrun(sk);
46c9521f 1956 return;
1da177e4
LT
1957 }
1958
1959 sock_hold(sk);
1960 if (p->skb2 == NULL) {
68acc024 1961 if (skb_shared(p->skb)) {
1da177e4
LT
1962 p->skb2 = skb_clone(p->skb, p->allocation);
1963 } else {
68acc024
TC
1964 p->skb2 = skb_get(p->skb);
1965 /*
1966 * skb ownership may have been set when
1967 * delivered to a previous socket.
1968 */
1969 skb_orphan(p->skb2);
1da177e4
LT
1970 }
1971 }
1972 if (p->skb2 == NULL) {
1973 netlink_overrun(sk);
1974 /* Clone failed. Notify ALL listeners. */
1975 p->failure = 1;
cc3a572f 1976 if (nlk->flags & NETLINK_F_BROADCAST_SEND_ERROR)
be0c22a4 1977 p->delivery_failure = 1;
59324cf3
ND
1978 goto out;
1979 }
1980 if (p->tx_filter && p->tx_filter(sk, p->skb2, p->tx_data)) {
910a7e90
EB
1981 kfree_skb(p->skb2);
1982 p->skb2 = NULL;
59324cf3
ND
1983 goto out;
1984 }
1985 if (sk_filter(sk, p->skb2)) {
b1153f29
SH
1986 kfree_skb(p->skb2);
1987 p->skb2 = NULL;
59324cf3
ND
1988 goto out;
1989 }
1990 NETLINK_CB(p->skb2).nsid = peernet2id(sock_net(sk), p->net);
1991 NETLINK_CB(p->skb2).nsid_is_set = true;
1992 val = netlink_broadcast_deliver(sk, p->skb2);
1993 if (val < 0) {
1da177e4 1994 netlink_overrun(sk);
cc3a572f 1995 if (nlk->flags & NETLINK_F_BROADCAST_SEND_ERROR)
be0c22a4 1996 p->delivery_failure = 1;
1da177e4
LT
1997 } else {
1998 p->congested |= val;
1999 p->delivered = 1;
2000 p->skb2 = NULL;
2001 }
59324cf3 2002out:
1da177e4 2003 sock_put(sk);
1da177e4
LT
2004}
2005
15e47304 2006int netlink_broadcast_filtered(struct sock *ssk, struct sk_buff *skb, u32 portid,
910a7e90
EB
2007 u32 group, gfp_t allocation,
2008 int (*filter)(struct sock *dsk, struct sk_buff *skb, void *data),
2009 void *filter_data)
1da177e4 2010{
3b1e0a65 2011 struct net *net = sock_net(ssk);
1da177e4 2012 struct netlink_broadcast_data info;
1da177e4
LT
2013 struct sock *sk;
2014
2015 skb = netlink_trim(skb, allocation);
2016
2017 info.exclude_sk = ssk;
b4b51029 2018 info.net = net;
15e47304 2019 info.portid = portid;
1da177e4
LT
2020 info.group = group;
2021 info.failure = 0;
ff491a73 2022 info.delivery_failure = 0;
1da177e4
LT
2023 info.congested = 0;
2024 info.delivered = 0;
2025 info.allocation = allocation;
2026 info.skb = skb;
2027 info.skb2 = NULL;
910a7e90
EB
2028 info.tx_filter = filter;
2029 info.tx_data = filter_data;
1da177e4
LT
2030
2031 /* While we sleep in clone, do not allow to change socket list */
2032
2033 netlink_lock_table();
2034
b67bfe0d 2035 sk_for_each_bound(sk, &nl_table[ssk->sk_protocol].mc_list)
1da177e4
LT
2036 do_one_broadcast(sk, &info);
2037
70d4bf6d 2038 consume_skb(skb);
aa1c6a6f 2039
1da177e4
LT
2040 netlink_unlock_table();
2041
70d4bf6d
NH
2042 if (info.delivery_failure) {
2043 kfree_skb(info.skb2);
ff491a73 2044 return -ENOBUFS;
658cb354
ED
2045 }
2046 consume_skb(info.skb2);
ff491a73 2047
1da177e4
LT
2048 if (info.delivered) {
2049 if (info.congested && (allocation & __GFP_WAIT))
2050 yield();
2051 return 0;
2052 }
1da177e4
LT
2053 return -ESRCH;
2054}
910a7e90
EB
2055EXPORT_SYMBOL(netlink_broadcast_filtered);
2056
15e47304 2057int netlink_broadcast(struct sock *ssk, struct sk_buff *skb, u32 portid,
910a7e90
EB
2058 u32 group, gfp_t allocation)
2059{
15e47304 2060 return netlink_broadcast_filtered(ssk, skb, portid, group, allocation,
910a7e90
EB
2061 NULL, NULL);
2062}
6ac552fd 2063EXPORT_SYMBOL(netlink_broadcast);
1da177e4
LT
2064
2065struct netlink_set_err_data {
2066 struct sock *exclude_sk;
15e47304 2067 u32 portid;
1da177e4
LT
2068 u32 group;
2069 int code;
2070};
2071
b57ef81f 2072static int do_one_set_err(struct sock *sk, struct netlink_set_err_data *p)
1da177e4
LT
2073{
2074 struct netlink_sock *nlk = nlk_sk(sk);
1a50307b 2075 int ret = 0;
1da177e4
LT
2076
2077 if (sk == p->exclude_sk)
2078 goto out;
2079
09ad9bc7 2080 if (!net_eq(sock_net(sk), sock_net(p->exclude_sk)))
b4b51029
EB
2081 goto out;
2082
15e47304 2083 if (nlk->portid == p->portid || p->group - 1 >= nlk->ngroups ||
f7fa9b10 2084 !test_bit(p->group - 1, nlk->groups))
1da177e4
LT
2085 goto out;
2086
cc3a572f 2087 if (p->code == ENOBUFS && nlk->flags & NETLINK_F_RECV_NO_ENOBUFS) {
1a50307b
PNA
2088 ret = 1;
2089 goto out;
2090 }
2091
1da177e4
LT
2092 sk->sk_err = p->code;
2093 sk->sk_error_report(sk);
2094out:
1a50307b 2095 return ret;
1da177e4
LT
2096}
2097
4843b93c
PNA
2098/**
2099 * netlink_set_err - report error to broadcast listeners
2100 * @ssk: the kernel netlink socket, as returned by netlink_kernel_create()
15e47304 2101 * @portid: the PORTID of a process that we want to skip (if any)
840e93f2 2102 * @group: the broadcast group that will notice the error
4843b93c 2103 * @code: error code, must be negative (as usual in kernelspace)
1a50307b
PNA
2104 *
2105 * This function returns the number of broadcast listeners that have set the
cc3a572f 2106 * NETLINK_NO_ENOBUFS socket option.
4843b93c 2107 */
15e47304 2108int netlink_set_err(struct sock *ssk, u32 portid, u32 group, int code)
1da177e4
LT
2109{
2110 struct netlink_set_err_data info;
1da177e4 2111 struct sock *sk;
1a50307b 2112 int ret = 0;
1da177e4
LT
2113
2114 info.exclude_sk = ssk;
15e47304 2115 info.portid = portid;
1da177e4 2116 info.group = group;
4843b93c
PNA
2117 /* sk->sk_err wants a positive error value */
2118 info.code = -code;
1da177e4
LT
2119
2120 read_lock(&nl_table_lock);
2121
b67bfe0d 2122 sk_for_each_bound(sk, &nl_table[ssk->sk_protocol].mc_list)
1a50307b 2123 ret += do_one_set_err(sk, &info);
1da177e4
LT
2124
2125 read_unlock(&nl_table_lock);
1a50307b 2126 return ret;
1da177e4 2127}
dd5b6ce6 2128EXPORT_SYMBOL(netlink_set_err);
1da177e4 2129
84659eb5
JB
2130/* must be called with netlink table grabbed */
2131static void netlink_update_socket_mc(struct netlink_sock *nlk,
2132 unsigned int group,
2133 int is_new)
2134{
2135 int old, new = !!is_new, subscriptions;
2136
2137 old = test_bit(group - 1, nlk->groups);
2138 subscriptions = nlk->subscriptions - old + new;
2139 if (new)
2140 __set_bit(group - 1, nlk->groups);
2141 else
2142 __clear_bit(group - 1, nlk->groups);
2143 netlink_update_subscriptions(&nlk->sk, subscriptions);
2144 netlink_update_listeners(&nlk->sk);
2145}
2146
9a4595bc 2147static int netlink_setsockopt(struct socket *sock, int level, int optname,
b7058842 2148 char __user *optval, unsigned int optlen)
9a4595bc
PM
2149{
2150 struct sock *sk = sock->sk;
2151 struct netlink_sock *nlk = nlk_sk(sk);
eb496534
JB
2152 unsigned int val = 0;
2153 int err;
9a4595bc
PM
2154
2155 if (level != SOL_NETLINK)
2156 return -ENOPROTOOPT;
2157
ccdfcc39
PM
2158 if (optname != NETLINK_RX_RING && optname != NETLINK_TX_RING &&
2159 optlen >= sizeof(int) &&
eb496534 2160 get_user(val, (unsigned int __user *)optval))
9a4595bc
PM
2161 return -EFAULT;
2162
2163 switch (optname) {
2164 case NETLINK_PKTINFO:
2165 if (val)
cc3a572f 2166 nlk->flags |= NETLINK_F_RECV_PKTINFO;
9a4595bc 2167 else
cc3a572f 2168 nlk->flags &= ~NETLINK_F_RECV_PKTINFO;
9a4595bc
PM
2169 err = 0;
2170 break;
2171 case NETLINK_ADD_MEMBERSHIP:
2172 case NETLINK_DROP_MEMBERSHIP: {
5187cd05 2173 if (!netlink_allowed(sock, NL_CFG_F_NONROOT_RECV))
9a4595bc 2174 return -EPERM;
b4ff4f04
JB
2175 err = netlink_realloc_groups(sk);
2176 if (err)
2177 return err;
9a4595bc
PM
2178 if (!val || val - 1 >= nlk->ngroups)
2179 return -EINVAL;
7774d5e0 2180 if (optname == NETLINK_ADD_MEMBERSHIP && nlk->netlink_bind) {
023e2cfa 2181 err = nlk->netlink_bind(sock_net(sk), val);
4f520900
RGB
2182 if (err)
2183 return err;
2184 }
9a4595bc 2185 netlink_table_grab();
84659eb5
JB
2186 netlink_update_socket_mc(nlk, val,
2187 optname == NETLINK_ADD_MEMBERSHIP);
9a4595bc 2188 netlink_table_ungrab();
7774d5e0 2189 if (optname == NETLINK_DROP_MEMBERSHIP && nlk->netlink_unbind)
023e2cfa 2190 nlk->netlink_unbind(sock_net(sk), val);
03292745 2191
9a4595bc
PM
2192 err = 0;
2193 break;
2194 }
be0c22a4
PNA
2195 case NETLINK_BROADCAST_ERROR:
2196 if (val)
cc3a572f 2197 nlk->flags |= NETLINK_F_BROADCAST_SEND_ERROR;
be0c22a4 2198 else
cc3a572f 2199 nlk->flags &= ~NETLINK_F_BROADCAST_SEND_ERROR;
be0c22a4
PNA
2200 err = 0;
2201 break;
38938bfe
PNA
2202 case NETLINK_NO_ENOBUFS:
2203 if (val) {
cc3a572f
ND
2204 nlk->flags |= NETLINK_F_RECV_NO_ENOBUFS;
2205 clear_bit(NETLINK_S_CONGESTED, &nlk->state);
38938bfe 2206 wake_up_interruptible(&nlk->wait);
658cb354 2207 } else {
cc3a572f 2208 nlk->flags &= ~NETLINK_F_RECV_NO_ENOBUFS;
658cb354 2209 }
38938bfe
PNA
2210 err = 0;
2211 break;
ccdfcc39
PM
2212#ifdef CONFIG_NETLINK_MMAP
2213 case NETLINK_RX_RING:
2214 case NETLINK_TX_RING: {
2215 struct nl_mmap_req req;
2216
2217 /* Rings might consume more memory than queue limits, require
2218 * CAP_NET_ADMIN.
2219 */
2220 if (!capable(CAP_NET_ADMIN))
2221 return -EPERM;
2222 if (optlen < sizeof(req))
2223 return -EINVAL;
2224 if (copy_from_user(&req, optval, sizeof(req)))
2225 return -EFAULT;
2226 err = netlink_set_ring(sk, &req, false,
2227 optname == NETLINK_TX_RING);
2228 break;
2229 }
2230#endif /* CONFIG_NETLINK_MMAP */
59324cf3
ND
2231 case NETLINK_LISTEN_ALL_NSID:
2232 if (!ns_capable(sock_net(sk)->user_ns, CAP_NET_BROADCAST))
2233 return -EPERM;
2234
2235 if (val)
2236 nlk->flags |= NETLINK_F_LISTEN_ALL_NSID;
2237 else
2238 nlk->flags &= ~NETLINK_F_LISTEN_ALL_NSID;
2239 err = 0;
2240 break;
9a4595bc
PM
2241 default:
2242 err = -ENOPROTOOPT;
2243 }
2244 return err;
2245}
2246
2247static int netlink_getsockopt(struct socket *sock, int level, int optname,
746fac4d 2248 char __user *optval, int __user *optlen)
9a4595bc
PM
2249{
2250 struct sock *sk = sock->sk;
2251 struct netlink_sock *nlk = nlk_sk(sk);
2252 int len, val, err;
2253
2254 if (level != SOL_NETLINK)
2255 return -ENOPROTOOPT;
2256
2257 if (get_user(len, optlen))
2258 return -EFAULT;
2259 if (len < 0)
2260 return -EINVAL;
2261
2262 switch (optname) {
2263 case NETLINK_PKTINFO:
2264 if (len < sizeof(int))
2265 return -EINVAL;
2266 len = sizeof(int);
cc3a572f 2267 val = nlk->flags & NETLINK_F_RECV_PKTINFO ? 1 : 0;
a27b58fe
HC
2268 if (put_user(len, optlen) ||
2269 put_user(val, optval))
2270 return -EFAULT;
9a4595bc
PM
2271 err = 0;
2272 break;
be0c22a4
PNA
2273 case NETLINK_BROADCAST_ERROR:
2274 if (len < sizeof(int))
2275 return -EINVAL;
2276 len = sizeof(int);
cc3a572f 2277 val = nlk->flags & NETLINK_F_BROADCAST_SEND_ERROR ? 1 : 0;
be0c22a4
PNA
2278 if (put_user(len, optlen) ||
2279 put_user(val, optval))
2280 return -EFAULT;
2281 err = 0;
2282 break;
38938bfe
PNA
2283 case NETLINK_NO_ENOBUFS:
2284 if (len < sizeof(int))
2285 return -EINVAL;
2286 len = sizeof(int);
cc3a572f 2287 val = nlk->flags & NETLINK_F_RECV_NO_ENOBUFS ? 1 : 0;
38938bfe
PNA
2288 if (put_user(len, optlen) ||
2289 put_user(val, optval))
2290 return -EFAULT;
2291 err = 0;
2292 break;
9a4595bc
PM
2293 default:
2294 err = -ENOPROTOOPT;
2295 }
2296 return err;
2297}
2298
2299static void netlink_cmsg_recv_pktinfo(struct msghdr *msg, struct sk_buff *skb)
2300{
2301 struct nl_pktinfo info;
2302
2303 info.group = NETLINK_CB(skb).dst_group;
2304 put_cmsg(msg, SOL_NETLINK, NETLINK_PKTINFO, sizeof(info), &info);
2305}
2306
59324cf3
ND
2307static void netlink_cmsg_listen_all_nsid(struct sock *sk, struct msghdr *msg,
2308 struct sk_buff *skb)
2309{
2310 if (!NETLINK_CB(skb).nsid_is_set)
2311 return;
2312
2313 put_cmsg(msg, SOL_NETLINK, NETLINK_LISTEN_ALL_NSID, sizeof(int),
2314 &NETLINK_CB(skb).nsid);
2315}
2316
1b784140 2317static int netlink_sendmsg(struct socket *sock, struct msghdr *msg, size_t len)
1da177e4 2318{
1da177e4
LT
2319 struct sock *sk = sock->sk;
2320 struct netlink_sock *nlk = nlk_sk(sk);
342dfc30 2321 DECLARE_SOCKADDR(struct sockaddr_nl *, addr, msg->msg_name);
15e47304 2322 u32 dst_portid;
d629b836 2323 u32 dst_group;
1da177e4
LT
2324 struct sk_buff *skb;
2325 int err;
2326 struct scm_cookie scm;
2d7a85f4 2327 u32 netlink_skb_flags = 0;
1da177e4
LT
2328
2329 if (msg->msg_flags&MSG_OOB)
2330 return -EOPNOTSUPP;
2331
7cc05662 2332 err = scm_send(sock, msg, &scm, true);
1da177e4
LT
2333 if (err < 0)
2334 return err;
2335
2336 if (msg->msg_namelen) {
b47030c7 2337 err = -EINVAL;
1da177e4 2338 if (addr->nl_family != AF_NETLINK)
b47030c7 2339 goto out;
15e47304 2340 dst_portid = addr->nl_pid;
d629b836 2341 dst_group = ffs(addr->nl_groups);
b47030c7 2342 err = -EPERM;
15e47304 2343 if ((dst_group || dst_portid) &&
5187cd05 2344 !netlink_allowed(sock, NL_CFG_F_NONROOT_SEND))
b47030c7 2345 goto out;
2d7a85f4 2346 netlink_skb_flags |= NETLINK_SKB_DST;
1da177e4 2347 } else {
15e47304 2348 dst_portid = nlk->dst_portid;
d629b836 2349 dst_group = nlk->dst_group;
1da177e4
LT
2350 }
2351
15e47304 2352 if (!nlk->portid) {
1da177e4
LT
2353 err = netlink_autobind(sock);
2354 if (err)
2355 goto out;
2356 }
2357
a8866ff6
AV
2358 /* It's a really convoluted way for userland to ask for mmaped
2359 * sendmsg(), but that's what we've got...
2360 */
5fd96123 2361 if (netlink_tx_is_mmaped(sk) &&
a8866ff6
AV
2362 msg->msg_iter.type == ITER_IOVEC &&
2363 msg->msg_iter.nr_segs == 1 &&
c0371da6 2364 msg->msg_iter.iov->iov_base == NULL) {
5fd96123 2365 err = netlink_mmap_sendmsg(sk, msg, dst_portid, dst_group,
7cc05662 2366 &scm);
5fd96123
PM
2367 goto out;
2368 }
2369
1da177e4
LT
2370 err = -EMSGSIZE;
2371 if (len > sk->sk_sndbuf - 32)
2372 goto out;
2373 err = -ENOBUFS;
3a36515f 2374 skb = netlink_alloc_large_skb(len, dst_group);
6ac552fd 2375 if (skb == NULL)
1da177e4
LT
2376 goto out;
2377
15e47304 2378 NETLINK_CB(skb).portid = nlk->portid;
d629b836 2379 NETLINK_CB(skb).dst_group = dst_group;
7cc05662 2380 NETLINK_CB(skb).creds = scm.creds;
2d7a85f4 2381 NETLINK_CB(skb).flags = netlink_skb_flags;
1da177e4 2382
1da177e4 2383 err = -EFAULT;
6ce8e9ce 2384 if (memcpy_from_msg(skb_put(skb, len), msg, len)) {
1da177e4
LT
2385 kfree_skb(skb);
2386 goto out;
2387 }
2388
2389 err = security_netlink_send(sk, skb);
2390 if (err) {
2391 kfree_skb(skb);
2392 goto out;
2393 }
2394
d629b836 2395 if (dst_group) {
1da177e4 2396 atomic_inc(&skb->users);
15e47304 2397 netlink_broadcast(sk, skb, dst_portid, dst_group, GFP_KERNEL);
1da177e4 2398 }
15e47304 2399 err = netlink_unicast(sk, skb, dst_portid, msg->msg_flags&MSG_DONTWAIT);
1da177e4
LT
2400
2401out:
7cc05662 2402 scm_destroy(&scm);
1da177e4
LT
2403 return err;
2404}
2405
1b784140 2406static int netlink_recvmsg(struct socket *sock, struct msghdr *msg, size_t len,
1da177e4
LT
2407 int flags)
2408{
1da177e4
LT
2409 struct scm_cookie scm;
2410 struct sock *sk = sock->sk;
2411 struct netlink_sock *nlk = nlk_sk(sk);
2412 int noblock = flags&MSG_DONTWAIT;
2413 size_t copied;
68d6ac6d 2414 struct sk_buff *skb, *data_skb;
b44d211e 2415 int err, ret;
1da177e4
LT
2416
2417 if (flags&MSG_OOB)
2418 return -EOPNOTSUPP;
2419
2420 copied = 0;
2421
6ac552fd
PM
2422 skb = skb_recv_datagram(sk, flags, noblock, &err);
2423 if (skb == NULL)
1da177e4
LT
2424 goto out;
2425
68d6ac6d
JB
2426 data_skb = skb;
2427
1dacc76d
JB
2428#ifdef CONFIG_COMPAT_NETLINK_MESSAGES
2429 if (unlikely(skb_shinfo(skb)->frag_list)) {
1dacc76d 2430 /*
68d6ac6d
JB
2431 * If this skb has a frag_list, then here that means that we
2432 * will have to use the frag_list skb's data for compat tasks
2433 * and the regular skb's data for normal (non-compat) tasks.
1dacc76d 2434 *
68d6ac6d
JB
2435 * If we need to send the compat skb, assign it to the
2436 * 'data_skb' variable so that it will be used below for data
2437 * copying. We keep 'skb' for everything else, including
2438 * freeing both later.
1dacc76d 2439 */
68d6ac6d
JB
2440 if (flags & MSG_CMSG_COMPAT)
2441 data_skb = skb_shinfo(skb)->frag_list;
1dacc76d
JB
2442 }
2443#endif
2444
9063e21f
ED
2445 /* Record the max length of recvmsg() calls for future allocations */
2446 nlk->max_recvmsg_len = max(nlk->max_recvmsg_len, len);
2447 nlk->max_recvmsg_len = min_t(size_t, nlk->max_recvmsg_len,
2448 16384);
2449
68d6ac6d 2450 copied = data_skb->len;
1da177e4
LT
2451 if (len < copied) {
2452 msg->msg_flags |= MSG_TRUNC;
2453 copied = len;
2454 }
2455
68d6ac6d 2456 skb_reset_transport_header(data_skb);
51f3d02b 2457 err = skb_copy_datagram_msg(data_skb, 0, msg, copied);
1da177e4
LT
2458
2459 if (msg->msg_name) {
342dfc30 2460 DECLARE_SOCKADDR(struct sockaddr_nl *, addr, msg->msg_name);
1da177e4
LT
2461 addr->nl_family = AF_NETLINK;
2462 addr->nl_pad = 0;
15e47304 2463 addr->nl_pid = NETLINK_CB(skb).portid;
d629b836 2464 addr->nl_groups = netlink_group_mask(NETLINK_CB(skb).dst_group);
1da177e4
LT
2465 msg->msg_namelen = sizeof(*addr);
2466 }
2467
cc3a572f 2468 if (nlk->flags & NETLINK_F_RECV_PKTINFO)
cc9a06cd 2469 netlink_cmsg_recv_pktinfo(msg, skb);
59324cf3
ND
2470 if (nlk->flags & NETLINK_F_LISTEN_ALL_NSID)
2471 netlink_cmsg_listen_all_nsid(sk, msg, skb);
cc9a06cd 2472
7cc05662
CH
2473 memset(&scm, 0, sizeof(scm));
2474 scm.creds = *NETLINK_CREDS(skb);
188ccb55 2475 if (flags & MSG_TRUNC)
68d6ac6d 2476 copied = data_skb->len;
daa3766e 2477
1da177e4
LT
2478 skb_free_datagram(sk, skb);
2479
16b304f3
PS
2480 if (nlk->cb_running &&
2481 atomic_read(&sk->sk_rmem_alloc) <= sk->sk_rcvbuf / 2) {
b44d211e
AV
2482 ret = netlink_dump(sk);
2483 if (ret) {
ac30ef83 2484 sk->sk_err = -ret;
b44d211e
AV
2485 sk->sk_error_report(sk);
2486 }
2487 }
1da177e4 2488
7cc05662 2489 scm_recv(sock, msg, &scm, flags);
1da177e4
LT
2490out:
2491 netlink_rcv_wake(sk);
2492 return err ? : copied;
2493}
2494
676d2369 2495static void netlink_data_ready(struct sock *sk)
1da177e4 2496{
cd40b7d3 2497 BUG();
1da177e4
LT
2498}
2499
2500/*
746fac4d 2501 * We export these functions to other modules. They provide a
1da177e4
LT
2502 * complete set of kernel non-blocking support for message
2503 * queueing.
2504 */
2505
2506struct sock *
9f00d977
PNA
2507__netlink_kernel_create(struct net *net, int unit, struct module *module,
2508 struct netlink_kernel_cfg *cfg)
1da177e4
LT
2509{
2510 struct socket *sock;
2511 struct sock *sk;
77247bbb 2512 struct netlink_sock *nlk;
5c398dc8 2513 struct listeners *listeners = NULL;
a31f2d17
PNA
2514 struct mutex *cb_mutex = cfg ? cfg->cb_mutex : NULL;
2515 unsigned int groups;
1da177e4 2516
fab2caf6 2517 BUG_ON(!nl_table);
1da177e4 2518
6ac552fd 2519 if (unit < 0 || unit >= MAX_LINKS)
1da177e4
LT
2520 return NULL;
2521
2522 if (sock_create_lite(PF_NETLINK, SOCK_DGRAM, unit, &sock))
2523 return NULL;
13d3078e
EB
2524
2525 if (__netlink_create(net, sock, cb_mutex, unit, 1) < 0)
23fe1866
PE
2526 goto out_sock_release_nosk;
2527
2528 sk = sock->sk;
4fdb3bb7 2529
a31f2d17 2530 if (!cfg || cfg->groups < 32)
4277a083 2531 groups = 32;
a31f2d17
PNA
2532 else
2533 groups = cfg->groups;
4277a083 2534
5c398dc8 2535 listeners = kzalloc(sizeof(*listeners) + NLGRPSZ(groups), GFP_KERNEL);
4277a083
PM
2536 if (!listeners)
2537 goto out_sock_release;
2538
1da177e4 2539 sk->sk_data_ready = netlink_data_ready;
a31f2d17
PNA
2540 if (cfg && cfg->input)
2541 nlk_sk(sk)->netlink_rcv = cfg->input;
1da177e4 2542
8ea65f4a 2543 if (netlink_insert(sk, 0))
77247bbb 2544 goto out_sock_release;
4fdb3bb7 2545
77247bbb 2546 nlk = nlk_sk(sk);
cc3a572f 2547 nlk->flags |= NETLINK_F_KERNEL_SOCKET;
4fdb3bb7 2548
4fdb3bb7 2549 netlink_table_grab();
b4b51029
EB
2550 if (!nl_table[unit].registered) {
2551 nl_table[unit].groups = groups;
5c398dc8 2552 rcu_assign_pointer(nl_table[unit].listeners, listeners);
b4b51029
EB
2553 nl_table[unit].cb_mutex = cb_mutex;
2554 nl_table[unit].module = module;
9785e10a
PNA
2555 if (cfg) {
2556 nl_table[unit].bind = cfg->bind;
6251edd9 2557 nl_table[unit].unbind = cfg->unbind;
9785e10a 2558 nl_table[unit].flags = cfg->flags;
da12c90e
G
2559 if (cfg->compare)
2560 nl_table[unit].compare = cfg->compare;
9785e10a 2561 }
b4b51029 2562 nl_table[unit].registered = 1;
f937f1f4
JJ
2563 } else {
2564 kfree(listeners);
869e58f8 2565 nl_table[unit].registered++;
b4b51029 2566 }
4fdb3bb7 2567 netlink_table_ungrab();
77247bbb
PM
2568 return sk;
2569
4fdb3bb7 2570out_sock_release:
4277a083 2571 kfree(listeners);
9dfbec1f 2572 netlink_kernel_release(sk);
23fe1866
PE
2573 return NULL;
2574
2575out_sock_release_nosk:
4fdb3bb7 2576 sock_release(sock);
77247bbb 2577 return NULL;
1da177e4 2578}
9f00d977 2579EXPORT_SYMBOL(__netlink_kernel_create);
b7c6ba6e
DL
2580
2581void
2582netlink_kernel_release(struct sock *sk)
2583{
13d3078e
EB
2584 if (sk == NULL || sk->sk_socket == NULL)
2585 return;
2586
2587 sock_release(sk->sk_socket);
b7c6ba6e
DL
2588}
2589EXPORT_SYMBOL(netlink_kernel_release);
2590
d136f1bd 2591int __netlink_change_ngroups(struct sock *sk, unsigned int groups)
b4ff4f04 2592{
5c398dc8 2593 struct listeners *new, *old;
b4ff4f04 2594 struct netlink_table *tbl = &nl_table[sk->sk_protocol];
b4ff4f04
JB
2595
2596 if (groups < 32)
2597 groups = 32;
2598
b4ff4f04 2599 if (NLGRPSZ(tbl->groups) < NLGRPSZ(groups)) {
5c398dc8
ED
2600 new = kzalloc(sizeof(*new) + NLGRPSZ(groups), GFP_ATOMIC);
2601 if (!new)
d136f1bd 2602 return -ENOMEM;
6d772ac5 2603 old = nl_deref_protected(tbl->listeners);
5c398dc8
ED
2604 memcpy(new->masks, old->masks, NLGRPSZ(tbl->groups));
2605 rcu_assign_pointer(tbl->listeners, new);
2606
37b6b935 2607 kfree_rcu(old, rcu);
b4ff4f04
JB
2608 }
2609 tbl->groups = groups;
2610
d136f1bd
JB
2611 return 0;
2612}
2613
2614/**
2615 * netlink_change_ngroups - change number of multicast groups
2616 *
2617 * This changes the number of multicast groups that are available
2618 * on a certain netlink family. Note that it is not possible to
2619 * change the number of groups to below 32. Also note that it does
2620 * not implicitly call netlink_clear_multicast_users() when the
2621 * number of groups is reduced.
2622 *
2623 * @sk: The kernel netlink socket, as returned by netlink_kernel_create().
2624 * @groups: The new number of groups.
2625 */
2626int netlink_change_ngroups(struct sock *sk, unsigned int groups)
2627{
2628 int err;
2629
2630 netlink_table_grab();
2631 err = __netlink_change_ngroups(sk, groups);
b4ff4f04 2632 netlink_table_ungrab();
d136f1bd 2633
b4ff4f04
JB
2634 return err;
2635}
b4ff4f04 2636
b8273570
JB
2637void __netlink_clear_multicast_users(struct sock *ksk, unsigned int group)
2638{
2639 struct sock *sk;
b8273570
JB
2640 struct netlink_table *tbl = &nl_table[ksk->sk_protocol];
2641
b67bfe0d 2642 sk_for_each_bound(sk, &tbl->mc_list)
b8273570
JB
2643 netlink_update_socket_mc(nlk_sk(sk), group, 0);
2644}
2645
a46621a3 2646struct nlmsghdr *
15e47304 2647__nlmsg_put(struct sk_buff *skb, u32 portid, u32 seq, int type, int len, int flags)
a46621a3
DV
2648{
2649 struct nlmsghdr *nlh;
573ce260 2650 int size = nlmsg_msg_size(len);
a46621a3 2651
23b45672 2652 nlh = (struct nlmsghdr *)skb_put(skb, NLMSG_ALIGN(size));
a46621a3
DV
2653 nlh->nlmsg_type = type;
2654 nlh->nlmsg_len = size;
2655 nlh->nlmsg_flags = flags;
15e47304 2656 nlh->nlmsg_pid = portid;
a46621a3
DV
2657 nlh->nlmsg_seq = seq;
2658 if (!__builtin_constant_p(size) || NLMSG_ALIGN(size) - size != 0)
573ce260 2659 memset(nlmsg_data(nlh) + len, 0, NLMSG_ALIGN(size) - size);
a46621a3
DV
2660 return nlh;
2661}
2662EXPORT_SYMBOL(__nlmsg_put);
2663
1da177e4
LT
2664/*
2665 * It looks a bit ugly.
2666 * It would be better to create kernel thread.
2667 */
2668
2669static int netlink_dump(struct sock *sk)
2670{
2671 struct netlink_sock *nlk = nlk_sk(sk);
2672 struct netlink_callback *cb;
c7ac8679 2673 struct sk_buff *skb = NULL;
1da177e4 2674 struct nlmsghdr *nlh;
bf8b79e4 2675 int len, err = -ENOBUFS;
c7ac8679 2676 int alloc_size;
1da177e4 2677
af65bdfc 2678 mutex_lock(nlk->cb_mutex);
16b304f3 2679 if (!nlk->cb_running) {
bf8b79e4
TG
2680 err = -EINVAL;
2681 goto errout_skb;
1da177e4
LT
2682 }
2683
16b304f3 2684 cb = &nlk->cb;
c7ac8679
GR
2685 alloc_size = max_t(int, cb->min_dump_alloc, NLMSG_GOODSIZE);
2686
f9c22888
PM
2687 if (!netlink_rx_is_mmaped(sk) &&
2688 atomic_read(&sk->sk_rmem_alloc) >= sk->sk_rcvbuf)
2689 goto errout_skb;
9063e21f
ED
2690
2691 /* NLMSG_GOODSIZE is small to avoid high order allocations being
2692 * required, but it makes sense to _attempt_ a 16K bytes allocation
2693 * to reduce number of system calls on dump operations, if user
2694 * ever provided a big enough buffer.
2695 */
2696 if (alloc_size < nlk->max_recvmsg_len) {
2697 skb = netlink_alloc_skb(sk,
2698 nlk->max_recvmsg_len,
2699 nlk->portid,
2700 GFP_KERNEL |
2701 __GFP_NOWARN |
2702 __GFP_NORETRY);
2703 /* available room should be exact amount to avoid MSG_TRUNC */
2704 if (skb)
2705 skb_reserve(skb, skb_tailroom(skb) -
2706 nlk->max_recvmsg_len);
2707 }
2708 if (!skb)
2709 skb = netlink_alloc_skb(sk, alloc_size, nlk->portid,
2710 GFP_KERNEL);
c7ac8679 2711 if (!skb)
c63d6ea3 2712 goto errout_skb;
f9c22888 2713 netlink_skb_set_owner_r(skb, sk);
c7ac8679 2714
1da177e4
LT
2715 len = cb->dump(skb, cb);
2716
2717 if (len > 0) {
af65bdfc 2718 mutex_unlock(nlk->cb_mutex);
b1153f29
SH
2719
2720 if (sk_filter(sk, skb))
2721 kfree_skb(skb);
4a7e7c2a
ED
2722 else
2723 __netlink_sendskb(sk, skb);
1da177e4
LT
2724 return 0;
2725 }
2726
bf8b79e4
TG
2727 nlh = nlmsg_put_answer(skb, cb, NLMSG_DONE, sizeof(len), NLM_F_MULTI);
2728 if (!nlh)
2729 goto errout_skb;
2730
670dc283
JB
2731 nl_dump_check_consistent(cb, nlh);
2732
bf8b79e4
TG
2733 memcpy(nlmsg_data(nlh), &len, sizeof(len));
2734
b1153f29
SH
2735 if (sk_filter(sk, skb))
2736 kfree_skb(skb);
4a7e7c2a
ED
2737 else
2738 __netlink_sendskb(sk, skb);
1da177e4 2739
a8f74b22
TG
2740 if (cb->done)
2741 cb->done(cb);
1da177e4 2742
16b304f3
PS
2743 nlk->cb_running = false;
2744 mutex_unlock(nlk->cb_mutex);
6dc878a8 2745 module_put(cb->module);
16b304f3 2746 consume_skb(cb->skb);
1da177e4 2747 return 0;
1797754e 2748
bf8b79e4 2749errout_skb:
af65bdfc 2750 mutex_unlock(nlk->cb_mutex);
bf8b79e4 2751 kfree_skb(skb);
bf8b79e4 2752 return err;
1da177e4
LT
2753}
2754
6dc878a8
G
2755int __netlink_dump_start(struct sock *ssk, struct sk_buff *skb,
2756 const struct nlmsghdr *nlh,
2757 struct netlink_dump_control *control)
1da177e4
LT
2758{
2759 struct netlink_callback *cb;
2760 struct sock *sk;
2761 struct netlink_sock *nlk;
b44d211e 2762 int ret;
1da177e4 2763
f9c22888
PM
2764 /* Memory mapped dump requests need to be copied to avoid looping
2765 * on the pending state in netlink_mmap_sendmsg() while the CB hold
2766 * a reference to the skb.
2767 */
2768 if (netlink_skb_is_mmaped(skb)) {
2769 skb = skb_copy(skb, GFP_KERNEL);
16b304f3 2770 if (skb == NULL)
f9c22888 2771 return -ENOBUFS;
f9c22888
PM
2772 } else
2773 atomic_inc(&skb->users);
2774
15e47304 2775 sk = netlink_lookup(sock_net(ssk), ssk->sk_protocol, NETLINK_CB(skb).portid);
1da177e4 2776 if (sk == NULL) {
16b304f3
PS
2777 ret = -ECONNREFUSED;
2778 goto error_free;
1da177e4 2779 }
6dc878a8 2780
16b304f3 2781 nlk = nlk_sk(sk);
af65bdfc 2782 mutex_lock(nlk->cb_mutex);
6dc878a8 2783 /* A dump is in progress... */
16b304f3 2784 if (nlk->cb_running) {
6dc878a8 2785 ret = -EBUSY;
16b304f3 2786 goto error_unlock;
1da177e4 2787 }
6dc878a8 2788 /* add reference of module which cb->dump belongs to */
16b304f3 2789 if (!try_module_get(control->module)) {
6dc878a8 2790 ret = -EPROTONOSUPPORT;
16b304f3 2791 goto error_unlock;
6dc878a8
G
2792 }
2793
16b304f3
PS
2794 cb = &nlk->cb;
2795 memset(cb, 0, sizeof(*cb));
2796 cb->dump = control->dump;
2797 cb->done = control->done;
2798 cb->nlh = nlh;
2799 cb->data = control->data;
2800 cb->module = control->module;
2801 cb->min_dump_alloc = control->min_dump_alloc;
2802 cb->skb = skb;
2803
2804 nlk->cb_running = true;
2805
af65bdfc 2806 mutex_unlock(nlk->cb_mutex);
1da177e4 2807
b44d211e 2808 ret = netlink_dump(sk);
1da177e4 2809 sock_put(sk);
5c58298c 2810
b44d211e
AV
2811 if (ret)
2812 return ret;
2813
5c58298c
DL
2814 /* We successfully started a dump, by returning -EINTR we
2815 * signal not to send ACK even if it was requested.
2816 */
2817 return -EINTR;
16b304f3
PS
2818
2819error_unlock:
2820 sock_put(sk);
2821 mutex_unlock(nlk->cb_mutex);
2822error_free:
2823 kfree_skb(skb);
2824 return ret;
1da177e4 2825}
6dc878a8 2826EXPORT_SYMBOL(__netlink_dump_start);
1da177e4
LT
2827
2828void netlink_ack(struct sk_buff *in_skb, struct nlmsghdr *nlh, int err)
2829{
2830 struct sk_buff *skb;
2831 struct nlmsghdr *rep;
2832 struct nlmsgerr *errmsg;
339bf98f 2833 size_t payload = sizeof(*errmsg);
1da177e4 2834
339bf98f
TG
2835 /* error messages get the original request appened */
2836 if (err)
2837 payload += nlmsg_len(nlh);
1da177e4 2838
f9c22888
PM
2839 skb = netlink_alloc_skb(in_skb->sk, nlmsg_total_size(payload),
2840 NETLINK_CB(in_skb).portid, GFP_KERNEL);
1da177e4
LT
2841 if (!skb) {
2842 struct sock *sk;
2843
3b1e0a65 2844 sk = netlink_lookup(sock_net(in_skb->sk),
b4b51029 2845 in_skb->sk->sk_protocol,
15e47304 2846 NETLINK_CB(in_skb).portid);
1da177e4
LT
2847 if (sk) {
2848 sk->sk_err = ENOBUFS;
2849 sk->sk_error_report(sk);
2850 sock_put(sk);
2851 }
2852 return;
2853 }
2854
15e47304 2855 rep = __nlmsg_put(skb, NETLINK_CB(in_skb).portid, nlh->nlmsg_seq,
5dba93ae 2856 NLMSG_ERROR, payload, 0);
bf8b79e4 2857 errmsg = nlmsg_data(rep);
1da177e4 2858 errmsg->error = err;
bf8b79e4 2859 memcpy(&errmsg->msg, nlh, err ? nlh->nlmsg_len : sizeof(*nlh));
15e47304 2860 netlink_unicast(in_skb->sk, skb, NETLINK_CB(in_skb).portid, MSG_DONTWAIT);
1da177e4 2861}
6ac552fd 2862EXPORT_SYMBOL(netlink_ack);
1da177e4 2863
cd40b7d3 2864int netlink_rcv_skb(struct sk_buff *skb, int (*cb)(struct sk_buff *,
1d00a4eb 2865 struct nlmsghdr *))
82ace47a 2866{
82ace47a
TG
2867 struct nlmsghdr *nlh;
2868 int err;
2869
2870 while (skb->len >= nlmsg_total_size(0)) {
cd40b7d3
DL
2871 int msglen;
2872
b529ccf2 2873 nlh = nlmsg_hdr(skb);
d35b6856 2874 err = 0;
82ace47a 2875
ad8e4b75 2876 if (nlh->nlmsg_len < NLMSG_HDRLEN || skb->len < nlh->nlmsg_len)
82ace47a
TG
2877 return 0;
2878
d35b6856
TG
2879 /* Only requests are handled by the kernel */
2880 if (!(nlh->nlmsg_flags & NLM_F_REQUEST))
5c58298c 2881 goto ack;
45e7ae7f
TG
2882
2883 /* Skip control messages */
2884 if (nlh->nlmsg_type < NLMSG_MIN_TYPE)
5c58298c 2885 goto ack;
d35b6856 2886
1d00a4eb 2887 err = cb(skb, nlh);
5c58298c
DL
2888 if (err == -EINTR)
2889 goto skip;
2890
2891ack:
d35b6856 2892 if (nlh->nlmsg_flags & NLM_F_ACK || err)
82ace47a 2893 netlink_ack(skb, nlh, err);
82ace47a 2894
5c58298c 2895skip:
6ac552fd 2896 msglen = NLMSG_ALIGN(nlh->nlmsg_len);
cd40b7d3
DL
2897 if (msglen > skb->len)
2898 msglen = skb->len;
2899 skb_pull(skb, msglen);
82ace47a
TG
2900 }
2901
2902 return 0;
2903}
6ac552fd 2904EXPORT_SYMBOL(netlink_rcv_skb);
82ace47a 2905
d387f6ad
TG
2906/**
2907 * nlmsg_notify - send a notification netlink message
2908 * @sk: netlink socket to use
2909 * @skb: notification message
15e47304 2910 * @portid: destination netlink portid for reports or 0
d387f6ad
TG
2911 * @group: destination multicast group or 0
2912 * @report: 1 to report back, 0 to disable
2913 * @flags: allocation flags
2914 */
15e47304 2915int nlmsg_notify(struct sock *sk, struct sk_buff *skb, u32 portid,
d387f6ad
TG
2916 unsigned int group, int report, gfp_t flags)
2917{
2918 int err = 0;
2919
2920 if (group) {
15e47304 2921 int exclude_portid = 0;
d387f6ad
TG
2922
2923 if (report) {
2924 atomic_inc(&skb->users);
15e47304 2925 exclude_portid = portid;
d387f6ad
TG
2926 }
2927
1ce85fe4
PNA
2928 /* errors reported via destination sk->sk_err, but propagate
2929 * delivery errors if NETLINK_BROADCAST_ERROR flag is set */
15e47304 2930 err = nlmsg_multicast(sk, skb, exclude_portid, group, flags);
d387f6ad
TG
2931 }
2932
1ce85fe4
PNA
2933 if (report) {
2934 int err2;
2935
15e47304 2936 err2 = nlmsg_unicast(sk, skb, portid);
1ce85fe4
PNA
2937 if (!err || err == -ESRCH)
2938 err = err2;
2939 }
d387f6ad
TG
2940
2941 return err;
2942}
6ac552fd 2943EXPORT_SYMBOL(nlmsg_notify);
d387f6ad 2944
1da177e4
LT
2945#ifdef CONFIG_PROC_FS
2946struct nl_seq_iter {
e372c414 2947 struct seq_net_private p;
56d28b1e 2948 struct rhashtable_iter hti;
1da177e4 2949 int link;
1da177e4
LT
2950};
2951
56d28b1e 2952static int netlink_walk_start(struct nl_seq_iter *iter)
1da177e4 2953{
56d28b1e 2954 int err;
1da177e4 2955
56d28b1e
HX
2956 err = rhashtable_walk_init(&nl_table[iter->link].hash, &iter->hti);
2957 if (err) {
2958 iter->link = MAX_LINKS;
2959 return err;
1da177e4 2960 }
56d28b1e
HX
2961
2962 err = rhashtable_walk_start(&iter->hti);
2963 return err == -EAGAIN ? 0 : err;
1da177e4
LT
2964}
2965
56d28b1e 2966static void netlink_walk_stop(struct nl_seq_iter *iter)
1da177e4 2967{
56d28b1e
HX
2968 rhashtable_walk_stop(&iter->hti);
2969 rhashtable_walk_exit(&iter->hti);
1da177e4
LT
2970}
2971
56d28b1e 2972static void *__netlink_seq_next(struct seq_file *seq)
1da177e4 2973{
56d28b1e 2974 struct nl_seq_iter *iter = seq->private;
e341694e 2975 struct netlink_sock *nlk;
1da177e4 2976
56d28b1e
HX
2977 do {
2978 for (;;) {
2979 int err;
1da177e4 2980
56d28b1e 2981 nlk = rhashtable_walk_next(&iter->hti);
746fac4d 2982
56d28b1e
HX
2983 if (IS_ERR(nlk)) {
2984 if (PTR_ERR(nlk) == -EAGAIN)
2985 continue;
e341694e 2986
56d28b1e
HX
2987 return nlk;
2988 }
1da177e4 2989
56d28b1e
HX
2990 if (nlk)
2991 break;
1da177e4 2992
56d28b1e
HX
2993 netlink_walk_stop(iter);
2994 if (++iter->link >= MAX_LINKS)
2995 return NULL;
da12c90e 2996
56d28b1e
HX
2997 err = netlink_walk_start(iter);
2998 if (err)
2999 return ERR_PTR(err);
1da177e4 3000 }
56d28b1e 3001 } while (sock_net(&nlk->sk) != seq_file_net(seq));
1da177e4 3002
56d28b1e
HX
3003 return nlk;
3004}
1da177e4 3005
56d28b1e
HX
3006static void *netlink_seq_start(struct seq_file *seq, loff_t *posp)
3007{
3008 struct nl_seq_iter *iter = seq->private;
3009 void *obj = SEQ_START_TOKEN;
3010 loff_t pos;
3011 int err;
3012
3013 iter->link = 0;
3014
3015 err = netlink_walk_start(iter);
3016 if (err)
3017 return ERR_PTR(err);
3018
3019 for (pos = *posp; pos && obj && !IS_ERR(obj); pos--)
3020 obj = __netlink_seq_next(seq);
3021
3022 return obj;
3023}
3024
3025static void *netlink_seq_next(struct seq_file *seq, void *v, loff_t *pos)
3026{
3027 ++*pos;
3028 return __netlink_seq_next(seq);
1da177e4
LT
3029}
3030
3031static void netlink_seq_stop(struct seq_file *seq, void *v)
3032{
56d28b1e
HX
3033 struct nl_seq_iter *iter = seq->private;
3034
3035 if (iter->link >= MAX_LINKS)
3036 return;
3037
3038 netlink_walk_stop(iter);
1da177e4
LT
3039}
3040
3041
3042static int netlink_seq_show(struct seq_file *seq, void *v)
3043{
658cb354 3044 if (v == SEQ_START_TOKEN) {
1da177e4
LT
3045 seq_puts(seq,
3046 "sk Eth Pid Groups "
cf0aa4e0 3047 "Rmem Wmem Dump Locks Drops Inode\n");
658cb354 3048 } else {
1da177e4
LT
3049 struct sock *s = v;
3050 struct netlink_sock *nlk = nlk_sk(s);
3051
16b304f3 3052 seq_printf(seq, "%pK %-3d %-6u %08x %-8d %-8d %d %-8d %-8d %-8lu\n",
1da177e4
LT
3053 s,
3054 s->sk_protocol,
15e47304 3055 nlk->portid,
513c2500 3056 nlk->groups ? (u32)nlk->groups[0] : 0,
31e6d363
ED
3057 sk_rmem_alloc_get(s),
3058 sk_wmem_alloc_get(s),
16b304f3 3059 nlk->cb_running,
38938bfe 3060 atomic_read(&s->sk_refcnt),
cf0aa4e0
MY
3061 atomic_read(&s->sk_drops),
3062 sock_i_ino(s)
1da177e4
LT
3063 );
3064
3065 }
3066 return 0;
3067}
3068
56b3d975 3069static const struct seq_operations netlink_seq_ops = {
1da177e4
LT
3070 .start = netlink_seq_start,
3071 .next = netlink_seq_next,
3072 .stop = netlink_seq_stop,
3073 .show = netlink_seq_show,
3074};
3075
3076
3077static int netlink_seq_open(struct inode *inode, struct file *file)
3078{
e372c414
DL
3079 return seq_open_net(inode, file, &netlink_seq_ops,
3080 sizeof(struct nl_seq_iter));
b4b51029
EB
3081}
3082
da7071d7 3083static const struct file_operations netlink_seq_fops = {
1da177e4
LT
3084 .owner = THIS_MODULE,
3085 .open = netlink_seq_open,
3086 .read = seq_read,
3087 .llseek = seq_lseek,
e372c414 3088 .release = seq_release_net,
1da177e4
LT
3089};
3090
3091#endif
3092
3093int netlink_register_notifier(struct notifier_block *nb)
3094{
e041c683 3095 return atomic_notifier_chain_register(&netlink_chain, nb);
1da177e4 3096}
6ac552fd 3097EXPORT_SYMBOL(netlink_register_notifier);
1da177e4
LT
3098
3099int netlink_unregister_notifier(struct notifier_block *nb)
3100{
e041c683 3101 return atomic_notifier_chain_unregister(&netlink_chain, nb);
1da177e4 3102}
6ac552fd 3103EXPORT_SYMBOL(netlink_unregister_notifier);
746fac4d 3104
90ddc4f0 3105static const struct proto_ops netlink_ops = {
1da177e4
LT
3106 .family = PF_NETLINK,
3107 .owner = THIS_MODULE,
3108 .release = netlink_release,
3109 .bind = netlink_bind,
3110 .connect = netlink_connect,
3111 .socketpair = sock_no_socketpair,
3112 .accept = sock_no_accept,
3113 .getname = netlink_getname,
9652e931 3114 .poll = netlink_poll,
1da177e4
LT
3115 .ioctl = sock_no_ioctl,
3116 .listen = sock_no_listen,
3117 .shutdown = sock_no_shutdown,
9a4595bc
PM
3118 .setsockopt = netlink_setsockopt,
3119 .getsockopt = netlink_getsockopt,
1da177e4
LT
3120 .sendmsg = netlink_sendmsg,
3121 .recvmsg = netlink_recvmsg,
ccdfcc39 3122 .mmap = netlink_mmap,
1da177e4
LT
3123 .sendpage = sock_no_sendpage,
3124};
3125
ec1b4cf7 3126static const struct net_proto_family netlink_family_ops = {
1da177e4
LT
3127 .family = PF_NETLINK,
3128 .create = netlink_create,
3129 .owner = THIS_MODULE, /* for consistency 8) */
3130};
3131
4665079c 3132static int __net_init netlink_net_init(struct net *net)
b4b51029
EB
3133{
3134#ifdef CONFIG_PROC_FS
d4beaa66 3135 if (!proc_create("netlink", 0, net->proc_net, &netlink_seq_fops))
b4b51029
EB
3136 return -ENOMEM;
3137#endif
3138 return 0;
3139}
3140
4665079c 3141static void __net_exit netlink_net_exit(struct net *net)
b4b51029
EB
3142{
3143#ifdef CONFIG_PROC_FS
ece31ffd 3144 remove_proc_entry("netlink", net->proc_net);
b4b51029
EB
3145#endif
3146}
3147
b963ea89
DM
3148static void __init netlink_add_usersock_entry(void)
3149{
5c398dc8 3150 struct listeners *listeners;
b963ea89
DM
3151 int groups = 32;
3152
5c398dc8 3153 listeners = kzalloc(sizeof(*listeners) + NLGRPSZ(groups), GFP_KERNEL);
b963ea89 3154 if (!listeners)
5c398dc8 3155 panic("netlink_add_usersock_entry: Cannot allocate listeners\n");
b963ea89
DM
3156
3157 netlink_table_grab();
3158
3159 nl_table[NETLINK_USERSOCK].groups = groups;
5c398dc8 3160 rcu_assign_pointer(nl_table[NETLINK_USERSOCK].listeners, listeners);
b963ea89
DM
3161 nl_table[NETLINK_USERSOCK].module = THIS_MODULE;
3162 nl_table[NETLINK_USERSOCK].registered = 1;
9785e10a 3163 nl_table[NETLINK_USERSOCK].flags = NL_CFG_F_NONROOT_SEND;
b963ea89
DM
3164
3165 netlink_table_ungrab();
3166}
3167
022cbae6 3168static struct pernet_operations __net_initdata netlink_net_ops = {
b4b51029
EB
3169 .init = netlink_net_init,
3170 .exit = netlink_net_exit,
3171};
3172
49f7b33e 3173static inline u32 netlink_hash(const void *data, u32 len, u32 seed)
c428ecd1
HX
3174{
3175 const struct netlink_sock *nlk = data;
3176 struct netlink_compare_arg arg;
3177
3178 netlink_compare_arg_init(&arg, sock_net(&nlk->sk), nlk->portid);
11b58ba1 3179 return jhash2((u32 *)&arg, netlink_compare_arg_len / sizeof(u32), seed);
c428ecd1
HX
3180}
3181
3182static const struct rhashtable_params netlink_rhashtable_params = {
3183 .head_offset = offsetof(struct netlink_sock, node),
3184 .key_len = netlink_compare_arg_len,
c428ecd1
HX
3185 .obj_hashfn = netlink_hash,
3186 .obj_cmpfn = netlink_compare,
b5e2c150 3187 .automatic_shrinking = true,
c428ecd1
HX
3188};
3189
1da177e4
LT
3190static int __init netlink_proto_init(void)
3191{
1da177e4 3192 int i;
1da177e4
LT
3193 int err = proto_register(&netlink_proto, 0);
3194
3195 if (err != 0)
3196 goto out;
3197
fab25745 3198 BUILD_BUG_ON(sizeof(struct netlink_skb_parms) > FIELD_SIZEOF(struct sk_buff, cb));
1da177e4 3199
0da974f4 3200 nl_table = kcalloc(MAX_LINKS, sizeof(*nl_table), GFP_KERNEL);
fab2caf6
AM
3201 if (!nl_table)
3202 goto panic;
1da177e4 3203
1da177e4 3204 for (i = 0; i < MAX_LINKS; i++) {
c428ecd1
HX
3205 if (rhashtable_init(&nl_table[i].hash,
3206 &netlink_rhashtable_params) < 0) {
e341694e
TG
3207 while (--i > 0)
3208 rhashtable_destroy(&nl_table[i].hash);
1da177e4 3209 kfree(nl_table);
fab2caf6 3210 goto panic;
1da177e4 3211 }
1da177e4
LT
3212 }
3213
bcbde0d4
DB
3214 INIT_LIST_HEAD(&netlink_tap_all);
3215
b963ea89
DM
3216 netlink_add_usersock_entry();
3217
1da177e4 3218 sock_register(&netlink_family_ops);
b4b51029 3219 register_pernet_subsys(&netlink_net_ops);
746fac4d 3220 /* The netlink device handler may be needed early. */
1da177e4
LT
3221 rtnetlink_init();
3222out:
3223 return err;
fab2caf6
AM
3224panic:
3225 panic("netlink_init: Cannot allocate nl_table\n");
1da177e4
LT
3226}
3227
1da177e4 3228core_initcall(netlink_proto_init);