socket.c 50.7 KB
Newer Older
P
Per Liden 已提交
1 2
/*
 * net/tipc/socket.c: TIPC socket API
3
 *
4
 * Copyright (c) 2001-2007, 2012 Ericsson AB
5
 * Copyright (c) 2004-2008, 2010-2013, Wind River Systems
P
Per Liden 已提交
6 7
 * All rights reserved.
 *
P
Per Liden 已提交
8
 * Redistribution and use in source and binary forms, with or without
P
Per Liden 已提交
9 10
 * modification, are permitted provided that the following conditions are met:
 *
P
Per Liden 已提交
11 12 13 14 15 16 17 18
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 * 3. Neither the names of the copyright holders nor the names of its
 *    contributors may be used to endorse or promote products derived from
 *    this software without specific prior written permission.
P
Per Liden 已提交
19
 *
P
Per Liden 已提交
20 21 22 23 24 25 26 27 28 29 30 31 32 33
 * Alternatively, this software may be distributed under the terms of the
 * GNU General Public License ("GPL") version 2 as published by the Free
 * Software Foundation.
 *
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
P
Per Liden 已提交
34 35 36 37
 * POSSIBILITY OF SUCH DAMAGE.
 */

#include "core.h"
38
#include "port.h"
P
Per Liden 已提交
39

40 41 42
#include <linux/export.h>
#include <net/sock.h>

P
Per Liden 已提交
43 44 45
#define SS_LISTENING	-1	/* socket is listening */
#define SS_READY	-2	/* socket is connectionless */

46
#define CONN_TIMEOUT_DEFAULT	8000	/* default connect timeout = 8s */
P
Per Liden 已提交
47 48 49 50

struct tipc_sock {
	struct sock sk;
	struct tipc_port *p;
51
	struct tipc_portid peer_name;
52
	unsigned int conn_timeout;
P
Per Liden 已提交
53 54
};

55
#define tipc_sk(sk) ((struct tipc_sock *)(sk))
J
Joe Perches 已提交
56
#define tipc_sk_port(sk) (tipc_sk(sk)->p)
P
Per Liden 已提交
57

58
static int backlog_rcv(struct sock *sk, struct sk_buff *skb);
P
Per Liden 已提交
59 60
static u32 dispatch(struct tipc_port *tport, struct sk_buff *buf);
static void wakeupdispatch(struct tipc_port *tport);
61 62
static void tipc_data_ready(struct sock *sk, int len);
static void tipc_write_space(struct sock *sk);
63 64
static int release(struct socket *sock);
static int accept(struct socket *sock, struct socket *new_sock, int flags);
P
Per Liden 已提交
65

66 67 68
static const struct proto_ops packet_ops;
static const struct proto_ops stream_ops;
static const struct proto_ops msg_ops;
P
Per Liden 已提交
69 70

static struct proto tipc_proto;
71
static struct proto tipc_proto_kern;
P
Per Liden 已提交
72

73
/*
74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121
 * Revised TIPC socket locking policy:
 *
 * Most socket operations take the standard socket lock when they start
 * and hold it until they finish (or until they need to sleep).  Acquiring
 * this lock grants the owner exclusive access to the fields of the socket
 * data structures, with the exception of the backlog queue.  A few socket
 * operations can be done without taking the socket lock because they only
 * read socket information that never changes during the life of the socket.
 *
 * Socket operations may acquire the lock for the associated TIPC port if they
 * need to perform an operation on the port.  If any routine needs to acquire
 * both the socket lock and the port lock it must take the socket lock first
 * to avoid the risk of deadlock.
 *
 * The dispatcher handling incoming messages cannot grab the socket lock in
 * the standard fashion, since invoked it runs at the BH level and cannot block.
 * Instead, it checks to see if the socket lock is currently owned by someone,
 * and either handles the message itself or adds it to the socket's backlog
 * queue; in the latter case the queued message is processed once the process
 * owning the socket lock releases it.
 *
 * NOTE: Releasing the socket lock while an operation is sleeping overcomes
 * the problem of a blocked socket operation preventing any other operations
 * from occurring.  However, applications must be careful if they have
 * multiple threads trying to send (or receive) on the same socket, as these
 * operations might interfere with each other.  For example, doing a connect
 * and a receive at the same time might allow the receive to consume the
 * ACK message meant for the connect.  While additional work could be done
 * to try and overcome this, it doesn't seem to be worthwhile at the present.
 *
 * NOTE: Releasing the socket lock while an operation is sleeping also ensures
 * that another operation that must be performed in a non-blocking manner is
 * not delayed for very long because the lock has already been taken.
 *
 * NOTE: This code assumes that certain fields of a port/socket pair are
 * constant over its lifetime; such fields can be examined without taking
 * the socket lock and/or port lock, and do not need to be re-read even
 * after resuming processing after waiting.  These fields include:
 *   - socket type
 *   - pointer to socket sk structure (aka tipc_sock structure)
 *   - pointer to port structure
 *   - port reference
 */

/**
 * advance_rx_queue - discard first buffer in socket receive queue
 *
 * Caller must hold socket lock
P
Per Liden 已提交
122
 */
123
static void advance_rx_queue(struct sock *sk)
P
Per Liden 已提交
124
{
125
	kfree_skb(__skb_dequeue(&sk->sk_receive_queue));
P
Per Liden 已提交
126 127 128
}

/**
129 130 131
 * reject_rx_queue - reject all buffers in socket receive queue
 *
 * Caller must hold socket lock
P
Per Liden 已提交
132
 */
133
static void reject_rx_queue(struct sock *sk)
P
Per Liden 已提交
134
{
135 136
	struct sk_buff *buf;

137
	while ((buf = __skb_dequeue(&sk->sk_receive_queue)))
138
		tipc_reject_msg(buf, TIPC_ERR_NO_PORT);
P
Per Liden 已提交
139 140 141
}

/**
142
 * tipc_sk_create - create a TIPC socket
143
 * @net: network namespace (must be default network)
P
Per Liden 已提交
144 145
 * @sock: pre-allocated socket structure
 * @protocol: protocol indicator (must be 0)
146
 * @kern: caused by kernel or by userspace?
147
 *
148 149
 * This routine creates additional data structures used by the TIPC socket,
 * initializes them, and links them together.
P
Per Liden 已提交
150 151 152
 *
 * Returns 0 on success, errno otherwise
 */
153 154
static int tipc_sk_create(struct net *net, struct socket *sock, int protocol,
			  int kern)
P
Per Liden 已提交
155
{
156 157
	const struct proto_ops *ops;
	socket_state state;
P
Per Liden 已提交
158
	struct sock *sk;
159
	struct tipc_port *tp_ptr;
160 161

	/* Validate arguments */
P
Per Liden 已提交
162 163 164 165 166
	if (unlikely(protocol != 0))
		return -EPROTONOSUPPORT;

	switch (sock->type) {
	case SOCK_STREAM:
167 168
		ops = &stream_ops;
		state = SS_UNCONNECTED;
P
Per Liden 已提交
169 170
		break;
	case SOCK_SEQPACKET:
171 172
		ops = &packet_ops;
		state = SS_UNCONNECTED;
P
Per Liden 已提交
173 174 175
		break;
	case SOCK_DGRAM:
	case SOCK_RDM:
176 177
		ops = &msg_ops;
		state = SS_READY;
P
Per Liden 已提交
178
		break;
179 180
	default:
		return -EPROTOTYPE;
P
Per Liden 已提交
181 182
	}

183
	/* Allocate socket's protocol area */
184 185 186 187 188
	if (!kern)
		sk = sk_alloc(net, AF_TIPC, GFP_KERNEL, &tipc_proto);
	else
		sk = sk_alloc(net, AF_TIPC, GFP_KERNEL, &tipc_proto_kern);

189
	if (sk == NULL)
P
Per Liden 已提交
190 191
		return -ENOMEM;

192
	/* Allocate TIPC port for socket to use */
193 194
	tp_ptr = tipc_createport(sk, &dispatch, &wakeupdispatch,
				 TIPC_LOW_IMPORTANCE);
195
	if (unlikely(!tp_ptr)) {
196 197 198
		sk_free(sk);
		return -ENOMEM;
	}
P
Per Liden 已提交
199

200 201 202
	/* Finish initializing socket data structures */
	sock->ops = ops;
	sock->state = state;
P
Per Liden 已提交
203

204 205
	sock_init_data(sock, sk);
	sk->sk_backlog_rcv = backlog_rcv;
206
	sk->sk_rcvbuf = sysctl_tipc_rmem[1];
207 208
	sk->sk_data_ready = tipc_data_ready;
	sk->sk_write_space = tipc_write_space;
209
	tipc_sk(sk)->p = tp_ptr;
210
	tipc_sk(sk)->conn_timeout = CONN_TIMEOUT_DEFAULT;
P
Per Liden 已提交
211

212 213
	spin_unlock_bh(tp_ptr->lock);

214
	if (sock->state == SS_READY) {
215
		tipc_set_portunreturnable(tp_ptr->ref, 1);
216
		if (sock->type == SOCK_DGRAM)
217
			tipc_set_portunreliable(tp_ptr->ref, 1);
218
	}
P
Per Liden 已提交
219 220 221 222

	return 0;
}

223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272
/**
 * tipc_sock_create_local - create TIPC socket from inside TIPC module
 * @type: socket type - SOCK_RDM or SOCK_SEQPACKET
 *
 * We cannot use sock_creat_kern here because it bumps module user count.
 * Since socket owner and creator is the same module we must make sure
 * that module count remains zero for module local sockets, otherwise
 * we cannot do rmmod.
 *
 * Returns 0 on success, errno otherwise
 */
int tipc_sock_create_local(int type, struct socket **res)
{
	int rc;

	rc = sock_create_lite(AF_TIPC, type, 0, res);
	if (rc < 0) {
		pr_err("Failed to create kernel socket\n");
		return rc;
	}
	tipc_sk_create(&init_net, *res, 0, 1);

	return 0;
}

/**
 * tipc_sock_release_local - release socket created by tipc_sock_create_local
 * @sock: the socket to be released.
 *
 * Module reference count is not incremented when such sockets are created,
 * so we must keep it from being decremented when they are released.
 */
void tipc_sock_release_local(struct socket *sock)
{
	release(sock);
	sock->ops = NULL;
	sock_release(sock);
}

/**
 * tipc_sock_accept_local - accept a connection on a socket created
 * with tipc_sock_create_local. Use this function to avoid that
 * module reference count is inadvertently incremented.
 *
 * @sock:    the accepting socket
 * @newsock: reference to the new socket to be created
 * @flags:   socket flags
 */

int tipc_sock_accept_local(struct socket *sock, struct socket **newsock,
273
			   int flags)
274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291
{
	struct sock *sk = sock->sk;
	int ret;

	ret = sock_create_lite(sk->sk_family, sk->sk_type,
			       sk->sk_protocol, newsock);
	if (ret < 0)
		return ret;

	ret = accept(sock, *newsock, flags);
	if (ret < 0) {
		sock_release(*newsock);
		return ret;
	}
	(*newsock)->ops = sock->ops;
	return ret;
}

P
Per Liden 已提交
292 293 294 295 296 297 298 299 300
/**
 * release - destroy a TIPC socket
 * @sock: socket to destroy
 *
 * This routine cleans up any messages that are still queued on the socket.
 * For DGRAM and RDM socket types, all queued messages are rejected.
 * For SEQPACKET and STREAM socket types, the first message is rejected
 * and any others are discarded.  (If the first message on a STREAM socket
 * is partially-read, it is discarded and the next one is rejected instead.)
301
 *
P
Per Liden 已提交
302 303 304 305 306 307 308 309 310
 * NOTE: Rejected messages are not necessarily returned to the sender!  They
 * are returned or discarded according to the "destination droppable" setting
 * specified for the message by the sender.
 *
 * Returns 0 on success, errno otherwise
 */
static int release(struct socket *sock)
{
	struct sock *sk = sock->sk;
311
	struct tipc_port *tport;
P
Per Liden 已提交
312
	struct sk_buff *buf;
313
	int res;
P
Per Liden 已提交
314

315 316 317 318 319
	/*
	 * Exit if socket isn't fully initialized (occurs when a failed accept()
	 * releases a pre-allocated child socket that was never used)
	 */
	if (sk == NULL)
P
Per Liden 已提交
320
		return 0;
321

322 323 324 325 326 327 328
	tport = tipc_sk_port(sk);
	lock_sock(sk);

	/*
	 * Reject all unreceived messages, except on an active connection
	 * (which disconnects locally & sends a 'FIN+' to peer)
	 */
P
Per Liden 已提交
329
	while (sock->state != SS_DISCONNECTING) {
330 331
		buf = __skb_dequeue(&sk->sk_receive_queue);
		if (buf == NULL)
P
Per Liden 已提交
332
			break;
Y
Ying Xue 已提交
333
		if (TIPC_SKB_CB(buf)->handle != NULL)
334
			kfree_skb(buf);
335 336 337 338 339 340
		else {
			if ((sock->state == SS_CONNECTING) ||
			    (sock->state == SS_CONNECTED)) {
				sock->state = SS_DISCONNECTING;
				tipc_disconnect(tport->ref);
			}
P
Per Liden 已提交
341
			tipc_reject_msg(buf, TIPC_ERR_NO_PORT);
342
		}
P
Per Liden 已提交
343 344
	}

345 346 347 348
	/*
	 * Delete TIPC port; this ensures no more messages are queued
	 * (also disconnects an active connection & sends a 'FIN-' to peer)
	 */
349
	res = tipc_deleteport(tport);
P
Per Liden 已提交
350

351
	/* Discard any remaining (connection-based) messages in receive queue */
352
	__skb_queue_purge(&sk->sk_receive_queue);
P
Per Liden 已提交
353

354 355 356
	/* Reject any messages that accumulated in backlog queue */
	sock->state = SS_DISCONNECTING;
	release_sock(sk);
P
Per Liden 已提交
357 358

	sock_put(sk);
359
	sock->sk = NULL;
P
Per Liden 已提交
360 361 362 363 364 365 366 367 368

	return res;
}

/**
 * bind - associate or disassocate TIPC name(s) with a socket
 * @sock: socket structure
 * @uaddr: socket address describing name(s) and desired operation
 * @uaddr_len: size of socket address data structure
369
 *
P
Per Liden 已提交
370 371 372
 * Name and name sequence binding is indicated using a positive scope value;
 * a negative scope value unbinds the specified name.  Specifying no name
 * (i.e. a socket address length of 0) unbinds all names from the socket.
373
 *
P
Per Liden 已提交
374
 * Returns 0 on success, errno otherwise
375 376 377
 *
 * NOTE: This routine doesn't need to take the socket lock since it doesn't
 *       access any non-constant socket information.
P
Per Liden 已提交
378 379 380
 */
static int bind(struct socket *sock, struct sockaddr *uaddr, int uaddr_len)
{
381
	struct sock *sk = sock->sk;
P
Per Liden 已提交
382
	struct sockaddr_tipc *addr = (struct sockaddr_tipc *)uaddr;
383 384
	struct tipc_port *tport = tipc_sk_port(sock->sk);
	int res = -EINVAL;
P
Per Liden 已提交
385

386 387 388 389 390
	lock_sock(sk);
	if (unlikely(!uaddr_len)) {
		res = tipc_withdraw(tport, 0, NULL);
		goto exit;
	}
391

392 393 394 395 396 397 398 399
	if (uaddr_len < sizeof(struct sockaddr_tipc)) {
		res = -EINVAL;
		goto exit;
	}
	if (addr->family != AF_TIPC) {
		res = -EAFNOSUPPORT;
		goto exit;
	}
P
Per Liden 已提交
400 401 402

	if (addr->addrtype == TIPC_ADDR_NAME)
		addr->addr.nameseq.upper = addr->addr.nameseq.lower;
403 404 405 406
	else if (addr->addrtype != TIPC_ADDR_NAMESEQ) {
		res = -EAFNOSUPPORT;
		goto exit;
	}
407

408
	if ((addr->addr.nameseq.type < TIPC_RESERVED_TYPES) &&
409
	    (addr->addr.nameseq.type != TIPC_TOP_SRV) &&
410 411 412 413
	    (addr->addr.nameseq.type != TIPC_CFG_SRV)) {
		res = -EACCES;
		goto exit;
	}
414

415 416 417 418 419 420
	res = (addr->scope > 0) ?
		tipc_publish(tport, addr->scope, &addr->addr.nameseq) :
		tipc_withdraw(tport, -addr->scope, &addr->addr.nameseq);
exit:
	release_sock(sk);
	return res;
P
Per Liden 已提交
421 422
}

423
/**
P
Per Liden 已提交
424 425 426 427
 * get_name - get port ID of socket or peer socket
 * @sock: socket structure
 * @uaddr: area for returned socket address
 * @uaddr_len: area for returned length of socket address
428
 * @peer: 0 = own ID, 1 = current peer ID, 2 = current/former peer ID
429
 *
P
Per Liden 已提交
430
 * Returns 0 on success, errno otherwise
431
 *
432 433
 * NOTE: This routine doesn't need to take the socket lock since it only
 *       accesses socket information that is unchanging (or which changes in
434
 *       a completely predictable manner).
P
Per Liden 已提交
435
 */
436
static int get_name(struct socket *sock, struct sockaddr *uaddr,
P
Per Liden 已提交
437 438 439
		    int *uaddr_len, int peer)
{
	struct sockaddr_tipc *addr = (struct sockaddr_tipc *)uaddr;
440
	struct tipc_sock *tsock = tipc_sk(sock->sk);
P
Per Liden 已提交
441

442
	memset(addr, 0, sizeof(*addr));
443
	if (peer) {
444 445 446 447 448
		if ((sock->state != SS_CONNECTED) &&
			((peer != 2) || (sock->state != SS_DISCONNECTING)))
			return -ENOTCONN;
		addr->addr.id.ref = tsock->peer_name.ref;
		addr->addr.id.node = tsock->peer_name.node;
449
	} else {
A
Allan Stephens 已提交
450 451
		addr->addr.id.ref = tsock->p->ref;
		addr->addr.id.node = tipc_own_addr;
452
	}
P
Per Liden 已提交
453 454 455 456 457 458 459

	*uaddr_len = sizeof(*addr);
	addr->addrtype = TIPC_ADDR_ID;
	addr->family = AF_TIPC;
	addr->scope = 0;
	addr->addr.name.domain = 0;

460
	return 0;
P
Per Liden 已提交
461 462 463 464 465 466 467 468
}

/**
 * poll - read and possibly block on pollmask
 * @file: file structure associated with the socket
 * @sock: socket for which to calculate the poll bits
 * @wait: ???
 *
469 470 471 472 473 474 475 476 477
 * Returns pollmask value
 *
 * COMMENTARY:
 * It appears that the usual socket locking mechanisms are not useful here
 * since the pollmask info is potentially out-of-date the moment this routine
 * exits.  TCP and other protocols seem to rely on higher level poll routines
 * to handle any preventable race conditions, so TIPC will do the same ...
 *
 * TIPC sets the returned events as follows:
478 479 480 481
 *
 * socket state		flags set
 * ------------		---------
 * unconnected		no read flags
482
 *			POLLOUT if port is not congested
483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501
 *
 * connecting		POLLIN/POLLRDNORM if ACK/NACK in rx queue
 *			no write flags
 *
 * connected		POLLIN/POLLRDNORM if data in rx queue
 *			POLLOUT if port is not congested
 *
 * disconnecting	POLLIN/POLLRDNORM/POLLHUP
 *			no write flags
 *
 * listening		POLLIN if SYN in rx queue
 *			no write flags
 *
 * ready		POLLIN/POLLRDNORM if data in rx queue
 * [connectionless]	POLLOUT (since port cannot be congested)
 *
 * IMPORTANT: The fact that a read or write operation is indicated does NOT
 * imply that the operation will succeed, merely that it should be performed
 * and will not block.
P
Per Liden 已提交
502
 */
503
static unsigned int poll(struct file *file, struct socket *sock,
P
Per Liden 已提交
504 505
			 poll_table *wait)
{
506
	struct sock *sk = sock->sk;
507
	u32 mask = 0;
508

509
	sock_poll_wait(file, sk_sleep(sk), wait);
510

511
	switch ((int)sock->state) {
512 513 514 515
	case SS_UNCONNECTED:
		if (!tipc_sk_port(sk)->congested)
			mask |= POLLOUT;
		break;
516 517 518 519 520 521 522 523 524 525 526 527 528 529
	case SS_READY:
	case SS_CONNECTED:
		if (!tipc_sk_port(sk)->congested)
			mask |= POLLOUT;
		/* fall thru' */
	case SS_CONNECTING:
	case SS_LISTENING:
		if (!skb_queue_empty(&sk->sk_receive_queue))
			mask |= (POLLIN | POLLRDNORM);
		break;
	case SS_DISCONNECTING:
		mask = (POLLIN | POLLRDNORM | POLLHUP);
		break;
	}
530 531

	return mask;
P
Per Liden 已提交
532 533
}

534
/**
P
Per Liden 已提交
535 536 537
 * dest_name_check - verify user is permitted to send to specified port name
 * @dest: destination address
 * @m: descriptor for message to be sent
538
 *
P
Per Liden 已提交
539 540
 * Prevents restricted configuration commands from being issued by
 * unauthorized users.
541
 *
P
Per Liden 已提交
542 543
 * Returns 0 if permission is granted, otherwise errno
 */
S
Sam Ravnborg 已提交
544
static int dest_name_check(struct sockaddr_tipc *dest, struct msghdr *m)
P
Per Liden 已提交
545 546 547
{
	struct tipc_cfg_msg_hdr hdr;

548 549 550 551 552 553
	if (likely(dest->addr.name.name.type >= TIPC_RESERVED_TYPES))
		return 0;
	if (likely(dest->addr.name.name.type == TIPC_TOP_SRV))
		return 0;
	if (likely(dest->addr.name.name.type != TIPC_CFG_SRV))
		return -EACCES;
P
Per Liden 已提交
554

555 556
	if (!m->msg_iovlen || (m->msg_iov[0].iov_len < sizeof(hdr)))
		return -EMSGSIZE;
557
	if (copy_from_user(&hdr, m->msg_iov[0].iov_base, sizeof(hdr)))
P
Per Liden 已提交
558
		return -EFAULT;
559
	if ((ntohs(hdr.tcm_type) & 0xC000) && (!capable(CAP_NET_ADMIN)))
P
Per Liden 已提交
560
		return -EACCES;
561

P
Per Liden 已提交
562 563 564
	return 0;
}

565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589
static int tipc_wait_for_sndmsg(struct socket *sock, long *timeo_p)
{
	struct sock *sk = sock->sk;
	struct tipc_port *tport = tipc_sk_port(sk);
	DEFINE_WAIT(wait);
	int done;

	do {
		int err = sock_error(sk);
		if (err)
			return err;
		if (sock->state == SS_DISCONNECTING)
			return -EPIPE;
		if (!*timeo_p)
			return -EAGAIN;
		if (signal_pending(current))
			return sock_intr_errno(*timeo_p);

		prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
		done = sk_wait_event(sk, timeo_p, !tport->congested);
		finish_wait(sk_sleep(sk), &wait);
	} while (!done);
	return 0;
}

P
Per Liden 已提交
590 591
/**
 * send_msg - send message in connectionless manner
592
 * @iocb: if NULL, indicates that socket lock is already held
P
Per Liden 已提交
593 594
 * @sock: socket structure
 * @m: message to send
595
 * @total_len: length of message
596
 *
P
Per Liden 已提交
597
 * Message must have an destination specified explicitly.
598
 * Used for SOCK_RDM and SOCK_DGRAM messages,
P
Per Liden 已提交
599 600
 * and for 'SYN' messages on SOCK_SEQPACKET and SOCK_STREAM connections.
 * (Note: 'SYN+' is prohibited on SOCK_STREAM.)
601
 *
P
Per Liden 已提交
602 603 604 605 606
 * Returns the number of bytes sent on success, or errno otherwise
 */
static int send_msg(struct kiocb *iocb, struct socket *sock,
		    struct msghdr *m, size_t total_len)
{
607 608
	struct sock *sk = sock->sk;
	struct tipc_port *tport = tipc_sk_port(sk);
609
	DECLARE_SOCKADDR(struct sockaddr_tipc *, dest, m->msg_name);
P
Per Liden 已提交
610
	int needs_conn;
611
	long timeo;
P
Per Liden 已提交
612 613 614 615
	int res = -EINVAL;

	if (unlikely(!dest))
		return -EDESTADDRREQ;
616 617
	if (unlikely((m->msg_namelen < sizeof(*dest)) ||
		     (dest->family != AF_TIPC)))
P
Per Liden 已提交
618
		return -EINVAL;
619
	if (total_len > TIPC_MAX_USER_MSG_SIZE)
620
		return -EMSGSIZE;
P
Per Liden 已提交
621

622 623 624
	if (iocb)
		lock_sock(sk);

P
Per Liden 已提交
625 626
	needs_conn = (sock->state != SS_READY);
	if (unlikely(needs_conn)) {
627 628 629 630 631 632 633 634
		if (sock->state == SS_LISTENING) {
			res = -EPIPE;
			goto exit;
		}
		if (sock->state != SS_UNCONNECTED) {
			res = -EISCONN;
			goto exit;
		}
635
		if (tport->published) {
636 637 638
			res = -EOPNOTSUPP;
			goto exit;
		}
639
		if (dest->addrtype == TIPC_ADDR_NAME) {
640 641
			tport->conn_type = dest->addr.name.name.type;
			tport->conn_instance = dest->addr.name.name.instance;
642
		}
P
Per Liden 已提交
643 644

		/* Abort any pending connection attempts (very unlikely) */
645
		reject_rx_queue(sk);
P
Per Liden 已提交
646 647
	}

648
	timeo = sock_sndtimeo(sk, m->msg_flags & MSG_DONTWAIT);
649 650
	do {
		if (dest->addrtype == TIPC_ADDR_NAME) {
651 652
			res = dest_name_check(dest, m);
			if (res)
653 654
				break;
			res = tipc_send2name(tport->ref,
655 656
					     &dest->addr.name.name,
					     dest->addr.name.domain,
657 658
					     m->msg_iov,
					     total_len);
659
		} else if (dest->addrtype == TIPC_ADDR_ID) {
660
			res = tipc_send2port(tport->ref,
661
					     &dest->addr.id,
662 663
					     m->msg_iov,
					     total_len);
664
		} else if (dest->addrtype == TIPC_ADDR_MCAST) {
P
Per Liden 已提交
665 666
			if (needs_conn) {
				res = -EOPNOTSUPP;
667
				break;
P
Per Liden 已提交
668
			}
669 670
			res = dest_name_check(dest, m);
			if (res)
671 672
				break;
			res = tipc_multicast(tport->ref,
673
					     &dest->addr.nameseq,
674 675
					     m->msg_iov,
					     total_len);
676 677
		}
		if (likely(res != -ELINKCONG)) {
678
			if (needs_conn && (res >= 0))
679 680
				sock->state = SS_CONNECTING;
			break;
681
		}
682 683
		res = tipc_wait_for_sndmsg(sock, &timeo);
		if (res)
684
			break;
685
	} while (1);
686 687 688 689 690

exit:
	if (iocb)
		release_sock(sk);
	return res;
P
Per Liden 已提交
691 692
}

693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720
static int tipc_wait_for_sndpkt(struct socket *sock, long *timeo_p)
{
	struct sock *sk = sock->sk;
	struct tipc_port *tport = tipc_sk_port(sk);
	DEFINE_WAIT(wait);
	int done;

	do {
		int err = sock_error(sk);
		if (err)
			return err;
		if (sock->state == SS_DISCONNECTING)
			return -EPIPE;
		else if (sock->state != SS_CONNECTED)
			return -ENOTCONN;
		if (!*timeo_p)
			return -EAGAIN;
		if (signal_pending(current))
			return sock_intr_errno(*timeo_p);

		prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
		done = sk_wait_event(sk, timeo_p,
				     (!tport->congested || !tport->connected));
		finish_wait(sk_sleep(sk), &wait);
	} while (!done);
	return 0;
}

721
/**
P
Per Liden 已提交
722
 * send_packet - send a connection-oriented message
723
 * @iocb: if NULL, indicates that socket lock is already held
P
Per Liden 已提交
724 725
 * @sock: socket structure
 * @m: message to send
726
 * @total_len: length of message
727
 *
P
Per Liden 已提交
728
 * Used for SOCK_SEQPACKET messages and SOCK_STREAM data.
729
 *
P
Per Liden 已提交
730 731 732 733 734
 * Returns the number of bytes sent on success, or errno otherwise
 */
static int send_packet(struct kiocb *iocb, struct socket *sock,
		       struct msghdr *m, size_t total_len)
{
735 736
	struct sock *sk = sock->sk;
	struct tipc_port *tport = tipc_sk_port(sk);
737
	DECLARE_SOCKADDR(struct sockaddr_tipc *, dest, m->msg_name);
738 739
	int res = -EINVAL;
	long timeo;
P
Per Liden 已提交
740 741 742 743 744

	/* Handle implied connection establishment */
	if (unlikely(dest))
		return send_msg(iocb, sock, m, total_len);

745
	if (total_len > TIPC_MAX_USER_MSG_SIZE)
746 747
		return -EMSGSIZE;

748 749
	if (iocb)
		lock_sock(sk);
P
Per Liden 已提交
750

751 752 753 754 755 756 757
	if (unlikely(sock->state != SS_CONNECTED)) {
		if (sock->state == SS_DISCONNECTING)
			res = -EPIPE;
		else
			res = -ENOTCONN;
		goto exit;
	}
758

759
	timeo = sock_sndtimeo(sk, m->msg_flags & MSG_DONTWAIT);
760
	do {
761
		res = tipc_send(tport->ref, m->msg_iov, total_len);
762
		if (likely(res != -ELINKCONG))
763
			break;
764 765
		res = tipc_wait_for_sndpkt(sock, &timeo);
		if (res)
766
			break;
767
	} while (1);
768
exit:
769 770 771
	if (iocb)
		release_sock(sk);
	return res;
P
Per Liden 已提交
772 773
}

774
/**
P
Per Liden 已提交
775 776 777 778 779
 * send_stream - send stream-oriented data
 * @iocb: (unused)
 * @sock: socket structure
 * @m: data to send
 * @total_len: total length of data to be sent
780
 *
P
Per Liden 已提交
781
 * Used for SOCK_STREAM data.
782 783
 *
 * Returns the number of bytes sent on success (or partial success),
784
 * or errno if no data sent
P
Per Liden 已提交
785 786 787 788
 */
static int send_stream(struct kiocb *iocb, struct socket *sock,
		       struct msghdr *m, size_t total_len)
{
789 790
	struct sock *sk = sock->sk;
	struct tipc_port *tport = tipc_sk_port(sk);
P
Per Liden 已提交
791 792 793 794 795
	struct msghdr my_msg;
	struct iovec my_iov;
	struct iovec *curr_iov;
	int curr_iovlen;
	char __user *curr_start;
796
	u32 hdr_size;
P
Per Liden 已提交
797 798
	int curr_left;
	int bytes_to_send;
799
	int bytes_sent;
P
Per Liden 已提交
800
	int res;
801

802 803
	lock_sock(sk);

804
	/* Handle special cases where there is no connection */
805
	if (unlikely(sock->state != SS_CONNECTED)) {
W
wangweidong 已提交
806
		if (sock->state == SS_UNCONNECTED)
807
			res = send_packet(NULL, sock, m, total_len);
808 809
		else
			res = sock->state == SS_DISCONNECTING ? -EPIPE : -ENOTCONN;
W
wangweidong 已提交
810
		goto exit;
811
	}
P
Per Liden 已提交
812

813 814 815 816
	if (unlikely(m->msg_name)) {
		res = -EISCONN;
		goto exit;
	}
817

818
	if (total_len > (unsigned int)INT_MAX) {
819 820 821 822
		res = -EMSGSIZE;
		goto exit;
	}

823
	/*
P
Per Liden 已提交
824 825
	 * Send each iovec entry using one or more messages
	 *
826
	 * Note: This algorithm is good for the most likely case
P
Per Liden 已提交
827 828 829
	 * (i.e. one large iovec entry), but could be improved to pass sets
	 * of small iovec entries into send_packet().
	 */
830 831
	curr_iov = m->msg_iov;
	curr_iovlen = m->msg_iovlen;
P
Per Liden 已提交
832 833
	my_msg.msg_iov = &my_iov;
	my_msg.msg_iovlen = 1;
834 835
	my_msg.msg_flags = m->msg_flags;
	my_msg.msg_name = NULL;
836
	bytes_sent = 0;
P
Per Liden 已提交
837

838 839
	hdr_size = msg_hdr_sz(&tport->phdr);

P
Per Liden 已提交
840 841 842 843 844
	while (curr_iovlen--) {
		curr_start = curr_iov->iov_base;
		curr_left = curr_iov->iov_len;

		while (curr_left) {
845 846 847 848 849
			bytes_to_send = tport->max_pkt - hdr_size;
			if (bytes_to_send > TIPC_MAX_USER_MSG_SIZE)
				bytes_to_send = TIPC_MAX_USER_MSG_SIZE;
			if (curr_left < bytes_to_send)
				bytes_to_send = curr_left;
P
Per Liden 已提交
850 851
			my_iov.iov_base = curr_start;
			my_iov.iov_len = bytes_to_send;
852
			res = send_packet(NULL, sock, &my_msg, bytes_to_send);
853
			if (res < 0) {
854
				if (bytes_sent)
855
					res = bytes_sent;
856
				goto exit;
857
			}
P
Per Liden 已提交
858 859
			curr_left -= bytes_to_send;
			curr_start += bytes_to_send;
860
			bytes_sent += bytes_to_send;
P
Per Liden 已提交
861 862 863 864
		}

		curr_iov++;
	}
865 866 867 868
	res = bytes_sent;
exit:
	release_sock(sk);
	return res;
P
Per Liden 已提交
869 870 871 872 873 874
}

/**
 * auto_connect - complete connection setup to a remote port
 * @sock: socket structure
 * @msg: peer's response message
875
 *
P
Per Liden 已提交
876 877
 * Returns 0 on success, errno otherwise
 */
878
static int auto_connect(struct socket *sock, struct tipc_msg *msg)
P
Per Liden 已提交
879
{
880
	struct tipc_sock *tsock = tipc_sk(sock->sk);
881
	struct tipc_port *p_ptr;
P
Per Liden 已提交
882

883 884
	tsock->peer_name.ref = msg_origport(msg);
	tsock->peer_name.node = msg_orignode(msg);
885 886 887 888 889 890 891 892 893
	p_ptr = tipc_port_deref(tsock->p->ref);
	if (!p_ptr)
		return -EINVAL;

	__tipc_connect(tsock->p->ref, p_ptr, &tsock->peer_name);

	if (msg_importance(msg) > TIPC_CRITICAL_IMPORTANCE)
		return -EINVAL;
	msg_set_importance(&p_ptr->phdr, (u32)msg_importance(msg));
P
Per Liden 已提交
894 895 896 897 898 899 900 901
	sock->state = SS_CONNECTED;
	return 0;
}

/**
 * set_orig_addr - capture sender's address for received message
 * @m: descriptor for message info
 * @msg: received message header
902
 *
P
Per Liden 已提交
903 904
 * Note: Address is not captured if not requested by receiver.
 */
S
Sam Ravnborg 已提交
905
static void set_orig_addr(struct msghdr *m, struct tipc_msg *msg)
P
Per Liden 已提交
906
{
907
	DECLARE_SOCKADDR(struct sockaddr_tipc *, addr, m->msg_name);
P
Per Liden 已提交
908

909
	if (addr) {
P
Per Liden 已提交
910 911
		addr->family = AF_TIPC;
		addr->addrtype = TIPC_ADDR_ID;
912
		memset(&addr->addr, 0, sizeof(addr->addr));
P
Per Liden 已提交
913 914
		addr->addr.id.ref = msg_origport(msg);
		addr->addr.id.node = msg_orignode(msg);
915 916
		addr->addr.name.domain = 0;	/* could leave uninitialized */
		addr->scope = 0;		/* could leave uninitialized */
P
Per Liden 已提交
917 918 919 920 921
		m->msg_namelen = sizeof(struct sockaddr_tipc);
	}
}

/**
922
 * anc_data_recv - optionally capture ancillary data for received message
P
Per Liden 已提交
923 924 925
 * @m: descriptor for message info
 * @msg: received message header
 * @tport: TIPC port associated with message
926
 *
P
Per Liden 已提交
927
 * Note: Ancillary data is not captured if not requested by receiver.
928
 *
P
Per Liden 已提交
929 930
 * Returns 0 if successful, otherwise errno
 */
S
Sam Ravnborg 已提交
931
static int anc_data_recv(struct msghdr *m, struct tipc_msg *msg,
932
			 struct tipc_port *tport)
P
Per Liden 已提交
933 934 935 936
{
	u32 anc_data[3];
	u32 err;
	u32 dest_type;
937
	int has_name;
P
Per Liden 已提交
938 939 940 941 942 943 944 945 946 947
	int res;

	if (likely(m->msg_controllen == 0))
		return 0;

	/* Optionally capture errored message object(s) */
	err = msg ? msg_errcode(msg) : 0;
	if (unlikely(err)) {
		anc_data[0] = err;
		anc_data[1] = msg_data_sz(msg);
948 949
		res = put_cmsg(m, SOL_TIPC, TIPC_ERRINFO, 8, anc_data);
		if (res)
P
Per Liden 已提交
950
			return res;
951 952 953 954 955 956
		if (anc_data[1]) {
			res = put_cmsg(m, SOL_TIPC, TIPC_RETDATA, anc_data[1],
				       msg_data(msg));
			if (res)
				return res;
		}
P
Per Liden 已提交
957 958 959 960 961 962
	}

	/* Optionally capture message destination object */
	dest_type = msg ? msg_type(msg) : TIPC_DIRECT_MSG;
	switch (dest_type) {
	case TIPC_NAMED_MSG:
963
		has_name = 1;
P
Per Liden 已提交
964 965 966 967 968
		anc_data[0] = msg_nametype(msg);
		anc_data[1] = msg_namelower(msg);
		anc_data[2] = msg_namelower(msg);
		break;
	case TIPC_MCAST_MSG:
969
		has_name = 1;
P
Per Liden 已提交
970 971 972 973 974
		anc_data[0] = msg_nametype(msg);
		anc_data[1] = msg_namelower(msg);
		anc_data[2] = msg_nameupper(msg);
		break;
	case TIPC_CONN_MSG:
975
		has_name = (tport->conn_type != 0);
P
Per Liden 已提交
976 977 978 979 980
		anc_data[0] = tport->conn_type;
		anc_data[1] = tport->conn_instance;
		anc_data[2] = tport->conn_instance;
		break;
	default:
981
		has_name = 0;
P
Per Liden 已提交
982
	}
983 984 985 986 987
	if (has_name) {
		res = put_cmsg(m, SOL_TIPC, TIPC_DESTNAME, 12, anc_data);
		if (res)
			return res;
	}
P
Per Liden 已提交
988 989 990 991

	return 0;
}

Y
Ying Xue 已提交
992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022
static int tipc_wait_for_rcvmsg(struct socket *sock, long timeo)
{
	struct sock *sk = sock->sk;
	DEFINE_WAIT(wait);
	int err;

	for (;;) {
		prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
		if (skb_queue_empty(&sk->sk_receive_queue)) {
			if (sock->state == SS_DISCONNECTING) {
				err = -ENOTCONN;
				break;
			}
			release_sock(sk);
			timeo = schedule_timeout(timeo);
			lock_sock(sk);
		}
		err = 0;
		if (!skb_queue_empty(&sk->sk_receive_queue))
			break;
		err = sock_intr_errno(timeo);
		if (signal_pending(current))
			break;
		err = -EAGAIN;
		if (!timeo)
			break;
	}
	finish_wait(sk_sleep(sk), &wait);
	return err;
}

1023
/**
P
Per Liden 已提交
1024 1025 1026 1027 1028
 * recv_msg - receive packet-oriented message
 * @iocb: (unused)
 * @m: descriptor for message info
 * @buf_len: total size of user buffer area
 * @flags: receive flags
1029
 *
P
Per Liden 已提交
1030 1031 1032 1033 1034 1035 1036 1037
 * Used for SOCK_DGRAM, SOCK_RDM, and SOCK_SEQPACKET messages.
 * If the complete message doesn't fit in user area, truncate it.
 *
 * Returns size of returned message data, errno otherwise
 */
static int recv_msg(struct kiocb *iocb, struct socket *sock,
		    struct msghdr *m, size_t buf_len, int flags)
{
1038 1039
	struct sock *sk = sock->sk;
	struct tipc_port *tport = tipc_sk_port(sk);
P
Per Liden 已提交
1040 1041
	struct sk_buff *buf;
	struct tipc_msg *msg;
Y
Ying Xue 已提交
1042
	long timeo;
P
Per Liden 已提交
1043 1044 1045 1046
	unsigned int sz;
	u32 err;
	int res;

1047
	/* Catch invalid receive requests */
P
Per Liden 已提交
1048 1049 1050
	if (unlikely(!buf_len))
		return -EINVAL;

1051
	lock_sock(sk);
P
Per Liden 已提交
1052

1053 1054
	if (unlikely(sock->state == SS_UNCONNECTED)) {
		res = -ENOTCONN;
P
Per Liden 已提交
1055 1056 1057
		goto exit;
	}

Y
Ying Xue 已提交
1058
	timeo = sock_rcvtimeo(sk, flags & MSG_DONTWAIT);
1059
restart:
P
Per Liden 已提交
1060

1061
	/* Look for a message in receive queue; wait if necessary */
Y
Ying Xue 已提交
1062 1063 1064
	res = tipc_wait_for_rcvmsg(sock, timeo);
	if (res)
		goto exit;
P
Per Liden 已提交
1065

1066 1067
	/* Look at first message in receive queue */
	buf = skb_peek(&sk->sk_receive_queue);
P
Per Liden 已提交
1068 1069 1070 1071 1072 1073
	msg = buf_msg(buf);
	sz = msg_data_sz(msg);
	err = msg_errcode(msg);

	/* Discard an empty non-errored message & try again */
	if ((!sz) && (!err)) {
1074
		advance_rx_queue(sk);
P
Per Liden 已提交
1075 1076 1077 1078 1079 1080 1081
		goto restart;
	}

	/* Capture sender's address (optional) */
	set_orig_addr(m, msg);

	/* Capture ancillary data (optional) */
1082 1083
	res = anc_data_recv(m, msg, tport);
	if (res)
P
Per Liden 已提交
1084 1085 1086 1087 1088 1089 1090 1091
		goto exit;

	/* Capture message data (if valid) & compute return value (always) */
	if (!err) {
		if (unlikely(buf_len < sz)) {
			sz = buf_len;
			m->msg_flags |= MSG_TRUNC;
		}
1092 1093 1094
		res = skb_copy_datagram_iovec(buf, msg_hdr_sz(msg),
					      m->msg_iov, sz);
		if (res)
P
Per Liden 已提交
1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106
			goto exit;
		res = sz;
	} else {
		if ((sock->state == SS_READY) ||
		    ((err == TIPC_CONN_SHUTDOWN) || m->msg_control))
			res = 0;
		else
			res = -ECONNRESET;
	}

	/* Consume received message (optional) */
	if (likely(!(flags & MSG_PEEK))) {
1107
		if ((sock->state != SS_READY) &&
1108 1109 1110
		    (++tport->conn_unacked >= TIPC_FLOW_CONTROL_WIN))
			tipc_acknowledge(tport->ref, tport->conn_unacked);
		advance_rx_queue(sk);
1111
	}
P
Per Liden 已提交
1112
exit:
1113
	release_sock(sk);
P
Per Liden 已提交
1114 1115 1116
	return res;
}

1117
/**
P
Per Liden 已提交
1118 1119 1120 1121 1122
 * recv_stream - receive stream-oriented data
 * @iocb: (unused)
 * @m: descriptor for message info
 * @buf_len: total size of user buffer area
 * @flags: receive flags
1123 1124
 *
 * Used for SOCK_STREAM messages only.  If not enough data is available
P
Per Liden 已提交
1125 1126 1127 1128 1129 1130 1131
 * will optionally wait for more; never truncates data.
 *
 * Returns size of returned message data, errno otherwise
 */
static int recv_stream(struct kiocb *iocb, struct socket *sock,
		       struct msghdr *m, size_t buf_len, int flags)
{
1132 1133
	struct sock *sk = sock->sk;
	struct tipc_port *tport = tipc_sk_port(sk);
P
Per Liden 已提交
1134 1135
	struct sk_buff *buf;
	struct tipc_msg *msg;
Y
Ying Xue 已提交
1136
	long timeo;
P
Per Liden 已提交
1137
	unsigned int sz;
1138
	int sz_to_copy, target, needed;
P
Per Liden 已提交
1139 1140
	int sz_copied = 0;
	u32 err;
1141
	int res = 0;
P
Per Liden 已提交
1142

1143
	/* Catch invalid receive attempts */
P
Per Liden 已提交
1144 1145 1146
	if (unlikely(!buf_len))
		return -EINVAL;

1147
	lock_sock(sk);
P
Per Liden 已提交
1148

Y
Ying Xue 已提交
1149
	if (unlikely(sock->state == SS_UNCONNECTED)) {
1150
		res = -ENOTCONN;
P
Per Liden 已提交
1151 1152 1153
		goto exit;
	}

1154
	target = sock_rcvlowat(sk, flags & MSG_WAITALL, buf_len);
Y
Ying Xue 已提交
1155
	timeo = sock_rcvtimeo(sk, flags & MSG_DONTWAIT);
P
Per Liden 已提交
1156

1157
restart:
1158
	/* Look for a message in receive queue; wait if necessary */
Y
Ying Xue 已提交
1159 1160 1161
	res = tipc_wait_for_rcvmsg(sock, timeo);
	if (res)
		goto exit;
P
Per Liden 已提交
1162

1163 1164
	/* Look at first message in receive queue */
	buf = skb_peek(&sk->sk_receive_queue);
P
Per Liden 已提交
1165 1166 1167 1168 1169 1170
	msg = buf_msg(buf);
	sz = msg_data_sz(msg);
	err = msg_errcode(msg);

	/* Discard an empty non-errored message & try again */
	if ((!sz) && (!err)) {
1171
		advance_rx_queue(sk);
P
Per Liden 已提交
1172 1173 1174 1175 1176 1177
		goto restart;
	}

	/* Optionally capture sender's address & ancillary data of first msg */
	if (sz_copied == 0) {
		set_orig_addr(m, msg);
1178 1179
		res = anc_data_recv(m, msg, tport);
		if (res)
P
Per Liden 已提交
1180 1181 1182 1183 1184
			goto exit;
	}

	/* Capture message data (if valid) & compute return value (always) */
	if (!err) {
1185
		u32 offset = (u32)(unsigned long)(TIPC_SKB_CB(buf)->handle);
P
Per Liden 已提交
1186

1187
		sz -= offset;
P
Per Liden 已提交
1188 1189
		needed = (buf_len - sz_copied);
		sz_to_copy = (sz <= needed) ? sz : needed;
1190 1191 1192 1193

		res = skb_copy_datagram_iovec(buf, msg_hdr_sz(msg) + offset,
					      m->msg_iov, sz_to_copy);
		if (res)
P
Per Liden 已提交
1194
			goto exit;
1195

P
Per Liden 已提交
1196 1197 1198 1199
		sz_copied += sz_to_copy;

		if (sz_to_copy < sz) {
			if (!(flags & MSG_PEEK))
1200 1201
				TIPC_SKB_CB(buf)->handle =
				(void *)(unsigned long)(offset + sz_to_copy);
P
Per Liden 已提交
1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214 1215
			goto exit;
		}
	} else {
		if (sz_copied != 0)
			goto exit; /* can't add error msg to valid data */

		if ((err == TIPC_CONN_SHUTDOWN) || m->msg_control)
			res = 0;
		else
			res = -ECONNRESET;
	}

	/* Consume received message (optional) */
	if (likely(!(flags & MSG_PEEK))) {
1216 1217 1218
		if (unlikely(++tport->conn_unacked >= TIPC_FLOW_CONTROL_WIN))
			tipc_acknowledge(tport->ref, tport->conn_unacked);
		advance_rx_queue(sk);
1219
	}
P
Per Liden 已提交
1220 1221

	/* Loop around if more data is required */
1222 1223
	if ((sz_copied < buf_len) &&	/* didn't get all requested data */
	    (!skb_queue_empty(&sk->sk_receive_queue) ||
1224
	    (sz_copied < target)) &&	/* and more is ready or required */
1225 1226
	    (!(flags & MSG_PEEK)) &&	/* and aren't just peeking at data */
	    (!err))			/* and haven't reached a FIN */
P
Per Liden 已提交
1227 1228 1229
		goto restart;

exit:
1230
	release_sock(sk);
1231
	return sz_copied ? sz_copied : res;
P
Per Liden 已提交
1232 1233
}

1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266
/**
 * tipc_write_space - wake up thread if port congestion is released
 * @sk: socket
 */
static void tipc_write_space(struct sock *sk)
{
	struct socket_wq *wq;

	rcu_read_lock();
	wq = rcu_dereference(sk->sk_wq);
	if (wq_has_sleeper(wq))
		wake_up_interruptible_sync_poll(&wq->wait, POLLOUT |
						POLLWRNORM | POLLWRBAND);
	rcu_read_unlock();
}

/**
 * tipc_data_ready - wake up threads to indicate messages have been received
 * @sk: socket
 * @len: the length of messages
 */
static void tipc_data_ready(struct sock *sk, int len)
{
	struct socket_wq *wq;

	rcu_read_lock();
	wq = rcu_dereference(sk->sk_wq);
	if (wq_has_sleeper(wq))
		wake_up_interruptible_sync_poll(&wq->wait, POLLIN |
						POLLRDNORM | POLLRDBAND);
	rcu_read_unlock();
}

1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278
/**
 * filter_connect - Handle all incoming messages for a connection-based socket
 * @tsock: TIPC socket
 * @msg: message
 *
 * Returns TIPC error status code and socket error status code
 * once it encounters some errors
 */
static u32 filter_connect(struct tipc_sock *tsock, struct sk_buff **buf)
{
	struct socket *sock = tsock->sk.sk_socket;
	struct tipc_msg *msg = buf_msg(*buf);
1279
	struct sock *sk = &tsock->sk;
1280
	u32 retval = TIPC_ERR_NO_PORT;
1281
	int res;
1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298

	if (msg_mcast(msg))
		return retval;

	switch ((int)sock->state) {
	case SS_CONNECTED:
		/* Accept only connection-based messages sent by peer */
		if (msg_connected(msg) && tipc_port_peer_msg(tsock->p, msg)) {
			if (unlikely(msg_errcode(msg))) {
				sock->state = SS_DISCONNECTING;
				__tipc_disconnect(tsock->p);
			}
			retval = TIPC_OK;
		}
		break;
	case SS_CONNECTING:
		/* Accept only ACK or NACK message */
1299 1300
		if (unlikely(msg_errcode(msg))) {
			sock->state = SS_DISCONNECTING;
1301
			sk->sk_err = ECONNREFUSED;
1302 1303 1304 1305 1306 1307 1308 1309 1310 1311
			retval = TIPC_OK;
			break;
		}

		if (unlikely(!msg_connected(msg)))
			break;

		res = auto_connect(sock, msg);
		if (res) {
			sock->state = SS_DISCONNECTING;
1312
			sk->sk_err = -res;
1313
			retval = TIPC_OK;
1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328
			break;
		}

		/* If an incoming message is an 'ACK-', it should be
		 * discarded here because it doesn't contain useful
		 * data. In addition, we should try to wake up
		 * connect() routine if sleeping.
		 */
		if (msg_data_sz(msg) == 0) {
			kfree_skb(*buf);
			*buf = NULL;
			if (waitqueue_active(sk_sleep(sk)))
				wake_up_interruptible(sk_sleep(sk));
		}
		retval = TIPC_OK;
1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343
		break;
	case SS_LISTENING:
	case SS_UNCONNECTED:
		/* Accept only SYN message */
		if (!msg_connected(msg) && !(msg_errcode(msg)))
			retval = TIPC_OK;
		break;
	case SS_DISCONNECTING:
		break;
	default:
		pr_err("Unknown socket state %u\n", sock->state);
	}
	return retval;
}

1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354
/**
 * rcvbuf_limit - get proper overload limit of socket receive queue
 * @sk: socket
 * @buf: message
 *
 * For all connection oriented messages, irrespective of importance,
 * the default overload value (i.e. 67MB) is set as limit.
 *
 * For all connectionless messages, by default new queue limits are
 * as belows:
 *
1355 1356 1357 1358
 * TIPC_LOW_IMPORTANCE       (4 MB)
 * TIPC_MEDIUM_IMPORTANCE    (8 MB)
 * TIPC_HIGH_IMPORTANCE      (16 MB)
 * TIPC_CRITICAL_IMPORTANCE  (32 MB)
1359 1360 1361 1362 1363 1364 1365 1366
 *
 * Returns overload limit according to corresponding message importance
 */
static unsigned int rcvbuf_limit(struct sock *sk, struct sk_buff *buf)
{
	struct tipc_msg *msg = buf_msg(buf);

	if (msg_connected(msg))
1367 1368 1369 1370
		return sysctl_tipc_rmem[2];

	return sk->sk_rcvbuf >> TIPC_CRITICAL_IMPORTANCE <<
		msg_importance(msg);
1371 1372
}

1373
/**
1374 1375
 * filter_rcv - validate incoming message
 * @sk: socket
P
Per Liden 已提交
1376
 * @buf: message
1377
 *
1378 1379 1380 1381
 * Enqueues message on receive queue if acceptable; optionally handles
 * disconnect indication for a connected socket.
 *
 * Called with socket lock already taken; port lock may also be taken.
1382
 *
P
Per Liden 已提交
1383 1384
 * Returns TIPC error status code (TIPC_OK if message is not to be rejected)
 */
1385
static u32 filter_rcv(struct sock *sk, struct sk_buff *buf)
P
Per Liden 已提交
1386
{
1387
	struct socket *sock = sk->sk_socket;
P
Per Liden 已提交
1388
	struct tipc_msg *msg = buf_msg(buf);
1389
	unsigned int limit = rcvbuf_limit(sk, buf);
1390
	u32 res = TIPC_OK;
P
Per Liden 已提交
1391 1392

	/* Reject message if it is wrong sort of message for socket */
1393 1394
	if (msg_type(msg) > TIPC_DIRECT_MSG)
		return TIPC_ERR_NO_PORT;
1395

P
Per Liden 已提交
1396
	if (sock->state == SS_READY) {
1397
		if (msg_connected(msg))
P
Per Liden 已提交
1398 1399
			return TIPC_ERR_NO_PORT;
	} else {
1400 1401 1402
		res = filter_connect(tipc_sk(sk), &buf);
		if (res != TIPC_OK || buf == NULL)
			return res;
P
Per Liden 已提交
1403 1404 1405
	}

	/* Reject message if there isn't room to queue it */
1406 1407
	if (sk_rmem_alloc_get(sk) + buf->truesize >= limit)
		return TIPC_ERR_OVERLOAD;
P
Per Liden 已提交
1408

1409
	/* Enqueue message */
Y
Ying Xue 已提交
1410
	TIPC_SKB_CB(buf)->handle = NULL;
1411
	__skb_queue_tail(&sk->sk_receive_queue, buf);
1412
	skb_set_owner_r(buf, sk);
1413

1414
	sk->sk_data_ready(sk, 0);
1415 1416
	return TIPC_OK;
}
P
Per Liden 已提交
1417

1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447
/**
 * backlog_rcv - handle incoming message from backlog queue
 * @sk: socket
 * @buf: message
 *
 * Caller must hold socket lock, but not port lock.
 *
 * Returns 0
 */
static int backlog_rcv(struct sock *sk, struct sk_buff *buf)
{
	u32 res;

	res = filter_rcv(sk, buf);
	if (res)
		tipc_reject_msg(buf, res);
	return 0;
}

/**
 * dispatch - handle incoming message
 * @tport: TIPC port that received message
 * @buf: message
 *
 * Called with port lock already taken.
 *
 * Returns TIPC error status code (TIPC_OK if message is not to be rejected)
 */
static u32 dispatch(struct tipc_port *tport, struct sk_buff *buf)
{
1448
	struct sock *sk = tport->sk;
1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460
	u32 res;

	/*
	 * Process message if socket is unlocked; otherwise add to backlog queue
	 *
	 * This code is based on sk_receive_skb(), but must be distinct from it
	 * since a TIPC-specific filter/reject mechanism is utilized
	 */
	bh_lock_sock(sk);
	if (!sock_owned_by_user(sk)) {
		res = filter_rcv(sk, buf);
	} else {
1461
		if (sk_add_backlog(sk, buf, rcvbuf_limit(sk, buf)))
Z
Zhu Yi 已提交
1462 1463 1464
			res = TIPC_ERR_OVERLOAD;
		else
			res = TIPC_OK;
1465 1466 1467 1468
	}
	bh_unlock_sock(sk);

	return res;
P
Per Liden 已提交
1469 1470
}

1471
/**
P
Per Liden 已提交
1472 1473
 * wakeupdispatch - wake up port after congestion
 * @tport: port to wakeup
1474
 *
1475
 * Called with port lock already taken.
P
Per Liden 已提交
1476 1477 1478
 */
static void wakeupdispatch(struct tipc_port *tport)
{
1479
	struct sock *sk = tport->sk;
P
Per Liden 已提交
1480

1481
	sk->sk_write_space(sk);
P
Per Liden 已提交
1482 1483
}

Y
Ying Xue 已提交
1484 1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496 1497 1498 1499 1500 1501 1502 1503 1504 1505
static int tipc_wait_for_connect(struct socket *sock, long *timeo_p)
{
	struct sock *sk = sock->sk;
	DEFINE_WAIT(wait);
	int done;

	do {
		int err = sock_error(sk);
		if (err)
			return err;
		if (!*timeo_p)
			return -ETIMEDOUT;
		if (signal_pending(current))
			return sock_intr_errno(*timeo_p);

		prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
		done = sk_wait_event(sk, timeo_p, sock->state != SS_CONNECTING);
		finish_wait(sk_sleep(sk), &wait);
	} while (!done);
	return 0;
}

P
Per Liden 已提交
1506 1507 1508 1509 1510
/**
 * connect - establish a connection to another TIPC port
 * @sock: socket structure
 * @dest: socket address for destination port
 * @destlen: size of socket address data structure
1511
 * @flags: file-related flags associated with socket
P
Per Liden 已提交
1512 1513 1514
 *
 * Returns 0 on success, errno otherwise
 */
1515
static int connect(struct socket *sock, struct sockaddr *dest, int destlen,
P
Per Liden 已提交
1516 1517
		   int flags)
{
1518
	struct sock *sk = sock->sk;
1519 1520
	struct sockaddr_tipc *dst = (struct sockaddr_tipc *)dest;
	struct msghdr m = {NULL,};
Y
Ying Xue 已提交
1521 1522
	long timeout = (flags & O_NONBLOCK) ? 0 : tipc_sk(sk)->conn_timeout;
	socket_state previous;
1523 1524
	int res;

1525 1526
	lock_sock(sk);

1527
	/* For now, TIPC does not allow use of connect() with DGRAM/RDM types */
1528 1529 1530 1531
	if (sock->state == SS_READY) {
		res = -EOPNOTSUPP;
		goto exit;
	}
1532 1533 1534 1535 1536 1537 1538

	/*
	 * Reject connection attempt using multicast address
	 *
	 * Note: send_msg() validates the rest of the address fields,
	 *       so there's no need to do it here
	 */
1539 1540 1541 1542 1543
	if (dst->addrtype == TIPC_ADDR_MCAST) {
		res = -EINVAL;
		goto exit;
	}

Y
Ying Xue 已提交
1544
	previous = sock->state;
1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566
	switch (sock->state) {
	case SS_UNCONNECTED:
		/* Send a 'SYN-' to destination */
		m.msg_name = dest;
		m.msg_namelen = destlen;

		/* If connect is in non-blocking case, set MSG_DONTWAIT to
		 * indicate send_msg() is never blocked.
		 */
		if (!timeout)
			m.msg_flags = MSG_DONTWAIT;

		res = send_msg(NULL, sock, &m, 0);
		if ((res < 0) && (res != -EWOULDBLOCK))
			goto exit;

		/* Just entered SS_CONNECTING state; the only
		 * difference is that return value in non-blocking
		 * case is EINPROGRESS, rather than EALREADY.
		 */
		res = -EINPROGRESS;
	case SS_CONNECTING:
Y
Ying Xue 已提交
1567 1568 1569 1570 1571 1572 1573
		if (previous == SS_CONNECTING)
			res = -EALREADY;
		if (!timeout)
			goto exit;
		timeout = msecs_to_jiffies(timeout);
		/* Wait until an 'ACK' or 'RST' arrives, or a timeout occurs */
		res = tipc_wait_for_connect(sock, &timeout);
1574 1575 1576 1577 1578 1579
		break;
	case SS_CONNECTED:
		res = -EISCONN;
		break;
	default:
		res = -EINVAL;
Y
Ying Xue 已提交
1580
		break;
1581
	}
1582 1583
exit:
	release_sock(sk);
1584
	return res;
P
Per Liden 已提交
1585 1586
}

1587
/**
P
Per Liden 已提交
1588 1589 1590
 * listen - allow socket to listen for incoming connections
 * @sock: socket structure
 * @len: (unused)
1591
 *
P
Per Liden 已提交
1592 1593 1594 1595
 * Returns 0 on success, errno otherwise
 */
static int listen(struct socket *sock, int len)
{
1596 1597 1598 1599
	struct sock *sk = sock->sk;
	int res;

	lock_sock(sk);
P
Per Liden 已提交
1600

1601
	if (sock->state != SS_UNCONNECTED)
1602 1603 1604 1605 1606 1607 1608 1609
		res = -EINVAL;
	else {
		sock->state = SS_LISTENING;
		res = 0;
	}

	release_sock(sk);
	return res;
P
Per Liden 已提交
1610 1611
}

Y
Ying Xue 已提交
1612 1613 1614 1615 1616 1617 1618 1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631 1632 1633 1634 1635 1636 1637 1638 1639 1640 1641 1642 1643 1644 1645 1646 1647
static int tipc_wait_for_accept(struct socket *sock, long timeo)
{
	struct sock *sk = sock->sk;
	DEFINE_WAIT(wait);
	int err;

	/* True wake-one mechanism for incoming connections: only
	 * one process gets woken up, not the 'whole herd'.
	 * Since we do not 'race & poll' for established sockets
	 * anymore, the common case will execute the loop only once.
	*/
	for (;;) {
		prepare_to_wait_exclusive(sk_sleep(sk), &wait,
					  TASK_INTERRUPTIBLE);
		if (skb_queue_empty(&sk->sk_receive_queue)) {
			release_sock(sk);
			timeo = schedule_timeout(timeo);
			lock_sock(sk);
		}
		err = 0;
		if (!skb_queue_empty(&sk->sk_receive_queue))
			break;
		err = -EINVAL;
		if (sock->state != SS_LISTENING)
			break;
		err = sock_intr_errno(timeo);
		if (signal_pending(current))
			break;
		err = -EAGAIN;
		if (!timeo)
			break;
	}
	finish_wait(sk_sleep(sk), &wait);
	return err;
}

1648
/**
P
Per Liden 已提交
1649 1650 1651 1652
 * accept - wait for connection request
 * @sock: listening socket
 * @newsock: new socket that is to be connected
 * @flags: file-related flags associated with socket
1653
 *
P
Per Liden 已提交
1654 1655
 * Returns 0 on success, errno otherwise
 */
1656
static int accept(struct socket *sock, struct socket *new_sock, int flags)
P
Per Liden 已提交
1657
{
1658
	struct sock *new_sk, *sk = sock->sk;
P
Per Liden 已提交
1659
	struct sk_buff *buf;
1660 1661 1662 1663
	struct tipc_sock *new_tsock;
	struct tipc_port *new_tport;
	struct tipc_msg *msg;
	u32 new_ref;
Y
Ying Xue 已提交
1664
	long timeo;
1665
	int res;
P
Per Liden 已提交
1666

1667
	lock_sock(sk);
P
Per Liden 已提交
1668

1669 1670
	if (sock->state != SS_LISTENING) {
		res = -EINVAL;
P
Per Liden 已提交
1671 1672 1673
		goto exit;
	}

Y
Ying Xue 已提交
1674 1675 1676 1677
	timeo = sock_rcvtimeo(sk, flags & O_NONBLOCK);
	res = tipc_wait_for_accept(sock, timeo);
	if (res)
		goto exit;
1678 1679 1680

	buf = skb_peek(&sk->sk_receive_queue);

1681
	res = tipc_sk_create(sock_net(sock->sk), new_sock, 0, 1);
1682 1683
	if (res)
		goto exit;
P
Per Liden 已提交
1684

1685 1686 1687 1688 1689
	new_sk = new_sock->sk;
	new_tsock = tipc_sk(new_sk);
	new_tport = new_tsock->p;
	new_ref = new_tport->ref;
	msg = buf_msg(buf);
P
Per Liden 已提交
1690

1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701 1702 1703 1704 1705 1706 1707 1708 1709
	/* we lock on new_sk; but lockdep sees the lock on sk */
	lock_sock_nested(new_sk, SINGLE_DEPTH_NESTING);

	/*
	 * Reject any stray messages received by new socket
	 * before the socket lock was taken (very, very unlikely)
	 */
	reject_rx_queue(new_sk);

	/* Connect new socket to it's peer */
	new_tsock->peer_name.ref = msg_origport(msg);
	new_tsock->peer_name.node = msg_orignode(msg);
	tipc_connect(new_ref, &new_tsock->peer_name);
	new_sock->state = SS_CONNECTED;

	tipc_set_portimportance(new_ref, msg_importance(msg));
	if (msg_named(msg)) {
		new_tport->conn_type = msg_nametype(msg);
		new_tport->conn_instance = msg_nameinst(msg);
P
Per Liden 已提交
1710
	}
1711 1712 1713 1714 1715 1716 1717 1718 1719 1720 1721 1722 1723

	/*
	 * Respond to 'SYN-' by discarding it & returning 'ACK'-.
	 * Respond to 'SYN+' by queuing it on new socket.
	 */
	if (!msg_data_sz(msg)) {
		struct msghdr m = {NULL,};

		advance_rx_queue(sk);
		send_packet(NULL, new_sock, &m, 0);
	} else {
		__skb_dequeue(&sk->sk_receive_queue);
		__skb_queue_head(&new_sk->sk_receive_queue, buf);
1724
		skb_set_owner_r(buf, new_sk);
1725 1726 1727
	}
	release_sock(new_sk);

P
Per Liden 已提交
1728
exit:
1729
	release_sock(sk);
P
Per Liden 已提交
1730 1731 1732 1733 1734 1735
	return res;
}

/**
 * shutdown - shutdown socket connection
 * @sock: socket structure
1736
 * @how: direction to close (must be SHUT_RDWR)
P
Per Liden 已提交
1737 1738
 *
 * Terminates connection (if necessary), then purges socket's receive queue.
1739
 *
P
Per Liden 已提交
1740 1741 1742 1743
 * Returns 0 on success, errno otherwise
 */
static int shutdown(struct socket *sock, int how)
{
1744 1745
	struct sock *sk = sock->sk;
	struct tipc_port *tport = tipc_sk_port(sk);
P
Per Liden 已提交
1746 1747 1748
	struct sk_buff *buf;
	int res;

1749 1750
	if (how != SHUT_RDWR)
		return -EINVAL;
P
Per Liden 已提交
1751

1752
	lock_sock(sk);
P
Per Liden 已提交
1753 1754

	switch (sock->state) {
1755
	case SS_CONNECTING:
P
Per Liden 已提交
1756 1757 1758
	case SS_CONNECTED:

restart:
1759
		/* Disconnect and send a 'FIN+' or 'FIN-' message to peer */
1760 1761
		buf = __skb_dequeue(&sk->sk_receive_queue);
		if (buf) {
Y
Ying Xue 已提交
1762
			if (TIPC_SKB_CB(buf)->handle != NULL) {
1763
				kfree_skb(buf);
P
Per Liden 已提交
1764 1765
				goto restart;
			}
1766
			tipc_disconnect(tport->ref);
P
Per Liden 已提交
1767
			tipc_reject_msg(buf, TIPC_CONN_SHUTDOWN);
1768 1769
		} else {
			tipc_shutdown(tport->ref);
P
Per Liden 已提交
1770
		}
1771 1772

		sock->state = SS_DISCONNECTING;
P
Per Liden 已提交
1773 1774 1775 1776 1777

		/* fall through */

	case SS_DISCONNECTING:

1778
		/* Discard any unreceived messages */
1779
		__skb_queue_purge(&sk->sk_receive_queue);
1780 1781 1782

		/* Wake up anyone sleeping in poll */
		sk->sk_state_change(sk);
P
Per Liden 已提交
1783 1784 1785 1786 1787 1788 1789
		res = 0;
		break;

	default:
		res = -ENOTCONN;
	}

1790
	release_sock(sk);
P
Per Liden 已提交
1791 1792 1793 1794 1795 1796 1797 1798 1799 1800
	return res;
}

/**
 * setsockopt - set socket option
 * @sock: socket structure
 * @lvl: option level
 * @opt: option identifier
 * @ov: pointer to new option value
 * @ol: length of option value
1801 1802
 *
 * For stream sockets only, accepts and ignores all IPPROTO_TCP options
P
Per Liden 已提交
1803
 * (to ease compatibility).
1804
 *
P
Per Liden 已提交
1805 1806
 * Returns 0 on success, errno otherwise
 */
1807 1808
static int setsockopt(struct socket *sock, int lvl, int opt, char __user *ov,
		      unsigned int ol)
P
Per Liden 已提交
1809
{
1810 1811
	struct sock *sk = sock->sk;
	struct tipc_port *tport = tipc_sk_port(sk);
P
Per Liden 已提交
1812 1813 1814
	u32 value;
	int res;

1815 1816
	if ((lvl == IPPROTO_TCP) && (sock->type == SOCK_STREAM))
		return 0;
P
Per Liden 已提交
1817 1818 1819 1820
	if (lvl != SOL_TIPC)
		return -ENOPROTOOPT;
	if (ol < sizeof(value))
		return -EINVAL;
1821 1822
	res = get_user(value, (u32 __user *)ov);
	if (res)
P
Per Liden 已提交
1823 1824
		return res;

1825
	lock_sock(sk);
1826

P
Per Liden 已提交
1827 1828
	switch (opt) {
	case TIPC_IMPORTANCE:
1829
		res = tipc_set_portimportance(tport->ref, value);
P
Per Liden 已提交
1830 1831 1832
		break;
	case TIPC_SRC_DROPPABLE:
		if (sock->type != SOCK_STREAM)
1833
			res = tipc_set_portunreliable(tport->ref, value);
1834
		else
P
Per Liden 已提交
1835 1836 1837
			res = -ENOPROTOOPT;
		break;
	case TIPC_DEST_DROPPABLE:
1838
		res = tipc_set_portunreturnable(tport->ref, value);
P
Per Liden 已提交
1839 1840
		break;
	case TIPC_CONN_TIMEOUT:
1841
		tipc_sk(sk)->conn_timeout = value;
1842
		/* no need to set "res", since already 0 at this point */
P
Per Liden 已提交
1843 1844 1845 1846 1847
		break;
	default:
		res = -EINVAL;
	}

1848 1849
	release_sock(sk);

P
Per Liden 已提交
1850 1851 1852 1853 1854 1855 1856 1857 1858 1859
	return res;
}

/**
 * getsockopt - get socket option
 * @sock: socket structure
 * @lvl: option level
 * @opt: option identifier
 * @ov: receptacle for option value
 * @ol: receptacle for length of option value
1860 1861
 *
 * For stream sockets only, returns 0 length result for all IPPROTO_TCP options
P
Per Liden 已提交
1862
 * (to ease compatibility).
1863
 *
P
Per Liden 已提交
1864 1865
 * Returns 0 on success, errno otherwise
 */
1866 1867
static int getsockopt(struct socket *sock, int lvl, int opt, char __user *ov,
		      int __user *ol)
P
Per Liden 已提交
1868
{
1869 1870
	struct sock *sk = sock->sk;
	struct tipc_port *tport = tipc_sk_port(sk);
1871
	int len;
P
Per Liden 已提交
1872
	u32 value;
1873
	int res;
P
Per Liden 已提交
1874

1875 1876
	if ((lvl == IPPROTO_TCP) && (sock->type == SOCK_STREAM))
		return put_user(0, ol);
P
Per Liden 已提交
1877 1878
	if (lvl != SOL_TIPC)
		return -ENOPROTOOPT;
1879 1880
	res = get_user(len, ol);
	if (res)
1881
		return res;
P
Per Liden 已提交
1882

1883
	lock_sock(sk);
P
Per Liden 已提交
1884 1885 1886

	switch (opt) {
	case TIPC_IMPORTANCE:
1887
		res = tipc_portimportance(tport->ref, &value);
P
Per Liden 已提交
1888 1889
		break;
	case TIPC_SRC_DROPPABLE:
1890
		res = tipc_portunreliable(tport->ref, &value);
P
Per Liden 已提交
1891 1892
		break;
	case TIPC_DEST_DROPPABLE:
1893
		res = tipc_portunreturnable(tport->ref, &value);
P
Per Liden 已提交
1894 1895
		break;
	case TIPC_CONN_TIMEOUT:
1896
		value = tipc_sk(sk)->conn_timeout;
1897
		/* no need to set "res", since already 0 at this point */
P
Per Liden 已提交
1898
		break;
1899
	case TIPC_NODE_RECVQ_DEPTH:
1900
		value = 0; /* was tipc_queue_size, now obsolete */
1901
		break;
1902
	case TIPC_SOCK_RECVQ_DEPTH:
1903 1904
		value = skb_queue_len(&sk->sk_receive_queue);
		break;
P
Per Liden 已提交
1905 1906 1907 1908
	default:
		res = -EINVAL;
	}

1909 1910
	release_sock(sk);

1911 1912
	if (res)
		return res;	/* "get" failed */
P
Per Liden 已提交
1913

1914 1915 1916 1917 1918 1919 1920
	if (len < sizeof(value))
		return -EINVAL;

	if (copy_to_user(ov, &value, sizeof(value)))
		return -EFAULT;

	return put_user(sizeof(value), ol);
P
Per Liden 已提交
1921 1922
}

1923 1924
/* Protocol switches for the various types of TIPC sockets */

1925
static const struct proto_ops msg_ops = {
1926
	.owner		= THIS_MODULE,
P
Per Liden 已提交
1927 1928 1929 1930
	.family		= AF_TIPC,
	.release	= release,
	.bind		= bind,
	.connect	= connect,
1931
	.socketpair	= sock_no_socketpair,
1932
	.accept		= sock_no_accept,
P
Per Liden 已提交
1933 1934
	.getname	= get_name,
	.poll		= poll,
1935
	.ioctl		= sock_no_ioctl,
1936
	.listen		= sock_no_listen,
P
Per Liden 已提交
1937 1938 1939 1940 1941
	.shutdown	= shutdown,
	.setsockopt	= setsockopt,
	.getsockopt	= getsockopt,
	.sendmsg	= send_msg,
	.recvmsg	= recv_msg,
1942 1943
	.mmap		= sock_no_mmap,
	.sendpage	= sock_no_sendpage
P
Per Liden 已提交
1944 1945
};

1946
static const struct proto_ops packet_ops = {
1947
	.owner		= THIS_MODULE,
P
Per Liden 已提交
1948 1949 1950 1951
	.family		= AF_TIPC,
	.release	= release,
	.bind		= bind,
	.connect	= connect,
1952
	.socketpair	= sock_no_socketpair,
P
Per Liden 已提交
1953 1954 1955
	.accept		= accept,
	.getname	= get_name,
	.poll		= poll,
1956
	.ioctl		= sock_no_ioctl,
P
Per Liden 已提交
1957 1958 1959 1960 1961 1962
	.listen		= listen,
	.shutdown	= shutdown,
	.setsockopt	= setsockopt,
	.getsockopt	= getsockopt,
	.sendmsg	= send_packet,
	.recvmsg	= recv_msg,
1963 1964
	.mmap		= sock_no_mmap,
	.sendpage	= sock_no_sendpage
P
Per Liden 已提交
1965 1966
};

1967
static const struct proto_ops stream_ops = {
1968
	.owner		= THIS_MODULE,
P
Per Liden 已提交
1969 1970 1971 1972
	.family		= AF_TIPC,
	.release	= release,
	.bind		= bind,
	.connect	= connect,
1973
	.socketpair	= sock_no_socketpair,
P
Per Liden 已提交
1974 1975 1976
	.accept		= accept,
	.getname	= get_name,
	.poll		= poll,
1977
	.ioctl		= sock_no_ioctl,
P
Per Liden 已提交
1978 1979 1980 1981 1982 1983
	.listen		= listen,
	.shutdown	= shutdown,
	.setsockopt	= setsockopt,
	.getsockopt	= getsockopt,
	.sendmsg	= send_stream,
	.recvmsg	= recv_stream,
1984 1985
	.mmap		= sock_no_mmap,
	.sendpage	= sock_no_sendpage
P
Per Liden 已提交
1986 1987
};

1988
static const struct net_proto_family tipc_family_ops = {
1989
	.owner		= THIS_MODULE,
P
Per Liden 已提交
1990
	.family		= AF_TIPC,
1991
	.create		= tipc_sk_create
P
Per Liden 已提交
1992 1993 1994 1995 1996
};

static struct proto tipc_proto = {
	.name		= "TIPC",
	.owner		= THIS_MODULE,
1997 1998
	.obj_size	= sizeof(struct tipc_sock),
	.sysctl_rmem	= sysctl_tipc_rmem
P
Per Liden 已提交
1999 2000
};

2001 2002 2003 2004 2005 2006
static struct proto tipc_proto_kern = {
	.name		= "TIPC",
	.obj_size	= sizeof(struct tipc_sock),
	.sysctl_rmem	= sysctl_tipc_rmem
};

P
Per Liden 已提交
2007
/**
2008
 * tipc_socket_init - initialize TIPC socket interface
2009
 *
P
Per Liden 已提交
2010 2011
 * Returns 0 on success, errno otherwise
 */
2012
int tipc_socket_init(void)
P
Per Liden 已提交
2013 2014 2015
{
	int res;

2016
	res = proto_register(&tipc_proto, 1);
P
Per Liden 已提交
2017
	if (res) {
2018
		pr_err("Failed to register TIPC protocol type\n");
P
Per Liden 已提交
2019 2020 2021 2022 2023
		goto out;
	}

	res = sock_register(&tipc_family_ops);
	if (res) {
2024
		pr_err("Failed to register TIPC socket type\n");
P
Per Liden 已提交
2025 2026 2027 2028 2029 2030 2031 2032
		proto_unregister(&tipc_proto);
		goto out;
	}
 out:
	return res;
}

/**
2033
 * tipc_socket_stop - stop TIPC socket interface
P
Per Liden 已提交
2034
 */
2035
void tipc_socket_stop(void)
P
Per Liden 已提交
2036 2037 2038 2039
{
	sock_unregister(tipc_family_ops.family);
	proto_unregister(&tipc_proto);
}