1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * Copyright (C) 2016 Namjae Jeon <linkinjeon@kernel.org>
4 * Copyright (C) 2018 Samsung Electronics Co., Ltd.
5 */
6
7 #include <linux/freezer.h>
8
9 #include "smb_common.h"
10 #include "server.h"
11 #include "auth.h"
12 #include "connection.h"
13 #include "transport_tcp.h"
14
15 #define IFACE_STATE_DOWN BIT(0)
16 #define IFACE_STATE_CONFIGURED BIT(1)
17
18 static atomic_t active_num_conn;
19
20 struct interface {
21 struct task_struct *ksmbd_kthread;
22 struct socket *ksmbd_socket;
23 struct list_head entry;
24 char *name;
25 struct mutex sock_release_lock;
26 int state;
27 };
28
29 static LIST_HEAD(iface_list);
30
31 static int bind_additional_ifaces;
32
33 struct tcp_transport {
34 struct ksmbd_transport transport;
35 struct socket *sock;
36 struct kvec *iov;
37 unsigned int nr_iov;
38 };
39
40 static struct ksmbd_transport_ops ksmbd_tcp_transport_ops;
41
42 static void tcp_stop_kthread(struct task_struct *kthread);
43 static struct interface *alloc_iface(char *ifname);
44
45 #define KSMBD_TRANS(t) (&(t)->transport)
46 #define TCP_TRANS(t) ((struct tcp_transport *)container_of(t, \
47 struct tcp_transport, transport))
48
ksmbd_tcp_nodelay(struct socket * sock)49 static inline void ksmbd_tcp_nodelay(struct socket *sock)
50 {
51 tcp_sock_set_nodelay(sock->sk);
52 }
53
ksmbd_tcp_reuseaddr(struct socket * sock)54 static inline void ksmbd_tcp_reuseaddr(struct socket *sock)
55 {
56 sock_set_reuseaddr(sock->sk);
57 }
58
ksmbd_tcp_rcv_timeout(struct socket * sock,s64 secs)59 static inline void ksmbd_tcp_rcv_timeout(struct socket *sock, s64 secs)
60 {
61 lock_sock(sock->sk);
62 if (secs && secs < MAX_SCHEDULE_TIMEOUT / HZ - 1)
63 sock->sk->sk_rcvtimeo = secs * HZ;
64 else
65 sock->sk->sk_rcvtimeo = MAX_SCHEDULE_TIMEOUT;
66 release_sock(sock->sk);
67 }
68
ksmbd_tcp_snd_timeout(struct socket * sock,s64 secs)69 static inline void ksmbd_tcp_snd_timeout(struct socket *sock, s64 secs)
70 {
71 sock_set_sndtimeo(sock->sk, secs);
72 }
73
alloc_transport(struct socket * client_sk)74 static struct tcp_transport *alloc_transport(struct socket *client_sk)
75 {
76 struct tcp_transport *t;
77 struct ksmbd_conn *conn;
78
79 t = kzalloc(sizeof(*t), GFP_KERNEL);
80 if (!t)
81 return NULL;
82 t->sock = client_sk;
83
84 conn = ksmbd_conn_alloc();
85 if (!conn) {
86 kfree(t);
87 return NULL;
88 }
89
90 conn->transport = KSMBD_TRANS(t);
91 KSMBD_TRANS(t)->conn = conn;
92 KSMBD_TRANS(t)->ops = &ksmbd_tcp_transport_ops;
93 return t;
94 }
95
free_transport(struct tcp_transport * t)96 static void free_transport(struct tcp_transport *t)
97 {
98 kernel_sock_shutdown(t->sock, SHUT_RDWR);
99 sock_release(t->sock);
100 t->sock = NULL;
101
102 ksmbd_conn_free(KSMBD_TRANS(t)->conn);
103 kfree(t->iov);
104 kfree(t);
105 }
106
107 /**
108 * kvec_array_init() - initialize a IO vector segment
109 * @new: IO vector to be initialized
110 * @iov: base IO vector
111 * @nr_segs: number of segments in base iov
112 * @bytes: total iovec length so far for read
113 *
114 * Return: Number of IO segments
115 */
kvec_array_init(struct kvec * new,struct kvec * iov,unsigned int nr_segs,size_t bytes)116 static unsigned int kvec_array_init(struct kvec *new, struct kvec *iov,
117 unsigned int nr_segs, size_t bytes)
118 {
119 size_t base = 0;
120
121 while (bytes || !iov->iov_len) {
122 int copy = min(bytes, iov->iov_len);
123
124 bytes -= copy;
125 base += copy;
126 if (iov->iov_len == base) {
127 iov++;
128 nr_segs--;
129 base = 0;
130 }
131 }
132
133 memcpy(new, iov, sizeof(*iov) * nr_segs);
134 new->iov_base += base;
135 new->iov_len -= base;
136 return nr_segs;
137 }
138
139 /**
140 * get_conn_iovec() - get connection iovec for reading from socket
141 * @t: TCP transport instance
142 * @nr_segs: number of segments in iov
143 *
144 * Return: return existing or newly allocate iovec
145 */
get_conn_iovec(struct tcp_transport * t,unsigned int nr_segs)146 static struct kvec *get_conn_iovec(struct tcp_transport *t, unsigned int nr_segs)
147 {
148 struct kvec *new_iov;
149
150 if (t->iov && nr_segs <= t->nr_iov)
151 return t->iov;
152
153 /* not big enough -- allocate a new one and release the old */
154 new_iov = kmalloc_array(nr_segs, sizeof(*new_iov), GFP_KERNEL);
155 if (new_iov) {
156 kfree(t->iov);
157 t->iov = new_iov;
158 t->nr_iov = nr_segs;
159 }
160 return new_iov;
161 }
162
ksmbd_tcp_get_port(const struct sockaddr * sa)163 static unsigned short ksmbd_tcp_get_port(const struct sockaddr *sa)
164 {
165 switch (sa->sa_family) {
166 case AF_INET:
167 return ntohs(((struct sockaddr_in *)sa)->sin_port);
168 case AF_INET6:
169 return ntohs(((struct sockaddr_in6 *)sa)->sin6_port);
170 }
171 return 0;
172 }
173
174 /**
175 * ksmbd_tcp_new_connection() - create a new tcp session on mount
176 * @client_sk: socket associated with new connection
177 *
178 * whenever a new connection is requested, create a conn thread
179 * (session thread) to handle new incoming smb requests from the connection
180 *
181 * Return: 0 on success, otherwise error
182 */
ksmbd_tcp_new_connection(struct socket * client_sk)183 static int ksmbd_tcp_new_connection(struct socket *client_sk)
184 {
185 struct sockaddr *csin;
186 int rc = 0;
187 struct tcp_transport *t;
188 struct task_struct *handler;
189
190 t = alloc_transport(client_sk);
191 if (!t) {
192 sock_release(client_sk);
193 return -ENOMEM;
194 }
195
196 csin = KSMBD_TCP_PEER_SOCKADDR(KSMBD_TRANS(t)->conn);
197 if (kernel_getpeername(client_sk, csin) < 0) {
198 pr_err("client ip resolution failed\n");
199 rc = -EINVAL;
200 goto out_error;
201 }
202
203 handler = kthread_run(ksmbd_conn_handler_loop,
204 KSMBD_TRANS(t)->conn,
205 "ksmbd:%u",
206 ksmbd_tcp_get_port(csin));
207 if (IS_ERR(handler)) {
208 pr_err("cannot start conn thread\n");
209 rc = PTR_ERR(handler);
210 free_transport(t);
211 }
212 return rc;
213
214 out_error:
215 free_transport(t);
216 return rc;
217 }
218
219 /**
220 * ksmbd_kthread_fn() - listen to new SMB connections and callback server
221 * @p: arguments to forker thread
222 *
223 * Return: 0 on success, error number otherwise
224 */
ksmbd_kthread_fn(void * p)225 static int ksmbd_kthread_fn(void *p)
226 {
227 struct socket *client_sk = NULL;
228 struct interface *iface = (struct interface *)p;
229 int ret;
230
231 while (!kthread_should_stop()) {
232 mutex_lock(&iface->sock_release_lock);
233 if (!iface->ksmbd_socket) {
234 mutex_unlock(&iface->sock_release_lock);
235 break;
236 }
237 ret = kernel_accept(iface->ksmbd_socket, &client_sk,
238 SOCK_NONBLOCK);
239 mutex_unlock(&iface->sock_release_lock);
240 if (ret) {
241 if (ret == -EAGAIN)
242 /* check for new connections every 100 msecs */
243 schedule_timeout_interruptible(HZ / 10);
244 continue;
245 }
246
247 if (server_conf.max_connections &&
248 atomic_inc_return(&active_num_conn) >= server_conf.max_connections) {
249 pr_info_ratelimited("Limit the maximum number of connections(%u)\n",
250 atomic_read(&active_num_conn));
251 atomic_dec(&active_num_conn);
252 sock_release(client_sk);
253 continue;
254 }
255
256 ksmbd_debug(CONN, "connect success: accepted new connection\n");
257 client_sk->sk->sk_rcvtimeo = KSMBD_TCP_RECV_TIMEOUT;
258 client_sk->sk->sk_sndtimeo = KSMBD_TCP_SEND_TIMEOUT;
259
260 ksmbd_tcp_new_connection(client_sk);
261 }
262
263 ksmbd_debug(CONN, "releasing socket\n");
264 return 0;
265 }
266
267 /**
268 * ksmbd_tcp_run_kthread() - start forker thread
269 * @iface: pointer to struct interface
270 *
271 * start forker thread(ksmbd/0) at module init time to listen
272 * on port 445 for new SMB connection requests. It creates per connection
273 * server threads(ksmbd/x)
274 *
275 * Return: 0 on success or error number
276 */
ksmbd_tcp_run_kthread(struct interface * iface)277 static int ksmbd_tcp_run_kthread(struct interface *iface)
278 {
279 int rc;
280 struct task_struct *kthread;
281
282 kthread = kthread_run(ksmbd_kthread_fn, (void *)iface, "ksmbd-%s",
283 iface->name);
284 if (IS_ERR(kthread)) {
285 rc = PTR_ERR(kthread);
286 return rc;
287 }
288 iface->ksmbd_kthread = kthread;
289
290 return 0;
291 }
292
293 /**
294 * ksmbd_tcp_readv() - read data from socket in given iovec
295 * @t: TCP transport instance
296 * @iov_orig: base IO vector
297 * @nr_segs: number of segments in base iov
298 * @to_read: number of bytes to read from socket
299 * @max_retries: maximum retry count
300 *
301 * Return: on success return number of bytes read from socket,
302 * otherwise return error number
303 */
ksmbd_tcp_readv(struct tcp_transport * t,struct kvec * iov_orig,unsigned int nr_segs,unsigned int to_read,int max_retries)304 static int ksmbd_tcp_readv(struct tcp_transport *t, struct kvec *iov_orig,
305 unsigned int nr_segs, unsigned int to_read,
306 int max_retries)
307 {
308 int length = 0;
309 int total_read;
310 unsigned int segs;
311 struct msghdr ksmbd_msg;
312 struct kvec *iov;
313 struct ksmbd_conn *conn = KSMBD_TRANS(t)->conn;
314
315 iov = get_conn_iovec(t, nr_segs);
316 if (!iov)
317 return -ENOMEM;
318
319 ksmbd_msg.msg_control = NULL;
320 ksmbd_msg.msg_controllen = 0;
321
322 for (total_read = 0; to_read; total_read += length, to_read -= length) {
323 try_to_freeze();
324
325 if (!ksmbd_conn_alive(conn)) {
326 total_read = -ESHUTDOWN;
327 break;
328 }
329 segs = kvec_array_init(iov, iov_orig, nr_segs, total_read);
330
331 length = kernel_recvmsg(t->sock, &ksmbd_msg,
332 iov, segs, to_read, 0);
333
334 if (length == -EINTR) {
335 total_read = -ESHUTDOWN;
336 break;
337 } else if (ksmbd_conn_need_reconnect(conn)) {
338 total_read = -EAGAIN;
339 break;
340 } else if (length == -ERESTARTSYS || length == -EAGAIN) {
341 /*
342 * If max_retries is negative, Allow unlimited
343 * retries to keep connection with inactive sessions.
344 */
345 if (max_retries == 0) {
346 total_read = length;
347 break;
348 } else if (max_retries > 0) {
349 max_retries--;
350 }
351
352 usleep_range(1000, 2000);
353 length = 0;
354 continue;
355 } else if (length <= 0) {
356 total_read = length;
357 break;
358 }
359 }
360 return total_read;
361 }
362
363 /**
364 * ksmbd_tcp_read() - read data from socket in given buffer
365 * @t: TCP transport instance
366 * @buf: buffer to store read data from socket
367 * @to_read: number of bytes to read from socket
368 * @max_retries: number of retries if reading from socket fails
369 *
370 * Return: on success return number of bytes read from socket,
371 * otherwise return error number
372 */
ksmbd_tcp_read(struct ksmbd_transport * t,char * buf,unsigned int to_read,int max_retries)373 static int ksmbd_tcp_read(struct ksmbd_transport *t, char *buf,
374 unsigned int to_read, int max_retries)
375 {
376 struct kvec iov;
377
378 iov.iov_base = buf;
379 iov.iov_len = to_read;
380
381 return ksmbd_tcp_readv(TCP_TRANS(t), &iov, 1, to_read, max_retries);
382 }
383
ksmbd_tcp_writev(struct ksmbd_transport * t,struct kvec * iov,int nvecs,int size,bool need_invalidate,unsigned int remote_key)384 static int ksmbd_tcp_writev(struct ksmbd_transport *t, struct kvec *iov,
385 int nvecs, int size, bool need_invalidate,
386 unsigned int remote_key)
387
388 {
389 struct msghdr smb_msg = {.msg_flags = MSG_NOSIGNAL};
390
391 return kernel_sendmsg(TCP_TRANS(t)->sock, &smb_msg, iov, nvecs, size);
392 }
393
ksmbd_tcp_disconnect(struct ksmbd_transport * t)394 static void ksmbd_tcp_disconnect(struct ksmbd_transport *t)
395 {
396 free_transport(TCP_TRANS(t));
397 if (server_conf.max_connections)
398 atomic_dec(&active_num_conn);
399 }
400
tcp_destroy_socket(struct socket * ksmbd_socket)401 static void tcp_destroy_socket(struct socket *ksmbd_socket)
402 {
403 int ret;
404
405 if (!ksmbd_socket)
406 return;
407
408 /* set zero to timeout */
409 ksmbd_tcp_rcv_timeout(ksmbd_socket, 0);
410 ksmbd_tcp_snd_timeout(ksmbd_socket, 0);
411
412 ret = kernel_sock_shutdown(ksmbd_socket, SHUT_RDWR);
413 if (ret)
414 pr_err("Failed to shutdown socket: %d\n", ret);
415 sock_release(ksmbd_socket);
416 }
417
418 /**
419 * create_socket - create socket for ksmbd/0
420 * @iface: interface to bind the created socket to
421 *
422 * Return: 0 on success, error number otherwise
423 */
create_socket(struct interface * iface)424 static int create_socket(struct interface *iface)
425 {
426 int ret;
427 struct sockaddr_in6 sin6;
428 struct sockaddr_in sin;
429 struct socket *ksmbd_socket;
430 bool ipv4 = false;
431
432 ret = sock_create(PF_INET6, SOCK_STREAM, IPPROTO_TCP, &ksmbd_socket);
433 if (ret) {
434 if (ret != -EAFNOSUPPORT)
435 pr_err("Can't create socket for ipv6, fallback to ipv4: %d\n", ret);
436 ret = sock_create(PF_INET, SOCK_STREAM, IPPROTO_TCP,
437 &ksmbd_socket);
438 if (ret) {
439 pr_err("Can't create socket for ipv4: %d\n", ret);
440 goto out_clear;
441 }
442
443 sin.sin_family = PF_INET;
444 sin.sin_addr.s_addr = htonl(INADDR_ANY);
445 sin.sin_port = htons(server_conf.tcp_port);
446 ipv4 = true;
447 } else {
448 sin6.sin6_family = PF_INET6;
449 sin6.sin6_addr = in6addr_any;
450 sin6.sin6_port = htons(server_conf.tcp_port);
451
452 lock_sock(ksmbd_socket->sk);
453 ksmbd_socket->sk->sk_ipv6only = false;
454 release_sock(ksmbd_socket->sk);
455 }
456
457 ksmbd_tcp_nodelay(ksmbd_socket);
458 ksmbd_tcp_reuseaddr(ksmbd_socket);
459
460 ret = sock_setsockopt(ksmbd_socket,
461 SOL_SOCKET,
462 SO_BINDTODEVICE,
463 KERNEL_SOCKPTR(iface->name),
464 strlen(iface->name));
465 if (ret != -ENODEV && ret < 0) {
466 pr_err("Failed to set SO_BINDTODEVICE: %d\n", ret);
467 goto out_error;
468 }
469
470 if (ipv4)
471 ret = kernel_bind(ksmbd_socket, (struct sockaddr *)&sin,
472 sizeof(sin));
473 else
474 ret = kernel_bind(ksmbd_socket, (struct sockaddr *)&sin6,
475 sizeof(sin6));
476 if (ret) {
477 pr_err("Failed to bind socket: %d\n", ret);
478 goto out_error;
479 }
480
481 ksmbd_socket->sk->sk_rcvtimeo = KSMBD_TCP_RECV_TIMEOUT;
482 ksmbd_socket->sk->sk_sndtimeo = KSMBD_TCP_SEND_TIMEOUT;
483
484 ret = kernel_listen(ksmbd_socket, KSMBD_SOCKET_BACKLOG);
485 if (ret) {
486 pr_err("Port listen() error: %d\n", ret);
487 goto out_error;
488 }
489
490 iface->ksmbd_socket = ksmbd_socket;
491 ret = ksmbd_tcp_run_kthread(iface);
492 if (ret) {
493 pr_err("Can't start ksmbd main kthread: %d\n", ret);
494 goto out_error;
495 }
496 iface->state = IFACE_STATE_CONFIGURED;
497
498 return 0;
499
500 out_error:
501 tcp_destroy_socket(ksmbd_socket);
502 out_clear:
503 iface->ksmbd_socket = NULL;
504 return ret;
505 }
506
ksmbd_netdev_event(struct notifier_block * nb,unsigned long event,void * ptr)507 static int ksmbd_netdev_event(struct notifier_block *nb, unsigned long event,
508 void *ptr)
509 {
510 struct net_device *netdev = netdev_notifier_info_to_dev(ptr);
511 struct interface *iface;
512 int ret, found = 0;
513
514 switch (event) {
515 case NETDEV_UP:
516 if (netif_is_bridge_port(netdev))
517 return NOTIFY_OK;
518
519 list_for_each_entry(iface, &iface_list, entry) {
520 if (!strcmp(iface->name, netdev->name)) {
521 found = 1;
522 if (iface->state != IFACE_STATE_DOWN)
523 break;
524 ret = create_socket(iface);
525 if (ret)
526 return NOTIFY_OK;
527 break;
528 }
529 }
530 if (!found && bind_additional_ifaces) {
531 iface = alloc_iface(kstrdup(netdev->name, GFP_KERNEL));
532 if (!iface)
533 return NOTIFY_OK;
534 ret = create_socket(iface);
535 if (ret)
536 break;
537 }
538 break;
539 case NETDEV_DOWN:
540 list_for_each_entry(iface, &iface_list, entry) {
541 if (!strcmp(iface->name, netdev->name) &&
542 iface->state == IFACE_STATE_CONFIGURED) {
543 tcp_stop_kthread(iface->ksmbd_kthread);
544 iface->ksmbd_kthread = NULL;
545 mutex_lock(&iface->sock_release_lock);
546 tcp_destroy_socket(iface->ksmbd_socket);
547 iface->ksmbd_socket = NULL;
548 mutex_unlock(&iface->sock_release_lock);
549
550 iface->state = IFACE_STATE_DOWN;
551 break;
552 }
553 }
554 break;
555 }
556
557 return NOTIFY_DONE;
558 }
559
560 static struct notifier_block ksmbd_netdev_notifier = {
561 .notifier_call = ksmbd_netdev_event,
562 };
563
ksmbd_tcp_init(void)564 int ksmbd_tcp_init(void)
565 {
566 register_netdevice_notifier(&ksmbd_netdev_notifier);
567
568 return 0;
569 }
570
tcp_stop_kthread(struct task_struct * kthread)571 static void tcp_stop_kthread(struct task_struct *kthread)
572 {
573 int ret;
574
575 if (!kthread)
576 return;
577
578 ret = kthread_stop(kthread);
579 if (ret)
580 pr_err("failed to stop forker thread\n");
581 }
582
ksmbd_tcp_destroy(void)583 void ksmbd_tcp_destroy(void)
584 {
585 struct interface *iface, *tmp;
586
587 unregister_netdevice_notifier(&ksmbd_netdev_notifier);
588
589 list_for_each_entry_safe(iface, tmp, &iface_list, entry) {
590 list_del(&iface->entry);
591 kfree(iface->name);
592 kfree(iface);
593 }
594 }
595
alloc_iface(char * ifname)596 static struct interface *alloc_iface(char *ifname)
597 {
598 struct interface *iface;
599
600 if (!ifname)
601 return NULL;
602
603 iface = kzalloc(sizeof(struct interface), GFP_KERNEL);
604 if (!iface) {
605 kfree(ifname);
606 return NULL;
607 }
608
609 iface->name = ifname;
610 iface->state = IFACE_STATE_DOWN;
611 list_add(&iface->entry, &iface_list);
612 mutex_init(&iface->sock_release_lock);
613 return iface;
614 }
615
ksmbd_tcp_set_interfaces(char * ifc_list,int ifc_list_sz)616 int ksmbd_tcp_set_interfaces(char *ifc_list, int ifc_list_sz)
617 {
618 int sz = 0;
619
620 if (!ifc_list_sz) {
621 struct net_device *netdev;
622
623 rtnl_lock();
624 for_each_netdev(&init_net, netdev) {
625 if (netif_is_bridge_port(netdev))
626 continue;
627 if (!alloc_iface(kstrdup(netdev->name, GFP_KERNEL))) {
628 rtnl_unlock();
629 return -ENOMEM;
630 }
631 }
632 rtnl_unlock();
633 bind_additional_ifaces = 1;
634 return 0;
635 }
636
637 while (ifc_list_sz > 0) {
638 if (!alloc_iface(kstrdup(ifc_list, GFP_KERNEL)))
639 return -ENOMEM;
640
641 sz = strlen(ifc_list);
642 if (!sz)
643 break;
644
645 ifc_list += sz + 1;
646 ifc_list_sz -= (sz + 1);
647 }
648
649 bind_additional_ifaces = 0;
650
651 return 0;
652 }
653
654 static struct ksmbd_transport_ops ksmbd_tcp_transport_ops = {
655 .read = ksmbd_tcp_read,
656 .writev = ksmbd_tcp_writev,
657 .disconnect = ksmbd_tcp_disconnect,
658 };
659