socket.c 86.0 KB
Newer Older
P
Per Liden 已提交
1
/*
2
 * net/tipc/socket.c: TIPC socket API
3
 *
J
Jon Maloy 已提交
4
 * Copyright (c) 2001-2007, 2012-2017, 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
 * POSSIBILITY OF SUCH DAMAGE.
 */

37
#include <linux/rhashtable.h>
38 39
#include <linux/sched/signal.h>

P
Per Liden 已提交
40
#include "core.h"
41
#include "name_table.h"
E
Erik Hugne 已提交
42
#include "node.h"
43
#include "link.h"
44
#include "name_distr.h"
45
#include "socket.h"
46
#include "bcast.h"
47
#include "netlink.h"
J
Jon Maloy 已提交
48
#include "group.h"
49

50
#define CONN_TIMEOUT_DEFAULT	8000	/* default connect timeout = 8s */
51
#define CONN_PROBING_INTV	msecs_to_jiffies(3600000)  /* [ms] => 1 h */
52 53 54
#define TIPC_FWD_MSG		1
#define TIPC_MAX_PORT		0xffffffff
#define TIPC_MIN_PORT		1
55
#define TIPC_ACK_RATE		4       /* ACK at 1/4 of of rcv window size */
56

57 58
enum {
	TIPC_LISTEN = TCP_LISTEN,
59
	TIPC_ESTABLISHED = TCP_ESTABLISHED,
60
	TIPC_OPEN = TCP_CLOSE,
61
	TIPC_DISCONNECTING = TCP_CLOSE_WAIT,
62
	TIPC_CONNECTING = TCP_SYN_SENT,
63 64
};

65 66 67 68 69
struct sockaddr_pair {
	struct sockaddr_tipc sock;
	struct sockaddr_tipc member;
};

70 71 72 73 74 75 76
/**
 * struct tipc_sock - TIPC socket structure
 * @sk: socket - interacts with 'port' and with user via the socket API
 * @conn_type: TIPC type used when connection was established
 * @conn_instance: TIPC instance used when connection was established
 * @published: non-zero if port has one or more associated names
 * @max_pkt: maximum packet size "hint" used when building messages sent by port
77
 * @portid: unique port identity in TIPC socket hash table
78
 * @phdr: preformatted message header used when sending messages
79
 * #cong_links: list of congested links
80
 * @publications: list of publications for port
81
 * @blocking_link: address of the congested link we are currently sleeping on
82 83 84 85
 * @pub_count: total # of publications port has made during its lifetime
 * @probing_state:
 * @conn_timeout: the time we can wait for an unresponded setup request
 * @dupl_rcvcnt: number of bytes counted twice, in both backlog and rcv queue
86
 * @cong_link_cnt: number of congested links
J
Jon Maloy 已提交
87
 * @snt_unacked: # messages sent by socket, and not yet acked by peer
88
 * @rcv_unacked: # messages read by user, but not yet acked back to peer
89
 * @peer: 'connected' peer for dgram/rdm
90
 * @node: hash table node
91
 * @mc_method: cookie for use between socket and broadcast layer
92
 * @rcu: rcu struct for tipc_sock
93 94 95 96 97 98 99
 */
struct tipc_sock {
	struct sock sk;
	u32 conn_type;
	u32 conn_instance;
	int published;
	u32 max_pkt;
100
	u32 portid;
101
	struct tipc_msg phdr;
102
	struct list_head cong_links;
103 104 105 106
	struct list_head publications;
	u32 pub_count;
	uint conn_timeout;
	atomic_t dupl_rcvcnt;
107
	bool probe_unacked;
108
	u16 cong_link_cnt;
109 110
	u16 snt_unacked;
	u16 snd_win;
111
	u16 peer_caps;
112 113
	u16 rcv_unacked;
	u16 rcv_win;
114
	struct sockaddr_tipc peer;
115
	struct rhash_head node;
116
	struct tipc_mc_method mc_method;
117
	struct rcu_head rcu;
J
Jon Maloy 已提交
118
	struct tipc_group *group;
119
};
P
Per Liden 已提交
120

J
Jon Maloy 已提交
121
static int tipc_sk_backlog_rcv(struct sock *sk, struct sk_buff *skb);
122
static void tipc_data_ready(struct sock *sk);
123
static void tipc_write_space(struct sock *sk);
124
static void tipc_sock_destruct(struct sock *sk);
125
static int tipc_release(struct socket *sock);
126 127
static int tipc_accept(struct socket *sock, struct socket *new_sock, int flags,
		       bool kern);
128
static void tipc_sk_timeout(struct timer_list *t);
129
static int tipc_sk_publish(struct tipc_sock *tsk, uint scope,
J
Jon Paul Maloy 已提交
130
			   struct tipc_name_seq const *seq);
131
static int tipc_sk_withdraw(struct tipc_sock *tsk, uint scope,
J
Jon Paul Maloy 已提交
132
			    struct tipc_name_seq const *seq);
J
Jon Maloy 已提交
133
static int tipc_sk_leave(struct tipc_sock *tsk);
134
static struct tipc_sock *tipc_sk_lookup(struct net *net, u32 portid);
135 136
static int tipc_sk_insert(struct tipc_sock *tsk);
static void tipc_sk_remove(struct tipc_sock *tsk);
137
static int __tipc_sendstream(struct socket *sock, struct msghdr *m, size_t dsz);
138
static int __tipc_sendmsg(struct socket *sock, struct msghdr *m, size_t dsz);
P
Per Liden 已提交
139

140 141 142
static const struct proto_ops packet_ops;
static const struct proto_ops stream_ops;
static const struct proto_ops msg_ops;
P
Per Liden 已提交
143
static struct proto tipc_proto;
144 145
static const struct rhashtable_params tsk_rht_params;

146 147 148 149 150
static u32 tsk_own_node(struct tipc_sock *tsk)
{
	return msg_prevnode(&tsk->phdr);
}

151
static u32 tsk_peer_node(struct tipc_sock *tsk)
152
{
153
	return msg_destnode(&tsk->phdr);
154 155
}

156
static u32 tsk_peer_port(struct tipc_sock *tsk)
157
{
158
	return msg_destport(&tsk->phdr);
159 160
}

161
static  bool tsk_unreliable(struct tipc_sock *tsk)
162
{
163
	return msg_src_droppable(&tsk->phdr) != 0;
164 165
}

166
static void tsk_set_unreliable(struct tipc_sock *tsk, bool unreliable)
167
{
168
	msg_set_src_droppable(&tsk->phdr, unreliable ? 1 : 0);
169 170
}

171
static bool tsk_unreturnable(struct tipc_sock *tsk)
172
{
173
	return msg_dest_droppable(&tsk->phdr) != 0;
174 175
}

176
static void tsk_set_unreturnable(struct tipc_sock *tsk, bool unreturnable)
177
{
178
	msg_set_dest_droppable(&tsk->phdr, unreturnable ? 1 : 0);
179 180
}

181
static int tsk_importance(struct tipc_sock *tsk)
182
{
183
	return msg_importance(&tsk->phdr);
184 185
}

186
static int tsk_set_importance(struct tipc_sock *tsk, int imp)
187 188 189
{
	if (imp > TIPC_CRITICAL_IMPORTANCE)
		return -EINVAL;
190
	msg_set_importance(&tsk->phdr, (u32)imp);
191 192
	return 0;
}
193

194 195 196 197 198
static struct tipc_sock *tipc_sk(const struct sock *sk)
{
	return container_of(sk, struct tipc_sock, sk);
}

199
static bool tsk_conn_cong(struct tipc_sock *tsk)
200
{
201
	return tsk->snt_unacked > tsk->snd_win;
202 203
}

204 205 206 207 208
static u16 tsk_blocks(int len)
{
	return ((len / FLOWCTL_BLK_SZ) + 1);
}

209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226
/* tsk_blocks(): translate a buffer size in bytes to number of
 * advertisable blocks, taking into account the ratio truesize(len)/len
 * We can trust that this ratio is always < 4 for len >= FLOWCTL_BLK_SZ
 */
static u16 tsk_adv_blocks(int len)
{
	return len / FLOWCTL_BLK_SZ / 4;
}

/* tsk_inc(): increment counter for sent or received data
 * - If block based flow control is not supported by peer we
 *   fall back to message based ditto, incrementing the counter
 */
static u16 tsk_inc(struct tipc_sock *tsk, int msglen)
{
	if (likely(tsk->peer_caps & TIPC_BLOCK_FLOWCTL))
		return ((msglen / FLOWCTL_BLK_SZ) + 1);
	return 1;
227 228
}

229
/**
230
 * tsk_advance_rx_queue - discard first buffer in socket receive queue
231 232
 *
 * Caller must hold socket lock
P
Per Liden 已提交
233
 */
234
static void tsk_advance_rx_queue(struct sock *sk)
P
Per Liden 已提交
235
{
236
	kfree_skb(__skb_dequeue(&sk->sk_receive_queue));
P
Per Liden 已提交
237 238
}

239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254
/* tipc_sk_respond() : send response message back to sender
 */
static void tipc_sk_respond(struct sock *sk, struct sk_buff *skb, int err)
{
	u32 selector;
	u32 dnode;
	u32 onode = tipc_own_addr(sock_net(sk));

	if (!tipc_msg_reverse(onode, &skb, err))
		return;

	dnode = msg_destnode(buf_msg(skb));
	selector = msg_origport(buf_msg(skb));
	tipc_node_xmit_skb(sock_net(sk), skb, dnode, selector);
}

P
Per Liden 已提交
255
/**
256
 * tsk_rej_rx_queue - reject all buffers in socket receive queue
257 258
 *
 * Caller must hold socket lock
P
Per Liden 已提交
259
 */
260
static void tsk_rej_rx_queue(struct sock *sk)
P
Per Liden 已提交
261
{
262
	struct sk_buff *skb;
263

264 265
	while ((skb = __skb_dequeue(&sk->sk_receive_queue)))
		tipc_sk_respond(sk, skb, TIPC_ERR_NO_PORT);
P
Per Liden 已提交
266 267
}

268 269
static bool tipc_sk_connected(struct sock *sk)
{
270
	return sk->sk_state == TIPC_ESTABLISHED;
271 272
}

273 274 275 276 277 278 279 280 281 282
/* tipc_sk_type_connectionless - check if the socket is datagram socket
 * @sk: socket
 *
 * Returns true if connection less, false otherwise
 */
static bool tipc_sk_type_connectionless(struct sock *sk)
{
	return sk->sk_type == SOCK_RDM || sk->sk_type == SOCK_DGRAM;
}

283
/* tsk_peer_msg - verify if message was sent by connected port's peer
J
Jon Paul Maloy 已提交
284 285 286 287
 *
 * Handles cases where the node's network address has changed from
 * the default of <0.0.0> to its configured setting.
 */
288
static bool tsk_peer_msg(struct tipc_sock *tsk, struct tipc_msg *msg)
J
Jon Paul Maloy 已提交
289
{
290 291
	struct sock *sk = &tsk->sk;
	struct tipc_net *tn = net_generic(sock_net(sk), tipc_net_id);
292
	u32 peer_port = tsk_peer_port(tsk);
J
Jon Paul Maloy 已提交
293 294 295
	u32 orig_node;
	u32 peer_node;

296
	if (unlikely(!tipc_sk_connected(sk)))
J
Jon Paul Maloy 已提交
297 298 299 300 301 302
		return false;

	if (unlikely(msg_origport(msg) != peer_port))
		return false;

	orig_node = msg_orignode(msg);
303
	peer_node = tsk_peer_node(tsk);
J
Jon Paul Maloy 已提交
304 305 306 307

	if (likely(orig_node == peer_node))
		return true;

308
	if (!orig_node && (peer_node == tn->own_addr))
J
Jon Paul Maloy 已提交
309 310
		return true;

311
	if (!peer_node && (orig_node == tn->own_addr))
J
Jon Paul Maloy 已提交
312 313 314 315 316
		return true;

	return false;
}

317 318 319 320 321 322 323 324 325
/* tipc_set_sk_state - set the sk_state of the socket
 * @sk: socket
 *
 * Caller must hold socket lock
 *
 * Returns 0 on success, errno otherwise
 */
static int tipc_set_sk_state(struct sock *sk, int state)
{
326
	int oldsk_state = sk->sk_state;
327 328 329
	int res = -EINVAL;

	switch (state) {
330 331 332
	case TIPC_OPEN:
		res = 0;
		break;
333
	case TIPC_LISTEN:
334
	case TIPC_CONNECTING:
335
		if (oldsk_state == TIPC_OPEN)
336 337
			res = 0;
		break;
338
	case TIPC_ESTABLISHED:
339
		if (oldsk_state == TIPC_CONNECTING ||
340
		    oldsk_state == TIPC_OPEN)
341 342
			res = 0;
		break;
343
	case TIPC_DISCONNECTING:
344
		if (oldsk_state == TIPC_CONNECTING ||
345 346 347
		    oldsk_state == TIPC_ESTABLISHED)
			res = 0;
		break;
348 349 350 351 352 353 354 355
	}

	if (!res)
		sk->sk_state = state;

	return res;
}

356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377
static int tipc_sk_sock_err(struct socket *sock, long *timeout)
{
	struct sock *sk = sock->sk;
	int err = sock_error(sk);
	int typ = sock->type;

	if (err)
		return err;
	if (typ == SOCK_STREAM || typ == SOCK_SEQPACKET) {
		if (sk->sk_state == TIPC_DISCONNECTING)
			return -EPIPE;
		else if (!tipc_sk_connected(sk))
			return -ENOTCONN;
	}
	if (!*timeout)
		return -EAGAIN;
	if (signal_pending(current))
		return sock_intr_errno(*timeout);

	return 0;
}

378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396
#define tipc_wait_for_cond(sock_, timeo_, condition_)			       \
({                                                                             \
	struct sock *sk_;						       \
	int rc_;							       \
									       \
	while ((rc_ = !(condition_))) {					       \
		DEFINE_WAIT_FUNC(wait_, woken_wake_function);	               \
		sk_ = (sock_)->sk;					       \
		rc_ = tipc_sk_sock_err((sock_), timeo_);		       \
		if (rc_)						       \
			break;						       \
		prepare_to_wait(sk_sleep(sk_), &wait_, TASK_INTERRUPTIBLE);    \
		release_sock(sk_);					       \
		*(timeo_) = wait_woken(&wait_, TASK_INTERRUPTIBLE, *(timeo_)); \
		sched_annotate_sleep();				               \
		lock_sock(sk_);						       \
		remove_wait_queue(sk_sleep(sk_), &wait_);		       \
	}								       \
	rc_;								       \
397 398
})

P
Per Liden 已提交
399
/**
400
 * tipc_sk_create - create a TIPC socket
401
 * @net: network namespace (must be default network)
P
Per Liden 已提交
402 403
 * @sock: pre-allocated socket structure
 * @protocol: protocol indicator (must be 0)
404
 * @kern: caused by kernel or by userspace?
405
 *
406 407
 * This routine creates additional data structures used by the TIPC socket,
 * initializes them, and links them together.
P
Per Liden 已提交
408 409 410
 *
 * Returns 0 on success, errno otherwise
 */
411 412
static int tipc_sk_create(struct net *net, struct socket *sock,
			  int protocol, int kern)
P
Per Liden 已提交
413
{
414
	struct tipc_net *tn;
415
	const struct proto_ops *ops;
P
Per Liden 已提交
416
	struct sock *sk;
417
	struct tipc_sock *tsk;
418
	struct tipc_msg *msg;
419 420

	/* Validate arguments */
P
Per Liden 已提交
421 422 423 424 425
	if (unlikely(protocol != 0))
		return -EPROTONOSUPPORT;

	switch (sock->type) {
	case SOCK_STREAM:
426
		ops = &stream_ops;
P
Per Liden 已提交
427 428
		break;
	case SOCK_SEQPACKET:
429
		ops = &packet_ops;
P
Per Liden 已提交
430 431 432
		break;
	case SOCK_DGRAM:
	case SOCK_RDM:
433
		ops = &msg_ops;
P
Per Liden 已提交
434
		break;
435 436
	default:
		return -EPROTOTYPE;
P
Per Liden 已提交
437 438
	}

439
	/* Allocate socket's protocol area */
440
	sk = sk_alloc(net, AF_TIPC, GFP_KERNEL, &tipc_proto, kern);
441
	if (sk == NULL)
P
Per Liden 已提交
442 443
		return -ENOMEM;

444
	tsk = tipc_sk(sk);
445 446
	tsk->max_pkt = MAX_PKT_DEFAULT;
	INIT_LIST_HEAD(&tsk->publications);
447
	INIT_LIST_HEAD(&tsk->cong_links);
448
	msg = &tsk->phdr;
449
	tn = net_generic(sock_net(sk), tipc_net_id);
P
Per Liden 已提交
450

451 452 453
	/* Finish initializing socket data structures */
	sock->ops = ops;
	sock_init_data(sock, sk);
454
	tipc_set_sk_state(sk, TIPC_OPEN);
455
	if (tipc_sk_insert(tsk)) {
M
Masanari Iida 已提交
456
		pr_warn("Socket create failed; port number exhausted\n");
457 458
		return -EINVAL;
	}
459 460 461 462 463 464 465

	/* Ensure tsk is visible before we read own_addr. */
	smp_mb();

	tipc_msg_init(tn->own_addr, msg, TIPC_LOW_IMPORTANCE, TIPC_NAMED_MSG,
		      NAMED_H_SIZE, 0);

466
	msg_set_origport(msg, tsk->portid);
467
	timer_setup(&sk->sk_timer, tipc_sk_timeout, 0);
468
	sk->sk_shutdown = 0;
J
Jon Maloy 已提交
469
	sk->sk_backlog_rcv = tipc_sk_backlog_rcv;
470
	sk->sk_rcvbuf = sysctl_tipc_rmem[1];
471 472
	sk->sk_data_ready = tipc_data_ready;
	sk->sk_write_space = tipc_write_space;
473
	sk->sk_destruct = tipc_sock_destruct;
474 475
	tsk->conn_timeout = CONN_TIMEOUT_DEFAULT;
	atomic_set(&tsk->dupl_rcvcnt, 0);
476

477 478 479 480
	/* Start out with safe limits until we receive an advertised window */
	tsk->snd_win = tsk_adv_blocks(RCVBUF_MIN);
	tsk->rcv_win = tsk->snd_win;

481
	if (tipc_sk_type_connectionless(sk)) {
482
		tsk_set_unreturnable(tsk, true);
483
		if (sock->type == SOCK_DGRAM)
484
			tsk_set_unreliable(tsk, true);
485
	}
486

P
Per Liden 已提交
487 488 489
	return 0;
}

490 491 492 493 494 495 496
static void tipc_sk_callback(struct rcu_head *head)
{
	struct tipc_sock *tsk = container_of(head, struct tipc_sock, rcu);

	sock_put(&tsk->sk);
}

497 498 499 500 501 502
/* Caller should hold socket lock for the socket. */
static void __tipc_shutdown(struct socket *sock, int error)
{
	struct sock *sk = sock->sk;
	struct tipc_sock *tsk = tipc_sk(sk);
	struct net *net = sock_net(sk);
503
	long timeout = CONN_TIMEOUT_DEFAULT;
504 505 506
	u32 dnode = tsk_peer_node(tsk);
	struct sk_buff *skb;

507 508 509 510
	/* Avoid that hi-prio shutdown msgs bypass msgs in link wakeup queue */
	tipc_wait_for_cond(sock, &timeout, (!tsk->cong_link_cnt &&
					    !tsk_conn_cong(tsk)));

511 512 513 514 515 516
	/* Reject all unreceived messages, except on an active connection
	 * (which disconnects locally & sends a 'FIN+' to peer).
	 */
	while ((skb = __skb_dequeue(&sk->sk_receive_queue)) != NULL) {
		if (TIPC_SKB_CB(skb)->bytes_read) {
			kfree_skb(skb);
517
			continue;
518
		}
519 520 521 522 523 524
		if (!tipc_sk_type_connectionless(sk) &&
		    sk->sk_state != TIPC_DISCONNECTING) {
			tipc_set_sk_state(sk, TIPC_DISCONNECTING);
			tipc_node_remove_conn(net, dnode, tsk->portid);
		}
		tipc_sk_respond(sk, skb, error);
525
	}
526 527 528 529

	if (tipc_sk_type_connectionless(sk))
		return;

530 531 532 533 534 535 536
	if (sk->sk_state != TIPC_DISCONNECTING) {
		skb = tipc_msg_create(TIPC_CRITICAL_IMPORTANCE,
				      TIPC_CONN_MSG, SHORT_H_SIZE, 0, dnode,
				      tsk_own_node(tsk), tsk_peer_port(tsk),
				      tsk->portid, error);
		if (skb)
			tipc_node_xmit_skb(net, skb, dnode, tsk->portid);
537 538
		tipc_node_remove_conn(net, dnode, tsk->portid);
		tipc_set_sk_state(sk, TIPC_DISCONNECTING);
539 540 541
	}
}

P
Per Liden 已提交
542
/**
543
 * tipc_release - destroy a TIPC socket
P
Per Liden 已提交
544 545 546 547 548 549 550
 * @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.)
551
 *
P
Per Liden 已提交
552 553 554 555 556 557
 * 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
 */
558
static int tipc_release(struct socket *sock)
P
Per Liden 已提交
559 560
{
	struct sock *sk = sock->sk;
561
	struct tipc_sock *tsk;
P
Per Liden 已提交
562

563 564 565 566 567
	/*
	 * 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 已提交
568
		return 0;
569

570
	tsk = tipc_sk(sk);
571 572
	lock_sock(sk);

573 574
	__tipc_shutdown(sock, TIPC_ERR_NO_PORT);
	sk->sk_shutdown = SHUTDOWN_MASK;
J
Jon Maloy 已提交
575
	tipc_sk_leave(tsk);
576
	tipc_sk_withdraw(tsk, 0, NULL);
577
	sk_stop_timer(sk, &sk->sk_timer);
578
	tipc_sk_remove(tsk);
P
Per Liden 已提交
579

580 581
	/* Reject any messages that accumulated in backlog queue */
	release_sock(sk);
J
Jon Maloy 已提交
582
	tipc_dest_list_purge(&tsk->cong_links);
583
	tsk->cong_link_cnt = 0;
584
	call_rcu(&tsk->rcu, tipc_sk_callback);
585
	sock->sk = NULL;
P
Per Liden 已提交
586

587
	return 0;
P
Per Liden 已提交
588 589 590
}

/**
591
 * tipc_bind - associate or disassocate TIPC name(s) with a socket
P
Per Liden 已提交
592 593 594
 * @sock: socket structure
 * @uaddr: socket address describing name(s) and desired operation
 * @uaddr_len: size of socket address data structure
595
 *
P
Per Liden 已提交
596 597 598
 * 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.
599
 *
P
Per Liden 已提交
600
 * Returns 0 on success, errno otherwise
601 602 603
 *
 * NOTE: This routine doesn't need to take the socket lock since it doesn't
 *       access any non-constant socket information.
P
Per Liden 已提交
604
 */
605 606
static int tipc_bind(struct socket *sock, struct sockaddr *uaddr,
		     int uaddr_len)
P
Per Liden 已提交
607
{
608
	struct sock *sk = sock->sk;
P
Per Liden 已提交
609
	struct sockaddr_tipc *addr = (struct sockaddr_tipc *)uaddr;
610
	struct tipc_sock *tsk = tipc_sk(sk);
611
	int res = -EINVAL;
P
Per Liden 已提交
612

613 614
	lock_sock(sk);
	if (unlikely(!uaddr_len)) {
615
		res = tipc_sk_withdraw(tsk, 0, NULL);
616 617
		goto exit;
	}
J
Jon Maloy 已提交
618 619 620 621
	if (tsk->group) {
		res = -EACCES;
		goto exit;
	}
622 623 624 625 626 627 628 629
	if (uaddr_len < sizeof(struct sockaddr_tipc)) {
		res = -EINVAL;
		goto exit;
	}
	if (addr->family != AF_TIPC) {
		res = -EAFNOSUPPORT;
		goto exit;
	}
P
Per Liden 已提交
630 631 632

	if (addr->addrtype == TIPC_ADDR_NAME)
		addr->addr.nameseq.upper = addr->addr.nameseq.lower;
633 634 635 636
	else if (addr->addrtype != TIPC_ADDR_NAMESEQ) {
		res = -EAFNOSUPPORT;
		goto exit;
	}
637

638
	if ((addr->addr.nameseq.type < TIPC_RESERVED_TYPES) &&
639
	    (addr->addr.nameseq.type != TIPC_TOP_SRV) &&
640 641 642 643
	    (addr->addr.nameseq.type != TIPC_CFG_SRV)) {
		res = -EACCES;
		goto exit;
	}
644

645
	res = (addr->scope > 0) ?
646 647
		tipc_sk_publish(tsk, addr->scope, &addr->addr.nameseq) :
		tipc_sk_withdraw(tsk, -addr->scope, &addr->addr.nameseq);
648 649 650
exit:
	release_sock(sk);
	return res;
P
Per Liden 已提交
651 652
}

653
/**
654
 * tipc_getname - get port ID of socket or peer socket
P
Per Liden 已提交
655 656 657
 * @sock: socket structure
 * @uaddr: area for returned socket address
 * @uaddr_len: area for returned length of socket address
658
 * @peer: 0 = own ID, 1 = current peer ID, 2 = current/former peer ID
659
 *
P
Per Liden 已提交
660
 * Returns 0 on success, errno otherwise
661
 *
662 663
 * NOTE: This routine doesn't need to take the socket lock since it only
 *       accesses socket information that is unchanging (or which changes in
664
 *       a completely predictable manner).
P
Per Liden 已提交
665
 */
666 667
static int tipc_getname(struct socket *sock, struct sockaddr *uaddr,
			int *uaddr_len, int peer)
P
Per Liden 已提交
668 669
{
	struct sockaddr_tipc *addr = (struct sockaddr_tipc *)uaddr;
670 671
	struct sock *sk = sock->sk;
	struct tipc_sock *tsk = tipc_sk(sk);
672
	struct tipc_net *tn = net_generic(sock_net(sock->sk), tipc_net_id);
P
Per Liden 已提交
673

674
	memset(addr, 0, sizeof(*addr));
675
	if (peer) {
676
		if ((!tipc_sk_connected(sk)) &&
677
		    ((peer != 2) || (sk->sk_state != TIPC_DISCONNECTING)))
678
			return -ENOTCONN;
679 680
		addr->addr.id.ref = tsk_peer_port(tsk);
		addr->addr.id.node = tsk_peer_node(tsk);
681
	} else {
682
		addr->addr.id.ref = tsk->portid;
683
		addr->addr.id.node = tn->own_addr;
684
	}
P
Per Liden 已提交
685 686 687 688 689 690 691

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

692
	return 0;
P
Per Liden 已提交
693 694 695
}

/**
696
 * tipc_poll - read and possibly block on pollmask
P
Per Liden 已提交
697 698 699 700
 * @file: file structure associated with the socket
 * @sock: socket for which to calculate the poll bits
 * @wait: ???
 *
701 702 703 704 705 706 707 708
 * 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 ...
 *
709 710 711
 * 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 已提交
712
 */
713 714
static unsigned int tipc_poll(struct file *file, struct socket *sock,
			      poll_table *wait)
P
Per Liden 已提交
715
{
716
	struct sock *sk = sock->sk;
717
	struct tipc_sock *tsk = tipc_sk(sk);
J
Jon Maloy 已提交
718
	struct tipc_group *grp = tsk->group;
719
	u32 revents = 0;
720

721
	sock_poll_wait(file, sk_sleep(sk), wait);
722

723
	if (sk->sk_shutdown & RCV_SHUTDOWN)
724
		revents |= POLLRDHUP | POLLIN | POLLRDNORM;
725
	if (sk->sk_shutdown == SHUTDOWN_MASK)
726
		revents |= POLLHUP;
727

728 729
	switch (sk->sk_state) {
	case TIPC_ESTABLISHED:
730
	case TIPC_CONNECTING:
731
		if (!tsk->cong_link_cnt && !tsk_conn_cong(tsk))
732
			revents |= POLLOUT;
733 734
		/* fall thru' */
	case TIPC_LISTEN:
J
Jon Maloy 已提交
735
		if (!skb_queue_empty(&sk->sk_receive_queue))
736
			revents |= POLLIN | POLLRDNORM;
737 738
		break;
	case TIPC_OPEN:
J
Jon Maloy 已提交
739 740
		if (!grp || tipc_group_size(grp))
			if (!tsk->cong_link_cnt)
741 742 743
				revents |= POLLOUT;
		if (!tipc_sk_type_connectionless(sk))
			break;
J
Jon Maloy 已提交
744
		if (skb_queue_empty(&sk->sk_receive_queue))
745 746
			break;
		revents |= POLLIN | POLLRDNORM;
747 748
		break;
	case TIPC_DISCONNECTING:
749
		revents = POLLIN | POLLRDNORM | POLLHUP;
750
		break;
751
	}
752
	return revents;
P
Per Liden 已提交
753 754
}

755 756 757 758
/**
 * tipc_sendmcast - send multicast message
 * @sock: socket structure
 * @seq: destination address
759
 * @msg: message to send
760 761
 * @dlen: length of data to send
 * @timeout: timeout to wait for wakeup
762 763 764 765 766
 *
 * Called from function tipc_sendmsg(), which has done all sanity checks
 * Returns the number of bytes sent on success, or errno
 */
static int tipc_sendmcast(struct  socket *sock, struct tipc_name_seq *seq,
767
			  struct msghdr *msg, size_t dlen, long timeout)
768 769
{
	struct sock *sk = sock->sk;
770
	struct tipc_sock *tsk = tipc_sk(sk);
771
	struct tipc_msg *hdr = &tsk->phdr;
772
	struct net *net = sock_net(sk);
773
	int mtu = tipc_bcast_get_mtu(net);
774
	struct tipc_mc_method *method = &tsk->mc_method;
775
	u32 domain = addr_domain(net, TIPC_CLUSTER_SCOPE);
776
	struct sk_buff_head pkts;
777
	struct tipc_nlist dsts;
778 779
	int rc;

J
Jon Maloy 已提交
780 781 782
	if (tsk->group)
		return -EACCES;

783
	/* Block or return if any destination link is congested */
784 785 786
	rc = tipc_wait_for_cond(sock, &timeout, !tsk->cong_link_cnt);
	if (unlikely(rc))
		return rc;
787

788 789 790 791 792 793 794 795
	/* Lookup destination nodes */
	tipc_nlist_init(&dsts, tipc_own_addr(net));
	tipc_nametbl_lookup_dst_nodes(net, seq->type, seq->lower,
				      seq->upper, domain, &dsts);
	if (!dsts.local && !dsts.remote)
		return -EHOSTUNREACH;

	/* Build message header */
796
	msg_set_type(hdr, TIPC_MCAST_MSG);
797
	msg_set_hdr_sz(hdr, MCAST_H_SIZE);
798 799 800 801 802 803 804
	msg_set_lookup_scope(hdr, TIPC_CLUSTER_SCOPE);
	msg_set_destport(hdr, 0);
	msg_set_destnode(hdr, 0);
	msg_set_nametype(hdr, seq->type);
	msg_set_namelower(hdr, seq->lower);
	msg_set_nameupper(hdr, seq->upper);

805
	/* Build message as chain of buffers */
806 807
	skb_queue_head_init(&pkts);
	rc = tipc_msg_build(hdr, msg, 0, dlen, mtu, &pkts);
808

809 810
	/* Send message if build was successful */
	if (unlikely(rc == dlen))
811
		rc = tipc_mcast_xmit(net, &pkts, method, &dsts,
812 813 814
				     &tsk->cong_link_cnt);

	tipc_nlist_purge(&dsts);
815 816

	return rc ? rc : dlen;
817 818
}

819 820 821 822 823 824 825 826 827 828 829 830 831
/**
 * tipc_send_group_msg - send a message to a member in the group
 * @net: network namespace
 * @m: message to send
 * @mb: group member
 * @dnode: destination node
 * @dport: destination port
 * @dlen: total length of message data
 */
static int tipc_send_group_msg(struct net *net, struct tipc_sock *tsk,
			       struct msghdr *m, struct tipc_member *mb,
			       u32 dnode, u32 dport, int dlen)
{
832
	u16 bc_snd_nxt = tipc_group_bc_snd_nxt(tsk->group);
833
	struct tipc_mc_method *method = &tsk->mc_method;
834 835 836 837 838 839 840 841 842 843
	int blks = tsk_blocks(GROUP_H_SIZE + dlen);
	struct tipc_msg *hdr = &tsk->phdr;
	struct sk_buff_head pkts;
	int mtu, rc;

	/* Complete message header */
	msg_set_type(hdr, TIPC_GRP_UCAST_MSG);
	msg_set_hdr_sz(hdr, GROUP_H_SIZE);
	msg_set_destport(hdr, dport);
	msg_set_destnode(hdr, dnode);
844
	msg_set_grp_bc_seqno(hdr, bc_snd_nxt);
845 846 847 848 849 850 851 852 853 854 855 856 857 858 859

	/* Build message as chain of buffers */
	skb_queue_head_init(&pkts);
	mtu = tipc_node_get_mtu(net, dnode, tsk->portid);
	rc = tipc_msg_build(hdr, m, 0, dlen, mtu, &pkts);
	if (unlikely(rc != dlen))
		return rc;

	/* Send message */
	rc = tipc_node_xmit(net, &pkts, dnode, tsk->portid);
	if (unlikely(rc == -ELINKCONG)) {
		tipc_dest_push(&tsk->cong_links, dnode, 0);
		tsk->cong_link_cnt++;
	}

860
	/* Update send window */
861 862
	tipc_group_update_member(mb, blks);

863 864 865
	/* A broadcast sent within next EXPIRE period must follow same path */
	method->rcast = true;
	method->mandatory = true;
866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908 909 910 911
	return dlen;
}

/**
 * tipc_send_group_unicast - send message to a member in the group
 * @sock: socket structure
 * @m: message to send
 * @dlen: total length of message data
 * @timeout: timeout to wait for wakeup
 *
 * Called from function tipc_sendmsg(), which has done all sanity checks
 * Returns the number of bytes sent on success, or errno
 */
static int tipc_send_group_unicast(struct socket *sock, struct msghdr *m,
				   int dlen, long timeout)
{
	struct sock *sk = sock->sk;
	DECLARE_SOCKADDR(struct sockaddr_tipc *, dest, m->msg_name);
	int blks = tsk_blocks(GROUP_H_SIZE + dlen);
	struct tipc_sock *tsk = tipc_sk(sk);
	struct tipc_group *grp = tsk->group;
	struct net *net = sock_net(sk);
	struct tipc_member *mb = NULL;
	u32 node, port;
	int rc;

	node = dest->addr.id.node;
	port = dest->addr.id.ref;
	if (!port && !node)
		return -EHOSTUNREACH;

	/* Block or return if destination link or member is congested */
	rc = tipc_wait_for_cond(sock, &timeout,
				!tipc_dest_find(&tsk->cong_links, node, 0) &&
				!tipc_group_cong(grp, node, port, blks, &mb));
	if (unlikely(rc))
		return rc;

	if (unlikely(!mb))
		return -EHOSTUNREACH;

	rc = tipc_send_group_msg(net, tsk, m, mb, node, port, dlen);

	return rc ? rc : dlen;
}

912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988 989 990 991 992 993
/**
 * tipc_send_group_anycast - send message to any member with given identity
 * @sock: socket structure
 * @m: message to send
 * @dlen: total length of message data
 * @timeout: timeout to wait for wakeup
 *
 * Called from function tipc_sendmsg(), which has done all sanity checks
 * Returns the number of bytes sent on success, or errno
 */
static int tipc_send_group_anycast(struct socket *sock, struct msghdr *m,
				   int dlen, long timeout)
{
	DECLARE_SOCKADDR(struct sockaddr_tipc *, dest, m->msg_name);
	struct sock *sk = sock->sk;
	struct tipc_sock *tsk = tipc_sk(sk);
	struct list_head *cong_links = &tsk->cong_links;
	int blks = tsk_blocks(GROUP_H_SIZE + dlen);
	struct tipc_group *grp = tsk->group;
	struct tipc_member *first = NULL;
	struct tipc_member *mbr = NULL;
	struct net *net = sock_net(sk);
	u32 node, port, exclude;
	u32 type, inst, domain;
	struct list_head dsts;
	int lookups = 0;
	int dstcnt, rc;
	bool cong;

	INIT_LIST_HEAD(&dsts);

	type = dest->addr.name.name.type;
	inst = dest->addr.name.name.instance;
	domain = addr_domain(net, dest->scope);
	exclude = tipc_group_exclude(grp);

	while (++lookups < 4) {
		first = NULL;

		/* Look for a non-congested destination member, if any */
		while (1) {
			if (!tipc_nametbl_lookup(net, type, inst, domain, &dsts,
						 &dstcnt, exclude, false))
				return -EHOSTUNREACH;
			tipc_dest_pop(&dsts, &node, &port);
			cong = tipc_group_cong(grp, node, port, blks, &mbr);
			if (!cong)
				break;
			if (mbr == first)
				break;
			if (!first)
				first = mbr;
		}

		/* Start over if destination was not in member list */
		if (unlikely(!mbr))
			continue;

		if (likely(!cong && !tipc_dest_find(cong_links, node, 0)))
			break;

		/* Block or return if destination link or member is congested */
		rc = tipc_wait_for_cond(sock, &timeout,
					!tipc_dest_find(cong_links, node, 0) &&
					!tipc_group_cong(grp, node, port,
							 blks, &mbr));
		if (unlikely(rc))
			return rc;

		/* Send, unless destination disappeared while waiting */
		if (likely(mbr))
			break;
	}

	if (unlikely(lookups >= 4))
		return -EHOSTUNREACH;

	rc = tipc_send_group_msg(net, tsk, m, mbr, node, port, dlen);

	return rc ? rc : dlen;
}

J
Jon Maloy 已提交
994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006
/**
 * tipc_send_group_bcast - send message to all members in communication group
 * @sk: socket structure
 * @m: message to send
 * @dlen: total length of message data
 * @timeout: timeout to wait for wakeup
 *
 * Called from function tipc_sendmsg(), which has done all sanity checks
 * Returns the number of bytes sent on success, or errno
 */
static int tipc_send_group_bcast(struct socket *sock, struct msghdr *m,
				 int dlen, long timeout)
{
1007
	DECLARE_SOCKADDR(struct sockaddr_tipc *, dest, m->msg_name);
J
Jon Maloy 已提交
1008 1009 1010 1011 1012 1013
	struct sock *sk = sock->sk;
	struct net *net = sock_net(sk);
	struct tipc_sock *tsk = tipc_sk(sk);
	struct tipc_group *grp = tsk->group;
	struct tipc_nlist *dsts = tipc_group_dests(grp);
	struct tipc_mc_method *method = &tsk->mc_method;
1014
	bool ack = method->mandatory && method->rcast;
1015
	int blks = tsk_blocks(MCAST_H_SIZE + dlen);
J
Jon Maloy 已提交
1016 1017 1018 1019 1020 1021 1022 1023
	struct tipc_msg *hdr = &tsk->phdr;
	int mtu = tipc_bcast_get_mtu(net);
	struct sk_buff_head pkts;
	int rc = -EHOSTUNREACH;

	if (!dsts->local && !dsts->remote)
		return -EHOSTUNREACH;

1024 1025 1026
	/* Block or return if any destination link or member is congested */
	rc = tipc_wait_for_cond(sock, &timeout,	!tsk->cong_link_cnt &&
				!tipc_group_bc_cong(grp, blks));
J
Jon Maloy 已提交
1027 1028 1029 1030
	if (unlikely(rc))
		return rc;

	/* Complete message header */
1031 1032 1033 1034 1035 1036 1037
	if (dest) {
		msg_set_type(hdr, TIPC_GRP_MCAST_MSG);
		msg_set_nameinst(hdr, dest->addr.name.name.instance);
	} else {
		msg_set_type(hdr, TIPC_GRP_BCAST_MSG);
		msg_set_nameinst(hdr, 0);
	}
1038
	msg_set_hdr_sz(hdr, GROUP_H_SIZE);
J
Jon Maloy 已提交
1039 1040 1041 1042
	msg_set_destport(hdr, 0);
	msg_set_destnode(hdr, 0);
	msg_set_grp_bc_seqno(hdr, tipc_group_bc_snd_nxt(grp));

1043 1044 1045
	/* Avoid getting stuck with repeated forced replicasts */
	msg_set_grp_bc_ack_req(hdr, ack);

J
Jon Maloy 已提交
1046 1047 1048 1049 1050 1051 1052
	/* Build message as chain of buffers */
	skb_queue_head_init(&pkts);
	rc = tipc_msg_build(hdr, m, 0, dlen, mtu, &pkts);
	if (unlikely(rc != dlen))
		return rc;

	/* Send message */
1053
	rc = tipc_mcast_xmit(net, &pkts, method, dsts, &tsk->cong_link_cnt);
J
Jon Maloy 已提交
1054 1055 1056
	if (unlikely(rc))
		return rc;

1057
	/* Update broadcast sequence number and send windows */
1058 1059 1060 1061 1062 1063
	tipc_group_update_bc_members(tsk->group, blks, ack);

	/* Broadcast link is now free to choose method for next broadcast */
	method->mandatory = false;
	method->expires = jiffies;

J
Jon Maloy 已提交
1064 1065 1066
	return dlen;
}

1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108
/**
 * tipc_send_group_mcast - send message to all members with given identity
 * @sock: socket structure
 * @m: message to send
 * @dlen: total length of message data
 * @timeout: timeout to wait for wakeup
 *
 * Called from function tipc_sendmsg(), which has done all sanity checks
 * Returns the number of bytes sent on success, or errno
 */
static int tipc_send_group_mcast(struct socket *sock, struct msghdr *m,
				 int dlen, long timeout)
{
	struct sock *sk = sock->sk;
	DECLARE_SOCKADDR(struct sockaddr_tipc *, dest, m->msg_name);
	struct tipc_name_seq *seq = &dest->addr.nameseq;
	struct tipc_sock *tsk = tipc_sk(sk);
	struct tipc_group *grp = tsk->group;
	struct net *net = sock_net(sk);
	u32 domain, exclude, dstcnt;
	struct list_head dsts;

	INIT_LIST_HEAD(&dsts);

	if (seq->lower != seq->upper)
		return -ENOTSUPP;

	domain = addr_domain(net, dest->scope);
	exclude = tipc_group_exclude(grp);
	if (!tipc_nametbl_lookup(net, seq->type, seq->lower, domain,
				 &dsts, &dstcnt, exclude, true))
		return -EHOSTUNREACH;

	if (dstcnt == 1) {
		tipc_dest_pop(&dsts, &dest->addr.id.node, &dest->addr.id.ref);
		return tipc_send_group_unicast(sock, m, dlen, timeout);
	}

	tipc_dest_list_purge(&dsts);
	return tipc_send_group_bcast(sock, m, dlen, timeout);
}

1109 1110 1111 1112 1113 1114
/**
 * tipc_sk_mcast_rcv - Deliver multicast messages to all destination sockets
 * @arrvq: queue with arriving messages, to be cloned after destination lookup
 * @inputq: queue with cloned messages, delivered to socket after dest lookup
 *
 * Multi-threaded: parallel calls with reference to same queues may occur
1115
 */
1116 1117
void tipc_sk_mcast_rcv(struct net *net, struct sk_buff_head *arrvq,
		       struct sk_buff_head *inputq)
1118 1119
{
	u32 scope = TIPC_CLUSTER_SCOPE;
J
Jon Maloy 已提交
1120
	u32 self = tipc_own_addr(net);
1121
	struct sk_buff *skb, *_skb;
J
Jon Maloy 已提交
1122 1123 1124 1125 1126
	u32 lower = 0, upper = ~0;
	struct sk_buff_head tmpq;
	u32 portid, oport, onode;
	struct list_head dports;
	struct tipc_msg *msg;
1127
	int user, mtyp, hsz;
1128

1129
	__skb_queue_head_init(&tmpq);
1130
	INIT_LIST_HEAD(&dports);
1131

1132 1133 1134
	skb = tipc_skb_peek(arrvq, &inputq->lock);
	for (; skb; skb = tipc_skb_peek(arrvq, &inputq->lock)) {
		msg = buf_msg(skb);
1135 1136 1137 1138 1139 1140 1141 1142
		user = msg_user(msg);
		mtyp = msg_type(msg);
		if (mtyp == TIPC_GRP_UCAST_MSG || user == GROUP_PROTOCOL) {
			spin_lock_bh(&inputq->lock);
			if (skb_peek(arrvq) == skb) {
				__skb_dequeue(arrvq);
				__skb_queue_tail(inputq, skb);
			}
J
Jon Maloy 已提交
1143
			kfree_skb(skb);
1144 1145 1146
			spin_unlock_bh(&inputq->lock);
			continue;
		}
1147
		hsz = skb_headroom(skb) + msg_hdr_sz(msg);
J
Jon Maloy 已提交
1148 1149 1150
		oport = msg_origport(msg);
		onode = msg_orignode(msg);
		if (onode == self)
1151 1152 1153
			scope = TIPC_NODE_SCOPE;

		/* Create destination port list and message clones: */
J
Jon Maloy 已提交
1154 1155 1156 1157 1158 1159
		if (!msg_in_group(msg)) {
			lower = msg_namelower(msg);
			upper = msg_nameupper(msg);
		}
		tipc_nametbl_mc_translate(net, msg_nametype(msg), lower, upper,
					  scope, &dports);
J
Jon Maloy 已提交
1160
		while (tipc_dest_pop(&dports, NULL, &portid)) {
1161 1162 1163 1164 1165 1166 1167
			_skb = __pskb_copy(skb, hsz, GFP_ATOMIC);
			if (_skb) {
				msg_set_destport(buf_msg(_skb), portid);
				__skb_queue_tail(&tmpq, _skb);
				continue;
			}
			pr_warn("Failed to clone mcast rcv buffer\n");
1168
		}
1169 1170 1171 1172 1173 1174 1175 1176 1177
		/* Append to inputq if not already done by other thread */
		spin_lock_bh(&inputq->lock);
		if (skb_peek(arrvq) == skb) {
			skb_queue_splice_tail_init(&tmpq, inputq);
			kfree_skb(__skb_dequeue(arrvq));
		}
		spin_unlock_bh(&inputq->lock);
		__skb_queue_purge(&tmpq);
		kfree_skb(skb);
1178
	}
1179
	tipc_sk_rcv(net, inputq);
1180 1181
}

1182
/**
J
Jon Maloy 已提交
1183
 * tipc_sk_conn_proto_rcv - receive a connection mng protocol message
1184
 * @tsk: receiving socket
1185
 * @skb: pointer to message buffer.
1186
 */
J
Jon Maloy 已提交
1187 1188
static void tipc_sk_conn_proto_rcv(struct tipc_sock *tsk, struct sk_buff *skb,
				   struct sk_buff_head *xmitq)
1189
{
1190
	struct tipc_msg *hdr = buf_msg(skb);
J
Jon Maloy 已提交
1191 1192
	u32 onode = tsk_own_node(tsk);
	struct sock *sk = &tsk->sk;
1193
	int mtyp = msg_type(hdr);
1194
	bool conn_cong;
1195

1196
	/* Ignore if connection cannot be validated: */
1197
	if (!tsk_peer_msg(tsk, hdr))
1198 1199
		goto exit;

1200 1201 1202 1203 1204 1205 1206 1207
	if (unlikely(msg_errcode(hdr))) {
		tipc_set_sk_state(sk, TIPC_DISCONNECTING);
		tipc_node_remove_conn(sock_net(sk), tsk_peer_node(tsk),
				      tsk_peer_port(tsk));
		sk->sk_state_change(sk);
		goto exit;
	}

1208
	tsk->probe_unacked = false;
1209

1210 1211
	if (mtyp == CONN_PROBE) {
		msg_set_type(hdr, CONN_PROBE_REPLY);
J
Jon Paul Maloy 已提交
1212 1213
		if (tipc_msg_reverse(onode, &skb, TIPC_OK))
			__skb_queue_tail(xmitq, skb);
1214 1215
		return;
	} else if (mtyp == CONN_ACK) {
1216
		conn_cong = tsk_conn_cong(tsk);
1217 1218 1219
		tsk->snt_unacked -= msg_conn_ack(hdr);
		if (tsk->peer_caps & TIPC_BLOCK_FLOWCTL)
			tsk->snd_win = msg_adv_win(hdr);
1220
		if (conn_cong)
1221 1222 1223
			sk->sk_write_space(sk);
	} else if (mtyp != CONN_PROBE_REPLY) {
		pr_warn("Received unknown CONN_PROTO msg\n");
1224 1225
	}
exit:
1226
	kfree_skb(skb);
1227 1228
}

P
Per Liden 已提交
1229
/**
1230
 * tipc_sendmsg - send message in connectionless manner
P
Per Liden 已提交
1231 1232
 * @sock: socket structure
 * @m: message to send
1233
 * @dsz: amount of user data to be sent
1234
 *
P
Per Liden 已提交
1235
 * Message must have an destination specified explicitly.
1236
 * Used for SOCK_RDM and SOCK_DGRAM messages,
P
Per Liden 已提交
1237 1238
 * and for 'SYN' messages on SOCK_SEQPACKET and SOCK_STREAM connections.
 * (Note: 'SYN+' is prohibited on SOCK_STREAM.)
1239
 *
P
Per Liden 已提交
1240 1241
 * Returns the number of bytes sent on success, or errno otherwise
 */
1242
static int tipc_sendmsg(struct socket *sock,
1243
			struct msghdr *m, size_t dsz)
1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254
{
	struct sock *sk = sock->sk;
	int ret;

	lock_sock(sk);
	ret = __tipc_sendmsg(sock, m, dsz);
	release_sock(sk);

	return ret;
}

1255
static int __tipc_sendmsg(struct socket *sock, struct msghdr *m, size_t dlen)
P
Per Liden 已提交
1256
{
1257
	struct sock *sk = sock->sk;
1258
	struct net *net = sock_net(sk);
1259 1260 1261 1262 1263
	struct tipc_sock *tsk = tipc_sk(sk);
	DECLARE_SOCKADDR(struct sockaddr_tipc *, dest, m->msg_name);
	long timeout = sock_sndtimeo(sk, m->msg_flags & MSG_DONTWAIT);
	struct list_head *clinks = &tsk->cong_links;
	bool syn = !tipc_sk_type_connectionless(sk);
J
Jon Maloy 已提交
1264
	struct tipc_group *grp = tsk->group;
1265
	struct tipc_msg *hdr = &tsk->phdr;
1266
	struct tipc_name_seq *seq;
1267 1268 1269 1270
	struct sk_buff_head pkts;
	u32 type, inst, domain;
	u32 dnode, dport;
	int mtu, rc;
P
Per Liden 已提交
1271

1272
	if (unlikely(dlen > TIPC_MAX_USER_MSG_SIZE))
1273
		return -EMSGSIZE;
1274

1275 1276 1277 1278 1279 1280 1281 1282 1283 1284
	if (likely(dest)) {
		if (unlikely(m->msg_namelen < sizeof(*dest)))
			return -EINVAL;
		if (unlikely(dest->family != AF_TIPC))
			return -EINVAL;
	}

	if (grp) {
		if (!dest)
			return tipc_send_group_bcast(sock, m, dlen, timeout);
1285 1286
		if (dest->addrtype == TIPC_ADDR_NAME)
			return tipc_send_group_anycast(sock, m, dlen, timeout);
1287 1288
		if (dest->addrtype == TIPC_ADDR_ID)
			return tipc_send_group_unicast(sock, m, dlen, timeout);
1289 1290
		if (dest->addrtype == TIPC_ADDR_MCAST)
			return tipc_send_group_mcast(sock, m, dlen, timeout);
1291 1292
		return -EINVAL;
	}
J
Jon Maloy 已提交
1293

1294
	if (unlikely(!dest)) {
1295 1296
		dest = &tsk->peer;
		if (!syn || dest->family != AF_TIPC)
1297 1298
			return -EDESTADDRREQ;
	}
1299 1300

	if (unlikely(syn)) {
1301
		if (sk->sk_state == TIPC_LISTEN)
1302
			return -EPIPE;
1303
		if (sk->sk_state != TIPC_OPEN)
1304 1305 1306
			return -EISCONN;
		if (tsk->published)
			return -EOPNOTSUPP;
1307
		if (dest->addrtype == TIPC_ADDR_NAME) {
1308 1309
			tsk->conn_type = dest->addr.name.name.type;
			tsk->conn_instance = dest->addr.name.name.instance;
1310
		}
P
Per Liden 已提交
1311
	}
1312

1313 1314 1315
	seq = &dest->addr.nameseq;
	if (dest->addrtype == TIPC_ADDR_MCAST)
		return tipc_sendmcast(sock, seq, m, dlen, timeout);
1316

1317 1318 1319 1320
	if (dest->addrtype == TIPC_ADDR_NAME) {
		type = dest->addr.name.name.type;
		inst = dest->addr.name.name.instance;
		domain = dest->addr.name.domain;
1321
		dnode = domain;
1322 1323 1324 1325 1326
		msg_set_type(hdr, TIPC_NAMED_MSG);
		msg_set_hdr_sz(hdr, NAMED_H_SIZE);
		msg_set_nametype(hdr, type);
		msg_set_nameinst(hdr, inst);
		msg_set_lookup_scope(hdr, tipc_addr_scope(domain));
1327
		dport = tipc_nametbl_translate(net, type, inst, &dnode);
1328 1329
		msg_set_destnode(hdr, dnode);
		msg_set_destport(hdr, dport);
1330 1331
		if (unlikely(!dport && !dnode))
			return -EHOSTUNREACH;
1332 1333
	} else if (dest->addrtype == TIPC_ADDR_ID) {
		dnode = dest->addr.id.node;
1334 1335 1336 1337 1338
		msg_set_type(hdr, TIPC_DIRECT_MSG);
		msg_set_lookup_scope(hdr, 0);
		msg_set_destnode(hdr, dnode);
		msg_set_destport(hdr, dest->addr.id.ref);
		msg_set_hdr_sz(hdr, BASIC_H_SIZE);
1339 1340
	}

1341
	/* Block or return if destination link is congested */
J
Jon Maloy 已提交
1342 1343
	rc = tipc_wait_for_cond(sock, &timeout,
				!tipc_dest_find(clinks, dnode, 0));
1344 1345 1346 1347
	if (unlikely(rc))
		return rc;

	skb_queue_head_init(&pkts);
1348
	mtu = tipc_node_get_mtu(net, dnode, tsk->portid);
1349 1350
	rc = tipc_msg_build(hdr, m, 0, dlen, mtu, &pkts);
	if (unlikely(rc != dlen))
1351
		return rc;
1352

1353 1354
	rc = tipc_node_xmit(net, &pkts, dnode, tsk->portid);
	if (unlikely(rc == -ELINKCONG)) {
J
Jon Maloy 已提交
1355
		tipc_dest_push(clinks, dnode, 0);
1356 1357 1358
		tsk->cong_link_cnt++;
		rc = 0;
	}
1359

1360 1361 1362 1363
	if (unlikely(syn && !rc))
		tipc_set_sk_state(sk, TIPC_CONNECTING);

	return rc ? rc : dlen;
P
Per Liden 已提交
1364 1365
}

1366
/**
1367
 * tipc_sendstream - send stream-oriented data
P
Per Liden 已提交
1368
 * @sock: socket structure
1369 1370
 * @m: data to send
 * @dsz: total length of data to be transmitted
1371
 *
1372
 * Used for SOCK_STREAM data.
1373
 *
1374 1375
 * Returns the number of bytes sent on success (or partial success),
 * or errno if no data sent
P
Per Liden 已提交
1376
 */
1377
static int tipc_sendstream(struct socket *sock, struct msghdr *m, size_t dsz)
1378 1379 1380 1381 1382
{
	struct sock *sk = sock->sk;
	int ret;

	lock_sock(sk);
1383
	ret = __tipc_sendstream(sock, m, dsz);
1384 1385 1386 1387 1388
	release_sock(sk);

	return ret;
}

1389
static int __tipc_sendstream(struct socket *sock, struct msghdr *m, size_t dlen)
P
Per Liden 已提交
1390
{
1391
	struct sock *sk = sock->sk;
1392
	DECLARE_SOCKADDR(struct sockaddr_tipc *, dest, m->msg_name);
1393 1394 1395 1396 1397 1398 1399 1400
	long timeout = sock_sndtimeo(sk, m->msg_flags & MSG_DONTWAIT);
	struct tipc_sock *tsk = tipc_sk(sk);
	struct tipc_msg *hdr = &tsk->phdr;
	struct net *net = sock_net(sk);
	struct sk_buff_head pkts;
	u32 dnode = tsk_peer_node(tsk);
	int send, sent = 0;
	int rc = 0;
1401

1402
	skb_queue_head_init(&pkts);
1403

1404 1405
	if (unlikely(dlen > INT_MAX))
		return -EMSGSIZE;
1406

1407 1408 1409 1410 1411
	/* Handle implicit connection setup */
	if (unlikely(dest)) {
		rc = __tipc_sendmsg(sock, m, dlen);
		if (dlen && (dlen == rc))
			tsk->snt_unacked = tsk_inc(tsk, dlen + msg_hdr_sz(hdr));
1412
		return rc;
1413
	}
1414

1415
	do {
1416 1417
		rc = tipc_wait_for_cond(sock, &timeout,
					(!tsk->cong_link_cnt &&
1418 1419
					 !tsk_conn_cong(tsk) &&
					 tipc_sk_connected(sk)));
1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437
		if (unlikely(rc))
			break;

		send = min_t(size_t, dlen - sent, TIPC_MAX_USER_MSG_SIZE);
		rc = tipc_msg_build(hdr, m, sent, send, tsk->max_pkt, &pkts);
		if (unlikely(rc != send))
			break;

		rc = tipc_node_xmit(net, &pkts, dnode, tsk->portid);
		if (unlikely(rc == -ELINKCONG)) {
			tsk->cong_link_cnt = 1;
			rc = 0;
		}
		if (likely(!rc)) {
			tsk->snt_unacked += tsk_inc(tsk, send + MIN_H_SIZE);
			sent += send;
		}
	} while (sent < dlen && !rc);
1438

1439
	return sent ? sent : rc;
P
Per Liden 已提交
1440 1441
}

1442
/**
1443
 * tipc_send_packet - send a connection-oriented message
P
Per Liden 已提交
1444
 * @sock: socket structure
1445 1446
 * @m: message to send
 * @dsz: length of data to be transmitted
1447
 *
1448
 * Used for SOCK_SEQPACKET messages.
1449
 *
1450
 * Returns the number of bytes sent on success, or errno otherwise
P
Per Liden 已提交
1451
 */
1452
static int tipc_send_packet(struct socket *sock, struct msghdr *m, size_t dsz)
P
Per Liden 已提交
1453
{
1454 1455
	if (dsz > TIPC_MAX_USER_MSG_SIZE)
		return -EMSGSIZE;
P
Per Liden 已提交
1456

1457
	return tipc_sendstream(sock, m, dsz);
P
Per Liden 已提交
1458 1459
}

1460
/* tipc_sk_finish_conn - complete the setup of a connection
P
Per Liden 已提交
1461
 */
1462
static void tipc_sk_finish_conn(struct tipc_sock *tsk, u32 peer_port,
1463
				u32 peer_node)
P
Per Liden 已提交
1464
{
1465 1466
	struct sock *sk = &tsk->sk;
	struct net *net = sock_net(sk);
1467
	struct tipc_msg *msg = &tsk->phdr;
P
Per Liden 已提交
1468

1469 1470 1471 1472 1473
	msg_set_destnode(msg, peer_node);
	msg_set_destport(msg, peer_port);
	msg_set_type(msg, TIPC_CONN_MSG);
	msg_set_lookup_scope(msg, 0);
	msg_set_hdr_sz(msg, SHORT_H_SIZE);
1474

1475
	sk_reset_timer(sk, &sk->sk_timer, jiffies + CONN_PROBING_INTV);
1476
	tipc_set_sk_state(sk, TIPC_ESTABLISHED);
1477 1478
	tipc_node_add_conn(net, peer_node, tsk->portid, peer_port);
	tsk->max_pkt = tipc_node_get_mtu(net, peer_node, tsk->portid);
1479
	tsk->peer_caps = tipc_node_get_capabilities(net, peer_node);
1480 1481 1482 1483 1484 1485
	if (tsk->peer_caps & TIPC_BLOCK_FLOWCTL)
		return;

	/* Fall back to message based flow control */
	tsk->rcv_win = FLOWCTL_MSG_WIN;
	tsk->snd_win = FLOWCTL_MSG_WIN;
P
Per Liden 已提交
1486 1487 1488
}

/**
1489
 * tipc_sk_set_orig_addr - capture sender's address for received message
P
Per Liden 已提交
1490
 * @m: descriptor for message info
1491
 * @hdr: received message header
1492
 *
P
Per Liden 已提交
1493 1494
 * Note: Address is not captured if not requested by receiver.
 */
1495
static void tipc_sk_set_orig_addr(struct msghdr *m, struct sk_buff *skb)
P
Per Liden 已提交
1496
{
1497 1498 1499 1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520
	DECLARE_SOCKADDR(struct sockaddr_pair *, srcaddr, m->msg_name);
	struct tipc_msg *hdr = buf_msg(skb);

	if (!srcaddr)
		return;

	srcaddr->sock.family = AF_TIPC;
	srcaddr->sock.addrtype = TIPC_ADDR_ID;
	srcaddr->sock.addr.id.ref = msg_origport(hdr);
	srcaddr->sock.addr.id.node = msg_orignode(hdr);
	srcaddr->sock.addr.name.domain = 0;
	srcaddr->sock.scope = 0;
	m->msg_namelen = sizeof(struct sockaddr_tipc);

	if (!msg_in_group(hdr))
		return;

	/* Group message users may also want to know sending member's id */
	srcaddr->member.family = AF_TIPC;
	srcaddr->member.addrtype = TIPC_ADDR_NAME;
	srcaddr->member.addr.name.name.type = msg_nametype(hdr);
	srcaddr->member.addr.name.name.instance = TIPC_SKB_CB(skb)->orig_member;
	srcaddr->member.addr.name.domain = 0;
	m->msg_namelen = sizeof(*srcaddr);
P
Per Liden 已提交
1521 1522 1523
}

/**
1524
 * tipc_sk_anc_data_recv - optionally capture ancillary data for received message
P
Per Liden 已提交
1525 1526
 * @m: descriptor for message info
 * @msg: received message header
1527
 * @tsk: TIPC port associated with message
1528
 *
P
Per Liden 已提交
1529
 * Note: Ancillary data is not captured if not requested by receiver.
1530
 *
P
Per Liden 已提交
1531 1532
 * Returns 0 if successful, otherwise errno
 */
1533 1534
static int tipc_sk_anc_data_recv(struct msghdr *m, struct tipc_msg *msg,
				 struct tipc_sock *tsk)
P
Per Liden 已提交
1535 1536 1537 1538
{
	u32 anc_data[3];
	u32 err;
	u32 dest_type;
1539
	int has_name;
P
Per Liden 已提交
1540 1541 1542 1543 1544 1545 1546 1547 1548 1549
	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);
1550 1551
		res = put_cmsg(m, SOL_TIPC, TIPC_ERRINFO, 8, anc_data);
		if (res)
P
Per Liden 已提交
1552
			return res;
1553 1554 1555 1556 1557 1558
		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 已提交
1559 1560 1561 1562 1563 1564
	}

	/* Optionally capture message destination object */
	dest_type = msg ? msg_type(msg) : TIPC_DIRECT_MSG;
	switch (dest_type) {
	case TIPC_NAMED_MSG:
1565
		has_name = 1;
P
Per Liden 已提交
1566 1567 1568 1569 1570
		anc_data[0] = msg_nametype(msg);
		anc_data[1] = msg_namelower(msg);
		anc_data[2] = msg_namelower(msg);
		break;
	case TIPC_MCAST_MSG:
1571
		has_name = 1;
P
Per Liden 已提交
1572 1573 1574 1575 1576
		anc_data[0] = msg_nametype(msg);
		anc_data[1] = msg_namelower(msg);
		anc_data[2] = msg_nameupper(msg);
		break;
	case TIPC_CONN_MSG:
1577 1578 1579 1580
		has_name = (tsk->conn_type != 0);
		anc_data[0] = tsk->conn_type;
		anc_data[1] = tsk->conn_instance;
		anc_data[2] = tsk->conn_instance;
P
Per Liden 已提交
1581 1582
		break;
	default:
1583
		has_name = 0;
P
Per Liden 已提交
1584
	}
1585 1586 1587 1588 1589
	if (has_name) {
		res = put_cmsg(m, SOL_TIPC, TIPC_DESTNAME, 12, anc_data);
		if (res)
			return res;
	}
P
Per Liden 已提交
1590 1591 1592 1593

	return 0;
}

1594
static void tipc_sk_send_ack(struct tipc_sock *tsk)
1595
{
1596 1597
	struct sock *sk = &tsk->sk;
	struct net *net = sock_net(sk);
1598
	struct sk_buff *skb = NULL;
1599
	struct tipc_msg *msg;
1600 1601
	u32 peer_port = tsk_peer_port(tsk);
	u32 dnode = tsk_peer_node(tsk);
1602

1603
	if (!tipc_sk_connected(sk))
1604
		return;
1605 1606 1607
	skb = tipc_msg_create(CONN_MANAGER, CONN_ACK, INT_H_SIZE, 0,
			      dnode, tsk_own_node(tsk), peer_port,
			      tsk->portid, TIPC_OK);
1608
	if (!skb)
1609
		return;
1610
	msg = buf_msg(skb);
1611 1612 1613 1614 1615 1616 1617 1618
	msg_set_conn_ack(msg, tsk->rcv_unacked);
	tsk->rcv_unacked = 0;

	/* Adjust to and advertize the correct window limit */
	if (tsk->peer_caps & TIPC_BLOCK_FLOWCTL) {
		tsk->rcv_win = tsk_adv_blocks(tsk->sk.sk_rcvbuf);
		msg_set_adv_win(msg, tsk->rcv_win);
	}
1619
	tipc_node_xmit_skb(net, skb, dnode, msg_link_selector(msg));
1620 1621
}

1622
static int tipc_wait_for_rcvmsg(struct socket *sock, long *timeop)
Y
Ying Xue 已提交
1623 1624 1625
{
	struct sock *sk = sock->sk;
	DEFINE_WAIT(wait);
1626
	long timeo = *timeop;
1627 1628 1629 1630
	int err = sock_error(sk);

	if (err)
		return err;
Y
Ying Xue 已提交
1631 1632 1633

	for (;;) {
		prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
1634
		if (timeo && skb_queue_empty(&sk->sk_receive_queue)) {
1635
			if (sk->sk_shutdown & RCV_SHUTDOWN) {
Y
Ying Xue 已提交
1636 1637 1638 1639 1640 1641 1642 1643 1644 1645 1646 1647 1648
				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 = -EAGAIN;
		if (!timeo)
			break;
1649 1650 1651
		err = sock_intr_errno(timeo);
		if (signal_pending(current))
			break;
1652 1653 1654 1655

		err = sock_error(sk);
		if (err)
			break;
Y
Ying Xue 已提交
1656 1657
	}
	finish_wait(sk_sleep(sk), &wait);
1658
	*timeop = timeo;
Y
Ying Xue 已提交
1659 1660 1661
	return err;
}

1662
/**
1663
 * tipc_recvmsg - receive packet-oriented message
P
Per Liden 已提交
1664
 * @m: descriptor for message info
1665
 * @buflen: length of user buffer area
P
Per Liden 已提交
1666
 * @flags: receive flags
1667
 *
P
Per Liden 已提交
1668 1669 1670 1671 1672
 * 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
 */
1673 1674
static int tipc_recvmsg(struct socket *sock, struct msghdr *m,
			size_t buflen,	int flags)
P
Per Liden 已提交
1675
{
1676
	struct sock *sk = sock->sk;
1677
	bool connected = !tipc_sk_type_connectionless(sk);
1678
	struct tipc_sock *tsk = tipc_sk(sk);
1679
	int rc, err, hlen, dlen, copy;
1680
	struct sk_buff_head xmitq;
1681 1682 1683
	struct tipc_msg *hdr;
	struct sk_buff *skb;
	bool grp_evt;
1684
	long timeout;
P
Per Liden 已提交
1685

1686
	/* Catch invalid receive requests */
1687
	if (unlikely(!buflen))
P
Per Liden 已提交
1688 1689
		return -EINVAL;

1690
	lock_sock(sk);
1691 1692
	if (unlikely(connected && sk->sk_state == TIPC_OPEN)) {
		rc = -ENOTCONN;
P
Per Liden 已提交
1693 1694
		goto exit;
	}
1695
	timeout = sock_rcvtimeo(sk, flags & MSG_DONTWAIT);
P
Per Liden 已提交
1696

1697
	/* Step rcv queue to first msg with data or error; wait if necessary */
1698 1699 1700 1701 1702 1703 1704 1705 1706
	do {
		rc = tipc_wait_for_rcvmsg(sock, &timeout);
		if (unlikely(rc))
			goto exit;
		skb = skb_peek(&sk->sk_receive_queue);
		hdr = buf_msg(skb);
		dlen = msg_data_sz(hdr);
		hlen = msg_hdr_sz(hdr);
		err = msg_errcode(hdr);
1707
		grp_evt = msg_is_grp_evt(hdr);
1708 1709
		if (likely(dlen || err))
			break;
1710
		tsk_advance_rx_queue(sk);
1711
	} while (1);
P
Per Liden 已提交
1712

1713
	/* Collect msg meta data, including error code and rejected data */
1714
	tipc_sk_set_orig_addr(m, skb);
1715 1716
	rc = tipc_sk_anc_data_recv(m, hdr, tsk);
	if (unlikely(rc))
P
Per Liden 已提交
1717 1718
		goto exit;

1719 1720 1721 1722
	/* Capture data if non-error msg, otherwise just set return value */
	if (likely(!err)) {
		copy = min_t(int, dlen, buflen);
		if (unlikely(copy != dlen))
P
Per Liden 已提交
1723
			m->msg_flags |= MSG_TRUNC;
1724
		rc = skb_copy_datagram_msg(skb, hlen, m, copy);
P
Per Liden 已提交
1725
	} else {
1726 1727 1728 1729
		copy = 0;
		rc = 0;
		if (err != TIPC_CONN_SHUTDOWN && connected && !m->msg_control)
			rc = -ECONNRESET;
P
Per Liden 已提交
1730
	}
1731 1732
	if (unlikely(rc))
		goto exit;
P
Per Liden 已提交
1733

1734 1735 1736 1737 1738 1739 1740 1741
	/* Mark message as group event if applicable */
	if (unlikely(grp_evt)) {
		if (msg_grp_evt(hdr) == TIPC_WITHDRAWN)
			m->msg_flags |= MSG_EOR;
		m->msg_flags |= MSG_OOB;
		copy = 0;
	}

1742
	/* Caption of data or error code/rejected data was successful */
1743 1744 1745
	if (unlikely(flags & MSG_PEEK))
		goto exit;

1746 1747 1748 1749 1750 1751 1752 1753 1754
	/* Send group flow control advertisement when applicable */
	if (tsk->group && msg_in_group(hdr) && !grp_evt) {
		skb_queue_head_init(&xmitq);
		tipc_group_update_rcv_win(tsk->group, tsk_blocks(hlen + dlen),
					  msg_orignode(hdr), msg_origport(hdr),
					  &xmitq);
		tipc_node_distr_xmit(sock_net(sk), &xmitq);
	}

1755
	tsk_advance_rx_queue(sk);
1756

1757 1758 1759
	if (likely(!connected))
		goto exit;

1760
	/* Send connection flow control advertisement when applicable */
1761 1762 1763
	tsk->rcv_unacked += tsk_inc(tsk, hlen + dlen);
	if (tsk->rcv_unacked >= tsk->rcv_win / TIPC_ACK_RATE)
		tipc_sk_send_ack(tsk);
P
Per Liden 已提交
1764
exit:
1765
	release_sock(sk);
1766
	return rc ? rc : copy;
P
Per Liden 已提交
1767 1768
}

1769
/**
1770
 * tipc_recvstream - receive stream-oriented data
P
Per Liden 已提交
1771
 * @m: descriptor for message info
1772
 * @buflen: total size of user buffer area
P
Per Liden 已提交
1773
 * @flags: receive flags
1774 1775
 *
 * Used for SOCK_STREAM messages only.  If not enough data is available
P
Per Liden 已提交
1776 1777 1778 1779
 * will optionally wait for more; never truncates data.
 *
 * Returns size of returned message data, errno otherwise
 */
1780 1781
static int tipc_recvstream(struct socket *sock, struct msghdr *m,
			   size_t buflen, int flags)
P
Per Liden 已提交
1782
{
1783
	struct sock *sk = sock->sk;
1784
	struct tipc_sock *tsk = tipc_sk(sk);
1785 1786 1787 1788 1789 1790 1791
	struct sk_buff *skb;
	struct tipc_msg *hdr;
	struct tipc_skb_cb *skb_cb;
	bool peek = flags & MSG_PEEK;
	int offset, required, copy, copied = 0;
	int hlen, dlen, err, rc;
	long timeout;
P
Per Liden 已提交
1792

1793
	/* Catch invalid receive attempts */
1794
	if (unlikely(!buflen))
P
Per Liden 已提交
1795 1796
		return -EINVAL;

1797
	lock_sock(sk);
P
Per Liden 已提交
1798

1799
	if (unlikely(sk->sk_state == TIPC_OPEN)) {
1800
		rc = -ENOTCONN;
Y
Ying Xue 已提交
1801
		goto exit;
P
Per Liden 已提交
1802
	}
1803 1804
	required = sock_rcvlowat(sk, flags & MSG_WAITALL, buflen);
	timeout = sock_rcvtimeo(sk, flags & MSG_DONTWAIT);
P
Per Liden 已提交
1805

1806 1807 1808 1809 1810 1811 1812 1813 1814 1815 1816
	do {
		/* Look at first msg in receive queue; wait if necessary */
		rc = tipc_wait_for_rcvmsg(sock, &timeout);
		if (unlikely(rc))
			break;
		skb = skb_peek(&sk->sk_receive_queue);
		skb_cb = TIPC_SKB_CB(skb);
		hdr = buf_msg(skb);
		dlen = msg_data_sz(hdr);
		hlen = msg_hdr_sz(hdr);
		err = msg_errcode(hdr);
1817

1818 1819 1820 1821 1822
		/* Discard any empty non-errored (SYN-) message */
		if (unlikely(!dlen && !err)) {
			tsk_advance_rx_queue(sk);
			continue;
		}
1823

1824 1825
		/* Collect msg meta data, incl. error code and rejected data */
		if (!copied) {
1826
			tipc_sk_set_orig_addr(m, skb);
1827 1828 1829 1830
			rc = tipc_sk_anc_data_recv(m, hdr, tsk);
			if (rc)
				break;
		}
P
Per Liden 已提交
1831

1832 1833 1834 1835 1836 1837 1838 1839 1840 1841 1842 1843 1844 1845 1846 1847 1848 1849 1850 1851
		/* Copy data if msg ok, otherwise return error/partial data */
		if (likely(!err)) {
			offset = skb_cb->bytes_read;
			copy = min_t(int, dlen - offset, buflen - copied);
			rc = skb_copy_datagram_msg(skb, hlen + offset, m, copy);
			if (unlikely(rc))
				break;
			copied += copy;
			offset += copy;
			if (unlikely(offset < dlen)) {
				if (!peek)
					skb_cb->bytes_read = offset;
				break;
			}
		} else {
			rc = 0;
			if ((err != TIPC_CONN_SHUTDOWN) && !m->msg_control)
				rc = -ECONNRESET;
			if (copied || rc)
				break;
P
Per Liden 已提交
1852 1853
		}

1854 1855
		if (unlikely(peek))
			break;
P
Per Liden 已提交
1856

1857
		tsk_advance_rx_queue(sk);
1858

1859 1860 1861 1862
		/* Send connection flow control advertisement when applicable */
		tsk->rcv_unacked += tsk_inc(tsk, hlen + dlen);
		if (unlikely(tsk->rcv_unacked >= tsk->rcv_win / TIPC_ACK_RATE))
			tipc_sk_send_ack(tsk);
P
Per Liden 已提交
1863

1864 1865 1866
		/* Exit if all requested data or FIN/error received */
		if (copied == buflen || err)
			break;
P
Per Liden 已提交
1867

1868
	} while (!skb_queue_empty(&sk->sk_receive_queue) || copied < required);
P
Per Liden 已提交
1869
exit:
1870
	release_sock(sk);
1871
	return copied ? copied : rc;
P
Per Liden 已提交
1872 1873
}

1874 1875 1876 1877 1878 1879 1880 1881 1882 1883
/**
 * 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);
H
Herbert Xu 已提交
1884
	if (skwq_has_sleeper(wq))
1885 1886 1887 1888 1889 1890 1891 1892 1893 1894
		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
 */
1895
static void tipc_data_ready(struct sock *sk)
1896 1897 1898 1899 1900
{
	struct socket_wq *wq;

	rcu_read_lock();
	wq = rcu_dereference(sk->sk_wq);
H
Herbert Xu 已提交
1901
	if (skwq_has_sleeper(wq))
1902 1903 1904 1905 1906
		wake_up_interruptible_sync_poll(&wq->wait, POLLIN |
						POLLRDNORM | POLLRDBAND);
	rcu_read_unlock();
}

1907 1908 1909 1910 1911
static void tipc_sock_destruct(struct sock *sk)
{
	__skb_queue_purge(&sk->sk_receive_queue);
}

J
Jon Maloy 已提交
1912 1913 1914 1915 1916 1917 1918
static void tipc_sk_proto_rcv(struct sock *sk,
			      struct sk_buff_head *inputq,
			      struct sk_buff_head *xmitq)
{
	struct sk_buff *skb = __skb_dequeue(inputq);
	struct tipc_sock *tsk = tipc_sk(sk);
	struct tipc_msg *hdr = buf_msg(skb);
J
Jon Maloy 已提交
1919
	struct tipc_group *grp = tsk->group;
1920
	bool wakeup = false;
J
Jon Maloy 已提交
1921 1922 1923 1924 1925 1926

	switch (msg_user(hdr)) {
	case CONN_MANAGER:
		tipc_sk_conn_proto_rcv(tsk, skb, xmitq);
		return;
	case SOCK_WAKEUP:
J
Jon Maloy 已提交
1927
		tipc_dest_del(&tsk->cong_links, msg_orignode(hdr), 0);
J
Jon Maloy 已提交
1928
		tsk->cong_link_cnt--;
1929
		wakeup = true;
J
Jon Maloy 已提交
1930
		break;
J
Jon Maloy 已提交
1931
	case GROUP_PROTOCOL:
1932
		tipc_group_proto_rcv(grp, &wakeup, hdr, inputq, xmitq);
J
Jon Maloy 已提交
1933
		break;
J
Jon Maloy 已提交
1934
	case TOP_SRV:
1935
		tipc_group_member_evt(tsk->group, &wakeup, &sk->sk_rcvbuf,
1936
				      hdr, inputq, xmitq);
J
Jon Maloy 已提交
1937 1938 1939 1940 1941
		break;
	default:
		break;
	}

1942 1943 1944
	if (wakeup)
		sk->sk_write_space(sk);

J
Jon Maloy 已提交
1945 1946 1947
	kfree_skb(skb);
}

1948
/**
J
Jon Maloy 已提交
1949
 * tipc_filter_connect - Handle incoming message for a connection-based socket
1950
 * @tsk: TIPC socket
1951
 * @skb: pointer to message buffer. Set to NULL if buffer is consumed
1952
 *
1953
 * Returns true if everything ok, false otherwise
1954
 */
J
Jon Maloy 已提交
1955
static bool tipc_sk_filter_connect(struct tipc_sock *tsk, struct sk_buff *skb)
1956
{
1957
	struct sock *sk = &tsk->sk;
1958
	struct net *net = sock_net(sk);
1959
	struct tipc_msg *hdr = buf_msg(skb);
1960 1961
	u32 pport = msg_origport(hdr);
	u32 pnode = msg_orignode(hdr);
1962

1963 1964
	if (unlikely(msg_mcast(hdr)))
		return false;
1965

1966 1967
	switch (sk->sk_state) {
	case TIPC_CONNECTING:
1968
		/* Accept only ACK or NACK message */
1969 1970 1971 1972 1973 1974 1975 1976 1977 1978
		if (unlikely(!msg_connected(hdr))) {
			if (pport != tsk_peer_port(tsk) ||
			    pnode != tsk_peer_node(tsk))
				return false;

			tipc_set_sk_state(sk, TIPC_DISCONNECTING);
			sk->sk_err = ECONNREFUSED;
			sk->sk_state_change(sk);
			return true;
		}
1979

1980
		if (unlikely(msg_errcode(hdr))) {
1981
			tipc_set_sk_state(sk, TIPC_DISCONNECTING);
1982
			sk->sk_err = ECONNREFUSED;
1983
			sk->sk_state_change(sk);
1984
			return true;
1985 1986
		}

1987
		if (unlikely(!msg_isdata(hdr))) {
1988
			tipc_set_sk_state(sk, TIPC_DISCONNECTING);
1989
			sk->sk_err = EINVAL;
1990
			sk->sk_state_change(sk);
1991
			return true;
1992 1993
		}

1994 1995
		tipc_sk_finish_conn(tsk, msg_origport(hdr), msg_orignode(hdr));
		msg_set_importance(&tsk->phdr, msg_importance(hdr));
1996

1997 1998 1999 2000 2001
		/* If 'ACK+' message, add to socket receive queue */
		if (msg_data_sz(hdr))
			return true;

		/* If empty 'ACK-' message, wake up sleeping connect() */
2002
		sk->sk_data_ready(sk);
2003 2004 2005 2006 2007

		/* 'ACK-' message is neither accepted nor rejected: */
		msg_set_dest_droppable(hdr, 1);
		return false;

2008
	case TIPC_OPEN:
2009
	case TIPC_DISCONNECTING:
2010 2011
		break;
	case TIPC_LISTEN:
2012
		/* Accept only SYN message */
2013 2014
		if (!msg_connected(hdr) && !(msg_errcode(hdr)))
			return true;
2015
		break;
2016 2017 2018 2019 2020 2021 2022 2023 2024 2025 2026 2027 2028
	case TIPC_ESTABLISHED:
		/* Accept only connection-based messages sent by peer */
		if (unlikely(!tsk_peer_msg(tsk, hdr)))
			return false;

		if (unlikely(msg_errcode(hdr))) {
			tipc_set_sk_state(sk, TIPC_DISCONNECTING);
			/* Let timer expire on it's own */
			tipc_node_remove_conn(net, tsk_peer_node(tsk),
					      tsk->portid);
			sk->sk_state_change(sk);
		}
		return true;
2029
	default:
2030
		pr_err("Unknown sk_state %u\n", sk->sk_state);
2031
	}
2032

2033
	return false;
2034 2035
}

2036 2037 2038
/**
 * rcvbuf_limit - get proper overload limit of socket receive queue
 * @sk: socket
2039
 * @skb: message
2040
 *
2041 2042
 * For connection oriented messages, irrespective of importance,
 * default queue limit is 2 MB.
2043
 *
2044 2045
 * For connectionless messages, queue limits are based on message
 * importance as follows:
2046
 *
2047 2048 2049 2050
 * TIPC_LOW_IMPORTANCE       (2 MB)
 * TIPC_MEDIUM_IMPORTANCE    (4 MB)
 * TIPC_HIGH_IMPORTANCE      (8 MB)
 * TIPC_CRITICAL_IMPORTANCE  (16 MB)
2051 2052 2053
 *
 * Returns overload limit according to corresponding message importance
 */
2054
static unsigned int rcvbuf_limit(struct sock *sk, struct sk_buff *skb)
2055
{
2056 2057 2058
	struct tipc_sock *tsk = tipc_sk(sk);
	struct tipc_msg *hdr = buf_msg(skb);

2059 2060 2061
	if (unlikely(msg_in_group(hdr)))
		return sk->sk_rcvbuf;

2062 2063
	if (unlikely(!msg_connected(hdr)))
		return sk->sk_rcvbuf << msg_importance(hdr);
2064

2065 2066
	if (likely(tsk->peer_caps & TIPC_BLOCK_FLOWCTL))
		return sk->sk_rcvbuf;
2067

2068
	return FLOWCTL_MSG_LIM;
2069 2070
}

2071
/**
J
Jon Maloy 已提交
2072
 * tipc_sk_filter_rcv - validate incoming message
2073
 * @sk: socket
2074
 * @skb: pointer to message.
2075
 *
2076 2077 2078
 * Enqueues message on receive queue if acceptable; optionally handles
 * disconnect indication for a connected socket.
 *
2079
 * Called with socket lock already taken
2080
 *
P
Per Liden 已提交
2081
 */
J
Jon Maloy 已提交
2082 2083
static void tipc_sk_filter_rcv(struct sock *sk, struct sk_buff *skb,
			       struct sk_buff_head *xmitq)
P
Per Liden 已提交
2084
{
J
Jon Maloy 已提交
2085
	bool sk_conn = !tipc_sk_type_connectionless(sk);
2086
	struct tipc_sock *tsk = tipc_sk(sk);
J
Jon Maloy 已提交
2087
	struct tipc_group *grp = tsk->group;
2088
	struct tipc_msg *hdr = buf_msg(skb);
J
Jon Maloy 已提交
2089 2090 2091
	struct net *net = sock_net(sk);
	struct sk_buff_head inputq;
	int limit, err = TIPC_OK;
2092

J
Jon Maloy 已提交
2093 2094 2095
	TIPC_SKB_CB(skb)->bytes_read = 0;
	__skb_queue_head_init(&inputq);
	__skb_queue_tail(&inputq, skb);
2096

J
Jon Maloy 已提交
2097 2098
	if (unlikely(!msg_isdata(hdr)))
		tipc_sk_proto_rcv(sk, &inputq, xmitq);
2099

J
Jon Maloy 已提交
2100 2101 2102
	if (unlikely(grp))
		tipc_group_filter_msg(grp, &inputq, xmitq);

J
Jon Maloy 已提交
2103 2104 2105 2106 2107
	/* Validate and add to receive buffer if there is space */
	while ((skb = __skb_dequeue(&inputq))) {
		hdr = buf_msg(skb);
		limit = rcvbuf_limit(sk, skb);
		if ((sk_conn && !tipc_sk_filter_connect(tsk, skb)) ||
J
Jon Maloy 已提交
2108 2109
		    (!sk_conn && msg_connected(hdr)) ||
		    (!grp && msg_in_group(hdr)))
2110
			err = TIPC_ERR_NO_PORT;
J
Jon Maloy 已提交
2111 2112
		else if (sk_rmem_alloc_get(sk) + skb->truesize >= limit)
			err = TIPC_ERR_OVERLOAD;
P
Per Liden 已提交
2113

J
Jon Maloy 已提交
2114 2115 2116 2117 2118 2119 2120 2121
		if (unlikely(err)) {
			tipc_skb_reject(net, err, skb, xmitq);
			err = TIPC_OK;
			continue;
		}
		__skb_queue_tail(&sk->sk_receive_queue, skb);
		skb_set_owner_r(skb, sk);
		sk->sk_data_ready(sk);
2122
	}
2123
}
P
Per Liden 已提交
2124

2125
/**
J
Jon Maloy 已提交
2126
 * tipc_sk_backlog_rcv - handle incoming message from backlog queue
2127
 * @sk: socket
2128
 * @skb: message
2129
 *
2130
 * Caller must hold socket lock
2131
 */
J
Jon Maloy 已提交
2132
static int tipc_sk_backlog_rcv(struct sock *sk, struct sk_buff *skb)
2133
{
J
Jon Maloy 已提交
2134
	unsigned int before = sk_rmem_alloc_get(sk);
J
Jon Paul Maloy 已提交
2135
	struct sk_buff_head xmitq;
J
Jon Maloy 已提交
2136
	unsigned int added;
2137

J
Jon Paul Maloy 已提交
2138 2139
	__skb_queue_head_init(&xmitq);

J
Jon Maloy 已提交
2140 2141 2142
	tipc_sk_filter_rcv(sk, skb, &xmitq);
	added = sk_rmem_alloc_get(sk) - before;
	atomic_add(added, &tipc_sk(sk)->dupl_rcvcnt);
J
Jon Paul Maloy 已提交
2143

J
Jon Maloy 已提交
2144
	/* Send pending response/rejected messages, if any */
2145
	tipc_node_distr_xmit(sock_net(sk), &xmitq);
2146 2147 2148
	return 0;
}

2149
/**
2150 2151 2152 2153 2154
 * tipc_sk_enqueue - extract all buffers with destination 'dport' from
 *                   inputq and try adding them to socket or backlog queue
 * @inputq: list of incoming buffers with potentially different destinations
 * @sk: socket where the buffers should be enqueued
 * @dport: port number for the socket
2155 2156 2157
 *
 * Caller must hold socket lock
 */
2158
static void tipc_sk_enqueue(struct sk_buff_head *inputq, struct sock *sk,
J
Jon Paul Maloy 已提交
2159
			    u32 dport, struct sk_buff_head *xmitq)
2160
{
J
Jon Paul Maloy 已提交
2161 2162
	unsigned long time_limit = jiffies + 2;
	struct sk_buff *skb;
2163 2164
	unsigned int lim;
	atomic_t *dcnt;
J
Jon Paul Maloy 已提交
2165
	u32 onode;
2166 2167

	while (skb_queue_len(inputq)) {
2168
		if (unlikely(time_after_eq(jiffies, time_limit)))
2169 2170
			return;

2171 2172
		skb = tipc_skb_dequeue(inputq, dport);
		if (unlikely(!skb))
2173 2174 2175
			return;

		/* Add message directly to receive queue if possible */
2176
		if (!sock_owned_by_user(sk)) {
J
Jon Maloy 已提交
2177
			tipc_sk_filter_rcv(sk, skb, xmitq);
2178
			continue;
2179
		}
2180 2181

		/* Try backlog, compensating for double-counted bytes */
2182
		dcnt = &tipc_sk(sk)->dupl_rcvcnt;
2183
		if (!sk->sk_backlog.len)
2184 2185 2186 2187
			atomic_set(dcnt, 0);
		lim = rcvbuf_limit(sk, skb) + atomic_read(dcnt);
		if (likely(!sk_add_backlog(sk, skb, lim)))
			continue;
2188 2189

		/* Overload => reject message back to sender */
J
Jon Paul Maloy 已提交
2190 2191 2192
		onode = tipc_own_addr(sock_net(sk));
		if (tipc_msg_reverse(onode, &skb, TIPC_ERR_OVERLOAD))
			__skb_queue_tail(xmitq, skb);
2193
		break;
2194
	}
2195 2196
}

2197
/**
2198 2199 2200 2201
 * tipc_sk_rcv - handle a chain of incoming buffers
 * @inputq: buffer list containing the buffers
 * Consumes all buffers in list until inputq is empty
 * Note: may be called in multiple threads referring to the same queue
2202
 */
2203
void tipc_sk_rcv(struct net *net, struct sk_buff_head *inputq)
2204
{
J
Jon Paul Maloy 已提交
2205
	struct sk_buff_head xmitq;
2206
	u32 dnode, dport = 0;
E
Erik Hugne 已提交
2207
	int err;
2208 2209
	struct tipc_sock *tsk;
	struct sock *sk;
2210
	struct sk_buff *skb;
2211

J
Jon Paul Maloy 已提交
2212
	__skb_queue_head_init(&xmitq);
2213 2214 2215
	while (skb_queue_len(inputq)) {
		dport = tipc_skb_peek_port(inputq, dport);
		tsk = tipc_sk_lookup(net, dport);
2216

2217 2218 2219
		if (likely(tsk)) {
			sk = &tsk->sk;
			if (likely(spin_trylock_bh(&sk->sk_lock.slock))) {
J
Jon Paul Maloy 已提交
2220
				tipc_sk_enqueue(inputq, sk, dport, &xmitq);
2221 2222
				spin_unlock_bh(&sk->sk_lock.slock);
			}
J
Jon Paul Maloy 已提交
2223
			/* Send pending response/rejected messages, if any */
2224
			tipc_node_distr_xmit(sock_net(sk), &xmitq);
2225 2226 2227
			sock_put(sk);
			continue;
		}
2228 2229 2230 2231 2232 2233 2234 2235 2236 2237 2238 2239
		/* No destination socket => dequeue skb if still there */
		skb = tipc_skb_dequeue(inputq, dport);
		if (!skb)
			return;

		/* Try secondary lookup if unresolved named message */
		err = TIPC_ERR_NO_PORT;
		if (tipc_msg_lookup_dest(net, skb, &err))
			goto xmit;

		/* Prepare for message rejection */
		if (!tipc_msg_reverse(tipc_own_addr(net), &skb, err))
2240
			continue;
2241
xmit:
2242
		dnode = msg_destnode(buf_msg(skb));
2243
		tipc_node_xmit_skb(net, skb, dnode, dport);
2244
	}
P
Per Liden 已提交
2245 2246
}

Y
Ying Xue 已提交
2247 2248
static int tipc_wait_for_connect(struct socket *sock, long *timeo_p)
{
W
WANG Cong 已提交
2249
	DEFINE_WAIT_FUNC(wait, woken_wake_function);
Y
Ying Xue 已提交
2250 2251 2252 2253 2254 2255 2256 2257 2258 2259 2260 2261
	struct sock *sk = sock->sk;
	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);

W
WANG Cong 已提交
2262
		add_wait_queue(sk_sleep(sk), &wait);
2263
		done = sk_wait_event(sk, timeo_p,
W
WANG Cong 已提交
2264 2265
				     sk->sk_state != TIPC_CONNECTING, &wait);
		remove_wait_queue(sk_sleep(sk), &wait);
Y
Ying Xue 已提交
2266 2267 2268 2269
	} while (!done);
	return 0;
}

P
Per Liden 已提交
2270
/**
2271
 * tipc_connect - establish a connection to another TIPC port
P
Per Liden 已提交
2272 2273 2274
 * @sock: socket structure
 * @dest: socket address for destination port
 * @destlen: size of socket address data structure
2275
 * @flags: file-related flags associated with socket
P
Per Liden 已提交
2276 2277 2278
 *
 * Returns 0 on success, errno otherwise
 */
2279 2280
static int tipc_connect(struct socket *sock, struct sockaddr *dest,
			int destlen, int flags)
P
Per Liden 已提交
2281
{
2282
	struct sock *sk = sock->sk;
2283
	struct tipc_sock *tsk = tipc_sk(sk);
2284 2285
	struct sockaddr_tipc *dst = (struct sockaddr_tipc *)dest;
	struct msghdr m = {NULL,};
2286
	long timeout = (flags & O_NONBLOCK) ? 0 : tsk->conn_timeout;
2287
	int previous;
2288
	int res = 0;
2289

2290 2291 2292
	if (destlen != sizeof(struct sockaddr_tipc))
		return -EINVAL;

2293 2294
	lock_sock(sk);

J
Jon Maloy 已提交
2295 2296 2297 2298 2299
	if (tsk->group) {
		res = -EINVAL;
		goto exit;
	}

2300 2301 2302
	if (dst->family == AF_UNSPEC) {
		memset(&tsk->peer, 0, sizeof(struct sockaddr_tipc));
		if (!tipc_sk_type_connectionless(sk))
2303
			res = -EINVAL;
2304
		goto exit;
2305 2306
	} else if (dst->family != AF_TIPC) {
		res = -EINVAL;
2307
	}
2308
	if (dst->addrtype != TIPC_ADDR_ID && dst->addrtype != TIPC_ADDR_NAME)
2309
		res = -EINVAL;
2310 2311 2312 2313 2314 2315
	if (res)
		goto exit;

	/* DGRAM/RDM connect(), just save the destaddr */
	if (tipc_sk_type_connectionless(sk)) {
		memcpy(&tsk->peer, dest, destlen);
2316 2317 2318
		goto exit;
	}

2319
	previous = sk->sk_state;
2320 2321 2322

	switch (sk->sk_state) {
	case TIPC_OPEN:
2323 2324 2325 2326 2327 2328 2329 2330 2331 2332
		/* 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;

2333
		res = __tipc_sendmsg(sock, &m, 0);
2334 2335 2336
		if ((res < 0) && (res != -EWOULDBLOCK))
			goto exit;

2337
		/* Just entered TIPC_CONNECTING state; the only
2338 2339 2340 2341
		 * difference is that return value in non-blocking
		 * case is EINPROGRESS, rather than EALREADY.
		 */
		res = -EINPROGRESS;
2342 2343 2344 2345 2346
		/* fall thru' */
	case TIPC_CONNECTING:
		if (!timeout) {
			if (previous == TIPC_CONNECTING)
				res = -EALREADY;
Y
Ying Xue 已提交
2347
			goto exit;
2348
		}
Y
Ying Xue 已提交
2349 2350 2351
		timeout = msecs_to_jiffies(timeout);
		/* Wait until an 'ACK' or 'RST' arrives, or a timeout occurs */
		res = tipc_wait_for_connect(sock, &timeout);
2352 2353
		break;
	case TIPC_ESTABLISHED:
2354
		res = -EISCONN;
2355 2356
		break;
	default:
2357
		res = -EINVAL;
2358
	}
2359

2360 2361
exit:
	release_sock(sk);
2362
	return res;
P
Per Liden 已提交
2363 2364
}

2365
/**
2366
 * tipc_listen - allow socket to listen for incoming connections
P
Per Liden 已提交
2367 2368
 * @sock: socket structure
 * @len: (unused)
2369
 *
P
Per Liden 已提交
2370 2371
 * Returns 0 on success, errno otherwise
 */
2372
static int tipc_listen(struct socket *sock, int len)
P
Per Liden 已提交
2373
{
2374 2375 2376 2377
	struct sock *sk = sock->sk;
	int res;

	lock_sock(sk);
2378
	res = tipc_set_sk_state(sk, TIPC_LISTEN);
2379
	release_sock(sk);
2380

2381
	return res;
P
Per Liden 已提交
2382 2383
}

Y
Ying Xue 已提交
2384 2385 2386 2387 2388 2389 2390 2391 2392 2393 2394 2395 2396 2397
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);
2398
		if (timeo && skb_queue_empty(&sk->sk_receive_queue)) {
Y
Ying Xue 已提交
2399 2400 2401 2402 2403 2404 2405 2406 2407 2408
			release_sock(sk);
			timeo = schedule_timeout(timeo);
			lock_sock(sk);
		}
		err = 0;
		if (!skb_queue_empty(&sk->sk_receive_queue))
			break;
		err = -EAGAIN;
		if (!timeo)
			break;
2409 2410 2411
		err = sock_intr_errno(timeo);
		if (signal_pending(current))
			break;
Y
Ying Xue 已提交
2412 2413 2414 2415 2416
	}
	finish_wait(sk_sleep(sk), &wait);
	return err;
}

2417
/**
2418
 * tipc_accept - wait for connection request
P
Per Liden 已提交
2419 2420 2421
 * @sock: listening socket
 * @newsock: new socket that is to be connected
 * @flags: file-related flags associated with socket
2422
 *
P
Per Liden 已提交
2423 2424
 * Returns 0 on success, errno otherwise
 */
2425 2426
static int tipc_accept(struct socket *sock, struct socket *new_sock, int flags,
		       bool kern)
P
Per Liden 已提交
2427
{
2428
	struct sock *new_sk, *sk = sock->sk;
P
Per Liden 已提交
2429
	struct sk_buff *buf;
2430
	struct tipc_sock *new_tsock;
2431
	struct tipc_msg *msg;
Y
Ying Xue 已提交
2432
	long timeo;
2433
	int res;
P
Per Liden 已提交
2434

2435
	lock_sock(sk);
P
Per Liden 已提交
2436

2437
	if (sk->sk_state != TIPC_LISTEN) {
2438
		res = -EINVAL;
P
Per Liden 已提交
2439 2440
		goto exit;
	}
Y
Ying Xue 已提交
2441 2442 2443 2444
	timeo = sock_rcvtimeo(sk, flags & O_NONBLOCK);
	res = tipc_wait_for_accept(sock, timeo);
	if (res)
		goto exit;
2445 2446 2447

	buf = skb_peek(&sk->sk_receive_queue);

2448
	res = tipc_sk_create(sock_net(sock->sk), new_sock, 0, kern);
2449 2450
	if (res)
		goto exit;
2451
	security_sk_clone(sock->sk, new_sock->sk);
P
Per Liden 已提交
2452

2453
	new_sk = new_sock->sk;
2454
	new_tsock = tipc_sk(new_sk);
2455
	msg = buf_msg(buf);
P
Per Liden 已提交
2456

2457 2458 2459 2460 2461 2462 2463
	/* 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)
	 */
2464
	tsk_rej_rx_queue(new_sk);
2465 2466

	/* Connect new socket to it's peer */
2467
	tipc_sk_finish_conn(new_tsock, msg_origport(msg), msg_orignode(msg));
2468

2469
	tsk_set_importance(new_tsock, msg_importance(msg));
2470
	if (msg_named(msg)) {
2471 2472
		new_tsock->conn_type = msg_nametype(msg);
		new_tsock->conn_instance = msg_nameinst(msg);
P
Per Liden 已提交
2473
	}
2474 2475 2476 2477 2478 2479 2480 2481

	/*
	 * 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,};

2482
		tsk_advance_rx_queue(sk);
2483
		__tipc_sendstream(new_sock, &m, 0);
2484 2485 2486
	} else {
		__skb_dequeue(&sk->sk_receive_queue);
		__skb_queue_head(&new_sk->sk_receive_queue, buf);
2487
		skb_set_owner_r(buf, new_sk);
2488 2489
	}
	release_sock(new_sk);
P
Per Liden 已提交
2490
exit:
2491
	release_sock(sk);
P
Per Liden 已提交
2492 2493 2494 2495
	return res;
}

/**
2496
 * tipc_shutdown - shutdown socket connection
P
Per Liden 已提交
2497
 * @sock: socket structure
2498
 * @how: direction to close (must be SHUT_RDWR)
P
Per Liden 已提交
2499 2500
 *
 * Terminates connection (if necessary), then purges socket's receive queue.
2501
 *
P
Per Liden 已提交
2502 2503
 * Returns 0 on success, errno otherwise
 */
2504
static int tipc_shutdown(struct socket *sock, int how)
P
Per Liden 已提交
2505
{
2506
	struct sock *sk = sock->sk;
P
Per Liden 已提交
2507 2508
	int res;

2509 2510
	if (how != SHUT_RDWR)
		return -EINVAL;
P
Per Liden 已提交
2511

2512
	lock_sock(sk);
P
Per Liden 已提交
2513

2514 2515
	__tipc_shutdown(sock, TIPC_CONN_SHUTDOWN);
	sk->sk_shutdown = SEND_SHUTDOWN;
P
Per Liden 已提交
2516

2517
	if (sk->sk_state == TIPC_DISCONNECTING) {
2518
		/* Discard any unreceived messages */
2519
		__skb_queue_purge(&sk->sk_receive_queue);
2520 2521 2522

		/* Wake up anyone sleeping in poll */
		sk->sk_state_change(sk);
P
Per Liden 已提交
2523
		res = 0;
2524
	} else {
P
Per Liden 已提交
2525 2526 2527
		res = -ENOTCONN;
	}

2528
	release_sock(sk);
P
Per Liden 已提交
2529 2530 2531
	return res;
}

2532
static void tipc_sk_timeout(struct timer_list *t)
2533
{
2534 2535
	struct sock *sk = from_timer(sk, t, sk_timer);
	struct tipc_sock *tsk = tipc_sk(sk);
2536 2537 2538 2539 2540
	u32 peer_port = tsk_peer_port(tsk);
	u32 peer_node = tsk_peer_node(tsk);
	u32 own_node = tsk_own_node(tsk);
	u32 own_port = tsk->portid;
	struct net *net = sock_net(sk);
2541
	struct sk_buff *skb = NULL;
2542

J
Jon Paul Maloy 已提交
2543
	bh_lock_sock(sk);
2544 2545 2546 2547 2548 2549
	if (!tipc_sk_connected(sk))
		goto exit;

	/* Try again later if socket is busy */
	if (sock_owned_by_user(sk)) {
		sk_reset_timer(sk, &sk->sk_timer, jiffies + HZ / 20);
J
Jon Paul Maloy 已提交
2550
		goto exit;
2551 2552
	}

2553
	if (tsk->probe_unacked) {
2554 2555 2556
		tipc_set_sk_state(sk, TIPC_DISCONNECTING);
		tipc_node_remove_conn(net, peer_node, peer_port);
		sk->sk_state_change(sk);
2557
		goto exit;
2558
	}
2559 2560 2561 2562
	/* Send new probe */
	skb = tipc_msg_create(CONN_MANAGER, CONN_PROBE, INT_H_SIZE, 0,
			      peer_node, own_node, peer_port, own_port,
			      TIPC_OK);
2563
	tsk->probe_unacked = true;
2564 2565
	sk_reset_timer(sk, &sk->sk_timer, jiffies + CONN_PROBING_INTV);
exit:
2566
	bh_unlock_sock(sk);
2567
	if (skb)
2568
		tipc_node_xmit_skb(net, skb, peer_node, own_port);
2569
	sock_put(sk);
2570 2571
}

2572
static int tipc_sk_publish(struct tipc_sock *tsk, uint scope,
J
Jon Paul Maloy 已提交
2573 2574
			   struct tipc_name_seq const *seq)
{
2575 2576
	struct sock *sk = &tsk->sk;
	struct net *net = sock_net(sk);
J
Jon Paul Maloy 已提交
2577 2578 2579
	struct publication *publ;
	u32 key;

2580
	if (tipc_sk_connected(sk))
J
Jon Paul Maloy 已提交
2581
		return -EINVAL;
2582 2583
	key = tsk->portid + tsk->pub_count + 1;
	if (key == tsk->portid)
J
Jon Paul Maloy 已提交
2584 2585
		return -EADDRINUSE;

2586
	publ = tipc_nametbl_publish(net, seq->type, seq->lower, seq->upper,
2587
				    scope, tsk->portid, key);
J
Jon Paul Maloy 已提交
2588 2589 2590
	if (unlikely(!publ))
		return -EINVAL;

2591 2592 2593
	list_add(&publ->pport_list, &tsk->publications);
	tsk->pub_count++;
	tsk->published = 1;
J
Jon Paul Maloy 已提交
2594 2595 2596
	return 0;
}

2597
static int tipc_sk_withdraw(struct tipc_sock *tsk, uint scope,
J
Jon Paul Maloy 已提交
2598 2599
			    struct tipc_name_seq const *seq)
{
2600
	struct net *net = sock_net(&tsk->sk);
J
Jon Paul Maloy 已提交
2601 2602 2603 2604
	struct publication *publ;
	struct publication *safe;
	int rc = -EINVAL;

2605
	list_for_each_entry_safe(publ, safe, &tsk->publications, pport_list) {
J
Jon Paul Maloy 已提交
2606 2607 2608 2609 2610 2611 2612 2613 2614
		if (seq) {
			if (publ->scope != scope)
				continue;
			if (publ->type != seq->type)
				continue;
			if (publ->lower != seq->lower)
				continue;
			if (publ->upper != seq->upper)
				break;
2615
			tipc_nametbl_withdraw(net, publ->type, publ->lower,
J
Jon Paul Maloy 已提交
2616 2617 2618 2619
					      publ->ref, publ->key);
			rc = 0;
			break;
		}
2620
		tipc_nametbl_withdraw(net, publ->type, publ->lower,
J
Jon Paul Maloy 已提交
2621 2622 2623
				      publ->ref, publ->key);
		rc = 0;
	}
2624 2625
	if (list_empty(&tsk->publications))
		tsk->published = 0;
J
Jon Paul Maloy 已提交
2626 2627 2628
	return rc;
}

2629 2630 2631
/* tipc_sk_reinit: set non-zero address in all existing sockets
 *                 when we go from standalone to network mode.
 */
2632
void tipc_sk_reinit(struct net *net)
2633
{
2634
	struct tipc_net *tn = net_generic(net, tipc_net_id);
2635
	struct rhashtable_iter iter;
2636
	struct tipc_sock *tsk;
2637 2638
	struct tipc_msg *msg;

2639 2640 2641
	rhashtable_walk_enter(&tn->sk_rht, &iter);

	do {
2642
		rhashtable_walk_start(&iter);
2643 2644

		while ((tsk = rhashtable_walk_next(&iter)) && !IS_ERR(tsk)) {
2645 2646
			spin_lock_bh(&tsk->sk.sk_lock.slock);
			msg = &tsk->phdr;
2647 2648
			msg_set_prevnode(msg, tn->own_addr);
			msg_set_orignode(msg, tn->own_addr);
2649 2650
			spin_unlock_bh(&tsk->sk.sk_lock.slock);
		}
2651

2652 2653
		rhashtable_walk_stop(&iter);
	} while (tsk == ERR_PTR(-EAGAIN));
2654 2655
}

2656
static struct tipc_sock *tipc_sk_lookup(struct net *net, u32 portid)
2657
{
2658
	struct tipc_net *tn = net_generic(net, tipc_net_id);
2659
	struct tipc_sock *tsk;
2660

2661
	rcu_read_lock();
2662
	tsk = rhashtable_lookup_fast(&tn->sk_rht, &portid, tsk_rht_params);
2663 2664 2665
	if (tsk)
		sock_hold(&tsk->sk);
	rcu_read_unlock();
2666

2667
	return tsk;
2668 2669
}

2670
static int tipc_sk_insert(struct tipc_sock *tsk)
2671
{
2672 2673 2674
	struct sock *sk = &tsk->sk;
	struct net *net = sock_net(sk);
	struct tipc_net *tn = net_generic(net, tipc_net_id);
2675 2676
	u32 remaining = (TIPC_MAX_PORT - TIPC_MIN_PORT) + 1;
	u32 portid = prandom_u32() % remaining + TIPC_MIN_PORT;
2677

2678 2679 2680 2681 2682 2683
	while (remaining--) {
		portid++;
		if ((portid < TIPC_MIN_PORT) || (portid > TIPC_MAX_PORT))
			portid = TIPC_MIN_PORT;
		tsk->portid = portid;
		sock_hold(&tsk->sk);
2684 2685
		if (!rhashtable_lookup_insert_fast(&tn->sk_rht, &tsk->node,
						   tsk_rht_params))
2686 2687
			return 0;
		sock_put(&tsk->sk);
2688 2689
	}

2690
	return -1;
2691 2692
}

2693
static void tipc_sk_remove(struct tipc_sock *tsk)
2694
{
2695
	struct sock *sk = &tsk->sk;
2696
	struct tipc_net *tn = net_generic(sock_net(sk), tipc_net_id);
2697

2698
	if (!rhashtable_remove_fast(&tn->sk_rht, &tsk->node, tsk_rht_params)) {
2699
		WARN_ON(refcount_read(&sk->sk_refcnt) == 1);
2700
		__sock_put(sk);
2701 2702 2703
	}
}

2704 2705 2706 2707 2708 2709 2710
static const struct rhashtable_params tsk_rht_params = {
	.nelem_hint = 192,
	.head_offset = offsetof(struct tipc_sock, node),
	.key_offset = offsetof(struct tipc_sock, portid),
	.key_len = sizeof(u32), /* portid */
	.max_size = 1048576,
	.min_size = 256,
2711
	.automatic_shrinking = true,
2712 2713
};

2714
int tipc_sk_rht_init(struct net *net)
2715
{
2716
	struct tipc_net *tn = net_generic(net, tipc_net_id);
2717 2718

	return rhashtable_init(&tn->sk_rht, &tsk_rht_params);
2719 2720
}

2721
void tipc_sk_rht_destroy(struct net *net)
2722
{
2723 2724
	struct tipc_net *tn = net_generic(net, tipc_net_id);

2725 2726
	/* Wait for socket readers to complete */
	synchronize_net();
2727

2728
	rhashtable_destroy(&tn->sk_rht);
2729 2730
}

J
Jon Maloy 已提交
2731 2732 2733 2734 2735 2736 2737 2738 2739 2740 2741 2742 2743 2744 2745 2746 2747 2748 2749 2750 2751 2752 2753 2754 2755
static int tipc_sk_join(struct tipc_sock *tsk, struct tipc_group_req *mreq)
{
	struct net *net = sock_net(&tsk->sk);
	u32 domain = addr_domain(net, mreq->scope);
	struct tipc_group *grp = tsk->group;
	struct tipc_msg *hdr = &tsk->phdr;
	struct tipc_name_seq seq;
	int rc;

	if (mreq->type < TIPC_RESERVED_TYPES)
		return -EACCES;
	if (grp)
		return -EACCES;
	grp = tipc_group_create(net, tsk->portid, mreq);
	if (!grp)
		return -ENOMEM;
	tsk->group = grp;
	msg_set_lookup_scope(hdr, mreq->scope);
	msg_set_nametype(hdr, mreq->type);
	msg_set_dest_droppable(hdr, true);
	seq.type = mreq->type;
	seq.lower = mreq->instance;
	seq.upper = seq.lower;
	tipc_nametbl_build_group(net, grp, mreq->type, domain);
	rc = tipc_sk_publish(tsk, mreq->scope, &seq);
C
Cong Wang 已提交
2756
	if (rc) {
J
Jon Maloy 已提交
2757
		tipc_group_delete(net, grp);
C
Cong Wang 已提交
2758 2759
		tsk->group = NULL;
	}
2760 2761 2762 2763

	/* Eliminate any risk that a broadcast overtakes the sent JOIN */
	tsk->mc_method.rcast = true;
	tsk->mc_method.mandatory = true;
J
Jon Maloy 已提交
2764 2765 2766 2767 2768 2769 2770 2771 2772 2773 2774 2775 2776 2777 2778 2779 2780 2781 2782
	return rc;
}

static int tipc_sk_leave(struct tipc_sock *tsk)
{
	struct net *net = sock_net(&tsk->sk);
	struct tipc_group *grp = tsk->group;
	struct tipc_name_seq seq;
	int scope;

	if (!grp)
		return -EINVAL;
	tipc_group_self(grp, &seq, &scope);
	tipc_group_delete(net, grp);
	tsk->group = NULL;
	tipc_sk_withdraw(tsk, scope, &seq);
	return 0;
}

P
Per Liden 已提交
2783
/**
2784
 * tipc_setsockopt - set socket option
P
Per Liden 已提交
2785 2786 2787 2788 2789
 * @sock: socket structure
 * @lvl: option level
 * @opt: option identifier
 * @ov: pointer to new option value
 * @ol: length of option value
2790 2791
 *
 * For stream sockets only, accepts and ignores all IPPROTO_TCP options
P
Per Liden 已提交
2792
 * (to ease compatibility).
2793
 *
P
Per Liden 已提交
2794 2795
 * Returns 0 on success, errno otherwise
 */
2796 2797
static int tipc_setsockopt(struct socket *sock, int lvl, int opt,
			   char __user *ov, unsigned int ol)
P
Per Liden 已提交
2798
{
2799
	struct sock *sk = sock->sk;
2800
	struct tipc_sock *tsk = tipc_sk(sk);
J
Jon Maloy 已提交
2801
	struct tipc_group_req mreq;
2802
	u32 value = 0;
2803
	int res = 0;
P
Per Liden 已提交
2804

2805 2806
	if ((lvl == IPPROTO_TCP) && (sock->type == SOCK_STREAM))
		return 0;
P
Per Liden 已提交
2807 2808
	if (lvl != SOL_TIPC)
		return -ENOPROTOOPT;
2809 2810 2811 2812 2813 2814 2815 2816

	switch (opt) {
	case TIPC_IMPORTANCE:
	case TIPC_SRC_DROPPABLE:
	case TIPC_DEST_DROPPABLE:
	case TIPC_CONN_TIMEOUT:
		if (ol < sizeof(value))
			return -EINVAL;
J
Jon Maloy 已提交
2817 2818 2819 2820 2821 2822 2823 2824
		if (get_user(value, (u32 __user *)ov))
			return -EFAULT;
		break;
	case TIPC_GROUP_JOIN:
		if (ol < sizeof(mreq))
			return -EINVAL;
		if (copy_from_user(&mreq, ov, sizeof(mreq)))
			return -EFAULT;
2825 2826 2827 2828 2829
		break;
	default:
		if (ov || ol)
			return -EINVAL;
	}
P
Per Liden 已提交
2830

2831
	lock_sock(sk);
2832

P
Per Liden 已提交
2833 2834
	switch (opt) {
	case TIPC_IMPORTANCE:
2835
		res = tsk_set_importance(tsk, value);
P
Per Liden 已提交
2836 2837 2838
		break;
	case TIPC_SRC_DROPPABLE:
		if (sock->type != SOCK_STREAM)
2839
			tsk_set_unreliable(tsk, value);
2840
		else
P
Per Liden 已提交
2841 2842 2843
			res = -ENOPROTOOPT;
		break;
	case TIPC_DEST_DROPPABLE:
2844
		tsk_set_unreturnable(tsk, value);
P
Per Liden 已提交
2845 2846
		break;
	case TIPC_CONN_TIMEOUT:
2847
		tipc_sk(sk)->conn_timeout = value;
P
Per Liden 已提交
2848
		break;
2849 2850 2851 2852 2853 2854 2855 2856
	case TIPC_MCAST_BROADCAST:
		tsk->mc_method.rcast = false;
		tsk->mc_method.mandatory = true;
		break;
	case TIPC_MCAST_REPLICAST:
		tsk->mc_method.rcast = true;
		tsk->mc_method.mandatory = true;
		break;
J
Jon Maloy 已提交
2857 2858 2859 2860 2861 2862
	case TIPC_GROUP_JOIN:
		res = tipc_sk_join(tsk, &mreq);
		break;
	case TIPC_GROUP_LEAVE:
		res = tipc_sk_leave(tsk);
		break;
P
Per Liden 已提交
2863 2864 2865 2866
	default:
		res = -EINVAL;
	}

2867 2868
	release_sock(sk);

P
Per Liden 已提交
2869 2870 2871 2872
	return res;
}

/**
2873
 * tipc_getsockopt - get socket option
P
Per Liden 已提交
2874 2875 2876 2877 2878
 * @sock: socket structure
 * @lvl: option level
 * @opt: option identifier
 * @ov: receptacle for option value
 * @ol: receptacle for length of option value
2879 2880
 *
 * For stream sockets only, returns 0 length result for all IPPROTO_TCP options
P
Per Liden 已提交
2881
 * (to ease compatibility).
2882
 *
P
Per Liden 已提交
2883 2884
 * Returns 0 on success, errno otherwise
 */
2885 2886
static int tipc_getsockopt(struct socket *sock, int lvl, int opt,
			   char __user *ov, int __user *ol)
P
Per Liden 已提交
2887
{
2888
	struct sock *sk = sock->sk;
2889
	struct tipc_sock *tsk = tipc_sk(sk);
J
Jon Maloy 已提交
2890 2891
	struct tipc_name_seq seq;
	int len, scope;
P
Per Liden 已提交
2892
	u32 value;
2893
	int res;
P
Per Liden 已提交
2894

2895 2896
	if ((lvl == IPPROTO_TCP) && (sock->type == SOCK_STREAM))
		return put_user(0, ol);
P
Per Liden 已提交
2897 2898
	if (lvl != SOL_TIPC)
		return -ENOPROTOOPT;
2899 2900
	res = get_user(len, ol);
	if (res)
2901
		return res;
P
Per Liden 已提交
2902

2903
	lock_sock(sk);
P
Per Liden 已提交
2904 2905 2906

	switch (opt) {
	case TIPC_IMPORTANCE:
2907
		value = tsk_importance(tsk);
P
Per Liden 已提交
2908 2909
		break;
	case TIPC_SRC_DROPPABLE:
2910
		value = tsk_unreliable(tsk);
P
Per Liden 已提交
2911 2912
		break;
	case TIPC_DEST_DROPPABLE:
2913
		value = tsk_unreturnable(tsk);
P
Per Liden 已提交
2914 2915
		break;
	case TIPC_CONN_TIMEOUT:
2916
		value = tsk->conn_timeout;
2917
		/* no need to set "res", since already 0 at this point */
P
Per Liden 已提交
2918
		break;
2919
	case TIPC_NODE_RECVQ_DEPTH:
2920
		value = 0; /* was tipc_queue_size, now obsolete */
2921
		break;
2922
	case TIPC_SOCK_RECVQ_DEPTH:
2923 2924
		value = skb_queue_len(&sk->sk_receive_queue);
		break;
J
Jon Maloy 已提交
2925 2926 2927 2928 2929 2930
	case TIPC_GROUP_JOIN:
		seq.type = 0;
		if (tsk->group)
			tipc_group_self(tsk->group, &seq, &scope);
		value = seq.type;
		break;
P
Per Liden 已提交
2931 2932 2933 2934
	default:
		res = -EINVAL;
	}

2935 2936
	release_sock(sk);

2937 2938
	if (res)
		return res;	/* "get" failed */
P
Per Liden 已提交
2939

2940 2941 2942 2943 2944 2945 2946
	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 已提交
2947 2948
}

2949
static int tipc_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
E
Erik Hugne 已提交
2950
{
2951
	struct sock *sk = sock->sk;
E
Erik Hugne 已提交
2952 2953 2954 2955 2956 2957 2958
	struct tipc_sioc_ln_req lnr;
	void __user *argp = (void __user *)arg;

	switch (cmd) {
	case SIOCGETLINKNAME:
		if (copy_from_user(&lnr, argp, sizeof(lnr)))
			return -EFAULT;
2959 2960
		if (!tipc_node_get_linkname(sock_net(sk),
					    lnr.bearer_id & 0xffff, lnr.peer,
E
Erik Hugne 已提交
2961 2962 2963 2964 2965 2966 2967 2968 2969 2970 2971
					    lnr.linkname, TIPC_MAX_LINK_NAME)) {
			if (copy_to_user(argp, &lnr, sizeof(lnr)))
				return -EFAULT;
			return 0;
		}
		return -EADDRNOTAVAIL;
	default:
		return -ENOIOCTLCMD;
	}
}

2972 2973 2974 2975
static int tipc_socketpair(struct socket *sock1, struct socket *sock2)
{
	struct tipc_sock *tsk2 = tipc_sk(sock2->sk);
	struct tipc_sock *tsk1 = tipc_sk(sock1->sk);
E
Erik Hugne 已提交
2976 2977 2978 2979 2980 2981 2982 2983 2984 2985 2986 2987 2988 2989 2990
	u32 onode = tipc_own_addr(sock_net(sock1->sk));

	tsk1->peer.family = AF_TIPC;
	tsk1->peer.addrtype = TIPC_ADDR_ID;
	tsk1->peer.scope = TIPC_NODE_SCOPE;
	tsk1->peer.addr.id.ref = tsk2->portid;
	tsk1->peer.addr.id.node = onode;
	tsk2->peer.family = AF_TIPC;
	tsk2->peer.addrtype = TIPC_ADDR_ID;
	tsk2->peer.scope = TIPC_NODE_SCOPE;
	tsk2->peer.addr.id.ref = tsk1->portid;
	tsk2->peer.addr.id.node = onode;

	tipc_sk_finish_conn(tsk1, tsk2->portid, onode);
	tipc_sk_finish_conn(tsk2, tsk1->portid, onode);
2991 2992 2993
	return 0;
}

2994 2995
/* Protocol switches for the various types of TIPC sockets */

2996
static const struct proto_ops msg_ops = {
2997
	.owner		= THIS_MODULE,
P
Per Liden 已提交
2998
	.family		= AF_TIPC,
2999 3000 3001
	.release	= tipc_release,
	.bind		= tipc_bind,
	.connect	= tipc_connect,
E
Erik Hugne 已提交
3002
	.socketpair	= tipc_socketpair,
3003
	.accept		= sock_no_accept,
3004 3005
	.getname	= tipc_getname,
	.poll		= tipc_poll,
E
Erik Hugne 已提交
3006
	.ioctl		= tipc_ioctl,
3007
	.listen		= sock_no_listen,
3008 3009 3010 3011 3012
	.shutdown	= tipc_shutdown,
	.setsockopt	= tipc_setsockopt,
	.getsockopt	= tipc_getsockopt,
	.sendmsg	= tipc_sendmsg,
	.recvmsg	= tipc_recvmsg,
3013 3014
	.mmap		= sock_no_mmap,
	.sendpage	= sock_no_sendpage
P
Per Liden 已提交
3015 3016
};

3017
static const struct proto_ops packet_ops = {
3018
	.owner		= THIS_MODULE,
P
Per Liden 已提交
3019
	.family		= AF_TIPC,
3020 3021 3022
	.release	= tipc_release,
	.bind		= tipc_bind,
	.connect	= tipc_connect,
3023
	.socketpair	= tipc_socketpair,
3024 3025 3026
	.accept		= tipc_accept,
	.getname	= tipc_getname,
	.poll		= tipc_poll,
E
Erik Hugne 已提交
3027
	.ioctl		= tipc_ioctl,
3028 3029 3030 3031 3032 3033
	.listen		= tipc_listen,
	.shutdown	= tipc_shutdown,
	.setsockopt	= tipc_setsockopt,
	.getsockopt	= tipc_getsockopt,
	.sendmsg	= tipc_send_packet,
	.recvmsg	= tipc_recvmsg,
3034 3035
	.mmap		= sock_no_mmap,
	.sendpage	= sock_no_sendpage
P
Per Liden 已提交
3036 3037
};

3038
static const struct proto_ops stream_ops = {
3039
	.owner		= THIS_MODULE,
P
Per Liden 已提交
3040
	.family		= AF_TIPC,
3041 3042 3043
	.release	= tipc_release,
	.bind		= tipc_bind,
	.connect	= tipc_connect,
3044
	.socketpair	= tipc_socketpair,
3045 3046 3047
	.accept		= tipc_accept,
	.getname	= tipc_getname,
	.poll		= tipc_poll,
E
Erik Hugne 已提交
3048
	.ioctl		= tipc_ioctl,
3049 3050 3051 3052
	.listen		= tipc_listen,
	.shutdown	= tipc_shutdown,
	.setsockopt	= tipc_setsockopt,
	.getsockopt	= tipc_getsockopt,
3053
	.sendmsg	= tipc_sendstream,
3054
	.recvmsg	= tipc_recvstream,
3055 3056
	.mmap		= sock_no_mmap,
	.sendpage	= sock_no_sendpage
P
Per Liden 已提交
3057 3058
};

3059
static const struct net_proto_family tipc_family_ops = {
3060
	.owner		= THIS_MODULE,
P
Per Liden 已提交
3061
	.family		= AF_TIPC,
3062
	.create		= tipc_sk_create
P
Per Liden 已提交
3063 3064 3065 3066 3067
};

static struct proto tipc_proto = {
	.name		= "TIPC",
	.owner		= THIS_MODULE,
3068 3069
	.obj_size	= sizeof(struct tipc_sock),
	.sysctl_rmem	= sysctl_tipc_rmem
P
Per Liden 已提交
3070 3071 3072
};

/**
3073
 * tipc_socket_init - initialize TIPC socket interface
3074
 *
P
Per Liden 已提交
3075 3076
 * Returns 0 on success, errno otherwise
 */
3077
int tipc_socket_init(void)
P
Per Liden 已提交
3078 3079 3080
{
	int res;

3081
	res = proto_register(&tipc_proto, 1);
P
Per Liden 已提交
3082
	if (res) {
3083
		pr_err("Failed to register TIPC protocol type\n");
P
Per Liden 已提交
3084 3085 3086 3087 3088
		goto out;
	}

	res = sock_register(&tipc_family_ops);
	if (res) {
3089
		pr_err("Failed to register TIPC socket type\n");
P
Per Liden 已提交
3090 3091 3092 3093 3094 3095 3096 3097
		proto_unregister(&tipc_proto);
		goto out;
	}
 out:
	return res;
}

/**
3098
 * tipc_socket_stop - stop TIPC socket interface
P
Per Liden 已提交
3099
 */
3100
void tipc_socket_stop(void)
P
Per Liden 已提交
3101 3102 3103 3104
{
	sock_unregister(tipc_family_ops.family);
	proto_unregister(&tipc_proto);
}
3105 3106

/* Caller should hold socket lock for the passed tipc socket. */
3107
static int __tipc_nl_add_sk_con(struct sk_buff *skb, struct tipc_sock *tsk)
3108 3109 3110 3111 3112 3113 3114 3115 3116 3117 3118 3119 3120 3121 3122 3123 3124 3125 3126 3127 3128 3129 3130 3131 3132 3133 3134 3135 3136 3137 3138 3139 3140 3141
{
	u32 peer_node;
	u32 peer_port;
	struct nlattr *nest;

	peer_node = tsk_peer_node(tsk);
	peer_port = tsk_peer_port(tsk);

	nest = nla_nest_start(skb, TIPC_NLA_SOCK_CON);

	if (nla_put_u32(skb, TIPC_NLA_CON_NODE, peer_node))
		goto msg_full;
	if (nla_put_u32(skb, TIPC_NLA_CON_SOCK, peer_port))
		goto msg_full;

	if (tsk->conn_type != 0) {
		if (nla_put_flag(skb, TIPC_NLA_CON_FLAG))
			goto msg_full;
		if (nla_put_u32(skb, TIPC_NLA_CON_TYPE, tsk->conn_type))
			goto msg_full;
		if (nla_put_u32(skb, TIPC_NLA_CON_INST, tsk->conn_instance))
			goto msg_full;
	}
	nla_nest_end(skb, nest);

	return 0;

msg_full:
	nla_nest_cancel(skb, nest);

	return -EMSGSIZE;
}

/* Caller should hold socket lock for the passed tipc socket. */
3142 3143
static int __tipc_nl_add_sk(struct sk_buff *skb, struct netlink_callback *cb,
			    struct tipc_sock *tsk)
3144 3145 3146 3147
{
	int err;
	void *hdr;
	struct nlattr *attrs;
3148 3149
	struct net *net = sock_net(skb->sk);
	struct tipc_net *tn = net_generic(net, tipc_net_id);
3150
	struct sock *sk = &tsk->sk;
3151 3152

	hdr = genlmsg_put(skb, NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq,
3153
			  &tipc_genl_family, NLM_F_MULTI, TIPC_NL_SOCK_GET);
3154 3155 3156 3157 3158 3159
	if (!hdr)
		goto msg_cancel;

	attrs = nla_nest_start(skb, TIPC_NLA_SOCK);
	if (!attrs)
		goto genlmsg_cancel;
3160
	if (nla_put_u32(skb, TIPC_NLA_SOCK_REF, tsk->portid))
3161
		goto attr_msg_cancel;
3162
	if (nla_put_u32(skb, TIPC_NLA_SOCK_ADDR, tn->own_addr))
3163 3164
		goto attr_msg_cancel;

3165
	if (tipc_sk_connected(sk)) {
3166 3167 3168 3169 3170 3171 3172 3173 3174 3175 3176 3177 3178 3179 3180 3181 3182 3183 3184 3185 3186 3187 3188 3189
		err = __tipc_nl_add_sk_con(skb, tsk);
		if (err)
			goto attr_msg_cancel;
	} else if (!list_empty(&tsk->publications)) {
		if (nla_put_flag(skb, TIPC_NLA_SOCK_HAS_PUBL))
			goto attr_msg_cancel;
	}
	nla_nest_end(skb, attrs);
	genlmsg_end(skb, hdr);

	return 0;

attr_msg_cancel:
	nla_nest_cancel(skb, attrs);
genlmsg_cancel:
	genlmsg_cancel(skb, hdr);
msg_cancel:
	return -EMSGSIZE;
}

int tipc_nl_sk_dump(struct sk_buff *skb, struct netlink_callback *cb)
{
	int err;
	struct tipc_sock *tsk;
3190 3191
	const struct bucket_table *tbl;
	struct rhash_head *pos;
3192 3193
	struct net *net = sock_net(skb->sk);
	struct tipc_net *tn = net_generic(net, tipc_net_id);
3194 3195
	u32 tbl_id = cb->args[0];
	u32 prev_portid = cb->args[1];
3196

3197
	rcu_read_lock();
3198
	tbl = rht_dereference_rcu((&tn->sk_rht)->tbl, &tn->sk_rht);
3199 3200
	for (; tbl_id < tbl->size; tbl_id++) {
		rht_for_each_entry_rcu(tsk, pos, tbl, tbl_id, node) {
3201
			spin_lock_bh(&tsk->sk.sk_lock.slock);
3202 3203 3204 3205 3206
			if (prev_portid && prev_portid != tsk->portid) {
				spin_unlock_bh(&tsk->sk.sk_lock.slock);
				continue;
			}

3207
			err = __tipc_nl_add_sk(skb, cb, tsk);
3208 3209 3210 3211 3212 3213
			if (err) {
				prev_portid = tsk->portid;
				spin_unlock_bh(&tsk->sk.sk_lock.slock);
				goto out;
			}
			prev_portid = 0;
3214 3215
			spin_unlock_bh(&tsk->sk.sk_lock.slock);
		}
3216
	}
3217
out:
3218
	rcu_read_unlock();
3219 3220
	cb->args[0] = tbl_id;
	cb->args[1] = prev_portid;
3221 3222 3223

	return skb->len;
}
3224 3225

/* Caller should hold socket lock for the passed tipc socket. */
3226 3227 3228
static int __tipc_nl_add_sk_publ(struct sk_buff *skb,
				 struct netlink_callback *cb,
				 struct publication *publ)
3229 3230 3231 3232 3233
{
	void *hdr;
	struct nlattr *attrs;

	hdr = genlmsg_put(skb, NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq,
3234
			  &tipc_genl_family, NLM_F_MULTI, TIPC_NL_PUBL_GET);
3235 3236 3237 3238 3239 3240 3241 3242 3243 3244 3245 3246 3247 3248 3249 3250 3251 3252 3253 3254 3255 3256 3257 3258 3259 3260 3261 3262 3263 3264
	if (!hdr)
		goto msg_cancel;

	attrs = nla_nest_start(skb, TIPC_NLA_PUBL);
	if (!attrs)
		goto genlmsg_cancel;

	if (nla_put_u32(skb, TIPC_NLA_PUBL_KEY, publ->key))
		goto attr_msg_cancel;
	if (nla_put_u32(skb, TIPC_NLA_PUBL_TYPE, publ->type))
		goto attr_msg_cancel;
	if (nla_put_u32(skb, TIPC_NLA_PUBL_LOWER, publ->lower))
		goto attr_msg_cancel;
	if (nla_put_u32(skb, TIPC_NLA_PUBL_UPPER, publ->upper))
		goto attr_msg_cancel;

	nla_nest_end(skb, attrs);
	genlmsg_end(skb, hdr);

	return 0;

attr_msg_cancel:
	nla_nest_cancel(skb, attrs);
genlmsg_cancel:
	genlmsg_cancel(skb, hdr);
msg_cancel:
	return -EMSGSIZE;
}

/* Caller should hold socket lock for the passed tipc socket. */
3265 3266 3267
static int __tipc_nl_list_sk_publ(struct sk_buff *skb,
				  struct netlink_callback *cb,
				  struct tipc_sock *tsk, u32 *last_publ)
3268 3269 3270 3271 3272 3273 3274 3275 3276 3277 3278 3279 3280 3281 3282 3283 3284 3285 3286 3287 3288 3289 3290 3291 3292 3293 3294 3295 3296 3297 3298 3299 3300 3301 3302 3303 3304 3305 3306 3307
{
	int err;
	struct publication *p;

	if (*last_publ) {
		list_for_each_entry(p, &tsk->publications, pport_list) {
			if (p->key == *last_publ)
				break;
		}
		if (p->key != *last_publ) {
			/* We never set seq or call nl_dump_check_consistent()
			 * this means that setting prev_seq here will cause the
			 * consistence check to fail in the netlink callback
			 * handler. Resulting in the last NLMSG_DONE message
			 * having the NLM_F_DUMP_INTR flag set.
			 */
			cb->prev_seq = 1;
			*last_publ = 0;
			return -EPIPE;
		}
	} else {
		p = list_first_entry(&tsk->publications, struct publication,
				     pport_list);
	}

	list_for_each_entry_from(p, &tsk->publications, pport_list) {
		err = __tipc_nl_add_sk_publ(skb, cb, p);
		if (err) {
			*last_publ = p->key;
			return err;
		}
	}
	*last_publ = 0;

	return 0;
}

int tipc_nl_publ_dump(struct sk_buff *skb, struct netlink_callback *cb)
{
	int err;
3308
	u32 tsk_portid = cb->args[0];
3309 3310
	u32 last_publ = cb->args[1];
	u32 done = cb->args[2];
3311
	struct net *net = sock_net(skb->sk);
3312 3313
	struct tipc_sock *tsk;

3314
	if (!tsk_portid) {
3315 3316 3317 3318 3319 3320 3321
		struct nlattr **attrs;
		struct nlattr *sock[TIPC_NLA_SOCK_MAX + 1];

		err = tipc_nlmsg_parse(cb->nlh, &attrs);
		if (err)
			return err;

3322 3323 3324
		if (!attrs[TIPC_NLA_SOCK])
			return -EINVAL;

3325 3326
		err = nla_parse_nested(sock, TIPC_NLA_SOCK_MAX,
				       attrs[TIPC_NLA_SOCK],
3327
				       tipc_nl_sock_policy, NULL);
3328 3329 3330 3331 3332 3333
		if (err)
			return err;

		if (!sock[TIPC_NLA_SOCK_REF])
			return -EINVAL;

3334
		tsk_portid = nla_get_u32(sock[TIPC_NLA_SOCK_REF]);
3335 3336 3337 3338 3339
	}

	if (done)
		return 0;

3340
	tsk = tipc_sk_lookup(net, tsk_portid);
3341 3342 3343 3344 3345 3346 3347 3348
	if (!tsk)
		return -EINVAL;

	lock_sock(&tsk->sk);
	err = __tipc_nl_list_sk_publ(skb, cb, tsk, &last_publ);
	if (!err)
		done = 1;
	release_sock(&tsk->sk);
3349
	sock_put(&tsk->sk);
3350

3351
	cb->args[0] = tsk_portid;
3352 3353 3354 3355 3356
	cb->args[1] = last_publ;
	cb->args[2] = done;

	return skb->len;
}