socket.c 86.3 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 476
	tsk->conn_timeout = CONN_TIMEOUT_DEFAULT;
	atomic_set(&tsk->dupl_rcvcnt, 0);
477

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

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

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

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

	sock_put(&tsk->sk);
}

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

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

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

	if (tipc_sk_type_connectionless(sk))
		return;

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

693
	return 0;
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 1284 1285
	struct sk_buff_head pkts;
	u32 type, inst, domain;
	u32 dnode, dport;
	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 1335
	if (dest->addrtype == TIPC_ADDR_NAME) {
		type = dest->addr.name.name.type;
		inst = dest->addr.name.name.instance;
		domain = dest->addr.name.domain;
1336
		dnode = domain;
1337 1338 1339 1340 1341
		msg_set_type(hdr, TIPC_NAMED_MSG);
		msg_set_hdr_sz(hdr, NAMED_H_SIZE);
		msg_set_nametype(hdr, type);
		msg_set_nameinst(hdr, inst);
		msg_set_lookup_scope(hdr, tipc_addr_scope(domain));
1342
		dport = tipc_nametbl_translate(net, type, inst, &dnode);
1343 1344
		msg_set_destnode(hdr, dnode);
		msg_set_destport(hdr, dport);
1345 1346
		if (unlikely(!dport && !dnode))
			return -EHOSTUNREACH;
1347 1348
	} else if (dest->addrtype == TIPC_ADDR_ID) {
		dnode = dest->addr.id.node;
1349 1350 1351 1352 1353
		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);
1354 1355
	}

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

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

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

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

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

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

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

	return ret;
}

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

1417
	skb_queue_head_init(&pkts);
1418

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

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

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

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

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

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

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

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

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

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

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

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

	return 0;
}

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

1770
	tsk_advance_rx_queue(sk);
1771

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

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

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

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

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

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

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

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

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

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

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

1872
		tsk_advance_rx_queue(sk);
1873

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

2048
	return false;
2049 2050
}

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

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

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

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

2083
	return FLOWCTL_MSG_LIM;
2084 2085
}

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

2308 2309
	lock_sock(sk);

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

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

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

2334
	previous = sk->sk_state;
2335 2336 2337

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

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

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

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

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

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

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

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

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

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

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

	buf = skb_peek(&sk->sk_receive_queue);

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

2654 2655 2656
	rhashtable_walk_enter(&tn->sk_rht, &iter);

	do {
2657
		rhashtable_walk_start(&iter);
2658 2659

		while ((tsk = rhashtable_walk_next(&iter)) && !IS_ERR(tsk)) {
2660 2661
			spin_lock_bh(&tsk->sk.sk_lock.slock);
			msg = &tsk->phdr;
2662 2663
			msg_set_prevnode(msg, tn->own_addr);
			msg_set_orignode(msg, tn->own_addr);
2664 2665
			spin_unlock_bh(&tsk->sk.sk_lock.slock);
		}
2666

2667 2668
		rhashtable_walk_stop(&iter);
	} while (tsk == ERR_PTR(-EAGAIN));
2669 2670
}

2671
static struct tipc_sock *tipc_sk_lookup(struct net *net, u32 portid)
2672
{
2673
	struct tipc_net *tn = net_generic(net, tipc_net_id);
2674
	struct tipc_sock *tsk;
2675

2676
	rcu_read_lock();
2677
	tsk = rhashtable_lookup_fast(&tn->sk_rht, &portid, tsk_rht_params);
2678 2679 2680
	if (tsk)
		sock_hold(&tsk->sk);
	rcu_read_unlock();
2681

2682
	return tsk;
2683 2684
}

2685
static int tipc_sk_insert(struct tipc_sock *tsk)
2686
{
2687 2688 2689
	struct sock *sk = &tsk->sk;
	struct net *net = sock_net(sk);
	struct tipc_net *tn = net_generic(net, tipc_net_id);
2690 2691
	u32 remaining = (TIPC_MAX_PORT - TIPC_MIN_PORT) + 1;
	u32 portid = prandom_u32() % remaining + TIPC_MIN_PORT;
2692

2693 2694 2695 2696 2697 2698
	while (remaining--) {
		portid++;
		if ((portid < TIPC_MIN_PORT) || (portid > TIPC_MAX_PORT))
			portid = TIPC_MIN_PORT;
		tsk->portid = portid;
		sock_hold(&tsk->sk);
2699 2700
		if (!rhashtable_lookup_insert_fast(&tn->sk_rht, &tsk->node,
						   tsk_rht_params))
2701 2702
			return 0;
		sock_put(&tsk->sk);
2703 2704
	}

2705
	return -1;
2706 2707
}

2708
static void tipc_sk_remove(struct tipc_sock *tsk)
2709
{
2710
	struct sock *sk = &tsk->sk;
2711
	struct tipc_net *tn = net_generic(sock_net(sk), tipc_net_id);
2712

2713
	if (!rhashtable_remove_fast(&tn->sk_rht, &tsk->node, tsk_rht_params)) {
2714
		WARN_ON(refcount_read(&sk->sk_refcnt) == 1);
2715
		__sock_put(sk);
2716 2717 2718
	}
}

2719 2720 2721 2722 2723 2724 2725
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,
2726
	.automatic_shrinking = true,
2727 2728
};

2729
int tipc_sk_rht_init(struct net *net)
2730
{
2731
	struct tipc_net *tn = net_generic(net, tipc_net_id);
2732 2733

	return rhashtable_init(&tn->sk_rht, &tsk_rht_params);
2734 2735
}

2736
void tipc_sk_rht_destroy(struct net *net)
2737
{
2738 2739
	struct tipc_net *tn = net_generic(net, tipc_net_id);

2740 2741
	/* Wait for socket readers to complete */
	synchronize_net();
2742

2743
	rhashtable_destroy(&tn->sk_rht);
2744 2745
}

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

2822 2823
	if ((lvl == IPPROTO_TCP) && (sock->type == SOCK_STREAM))
		return 0;
P
Per Liden 已提交
2824 2825
	if (lvl != SOL_TIPC)
		return -ENOPROTOOPT;
2826 2827 2828 2829 2830 2831 2832 2833

	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 已提交
2834 2835 2836 2837 2838 2839 2840 2841
		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;
2842 2843 2844 2845 2846
		break;
	default:
		if (ov || ol)
			return -EINVAL;
	}
P
Per Liden 已提交
2847

2848
	lock_sock(sk);
2849

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

2884 2885
	release_sock(sk);

P
Per Liden 已提交
2886 2887 2888 2889
	return res;
}

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

2912 2913
	if ((lvl == IPPROTO_TCP) && (sock->type == SOCK_STREAM))
		return put_user(0, ol);
P
Per Liden 已提交
2914 2915
	if (lvl != SOL_TIPC)
		return -ENOPROTOOPT;
2916 2917
	res = get_user(len, ol);
	if (res)
2918
		return res;
P
Per Liden 已提交
2919

2920
	lock_sock(sk);
P
Per Liden 已提交
2921 2922 2923

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

2952 2953
	release_sock(sk);

2954 2955
	if (res)
		return res;	/* "get" failed */
P
Per Liden 已提交
2956

2957 2958 2959 2960 2961 2962 2963
	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 已提交
2964 2965
}

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

2989 2990 2991 2992
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 已提交
2993 2994 2995 2996 2997 2998 2999 3000 3001 3002 3003 3004 3005 3006 3007
	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);
3008 3009 3010
	return 0;
}

3011 3012
/* Protocol switches for the various types of TIPC sockets */

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

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

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

3076
static const struct net_proto_family tipc_family_ops = {
3077
	.owner		= THIS_MODULE,
P
Per Liden 已提交
3078
	.family		= AF_TIPC,
3079
	.create		= tipc_sk_create
P
Per Liden 已提交
3080 3081 3082 3083 3084
};

static struct proto tipc_proto = {
	.name		= "TIPC",
	.owner		= THIS_MODULE,
3085 3086
	.obj_size	= sizeof(struct tipc_sock),
	.sysctl_rmem	= sysctl_tipc_rmem
P
Per Liden 已提交
3087 3088 3089
};

/**
3090
 * tipc_socket_init - initialize TIPC socket interface
3091
 *
P
Per Liden 已提交
3092 3093
 * Returns 0 on success, errno otherwise
 */
3094
int tipc_socket_init(void)
P
Per Liden 已提交
3095 3096 3097
{
	int res;

3098
	res = proto_register(&tipc_proto, 1);
P
Per Liden 已提交
3099
	if (res) {
3100
		pr_err("Failed to register TIPC protocol type\n");
P
Per Liden 已提交
3101 3102 3103 3104 3105
		goto out;
	}

	res = sock_register(&tipc_family_ops);
	if (res) {
3106
		pr_err("Failed to register TIPC socket type\n");
P
Per Liden 已提交
3107 3108 3109 3110 3111 3112 3113 3114
		proto_unregister(&tipc_proto);
		goto out;
	}
 out:
	return res;
}

/**
3115
 * tipc_socket_stop - stop TIPC socket interface
P
Per Liden 已提交
3116
 */
3117
void tipc_socket_stop(void)
P
Per Liden 已提交
3118 3119 3120 3121
{
	sock_unregister(tipc_family_ops.family);
	proto_unregister(&tipc_proto);
}
3122 3123

/* Caller should hold socket lock for the passed tipc socket. */
3124
static int __tipc_nl_add_sk_con(struct sk_buff *skb, struct tipc_sock *tsk)
3125 3126 3127 3128 3129 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
{
	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. */
3159 3160
static int __tipc_nl_add_sk(struct sk_buff *skb, struct netlink_callback *cb,
			    struct tipc_sock *tsk)
3161 3162 3163 3164
{
	int err;
	void *hdr;
	struct nlattr *attrs;
3165 3166
	struct net *net = sock_net(skb->sk);
	struct tipc_net *tn = net_generic(net, tipc_net_id);
3167
	struct sock *sk = &tsk->sk;
3168 3169

	hdr = genlmsg_put(skb, NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq,
3170
			  &tipc_genl_family, NLM_F_MULTI, TIPC_NL_SOCK_GET);
3171 3172 3173 3174 3175 3176
	if (!hdr)
		goto msg_cancel;

	attrs = nla_nest_start(skb, TIPC_NLA_SOCK);
	if (!attrs)
		goto genlmsg_cancel;
3177
	if (nla_put_u32(skb, TIPC_NLA_SOCK_REF, tsk->portid))
3178
		goto attr_msg_cancel;
3179
	if (nla_put_u32(skb, TIPC_NLA_SOCK_ADDR, tn->own_addr))
3180 3181
		goto attr_msg_cancel;

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

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

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

	return skb->len;
}
3241 3242

/* Caller should hold socket lock for the passed tipc socket. */
3243 3244 3245
static int __tipc_nl_add_sk_publ(struct sk_buff *skb,
				 struct netlink_callback *cb,
				 struct publication *publ)
3246 3247 3248 3249 3250
{
	void *hdr;
	struct nlattr *attrs;

	hdr = genlmsg_put(skb, NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq,
3251
			  &tipc_genl_family, NLM_F_MULTI, TIPC_NL_PUBL_GET);
3252 3253 3254 3255 3256 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
	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. */
3282 3283 3284
static int __tipc_nl_list_sk_publ(struct sk_buff *skb,
				  struct netlink_callback *cb,
				  struct tipc_sock *tsk, u32 *last_publ)
3285 3286 3287 3288 3289 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
{
	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;
3325
	u32 tsk_portid = cb->args[0];
3326 3327
	u32 last_publ = cb->args[1];
	u32 done = cb->args[2];
3328
	struct net *net = sock_net(skb->sk);
3329 3330
	struct tipc_sock *tsk;

3331
	if (!tsk_portid) {
3332 3333 3334 3335 3336 3337 3338
		struct nlattr **attrs;
		struct nlattr *sock[TIPC_NLA_SOCK_MAX + 1];

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

3339 3340 3341
		if (!attrs[TIPC_NLA_SOCK])
			return -EINVAL;

3342 3343
		err = nla_parse_nested(sock, TIPC_NLA_SOCK_MAX,
				       attrs[TIPC_NLA_SOCK],
3344
				       tipc_nl_sock_policy, NULL);
3345 3346 3347 3348 3349 3350
		if (err)
			return err;

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

3351
		tsk_portid = nla_get_u32(sock[TIPC_NLA_SOCK_REF]);
3352 3353 3354 3355 3356
	}

	if (done)
		return 0;

3357
	tsk = tipc_sk_lookup(net, tsk_portid);
3358 3359 3360 3361 3362 3363 3364 3365
	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);
3366
	sock_put(&tsk->sk);
3367

3368
	cb->args[0] = tsk_portid;
3369 3370 3371 3372 3373
	cb->args[1] = last_publ;
	cb->args[2] = done;

	return skb->len;
}