socket.c 86.4 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
	bool group_is_open;
120
};
P
Per Liden 已提交
121

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

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

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

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

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

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

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

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

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

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

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

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

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

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

210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227
/* 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;
228 229
}

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

240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255
/* 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 已提交
256
/**
257
 * tsk_rej_rx_queue - reject all buffers in socket receive queue
258 259
 *
 * Caller must hold socket lock
P
Per Liden 已提交
260
 */
261
static void tsk_rej_rx_queue(struct sock *sk)
P
Per Liden 已提交
262
{
263
	struct sk_buff *skb;
264

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

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

274 275 276 277 278 279 280 281 282 283
/* 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;
}

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

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

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

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

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

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

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

	return false;
}

318 319 320 321 322 323 324 325 326
/* 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)
{
327
	int oldsk_state = sk->sk_state;
328 329 330
	int res = -EINVAL;

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

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

	return res;
}

357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378
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;
}

379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397
#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_;								       \
398 399
})

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

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

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

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

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

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

	/* 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);

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

479 480 481 482
	/* 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;

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

P
Per Liden 已提交
489 490 491
	return 0;
}

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

	sock_put(&tsk->sk);
}

499 500 501 502 503 504
/* 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);
505
	long timeout = CONN_TIMEOUT_DEFAULT;
506 507 508
	u32 dnode = tsk_peer_node(tsk);
	struct sk_buff *skb;

509 510 511 512
	/* 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)));

513 514 515 516 517 518
	/* 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);
519
			continue;
520
		}
521 522 523 524 525 526
		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);
527
	}
528 529 530 531

	if (tipc_sk_type_connectionless(sk))
		return;

532 533 534 535 536 537 538
	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);
539 540
		tipc_node_remove_conn(net, dnode, tsk->portid);
		tipc_set_sk_state(sk, TIPC_DISCONNECTING);
541 542 543
	}
}

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

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

572
	tsk = tipc_sk(sk);
573 574
	lock_sock(sk);

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

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

589
	return 0;
P
Per Liden 已提交
590 591 592
}

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

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

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

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

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

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

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

	addr->addrtype = TIPC_ADDR_ID;
	addr->family = AF_TIPC;
	addr->scope = 0;
	addr->addr.name.domain = 0;

693
	return sizeof(*addr);
P
Per Liden 已提交
694 695 696
}

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

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

723
	if (sk->sk_shutdown & RCV_SHUTDOWN)
724
		revents |= EPOLLRDHUP | EPOLLIN | EPOLLRDNORM;
725
	if (sk->sk_shutdown == SHUTDOWN_MASK)
726
		revents |= EPOLLHUP;
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 |= EPOLLOUT;
733 734
		/* fall thru' */
	case TIPC_LISTEN:
J
Jon Maloy 已提交
735
		if (!skb_queue_empty(&sk->sk_receive_queue))
736
			revents |= EPOLLIN | EPOLLRDNORM;
737 738
		break;
	case TIPC_OPEN:
739
		if (tsk->group_is_open && !tsk->cong_link_cnt)
740
			revents |= EPOLLOUT;
741 742
		if (!tipc_sk_type_connectionless(sk))
			break;
J
Jon Maloy 已提交
743
		if (skb_queue_empty(&sk->sk_receive_queue))
744
			break;
745
		revents |= EPOLLIN | EPOLLRDNORM;
746 747
		break;
	case TIPC_DISCONNECTING:
748
		revents = EPOLLIN | EPOLLRDNORM | EPOLLHUP;
749
		break;
750
	}
751
	return revents;
P
Per Liden 已提交
752 753
}

754 755 756 757
/**
 * tipc_sendmcast - send multicast message
 * @sock: socket structure
 * @seq: destination address
758
 * @msg: message to send
759 760
 * @dlen: length of data to send
 * @timeout: timeout to wait for wakeup
761 762 763 764 765
 *
 * 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,
766
			  struct msghdr *msg, size_t dlen, long timeout)
767 768
{
	struct sock *sk = sock->sk;
769
	struct tipc_sock *tsk = tipc_sk(sk);
770
	struct tipc_msg *hdr = &tsk->phdr;
771
	struct net *net = sock_net(sk);
772
	int mtu = tipc_bcast_get_mtu(net);
773
	struct tipc_mc_method *method = &tsk->mc_method;
774
	struct sk_buff_head pkts;
775
	struct tipc_nlist dsts;
776 777
	int rc;

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

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

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

	/* Build message header */
794
	msg_set_type(hdr, TIPC_MCAST_MSG);
795
	msg_set_hdr_sz(hdr, MCAST_H_SIZE);
796 797 798 799 800 801 802
	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);

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

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

	tipc_nlist_purge(&dsts);
813 814

	return rc ? rc : dlen;
815 816
}

817 818 819 820 821 822 823 824 825 826 827 828 829
/**
 * 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)
{
830
	u16 bc_snd_nxt = tipc_group_bc_snd_nxt(tsk->group);
831
	struct tipc_mc_method *method = &tsk->mc_method;
832 833 834 835 836 837 838 839 840 841
	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);
842
	msg_set_grp_bc_seqno(hdr, bc_snd_nxt);
843 844 845 846 847 848 849 850 851 852 853 854 855 856 857

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

858
	/* Update send window */
859 860
	tipc_group_update_member(mb, blks);

861 862 863
	/* A broadcast sent within next EXPIRE period must follow same path */
	method->rcast = true;
	method->mandatory = true;
864 865 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
	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;
}

910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928
/**
 * 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;
929
	struct tipc_msg *hdr = &tsk->phdr;
930 931 932 933 934
	struct tipc_member *first = NULL;
	struct tipc_member *mbr = NULL;
	struct net *net = sock_net(sk);
	u32 node, port, exclude;
	struct list_head dsts;
935
	u32 type, inst, scope;
936 937 938 939 940 941
	int lookups = 0;
	int dstcnt, rc;
	bool cong;

	INIT_LIST_HEAD(&dsts);

942
	type = msg_nametype(hdr);
943
	inst = dest->addr.name.name.instance;
944
	scope = msg_lookup_scope(hdr);
945 946 947 948 949 950 951
	exclude = tipc_group_exclude(grp);

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

		/* Look for a non-congested destination member, if any */
		while (1) {
952
			if (!tipc_nametbl_lookup(net, type, inst, scope, &dsts,
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
						 &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 已提交
993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005
/**
 * 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)
{
1006
	DECLARE_SOCKADDR(struct sockaddr_tipc *, dest, m->msg_name);
J
Jon Maloy 已提交
1007 1008 1009 1010 1011 1012
	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;
1013
	bool ack = method->mandatory && method->rcast;
1014
	int blks = tsk_blocks(MCAST_H_SIZE + dlen);
J
Jon Maloy 已提交
1015 1016 1017 1018 1019 1020 1021 1022
	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;

1023 1024 1025
	/* 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 已提交
1026 1027 1028 1029
	if (unlikely(rc))
		return rc;

	/* Complete message header */
1030 1031 1032 1033 1034 1035 1036
	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);
	}
1037
	msg_set_hdr_sz(hdr, GROUP_H_SIZE);
J
Jon Maloy 已提交
1038 1039 1040 1041
	msg_set_destport(hdr, 0);
	msg_set_destnode(hdr, 0);
	msg_set_grp_bc_seqno(hdr, tipc_group_bc_snd_nxt(grp));

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

J
Jon Maloy 已提交
1045 1046 1047 1048 1049 1050 1051
	/* 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 */
1052
	rc = tipc_mcast_xmit(net, &pkts, method, dsts, &tsk->cong_link_cnt);
J
Jon Maloy 已提交
1053 1054 1055
	if (unlikely(rc))
		return rc;

1056
	/* Update broadcast sequence number and send windows */
1057 1058 1059 1060 1061 1062
	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 已提交
1063 1064 1065
	return dlen;
}

1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082
/**
 * 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_sock *tsk = tipc_sk(sk);
	struct tipc_group *grp = tsk->group;
1083
	struct tipc_msg *hdr = &tsk->phdr;
1084
	struct net *net = sock_net(sk);
1085
	u32 type, inst, scope, exclude;
1086
	struct list_head dsts;
1087
	u32 dstcnt;
1088 1089 1090

	INIT_LIST_HEAD(&dsts);

1091 1092 1093
	type = msg_nametype(hdr);
	inst = dest->addr.name.name.instance;
	scope = msg_lookup_scope(hdr);
1094
	exclude = tipc_group_exclude(grp);
1095 1096 1097

	if (!tipc_nametbl_lookup(net, type, inst, scope, &dsts,
				 &dstcnt, exclude, true))
1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108
		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
{
J
Jon Maloy 已提交
1119
	u32 self = tipc_own_addr(net);
1120
	u32 type, lower, upper, scope;
1121
	struct sk_buff *skb, *_skb;
J
Jon Maloy 已提交
1122
	u32 portid, oport, onode;
1123
	struct sk_buff_head tmpq;
J
Jon Maloy 已提交
1124
	struct list_head dports;
1125 1126 1127
	struct tipc_msg *hdr;
	int user, mtyp, hlen;
	bool exact;
1128

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

1132 1133
	skb = tipc_skb_peek(arrvq, &inputq->lock);
	for (; skb; skb = tipc_skb_peek(arrvq, &inputq->lock)) {
1134 1135 1136 1137 1138 1139 1140 1141
		hdr = buf_msg(skb);
		user = msg_user(hdr);
		mtyp = msg_type(hdr);
		hlen = skb_headroom(skb) + msg_hdr_sz(hdr);
		oport = msg_origport(hdr);
		onode = msg_orignode(hdr);
		type = msg_nametype(hdr);

1142 1143 1144 1145 1146 1147
		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 已提交
1148
			kfree_skb(skb);
1149 1150 1151
			spin_unlock_bh(&inputq->lock);
			continue;
		}
1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167

		/* Group messages require exact scope match */
		if (msg_in_group(hdr)) {
			lower = 0;
			upper = ~0;
			scope = msg_lookup_scope(hdr);
			exact = true;
		} else {
			/* TIPC_NODE_SCOPE means "any scope" in this context */
			if (onode == self)
				scope = TIPC_NODE_SCOPE;
			else
				scope = TIPC_CLUSTER_SCOPE;
			exact = false;
			lower = msg_namelower(hdr);
			upper = msg_nameupper(hdr);
J
Jon Maloy 已提交
1168
		}
1169 1170 1171 1172 1173 1174

		/* Create destination port list: */
		tipc_nametbl_mc_lookup(net, type, lower, upper,
				       scope, exact, &dports);

		/* Clone message per destination */
J
Jon Maloy 已提交
1175
		while (tipc_dest_pop(&dports, NULL, &portid)) {
1176
			_skb = __pskb_copy(skb, hlen, GFP_ATOMIC);
1177 1178 1179 1180 1181 1182
			if (_skb) {
				msg_set_destport(buf_msg(_skb), portid);
				__skb_queue_tail(&tmpq, _skb);
				continue;
			}
			pr_warn("Failed to clone mcast rcv buffer\n");
1183
		}
1184 1185 1186 1187 1188 1189 1190 1191 1192
		/* 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);
1193
	}
1194
	tipc_sk_rcv(net, inputq);
1195 1196
}

1197
/**
J
Jon Maloy 已提交
1198
 * tipc_sk_conn_proto_rcv - receive a connection mng protocol message
1199
 * @tsk: receiving socket
1200
 * @skb: pointer to message buffer.
1201
 */
J
Jon Maloy 已提交
1202 1203
static void tipc_sk_conn_proto_rcv(struct tipc_sock *tsk, struct sk_buff *skb,
				   struct sk_buff_head *xmitq)
1204
{
1205
	struct tipc_msg *hdr = buf_msg(skb);
J
Jon Maloy 已提交
1206 1207
	u32 onode = tsk_own_node(tsk);
	struct sock *sk = &tsk->sk;
1208
	int mtyp = msg_type(hdr);
1209
	bool conn_cong;
1210

1211
	/* Ignore if connection cannot be validated: */
1212
	if (!tsk_peer_msg(tsk, hdr))
1213 1214
		goto exit;

1215 1216 1217 1218 1219 1220 1221 1222
	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;
	}

1223
	tsk->probe_unacked = false;
1224

1225 1226
	if (mtyp == CONN_PROBE) {
		msg_set_type(hdr, CONN_PROBE_REPLY);
J
Jon Paul Maloy 已提交
1227 1228
		if (tipc_msg_reverse(onode, &skb, TIPC_OK))
			__skb_queue_tail(xmitq, skb);
1229 1230
		return;
	} else if (mtyp == CONN_ACK) {
1231
		conn_cong = tsk_conn_cong(tsk);
1232 1233 1234
		tsk->snt_unacked -= msg_conn_ack(hdr);
		if (tsk->peer_caps & TIPC_BLOCK_FLOWCTL)
			tsk->snd_win = msg_adv_win(hdr);
1235
		if (conn_cong)
1236 1237 1238
			sk->sk_write_space(sk);
	} else if (mtyp != CONN_PROBE_REPLY) {
		pr_warn("Received unknown CONN_PROTO msg\n");
1239 1240
	}
exit:
1241
	kfree_skb(skb);
1242 1243
}

P
Per Liden 已提交
1244
/**
1245
 * tipc_sendmsg - send message in connectionless manner
P
Per Liden 已提交
1246 1247
 * @sock: socket structure
 * @m: message to send
1248
 * @dsz: amount of user data to be sent
1249
 *
P
Per Liden 已提交
1250
 * Message must have an destination specified explicitly.
1251
 * Used for SOCK_RDM and SOCK_DGRAM messages,
P
Per Liden 已提交
1252 1253
 * and for 'SYN' messages on SOCK_SEQPACKET and SOCK_STREAM connections.
 * (Note: 'SYN+' is prohibited on SOCK_STREAM.)
1254
 *
P
Per Liden 已提交
1255 1256
 * Returns the number of bytes sent on success, or errno otherwise
 */
1257
static int tipc_sendmsg(struct socket *sock,
1258
			struct msghdr *m, size_t dsz)
1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269
{
	struct sock *sk = sock->sk;
	int ret;

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

	return ret;
}

1270
static int __tipc_sendmsg(struct socket *sock, struct msghdr *m, size_t dlen)
P
Per Liden 已提交
1271
{
1272
	struct sock *sk = sock->sk;
1273
	struct net *net = sock_net(sk);
1274 1275 1276 1277 1278
	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 已提交
1279
	struct tipc_group *grp = tsk->group;
1280
	struct tipc_msg *hdr = &tsk->phdr;
1281
	struct tipc_name_seq *seq;
1282 1283
	struct sk_buff_head pkts;
	u32 dnode, dport;
J
Jon Maloy 已提交
1284
	u32 type, inst;
1285
	int mtu, rc;
P
Per Liden 已提交
1286

1287
	if (unlikely(dlen > TIPC_MAX_USER_MSG_SIZE))
1288
		return -EMSGSIZE;
1289

1290 1291 1292 1293 1294 1295 1296 1297 1298 1299
	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);
1300 1301
		if (dest->addrtype == TIPC_ADDR_NAME)
			return tipc_send_group_anycast(sock, m, dlen, timeout);
1302 1303
		if (dest->addrtype == TIPC_ADDR_ID)
			return tipc_send_group_unicast(sock, m, dlen, timeout);
1304 1305
		if (dest->addrtype == TIPC_ADDR_MCAST)
			return tipc_send_group_mcast(sock, m, dlen, timeout);
1306 1307
		return -EINVAL;
	}
J
Jon Maloy 已提交
1308

1309
	if (unlikely(!dest)) {
1310 1311
		dest = &tsk->peer;
		if (!syn || dest->family != AF_TIPC)
1312 1313
			return -EDESTADDRREQ;
	}
1314 1315

	if (unlikely(syn)) {
1316
		if (sk->sk_state == TIPC_LISTEN)
1317
			return -EPIPE;
1318
		if (sk->sk_state != TIPC_OPEN)
1319 1320 1321
			return -EISCONN;
		if (tsk->published)
			return -EOPNOTSUPP;
1322
		if (dest->addrtype == TIPC_ADDR_NAME) {
1323 1324
			tsk->conn_type = dest->addr.name.name.type;
			tsk->conn_instance = dest->addr.name.name.instance;
1325
		}
P
Per Liden 已提交
1326
	}
1327

1328 1329 1330
	seq = &dest->addr.nameseq;
	if (dest->addrtype == TIPC_ADDR_MCAST)
		return tipc_sendmcast(sock, seq, m, dlen, timeout);
1331

1332 1333 1334
	if (dest->addrtype == TIPC_ADDR_NAME) {
		type = dest->addr.name.name.type;
		inst = dest->addr.name.name.instance;
J
Jon Maloy 已提交
1335
		dnode = dest->addr.name.domain;
1336 1337 1338 1339
		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);
J
Jon Maloy 已提交
1340
		msg_set_lookup_scope(hdr, tipc_node2scope(dnode));
1341
		dport = tipc_nametbl_translate(net, type, inst, &dnode);
1342 1343
		msg_set_destnode(hdr, dnode);
		msg_set_destport(hdr, dport);
1344 1345
		if (unlikely(!dport && !dnode))
			return -EHOSTUNREACH;
1346 1347
	} else if (dest->addrtype == TIPC_ADDR_ID) {
		dnode = dest->addr.id.node;
1348 1349 1350 1351 1352
		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);
1353 1354
	}

1355
	/* Block or return if destination link is congested */
J
Jon Maloy 已提交
1356 1357
	rc = tipc_wait_for_cond(sock, &timeout,
				!tipc_dest_find(clinks, dnode, 0));
1358 1359 1360 1361
	if (unlikely(rc))
		return rc;

	skb_queue_head_init(&pkts);
1362
	mtu = tipc_node_get_mtu(net, dnode, tsk->portid);
1363 1364
	rc = tipc_msg_build(hdr, m, 0, dlen, mtu, &pkts);
	if (unlikely(rc != dlen))
1365
		return rc;
1366

1367 1368
	rc = tipc_node_xmit(net, &pkts, dnode, tsk->portid);
	if (unlikely(rc == -ELINKCONG)) {
J
Jon Maloy 已提交
1369
		tipc_dest_push(clinks, dnode, 0);
1370 1371 1372
		tsk->cong_link_cnt++;
		rc = 0;
	}
1373

1374 1375 1376 1377
	if (unlikely(syn && !rc))
		tipc_set_sk_state(sk, TIPC_CONNECTING);

	return rc ? rc : dlen;
P
Per Liden 已提交
1378 1379
}

1380
/**
1381
 * tipc_sendstream - send stream-oriented data
P
Per Liden 已提交
1382
 * @sock: socket structure
1383 1384
 * @m: data to send
 * @dsz: total length of data to be transmitted
1385
 *
1386
 * Used for SOCK_STREAM data.
1387
 *
1388 1389
 * Returns the number of bytes sent on success (or partial success),
 * or errno if no data sent
P
Per Liden 已提交
1390
 */
1391
static int tipc_sendstream(struct socket *sock, struct msghdr *m, size_t dsz)
1392 1393 1394 1395 1396
{
	struct sock *sk = sock->sk;
	int ret;

	lock_sock(sk);
1397
	ret = __tipc_sendstream(sock, m, dsz);
1398 1399 1400 1401 1402
	release_sock(sk);

	return ret;
}

1403
static int __tipc_sendstream(struct socket *sock, struct msghdr *m, size_t dlen)
P
Per Liden 已提交
1404
{
1405
	struct sock *sk = sock->sk;
1406
	DECLARE_SOCKADDR(struct sockaddr_tipc *, dest, m->msg_name);
1407 1408 1409 1410 1411 1412 1413 1414
	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;
1415

1416
	skb_queue_head_init(&pkts);
1417

1418 1419
	if (unlikely(dlen > INT_MAX))
		return -EMSGSIZE;
1420

1421 1422 1423 1424 1425
	/* 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));
1426
		return rc;
1427
	}
1428

1429
	do {
1430 1431
		rc = tipc_wait_for_cond(sock, &timeout,
					(!tsk->cong_link_cnt &&
1432 1433
					 !tsk_conn_cong(tsk) &&
					 tipc_sk_connected(sk)));
1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451
		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);
1452

1453
	return sent ? sent : rc;
P
Per Liden 已提交
1454 1455
}

1456
/**
1457
 * tipc_send_packet - send a connection-oriented message
P
Per Liden 已提交
1458
 * @sock: socket structure
1459 1460
 * @m: message to send
 * @dsz: length of data to be transmitted
1461
 *
1462
 * Used for SOCK_SEQPACKET messages.
1463
 *
1464
 * Returns the number of bytes sent on success, or errno otherwise
P
Per Liden 已提交
1465
 */
1466
static int tipc_send_packet(struct socket *sock, struct msghdr *m, size_t dsz)
P
Per Liden 已提交
1467
{
1468 1469
	if (dsz > TIPC_MAX_USER_MSG_SIZE)
		return -EMSGSIZE;
P
Per Liden 已提交
1470

1471
	return tipc_sendstream(sock, m, dsz);
P
Per Liden 已提交
1472 1473
}

1474
/* tipc_sk_finish_conn - complete the setup of a connection
P
Per Liden 已提交
1475
 */
1476
static void tipc_sk_finish_conn(struct tipc_sock *tsk, u32 peer_port,
1477
				u32 peer_node)
P
Per Liden 已提交
1478
{
1479 1480
	struct sock *sk = &tsk->sk;
	struct net *net = sock_net(sk);
1481
	struct tipc_msg *msg = &tsk->phdr;
P
Per Liden 已提交
1482

1483 1484 1485 1486 1487
	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);
1488

1489
	sk_reset_timer(sk, &sk->sk_timer, jiffies + CONN_PROBING_INTV);
1490
	tipc_set_sk_state(sk, TIPC_ESTABLISHED);
1491 1492
	tipc_node_add_conn(net, peer_node, tsk->portid, peer_port);
	tsk->max_pkt = tipc_node_get_mtu(net, peer_node, tsk->portid);
1493
	tsk->peer_caps = tipc_node_get_capabilities(net, peer_node);
1494 1495 1496 1497 1498 1499
	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 已提交
1500 1501 1502
}

/**
1503
 * tipc_sk_set_orig_addr - capture sender's address for received message
P
Per Liden 已提交
1504
 * @m: descriptor for message info
1505
 * @hdr: received message header
1506
 *
P
Per Liden 已提交
1507 1508
 * Note: Address is not captured if not requested by receiver.
 */
1509
static void tipc_sk_set_orig_addr(struct msghdr *m, struct sk_buff *skb)
P
Per Liden 已提交
1510
{
1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534
	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 已提交
1535 1536 1537
}

/**
1538
 * tipc_sk_anc_data_recv - optionally capture ancillary data for received message
P
Per Liden 已提交
1539 1540
 * @m: descriptor for message info
 * @msg: received message header
1541
 * @tsk: TIPC port associated with message
1542
 *
P
Per Liden 已提交
1543
 * Note: Ancillary data is not captured if not requested by receiver.
1544
 *
P
Per Liden 已提交
1545 1546
 * Returns 0 if successful, otherwise errno
 */
1547 1548
static int tipc_sk_anc_data_recv(struct msghdr *m, struct tipc_msg *msg,
				 struct tipc_sock *tsk)
P
Per Liden 已提交
1549 1550 1551 1552
{
	u32 anc_data[3];
	u32 err;
	u32 dest_type;
1553
	int has_name;
P
Per Liden 已提交
1554 1555 1556 1557 1558 1559 1560 1561 1562 1563
	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);
1564 1565
		res = put_cmsg(m, SOL_TIPC, TIPC_ERRINFO, 8, anc_data);
		if (res)
P
Per Liden 已提交
1566
			return res;
1567 1568 1569 1570 1571 1572
		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 已提交
1573 1574 1575 1576 1577 1578
	}

	/* Optionally capture message destination object */
	dest_type = msg ? msg_type(msg) : TIPC_DIRECT_MSG;
	switch (dest_type) {
	case TIPC_NAMED_MSG:
1579
		has_name = 1;
P
Per Liden 已提交
1580 1581 1582 1583 1584
		anc_data[0] = msg_nametype(msg);
		anc_data[1] = msg_namelower(msg);
		anc_data[2] = msg_namelower(msg);
		break;
	case TIPC_MCAST_MSG:
1585
		has_name = 1;
P
Per Liden 已提交
1586 1587 1588 1589 1590
		anc_data[0] = msg_nametype(msg);
		anc_data[1] = msg_namelower(msg);
		anc_data[2] = msg_nameupper(msg);
		break;
	case TIPC_CONN_MSG:
1591 1592 1593 1594
		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 已提交
1595 1596
		break;
	default:
1597
		has_name = 0;
P
Per Liden 已提交
1598
	}
1599 1600 1601 1602 1603
	if (has_name) {
		res = put_cmsg(m, SOL_TIPC, TIPC_DESTNAME, 12, anc_data);
		if (res)
			return res;
	}
P
Per Liden 已提交
1604 1605 1606 1607

	return 0;
}

1608
static void tipc_sk_send_ack(struct tipc_sock *tsk)
1609
{
1610 1611
	struct sock *sk = &tsk->sk;
	struct net *net = sock_net(sk);
1612
	struct sk_buff *skb = NULL;
1613
	struct tipc_msg *msg;
1614 1615
	u32 peer_port = tsk_peer_port(tsk);
	u32 dnode = tsk_peer_node(tsk);
1616

1617
	if (!tipc_sk_connected(sk))
1618
		return;
1619 1620 1621
	skb = tipc_msg_create(CONN_MANAGER, CONN_ACK, INT_H_SIZE, 0,
			      dnode, tsk_own_node(tsk), peer_port,
			      tsk->portid, TIPC_OK);
1622
	if (!skb)
1623
		return;
1624
	msg = buf_msg(skb);
1625 1626 1627 1628 1629 1630 1631 1632
	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);
	}
1633
	tipc_node_xmit_skb(net, skb, dnode, msg_link_selector(msg));
1634 1635
}

1636
static int tipc_wait_for_rcvmsg(struct socket *sock, long *timeop)
Y
Ying Xue 已提交
1637 1638 1639
{
	struct sock *sk = sock->sk;
	DEFINE_WAIT(wait);
1640
	long timeo = *timeop;
1641 1642 1643 1644
	int err = sock_error(sk);

	if (err)
		return err;
Y
Ying Xue 已提交
1645 1646 1647

	for (;;) {
		prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
1648
		if (timeo && skb_queue_empty(&sk->sk_receive_queue)) {
1649
			if (sk->sk_shutdown & RCV_SHUTDOWN) {
Y
Ying Xue 已提交
1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662
				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;
1663 1664 1665
		err = sock_intr_errno(timeo);
		if (signal_pending(current))
			break;
1666 1667 1668 1669

		err = sock_error(sk);
		if (err)
			break;
Y
Ying Xue 已提交
1670 1671
	}
	finish_wait(sk_sleep(sk), &wait);
1672
	*timeop = timeo;
Y
Ying Xue 已提交
1673 1674 1675
	return err;
}

1676
/**
1677
 * tipc_recvmsg - receive packet-oriented message
P
Per Liden 已提交
1678
 * @m: descriptor for message info
1679
 * @buflen: length of user buffer area
P
Per Liden 已提交
1680
 * @flags: receive flags
1681
 *
P
Per Liden 已提交
1682 1683 1684 1685 1686
 * 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
 */
1687 1688
static int tipc_recvmsg(struct socket *sock, struct msghdr *m,
			size_t buflen,	int flags)
P
Per Liden 已提交
1689
{
1690
	struct sock *sk = sock->sk;
1691
	bool connected = !tipc_sk_type_connectionless(sk);
1692
	struct tipc_sock *tsk = tipc_sk(sk);
1693
	int rc, err, hlen, dlen, copy;
1694
	struct sk_buff_head xmitq;
1695 1696 1697
	struct tipc_msg *hdr;
	struct sk_buff *skb;
	bool grp_evt;
1698
	long timeout;
P
Per Liden 已提交
1699

1700
	/* Catch invalid receive requests */
1701
	if (unlikely(!buflen))
P
Per Liden 已提交
1702 1703
		return -EINVAL;

1704
	lock_sock(sk);
1705 1706
	if (unlikely(connected && sk->sk_state == TIPC_OPEN)) {
		rc = -ENOTCONN;
P
Per Liden 已提交
1707 1708
		goto exit;
	}
1709
	timeout = sock_rcvtimeo(sk, flags & MSG_DONTWAIT);
P
Per Liden 已提交
1710

1711
	/* Step rcv queue to first msg with data or error; wait if necessary */
1712 1713 1714 1715 1716 1717 1718 1719 1720
	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);
1721
		grp_evt = msg_is_grp_evt(hdr);
1722 1723
		if (likely(dlen || err))
			break;
1724
		tsk_advance_rx_queue(sk);
1725
	} while (1);
P
Per Liden 已提交
1726

1727
	/* Collect msg meta data, including error code and rejected data */
1728
	tipc_sk_set_orig_addr(m, skb);
1729 1730
	rc = tipc_sk_anc_data_recv(m, hdr, tsk);
	if (unlikely(rc))
P
Per Liden 已提交
1731 1732
		goto exit;

1733 1734 1735 1736
	/* 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 已提交
1737
			m->msg_flags |= MSG_TRUNC;
1738
		rc = skb_copy_datagram_msg(skb, hlen, m, copy);
P
Per Liden 已提交
1739
	} else {
1740 1741 1742 1743
		copy = 0;
		rc = 0;
		if (err != TIPC_CONN_SHUTDOWN && connected && !m->msg_control)
			rc = -ECONNRESET;
P
Per Liden 已提交
1744
	}
1745 1746
	if (unlikely(rc))
		goto exit;
P
Per Liden 已提交
1747

1748 1749 1750 1751 1752 1753 1754 1755
	/* 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;
	}

1756
	/* Caption of data or error code/rejected data was successful */
1757 1758 1759
	if (unlikely(flags & MSG_PEEK))
		goto exit;

1760 1761 1762 1763 1764 1765 1766 1767 1768
	/* 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);
	}

1769
	tsk_advance_rx_queue(sk);
1770

1771 1772 1773
	if (likely(!connected))
		goto exit;

1774
	/* Send connection flow control advertisement when applicable */
1775 1776 1777
	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 已提交
1778
exit:
1779
	release_sock(sk);
1780
	return rc ? rc : copy;
P
Per Liden 已提交
1781 1782
}

1783
/**
1784
 * tipc_recvstream - receive stream-oriented data
P
Per Liden 已提交
1785
 * @m: descriptor for message info
1786
 * @buflen: total size of user buffer area
P
Per Liden 已提交
1787
 * @flags: receive flags
1788 1789
 *
 * Used for SOCK_STREAM messages only.  If not enough data is available
P
Per Liden 已提交
1790 1791 1792 1793
 * will optionally wait for more; never truncates data.
 *
 * Returns size of returned message data, errno otherwise
 */
1794 1795
static int tipc_recvstream(struct socket *sock, struct msghdr *m,
			   size_t buflen, int flags)
P
Per Liden 已提交
1796
{
1797
	struct sock *sk = sock->sk;
1798
	struct tipc_sock *tsk = tipc_sk(sk);
1799 1800 1801 1802 1803 1804 1805
	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 已提交
1806

1807
	/* Catch invalid receive attempts */
1808
	if (unlikely(!buflen))
P
Per Liden 已提交
1809 1810
		return -EINVAL;

1811
	lock_sock(sk);
P
Per Liden 已提交
1812

1813
	if (unlikely(sk->sk_state == TIPC_OPEN)) {
1814
		rc = -ENOTCONN;
Y
Ying Xue 已提交
1815
		goto exit;
P
Per Liden 已提交
1816
	}
1817 1818
	required = sock_rcvlowat(sk, flags & MSG_WAITALL, buflen);
	timeout = sock_rcvtimeo(sk, flags & MSG_DONTWAIT);
P
Per Liden 已提交
1819

1820 1821 1822 1823 1824 1825 1826 1827 1828 1829 1830
	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);
1831

1832 1833 1834 1835 1836
		/* Discard any empty non-errored (SYN-) message */
		if (unlikely(!dlen && !err)) {
			tsk_advance_rx_queue(sk);
			continue;
		}
1837

1838 1839
		/* Collect msg meta data, incl. error code and rejected data */
		if (!copied) {
1840
			tipc_sk_set_orig_addr(m, skb);
1841 1842 1843 1844
			rc = tipc_sk_anc_data_recv(m, hdr, tsk);
			if (rc)
				break;
		}
P
Per Liden 已提交
1845

1846 1847 1848 1849 1850 1851 1852 1853 1854 1855 1856 1857 1858 1859 1860 1861 1862 1863 1864 1865
		/* 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 已提交
1866 1867
		}

1868 1869
		if (unlikely(peek))
			break;
P
Per Liden 已提交
1870

1871
		tsk_advance_rx_queue(sk);
1872

1873 1874 1875 1876
		/* 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 已提交
1877

1878 1879 1880
		/* Exit if all requested data or FIN/error received */
		if (copied == buflen || err)
			break;
P
Per Liden 已提交
1881

1882
	} while (!skb_queue_empty(&sk->sk_receive_queue) || copied < required);
P
Per Liden 已提交
1883
exit:
1884
	release_sock(sk);
1885
	return copied ? copied : rc;
P
Per Liden 已提交
1886 1887
}

1888 1889 1890 1891 1892 1893 1894 1895 1896 1897
/**
 * 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 已提交
1898
	if (skwq_has_sleeper(wq))
1899 1900
		wake_up_interruptible_sync_poll(&wq->wait, EPOLLOUT |
						EPOLLWRNORM | EPOLLWRBAND);
1901 1902 1903 1904 1905 1906 1907 1908
	rcu_read_unlock();
}

/**
 * tipc_data_ready - wake up threads to indicate messages have been received
 * @sk: socket
 * @len: the length of messages
 */
1909
static void tipc_data_ready(struct sock *sk)
1910 1911 1912 1913 1914
{
	struct socket_wq *wq;

	rcu_read_lock();
	wq = rcu_dereference(sk->sk_wq);
H
Herbert Xu 已提交
1915
	if (skwq_has_sleeper(wq))
1916 1917
		wake_up_interruptible_sync_poll(&wq->wait, EPOLLIN |
						EPOLLRDNORM | EPOLLRDBAND);
1918 1919 1920
	rcu_read_unlock();
}

1921 1922 1923 1924 1925
static void tipc_sock_destruct(struct sock *sk)
{
	__skb_queue_purge(&sk->sk_receive_queue);
}

J
Jon Maloy 已提交
1926 1927 1928 1929 1930 1931 1932
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 已提交
1933
	struct tipc_group *grp = tsk->group;
1934
	bool wakeup = false;
J
Jon Maloy 已提交
1935 1936 1937 1938 1939 1940

	switch (msg_user(hdr)) {
	case CONN_MANAGER:
		tipc_sk_conn_proto_rcv(tsk, skb, xmitq);
		return;
	case SOCK_WAKEUP:
J
Jon Maloy 已提交
1941
		tipc_dest_del(&tsk->cong_links, msg_orignode(hdr), 0);
J
Jon Maloy 已提交
1942
		tsk->cong_link_cnt--;
1943
		wakeup = true;
J
Jon Maloy 已提交
1944
		break;
J
Jon Maloy 已提交
1945
	case GROUP_PROTOCOL:
1946
		tipc_group_proto_rcv(grp, &wakeup, hdr, inputq, xmitq);
J
Jon Maloy 已提交
1947
		break;
J
Jon Maloy 已提交
1948
	case TOP_SRV:
1949
		tipc_group_member_evt(tsk->group, &wakeup, &sk->sk_rcvbuf,
1950
				      hdr, inputq, xmitq);
J
Jon Maloy 已提交
1951 1952 1953 1954 1955
		break;
	default:
		break;
	}

1956 1957 1958
	if (wakeup)
		sk->sk_write_space(sk);

J
Jon Maloy 已提交
1959 1960 1961
	kfree_skb(skb);
}

1962
/**
J
Jon Maloy 已提交
1963
 * tipc_filter_connect - Handle incoming message for a connection-based socket
1964
 * @tsk: TIPC socket
1965
 * @skb: pointer to message buffer. Set to NULL if buffer is consumed
1966
 *
1967
 * Returns true if everything ok, false otherwise
1968
 */
J
Jon Maloy 已提交
1969
static bool tipc_sk_filter_connect(struct tipc_sock *tsk, struct sk_buff *skb)
1970
{
1971
	struct sock *sk = &tsk->sk;
1972
	struct net *net = sock_net(sk);
1973
	struct tipc_msg *hdr = buf_msg(skb);
1974 1975
	u32 pport = msg_origport(hdr);
	u32 pnode = msg_orignode(hdr);
1976

1977 1978
	if (unlikely(msg_mcast(hdr)))
		return false;
1979

1980 1981
	switch (sk->sk_state) {
	case TIPC_CONNECTING:
1982
		/* Accept only ACK or NACK message */
1983 1984 1985 1986 1987 1988 1989 1990 1991 1992
		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;
		}
1993

1994
		if (unlikely(msg_errcode(hdr))) {
1995
			tipc_set_sk_state(sk, TIPC_DISCONNECTING);
1996
			sk->sk_err = ECONNREFUSED;
1997
			sk->sk_state_change(sk);
1998
			return true;
1999 2000
		}

2001
		if (unlikely(!msg_isdata(hdr))) {
2002
			tipc_set_sk_state(sk, TIPC_DISCONNECTING);
2003
			sk->sk_err = EINVAL;
2004
			sk->sk_state_change(sk);
2005
			return true;
2006 2007
		}

2008 2009
		tipc_sk_finish_conn(tsk, msg_origport(hdr), msg_orignode(hdr));
		msg_set_importance(&tsk->phdr, msg_importance(hdr));
2010

2011 2012 2013 2014 2015
		/* If 'ACK+' message, add to socket receive queue */
		if (msg_data_sz(hdr))
			return true;

		/* If empty 'ACK-' message, wake up sleeping connect() */
2016
		sk->sk_data_ready(sk);
2017 2018 2019 2020 2021

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

2022
	case TIPC_OPEN:
2023
	case TIPC_DISCONNECTING:
2024 2025
		break;
	case TIPC_LISTEN:
2026
		/* Accept only SYN message */
2027 2028
		if (!msg_connected(hdr) && !(msg_errcode(hdr)))
			return true;
2029
		break;
2030 2031 2032 2033 2034 2035 2036 2037 2038 2039 2040 2041 2042
	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;
2043
	default:
2044
		pr_err("Unknown sk_state %u\n", sk->sk_state);
2045
	}
2046

2047
	return false;
2048 2049
}

2050 2051 2052
/**
 * rcvbuf_limit - get proper overload limit of socket receive queue
 * @sk: socket
2053
 * @skb: message
2054
 *
2055 2056
 * For connection oriented messages, irrespective of importance,
 * default queue limit is 2 MB.
2057
 *
2058 2059
 * For connectionless messages, queue limits are based on message
 * importance as follows:
2060
 *
2061 2062 2063 2064
 * TIPC_LOW_IMPORTANCE       (2 MB)
 * TIPC_MEDIUM_IMPORTANCE    (4 MB)
 * TIPC_HIGH_IMPORTANCE      (8 MB)
 * TIPC_CRITICAL_IMPORTANCE  (16 MB)
2065 2066 2067
 *
 * Returns overload limit according to corresponding message importance
 */
2068
static unsigned int rcvbuf_limit(struct sock *sk, struct sk_buff *skb)
2069
{
2070 2071 2072
	struct tipc_sock *tsk = tipc_sk(sk);
	struct tipc_msg *hdr = buf_msg(skb);

2073 2074 2075
	if (unlikely(msg_in_group(hdr)))
		return sk->sk_rcvbuf;

2076 2077
	if (unlikely(!msg_connected(hdr)))
		return sk->sk_rcvbuf << msg_importance(hdr);
2078

2079 2080
	if (likely(tsk->peer_caps & TIPC_BLOCK_FLOWCTL))
		return sk->sk_rcvbuf;
2081

2082
	return FLOWCTL_MSG_LIM;
2083 2084
}

2085
/**
J
Jon Maloy 已提交
2086
 * tipc_sk_filter_rcv - validate incoming message
2087
 * @sk: socket
2088
 * @skb: pointer to message.
2089
 *
2090 2091 2092
 * Enqueues message on receive queue if acceptable; optionally handles
 * disconnect indication for a connected socket.
 *
2093
 * Called with socket lock already taken
2094
 *
P
Per Liden 已提交
2095
 */
J
Jon Maloy 已提交
2096 2097
static void tipc_sk_filter_rcv(struct sock *sk, struct sk_buff *skb,
			       struct sk_buff_head *xmitq)
P
Per Liden 已提交
2098
{
J
Jon Maloy 已提交
2099
	bool sk_conn = !tipc_sk_type_connectionless(sk);
2100
	struct tipc_sock *tsk = tipc_sk(sk);
J
Jon Maloy 已提交
2101
	struct tipc_group *grp = tsk->group;
2102
	struct tipc_msg *hdr = buf_msg(skb);
J
Jon Maloy 已提交
2103 2104 2105
	struct net *net = sock_net(sk);
	struct sk_buff_head inputq;
	int limit, err = TIPC_OK;
2106

J
Jon Maloy 已提交
2107 2108 2109
	TIPC_SKB_CB(skb)->bytes_read = 0;
	__skb_queue_head_init(&inputq);
	__skb_queue_tail(&inputq, skb);
2110

J
Jon Maloy 已提交
2111 2112
	if (unlikely(!msg_isdata(hdr)))
		tipc_sk_proto_rcv(sk, &inputq, xmitq);
2113

J
Jon Maloy 已提交
2114 2115 2116
	if (unlikely(grp))
		tipc_group_filter_msg(grp, &inputq, xmitq);

J
Jon Maloy 已提交
2117 2118 2119 2120 2121
	/* 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 已提交
2122 2123
		    (!sk_conn && msg_connected(hdr)) ||
		    (!grp && msg_in_group(hdr)))
2124
			err = TIPC_ERR_NO_PORT;
J
Jon Maloy 已提交
2125 2126
		else if (sk_rmem_alloc_get(sk) + skb->truesize >= limit)
			err = TIPC_ERR_OVERLOAD;
P
Per Liden 已提交
2127

J
Jon Maloy 已提交
2128 2129 2130 2131 2132 2133 2134 2135
		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);
2136
	}
2137
}
P
Per Liden 已提交
2138

2139
/**
J
Jon Maloy 已提交
2140
 * tipc_sk_backlog_rcv - handle incoming message from backlog queue
2141
 * @sk: socket
2142
 * @skb: message
2143
 *
2144
 * Caller must hold socket lock
2145
 */
J
Jon Maloy 已提交
2146
static int tipc_sk_backlog_rcv(struct sock *sk, struct sk_buff *skb)
2147
{
J
Jon Maloy 已提交
2148
	unsigned int before = sk_rmem_alloc_get(sk);
J
Jon Paul Maloy 已提交
2149
	struct sk_buff_head xmitq;
J
Jon Maloy 已提交
2150
	unsigned int added;
2151

J
Jon Paul Maloy 已提交
2152 2153
	__skb_queue_head_init(&xmitq);

J
Jon Maloy 已提交
2154 2155 2156
	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 已提交
2157

J
Jon Maloy 已提交
2158
	/* Send pending response/rejected messages, if any */
2159
	tipc_node_distr_xmit(sock_net(sk), &xmitq);
2160 2161 2162
	return 0;
}

2163
/**
2164 2165 2166 2167 2168
 * 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
2169 2170 2171
 *
 * Caller must hold socket lock
 */
2172
static void tipc_sk_enqueue(struct sk_buff_head *inputq, struct sock *sk,
J
Jon Paul Maloy 已提交
2173
			    u32 dport, struct sk_buff_head *xmitq)
2174
{
J
Jon Paul Maloy 已提交
2175 2176
	unsigned long time_limit = jiffies + 2;
	struct sk_buff *skb;
2177 2178
	unsigned int lim;
	atomic_t *dcnt;
J
Jon Paul Maloy 已提交
2179
	u32 onode;
2180 2181

	while (skb_queue_len(inputq)) {
2182
		if (unlikely(time_after_eq(jiffies, time_limit)))
2183 2184
			return;

2185 2186
		skb = tipc_skb_dequeue(inputq, dport);
		if (unlikely(!skb))
2187 2188 2189
			return;

		/* Add message directly to receive queue if possible */
2190
		if (!sock_owned_by_user(sk)) {
J
Jon Maloy 已提交
2191
			tipc_sk_filter_rcv(sk, skb, xmitq);
2192
			continue;
2193
		}
2194 2195

		/* Try backlog, compensating for double-counted bytes */
2196
		dcnt = &tipc_sk(sk)->dupl_rcvcnt;
2197
		if (!sk->sk_backlog.len)
2198 2199 2200 2201
			atomic_set(dcnt, 0);
		lim = rcvbuf_limit(sk, skb) + atomic_read(dcnt);
		if (likely(!sk_add_backlog(sk, skb, lim)))
			continue;
2202 2203

		/* Overload => reject message back to sender */
J
Jon Paul Maloy 已提交
2204 2205 2206
		onode = tipc_own_addr(sock_net(sk));
		if (tipc_msg_reverse(onode, &skb, TIPC_ERR_OVERLOAD))
			__skb_queue_tail(xmitq, skb);
2207
		break;
2208
	}
2209 2210
}

2211
/**
2212 2213 2214 2215
 * 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
2216
 */
2217
void tipc_sk_rcv(struct net *net, struct sk_buff_head *inputq)
2218
{
J
Jon Paul Maloy 已提交
2219
	struct sk_buff_head xmitq;
2220
	u32 dnode, dport = 0;
E
Erik Hugne 已提交
2221
	int err;
2222 2223
	struct tipc_sock *tsk;
	struct sock *sk;
2224
	struct sk_buff *skb;
2225

J
Jon Paul Maloy 已提交
2226
	__skb_queue_head_init(&xmitq);
2227 2228 2229
	while (skb_queue_len(inputq)) {
		dport = tipc_skb_peek_port(inputq, dport);
		tsk = tipc_sk_lookup(net, dport);
2230

2231 2232 2233
		if (likely(tsk)) {
			sk = &tsk->sk;
			if (likely(spin_trylock_bh(&sk->sk_lock.slock))) {
J
Jon Paul Maloy 已提交
2234
				tipc_sk_enqueue(inputq, sk, dport, &xmitq);
2235 2236
				spin_unlock_bh(&sk->sk_lock.slock);
			}
J
Jon Paul Maloy 已提交
2237
			/* Send pending response/rejected messages, if any */
2238
			tipc_node_distr_xmit(sock_net(sk), &xmitq);
2239 2240 2241
			sock_put(sk);
			continue;
		}
2242 2243 2244 2245 2246 2247 2248 2249 2250 2251 2252 2253
		/* 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))
2254
			continue;
2255
xmit:
2256
		dnode = msg_destnode(buf_msg(skb));
2257
		tipc_node_xmit_skb(net, skb, dnode, dport);
2258
	}
P
Per Liden 已提交
2259 2260
}

Y
Ying Xue 已提交
2261 2262
static int tipc_wait_for_connect(struct socket *sock, long *timeo_p)
{
W
WANG Cong 已提交
2263
	DEFINE_WAIT_FUNC(wait, woken_wake_function);
Y
Ying Xue 已提交
2264 2265 2266 2267 2268 2269 2270 2271 2272 2273 2274 2275
	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 已提交
2276
		add_wait_queue(sk_sleep(sk), &wait);
2277
		done = sk_wait_event(sk, timeo_p,
W
WANG Cong 已提交
2278 2279
				     sk->sk_state != TIPC_CONNECTING, &wait);
		remove_wait_queue(sk_sleep(sk), &wait);
Y
Ying Xue 已提交
2280 2281 2282 2283
	} while (!done);
	return 0;
}

P
Per Liden 已提交
2284
/**
2285
 * tipc_connect - establish a connection to another TIPC port
P
Per Liden 已提交
2286 2287 2288
 * @sock: socket structure
 * @dest: socket address for destination port
 * @destlen: size of socket address data structure
2289
 * @flags: file-related flags associated with socket
P
Per Liden 已提交
2290 2291 2292
 *
 * Returns 0 on success, errno otherwise
 */
2293 2294
static int tipc_connect(struct socket *sock, struct sockaddr *dest,
			int destlen, int flags)
P
Per Liden 已提交
2295
{
2296
	struct sock *sk = sock->sk;
2297
	struct tipc_sock *tsk = tipc_sk(sk);
2298 2299
	struct sockaddr_tipc *dst = (struct sockaddr_tipc *)dest;
	struct msghdr m = {NULL,};
2300
	long timeout = (flags & O_NONBLOCK) ? 0 : tsk->conn_timeout;
2301
	int previous;
2302
	int res = 0;
2303

2304 2305 2306
	if (destlen != sizeof(struct sockaddr_tipc))
		return -EINVAL;

2307 2308
	lock_sock(sk);

J
Jon Maloy 已提交
2309 2310 2311 2312 2313
	if (tsk->group) {
		res = -EINVAL;
		goto exit;
	}

2314 2315 2316
	if (dst->family == AF_UNSPEC) {
		memset(&tsk->peer, 0, sizeof(struct sockaddr_tipc));
		if (!tipc_sk_type_connectionless(sk))
2317
			res = -EINVAL;
2318
		goto exit;
2319 2320
	} else if (dst->family != AF_TIPC) {
		res = -EINVAL;
2321
	}
2322
	if (dst->addrtype != TIPC_ADDR_ID && dst->addrtype != TIPC_ADDR_NAME)
2323
		res = -EINVAL;
2324 2325 2326 2327 2328 2329
	if (res)
		goto exit;

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

2333
	previous = sk->sk_state;
2334 2335 2336

	switch (sk->sk_state) {
	case TIPC_OPEN:
2337 2338 2339 2340 2341 2342 2343 2344 2345 2346
		/* 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;

2347
		res = __tipc_sendmsg(sock, &m, 0);
2348 2349 2350
		if ((res < 0) && (res != -EWOULDBLOCK))
			goto exit;

2351
		/* Just entered TIPC_CONNECTING state; the only
2352 2353 2354 2355
		 * difference is that return value in non-blocking
		 * case is EINPROGRESS, rather than EALREADY.
		 */
		res = -EINPROGRESS;
2356 2357 2358 2359 2360
		/* fall thru' */
	case TIPC_CONNECTING:
		if (!timeout) {
			if (previous == TIPC_CONNECTING)
				res = -EALREADY;
Y
Ying Xue 已提交
2361
			goto exit;
2362
		}
Y
Ying Xue 已提交
2363 2364 2365
		timeout = msecs_to_jiffies(timeout);
		/* Wait until an 'ACK' or 'RST' arrives, or a timeout occurs */
		res = tipc_wait_for_connect(sock, &timeout);
2366 2367
		break;
	case TIPC_ESTABLISHED:
2368
		res = -EISCONN;
2369 2370
		break;
	default:
2371
		res = -EINVAL;
2372
	}
2373

2374 2375
exit:
	release_sock(sk);
2376
	return res;
P
Per Liden 已提交
2377 2378
}

2379
/**
2380
 * tipc_listen - allow socket to listen for incoming connections
P
Per Liden 已提交
2381 2382
 * @sock: socket structure
 * @len: (unused)
2383
 *
P
Per Liden 已提交
2384 2385
 * Returns 0 on success, errno otherwise
 */
2386
static int tipc_listen(struct socket *sock, int len)
P
Per Liden 已提交
2387
{
2388 2389 2390 2391
	struct sock *sk = sock->sk;
	int res;

	lock_sock(sk);
2392
	res = tipc_set_sk_state(sk, TIPC_LISTEN);
2393
	release_sock(sk);
2394

2395
	return res;
P
Per Liden 已提交
2396 2397
}

Y
Ying Xue 已提交
2398 2399 2400 2401 2402 2403 2404 2405 2406 2407 2408 2409 2410 2411
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);
2412
		if (timeo && skb_queue_empty(&sk->sk_receive_queue)) {
Y
Ying Xue 已提交
2413 2414 2415 2416 2417 2418 2419 2420 2421 2422
			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;
2423 2424 2425
		err = sock_intr_errno(timeo);
		if (signal_pending(current))
			break;
Y
Ying Xue 已提交
2426 2427 2428 2429 2430
	}
	finish_wait(sk_sleep(sk), &wait);
	return err;
}

2431
/**
2432
 * tipc_accept - wait for connection request
P
Per Liden 已提交
2433 2434 2435
 * @sock: listening socket
 * @newsock: new socket that is to be connected
 * @flags: file-related flags associated with socket
2436
 *
P
Per Liden 已提交
2437 2438
 * Returns 0 on success, errno otherwise
 */
2439 2440
static int tipc_accept(struct socket *sock, struct socket *new_sock, int flags,
		       bool kern)
P
Per Liden 已提交
2441
{
2442
	struct sock *new_sk, *sk = sock->sk;
P
Per Liden 已提交
2443
	struct sk_buff *buf;
2444
	struct tipc_sock *new_tsock;
2445
	struct tipc_msg *msg;
Y
Ying Xue 已提交
2446
	long timeo;
2447
	int res;
P
Per Liden 已提交
2448

2449
	lock_sock(sk);
P
Per Liden 已提交
2450

2451
	if (sk->sk_state != TIPC_LISTEN) {
2452
		res = -EINVAL;
P
Per Liden 已提交
2453 2454
		goto exit;
	}
Y
Ying Xue 已提交
2455 2456 2457 2458
	timeo = sock_rcvtimeo(sk, flags & O_NONBLOCK);
	res = tipc_wait_for_accept(sock, timeo);
	if (res)
		goto exit;
2459 2460 2461

	buf = skb_peek(&sk->sk_receive_queue);

2462
	res = tipc_sk_create(sock_net(sock->sk), new_sock, 0, kern);
2463 2464
	if (res)
		goto exit;
2465
	security_sk_clone(sock->sk, new_sock->sk);
P
Per Liden 已提交
2466

2467
	new_sk = new_sock->sk;
2468
	new_tsock = tipc_sk(new_sk);
2469
	msg = buf_msg(buf);
P
Per Liden 已提交
2470

2471 2472 2473 2474 2475 2476 2477
	/* 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)
	 */
2478
	tsk_rej_rx_queue(new_sk);
2479 2480

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

2483
	tsk_set_importance(new_tsock, msg_importance(msg));
2484
	if (msg_named(msg)) {
2485 2486
		new_tsock->conn_type = msg_nametype(msg);
		new_tsock->conn_instance = msg_nameinst(msg);
P
Per Liden 已提交
2487
	}
2488 2489 2490 2491 2492 2493 2494 2495

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

2496
		tsk_advance_rx_queue(sk);
2497
		__tipc_sendstream(new_sock, &m, 0);
2498 2499 2500
	} else {
		__skb_dequeue(&sk->sk_receive_queue);
		__skb_queue_head(&new_sk->sk_receive_queue, buf);
2501
		skb_set_owner_r(buf, new_sk);
2502 2503
	}
	release_sock(new_sk);
P
Per Liden 已提交
2504
exit:
2505
	release_sock(sk);
P
Per Liden 已提交
2506 2507 2508 2509
	return res;
}

/**
2510
 * tipc_shutdown - shutdown socket connection
P
Per Liden 已提交
2511
 * @sock: socket structure
2512
 * @how: direction to close (must be SHUT_RDWR)
P
Per Liden 已提交
2513 2514
 *
 * Terminates connection (if necessary), then purges socket's receive queue.
2515
 *
P
Per Liden 已提交
2516 2517
 * Returns 0 on success, errno otherwise
 */
2518
static int tipc_shutdown(struct socket *sock, int how)
P
Per Liden 已提交
2519
{
2520
	struct sock *sk = sock->sk;
P
Per Liden 已提交
2521 2522
	int res;

2523 2524
	if (how != SHUT_RDWR)
		return -EINVAL;
P
Per Liden 已提交
2525

2526
	lock_sock(sk);
P
Per Liden 已提交
2527

2528 2529
	__tipc_shutdown(sock, TIPC_CONN_SHUTDOWN);
	sk->sk_shutdown = SEND_SHUTDOWN;
P
Per Liden 已提交
2530

2531
	if (sk->sk_state == TIPC_DISCONNECTING) {
2532
		/* Discard any unreceived messages */
2533
		__skb_queue_purge(&sk->sk_receive_queue);
2534 2535 2536

		/* Wake up anyone sleeping in poll */
		sk->sk_state_change(sk);
P
Per Liden 已提交
2537
		res = 0;
2538
	} else {
P
Per Liden 已提交
2539 2540 2541
		res = -ENOTCONN;
	}

2542
	release_sock(sk);
P
Per Liden 已提交
2543 2544 2545
	return res;
}

2546
static void tipc_sk_timeout(struct timer_list *t)
2547
{
2548 2549
	struct sock *sk = from_timer(sk, t, sk_timer);
	struct tipc_sock *tsk = tipc_sk(sk);
2550 2551 2552 2553 2554
	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);
2555
	struct sk_buff *skb = NULL;
2556

J
Jon Paul Maloy 已提交
2557
	bh_lock_sock(sk);
2558 2559 2560 2561 2562 2563
	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 已提交
2564
		goto exit;
2565 2566
	}

2567
	if (tsk->probe_unacked) {
2568 2569 2570
		tipc_set_sk_state(sk, TIPC_DISCONNECTING);
		tipc_node_remove_conn(net, peer_node, peer_port);
		sk->sk_state_change(sk);
2571
		goto exit;
2572
	}
2573 2574 2575 2576
	/* 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);
2577
	tsk->probe_unacked = true;
2578 2579
	sk_reset_timer(sk, &sk->sk_timer, jiffies + CONN_PROBING_INTV);
exit:
2580
	bh_unlock_sock(sk);
2581
	if (skb)
2582
		tipc_node_xmit_skb(net, skb, peer_node, own_port);
2583
	sock_put(sk);
2584 2585
}

2586
static int tipc_sk_publish(struct tipc_sock *tsk, uint scope,
J
Jon Paul Maloy 已提交
2587 2588
			   struct tipc_name_seq const *seq)
{
2589 2590
	struct sock *sk = &tsk->sk;
	struct net *net = sock_net(sk);
J
Jon Paul Maloy 已提交
2591 2592 2593
	struct publication *publ;
	u32 key;

J
Jon Maloy 已提交
2594 2595 2596
	if (scope != TIPC_NODE_SCOPE)
		scope = TIPC_CLUSTER_SCOPE;

2597
	if (tipc_sk_connected(sk))
J
Jon Paul Maloy 已提交
2598
		return -EINVAL;
2599 2600
	key = tsk->portid + tsk->pub_count + 1;
	if (key == tsk->portid)
J
Jon Paul Maloy 已提交
2601 2602
		return -EADDRINUSE;

2603
	publ = tipc_nametbl_publish(net, seq->type, seq->lower, seq->upper,
2604
				    scope, tsk->portid, key);
J
Jon Paul Maloy 已提交
2605 2606 2607
	if (unlikely(!publ))
		return -EINVAL;

2608 2609 2610
	list_add(&publ->pport_list, &tsk->publications);
	tsk->pub_count++;
	tsk->published = 1;
J
Jon Paul Maloy 已提交
2611 2612 2613
	return 0;
}

2614
static int tipc_sk_withdraw(struct tipc_sock *tsk, uint scope,
J
Jon Paul Maloy 已提交
2615 2616
			    struct tipc_name_seq const *seq)
{
2617
	struct net *net = sock_net(&tsk->sk);
J
Jon Paul Maloy 已提交
2618 2619 2620 2621
	struct publication *publ;
	struct publication *safe;
	int rc = -EINVAL;

J
Jon Maloy 已提交
2622 2623 2624
	if (scope != TIPC_NODE_SCOPE)
		scope = TIPC_CLUSTER_SCOPE;

2625
	list_for_each_entry_safe(publ, safe, &tsk->publications, pport_list) {
J
Jon Paul Maloy 已提交
2626 2627 2628 2629 2630 2631 2632 2633 2634
		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;
2635
			tipc_nametbl_withdraw(net, publ->type, publ->lower,
J
Jon Paul Maloy 已提交
2636 2637 2638 2639
					      publ->ref, publ->key);
			rc = 0;
			break;
		}
2640
		tipc_nametbl_withdraw(net, publ->type, publ->lower,
J
Jon Paul Maloy 已提交
2641 2642 2643
				      publ->ref, publ->key);
		rc = 0;
	}
2644 2645
	if (list_empty(&tsk->publications))
		tsk->published = 0;
J
Jon Paul Maloy 已提交
2646 2647 2648
	return rc;
}

2649 2650 2651
/* tipc_sk_reinit: set non-zero address in all existing sockets
 *                 when we go from standalone to network mode.
 */
2652
void tipc_sk_reinit(struct net *net)
2653
{
2654
	struct tipc_net *tn = net_generic(net, tipc_net_id);
2655
	struct rhashtable_iter iter;
2656
	struct tipc_sock *tsk;
2657 2658
	struct tipc_msg *msg;

2659 2660 2661
	rhashtable_walk_enter(&tn->sk_rht, &iter);

	do {
2662
		rhashtable_walk_start(&iter);
2663 2664

		while ((tsk = rhashtable_walk_next(&iter)) && !IS_ERR(tsk)) {
2665 2666
			spin_lock_bh(&tsk->sk.sk_lock.slock);
			msg = &tsk->phdr;
2667 2668
			msg_set_prevnode(msg, tn->own_addr);
			msg_set_orignode(msg, tn->own_addr);
2669 2670
			spin_unlock_bh(&tsk->sk.sk_lock.slock);
		}
2671

2672 2673
		rhashtable_walk_stop(&iter);
	} while (tsk == ERR_PTR(-EAGAIN));
2674 2675
}

2676
static struct tipc_sock *tipc_sk_lookup(struct net *net, u32 portid)
2677
{
2678
	struct tipc_net *tn = net_generic(net, tipc_net_id);
2679
	struct tipc_sock *tsk;
2680

2681
	rcu_read_lock();
2682
	tsk = rhashtable_lookup_fast(&tn->sk_rht, &portid, tsk_rht_params);
2683 2684 2685
	if (tsk)
		sock_hold(&tsk->sk);
	rcu_read_unlock();
2686

2687
	return tsk;
2688 2689
}

2690
static int tipc_sk_insert(struct tipc_sock *tsk)
2691
{
2692 2693 2694
	struct sock *sk = &tsk->sk;
	struct net *net = sock_net(sk);
	struct tipc_net *tn = net_generic(net, tipc_net_id);
2695 2696
	u32 remaining = (TIPC_MAX_PORT - TIPC_MIN_PORT) + 1;
	u32 portid = prandom_u32() % remaining + TIPC_MIN_PORT;
2697

2698 2699 2700 2701 2702 2703
	while (remaining--) {
		portid++;
		if ((portid < TIPC_MIN_PORT) || (portid > TIPC_MAX_PORT))
			portid = TIPC_MIN_PORT;
		tsk->portid = portid;
		sock_hold(&tsk->sk);
2704 2705
		if (!rhashtable_lookup_insert_fast(&tn->sk_rht, &tsk->node,
						   tsk_rht_params))
2706 2707
			return 0;
		sock_put(&tsk->sk);
2708 2709
	}

2710
	return -1;
2711 2712
}

2713
static void tipc_sk_remove(struct tipc_sock *tsk)
2714
{
2715
	struct sock *sk = &tsk->sk;
2716
	struct tipc_net *tn = net_generic(sock_net(sk), tipc_net_id);
2717

2718
	if (!rhashtable_remove_fast(&tn->sk_rht, &tsk->node, tsk_rht_params)) {
2719
		WARN_ON(refcount_read(&sk->sk_refcnt) == 1);
2720
		__sock_put(sk);
2721 2722 2723
	}
}

2724 2725 2726 2727 2728 2729 2730
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,
2731
	.automatic_shrinking = true,
2732 2733
};

2734
int tipc_sk_rht_init(struct net *net)
2735
{
2736
	struct tipc_net *tn = net_generic(net, tipc_net_id);
2737 2738

	return rhashtable_init(&tn->sk_rht, &tsk_rht_params);
2739 2740
}

2741
void tipc_sk_rht_destroy(struct net *net)
2742
{
2743 2744
	struct tipc_net *tn = net_generic(net, tipc_net_id);

2745 2746
	/* Wait for socket readers to complete */
	synchronize_net();
2747

2748
	rhashtable_destroy(&tn->sk_rht);
2749 2750
}

J
Jon Maloy 已提交
2751 2752 2753 2754 2755 2756 2757 2758 2759 2760
static int tipc_sk_join(struct tipc_sock *tsk, struct tipc_group_req *mreq)
{
	struct net *net = sock_net(&tsk->sk);
	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;
2761 2762
	if (mreq->scope > TIPC_NODE_SCOPE)
		return -EINVAL;
J
Jon Maloy 已提交
2763 2764
	if (grp)
		return -EACCES;
2765
	grp = tipc_group_create(net, tsk->portid, mreq, &tsk->group_is_open);
J
Jon Maloy 已提交
2766 2767 2768 2769 2770 2771 2772 2773 2774
	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;
2775
	tipc_nametbl_build_group(net, grp, mreq->type, mreq->scope);
J
Jon Maloy 已提交
2776
	rc = tipc_sk_publish(tsk, mreq->scope, &seq);
C
Cong Wang 已提交
2777
	if (rc) {
J
Jon Maloy 已提交
2778
		tipc_group_delete(net, grp);
C
Cong Wang 已提交
2779
		tsk->group = NULL;
2780
		return rc;
C
Cong Wang 已提交
2781
	}
2782
	/* Eliminate any risk that a broadcast overtakes sent JOINs */
2783 2784
	tsk->mc_method.rcast = true;
	tsk->mc_method.mandatory = true;
2785
	tipc_group_join(net, grp, &tsk->sk.sk_rcvbuf);
J
Jon Maloy 已提交
2786 2787 2788 2789 2790 2791 2792 2793 2794 2795 2796 2797 2798 2799 2800 2801 2802 2803 2804
	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 已提交
2805
/**
2806
 * tipc_setsockopt - set socket option
P
Per Liden 已提交
2807 2808 2809 2810 2811
 * @sock: socket structure
 * @lvl: option level
 * @opt: option identifier
 * @ov: pointer to new option value
 * @ol: length of option value
2812 2813
 *
 * For stream sockets only, accepts and ignores all IPPROTO_TCP options
P
Per Liden 已提交
2814
 * (to ease compatibility).
2815
 *
P
Per Liden 已提交
2816 2817
 * Returns 0 on success, errno otherwise
 */
2818 2819
static int tipc_setsockopt(struct socket *sock, int lvl, int opt,
			   char __user *ov, unsigned int ol)
P
Per Liden 已提交
2820
{
2821
	struct sock *sk = sock->sk;
2822
	struct tipc_sock *tsk = tipc_sk(sk);
J
Jon Maloy 已提交
2823
	struct tipc_group_req mreq;
2824
	u32 value = 0;
2825
	int res = 0;
P
Per Liden 已提交
2826

2827 2828
	if ((lvl == IPPROTO_TCP) && (sock->type == SOCK_STREAM))
		return 0;
P
Per Liden 已提交
2829 2830
	if (lvl != SOL_TIPC)
		return -ENOPROTOOPT;
2831 2832 2833 2834 2835 2836 2837 2838

	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 已提交
2839 2840 2841 2842 2843 2844 2845 2846
		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;
2847 2848 2849 2850 2851
		break;
	default:
		if (ov || ol)
			return -EINVAL;
	}
P
Per Liden 已提交
2852

2853
	lock_sock(sk);
2854

P
Per Liden 已提交
2855 2856
	switch (opt) {
	case TIPC_IMPORTANCE:
2857
		res = tsk_set_importance(tsk, value);
P
Per Liden 已提交
2858 2859 2860
		break;
	case TIPC_SRC_DROPPABLE:
		if (sock->type != SOCK_STREAM)
2861
			tsk_set_unreliable(tsk, value);
2862
		else
P
Per Liden 已提交
2863 2864 2865
			res = -ENOPROTOOPT;
		break;
	case TIPC_DEST_DROPPABLE:
2866
		tsk_set_unreturnable(tsk, value);
P
Per Liden 已提交
2867 2868
		break;
	case TIPC_CONN_TIMEOUT:
2869
		tipc_sk(sk)->conn_timeout = value;
P
Per Liden 已提交
2870
		break;
2871 2872 2873 2874 2875 2876 2877 2878
	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 已提交
2879 2880 2881 2882 2883 2884
	case TIPC_GROUP_JOIN:
		res = tipc_sk_join(tsk, &mreq);
		break;
	case TIPC_GROUP_LEAVE:
		res = tipc_sk_leave(tsk);
		break;
P
Per Liden 已提交
2885 2886 2887 2888
	default:
		res = -EINVAL;
	}

2889 2890
	release_sock(sk);

P
Per Liden 已提交
2891 2892 2893 2894
	return res;
}

/**
2895
 * tipc_getsockopt - get socket option
P
Per Liden 已提交
2896 2897 2898 2899 2900
 * @sock: socket structure
 * @lvl: option level
 * @opt: option identifier
 * @ov: receptacle for option value
 * @ol: receptacle for length of option value
2901 2902
 *
 * For stream sockets only, returns 0 length result for all IPPROTO_TCP options
P
Per Liden 已提交
2903
 * (to ease compatibility).
2904
 *
P
Per Liden 已提交
2905 2906
 * Returns 0 on success, errno otherwise
 */
2907 2908
static int tipc_getsockopt(struct socket *sock, int lvl, int opt,
			   char __user *ov, int __user *ol)
P
Per Liden 已提交
2909
{
2910
	struct sock *sk = sock->sk;
2911
	struct tipc_sock *tsk = tipc_sk(sk);
J
Jon Maloy 已提交
2912 2913
	struct tipc_name_seq seq;
	int len, scope;
P
Per Liden 已提交
2914
	u32 value;
2915
	int res;
P
Per Liden 已提交
2916

2917 2918
	if ((lvl == IPPROTO_TCP) && (sock->type == SOCK_STREAM))
		return put_user(0, ol);
P
Per Liden 已提交
2919 2920
	if (lvl != SOL_TIPC)
		return -ENOPROTOOPT;
2921 2922
	res = get_user(len, ol);
	if (res)
2923
		return res;
P
Per Liden 已提交
2924

2925
	lock_sock(sk);
P
Per Liden 已提交
2926 2927 2928

	switch (opt) {
	case TIPC_IMPORTANCE:
2929
		value = tsk_importance(tsk);
P
Per Liden 已提交
2930 2931
		break;
	case TIPC_SRC_DROPPABLE:
2932
		value = tsk_unreliable(tsk);
P
Per Liden 已提交
2933 2934
		break;
	case TIPC_DEST_DROPPABLE:
2935
		value = tsk_unreturnable(tsk);
P
Per Liden 已提交
2936 2937
		break;
	case TIPC_CONN_TIMEOUT:
2938
		value = tsk->conn_timeout;
2939
		/* no need to set "res", since already 0 at this point */
P
Per Liden 已提交
2940
		break;
2941
	case TIPC_NODE_RECVQ_DEPTH:
2942
		value = 0; /* was tipc_queue_size, now obsolete */
2943
		break;
2944
	case TIPC_SOCK_RECVQ_DEPTH:
2945 2946
		value = skb_queue_len(&sk->sk_receive_queue);
		break;
J
Jon Maloy 已提交
2947 2948 2949 2950 2951 2952
	case TIPC_GROUP_JOIN:
		seq.type = 0;
		if (tsk->group)
			tipc_group_self(tsk->group, &seq, &scope);
		value = seq.type;
		break;
P
Per Liden 已提交
2953 2954 2955 2956
	default:
		res = -EINVAL;
	}

2957 2958
	release_sock(sk);

2959 2960
	if (res)
		return res;	/* "get" failed */
P
Per Liden 已提交
2961

2962 2963 2964 2965 2966 2967 2968
	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 已提交
2969 2970
}

2971
static int tipc_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
E
Erik Hugne 已提交
2972
{
2973
	struct sock *sk = sock->sk;
E
Erik Hugne 已提交
2974 2975 2976 2977 2978 2979 2980
	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;
2981 2982
		if (!tipc_node_get_linkname(sock_net(sk),
					    lnr.bearer_id & 0xffff, lnr.peer,
E
Erik Hugne 已提交
2983 2984 2985 2986 2987 2988 2989 2990 2991 2992 2993
					    lnr.linkname, TIPC_MAX_LINK_NAME)) {
			if (copy_to_user(argp, &lnr, sizeof(lnr)))
				return -EFAULT;
			return 0;
		}
		return -EADDRNOTAVAIL;
	default:
		return -ENOIOCTLCMD;
	}
}

2994 2995 2996 2997
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 已提交
2998 2999 3000 3001 3002 3003 3004 3005 3006 3007 3008 3009 3010 3011 3012
	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);
3013 3014 3015
	return 0;
}

3016 3017
/* Protocol switches for the various types of TIPC sockets */

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

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

3060
static const struct proto_ops stream_ops = {
3061
	.owner		= THIS_MODULE,
P
Per Liden 已提交
3062
	.family		= AF_TIPC,
3063 3064 3065
	.release	= tipc_release,
	.bind		= tipc_bind,
	.connect	= tipc_connect,
3066
	.socketpair	= tipc_socketpair,
3067 3068 3069
	.accept		= tipc_accept,
	.getname	= tipc_getname,
	.poll		= tipc_poll,
E
Erik Hugne 已提交
3070
	.ioctl		= tipc_ioctl,
3071 3072 3073 3074
	.listen		= tipc_listen,
	.shutdown	= tipc_shutdown,
	.setsockopt	= tipc_setsockopt,
	.getsockopt	= tipc_getsockopt,
3075
	.sendmsg	= tipc_sendstream,
3076
	.recvmsg	= tipc_recvstream,
3077 3078
	.mmap		= sock_no_mmap,
	.sendpage	= sock_no_sendpage
P
Per Liden 已提交
3079 3080
};

3081
static const struct net_proto_family tipc_family_ops = {
3082
	.owner		= THIS_MODULE,
P
Per Liden 已提交
3083
	.family		= AF_TIPC,
3084
	.create		= tipc_sk_create
P
Per Liden 已提交
3085 3086 3087 3088 3089
};

static struct proto tipc_proto = {
	.name		= "TIPC",
	.owner		= THIS_MODULE,
3090 3091
	.obj_size	= sizeof(struct tipc_sock),
	.sysctl_rmem	= sysctl_tipc_rmem
P
Per Liden 已提交
3092 3093 3094
};

/**
3095
 * tipc_socket_init - initialize TIPC socket interface
3096
 *
P
Per Liden 已提交
3097 3098
 * Returns 0 on success, errno otherwise
 */
3099
int tipc_socket_init(void)
P
Per Liden 已提交
3100 3101 3102
{
	int res;

3103
	res = proto_register(&tipc_proto, 1);
P
Per Liden 已提交
3104
	if (res) {
3105
		pr_err("Failed to register TIPC protocol type\n");
P
Per Liden 已提交
3106 3107 3108 3109 3110
		goto out;
	}

	res = sock_register(&tipc_family_ops);
	if (res) {
3111
		pr_err("Failed to register TIPC socket type\n");
P
Per Liden 已提交
3112 3113 3114 3115 3116 3117 3118 3119
		proto_unregister(&tipc_proto);
		goto out;
	}
 out:
	return res;
}

/**
3120
 * tipc_socket_stop - stop TIPC socket interface
P
Per Liden 已提交
3121
 */
3122
void tipc_socket_stop(void)
P
Per Liden 已提交
3123 3124 3125 3126
{
	sock_unregister(tipc_family_ops.family);
	proto_unregister(&tipc_proto);
}
3127 3128

/* Caller should hold socket lock for the passed tipc socket. */
3129
static int __tipc_nl_add_sk_con(struct sk_buff *skb, struct tipc_sock *tsk)
3130 3131 3132 3133 3134 3135 3136 3137 3138 3139 3140 3141 3142 3143 3144 3145 3146 3147 3148 3149 3150 3151 3152 3153 3154 3155 3156 3157 3158 3159 3160 3161 3162 3163
{
	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. */
3164 3165
static int __tipc_nl_add_sk(struct sk_buff *skb, struct netlink_callback *cb,
			    struct tipc_sock *tsk)
3166 3167 3168 3169
{
	int err;
	void *hdr;
	struct nlattr *attrs;
3170 3171
	struct net *net = sock_net(skb->sk);
	struct tipc_net *tn = net_generic(net, tipc_net_id);
3172
	struct sock *sk = &tsk->sk;
3173 3174

	hdr = genlmsg_put(skb, NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq,
3175
			  &tipc_genl_family, NLM_F_MULTI, TIPC_NL_SOCK_GET);
3176 3177 3178 3179 3180 3181
	if (!hdr)
		goto msg_cancel;

	attrs = nla_nest_start(skb, TIPC_NLA_SOCK);
	if (!attrs)
		goto genlmsg_cancel;
3182
	if (nla_put_u32(skb, TIPC_NLA_SOCK_REF, tsk->portid))
3183
		goto attr_msg_cancel;
3184
	if (nla_put_u32(skb, TIPC_NLA_SOCK_ADDR, tn->own_addr))
3185 3186
		goto attr_msg_cancel;

3187
	if (tipc_sk_connected(sk)) {
3188 3189 3190 3191 3192 3193 3194 3195 3196 3197 3198 3199 3200 3201 3202 3203 3204 3205 3206 3207 3208 3209 3210 3211
		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;
3212 3213
	const struct bucket_table *tbl;
	struct rhash_head *pos;
3214 3215
	struct net *net = sock_net(skb->sk);
	struct tipc_net *tn = net_generic(net, tipc_net_id);
3216 3217
	u32 tbl_id = cb->args[0];
	u32 prev_portid = cb->args[1];
3218

3219
	rcu_read_lock();
3220
	tbl = rht_dereference_rcu((&tn->sk_rht)->tbl, &tn->sk_rht);
3221 3222
	for (; tbl_id < tbl->size; tbl_id++) {
		rht_for_each_entry_rcu(tsk, pos, tbl, tbl_id, node) {
3223
			spin_lock_bh(&tsk->sk.sk_lock.slock);
3224 3225 3226 3227 3228
			if (prev_portid && prev_portid != tsk->portid) {
				spin_unlock_bh(&tsk->sk.sk_lock.slock);
				continue;
			}

3229
			err = __tipc_nl_add_sk(skb, cb, tsk);
3230 3231 3232 3233 3234 3235
			if (err) {
				prev_portid = tsk->portid;
				spin_unlock_bh(&tsk->sk.sk_lock.slock);
				goto out;
			}
			prev_portid = 0;
3236 3237
			spin_unlock_bh(&tsk->sk.sk_lock.slock);
		}
3238
	}
3239
out:
3240
	rcu_read_unlock();
3241 3242
	cb->args[0] = tbl_id;
	cb->args[1] = prev_portid;
3243 3244 3245

	return skb->len;
}
3246 3247

/* Caller should hold socket lock for the passed tipc socket. */
3248 3249 3250
static int __tipc_nl_add_sk_publ(struct sk_buff *skb,
				 struct netlink_callback *cb,
				 struct publication *publ)
3251 3252 3253 3254 3255
{
	void *hdr;
	struct nlattr *attrs;

	hdr = genlmsg_put(skb, NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq,
3256
			  &tipc_genl_family, NLM_F_MULTI, TIPC_NL_PUBL_GET);
3257 3258 3259 3260 3261 3262 3263 3264 3265 3266 3267 3268 3269 3270 3271 3272 3273 3274 3275 3276 3277 3278 3279 3280 3281 3282 3283 3284 3285 3286
	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. */
3287 3288 3289
static int __tipc_nl_list_sk_publ(struct sk_buff *skb,
				  struct netlink_callback *cb,
				  struct tipc_sock *tsk, u32 *last_publ)
3290 3291 3292 3293 3294 3295 3296 3297 3298 3299 3300 3301 3302 3303 3304 3305 3306 3307 3308 3309 3310 3311 3312 3313 3314 3315 3316 3317 3318 3319 3320 3321 3322 3323 3324 3325 3326 3327 3328 3329
{
	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;
3330
	u32 tsk_portid = cb->args[0];
3331 3332
	u32 last_publ = cb->args[1];
	u32 done = cb->args[2];
3333
	struct net *net = sock_net(skb->sk);
3334 3335
	struct tipc_sock *tsk;

3336
	if (!tsk_portid) {
3337 3338 3339 3340 3341 3342 3343
		struct nlattr **attrs;
		struct nlattr *sock[TIPC_NLA_SOCK_MAX + 1];

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

3344 3345 3346
		if (!attrs[TIPC_NLA_SOCK])
			return -EINVAL;

3347 3348
		err = nla_parse_nested(sock, TIPC_NLA_SOCK_MAX,
				       attrs[TIPC_NLA_SOCK],
3349
				       tipc_nl_sock_policy, NULL);
3350 3351 3352 3353 3354 3355
		if (err)
			return err;

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

3356
		tsk_portid = nla_get_u32(sock[TIPC_NLA_SOCK_REF]);
3357 3358 3359 3360 3361
	}

	if (done)
		return 0;

3362
	tsk = tipc_sk_lookup(net, tsk_portid);
3363 3364 3365 3366 3367 3368 3369 3370
	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);
3371
	sock_put(&tsk->sk);
3372

3373
	cb->args[0] = tsk_portid;
3374 3375 3376 3377 3378
	cb->args[1] = last_publ;
	cb->args[2] = done;

	return skb->len;
}