Merge branch 'net-bool'
[deliverable/linux.git] / net / core / sock_diag.c
CommitLineData
8ef874bf
PE
1#include <linux/mutex.h>
2#include <linux/socket.h>
3#include <linux/skbuff.h>
4#include <net/netlink.h>
5#include <net/net_namespace.h>
6#include <linux/module.h>
5d2e5f27 7#include <net/sock.h>
eb4cb008
CG
8#include <linux/kernel.h>
9#include <linux/tcp.h>
10#include <linux/workqueue.h>
8ef874bf
PE
11
12#include <linux/inet_diag.h>
13#include <linux/sock_diag.h>
14
8dcf01fc 15static const struct sock_diag_handler *sock_diag_handlers[AF_MAX];
8ef874bf
PE
16static int (*inet_rcv_compat)(struct sk_buff *skb, struct nlmsghdr *nlh);
17static DEFINE_MUTEX(sock_diag_table_mutex);
eb4cb008 18static struct workqueue_struct *broadcast_wq;
8ef874bf 19
33cf7c90 20static u64 sock_gen_cookie(struct sock *sk)
f65c1b53 21{
33cf7c90
ED
22 while (1) {
23 u64 res = atomic64_read(&sk->sk_cookie);
24
25 if (res)
26 return res;
27 res = atomic64_inc_return(&sock_net(sk)->cookie_gen);
28 atomic64_cmpxchg(&sk->sk_cookie, 0, res);
29 }
30}
31
32int sock_diag_check_cookie(struct sock *sk, const __u32 *cookie)
33{
34 u64 res;
35
36 if (cookie[0] == INET_DIAG_NOCOOKIE && cookie[1] == INET_DIAG_NOCOOKIE)
f65c1b53 37 return 0;
33cf7c90
ED
38
39 res = sock_gen_cookie(sk);
40 if ((u32)res != cookie[0] || (u32)(res >> 32) != cookie[1])
41 return -ESTALE;
42
43 return 0;
f65c1b53
PE
44}
45EXPORT_SYMBOL_GPL(sock_diag_check_cookie);
46
33cf7c90 47void sock_diag_save_cookie(struct sock *sk, __u32 *cookie)
f65c1b53 48{
33cf7c90
ED
49 u64 res = sock_gen_cookie(sk);
50
51 cookie[0] = (u32)res;
52 cookie[1] = (u32)(res >> 32);
f65c1b53
PE
53}
54EXPORT_SYMBOL_GPL(sock_diag_save_cookie);
55
5d2e5f27
PE
56int sock_diag_put_meminfo(struct sock *sk, struct sk_buff *skb, int attrtype)
57{
7b46866d 58 u32 mem[SK_MEMINFO_VARS];
5d2e5f27
PE
59
60 mem[SK_MEMINFO_RMEM_ALLOC] = sk_rmem_alloc_get(sk);
61 mem[SK_MEMINFO_RCVBUF] = sk->sk_rcvbuf;
62 mem[SK_MEMINFO_WMEM_ALLOC] = sk_wmem_alloc_get(sk);
63 mem[SK_MEMINFO_SNDBUF] = sk->sk_sndbuf;
64 mem[SK_MEMINFO_FWD_ALLOC] = sk->sk_forward_alloc;
65 mem[SK_MEMINFO_WMEM_QUEUED] = sk->sk_wmem_queued;
66 mem[SK_MEMINFO_OPTMEM] = atomic_read(&sk->sk_omem_alloc);
d594e987 67 mem[SK_MEMINFO_BACKLOG] = sk->sk_backlog.len;
5d2e5f27 68
7b46866d 69 return nla_put(skb, attrtype, sizeof(mem), &mem);
5d2e5f27
PE
70}
71EXPORT_SYMBOL_GPL(sock_diag_put_meminfo);
72
a53b72c8 73int sock_diag_put_filterinfo(bool may_report_filterinfo, struct sock *sk,
e8d9612c
ND
74 struct sk_buff *skb, int attrtype)
75{
a3ea269b 76 struct sock_fprog_kern *fprog;
e8d9612c 77 struct sk_filter *filter;
a3ea269b
DB
78 struct nlattr *attr;
79 unsigned int flen;
e8d9612c
ND
80 int err = 0;
81
a53b72c8 82 if (!may_report_filterinfo) {
e8d9612c
ND
83 nla_reserve(skb, attrtype, 0);
84 return 0;
85 }
86
87 rcu_read_lock();
e8d9612c 88 filter = rcu_dereference(sk->sk_filter);
a3ea269b
DB
89 if (!filter)
90 goto out;
e8d9612c 91
7ae457c1 92 fprog = filter->prog->orig_prog;
b382c086
DB
93 if (!fprog)
94 goto out;
95
009937e7 96 flen = bpf_classic_proglen(fprog);
a3ea269b
DB
97
98 attr = nla_reserve(skb, attrtype, flen);
e8d9612c
ND
99 if (attr == NULL) {
100 err = -EMSGSIZE;
101 goto out;
102 }
103
a3ea269b 104 memcpy(nla_data(attr), fprog->filter, flen);
e8d9612c
ND
105out:
106 rcu_read_unlock();
107 return err;
108}
109EXPORT_SYMBOL(sock_diag_put_filterinfo);
110
eb4cb008
CG
111struct broadcast_sk {
112 struct sock *sk;
113 struct work_struct work;
114};
115
116static size_t sock_diag_nlmsg_size(void)
117{
118 return NLMSG_ALIGN(sizeof(struct inet_diag_msg)
119 + nla_total_size(sizeof(u8)) /* INET_DIAG_PROTOCOL */
120 + nla_total_size(sizeof(struct tcp_info))); /* INET_DIAG_INFO */
121}
122
123static void sock_diag_broadcast_destroy_work(struct work_struct *work)
124{
125 struct broadcast_sk *bsk =
126 container_of(work, struct broadcast_sk, work);
127 struct sock *sk = bsk->sk;
128 const struct sock_diag_handler *hndl;
129 struct sk_buff *skb;
130 const enum sknetlink_groups group = sock_diag_destroy_group(sk);
131 int err = -1;
132
133 WARN_ON(group == SKNLGRP_NONE);
134
135 skb = nlmsg_new(sock_diag_nlmsg_size(), GFP_KERNEL);
136 if (!skb)
137 goto out;
138
139 mutex_lock(&sock_diag_table_mutex);
140 hndl = sock_diag_handlers[sk->sk_family];
141 if (hndl && hndl->get_info)
142 err = hndl->get_info(skb, sk);
143 mutex_unlock(&sock_diag_table_mutex);
144
145 if (!err)
146 nlmsg_multicast(sock_net(sk)->diag_nlsk, skb, 0, group,
147 GFP_KERNEL);
148 else
149 kfree_skb(skb);
150out:
151 sk_destruct(sk);
152 kfree(bsk);
153}
154
155void sock_diag_broadcast_destroy(struct sock *sk)
156{
157 /* Note, this function is often called from an interrupt context. */
158 struct broadcast_sk *bsk =
159 kmalloc(sizeof(struct broadcast_sk), GFP_ATOMIC);
160 if (!bsk)
161 return sk_destruct(sk);
162 bsk->sk = sk;
163 INIT_WORK(&bsk->work, sock_diag_broadcast_destroy_work);
164 queue_work(broadcast_wq, &bsk->work);
165}
166
8ef874bf
PE
167void sock_diag_register_inet_compat(int (*fn)(struct sk_buff *skb, struct nlmsghdr *nlh))
168{
169 mutex_lock(&sock_diag_table_mutex);
170 inet_rcv_compat = fn;
171 mutex_unlock(&sock_diag_table_mutex);
172}
173EXPORT_SYMBOL_GPL(sock_diag_register_inet_compat);
174
175void sock_diag_unregister_inet_compat(int (*fn)(struct sk_buff *skb, struct nlmsghdr *nlh))
176{
177 mutex_lock(&sock_diag_table_mutex);
178 inet_rcv_compat = NULL;
179 mutex_unlock(&sock_diag_table_mutex);
180}
181EXPORT_SYMBOL_GPL(sock_diag_unregister_inet_compat);
182
8dcf01fc 183int sock_diag_register(const struct sock_diag_handler *hndl)
8ef874bf
PE
184{
185 int err = 0;
186
6f8e4ad0 187 if (hndl->family >= AF_MAX)
8ef874bf
PE
188 return -EINVAL;
189
190 mutex_lock(&sock_diag_table_mutex);
191 if (sock_diag_handlers[hndl->family])
192 err = -EBUSY;
193 else
194 sock_diag_handlers[hndl->family] = hndl;
195 mutex_unlock(&sock_diag_table_mutex);
196
197 return err;
198}
199EXPORT_SYMBOL_GPL(sock_diag_register);
200
8dcf01fc 201void sock_diag_unregister(const struct sock_diag_handler *hnld)
8ef874bf
PE
202{
203 int family = hnld->family;
204
6f8e4ad0 205 if (family >= AF_MAX)
8ef874bf
PE
206 return;
207
208 mutex_lock(&sock_diag_table_mutex);
209 BUG_ON(sock_diag_handlers[family] != hnld);
210 sock_diag_handlers[family] = NULL;
211 mutex_unlock(&sock_diag_table_mutex);
212}
213EXPORT_SYMBOL_GPL(sock_diag_unregister);
214
8ef874bf
PE
215static int __sock_diag_rcv_msg(struct sk_buff *skb, struct nlmsghdr *nlh)
216{
217 int err;
7b46866d 218 struct sock_diag_req *req = nlmsg_data(nlh);
8dcf01fc 219 const struct sock_diag_handler *hndl;
8ef874bf
PE
220
221 if (nlmsg_len(nlh) < sizeof(*req))
222 return -EINVAL;
223
6e601a53
MK
224 if (req->sdiag_family >= AF_MAX)
225 return -EINVAL;
226
8e904550
MK
227 if (sock_diag_handlers[req->sdiag_family] == NULL)
228 request_module("net-pf-%d-proto-%d-type-%d", PF_NETLINK,
229 NETLINK_SOCK_DIAG, req->sdiag_family);
230
231 mutex_lock(&sock_diag_table_mutex);
232 hndl = sock_diag_handlers[req->sdiag_family];
8ef874bf
PE
233 if (hndl == NULL)
234 err = -ENOENT;
235 else
236 err = hndl->dump(skb, nlh);
8e904550 237 mutex_unlock(&sock_diag_table_mutex);
8ef874bf
PE
238
239 return err;
240}
241
242static int sock_diag_rcv_msg(struct sk_buff *skb, struct nlmsghdr *nlh)
243{
244 int ret;
245
246 switch (nlh->nlmsg_type) {
247 case TCPDIAG_GETSOCK:
248 case DCCPDIAG_GETSOCK:
249 if (inet_rcv_compat == NULL)
250 request_module("net-pf-%d-proto-%d-type-%d", PF_NETLINK,
aec8dc62 251 NETLINK_SOCK_DIAG, AF_INET);
8ef874bf
PE
252
253 mutex_lock(&sock_diag_table_mutex);
254 if (inet_rcv_compat != NULL)
255 ret = inet_rcv_compat(skb, nlh);
256 else
257 ret = -EOPNOTSUPP;
258 mutex_unlock(&sock_diag_table_mutex);
259
260 return ret;
261 case SOCK_DIAG_BY_FAMILY:
262 return __sock_diag_rcv_msg(skb, nlh);
263 default:
264 return -EINVAL;
265 }
266}
267
268static DEFINE_MUTEX(sock_diag_mutex);
269
270static void sock_diag_rcv(struct sk_buff *skb)
271{
272 mutex_lock(&sock_diag_mutex);
273 netlink_rcv_skb(skb, &sock_diag_rcv_msg);
274 mutex_unlock(&sock_diag_mutex);
275}
276
eb4cb008
CG
277static int sock_diag_bind(struct net *net, int group)
278{
279 switch (group) {
280 case SKNLGRP_INET_TCP_DESTROY:
281 case SKNLGRP_INET_UDP_DESTROY:
282 if (!sock_diag_handlers[AF_INET])
283 request_module("net-pf-%d-proto-%d-type-%d", PF_NETLINK,
284 NETLINK_SOCK_DIAG, AF_INET);
285 break;
286 case SKNLGRP_INET6_TCP_DESTROY:
287 case SKNLGRP_INET6_UDP_DESTROY:
288 if (!sock_diag_handlers[AF_INET6])
289 request_module("net-pf-%d-proto-%d-type-%d", PF_NETLINK,
290 NETLINK_SOCK_DIAG, AF_INET);
291 break;
292 }
293 return 0;
294}
295
51d7cccf 296static int __net_init diag_net_init(struct net *net)
8ef874bf 297{
a31f2d17 298 struct netlink_kernel_cfg cfg = {
eb4cb008 299 .groups = SKNLGRP_MAX,
a31f2d17 300 .input = sock_diag_rcv,
eb4cb008
CG
301 .bind = sock_diag_bind,
302 .flags = NL_CFG_F_NONROOT_RECV,
a31f2d17
PNA
303 };
304
9f00d977 305 net->diag_nlsk = netlink_kernel_create(net, NETLINK_SOCK_DIAG, &cfg);
51d7cccf
AV
306 return net->diag_nlsk == NULL ? -ENOMEM : 0;
307}
308
309static void __net_exit diag_net_exit(struct net *net)
310{
311 netlink_kernel_release(net->diag_nlsk);
312 net->diag_nlsk = NULL;
313}
314
315static struct pernet_operations diag_net_ops = {
316 .init = diag_net_init,
317 .exit = diag_net_exit,
318};
319
320static int __init sock_diag_init(void)
321{
eb4cb008
CG
322 broadcast_wq = alloc_workqueue("sock_diag_events", 0, 0);
323 BUG_ON(!broadcast_wq);
51d7cccf 324 return register_pernet_subsys(&diag_net_ops);
8ef874bf
PE
325}
326
327static void __exit sock_diag_exit(void)
328{
51d7cccf 329 unregister_pernet_subsys(&diag_net_ops);
eb4cb008 330 destroy_workqueue(broadcast_wq);
8ef874bf
PE
331}
332
333module_init(sock_diag_init);
334module_exit(sock_diag_exit);
335MODULE_LICENSE("GPL");
336MODULE_ALIAS_NET_PF_PROTO(PF_NETLINK, NETLINK_SOCK_DIAG);
This page took 0.213765 seconds and 5 git commands to generate.