1d021c344SAndy King /* 2d021c344SAndy King * VMware vSockets Driver 3d021c344SAndy King * 4d021c344SAndy King * Copyright (C) 2007-2013 VMware, Inc. All rights reserved. 5d021c344SAndy King * 6d021c344SAndy King * This program is free software; you can redistribute it and/or modify it 7d021c344SAndy King * under the terms of the GNU General Public License as published by the Free 8d021c344SAndy King * Software Foundation version 2 and no later version. 9d021c344SAndy King * 10d021c344SAndy King * This program is distributed in the hope that it will be useful, but WITHOUT 11d021c344SAndy King * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or 12d021c344SAndy King * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for 13d021c344SAndy King * more details. 14d021c344SAndy King */ 15d021c344SAndy King 16d021c344SAndy King /* Implementation notes: 17d021c344SAndy King * 18d021c344SAndy King * - There are two kinds of sockets: those created by user action (such as 19d021c344SAndy King * calling socket(2)) and those created by incoming connection request packets. 20d021c344SAndy King * 21d021c344SAndy King * - There are two "global" tables, one for bound sockets (sockets that have 22d021c344SAndy King * specified an address that they are responsible for) and one for connected 23d021c344SAndy King * sockets (sockets that have established a connection with another socket). 24d021c344SAndy King * These tables are "global" in that all sockets on the system are placed 25d021c344SAndy King * within them. - Note, though, that the bound table contains an extra entry 26d021c344SAndy King * for a list of unbound sockets and SOCK_DGRAM sockets will always remain in 27d021c344SAndy King * that list. The bound table is used solely for lookup of sockets when packets 28d021c344SAndy King * are received and that's not necessary for SOCK_DGRAM sockets since we create 29d021c344SAndy King * a datagram handle for each and need not perform a lookup. Keeping SOCK_DGRAM 30d021c344SAndy King * sockets out of the bound hash buckets will reduce the chance of collisions 31d021c344SAndy King * when looking for SOCK_STREAM sockets and prevents us from having to check the 32d021c344SAndy King * socket type in the hash table lookups. 33d021c344SAndy King * 34d021c344SAndy King * - Sockets created by user action will either be "client" sockets that 35d021c344SAndy King * initiate a connection or "server" sockets that listen for connections; we do 36d021c344SAndy King * not support simultaneous connects (two "client" sockets connecting). 37d021c344SAndy King * 38d021c344SAndy King * - "Server" sockets are referred to as listener sockets throughout this 39d021c344SAndy King * implementation because they are in the SS_LISTEN state. When a connection 40d021c344SAndy King * request is received (the second kind of socket mentioned above), we create a 41d021c344SAndy King * new socket and refer to it as a pending socket. These pending sockets are 42d021c344SAndy King * placed on the pending connection list of the listener socket. When future 43d021c344SAndy King * packets are received for the address the listener socket is bound to, we 44d021c344SAndy King * check if the source of the packet is from one that has an existing pending 45d021c344SAndy King * connection. If it does, we process the packet for the pending socket. When 46d021c344SAndy King * that socket reaches the connected state, it is removed from the listener 47d021c344SAndy King * socket's pending list and enqueued in the listener socket's accept queue. 48d021c344SAndy King * Callers of accept(2) will accept connected sockets from the listener socket's 49d021c344SAndy King * accept queue. If the socket cannot be accepted for some reason then it is 50d021c344SAndy King * marked rejected. Once the connection is accepted, it is owned by the user 51d021c344SAndy King * process and the responsibility for cleanup falls with that user process. 52d021c344SAndy King * 53d021c344SAndy King * - It is possible that these pending sockets will never reach the connected 54d021c344SAndy King * state; in fact, we may never receive another packet after the connection 55d021c344SAndy King * request. Because of this, we must schedule a cleanup function to run in the 56d021c344SAndy King * future, after some amount of time passes where a connection should have been 57d021c344SAndy King * established. This function ensures that the socket is off all lists so it 58d021c344SAndy King * cannot be retrieved, then drops all references to the socket so it is cleaned 59d021c344SAndy King * up (sock_put() -> sk_free() -> our sk_destruct implementation). Note this 60d021c344SAndy King * function will also cleanup rejected sockets, those that reach the connected 61d021c344SAndy King * state but leave it before they have been accepted. 62d021c344SAndy King * 63d021c344SAndy King * - Sockets created by user action will be cleaned up when the user process 64d021c344SAndy King * calls close(2), causing our release implementation to be called. Our release 65d021c344SAndy King * implementation will perform some cleanup then drop the last reference so our 66d021c344SAndy King * sk_destruct implementation is invoked. Our sk_destruct implementation will 67d021c344SAndy King * perform additional cleanup that's common for both types of sockets. 68d021c344SAndy King * 69d021c344SAndy King * - A socket's reference count is what ensures that the structure won't be 70d021c344SAndy King * freed. Each entry in a list (such as the "global" bound and connected tables 71d021c344SAndy King * and the listener socket's pending list and connected queue) ensures a 72d021c344SAndy King * reference. When we defer work until process context and pass a socket as our 73d021c344SAndy King * argument, we must ensure the reference count is increased to ensure the 74d021c344SAndy King * socket isn't freed before the function is run; the deferred function will 75d021c344SAndy King * then drop the reference. 76d021c344SAndy King */ 77d021c344SAndy King 78d021c344SAndy King #include <linux/types.h> 79d021c344SAndy King #include <linux/bitops.h> 80d021c344SAndy King #include <linux/cred.h> 81d021c344SAndy King #include <linux/init.h> 82d021c344SAndy King #include <linux/io.h> 83d021c344SAndy King #include <linux/kernel.h> 84d021c344SAndy King #include <linux/kmod.h> 85d021c344SAndy King #include <linux/list.h> 86d021c344SAndy King #include <linux/miscdevice.h> 87d021c344SAndy King #include <linux/module.h> 88d021c344SAndy King #include <linux/mutex.h> 89d021c344SAndy King #include <linux/net.h> 90d021c344SAndy King #include <linux/poll.h> 91d021c344SAndy King #include <linux/skbuff.h> 92d021c344SAndy King #include <linux/smp.h> 93d021c344SAndy King #include <linux/socket.h> 94d021c344SAndy King #include <linux/stddef.h> 95d021c344SAndy King #include <linux/unistd.h> 96d021c344SAndy King #include <linux/wait.h> 97d021c344SAndy King #include <linux/workqueue.h> 98d021c344SAndy King #include <net/sock.h> 99d021c344SAndy King 100d021c344SAndy King #include "af_vsock.h" 101d021c344SAndy King 102d021c344SAndy King static int __vsock_bind(struct sock *sk, struct sockaddr_vm *addr); 103d021c344SAndy King static void vsock_sk_destruct(struct sock *sk); 104d021c344SAndy King static int vsock_queue_rcv_skb(struct sock *sk, struct sk_buff *skb); 105d021c344SAndy King 106d021c344SAndy King /* Protocol family. */ 107d021c344SAndy King static struct proto vsock_proto = { 108d021c344SAndy King .name = "AF_VSOCK", 109d021c344SAndy King .owner = THIS_MODULE, 110d021c344SAndy King .obj_size = sizeof(struct vsock_sock), 111d021c344SAndy King }; 112d021c344SAndy King 113d021c344SAndy King /* The default peer timeout indicates how long we will wait for a peer response 114d021c344SAndy King * to a control message. 115d021c344SAndy King */ 116d021c344SAndy King #define VSOCK_DEFAULT_CONNECT_TIMEOUT (2 * HZ) 117d021c344SAndy King 118d021c344SAndy King #define SS_LISTEN 255 119d021c344SAndy King 120d021c344SAndy King static const struct vsock_transport *transport; 121d021c344SAndy King static DEFINE_MUTEX(vsock_register_mutex); 122d021c344SAndy King 123d021c344SAndy King /**** EXPORTS ****/ 124d021c344SAndy King 125d021c344SAndy King /* Get the ID of the local context. This is transport dependent. */ 126d021c344SAndy King 127d021c344SAndy King int vm_sockets_get_local_cid(void) 128d021c344SAndy King { 129d021c344SAndy King return transport->get_local_cid(); 130d021c344SAndy King } 131d021c344SAndy King EXPORT_SYMBOL_GPL(vm_sockets_get_local_cid); 132d021c344SAndy King 133d021c344SAndy King /**** UTILS ****/ 134d021c344SAndy King 135d021c344SAndy King /* Each bound VSocket is stored in the bind hash table and each connected 136d021c344SAndy King * VSocket is stored in the connected hash table. 137d021c344SAndy King * 138d021c344SAndy King * Unbound sockets are all put on the same list attached to the end of the hash 139d021c344SAndy King * table (vsock_unbound_sockets). Bound sockets are added to the hash table in 140d021c344SAndy King * the bucket that their local address hashes to (vsock_bound_sockets(addr) 141d021c344SAndy King * represents the list that addr hashes to). 142d021c344SAndy King * 143d021c344SAndy King * Specifically, we initialize the vsock_bind_table array to a size of 144d021c344SAndy King * VSOCK_HASH_SIZE + 1 so that vsock_bind_table[0] through 145d021c344SAndy King * vsock_bind_table[VSOCK_HASH_SIZE - 1] are for bound sockets and 146d021c344SAndy King * vsock_bind_table[VSOCK_HASH_SIZE] is for unbound sockets. The hash function 147d021c344SAndy King * mods with VSOCK_HASH_SIZE - 1 to ensure this. 148d021c344SAndy King */ 149d021c344SAndy King #define VSOCK_HASH_SIZE 251 150d021c344SAndy King #define MAX_PORT_RETRIES 24 151d021c344SAndy King 152d021c344SAndy King #define VSOCK_HASH(addr) ((addr)->svm_port % (VSOCK_HASH_SIZE - 1)) 153d021c344SAndy King #define vsock_bound_sockets(addr) (&vsock_bind_table[VSOCK_HASH(addr)]) 154d021c344SAndy King #define vsock_unbound_sockets (&vsock_bind_table[VSOCK_HASH_SIZE]) 155d021c344SAndy King 156d021c344SAndy King /* XXX This can probably be implemented in a better way. */ 157d021c344SAndy King #define VSOCK_CONN_HASH(src, dst) \ 158d021c344SAndy King (((src)->svm_cid ^ (dst)->svm_port) % (VSOCK_HASH_SIZE - 1)) 159d021c344SAndy King #define vsock_connected_sockets(src, dst) \ 160d021c344SAndy King (&vsock_connected_table[VSOCK_CONN_HASH(src, dst)]) 161d021c344SAndy King #define vsock_connected_sockets_vsk(vsk) \ 162d021c344SAndy King vsock_connected_sockets(&(vsk)->remote_addr, &(vsk)->local_addr) 163d021c344SAndy King 164d021c344SAndy King static struct list_head vsock_bind_table[VSOCK_HASH_SIZE + 1]; 165d021c344SAndy King static struct list_head vsock_connected_table[VSOCK_HASH_SIZE]; 166d021c344SAndy King static DEFINE_SPINLOCK(vsock_table_lock); 167d021c344SAndy King 168b3a6dfe8SAsias He /* Autobind this socket to the local address if necessary. */ 169b3a6dfe8SAsias He static int vsock_auto_bind(struct vsock_sock *vsk) 170b3a6dfe8SAsias He { 171b3a6dfe8SAsias He struct sock *sk = sk_vsock(vsk); 172b3a6dfe8SAsias He struct sockaddr_vm local_addr; 173b3a6dfe8SAsias He 174b3a6dfe8SAsias He if (vsock_addr_bound(&vsk->local_addr)) 175b3a6dfe8SAsias He return 0; 176b3a6dfe8SAsias He vsock_addr_init(&local_addr, VMADDR_CID_ANY, VMADDR_PORT_ANY); 177b3a6dfe8SAsias He return __vsock_bind(sk, &local_addr); 178b3a6dfe8SAsias He } 179b3a6dfe8SAsias He 18022ee3b57SGeert Uytterhoeven static void vsock_init_tables(void) 181d021c344SAndy King { 182d021c344SAndy King int i; 183d021c344SAndy King 184d021c344SAndy King for (i = 0; i < ARRAY_SIZE(vsock_bind_table); i++) 185d021c344SAndy King INIT_LIST_HEAD(&vsock_bind_table[i]); 186d021c344SAndy King 187d021c344SAndy King for (i = 0; i < ARRAY_SIZE(vsock_connected_table); i++) 188d021c344SAndy King INIT_LIST_HEAD(&vsock_connected_table[i]); 189d021c344SAndy King } 190d021c344SAndy King 191d021c344SAndy King static void __vsock_insert_bound(struct list_head *list, 192d021c344SAndy King struct vsock_sock *vsk) 193d021c344SAndy King { 194d021c344SAndy King sock_hold(&vsk->sk); 195d021c344SAndy King list_add(&vsk->bound_table, list); 196d021c344SAndy King } 197d021c344SAndy King 198d021c344SAndy King static void __vsock_insert_connected(struct list_head *list, 199d021c344SAndy King struct vsock_sock *vsk) 200d021c344SAndy King { 201d021c344SAndy King sock_hold(&vsk->sk); 202d021c344SAndy King list_add(&vsk->connected_table, list); 203d021c344SAndy King } 204d021c344SAndy King 205d021c344SAndy King static void __vsock_remove_bound(struct vsock_sock *vsk) 206d021c344SAndy King { 207d021c344SAndy King list_del_init(&vsk->bound_table); 208d021c344SAndy King sock_put(&vsk->sk); 209d021c344SAndy King } 210d021c344SAndy King 211d021c344SAndy King static void __vsock_remove_connected(struct vsock_sock *vsk) 212d021c344SAndy King { 213d021c344SAndy King list_del_init(&vsk->connected_table); 214d021c344SAndy King sock_put(&vsk->sk); 215d021c344SAndy King } 216d021c344SAndy King 217d021c344SAndy King static struct sock *__vsock_find_bound_socket(struct sockaddr_vm *addr) 218d021c344SAndy King { 219d021c344SAndy King struct vsock_sock *vsk; 220d021c344SAndy King 221d021c344SAndy King list_for_each_entry(vsk, vsock_bound_sockets(addr), bound_table) 222990454b5SReilly Grant if (addr->svm_port == vsk->local_addr.svm_port) 223d021c344SAndy King return sk_vsock(vsk); 224d021c344SAndy King 225d021c344SAndy King return NULL; 226d021c344SAndy King } 227d021c344SAndy King 228d021c344SAndy King static struct sock *__vsock_find_connected_socket(struct sockaddr_vm *src, 229d021c344SAndy King struct sockaddr_vm *dst) 230d021c344SAndy King { 231d021c344SAndy King struct vsock_sock *vsk; 232d021c344SAndy King 233d021c344SAndy King list_for_each_entry(vsk, vsock_connected_sockets(src, dst), 234d021c344SAndy King connected_table) { 235990454b5SReilly Grant if (vsock_addr_equals_addr(src, &vsk->remote_addr) && 236990454b5SReilly Grant dst->svm_port == vsk->local_addr.svm_port) { 237d021c344SAndy King return sk_vsock(vsk); 238d021c344SAndy King } 239d021c344SAndy King } 240d021c344SAndy King 241d021c344SAndy King return NULL; 242d021c344SAndy King } 243d021c344SAndy King 244d021c344SAndy King static bool __vsock_in_bound_table(struct vsock_sock *vsk) 245d021c344SAndy King { 246d021c344SAndy King return !list_empty(&vsk->bound_table); 247d021c344SAndy King } 248d021c344SAndy King 249d021c344SAndy King static bool __vsock_in_connected_table(struct vsock_sock *vsk) 250d021c344SAndy King { 251d021c344SAndy King return !list_empty(&vsk->connected_table); 252d021c344SAndy King } 253d021c344SAndy King 254d021c344SAndy King static void vsock_insert_unbound(struct vsock_sock *vsk) 255d021c344SAndy King { 256d021c344SAndy King spin_lock_bh(&vsock_table_lock); 257d021c344SAndy King __vsock_insert_bound(vsock_unbound_sockets, vsk); 258d021c344SAndy King spin_unlock_bh(&vsock_table_lock); 259d021c344SAndy King } 260d021c344SAndy King 261d021c344SAndy King void vsock_insert_connected(struct vsock_sock *vsk) 262d021c344SAndy King { 263d021c344SAndy King struct list_head *list = vsock_connected_sockets( 264d021c344SAndy King &vsk->remote_addr, &vsk->local_addr); 265d021c344SAndy King 266d021c344SAndy King spin_lock_bh(&vsock_table_lock); 267d021c344SAndy King __vsock_insert_connected(list, vsk); 268d021c344SAndy King spin_unlock_bh(&vsock_table_lock); 269d021c344SAndy King } 270d021c344SAndy King EXPORT_SYMBOL_GPL(vsock_insert_connected); 271d021c344SAndy King 272d021c344SAndy King void vsock_remove_bound(struct vsock_sock *vsk) 273d021c344SAndy King { 274d021c344SAndy King spin_lock_bh(&vsock_table_lock); 275d021c344SAndy King __vsock_remove_bound(vsk); 276d021c344SAndy King spin_unlock_bh(&vsock_table_lock); 277d021c344SAndy King } 278d021c344SAndy King EXPORT_SYMBOL_GPL(vsock_remove_bound); 279d021c344SAndy King 280d021c344SAndy King void vsock_remove_connected(struct vsock_sock *vsk) 281d021c344SAndy King { 282d021c344SAndy King spin_lock_bh(&vsock_table_lock); 283d021c344SAndy King __vsock_remove_connected(vsk); 284d021c344SAndy King spin_unlock_bh(&vsock_table_lock); 285d021c344SAndy King } 286d021c344SAndy King EXPORT_SYMBOL_GPL(vsock_remove_connected); 287d021c344SAndy King 288d021c344SAndy King struct sock *vsock_find_bound_socket(struct sockaddr_vm *addr) 289d021c344SAndy King { 290d021c344SAndy King struct sock *sk; 291d021c344SAndy King 292d021c344SAndy King spin_lock_bh(&vsock_table_lock); 293d021c344SAndy King sk = __vsock_find_bound_socket(addr); 294d021c344SAndy King if (sk) 295d021c344SAndy King sock_hold(sk); 296d021c344SAndy King 297d021c344SAndy King spin_unlock_bh(&vsock_table_lock); 298d021c344SAndy King 299d021c344SAndy King return sk; 300d021c344SAndy King } 301d021c344SAndy King EXPORT_SYMBOL_GPL(vsock_find_bound_socket); 302d021c344SAndy King 303d021c344SAndy King struct sock *vsock_find_connected_socket(struct sockaddr_vm *src, 304d021c344SAndy King struct sockaddr_vm *dst) 305d021c344SAndy King { 306d021c344SAndy King struct sock *sk; 307d021c344SAndy King 308d021c344SAndy King spin_lock_bh(&vsock_table_lock); 309d021c344SAndy King sk = __vsock_find_connected_socket(src, dst); 310d021c344SAndy King if (sk) 311d021c344SAndy King sock_hold(sk); 312d021c344SAndy King 313d021c344SAndy King spin_unlock_bh(&vsock_table_lock); 314d021c344SAndy King 315d021c344SAndy King return sk; 316d021c344SAndy King } 317d021c344SAndy King EXPORT_SYMBOL_GPL(vsock_find_connected_socket); 318d021c344SAndy King 319d021c344SAndy King static bool vsock_in_bound_table(struct vsock_sock *vsk) 320d021c344SAndy King { 321d021c344SAndy King bool ret; 322d021c344SAndy King 323d021c344SAndy King spin_lock_bh(&vsock_table_lock); 324d021c344SAndy King ret = __vsock_in_bound_table(vsk); 325d021c344SAndy King spin_unlock_bh(&vsock_table_lock); 326d021c344SAndy King 327d021c344SAndy King return ret; 328d021c344SAndy King } 329d021c344SAndy King 330d021c344SAndy King static bool vsock_in_connected_table(struct vsock_sock *vsk) 331d021c344SAndy King { 332d021c344SAndy King bool ret; 333d021c344SAndy King 334d021c344SAndy King spin_lock_bh(&vsock_table_lock); 335d021c344SAndy King ret = __vsock_in_connected_table(vsk); 336d021c344SAndy King spin_unlock_bh(&vsock_table_lock); 337d021c344SAndy King 338d021c344SAndy King return ret; 339d021c344SAndy King } 340d021c344SAndy King 341d021c344SAndy King void vsock_for_each_connected_socket(void (*fn)(struct sock *sk)) 342d021c344SAndy King { 343d021c344SAndy King int i; 344d021c344SAndy King 345d021c344SAndy King spin_lock_bh(&vsock_table_lock); 346d021c344SAndy King 347d021c344SAndy King for (i = 0; i < ARRAY_SIZE(vsock_connected_table); i++) { 348d021c344SAndy King struct vsock_sock *vsk; 349d021c344SAndy King list_for_each_entry(vsk, &vsock_connected_table[i], 350d021c344SAndy King connected_table); 351d021c344SAndy King fn(sk_vsock(vsk)); 352d021c344SAndy King } 353d021c344SAndy King 354d021c344SAndy King spin_unlock_bh(&vsock_table_lock); 355d021c344SAndy King } 356d021c344SAndy King EXPORT_SYMBOL_GPL(vsock_for_each_connected_socket); 357d021c344SAndy King 358d021c344SAndy King void vsock_add_pending(struct sock *listener, struct sock *pending) 359d021c344SAndy King { 360d021c344SAndy King struct vsock_sock *vlistener; 361d021c344SAndy King struct vsock_sock *vpending; 362d021c344SAndy King 363d021c344SAndy King vlistener = vsock_sk(listener); 364d021c344SAndy King vpending = vsock_sk(pending); 365d021c344SAndy King 366d021c344SAndy King sock_hold(pending); 367d021c344SAndy King sock_hold(listener); 368d021c344SAndy King list_add_tail(&vpending->pending_links, &vlistener->pending_links); 369d021c344SAndy King } 370d021c344SAndy King EXPORT_SYMBOL_GPL(vsock_add_pending); 371d021c344SAndy King 372d021c344SAndy King void vsock_remove_pending(struct sock *listener, struct sock *pending) 373d021c344SAndy King { 374d021c344SAndy King struct vsock_sock *vpending = vsock_sk(pending); 375d021c344SAndy King 376d021c344SAndy King list_del_init(&vpending->pending_links); 377d021c344SAndy King sock_put(listener); 378d021c344SAndy King sock_put(pending); 379d021c344SAndy King } 380d021c344SAndy King EXPORT_SYMBOL_GPL(vsock_remove_pending); 381d021c344SAndy King 382d021c344SAndy King void vsock_enqueue_accept(struct sock *listener, struct sock *connected) 383d021c344SAndy King { 384d021c344SAndy King struct vsock_sock *vlistener; 385d021c344SAndy King struct vsock_sock *vconnected; 386d021c344SAndy King 387d021c344SAndy King vlistener = vsock_sk(listener); 388d021c344SAndy King vconnected = vsock_sk(connected); 389d021c344SAndy King 390d021c344SAndy King sock_hold(connected); 391d021c344SAndy King sock_hold(listener); 392d021c344SAndy King list_add_tail(&vconnected->accept_queue, &vlistener->accept_queue); 393d021c344SAndy King } 394d021c344SAndy King EXPORT_SYMBOL_GPL(vsock_enqueue_accept); 395d021c344SAndy King 396d021c344SAndy King static struct sock *vsock_dequeue_accept(struct sock *listener) 397d021c344SAndy King { 398d021c344SAndy King struct vsock_sock *vlistener; 399d021c344SAndy King struct vsock_sock *vconnected; 400d021c344SAndy King 401d021c344SAndy King vlistener = vsock_sk(listener); 402d021c344SAndy King 403d021c344SAndy King if (list_empty(&vlistener->accept_queue)) 404d021c344SAndy King return NULL; 405d021c344SAndy King 406d021c344SAndy King vconnected = list_entry(vlistener->accept_queue.next, 407d021c344SAndy King struct vsock_sock, accept_queue); 408d021c344SAndy King 409d021c344SAndy King list_del_init(&vconnected->accept_queue); 410d021c344SAndy King sock_put(listener); 411d021c344SAndy King /* The caller will need a reference on the connected socket so we let 412d021c344SAndy King * it call sock_put(). 413d021c344SAndy King */ 414d021c344SAndy King 415d021c344SAndy King return sk_vsock(vconnected); 416d021c344SAndy King } 417d021c344SAndy King 418d021c344SAndy King static bool vsock_is_accept_queue_empty(struct sock *sk) 419d021c344SAndy King { 420d021c344SAndy King struct vsock_sock *vsk = vsock_sk(sk); 421d021c344SAndy King return list_empty(&vsk->accept_queue); 422d021c344SAndy King } 423d021c344SAndy King 424d021c344SAndy King static bool vsock_is_pending(struct sock *sk) 425d021c344SAndy King { 426d021c344SAndy King struct vsock_sock *vsk = vsock_sk(sk); 427d021c344SAndy King return !list_empty(&vsk->pending_links); 428d021c344SAndy King } 429d021c344SAndy King 430d021c344SAndy King static int vsock_send_shutdown(struct sock *sk, int mode) 431d021c344SAndy King { 432d021c344SAndy King return transport->shutdown(vsock_sk(sk), mode); 433d021c344SAndy King } 434d021c344SAndy King 435d021c344SAndy King void vsock_pending_work(struct work_struct *work) 436d021c344SAndy King { 437d021c344SAndy King struct sock *sk; 438d021c344SAndy King struct sock *listener; 439d021c344SAndy King struct vsock_sock *vsk; 440d021c344SAndy King bool cleanup; 441d021c344SAndy King 442d021c344SAndy King vsk = container_of(work, struct vsock_sock, dwork.work); 443d021c344SAndy King sk = sk_vsock(vsk); 444d021c344SAndy King listener = vsk->listener; 445d021c344SAndy King cleanup = true; 446d021c344SAndy King 447d021c344SAndy King lock_sock(listener); 448d021c344SAndy King lock_sock(sk); 449d021c344SAndy King 450d021c344SAndy King if (vsock_is_pending(sk)) { 451d021c344SAndy King vsock_remove_pending(listener, sk); 452d021c344SAndy King } else if (!vsk->rejected) { 453d021c344SAndy King /* We are not on the pending list and accept() did not reject 454d021c344SAndy King * us, so we must have been accepted by our user process. We 455d021c344SAndy King * just need to drop our references to the sockets and be on 456d021c344SAndy King * our way. 457d021c344SAndy King */ 458d021c344SAndy King cleanup = false; 459d021c344SAndy King goto out; 460d021c344SAndy King } 461d021c344SAndy King 462d021c344SAndy King listener->sk_ack_backlog--; 463d021c344SAndy King 464d021c344SAndy King /* We need to remove ourself from the global connected sockets list so 465d021c344SAndy King * incoming packets can't find this socket, and to reduce the reference 466d021c344SAndy King * count. 467d021c344SAndy King */ 468d021c344SAndy King if (vsock_in_connected_table(vsk)) 469d021c344SAndy King vsock_remove_connected(vsk); 470d021c344SAndy King 471d021c344SAndy King sk->sk_state = SS_FREE; 472d021c344SAndy King 473d021c344SAndy King out: 474d021c344SAndy King release_sock(sk); 475d021c344SAndy King release_sock(listener); 476d021c344SAndy King if (cleanup) 477d021c344SAndy King sock_put(sk); 478d021c344SAndy King 479d021c344SAndy King sock_put(sk); 480d021c344SAndy King sock_put(listener); 481d021c344SAndy King } 482d021c344SAndy King EXPORT_SYMBOL_GPL(vsock_pending_work); 483d021c344SAndy King 484d021c344SAndy King /**** SOCKET OPERATIONS ****/ 485d021c344SAndy King 486d021c344SAndy King static int __vsock_bind_stream(struct vsock_sock *vsk, 487d021c344SAndy King struct sockaddr_vm *addr) 488d021c344SAndy King { 489d021c344SAndy King static u32 port = LAST_RESERVED_PORT + 1; 490d021c344SAndy King struct sockaddr_vm new_addr; 491d021c344SAndy King 492d021c344SAndy King vsock_addr_init(&new_addr, addr->svm_cid, addr->svm_port); 493d021c344SAndy King 494d021c344SAndy King if (addr->svm_port == VMADDR_PORT_ANY) { 495d021c344SAndy King bool found = false; 496d021c344SAndy King unsigned int i; 497d021c344SAndy King 498d021c344SAndy King for (i = 0; i < MAX_PORT_RETRIES; i++) { 499d021c344SAndy King if (port <= LAST_RESERVED_PORT) 500d021c344SAndy King port = LAST_RESERVED_PORT + 1; 501d021c344SAndy King 502d021c344SAndy King new_addr.svm_port = port++; 503d021c344SAndy King 504d021c344SAndy King if (!__vsock_find_bound_socket(&new_addr)) { 505d021c344SAndy King found = true; 506d021c344SAndy King break; 507d021c344SAndy King } 508d021c344SAndy King } 509d021c344SAndy King 510d021c344SAndy King if (!found) 511d021c344SAndy King return -EADDRNOTAVAIL; 512d021c344SAndy King } else { 513d021c344SAndy King /* If port is in reserved range, ensure caller 514d021c344SAndy King * has necessary privileges. 515d021c344SAndy King */ 516d021c344SAndy King if (addr->svm_port <= LAST_RESERVED_PORT && 517d021c344SAndy King !capable(CAP_NET_BIND_SERVICE)) { 518d021c344SAndy King return -EACCES; 519d021c344SAndy King } 520d021c344SAndy King 521d021c344SAndy King if (__vsock_find_bound_socket(&new_addr)) 522d021c344SAndy King return -EADDRINUSE; 523d021c344SAndy King } 524d021c344SAndy King 525d021c344SAndy King vsock_addr_init(&vsk->local_addr, new_addr.svm_cid, new_addr.svm_port); 526d021c344SAndy King 527d021c344SAndy King /* Remove stream sockets from the unbound list and add them to the hash 528d021c344SAndy King * table for easy lookup by its address. The unbound list is simply an 529d021c344SAndy King * extra entry at the end of the hash table, a trick used by AF_UNIX. 530d021c344SAndy King */ 531d021c344SAndy King __vsock_remove_bound(vsk); 532d021c344SAndy King __vsock_insert_bound(vsock_bound_sockets(&vsk->local_addr), vsk); 533d021c344SAndy King 534d021c344SAndy King return 0; 535d021c344SAndy King } 536d021c344SAndy King 537d021c344SAndy King static int __vsock_bind_dgram(struct vsock_sock *vsk, 538d021c344SAndy King struct sockaddr_vm *addr) 539d021c344SAndy King { 540d021c344SAndy King return transport->dgram_bind(vsk, addr); 541d021c344SAndy King } 542d021c344SAndy King 543d021c344SAndy King static int __vsock_bind(struct sock *sk, struct sockaddr_vm *addr) 544d021c344SAndy King { 545d021c344SAndy King struct vsock_sock *vsk = vsock_sk(sk); 546d021c344SAndy King u32 cid; 547d021c344SAndy King int retval; 548d021c344SAndy King 549d021c344SAndy King /* First ensure this socket isn't already bound. */ 550d021c344SAndy King if (vsock_addr_bound(&vsk->local_addr)) 551d021c344SAndy King return -EINVAL; 552d021c344SAndy King 553d021c344SAndy King /* Now bind to the provided address or select appropriate values if 554d021c344SAndy King * none are provided (VMADDR_CID_ANY and VMADDR_PORT_ANY). Note that 555d021c344SAndy King * like AF_INET prevents binding to a non-local IP address (in most 556d021c344SAndy King * cases), we only allow binding to the local CID. 557d021c344SAndy King */ 558d021c344SAndy King cid = transport->get_local_cid(); 559d021c344SAndy King if (addr->svm_cid != cid && addr->svm_cid != VMADDR_CID_ANY) 560d021c344SAndy King return -EADDRNOTAVAIL; 561d021c344SAndy King 562d021c344SAndy King switch (sk->sk_socket->type) { 563d021c344SAndy King case SOCK_STREAM: 564d021c344SAndy King spin_lock_bh(&vsock_table_lock); 565d021c344SAndy King retval = __vsock_bind_stream(vsk, addr); 566d021c344SAndy King spin_unlock_bh(&vsock_table_lock); 567d021c344SAndy King break; 568d021c344SAndy King 569d021c344SAndy King case SOCK_DGRAM: 570d021c344SAndy King retval = __vsock_bind_dgram(vsk, addr); 571d021c344SAndy King break; 572d021c344SAndy King 573d021c344SAndy King default: 574d021c344SAndy King retval = -EINVAL; 575d021c344SAndy King break; 576d021c344SAndy King } 577d021c344SAndy King 578d021c344SAndy King return retval; 579d021c344SAndy King } 580d021c344SAndy King 581d021c344SAndy King struct sock *__vsock_create(struct net *net, 582d021c344SAndy King struct socket *sock, 583d021c344SAndy King struct sock *parent, 584d021c344SAndy King gfp_t priority, 585d021c344SAndy King unsigned short type) 586d021c344SAndy King { 587d021c344SAndy King struct sock *sk; 588d021c344SAndy King struct vsock_sock *psk; 589d021c344SAndy King struct vsock_sock *vsk; 590d021c344SAndy King 591d021c344SAndy King sk = sk_alloc(net, AF_VSOCK, priority, &vsock_proto); 592d021c344SAndy King if (!sk) 593d021c344SAndy King return NULL; 594d021c344SAndy King 595d021c344SAndy King sock_init_data(sock, sk); 596d021c344SAndy King 597d021c344SAndy King /* sk->sk_type is normally set in sock_init_data, but only if sock is 598d021c344SAndy King * non-NULL. We make sure that our sockets always have a type by 599d021c344SAndy King * setting it here if needed. 600d021c344SAndy King */ 601d021c344SAndy King if (!sock) 602d021c344SAndy King sk->sk_type = type; 603d021c344SAndy King 604d021c344SAndy King vsk = vsock_sk(sk); 605d021c344SAndy King vsock_addr_init(&vsk->local_addr, VMADDR_CID_ANY, VMADDR_PORT_ANY); 606d021c344SAndy King vsock_addr_init(&vsk->remote_addr, VMADDR_CID_ANY, VMADDR_PORT_ANY); 607d021c344SAndy King 608d021c344SAndy King sk->sk_destruct = vsock_sk_destruct; 609d021c344SAndy King sk->sk_backlog_rcv = vsock_queue_rcv_skb; 610d021c344SAndy King sk->sk_state = 0; 611d021c344SAndy King sock_reset_flag(sk, SOCK_DONE); 612d021c344SAndy King 613d021c344SAndy King INIT_LIST_HEAD(&vsk->bound_table); 614d021c344SAndy King INIT_LIST_HEAD(&vsk->connected_table); 615d021c344SAndy King vsk->listener = NULL; 616d021c344SAndy King INIT_LIST_HEAD(&vsk->pending_links); 617d021c344SAndy King INIT_LIST_HEAD(&vsk->accept_queue); 618d021c344SAndy King vsk->rejected = false; 619d021c344SAndy King vsk->sent_request = false; 620d021c344SAndy King vsk->ignore_connecting_rst = false; 621d021c344SAndy King vsk->peer_shutdown = 0; 622d021c344SAndy King 623d021c344SAndy King psk = parent ? vsock_sk(parent) : NULL; 624d021c344SAndy King if (parent) { 625d021c344SAndy King vsk->trusted = psk->trusted; 626d021c344SAndy King vsk->owner = get_cred(psk->owner); 627d021c344SAndy King vsk->connect_timeout = psk->connect_timeout; 628d021c344SAndy King } else { 629d021c344SAndy King vsk->trusted = capable(CAP_NET_ADMIN); 630d021c344SAndy King vsk->owner = get_current_cred(); 631d021c344SAndy King vsk->connect_timeout = VSOCK_DEFAULT_CONNECT_TIMEOUT; 632d021c344SAndy King } 633d021c344SAndy King 634d021c344SAndy King if (transport->init(vsk, psk) < 0) { 635d021c344SAndy King sk_free(sk); 636d021c344SAndy King return NULL; 637d021c344SAndy King } 638d021c344SAndy King 639d021c344SAndy King if (sock) 640d021c344SAndy King vsock_insert_unbound(vsk); 641d021c344SAndy King 642d021c344SAndy King return sk; 643d021c344SAndy King } 644d021c344SAndy King EXPORT_SYMBOL_GPL(__vsock_create); 645d021c344SAndy King 646d021c344SAndy King static void __vsock_release(struct sock *sk) 647d021c344SAndy King { 648d021c344SAndy King if (sk) { 649d021c344SAndy King struct sk_buff *skb; 650d021c344SAndy King struct sock *pending; 651d021c344SAndy King struct vsock_sock *vsk; 652d021c344SAndy King 653d021c344SAndy King vsk = vsock_sk(sk); 654d021c344SAndy King pending = NULL; /* Compiler warning. */ 655d021c344SAndy King 656d021c344SAndy King if (vsock_in_bound_table(vsk)) 657d021c344SAndy King vsock_remove_bound(vsk); 658d021c344SAndy King 659d021c344SAndy King if (vsock_in_connected_table(vsk)) 660d021c344SAndy King vsock_remove_connected(vsk); 661d021c344SAndy King 662d021c344SAndy King transport->release(vsk); 663d021c344SAndy King 664d021c344SAndy King lock_sock(sk); 665d021c344SAndy King sock_orphan(sk); 666d021c344SAndy King sk->sk_shutdown = SHUTDOWN_MASK; 667d021c344SAndy King 668d021c344SAndy King while ((skb = skb_dequeue(&sk->sk_receive_queue))) 669d021c344SAndy King kfree_skb(skb); 670d021c344SAndy King 671d021c344SAndy King /* Clean up any sockets that never were accepted. */ 672d021c344SAndy King while ((pending = vsock_dequeue_accept(sk)) != NULL) { 673d021c344SAndy King __vsock_release(pending); 674d021c344SAndy King sock_put(pending); 675d021c344SAndy King } 676d021c344SAndy King 677d021c344SAndy King release_sock(sk); 678d021c344SAndy King sock_put(sk); 679d021c344SAndy King } 680d021c344SAndy King } 681d021c344SAndy King 682d021c344SAndy King static void vsock_sk_destruct(struct sock *sk) 683d021c344SAndy King { 684d021c344SAndy King struct vsock_sock *vsk = vsock_sk(sk); 685d021c344SAndy King 686d021c344SAndy King transport->destruct(vsk); 687d021c344SAndy King 688d021c344SAndy King /* When clearing these addresses, there's no need to set the family and 689d021c344SAndy King * possibly register the address family with the kernel. 690d021c344SAndy King */ 691d021c344SAndy King vsock_addr_init(&vsk->local_addr, VMADDR_CID_ANY, VMADDR_PORT_ANY); 692d021c344SAndy King vsock_addr_init(&vsk->remote_addr, VMADDR_CID_ANY, VMADDR_PORT_ANY); 693d021c344SAndy King 694d021c344SAndy King put_cred(vsk->owner); 695d021c344SAndy King } 696d021c344SAndy King 697d021c344SAndy King static int vsock_queue_rcv_skb(struct sock *sk, struct sk_buff *skb) 698d021c344SAndy King { 699d021c344SAndy King int err; 700d021c344SAndy King 701d021c344SAndy King err = sock_queue_rcv_skb(sk, skb); 702d021c344SAndy King if (err) 703d021c344SAndy King kfree_skb(skb); 704d021c344SAndy King 705d021c344SAndy King return err; 706d021c344SAndy King } 707d021c344SAndy King 708d021c344SAndy King s64 vsock_stream_has_data(struct vsock_sock *vsk) 709d021c344SAndy King { 710d021c344SAndy King return transport->stream_has_data(vsk); 711d021c344SAndy King } 712d021c344SAndy King EXPORT_SYMBOL_GPL(vsock_stream_has_data); 713d021c344SAndy King 714d021c344SAndy King s64 vsock_stream_has_space(struct vsock_sock *vsk) 715d021c344SAndy King { 716d021c344SAndy King return transport->stream_has_space(vsk); 717d021c344SAndy King } 718d021c344SAndy King EXPORT_SYMBOL_GPL(vsock_stream_has_space); 719d021c344SAndy King 720d021c344SAndy King static int vsock_release(struct socket *sock) 721d021c344SAndy King { 722d021c344SAndy King __vsock_release(sock->sk); 723d021c344SAndy King sock->sk = NULL; 724d021c344SAndy King sock->state = SS_FREE; 725d021c344SAndy King 726d021c344SAndy King return 0; 727d021c344SAndy King } 728d021c344SAndy King 729d021c344SAndy King static int 730d021c344SAndy King vsock_bind(struct socket *sock, struct sockaddr *addr, int addr_len) 731d021c344SAndy King { 732d021c344SAndy King int err; 733d021c344SAndy King struct sock *sk; 734d021c344SAndy King struct sockaddr_vm *vm_addr; 735d021c344SAndy King 736d021c344SAndy King sk = sock->sk; 737d021c344SAndy King 738d021c344SAndy King if (vsock_addr_cast(addr, addr_len, &vm_addr) != 0) 739d021c344SAndy King return -EINVAL; 740d021c344SAndy King 741d021c344SAndy King lock_sock(sk); 742d021c344SAndy King err = __vsock_bind(sk, vm_addr); 743d021c344SAndy King release_sock(sk); 744d021c344SAndy King 745d021c344SAndy King return err; 746d021c344SAndy King } 747d021c344SAndy King 748d021c344SAndy King static int vsock_getname(struct socket *sock, 749d021c344SAndy King struct sockaddr *addr, int *addr_len, int peer) 750d021c344SAndy King { 751d021c344SAndy King int err; 752d021c344SAndy King struct sock *sk; 753d021c344SAndy King struct vsock_sock *vsk; 754d021c344SAndy King struct sockaddr_vm *vm_addr; 755d021c344SAndy King 756d021c344SAndy King sk = sock->sk; 757d021c344SAndy King vsk = vsock_sk(sk); 758d021c344SAndy King err = 0; 759d021c344SAndy King 760d021c344SAndy King lock_sock(sk); 761d021c344SAndy King 762d021c344SAndy King if (peer) { 763d021c344SAndy King if (sock->state != SS_CONNECTED) { 764d021c344SAndy King err = -ENOTCONN; 765d021c344SAndy King goto out; 766d021c344SAndy King } 767d021c344SAndy King vm_addr = &vsk->remote_addr; 768d021c344SAndy King } else { 769d021c344SAndy King vm_addr = &vsk->local_addr; 770d021c344SAndy King } 771d021c344SAndy King 772d021c344SAndy King if (!vm_addr) { 773d021c344SAndy King err = -EINVAL; 774d021c344SAndy King goto out; 775d021c344SAndy King } 776d021c344SAndy King 777d021c344SAndy King /* sys_getsockname() and sys_getpeername() pass us a 778d021c344SAndy King * MAX_SOCK_ADDR-sized buffer and don't set addr_len. Unfortunately 779d021c344SAndy King * that macro is defined in socket.c instead of .h, so we hardcode its 780d021c344SAndy King * value here. 781d021c344SAndy King */ 782d021c344SAndy King BUILD_BUG_ON(sizeof(*vm_addr) > 128); 783d021c344SAndy King memcpy(addr, vm_addr, sizeof(*vm_addr)); 784d021c344SAndy King *addr_len = sizeof(*vm_addr); 785d021c344SAndy King 786d021c344SAndy King out: 787d021c344SAndy King release_sock(sk); 788d021c344SAndy King return err; 789d021c344SAndy King } 790d021c344SAndy King 791d021c344SAndy King static int vsock_shutdown(struct socket *sock, int mode) 792d021c344SAndy King { 793d021c344SAndy King int err; 794d021c344SAndy King struct sock *sk; 795d021c344SAndy King 796d021c344SAndy King /* User level uses SHUT_RD (0) and SHUT_WR (1), but the kernel uses 797d021c344SAndy King * RCV_SHUTDOWN (1) and SEND_SHUTDOWN (2), so we must increment mode 798d021c344SAndy King * here like the other address families do. Note also that the 799d021c344SAndy King * increment makes SHUT_RDWR (2) into RCV_SHUTDOWN | SEND_SHUTDOWN (3), 800d021c344SAndy King * which is what we want. 801d021c344SAndy King */ 802d021c344SAndy King mode++; 803d021c344SAndy King 804d021c344SAndy King if ((mode & ~SHUTDOWN_MASK) || !mode) 805d021c344SAndy King return -EINVAL; 806d021c344SAndy King 807d021c344SAndy King /* If this is a STREAM socket and it is not connected then bail out 808d021c344SAndy King * immediately. If it is a DGRAM socket then we must first kick the 809d021c344SAndy King * socket so that it wakes up from any sleeping calls, for example 810d021c344SAndy King * recv(), and then afterwards return the error. 811d021c344SAndy King */ 812d021c344SAndy King 813d021c344SAndy King sk = sock->sk; 814d021c344SAndy King if (sock->state == SS_UNCONNECTED) { 815d021c344SAndy King err = -ENOTCONN; 816d021c344SAndy King if (sk->sk_type == SOCK_STREAM) 817d021c344SAndy King return err; 818d021c344SAndy King } else { 819d021c344SAndy King sock->state = SS_DISCONNECTING; 820d021c344SAndy King err = 0; 821d021c344SAndy King } 822d021c344SAndy King 823d021c344SAndy King /* Receive and send shutdowns are treated alike. */ 824d021c344SAndy King mode = mode & (RCV_SHUTDOWN | SEND_SHUTDOWN); 825d021c344SAndy King if (mode) { 826d021c344SAndy King lock_sock(sk); 827d021c344SAndy King sk->sk_shutdown |= mode; 828d021c344SAndy King sk->sk_state_change(sk); 829d021c344SAndy King release_sock(sk); 830d021c344SAndy King 831d021c344SAndy King if (sk->sk_type == SOCK_STREAM) { 832d021c344SAndy King sock_reset_flag(sk, SOCK_DONE); 833d021c344SAndy King vsock_send_shutdown(sk, mode); 834d021c344SAndy King } 835d021c344SAndy King } 836d021c344SAndy King 837d021c344SAndy King return err; 838d021c344SAndy King } 839d021c344SAndy King 840d021c344SAndy King static unsigned int vsock_poll(struct file *file, struct socket *sock, 841d021c344SAndy King poll_table *wait) 842d021c344SAndy King { 843d021c344SAndy King struct sock *sk; 844d021c344SAndy King unsigned int mask; 845d021c344SAndy King struct vsock_sock *vsk; 846d021c344SAndy King 847d021c344SAndy King sk = sock->sk; 848d021c344SAndy King vsk = vsock_sk(sk); 849d021c344SAndy King 850d021c344SAndy King poll_wait(file, sk_sleep(sk), wait); 851d021c344SAndy King mask = 0; 852d021c344SAndy King 853d021c344SAndy King if (sk->sk_err) 854d021c344SAndy King /* Signify that there has been an error on this socket. */ 855d021c344SAndy King mask |= POLLERR; 856d021c344SAndy King 857d021c344SAndy King /* INET sockets treat local write shutdown and peer write shutdown as a 858d021c344SAndy King * case of POLLHUP set. 859d021c344SAndy King */ 860d021c344SAndy King if ((sk->sk_shutdown == SHUTDOWN_MASK) || 861d021c344SAndy King ((sk->sk_shutdown & SEND_SHUTDOWN) && 862d021c344SAndy King (vsk->peer_shutdown & SEND_SHUTDOWN))) { 863d021c344SAndy King mask |= POLLHUP; 864d021c344SAndy King } 865d021c344SAndy King 866d021c344SAndy King if (sk->sk_shutdown & RCV_SHUTDOWN || 867d021c344SAndy King vsk->peer_shutdown & SEND_SHUTDOWN) { 868d021c344SAndy King mask |= POLLRDHUP; 869d021c344SAndy King } 870d021c344SAndy King 871d021c344SAndy King if (sock->type == SOCK_DGRAM) { 872d021c344SAndy King /* For datagram sockets we can read if there is something in 873d021c344SAndy King * the queue and write as long as the socket isn't shutdown for 874d021c344SAndy King * sending. 875d021c344SAndy King */ 876d021c344SAndy King if (!skb_queue_empty(&sk->sk_receive_queue) || 877d021c344SAndy King (sk->sk_shutdown & RCV_SHUTDOWN)) { 878d021c344SAndy King mask |= POLLIN | POLLRDNORM; 879d021c344SAndy King } 880d021c344SAndy King 881d021c344SAndy King if (!(sk->sk_shutdown & SEND_SHUTDOWN)) 882d021c344SAndy King mask |= POLLOUT | POLLWRNORM | POLLWRBAND; 883d021c344SAndy King 884d021c344SAndy King } else if (sock->type == SOCK_STREAM) { 885d021c344SAndy King lock_sock(sk); 886d021c344SAndy King 887d021c344SAndy King /* Listening sockets that have connections in their accept 888d021c344SAndy King * queue can be read. 889d021c344SAndy King */ 890d021c344SAndy King if (sk->sk_state == SS_LISTEN 891d021c344SAndy King && !vsock_is_accept_queue_empty(sk)) 892d021c344SAndy King mask |= POLLIN | POLLRDNORM; 893d021c344SAndy King 894d021c344SAndy King /* If there is something in the queue then we can read. */ 895d021c344SAndy King if (transport->stream_is_active(vsk) && 896d021c344SAndy King !(sk->sk_shutdown & RCV_SHUTDOWN)) { 897d021c344SAndy King bool data_ready_now = false; 898d021c344SAndy King int ret = transport->notify_poll_in( 899d021c344SAndy King vsk, 1, &data_ready_now); 900d021c344SAndy King if (ret < 0) { 901d021c344SAndy King mask |= POLLERR; 902d021c344SAndy King } else { 903d021c344SAndy King if (data_ready_now) 904d021c344SAndy King mask |= POLLIN | POLLRDNORM; 905d021c344SAndy King 906d021c344SAndy King } 907d021c344SAndy King } 908d021c344SAndy King 909d021c344SAndy King /* Sockets whose connections have been closed, reset, or 910d021c344SAndy King * terminated should also be considered read, and we check the 911d021c344SAndy King * shutdown flag for that. 912d021c344SAndy King */ 913d021c344SAndy King if (sk->sk_shutdown & RCV_SHUTDOWN || 914d021c344SAndy King vsk->peer_shutdown & SEND_SHUTDOWN) { 915d021c344SAndy King mask |= POLLIN | POLLRDNORM; 916d021c344SAndy King } 917d021c344SAndy King 918d021c344SAndy King /* Connected sockets that can produce data can be written. */ 919d021c344SAndy King if (sk->sk_state == SS_CONNECTED) { 920d021c344SAndy King if (!(sk->sk_shutdown & SEND_SHUTDOWN)) { 921d021c344SAndy King bool space_avail_now = false; 922d021c344SAndy King int ret = transport->notify_poll_out( 923d021c344SAndy King vsk, 1, &space_avail_now); 924d021c344SAndy King if (ret < 0) { 925d021c344SAndy King mask |= POLLERR; 926d021c344SAndy King } else { 927d021c344SAndy King if (space_avail_now) 928d021c344SAndy King /* Remove POLLWRBAND since INET 929d021c344SAndy King * sockets are not setting it. 930d021c344SAndy King */ 931d021c344SAndy King mask |= POLLOUT | POLLWRNORM; 932d021c344SAndy King 933d021c344SAndy King } 934d021c344SAndy King } 935d021c344SAndy King } 936d021c344SAndy King 937d021c344SAndy King /* Simulate INET socket poll behaviors, which sets 938d021c344SAndy King * POLLOUT|POLLWRNORM when peer is closed and nothing to read, 939d021c344SAndy King * but local send is not shutdown. 940d021c344SAndy King */ 941d021c344SAndy King if (sk->sk_state == SS_UNCONNECTED) { 942d021c344SAndy King if (!(sk->sk_shutdown & SEND_SHUTDOWN)) 943d021c344SAndy King mask |= POLLOUT | POLLWRNORM; 944d021c344SAndy King 945d021c344SAndy King } 946d021c344SAndy King 947d021c344SAndy King release_sock(sk); 948d021c344SAndy King } 949d021c344SAndy King 950d021c344SAndy King return mask; 951d021c344SAndy King } 952d021c344SAndy King 953d021c344SAndy King static int vsock_dgram_sendmsg(struct kiocb *kiocb, struct socket *sock, 954d021c344SAndy King struct msghdr *msg, size_t len) 955d021c344SAndy King { 956d021c344SAndy King int err; 957d021c344SAndy King struct sock *sk; 958d021c344SAndy King struct vsock_sock *vsk; 959d021c344SAndy King struct sockaddr_vm *remote_addr; 960d021c344SAndy King 961d021c344SAndy King if (msg->msg_flags & MSG_OOB) 962d021c344SAndy King return -EOPNOTSUPP; 963d021c344SAndy King 964d021c344SAndy King /* For now, MSG_DONTWAIT is always assumed... */ 965d021c344SAndy King err = 0; 966d021c344SAndy King sk = sock->sk; 967d021c344SAndy King vsk = vsock_sk(sk); 968d021c344SAndy King 969d021c344SAndy King lock_sock(sk); 970d021c344SAndy King 971b3a6dfe8SAsias He err = vsock_auto_bind(vsk); 972b3a6dfe8SAsias He if (err) 973d021c344SAndy King goto out; 974d021c344SAndy King 975d021c344SAndy King 976d021c344SAndy King /* If the provided message contains an address, use that. Otherwise 977d021c344SAndy King * fall back on the socket's remote handle (if it has been connected). 978d021c344SAndy King */ 979d021c344SAndy King if (msg->msg_name && 980d021c344SAndy King vsock_addr_cast(msg->msg_name, msg->msg_namelen, 981d021c344SAndy King &remote_addr) == 0) { 982d021c344SAndy King /* Ensure this address is of the right type and is a valid 983d021c344SAndy King * destination. 984d021c344SAndy King */ 985d021c344SAndy King 986d021c344SAndy King if (remote_addr->svm_cid == VMADDR_CID_ANY) 987d021c344SAndy King remote_addr->svm_cid = transport->get_local_cid(); 988d021c344SAndy King 989d021c344SAndy King if (!vsock_addr_bound(remote_addr)) { 990d021c344SAndy King err = -EINVAL; 991d021c344SAndy King goto out; 992d021c344SAndy King } 993d021c344SAndy King } else if (sock->state == SS_CONNECTED) { 994d021c344SAndy King remote_addr = &vsk->remote_addr; 995d021c344SAndy King 996d021c344SAndy King if (remote_addr->svm_cid == VMADDR_CID_ANY) 997d021c344SAndy King remote_addr->svm_cid = transport->get_local_cid(); 998d021c344SAndy King 999d021c344SAndy King /* XXX Should connect() or this function ensure remote_addr is 1000d021c344SAndy King * bound? 1001d021c344SAndy King */ 1002d021c344SAndy King if (!vsock_addr_bound(&vsk->remote_addr)) { 1003d021c344SAndy King err = -EINVAL; 1004d021c344SAndy King goto out; 1005d021c344SAndy King } 1006d021c344SAndy King } else { 1007d021c344SAndy King err = -EINVAL; 1008d021c344SAndy King goto out; 1009d021c344SAndy King } 1010d021c344SAndy King 1011d021c344SAndy King if (!transport->dgram_allow(remote_addr->svm_cid, 1012d021c344SAndy King remote_addr->svm_port)) { 1013d021c344SAndy King err = -EINVAL; 1014d021c344SAndy King goto out; 1015d021c344SAndy King } 1016d021c344SAndy King 1017d021c344SAndy King err = transport->dgram_enqueue(vsk, remote_addr, msg->msg_iov, len); 1018d021c344SAndy King 1019d021c344SAndy King out: 1020d021c344SAndy King release_sock(sk); 1021d021c344SAndy King return err; 1022d021c344SAndy King } 1023d021c344SAndy King 1024d021c344SAndy King static int vsock_dgram_connect(struct socket *sock, 1025d021c344SAndy King struct sockaddr *addr, int addr_len, int flags) 1026d021c344SAndy King { 1027d021c344SAndy King int err; 1028d021c344SAndy King struct sock *sk; 1029d021c344SAndy King struct vsock_sock *vsk; 1030d021c344SAndy King struct sockaddr_vm *remote_addr; 1031d021c344SAndy King 1032d021c344SAndy King sk = sock->sk; 1033d021c344SAndy King vsk = vsock_sk(sk); 1034d021c344SAndy King 1035d021c344SAndy King err = vsock_addr_cast(addr, addr_len, &remote_addr); 1036d021c344SAndy King if (err == -EAFNOSUPPORT && remote_addr->svm_family == AF_UNSPEC) { 1037d021c344SAndy King lock_sock(sk); 1038d021c344SAndy King vsock_addr_init(&vsk->remote_addr, VMADDR_CID_ANY, 1039d021c344SAndy King VMADDR_PORT_ANY); 1040d021c344SAndy King sock->state = SS_UNCONNECTED; 1041d021c344SAndy King release_sock(sk); 1042d021c344SAndy King return 0; 1043d021c344SAndy King } else if (err != 0) 1044d021c344SAndy King return -EINVAL; 1045d021c344SAndy King 1046d021c344SAndy King lock_sock(sk); 1047d021c344SAndy King 1048b3a6dfe8SAsias He err = vsock_auto_bind(vsk); 1049b3a6dfe8SAsias He if (err) 1050d021c344SAndy King goto out; 1051d021c344SAndy King 1052d021c344SAndy King if (!transport->dgram_allow(remote_addr->svm_cid, 1053d021c344SAndy King remote_addr->svm_port)) { 1054d021c344SAndy King err = -EINVAL; 1055d021c344SAndy King goto out; 1056d021c344SAndy King } 1057d021c344SAndy King 1058d021c344SAndy King memcpy(&vsk->remote_addr, remote_addr, sizeof(vsk->remote_addr)); 1059d021c344SAndy King sock->state = SS_CONNECTED; 1060d021c344SAndy King 1061d021c344SAndy King out: 1062d021c344SAndy King release_sock(sk); 1063d021c344SAndy King return err; 1064d021c344SAndy King } 1065d021c344SAndy King 1066d021c344SAndy King static int vsock_dgram_recvmsg(struct kiocb *kiocb, struct socket *sock, 1067d021c344SAndy King struct msghdr *msg, size_t len, int flags) 1068d021c344SAndy King { 1069d021c344SAndy King return transport->dgram_dequeue(kiocb, vsock_sk(sock->sk), msg, len, 1070d021c344SAndy King flags); 1071d021c344SAndy King } 1072d021c344SAndy King 1073d021c344SAndy King static const struct proto_ops vsock_dgram_ops = { 1074d021c344SAndy King .family = PF_VSOCK, 1075d021c344SAndy King .owner = THIS_MODULE, 1076d021c344SAndy King .release = vsock_release, 1077d021c344SAndy King .bind = vsock_bind, 1078d021c344SAndy King .connect = vsock_dgram_connect, 1079d021c344SAndy King .socketpair = sock_no_socketpair, 1080d021c344SAndy King .accept = sock_no_accept, 1081d021c344SAndy King .getname = vsock_getname, 1082d021c344SAndy King .poll = vsock_poll, 1083d021c344SAndy King .ioctl = sock_no_ioctl, 1084d021c344SAndy King .listen = sock_no_listen, 1085d021c344SAndy King .shutdown = vsock_shutdown, 1086d021c344SAndy King .setsockopt = sock_no_setsockopt, 1087d021c344SAndy King .getsockopt = sock_no_getsockopt, 1088d021c344SAndy King .sendmsg = vsock_dgram_sendmsg, 1089d021c344SAndy King .recvmsg = vsock_dgram_recvmsg, 1090d021c344SAndy King .mmap = sock_no_mmap, 1091d021c344SAndy King .sendpage = sock_no_sendpage, 1092d021c344SAndy King }; 1093d021c344SAndy King 1094d021c344SAndy King static void vsock_connect_timeout(struct work_struct *work) 1095d021c344SAndy King { 1096d021c344SAndy King struct sock *sk; 1097d021c344SAndy King struct vsock_sock *vsk; 1098d021c344SAndy King 1099d021c344SAndy King vsk = container_of(work, struct vsock_sock, dwork.work); 1100d021c344SAndy King sk = sk_vsock(vsk); 1101d021c344SAndy King 1102d021c344SAndy King lock_sock(sk); 1103d021c344SAndy King if (sk->sk_state == SS_CONNECTING && 1104d021c344SAndy King (sk->sk_shutdown != SHUTDOWN_MASK)) { 1105d021c344SAndy King sk->sk_state = SS_UNCONNECTED; 1106d021c344SAndy King sk->sk_err = ETIMEDOUT; 1107d021c344SAndy King sk->sk_error_report(sk); 1108d021c344SAndy King } 1109d021c344SAndy King release_sock(sk); 1110d021c344SAndy King 1111d021c344SAndy King sock_put(sk); 1112d021c344SAndy King } 1113d021c344SAndy King 1114d021c344SAndy King static int vsock_stream_connect(struct socket *sock, struct sockaddr *addr, 1115d021c344SAndy King int addr_len, int flags) 1116d021c344SAndy King { 1117d021c344SAndy King int err; 1118d021c344SAndy King struct sock *sk; 1119d021c344SAndy King struct vsock_sock *vsk; 1120d021c344SAndy King struct sockaddr_vm *remote_addr; 1121d021c344SAndy King long timeout; 1122d021c344SAndy King DEFINE_WAIT(wait); 1123d021c344SAndy King 1124d021c344SAndy King err = 0; 1125d021c344SAndy King sk = sock->sk; 1126d021c344SAndy King vsk = vsock_sk(sk); 1127d021c344SAndy King 1128d021c344SAndy King lock_sock(sk); 1129d021c344SAndy King 1130d021c344SAndy King /* XXX AF_UNSPEC should make us disconnect like AF_INET. */ 1131d021c344SAndy King switch (sock->state) { 1132d021c344SAndy King case SS_CONNECTED: 1133d021c344SAndy King err = -EISCONN; 1134d021c344SAndy King goto out; 1135d021c344SAndy King case SS_DISCONNECTING: 1136d021c344SAndy King err = -EINVAL; 1137d021c344SAndy King goto out; 1138d021c344SAndy King case SS_CONNECTING: 1139d021c344SAndy King /* This continues on so we can move sock into the SS_CONNECTED 1140d021c344SAndy King * state once the connection has completed (at which point err 1141d021c344SAndy King * will be set to zero also). Otherwise, we will either wait 1142d021c344SAndy King * for the connection or return -EALREADY should this be a 1143d021c344SAndy King * non-blocking call. 1144d021c344SAndy King */ 1145d021c344SAndy King err = -EALREADY; 1146d021c344SAndy King break; 1147d021c344SAndy King default: 1148d021c344SAndy King if ((sk->sk_state == SS_LISTEN) || 1149d021c344SAndy King vsock_addr_cast(addr, addr_len, &remote_addr) != 0) { 1150d021c344SAndy King err = -EINVAL; 1151d021c344SAndy King goto out; 1152d021c344SAndy King } 1153d021c344SAndy King 1154d021c344SAndy King /* The hypervisor and well-known contexts do not have socket 1155d021c344SAndy King * endpoints. 1156d021c344SAndy King */ 1157d021c344SAndy King if (!transport->stream_allow(remote_addr->svm_cid, 1158d021c344SAndy King remote_addr->svm_port)) { 1159d021c344SAndy King err = -ENETUNREACH; 1160d021c344SAndy King goto out; 1161d021c344SAndy King } 1162d021c344SAndy King 1163d021c344SAndy King /* Set the remote address that we are connecting to. */ 1164d021c344SAndy King memcpy(&vsk->remote_addr, remote_addr, 1165d021c344SAndy King sizeof(vsk->remote_addr)); 1166d021c344SAndy King 1167b3a6dfe8SAsias He err = vsock_auto_bind(vsk); 1168b3a6dfe8SAsias He if (err) 1169d021c344SAndy King goto out; 1170d021c344SAndy King 1171d021c344SAndy King sk->sk_state = SS_CONNECTING; 1172d021c344SAndy King 1173d021c344SAndy King err = transport->connect(vsk); 1174d021c344SAndy King if (err < 0) 1175d021c344SAndy King goto out; 1176d021c344SAndy King 1177d021c344SAndy King /* Mark sock as connecting and set the error code to in 1178d021c344SAndy King * progress in case this is a non-blocking connect. 1179d021c344SAndy King */ 1180d021c344SAndy King sock->state = SS_CONNECTING; 1181d021c344SAndy King err = -EINPROGRESS; 1182d021c344SAndy King } 1183d021c344SAndy King 1184d021c344SAndy King /* The receive path will handle all communication until we are able to 1185d021c344SAndy King * enter the connected state. Here we wait for the connection to be 1186d021c344SAndy King * completed or a notification of an error. 1187d021c344SAndy King */ 1188d021c344SAndy King timeout = vsk->connect_timeout; 1189d021c344SAndy King prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE); 1190d021c344SAndy King 1191d021c344SAndy King while (sk->sk_state != SS_CONNECTED && sk->sk_err == 0) { 1192d021c344SAndy King if (flags & O_NONBLOCK) { 1193d021c344SAndy King /* If we're not going to block, we schedule a timeout 1194d021c344SAndy King * function to generate a timeout on the connection 1195d021c344SAndy King * attempt, in case the peer doesn't respond in a 1196d021c344SAndy King * timely manner. We hold on to the socket until the 1197d021c344SAndy King * timeout fires. 1198d021c344SAndy King */ 1199d021c344SAndy King sock_hold(sk); 1200d021c344SAndy King INIT_DELAYED_WORK(&vsk->dwork, 1201d021c344SAndy King vsock_connect_timeout); 1202d021c344SAndy King schedule_delayed_work(&vsk->dwork, timeout); 1203d021c344SAndy King 1204d021c344SAndy King /* Skip ahead to preserve error code set above. */ 1205d021c344SAndy King goto out_wait; 1206d021c344SAndy King } 1207d021c344SAndy King 1208d021c344SAndy King release_sock(sk); 1209d021c344SAndy King timeout = schedule_timeout(timeout); 1210d021c344SAndy King lock_sock(sk); 1211d021c344SAndy King 1212d021c344SAndy King if (signal_pending(current)) { 1213d021c344SAndy King err = sock_intr_errno(timeout); 1214d021c344SAndy King goto out_wait_error; 1215d021c344SAndy King } else if (timeout == 0) { 1216d021c344SAndy King err = -ETIMEDOUT; 1217d021c344SAndy King goto out_wait_error; 1218d021c344SAndy King } 1219d021c344SAndy King 1220d021c344SAndy King prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE); 1221d021c344SAndy King } 1222d021c344SAndy King 1223d021c344SAndy King if (sk->sk_err) { 1224d021c344SAndy King err = -sk->sk_err; 1225d021c344SAndy King goto out_wait_error; 1226d021c344SAndy King } else 1227d021c344SAndy King err = 0; 1228d021c344SAndy King 1229d021c344SAndy King out_wait: 1230d021c344SAndy King finish_wait(sk_sleep(sk), &wait); 1231d021c344SAndy King out: 1232d021c344SAndy King release_sock(sk); 1233d021c344SAndy King return err; 1234d021c344SAndy King 1235d021c344SAndy King out_wait_error: 1236d021c344SAndy King sk->sk_state = SS_UNCONNECTED; 1237d021c344SAndy King sock->state = SS_UNCONNECTED; 1238d021c344SAndy King goto out_wait; 1239d021c344SAndy King } 1240d021c344SAndy King 1241d021c344SAndy King static int vsock_accept(struct socket *sock, struct socket *newsock, int flags) 1242d021c344SAndy King { 1243d021c344SAndy King struct sock *listener; 1244d021c344SAndy King int err; 1245d021c344SAndy King struct sock *connected; 1246d021c344SAndy King struct vsock_sock *vconnected; 1247d021c344SAndy King long timeout; 1248d021c344SAndy King DEFINE_WAIT(wait); 1249d021c344SAndy King 1250d021c344SAndy King err = 0; 1251d021c344SAndy King listener = sock->sk; 1252d021c344SAndy King 1253d021c344SAndy King lock_sock(listener); 1254d021c344SAndy King 1255d021c344SAndy King if (sock->type != SOCK_STREAM) { 1256d021c344SAndy King err = -EOPNOTSUPP; 1257d021c344SAndy King goto out; 1258d021c344SAndy King } 1259d021c344SAndy King 1260d021c344SAndy King if (listener->sk_state != SS_LISTEN) { 1261d021c344SAndy King err = -EINVAL; 1262d021c344SAndy King goto out; 1263d021c344SAndy King } 1264d021c344SAndy King 1265d021c344SAndy King /* Wait for children sockets to appear; these are the new sockets 1266d021c344SAndy King * created upon connection establishment. 1267d021c344SAndy King */ 1268d021c344SAndy King timeout = sock_sndtimeo(listener, flags & O_NONBLOCK); 1269d021c344SAndy King prepare_to_wait(sk_sleep(listener), &wait, TASK_INTERRUPTIBLE); 1270d021c344SAndy King 1271d021c344SAndy King while ((connected = vsock_dequeue_accept(listener)) == NULL && 1272d021c344SAndy King listener->sk_err == 0) { 1273d021c344SAndy King release_sock(listener); 1274d021c344SAndy King timeout = schedule_timeout(timeout); 1275d021c344SAndy King lock_sock(listener); 1276d021c344SAndy King 1277d021c344SAndy King if (signal_pending(current)) { 1278d021c344SAndy King err = sock_intr_errno(timeout); 1279d021c344SAndy King goto out_wait; 1280d021c344SAndy King } else if (timeout == 0) { 1281d021c344SAndy King err = -EAGAIN; 1282d021c344SAndy King goto out_wait; 1283d021c344SAndy King } 1284d021c344SAndy King 1285d021c344SAndy King prepare_to_wait(sk_sleep(listener), &wait, TASK_INTERRUPTIBLE); 1286d021c344SAndy King } 1287d021c344SAndy King 1288d021c344SAndy King if (listener->sk_err) 1289d021c344SAndy King err = -listener->sk_err; 1290d021c344SAndy King 1291d021c344SAndy King if (connected) { 1292d021c344SAndy King listener->sk_ack_backlog--; 1293d021c344SAndy King 1294d021c344SAndy King lock_sock(connected); 1295d021c344SAndy King vconnected = vsock_sk(connected); 1296d021c344SAndy King 1297d021c344SAndy King /* If the listener socket has received an error, then we should 1298d021c344SAndy King * reject this socket and return. Note that we simply mark the 1299d021c344SAndy King * socket rejected, drop our reference, and let the cleanup 1300d021c344SAndy King * function handle the cleanup; the fact that we found it in 1301d021c344SAndy King * the listener's accept queue guarantees that the cleanup 1302d021c344SAndy King * function hasn't run yet. 1303d021c344SAndy King */ 1304d021c344SAndy King if (err) { 1305d021c344SAndy King vconnected->rejected = true; 1306d021c344SAndy King release_sock(connected); 1307d021c344SAndy King sock_put(connected); 1308d021c344SAndy King goto out_wait; 1309d021c344SAndy King } 1310d021c344SAndy King 1311d021c344SAndy King newsock->state = SS_CONNECTED; 1312d021c344SAndy King sock_graft(connected, newsock); 1313d021c344SAndy King release_sock(connected); 1314d021c344SAndy King sock_put(connected); 1315d021c344SAndy King } 1316d021c344SAndy King 1317d021c344SAndy King out_wait: 1318d021c344SAndy King finish_wait(sk_sleep(listener), &wait); 1319d021c344SAndy King out: 1320d021c344SAndy King release_sock(listener); 1321d021c344SAndy King return err; 1322d021c344SAndy King } 1323d021c344SAndy King 1324d021c344SAndy King static int vsock_listen(struct socket *sock, int backlog) 1325d021c344SAndy King { 1326d021c344SAndy King int err; 1327d021c344SAndy King struct sock *sk; 1328d021c344SAndy King struct vsock_sock *vsk; 1329d021c344SAndy King 1330d021c344SAndy King sk = sock->sk; 1331d021c344SAndy King 1332d021c344SAndy King lock_sock(sk); 1333d021c344SAndy King 1334d021c344SAndy King if (sock->type != SOCK_STREAM) { 1335d021c344SAndy King err = -EOPNOTSUPP; 1336d021c344SAndy King goto out; 1337d021c344SAndy King } 1338d021c344SAndy King 1339d021c344SAndy King if (sock->state != SS_UNCONNECTED) { 1340d021c344SAndy King err = -EINVAL; 1341d021c344SAndy King goto out; 1342d021c344SAndy King } 1343d021c344SAndy King 1344d021c344SAndy King vsk = vsock_sk(sk); 1345d021c344SAndy King 1346d021c344SAndy King if (!vsock_addr_bound(&vsk->local_addr)) { 1347d021c344SAndy King err = -EINVAL; 1348d021c344SAndy King goto out; 1349d021c344SAndy King } 1350d021c344SAndy King 1351d021c344SAndy King sk->sk_max_ack_backlog = backlog; 1352d021c344SAndy King sk->sk_state = SS_LISTEN; 1353d021c344SAndy King 1354d021c344SAndy King err = 0; 1355d021c344SAndy King 1356d021c344SAndy King out: 1357d021c344SAndy King release_sock(sk); 1358d021c344SAndy King return err; 1359d021c344SAndy King } 1360d021c344SAndy King 1361d021c344SAndy King static int vsock_stream_setsockopt(struct socket *sock, 1362d021c344SAndy King int level, 1363d021c344SAndy King int optname, 1364d021c344SAndy King char __user *optval, 1365d021c344SAndy King unsigned int optlen) 1366d021c344SAndy King { 1367d021c344SAndy King int err; 1368d021c344SAndy King struct sock *sk; 1369d021c344SAndy King struct vsock_sock *vsk; 1370d021c344SAndy King u64 val; 1371d021c344SAndy King 1372d021c344SAndy King if (level != AF_VSOCK) 1373d021c344SAndy King return -ENOPROTOOPT; 1374d021c344SAndy King 1375d021c344SAndy King #define COPY_IN(_v) \ 1376d021c344SAndy King do { \ 1377d021c344SAndy King if (optlen < sizeof(_v)) { \ 1378d021c344SAndy King err = -EINVAL; \ 1379d021c344SAndy King goto exit; \ 1380d021c344SAndy King } \ 1381d021c344SAndy King if (copy_from_user(&_v, optval, sizeof(_v)) != 0) { \ 1382d021c344SAndy King err = -EFAULT; \ 1383d021c344SAndy King goto exit; \ 1384d021c344SAndy King } \ 1385d021c344SAndy King } while (0) 1386d021c344SAndy King 1387d021c344SAndy King err = 0; 1388d021c344SAndy King sk = sock->sk; 1389d021c344SAndy King vsk = vsock_sk(sk); 1390d021c344SAndy King 1391d021c344SAndy King lock_sock(sk); 1392d021c344SAndy King 1393d021c344SAndy King switch (optname) { 1394d021c344SAndy King case SO_VM_SOCKETS_BUFFER_SIZE: 1395d021c344SAndy King COPY_IN(val); 1396d021c344SAndy King transport->set_buffer_size(vsk, val); 1397d021c344SAndy King break; 1398d021c344SAndy King 1399d021c344SAndy King case SO_VM_SOCKETS_BUFFER_MAX_SIZE: 1400d021c344SAndy King COPY_IN(val); 1401d021c344SAndy King transport->set_max_buffer_size(vsk, val); 1402d021c344SAndy King break; 1403d021c344SAndy King 1404d021c344SAndy King case SO_VM_SOCKETS_BUFFER_MIN_SIZE: 1405d021c344SAndy King COPY_IN(val); 1406d021c344SAndy King transport->set_min_buffer_size(vsk, val); 1407d021c344SAndy King break; 1408d021c344SAndy King 1409d021c344SAndy King case SO_VM_SOCKETS_CONNECT_TIMEOUT: { 1410d021c344SAndy King struct timeval tv; 1411d021c344SAndy King COPY_IN(tv); 1412d021c344SAndy King if (tv.tv_sec >= 0 && tv.tv_usec < USEC_PER_SEC && 1413d021c344SAndy King tv.tv_sec < (MAX_SCHEDULE_TIMEOUT / HZ - 1)) { 1414d021c344SAndy King vsk->connect_timeout = tv.tv_sec * HZ + 1415d021c344SAndy King DIV_ROUND_UP(tv.tv_usec, (1000000 / HZ)); 1416d021c344SAndy King if (vsk->connect_timeout == 0) 1417d021c344SAndy King vsk->connect_timeout = 1418d021c344SAndy King VSOCK_DEFAULT_CONNECT_TIMEOUT; 1419d021c344SAndy King 1420d021c344SAndy King } else { 1421d021c344SAndy King err = -ERANGE; 1422d021c344SAndy King } 1423d021c344SAndy King break; 1424d021c344SAndy King } 1425d021c344SAndy King 1426d021c344SAndy King default: 1427d021c344SAndy King err = -ENOPROTOOPT; 1428d021c344SAndy King break; 1429d021c344SAndy King } 1430d021c344SAndy King 1431d021c344SAndy King #undef COPY_IN 1432d021c344SAndy King 1433d021c344SAndy King exit: 1434d021c344SAndy King release_sock(sk); 1435d021c344SAndy King return err; 1436d021c344SAndy King } 1437d021c344SAndy King 1438d021c344SAndy King static int vsock_stream_getsockopt(struct socket *sock, 1439d021c344SAndy King int level, int optname, 1440d021c344SAndy King char __user *optval, 1441d021c344SAndy King int __user *optlen) 1442d021c344SAndy King { 1443d021c344SAndy King int err; 1444d021c344SAndy King int len; 1445d021c344SAndy King struct sock *sk; 1446d021c344SAndy King struct vsock_sock *vsk; 1447d021c344SAndy King u64 val; 1448d021c344SAndy King 1449d021c344SAndy King if (level != AF_VSOCK) 1450d021c344SAndy King return -ENOPROTOOPT; 1451d021c344SAndy King 1452d021c344SAndy King err = get_user(len, optlen); 1453d021c344SAndy King if (err != 0) 1454d021c344SAndy King return err; 1455d021c344SAndy King 1456d021c344SAndy King #define COPY_OUT(_v) \ 1457d021c344SAndy King do { \ 1458d021c344SAndy King if (len < sizeof(_v)) \ 1459d021c344SAndy King return -EINVAL; \ 1460d021c344SAndy King \ 1461d021c344SAndy King len = sizeof(_v); \ 1462d021c344SAndy King if (copy_to_user(optval, &_v, len) != 0) \ 1463d021c344SAndy King return -EFAULT; \ 1464d021c344SAndy King \ 1465d021c344SAndy King } while (0) 1466d021c344SAndy King 1467d021c344SAndy King err = 0; 1468d021c344SAndy King sk = sock->sk; 1469d021c344SAndy King vsk = vsock_sk(sk); 1470d021c344SAndy King 1471d021c344SAndy King switch (optname) { 1472d021c344SAndy King case SO_VM_SOCKETS_BUFFER_SIZE: 1473d021c344SAndy King val = transport->get_buffer_size(vsk); 1474d021c344SAndy King COPY_OUT(val); 1475d021c344SAndy King break; 1476d021c344SAndy King 1477d021c344SAndy King case SO_VM_SOCKETS_BUFFER_MAX_SIZE: 1478d021c344SAndy King val = transport->get_max_buffer_size(vsk); 1479d021c344SAndy King COPY_OUT(val); 1480d021c344SAndy King break; 1481d021c344SAndy King 1482d021c344SAndy King case SO_VM_SOCKETS_BUFFER_MIN_SIZE: 1483d021c344SAndy King val = transport->get_min_buffer_size(vsk); 1484d021c344SAndy King COPY_OUT(val); 1485d021c344SAndy King break; 1486d021c344SAndy King 1487d021c344SAndy King case SO_VM_SOCKETS_CONNECT_TIMEOUT: { 1488d021c344SAndy King struct timeval tv; 1489d021c344SAndy King tv.tv_sec = vsk->connect_timeout / HZ; 1490d021c344SAndy King tv.tv_usec = 1491d021c344SAndy King (vsk->connect_timeout - 1492d021c344SAndy King tv.tv_sec * HZ) * (1000000 / HZ); 1493d021c344SAndy King COPY_OUT(tv); 1494d021c344SAndy King break; 1495d021c344SAndy King } 1496d021c344SAndy King default: 1497d021c344SAndy King return -ENOPROTOOPT; 1498d021c344SAndy King } 1499d021c344SAndy King 1500d021c344SAndy King err = put_user(len, optlen); 1501d021c344SAndy King if (err != 0) 1502d021c344SAndy King return -EFAULT; 1503d021c344SAndy King 1504d021c344SAndy King #undef COPY_OUT 1505d021c344SAndy King 1506d021c344SAndy King return 0; 1507d021c344SAndy King } 1508d021c344SAndy King 1509d021c344SAndy King static int vsock_stream_sendmsg(struct kiocb *kiocb, struct socket *sock, 1510d021c344SAndy King struct msghdr *msg, size_t len) 1511d021c344SAndy King { 1512d021c344SAndy King struct sock *sk; 1513d021c344SAndy King struct vsock_sock *vsk; 1514d021c344SAndy King ssize_t total_written; 1515d021c344SAndy King long timeout; 1516d021c344SAndy King int err; 1517d021c344SAndy King struct vsock_transport_send_notify_data send_data; 1518d021c344SAndy King 1519d021c344SAndy King DEFINE_WAIT(wait); 1520d021c344SAndy King 1521d021c344SAndy King sk = sock->sk; 1522d021c344SAndy King vsk = vsock_sk(sk); 1523d021c344SAndy King total_written = 0; 1524d021c344SAndy King err = 0; 1525d021c344SAndy King 1526d021c344SAndy King if (msg->msg_flags & MSG_OOB) 1527d021c344SAndy King return -EOPNOTSUPP; 1528d021c344SAndy King 1529d021c344SAndy King lock_sock(sk); 1530d021c344SAndy King 1531d021c344SAndy King /* Callers should not provide a destination with stream sockets. */ 1532d021c344SAndy King if (msg->msg_namelen) { 1533d021c344SAndy King err = sk->sk_state == SS_CONNECTED ? -EISCONN : -EOPNOTSUPP; 1534d021c344SAndy King goto out; 1535d021c344SAndy King } 1536d021c344SAndy King 1537d021c344SAndy King /* Send data only if both sides are not shutdown in the direction. */ 1538d021c344SAndy King if (sk->sk_shutdown & SEND_SHUTDOWN || 1539d021c344SAndy King vsk->peer_shutdown & RCV_SHUTDOWN) { 1540d021c344SAndy King err = -EPIPE; 1541d021c344SAndy King goto out; 1542d021c344SAndy King } 1543d021c344SAndy King 1544d021c344SAndy King if (sk->sk_state != SS_CONNECTED || 1545d021c344SAndy King !vsock_addr_bound(&vsk->local_addr)) { 1546d021c344SAndy King err = -ENOTCONN; 1547d021c344SAndy King goto out; 1548d021c344SAndy King } 1549d021c344SAndy King 1550d021c344SAndy King if (!vsock_addr_bound(&vsk->remote_addr)) { 1551d021c344SAndy King err = -EDESTADDRREQ; 1552d021c344SAndy King goto out; 1553d021c344SAndy King } 1554d021c344SAndy King 1555d021c344SAndy King /* Wait for room in the produce queue to enqueue our user's data. */ 1556d021c344SAndy King timeout = sock_sndtimeo(sk, msg->msg_flags & MSG_DONTWAIT); 1557d021c344SAndy King 1558d021c344SAndy King err = transport->notify_send_init(vsk, &send_data); 1559d021c344SAndy King if (err < 0) 1560d021c344SAndy King goto out; 1561d021c344SAndy King 1562d021c344SAndy King prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE); 1563d021c344SAndy King 1564d021c344SAndy King while (total_written < len) { 1565d021c344SAndy King ssize_t written; 1566d021c344SAndy King 1567d021c344SAndy King while (vsock_stream_has_space(vsk) == 0 && 1568d021c344SAndy King sk->sk_err == 0 && 1569d021c344SAndy King !(sk->sk_shutdown & SEND_SHUTDOWN) && 1570d021c344SAndy King !(vsk->peer_shutdown & RCV_SHUTDOWN)) { 1571d021c344SAndy King 1572d021c344SAndy King /* Don't wait for non-blocking sockets. */ 1573d021c344SAndy King if (timeout == 0) { 1574d021c344SAndy King err = -EAGAIN; 1575d021c344SAndy King goto out_wait; 1576d021c344SAndy King } 1577d021c344SAndy King 1578d021c344SAndy King err = transport->notify_send_pre_block(vsk, &send_data); 1579d021c344SAndy King if (err < 0) 1580d021c344SAndy King goto out_wait; 1581d021c344SAndy King 1582d021c344SAndy King release_sock(sk); 1583d021c344SAndy King timeout = schedule_timeout(timeout); 1584d021c344SAndy King lock_sock(sk); 1585d021c344SAndy King if (signal_pending(current)) { 1586d021c344SAndy King err = sock_intr_errno(timeout); 1587d021c344SAndy King goto out_wait; 1588d021c344SAndy King } else if (timeout == 0) { 1589d021c344SAndy King err = -EAGAIN; 1590d021c344SAndy King goto out_wait; 1591d021c344SAndy King } 1592d021c344SAndy King 1593d021c344SAndy King prepare_to_wait(sk_sleep(sk), &wait, 1594d021c344SAndy King TASK_INTERRUPTIBLE); 1595d021c344SAndy King } 1596d021c344SAndy King 1597d021c344SAndy King /* These checks occur both as part of and after the loop 1598d021c344SAndy King * conditional since we need to check before and after 1599d021c344SAndy King * sleeping. 1600d021c344SAndy King */ 1601d021c344SAndy King if (sk->sk_err) { 1602d021c344SAndy King err = -sk->sk_err; 1603d021c344SAndy King goto out_wait; 1604d021c344SAndy King } else if ((sk->sk_shutdown & SEND_SHUTDOWN) || 1605d021c344SAndy King (vsk->peer_shutdown & RCV_SHUTDOWN)) { 1606d021c344SAndy King err = -EPIPE; 1607d021c344SAndy King goto out_wait; 1608d021c344SAndy King } 1609d021c344SAndy King 1610d021c344SAndy King err = transport->notify_send_pre_enqueue(vsk, &send_data); 1611d021c344SAndy King if (err < 0) 1612d021c344SAndy King goto out_wait; 1613d021c344SAndy King 1614d021c344SAndy King /* Note that enqueue will only write as many bytes as are free 1615d021c344SAndy King * in the produce queue, so we don't need to ensure len is 1616d021c344SAndy King * smaller than the queue size. It is the caller's 1617d021c344SAndy King * responsibility to check how many bytes we were able to send. 1618d021c344SAndy King */ 1619d021c344SAndy King 1620d021c344SAndy King written = transport->stream_enqueue( 1621d021c344SAndy King vsk, msg->msg_iov, 1622d021c344SAndy King len - total_written); 1623d021c344SAndy King if (written < 0) { 1624d021c344SAndy King err = -ENOMEM; 1625d021c344SAndy King goto out_wait; 1626d021c344SAndy King } 1627d021c344SAndy King 1628d021c344SAndy King total_written += written; 1629d021c344SAndy King 1630d021c344SAndy King err = transport->notify_send_post_enqueue( 1631d021c344SAndy King vsk, written, &send_data); 1632d021c344SAndy King if (err < 0) 1633d021c344SAndy King goto out_wait; 1634d021c344SAndy King 1635d021c344SAndy King } 1636d021c344SAndy King 1637d021c344SAndy King out_wait: 1638d021c344SAndy King if (total_written > 0) 1639d021c344SAndy King err = total_written; 1640d021c344SAndy King finish_wait(sk_sleep(sk), &wait); 1641d021c344SAndy King out: 1642d021c344SAndy King release_sock(sk); 1643d021c344SAndy King return err; 1644d021c344SAndy King } 1645d021c344SAndy King 1646d021c344SAndy King 1647d021c344SAndy King static int 1648d021c344SAndy King vsock_stream_recvmsg(struct kiocb *kiocb, 1649d021c344SAndy King struct socket *sock, 1650d021c344SAndy King struct msghdr *msg, size_t len, int flags) 1651d021c344SAndy King { 1652d021c344SAndy King struct sock *sk; 1653d021c344SAndy King struct vsock_sock *vsk; 1654d021c344SAndy King int err; 1655d021c344SAndy King size_t target; 1656d021c344SAndy King ssize_t copied; 1657d021c344SAndy King long timeout; 1658d021c344SAndy King struct vsock_transport_recv_notify_data recv_data; 1659d021c344SAndy King 1660d021c344SAndy King DEFINE_WAIT(wait); 1661d021c344SAndy King 1662d021c344SAndy King sk = sock->sk; 1663d021c344SAndy King vsk = vsock_sk(sk); 1664d021c344SAndy King err = 0; 1665d021c344SAndy King 1666d5e0d0f6SMathias Krause msg->msg_namelen = 0; 1667d5e0d0f6SMathias Krause 1668d021c344SAndy King lock_sock(sk); 1669d021c344SAndy King 1670d021c344SAndy King if (sk->sk_state != SS_CONNECTED) { 1671d021c344SAndy King /* Recvmsg is supposed to return 0 if a peer performs an 1672d021c344SAndy King * orderly shutdown. Differentiate between that case and when a 1673d021c344SAndy King * peer has not connected or a local shutdown occured with the 1674d021c344SAndy King * SOCK_DONE flag. 1675d021c344SAndy King */ 1676d021c344SAndy King if (sock_flag(sk, SOCK_DONE)) 1677d021c344SAndy King err = 0; 1678d021c344SAndy King else 1679d021c344SAndy King err = -ENOTCONN; 1680d021c344SAndy King 1681d021c344SAndy King goto out; 1682d021c344SAndy King } 1683d021c344SAndy King 1684d021c344SAndy King if (flags & MSG_OOB) { 1685d021c344SAndy King err = -EOPNOTSUPP; 1686d021c344SAndy King goto out; 1687d021c344SAndy King } 1688d021c344SAndy King 1689d021c344SAndy King /* We don't check peer_shutdown flag here since peer may actually shut 1690d021c344SAndy King * down, but there can be data in the queue that a local socket can 1691d021c344SAndy King * receive. 1692d021c344SAndy King */ 1693d021c344SAndy King if (sk->sk_shutdown & RCV_SHUTDOWN) { 1694d021c344SAndy King err = 0; 1695d021c344SAndy King goto out; 1696d021c344SAndy King } 1697d021c344SAndy King 1698d021c344SAndy King /* It is valid on Linux to pass in a zero-length receive buffer. This 1699d021c344SAndy King * is not an error. We may as well bail out now. 1700d021c344SAndy King */ 1701d021c344SAndy King if (!len) { 1702d021c344SAndy King err = 0; 1703d021c344SAndy King goto out; 1704d021c344SAndy King } 1705d021c344SAndy King 1706d021c344SAndy King /* We must not copy less than target bytes into the user's buffer 1707d021c344SAndy King * before returning successfully, so we wait for the consume queue to 1708d021c344SAndy King * have that much data to consume before dequeueing. Note that this 1709d021c344SAndy King * makes it impossible to handle cases where target is greater than the 1710d021c344SAndy King * queue size. 1711d021c344SAndy King */ 1712d021c344SAndy King target = sock_rcvlowat(sk, flags & MSG_WAITALL, len); 1713d021c344SAndy King if (target >= transport->stream_rcvhiwat(vsk)) { 1714d021c344SAndy King err = -ENOMEM; 1715d021c344SAndy King goto out; 1716d021c344SAndy King } 1717d021c344SAndy King timeout = sock_rcvtimeo(sk, flags & MSG_DONTWAIT); 1718d021c344SAndy King copied = 0; 1719d021c344SAndy King 1720d021c344SAndy King err = transport->notify_recv_init(vsk, target, &recv_data); 1721d021c344SAndy King if (err < 0) 1722d021c344SAndy King goto out; 1723d021c344SAndy King 1724d021c344SAndy King prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE); 1725d021c344SAndy King 1726d021c344SAndy King while (1) { 1727d021c344SAndy King s64 ready = vsock_stream_has_data(vsk); 1728d021c344SAndy King 1729d021c344SAndy King if (ready < 0) { 1730d021c344SAndy King /* Invalid queue pair content. XXX This should be 1731d021c344SAndy King * changed to a connection reset in a later change. 1732d021c344SAndy King */ 1733d021c344SAndy King 1734d021c344SAndy King err = -ENOMEM; 1735d021c344SAndy King goto out_wait; 1736d021c344SAndy King } else if (ready > 0) { 1737d021c344SAndy King ssize_t read; 1738d021c344SAndy King 1739d021c344SAndy King err = transport->notify_recv_pre_dequeue( 1740d021c344SAndy King vsk, target, &recv_data); 1741d021c344SAndy King if (err < 0) 1742d021c344SAndy King break; 1743d021c344SAndy King 1744d021c344SAndy King read = transport->stream_dequeue( 1745d021c344SAndy King vsk, msg->msg_iov, 1746d021c344SAndy King len - copied, flags); 1747d021c344SAndy King if (read < 0) { 1748d021c344SAndy King err = -ENOMEM; 1749d021c344SAndy King break; 1750d021c344SAndy King } 1751d021c344SAndy King 1752d021c344SAndy King copied += read; 1753d021c344SAndy King 1754d021c344SAndy King err = transport->notify_recv_post_dequeue( 1755d021c344SAndy King vsk, target, read, 1756d021c344SAndy King !(flags & MSG_PEEK), &recv_data); 1757d021c344SAndy King if (err < 0) 1758d021c344SAndy King goto out_wait; 1759d021c344SAndy King 1760d021c344SAndy King if (read >= target || flags & MSG_PEEK) 1761d021c344SAndy King break; 1762d021c344SAndy King 1763d021c344SAndy King target -= read; 1764d021c344SAndy King } else { 1765d021c344SAndy King if (sk->sk_err != 0 || (sk->sk_shutdown & RCV_SHUTDOWN) 1766d021c344SAndy King || (vsk->peer_shutdown & SEND_SHUTDOWN)) { 1767d021c344SAndy King break; 1768d021c344SAndy King } 1769d021c344SAndy King /* Don't wait for non-blocking sockets. */ 1770d021c344SAndy King if (timeout == 0) { 1771d021c344SAndy King err = -EAGAIN; 1772d021c344SAndy King break; 1773d021c344SAndy King } 1774d021c344SAndy King 1775d021c344SAndy King err = transport->notify_recv_pre_block( 1776d021c344SAndy King vsk, target, &recv_data); 1777d021c344SAndy King if (err < 0) 1778d021c344SAndy King break; 1779d021c344SAndy King 1780d021c344SAndy King release_sock(sk); 1781d021c344SAndy King timeout = schedule_timeout(timeout); 1782d021c344SAndy King lock_sock(sk); 1783d021c344SAndy King 1784d021c344SAndy King if (signal_pending(current)) { 1785d021c344SAndy King err = sock_intr_errno(timeout); 1786d021c344SAndy King break; 1787d021c344SAndy King } else if (timeout == 0) { 1788d021c344SAndy King err = -EAGAIN; 1789d021c344SAndy King break; 1790d021c344SAndy King } 1791d021c344SAndy King 1792d021c344SAndy King prepare_to_wait(sk_sleep(sk), &wait, 1793d021c344SAndy King TASK_INTERRUPTIBLE); 1794d021c344SAndy King } 1795d021c344SAndy King } 1796d021c344SAndy King 1797d021c344SAndy King if (sk->sk_err) 1798d021c344SAndy King err = -sk->sk_err; 1799d021c344SAndy King else if (sk->sk_shutdown & RCV_SHUTDOWN) 1800d021c344SAndy King err = 0; 1801d021c344SAndy King 1802d021c344SAndy King if (copied > 0) { 1803d021c344SAndy King /* We only do these additional bookkeeping/notification steps 1804d021c344SAndy King * if we actually copied something out of the queue pair 1805d021c344SAndy King * instead of just peeking ahead. 1806d021c344SAndy King */ 1807d021c344SAndy King 1808d021c344SAndy King if (!(flags & MSG_PEEK)) { 1809d021c344SAndy King /* If the other side has shutdown for sending and there 1810d021c344SAndy King * is nothing more to read, then modify the socket 1811d021c344SAndy King * state. 1812d021c344SAndy King */ 1813d021c344SAndy King if (vsk->peer_shutdown & SEND_SHUTDOWN) { 1814d021c344SAndy King if (vsock_stream_has_data(vsk) <= 0) { 1815d021c344SAndy King sk->sk_state = SS_UNCONNECTED; 1816d021c344SAndy King sock_set_flag(sk, SOCK_DONE); 1817d021c344SAndy King sk->sk_state_change(sk); 1818d021c344SAndy King } 1819d021c344SAndy King } 1820d021c344SAndy King } 1821d021c344SAndy King err = copied; 1822d021c344SAndy King } 1823d021c344SAndy King 1824d021c344SAndy King out_wait: 1825d021c344SAndy King finish_wait(sk_sleep(sk), &wait); 1826d021c344SAndy King out: 1827d021c344SAndy King release_sock(sk); 1828d021c344SAndy King return err; 1829d021c344SAndy King } 1830d021c344SAndy King 1831d021c344SAndy King static const struct proto_ops vsock_stream_ops = { 1832d021c344SAndy King .family = PF_VSOCK, 1833d021c344SAndy King .owner = THIS_MODULE, 1834d021c344SAndy King .release = vsock_release, 1835d021c344SAndy King .bind = vsock_bind, 1836d021c344SAndy King .connect = vsock_stream_connect, 1837d021c344SAndy King .socketpair = sock_no_socketpair, 1838d021c344SAndy King .accept = vsock_accept, 1839d021c344SAndy King .getname = vsock_getname, 1840d021c344SAndy King .poll = vsock_poll, 1841d021c344SAndy King .ioctl = sock_no_ioctl, 1842d021c344SAndy King .listen = vsock_listen, 1843d021c344SAndy King .shutdown = vsock_shutdown, 1844d021c344SAndy King .setsockopt = vsock_stream_setsockopt, 1845d021c344SAndy King .getsockopt = vsock_stream_getsockopt, 1846d021c344SAndy King .sendmsg = vsock_stream_sendmsg, 1847d021c344SAndy King .recvmsg = vsock_stream_recvmsg, 1848d021c344SAndy King .mmap = sock_no_mmap, 1849d021c344SAndy King .sendpage = sock_no_sendpage, 1850d021c344SAndy King }; 1851d021c344SAndy King 1852d021c344SAndy King static int vsock_create(struct net *net, struct socket *sock, 1853d021c344SAndy King int protocol, int kern) 1854d021c344SAndy King { 1855d021c344SAndy King if (!sock) 1856d021c344SAndy King return -EINVAL; 1857d021c344SAndy King 18586cf1c5fcSAndy King if (protocol && protocol != PF_VSOCK) 1859d021c344SAndy King return -EPROTONOSUPPORT; 1860d021c344SAndy King 1861d021c344SAndy King switch (sock->type) { 1862d021c344SAndy King case SOCK_DGRAM: 1863d021c344SAndy King sock->ops = &vsock_dgram_ops; 1864d021c344SAndy King break; 1865d021c344SAndy King case SOCK_STREAM: 1866d021c344SAndy King sock->ops = &vsock_stream_ops; 1867d021c344SAndy King break; 1868d021c344SAndy King default: 1869d021c344SAndy King return -ESOCKTNOSUPPORT; 1870d021c344SAndy King } 1871d021c344SAndy King 1872d021c344SAndy King sock->state = SS_UNCONNECTED; 1873d021c344SAndy King 1874d021c344SAndy King return __vsock_create(net, sock, NULL, GFP_KERNEL, 0) ? 0 : -ENOMEM; 1875d021c344SAndy King } 1876d021c344SAndy King 1877d021c344SAndy King static const struct net_proto_family vsock_family_ops = { 1878d021c344SAndy King .family = AF_VSOCK, 1879d021c344SAndy King .create = vsock_create, 1880d021c344SAndy King .owner = THIS_MODULE, 1881d021c344SAndy King }; 1882d021c344SAndy King 1883d021c344SAndy King static long vsock_dev_do_ioctl(struct file *filp, 1884d021c344SAndy King unsigned int cmd, void __user *ptr) 1885d021c344SAndy King { 1886d021c344SAndy King u32 __user *p = ptr; 1887d021c344SAndy King int retval = 0; 1888d021c344SAndy King 1889d021c344SAndy King switch (cmd) { 1890d021c344SAndy King case IOCTL_VM_SOCKETS_GET_LOCAL_CID: 1891d021c344SAndy King if (put_user(transport->get_local_cid(), p) != 0) 1892d021c344SAndy King retval = -EFAULT; 1893d021c344SAndy King break; 1894d021c344SAndy King 1895d021c344SAndy King default: 1896d021c344SAndy King pr_err("Unknown ioctl %d\n", cmd); 1897d021c344SAndy King retval = -EINVAL; 1898d021c344SAndy King } 1899d021c344SAndy King 1900d021c344SAndy King return retval; 1901d021c344SAndy King } 1902d021c344SAndy King 1903d021c344SAndy King static long vsock_dev_ioctl(struct file *filp, 1904d021c344SAndy King unsigned int cmd, unsigned long arg) 1905d021c344SAndy King { 1906d021c344SAndy King return vsock_dev_do_ioctl(filp, cmd, (void __user *)arg); 1907d021c344SAndy King } 1908d021c344SAndy King 1909d021c344SAndy King #ifdef CONFIG_COMPAT 1910d021c344SAndy King static long vsock_dev_compat_ioctl(struct file *filp, 1911d021c344SAndy King unsigned int cmd, unsigned long arg) 1912d021c344SAndy King { 1913d021c344SAndy King return vsock_dev_do_ioctl(filp, cmd, compat_ptr(arg)); 1914d021c344SAndy King } 1915d021c344SAndy King #endif 1916d021c344SAndy King 1917d021c344SAndy King static const struct file_operations vsock_device_ops = { 1918d021c344SAndy King .owner = THIS_MODULE, 1919d021c344SAndy King .unlocked_ioctl = vsock_dev_ioctl, 1920d021c344SAndy King #ifdef CONFIG_COMPAT 1921d021c344SAndy King .compat_ioctl = vsock_dev_compat_ioctl, 1922d021c344SAndy King #endif 1923d021c344SAndy King .open = nonseekable_open, 1924d021c344SAndy King }; 1925d021c344SAndy King 1926d021c344SAndy King static struct miscdevice vsock_device = { 1927d021c344SAndy King .name = "vsock", 1928d021c344SAndy King .fops = &vsock_device_ops, 1929d021c344SAndy King }; 1930d021c344SAndy King 1931d021c344SAndy King static int __vsock_core_init(void) 1932d021c344SAndy King { 1933d021c344SAndy King int err; 1934d021c344SAndy King 1935d021c344SAndy King vsock_init_tables(); 1936d021c344SAndy King 19376ad0b2f7SAsias He vsock_device.minor = MISC_DYNAMIC_MINOR; 1938d021c344SAndy King err = misc_register(&vsock_device); 1939d021c344SAndy King if (err) { 1940d021c344SAndy King pr_err("Failed to register misc device\n"); 1941d021c344SAndy King return -ENOENT; 1942d021c344SAndy King } 1943d021c344SAndy King 1944d021c344SAndy King err = proto_register(&vsock_proto, 1); /* we want our slab */ 1945d021c344SAndy King if (err) { 1946d021c344SAndy King pr_err("Cannot register vsock protocol\n"); 1947d021c344SAndy King goto err_misc_deregister; 1948d021c344SAndy King } 1949d021c344SAndy King 1950d021c344SAndy King err = sock_register(&vsock_family_ops); 1951d021c344SAndy King if (err) { 1952d021c344SAndy King pr_err("could not register af_vsock (%d) address family: %d\n", 1953d021c344SAndy King AF_VSOCK, err); 1954d021c344SAndy King goto err_unregister_proto; 1955d021c344SAndy King } 1956d021c344SAndy King 1957d021c344SAndy King return 0; 1958d021c344SAndy King 1959d021c344SAndy King err_unregister_proto: 1960d021c344SAndy King proto_unregister(&vsock_proto); 1961d021c344SAndy King err_misc_deregister: 1962d021c344SAndy King misc_deregister(&vsock_device); 1963d021c344SAndy King return err; 1964d021c344SAndy King } 1965d021c344SAndy King 1966d021c344SAndy King int vsock_core_init(const struct vsock_transport *t) 1967d021c344SAndy King { 1968d021c344SAndy King int retval = mutex_lock_interruptible(&vsock_register_mutex); 1969d021c344SAndy King if (retval) 1970d021c344SAndy King return retval; 1971d021c344SAndy King 1972d021c344SAndy King if (transport) { 1973d021c344SAndy King retval = -EBUSY; 1974d021c344SAndy King goto out; 1975d021c344SAndy King } 1976d021c344SAndy King 1977d021c344SAndy King transport = t; 1978d021c344SAndy King retval = __vsock_core_init(); 1979d021c344SAndy King if (retval) 1980d021c344SAndy King transport = NULL; 1981d021c344SAndy King 1982d021c344SAndy King out: 1983d021c344SAndy King mutex_unlock(&vsock_register_mutex); 1984d021c344SAndy King return retval; 1985d021c344SAndy King } 1986d021c344SAndy King EXPORT_SYMBOL_GPL(vsock_core_init); 1987d021c344SAndy King 1988d021c344SAndy King void vsock_core_exit(void) 1989d021c344SAndy King { 1990d021c344SAndy King mutex_lock(&vsock_register_mutex); 1991d021c344SAndy King 1992d021c344SAndy King misc_deregister(&vsock_device); 1993d021c344SAndy King sock_unregister(AF_VSOCK); 1994d021c344SAndy King proto_unregister(&vsock_proto); 1995d021c344SAndy King 1996d021c344SAndy King /* We do not want the assignment below re-ordered. */ 1997d021c344SAndy King mb(); 1998d021c344SAndy King transport = NULL; 1999d021c344SAndy King 2000d021c344SAndy King mutex_unlock(&vsock_register_mutex); 2001d021c344SAndy King } 2002d021c344SAndy King EXPORT_SYMBOL_GPL(vsock_core_exit); 2003d021c344SAndy King 2004d021c344SAndy King MODULE_AUTHOR("VMware, Inc."); 2005d021c344SAndy King MODULE_DESCRIPTION("VMware Virtual Socket Family"); 20067ccd7de6SDmitry Torokhov MODULE_VERSION("1.0.0.0-k"); 2007d021c344SAndy King MODULE_LICENSE("GPL v2"); 2008