Commit | Line | Data |
---|---|---|
2874c5fd | 1 | // SPDX-License-Identifier: GPL-2.0-or-later |
52b7c59b PE |
2 | /* |
3 | * udp_diag.c Module for monitoring UDP transport protocols sockets. | |
4 | * | |
5 | * Authors: Pavel Emelyanov, <xemul@parallels.com> | |
52b7c59b PE |
6 | */ |
7 | ||
8 | ||
9 | #include <linux/module.h> | |
10 | #include <linux/inet_diag.h> | |
11 | #include <linux/udp.h> | |
12 | #include <net/udp.h> | |
13 | #include <net/udplite.h> | |
52b7c59b PE |
14 | #include <linux/sock_diag.h> |
15 | ||
b6d640c2 | 16 | static int sk_diag_dump(struct sock *sk, struct sk_buff *skb, |
34160ea3 ED |
17 | struct netlink_callback *cb, |
18 | const struct inet_diag_req_v2 *req, | |
d545caca | 19 | struct nlattr *bc, bool net_admin) |
b6d640c2 PE |
20 | { |
21 | if (!inet_diag_bc_sk(bc, sk)) | |
22 | return 0; | |
23 | ||
5682d393 MKL |
24 | return inet_sk_diag_fill(sk, NULL, skb, cb, req, NLM_F_MULTI, |
25 | net_admin); | |
b6d640c2 PE |
26 | } |
27 | ||
5682d393 MKL |
28 | static int udp_dump_one(struct udp_table *tbl, |
29 | struct netlink_callback *cb, | |
34160ea3 | 30 | const struct inet_diag_req_v2 *req) |
52b7c59b | 31 | { |
5682d393 | 32 | struct sk_buff *in_skb = cb->skb; |
6e822c2c | 33 | int err; |
ca065d0c | 34 | struct sock *sk = NULL; |
a925aa00 | 35 | struct sk_buff *rep; |
51d7cccf | 36 | struct net *net = sock_net(in_skb->sk); |
a925aa00 | 37 | |
ca065d0c | 38 | rcu_read_lock(); |
a925aa00 | 39 | if (req->sdiag_family == AF_INET) |
747569b0 | 40 | /* src and dst are swapped for historical reasons */ |
51d7cccf | 41 | sk = __udp4_lib_lookup(net, |
a925aa00 PE |
42 | req->id.idiag_src[0], req->id.idiag_sport, |
43 | req->id.idiag_dst[0], req->id.idiag_dport, | |
fb74c277 | 44 | req->id.idiag_if, 0, tbl, NULL); |
86e62ad6 | 45 | #if IS_ENABLED(CONFIG_IPV6) |
a925aa00 | 46 | else if (req->sdiag_family == AF_INET6) |
51d7cccf | 47 | sk = __udp6_lib_lookup(net, |
a925aa00 PE |
48 | (struct in6_addr *)req->id.idiag_src, |
49 | req->id.idiag_sport, | |
50 | (struct in6_addr *)req->id.idiag_dst, | |
51 | req->id.idiag_dport, | |
1801b570 | 52 | req->id.idiag_if, 0, tbl, NULL); |
86e62ad6 | 53 | #endif |
41c6d650 | 54 | if (sk && !refcount_inc_not_zero(&sk->sk_refcnt)) |
ca065d0c ED |
55 | sk = NULL; |
56 | rcu_read_unlock(); | |
a925aa00 | 57 | err = -ENOENT; |
51456b29 | 58 | if (!sk) |
a925aa00 PE |
59 | goto out_nosk; |
60 | ||
f65c1b53 | 61 | err = sock_diag_check_cookie(sk, req->id.idiag_cookie); |
a925aa00 PE |
62 | if (err) |
63 | goto out; | |
64 | ||
65 | err = -ENOMEM; | |
83f73c5b DY |
66 | rep = nlmsg_new(nla_total_size(sizeof(struct inet_diag_msg)) + |
67 | inet_diag_msg_attrs_size() + | |
68 | nla_total_size(sizeof(struct inet_diag_meminfo)) + 64, | |
573ce260 | 69 | GFP_KERNEL); |
a925aa00 PE |
70 | if (!rep) |
71 | goto out; | |
72 | ||
5682d393 MKL |
73 | err = inet_sk_diag_fill(sk, NULL, rep, cb, req, 0, |
74 | netlink_net_capable(in_skb, CAP_NET_ADMIN)); | |
a925aa00 PE |
75 | if (err < 0) { |
76 | WARN_ON(err == -EMSGSIZE); | |
77 | kfree_skb(rep); | |
78 | goto out; | |
79 | } | |
01757f53 YD |
80 | err = nlmsg_unicast(net->diag_nlsk, rep, NETLINK_CB(in_skb).portid); |
81 | ||
a925aa00 PE |
82 | out: |
83 | if (sk) | |
84 | sock_put(sk); | |
85 | out_nosk: | |
86 | return err; | |
52b7c59b PE |
87 | } |
88 | ||
34160ea3 ED |
89 | static void udp_dump(struct udp_table *table, struct sk_buff *skb, |
90 | struct netlink_callback *cb, | |
0df6d328 | 91 | const struct inet_diag_req_v2 *r) |
52b7c59b | 92 | { |
d545caca | 93 | bool net_admin = netlink_net_capable(cb->skb, CAP_NET_ADMIN); |
51d7cccf | 94 | struct net *net = sock_net(skb->sk); |
0df6d328 | 95 | struct inet_diag_dump_data *cb_data; |
ca065d0c | 96 | int num, s_num, slot, s_slot; |
0df6d328 | 97 | struct nlattr *bc; |
b6d640c2 | 98 | |
0df6d328 MKL |
99 | cb_data = cb->data; |
100 | bc = cb_data->inet_diag_nla_bc; | |
b6d640c2 PE |
101 | s_slot = cb->args[0]; |
102 | num = s_num = cb->args[1]; | |
103 | ||
86f3cddb | 104 | for (slot = s_slot; slot <= table->mask; s_num = 0, slot++) { |
b6d640c2 | 105 | struct udp_hslot *hslot = &table->hash[slot]; |
ca065d0c | 106 | struct sock *sk; |
b6d640c2 | 107 | |
86f3cddb HX |
108 | num = 0; |
109 | ||
ca065d0c | 110 | if (hlist_empty(&hslot->head)) |
b6d640c2 PE |
111 | continue; |
112 | ||
113 | spin_lock_bh(&hslot->lock); | |
ca065d0c | 114 | sk_for_each(sk, &hslot->head) { |
b6d640c2 PE |
115 | struct inet_sock *inet = inet_sk(sk); |
116 | ||
51d7cccf AV |
117 | if (!net_eq(sock_net(sk), net)) |
118 | continue; | |
b6d640c2 PE |
119 | if (num < s_num) |
120 | goto next; | |
121 | if (!(r->idiag_states & (1 << sk->sk_state))) | |
122 | goto next; | |
123 | if (r->sdiag_family != AF_UNSPEC && | |
124 | sk->sk_family != r->sdiag_family) | |
125 | goto next; | |
126 | if (r->id.idiag_sport != inet->inet_sport && | |
127 | r->id.idiag_sport) | |
128 | goto next; | |
129 | if (r->id.idiag_dport != inet->inet_dport && | |
130 | r->id.idiag_dport) | |
131 | goto next; | |
132 | ||
d545caca | 133 | if (sk_diag_dump(sk, skb, cb, r, bc, net_admin) < 0) { |
b6d640c2 PE |
134 | spin_unlock_bh(&hslot->lock); |
135 | goto done; | |
136 | } | |
137 | next: | |
138 | num++; | |
139 | } | |
140 | spin_unlock_bh(&hslot->lock); | |
141 | } | |
142 | done: | |
143 | cb->args[0] = slot; | |
144 | cb->args[1] = num; | |
52b7c59b PE |
145 | } |
146 | ||
147 | static void udp_diag_dump(struct sk_buff *skb, struct netlink_callback *cb, | |
0df6d328 | 148 | const struct inet_diag_req_v2 *r) |
52b7c59b | 149 | { |
0df6d328 | 150 | udp_dump(&udp_table, skb, cb, r); |
52b7c59b PE |
151 | } |
152 | ||
5682d393 | 153 | static int udp_diag_dump_one(struct netlink_callback *cb, |
34160ea3 | 154 | const struct inet_diag_req_v2 *req) |
52b7c59b | 155 | { |
5682d393 | 156 | return udp_dump_one(&udp_table, cb, req); |
52b7c59b PE |
157 | } |
158 | ||
62ad6fcd SW |
159 | static void udp_diag_get_info(struct sock *sk, struct inet_diag_msg *r, |
160 | void *info) | |
161 | { | |
6c206b20 | 162 | r->idiag_rqueue = udp_rqueue_get(sk); |
62ad6fcd SW |
163 | r->idiag_wqueue = sk_wmem_alloc_get(sk); |
164 | } | |
165 | ||
5d77dca8 DA |
166 | #ifdef CONFIG_INET_DIAG_DESTROY |
167 | static int __udp_diag_destroy(struct sk_buff *in_skb, | |
168 | const struct inet_diag_req_v2 *req, | |
169 | struct udp_table *tbl) | |
170 | { | |
171 | struct net *net = sock_net(in_skb->sk); | |
172 | struct sock *sk; | |
173 | int err; | |
174 | ||
175 | rcu_read_lock(); | |
176 | ||
177 | if (req->sdiag_family == AF_INET) | |
178 | sk = __udp4_lib_lookup(net, | |
179 | req->id.idiag_dst[0], req->id.idiag_dport, | |
180 | req->id.idiag_src[0], req->id.idiag_sport, | |
fb74c277 | 181 | req->id.idiag_if, 0, tbl, NULL); |
5d77dca8 DA |
182 | #if IS_ENABLED(CONFIG_IPV6) |
183 | else if (req->sdiag_family == AF_INET6) { | |
184 | if (ipv6_addr_v4mapped((struct in6_addr *)req->id.idiag_dst) && | |
185 | ipv6_addr_v4mapped((struct in6_addr *)req->id.idiag_src)) | |
186 | sk = __udp4_lib_lookup(net, | |
f95bf346 LC |
187 | req->id.idiag_dst[3], req->id.idiag_dport, |
188 | req->id.idiag_src[3], req->id.idiag_sport, | |
fb74c277 | 189 | req->id.idiag_if, 0, tbl, NULL); |
5d77dca8 DA |
190 | |
191 | else | |
192 | sk = __udp6_lib_lookup(net, | |
193 | (struct in6_addr *)req->id.idiag_dst, | |
194 | req->id.idiag_dport, | |
195 | (struct in6_addr *)req->id.idiag_src, | |
196 | req->id.idiag_sport, | |
1801b570 | 197 | req->id.idiag_if, 0, tbl, NULL); |
5d77dca8 DA |
198 | } |
199 | #endif | |
200 | else { | |
201 | rcu_read_unlock(); | |
202 | return -EINVAL; | |
203 | } | |
204 | ||
41c6d650 | 205 | if (sk && !refcount_inc_not_zero(&sk->sk_refcnt)) |
5d77dca8 DA |
206 | sk = NULL; |
207 | ||
208 | rcu_read_unlock(); | |
209 | ||
210 | if (!sk) | |
211 | return -ENOENT; | |
212 | ||
213 | if (sock_diag_check_cookie(sk, req->id.idiag_cookie)) { | |
214 | sock_put(sk); | |
215 | return -ENOENT; | |
216 | } | |
217 | ||
218 | err = sock_diag_destroy(sk, ECONNABORTED); | |
219 | ||
220 | sock_put(sk); | |
221 | ||
222 | return err; | |
223 | } | |
224 | ||
225 | static int udp_diag_destroy(struct sk_buff *in_skb, | |
226 | const struct inet_diag_req_v2 *req) | |
227 | { | |
228 | return __udp_diag_destroy(in_skb, req, &udp_table); | |
229 | } | |
230 | ||
231 | static int udplite_diag_destroy(struct sk_buff *in_skb, | |
232 | const struct inet_diag_req_v2 *req) | |
233 | { | |
234 | return __udp_diag_destroy(in_skb, req, &udplite_table); | |
235 | } | |
236 | ||
237 | #endif | |
238 | ||
52b7c59b PE |
239 | static const struct inet_diag_handler udp_diag_handler = { |
240 | .dump = udp_diag_dump, | |
241 | .dump_one = udp_diag_dump_one, | |
62ad6fcd | 242 | .idiag_get_info = udp_diag_get_info, |
52b7c59b | 243 | .idiag_type = IPPROTO_UDP, |
3fd22af8 | 244 | .idiag_info_size = 0, |
5d77dca8 DA |
245 | #ifdef CONFIG_INET_DIAG_DESTROY |
246 | .destroy = udp_diag_destroy, | |
247 | #endif | |
52b7c59b PE |
248 | }; |
249 | ||
250 | static void udplite_diag_dump(struct sk_buff *skb, struct netlink_callback *cb, | |
0df6d328 | 251 | const struct inet_diag_req_v2 *r) |
52b7c59b | 252 | { |
0df6d328 | 253 | udp_dump(&udplite_table, skb, cb, r); |
52b7c59b PE |
254 | } |
255 | ||
5682d393 | 256 | static int udplite_diag_dump_one(struct netlink_callback *cb, |
34160ea3 | 257 | const struct inet_diag_req_v2 *req) |
52b7c59b | 258 | { |
5682d393 | 259 | return udp_dump_one(&udplite_table, cb, req); |
52b7c59b PE |
260 | } |
261 | ||
262 | static const struct inet_diag_handler udplite_diag_handler = { | |
263 | .dump = udplite_diag_dump, | |
264 | .dump_one = udplite_diag_dump_one, | |
62ad6fcd | 265 | .idiag_get_info = udp_diag_get_info, |
52b7c59b | 266 | .idiag_type = IPPROTO_UDPLITE, |
3fd22af8 | 267 | .idiag_info_size = 0, |
5d77dca8 DA |
268 | #ifdef CONFIG_INET_DIAG_DESTROY |
269 | .destroy = udplite_diag_destroy, | |
270 | #endif | |
52b7c59b PE |
271 | }; |
272 | ||
273 | static int __init udp_diag_init(void) | |
274 | { | |
275 | int err; | |
276 | ||
277 | err = inet_diag_register(&udp_diag_handler); | |
278 | if (err) | |
279 | goto out; | |
280 | err = inet_diag_register(&udplite_diag_handler); | |
281 | if (err) | |
282 | goto out_lite; | |
283 | out: | |
284 | return err; | |
285 | out_lite: | |
286 | inet_diag_unregister(&udp_diag_handler); | |
287 | goto out; | |
288 | } | |
289 | ||
290 | static void __exit udp_diag_exit(void) | |
291 | { | |
292 | inet_diag_unregister(&udplite_diag_handler); | |
293 | inet_diag_unregister(&udp_diag_handler); | |
294 | } | |
295 | ||
296 | module_init(udp_diag_init); | |
297 | module_exit(udp_diag_exit); | |
298 | MODULE_LICENSE("GPL"); | |
aec8dc62 PE |
299 | MODULE_ALIAS_NET_PF_PROTO_TYPE(PF_NETLINK, NETLINK_SOCK_DIAG, 2-17 /* AF_INET - IPPROTO_UDP */); |
300 | MODULE_ALIAS_NET_PF_PROTO_TYPE(PF_NETLINK, NETLINK_SOCK_DIAG, 2-136 /* AF_INET - IPPROTO_UDPLITE */); |