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
};
P
Per Liden 已提交
120

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

	return false;
}

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

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

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

	return res;
}

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

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

	return 0;
}

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

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

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

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

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

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

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

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

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

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

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

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

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

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

	sock_put(&tsk->sk);
}

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

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

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

	if (tipc_sk_type_connectionless(sk))
		return;

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

P
Per Liden 已提交
542
/**
543
 * tipc_release - destroy a TIPC socket
P
Per Liden 已提交
544 545 546 547 548 549 550
 * @sock: socket to destroy
 *
 * This routine cleans up any messages that are still queued on the socket.
 * For DGRAM and RDM socket types, all queued messages are rejected.
 * For SEQPACKET and STREAM socket types, the first message is rejected
 * and any others are discarded.  (If the first message on a STREAM socket
 * is partially-read, it is discarded and the next one is rejected instead.)
551
 *
P
Per Liden 已提交
552 553 554 555 556 557
 * NOTE: Rejected messages are not necessarily returned to the sender!  They
 * are returned or discarded according to the "destination droppable" setting
 * specified for the message by the sender.
 *
 * Returns 0 on success, errno otherwise
 */
558
static int tipc_release(struct socket *sock)
P
Per Liden 已提交
559 560
{
	struct sock *sk = sock->sk;
561
	struct tipc_sock *tsk;
P
Per Liden 已提交
562

563 564 565 566 567
	/*
	 * Exit if socket isn't fully initialized (occurs when a failed accept()
	 * releases a pre-allocated child socket that was never used)
	 */
	if (sk == NULL)
P
Per Liden 已提交
568
		return 0;
569

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

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

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

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

/**
591
 * tipc_bind - associate or disassocate TIPC name(s) with a socket
P
Per Liden 已提交
592 593 594
 * @sock: socket structure
 * @uaddr: socket address describing name(s) and desired operation
 * @uaddr_len: size of socket address data structure
595
 *
P
Per Liden 已提交
596 597 598
 * Name and name sequence binding is indicated using a positive scope value;
 * a negative scope value unbinds the specified name.  Specifying no name
 * (i.e. a socket address length of 0) unbinds all names from the socket.
599
 *
P
Per Liden 已提交
600
 * Returns 0 on success, errno otherwise
601 602 603
 *
 * NOTE: This routine doesn't need to take the socket lock since it doesn't
 *       access any non-constant socket information.
P
Per Liden 已提交
604
 */
605 606
static int tipc_bind(struct socket *sock, struct sockaddr *uaddr,
		     int uaddr_len)
P
Per Liden 已提交
607
{
608
	struct sock *sk = sock->sk;
P
Per Liden 已提交
609
	struct sockaddr_tipc *addr = (struct sockaddr_tipc *)uaddr;
610
	struct tipc_sock *tsk = tipc_sk(sk);
611
	int res = -EINVAL;
P
Per Liden 已提交
612

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

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

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

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

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

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

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

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

/**
696
 * tipc_poll - read and possibly block on pollmask
P
Per Liden 已提交
697 698 699 700
 * @file: file structure associated with the socket
 * @sock: socket for which to calculate the poll bits
 * @wait: ???
 *
701 702 703 704 705 706 707 708
 * Returns pollmask value
 *
 * COMMENTARY:
 * It appears that the usual socket locking mechanisms are not useful here
 * since the pollmask info is potentially out-of-date the moment this routine
 * exits.  TCP and other protocols seem to rely on higher level poll routines
 * to handle any preventable race conditions, so TIPC will do the same ...
 *
709 710 711
 * IMPORTANT: The fact that a read or write operation is indicated does NOT
 * imply that the operation will succeed, merely that it should be performed
 * and will not block.
P
Per Liden 已提交
712
 */
713 714
static unsigned int tipc_poll(struct file *file, struct socket *sock,
			      poll_table *wait)
P
Per Liden 已提交
715
{
716
	struct sock *sk = sock->sk;
717
	struct tipc_sock *tsk = tipc_sk(sk);
718
	struct tipc_group *grp;
719
	u32 revents = 0;
720

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

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

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

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

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

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

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

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

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

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

	tipc_nlist_purge(&dsts);
815 816

	return rc ? rc : dlen;
817 818
}

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

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

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

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

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

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

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

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

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

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

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

	return rc ? rc : dlen;
}

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

	INIT_LIST_HEAD(&dsts);

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

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

		/* Look for a non-congested destination member, if any */
		while (1) {
954
			if (!tipc_nametbl_lookup(net, type, inst, scope, &dsts,
955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988 989 990 991 992 993 994
						 &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 已提交
995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007
/**
 * 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)
{
1008
	DECLARE_SOCKADDR(struct sockaddr_tipc *, dest, m->msg_name);
J
Jon Maloy 已提交
1009 1010 1011 1012 1013 1014
	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;
1015
	bool ack = method->mandatory && method->rcast;
1016
	int blks = tsk_blocks(MCAST_H_SIZE + dlen);
J
Jon Maloy 已提交
1017 1018 1019 1020 1021 1022 1023 1024
	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;

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

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

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

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

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

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

	INIT_LIST_HEAD(&dsts);

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

	if (!tipc_nametbl_lookup(net, type, inst, scope, &dsts,
				 &dstcnt, exclude, true))
1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110
		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);
}

1111 1112 1113 1114 1115 1116
/**
 * 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
1117
 */
1118 1119
void tipc_sk_mcast_rcv(struct net *net, struct sk_buff_head *arrvq,
		       struct sk_buff_head *inputq)
1120
{
J
Jon Maloy 已提交
1121
	u32 self = tipc_own_addr(net);
1122
	u32 type, lower, upper, scope;
1123
	struct sk_buff *skb, *_skb;
J
Jon Maloy 已提交
1124
	u32 portid, oport, onode;
1125
	struct sk_buff_head tmpq;
J
Jon Maloy 已提交
1126
	struct list_head dports;
1127 1128 1129
	struct tipc_msg *hdr;
	int user, mtyp, hlen;
	bool exact;
1130

1131
	__skb_queue_head_init(&tmpq);
1132
	INIT_LIST_HEAD(&dports);
1133

1134 1135
	skb = tipc_skb_peek(arrvq, &inputq->lock);
	for (; skb; skb = tipc_skb_peek(arrvq, &inputq->lock)) {
1136 1137 1138 1139 1140 1141 1142 1143
		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);

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

		/* 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 已提交
1170
		}
1171 1172 1173 1174 1175 1176

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

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

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

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

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

1225
	tsk->probe_unacked = false;
1226

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

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

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

	return ret;
}

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

1289
	if (unlikely(dlen > TIPC_MAX_USER_MSG_SIZE))
1290
		return -EMSGSIZE;
1291

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

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

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

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

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

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

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

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

1377 1378 1379 1380
	if (unlikely(syn && !rc))
		tipc_set_sk_state(sk, TIPC_CONNECTING);

	return rc ? rc : dlen;
P
Per Liden 已提交
1381 1382
}

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

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

	return ret;
}

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

1419
	skb_queue_head_init(&pkts);
1420

1421 1422
	if (unlikely(dlen > INT_MAX))
		return -EMSGSIZE;
1423

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

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

1456
	return sent ? sent : rc;
P
Per Liden 已提交
1457 1458
}

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

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

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

1486 1487 1488 1489 1490
	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);
1491

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

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

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

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

	return 0;
}

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

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

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

	if (err)
		return err;
Y
Ying Xue 已提交
1648 1649 1650

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

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

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

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

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

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

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

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

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

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

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

1772
	tsk_advance_rx_queue(sk);
1773

1774 1775 1776
	if (likely(!connected))
		goto exit;

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

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

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

1814
	lock_sock(sk);
P
Per Liden 已提交
1815

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

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

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

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

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

1871 1872
		if (unlikely(peek))
			break;
P
Per Liden 已提交
1873

1874
		tsk_advance_rx_queue(sk);
1875

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

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

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

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

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

	rcu_read_lock();
	wq = rcu_dereference(sk->sk_wq);
H
Herbert Xu 已提交
1918
	if (skwq_has_sleeper(wq))
1919 1920 1921 1922 1923
		wake_up_interruptible_sync_poll(&wq->wait, POLLIN |
						POLLRDNORM | POLLRDBAND);
	rcu_read_unlock();
}

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

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

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

1959 1960 1961
	if (wakeup)
		sk->sk_write_space(sk);

J
Jon Maloy 已提交
1962 1963 1964
	kfree_skb(skb);
}

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

1980 1981
	if (unlikely(msg_mcast(hdr)))
		return false;
1982

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

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

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

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

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

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

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

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

2050
	return false;
2051 2052
}

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

2076 2077 2078
	if (unlikely(msg_in_group(hdr)))
		return sk->sk_rcvbuf;

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

2082 2083
	if (likely(tsk->peer_caps & TIPC_BLOCK_FLOWCTL))
		return sk->sk_rcvbuf;
2084

2085
	return FLOWCTL_MSG_LIM;
2086 2087
}

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

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

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

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

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

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

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

J
Jon Paul Maloy 已提交
2155 2156
	__skb_queue_head_init(&xmitq);

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

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

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

	while (skb_queue_len(inputq)) {
2185
		if (unlikely(time_after_eq(jiffies, time_limit)))
2186 2187
			return;

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

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

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

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

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

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

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

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

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

2307 2308 2309
	if (destlen != sizeof(struct sockaddr_tipc))
		return -EINVAL;

2310 2311
	lock_sock(sk);

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

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

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

2336
	previous = sk->sk_state;
2337 2338 2339

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

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

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

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

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

	lock_sock(sk);
2395
	res = tipc_set_sk_state(sk, TIPC_LISTEN);
2396
	release_sock(sk);
2397

2398
	return res;
P
Per Liden 已提交
2399 2400
}

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

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

2452
	lock_sock(sk);
P
Per Liden 已提交
2453

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

	buf = skb_peek(&sk->sk_receive_queue);

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

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

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

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

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

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

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

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

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

2529
	lock_sock(sk);
P
Per Liden 已提交
2530

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

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

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

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

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

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

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

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

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

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

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

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

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

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

2656 2657 2658
	rhashtable_walk_enter(&tn->sk_rht, &iter);

	do {
2659
		rhashtable_walk_start(&iter);
2660 2661

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

2669 2670
		rhashtable_walk_stop(&iter);
	} while (tsk == ERR_PTR(-EAGAIN));
2671 2672
}

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

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

2684
	return tsk;
2685 2686
}

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

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

2707
	return -1;
2708 2709
}

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

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

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

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

	return rhashtable_init(&tn->sk_rht, &tsk_rht_params);
2736 2737
}

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

2742 2743
	/* Wait for socket readers to complete */
	synchronize_net();
2744

2745
	rhashtable_destroy(&tn->sk_rht);
2746 2747
}

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

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

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

2850
	lock_sock(sk);
2851

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

2886 2887
	release_sock(sk);

P
Per Liden 已提交
2888 2889 2890 2891
	return res;
}

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

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

2922
	lock_sock(sk);
P
Per Liden 已提交
2923 2924 2925

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

2954 2955
	release_sock(sk);

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

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

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

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

3013 3014
/* Protocol switches for the various types of TIPC sockets */

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

	return skb->len;
}
3243 3244

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

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

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

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

3341 3342 3343
		if (!attrs[TIPC_NLA_SOCK])
			return -EINVAL;

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

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

3353
		tsk_portid = nla_get_u32(sock[TIPC_NLA_SOCK_REF]);
3354 3355 3356 3357 3358
	}

	if (done)
		return 0;

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

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

	return skb->len;
}