l2cap_sock.c 35.5 KB
Newer Older
1 2 3 4 5
/*
   BlueZ - Bluetooth protocol stack for Linux
   Copyright (C) 2000-2001 Qualcomm Incorporated
   Copyright (C) 2009-2010 Gustavo F. Padovan <gustavo@padovan.org>
   Copyright (C) 2010 Google Inc.
6
   Copyright (C) 2011 ProFUSION Embedded Systems
7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29

   Written 2000,2001 by Maxim Krasnyansky <maxk@qualcomm.com>

   This program is free software; you can redistribute it and/or modify
   it under the terms of the GNU General Public License version 2 as
   published by the Free Software Foundation;

   THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
   OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
   FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS.
   IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY
   CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES
   WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
   ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
   OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.

   ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS,
   COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS
   SOFTWARE IS DISCLAIMED.
*/

/* Bluetooth L2CAP sockets. */

30
#include <linux/module.h>
31
#include <linux/export.h>
32

33
#include <net/bluetooth/bluetooth.h>
34
#include <net/bluetooth/hci_core.h>
35
#include <net/bluetooth/l2cap.h>
36 37

#include "smp.h"
38

39 40 41 42
static struct bt_sock_list l2cap_sk_list = {
	.lock = __RW_LOCK_UNLOCKED(l2cap_sk_list.lock)
};

43
static const struct proto_ops l2cap_sock_ops;
44
static void l2cap_sock_init(struct sock *sk, struct sock *parent);
45
static struct sock *l2cap_sock_alloc(struct net *net, struct socket *sock,
46
				     int proto, gfp_t prio, int kern);
47

48 49 50 51 52 53
bool l2cap_is_socket(struct socket *sock)
{
	return sock && sock->ops == &l2cap_sock_ops;
}
EXPORT_SYMBOL(l2cap_is_socket);

54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79
static int l2cap_validate_bredr_psm(u16 psm)
{
	/* PSM must be odd and lsb of upper byte must be 0 */
	if ((psm & 0x0101) != 0x0001)
		return -EINVAL;

	/* Restrict usage of well-known PSMs */
	if (psm < 0x1001 && !capable(CAP_NET_BIND_SERVICE))
		return -EACCES;

	return 0;
}

static int l2cap_validate_le_psm(u16 psm)
{
	/* Valid LE_PSM ranges are defined only until 0x00ff */
	if (psm > 0x00ff)
		return -EINVAL;

	/* Restrict fixed, SIG assigned PSM values to CAP_NET_BIND_SERVICE */
	if (psm <= 0x007f && !capable(CAP_NET_BIND_SERVICE))
		return -EACCES;

	return 0;
}

80 81 82
static int l2cap_sock_bind(struct socket *sock, struct sockaddr *addr, int alen)
{
	struct sock *sk = sock->sk;
83
	struct l2cap_chan *chan = l2cap_pi(sk)->chan;
84 85 86 87 88 89 90 91 92 93 94 95
	struct sockaddr_l2 la;
	int len, err = 0;

	BT_DBG("sk %p", sk);

	if (!addr || addr->sa_family != AF_BLUETOOTH)
		return -EINVAL;

	memset(&la, 0, sizeof(la));
	len = min_t(unsigned int, sizeof(la), alen);
	memcpy(&la, addr, len);

96
	if (la.l2_cid && la.l2_psm)
97 98
		return -EINVAL;

99 100 101
	if (!bdaddr_type_is_valid(la.l2_bdaddr_type))
		return -EINVAL;

102 103
	if (bdaddr_type_is_le(la.l2_bdaddr_type)) {
		/* We only allow ATT user space socket */
104
		if (la.l2_cid &&
105
		    la.l2_cid != cpu_to_le16(L2CAP_CID_ATT))
106 107 108
			return -EINVAL;
	}

109 110 111 112 113 114 115 116 117 118
	lock_sock(sk);

	if (sk->sk_state != BT_OPEN) {
		err = -EBADFD;
		goto done;
	}

	if (la.l2_psm) {
		__u16 psm = __le16_to_cpu(la.l2_psm);

119 120 121 122
		if (la.l2_bdaddr_type == BDADDR_BREDR)
			err = l2cap_validate_bredr_psm(psm);
		else
			err = l2cap_validate_le_psm(psm);
123

124
		if (err)
125 126 127
			goto done;
	}

128
	if (la.l2_cid)
S
Santosh Nayak 已提交
129
		err = l2cap_add_scid(chan, __le16_to_cpu(la.l2_cid));
130 131
	else
		err = l2cap_add_psm(chan, &la.l2_bdaddr, la.l2_psm);
132

133 134
	if (err < 0)
		goto done;
135

136
	switch (chan->chan_type) {
137 138 139 140
	case L2CAP_CHAN_CONN_LESS:
		if (__le16_to_cpu(la.l2_psm) == L2CAP_PSM_3DSP)
			chan->sec_level = BT_SECURITY_SDP;
		break;
141 142 143 144 145
	case L2CAP_CHAN_CONN_ORIENTED:
		if (__le16_to_cpu(la.l2_psm) == L2CAP_PSM_SDP ||
		    __le16_to_cpu(la.l2_psm) == L2CAP_PSM_RFCOMM)
			chan->sec_level = BT_SECURITY_SDP;
		break;
146 147 148
	case L2CAP_CHAN_RAW:
		chan->sec_level = BT_SECURITY_SDP;
		break;
149 150 151 152 153 154 155 156
	case L2CAP_CHAN_FIXED:
		/* Fixed channels default to the L2CAP core not holding a
		 * hci_conn reference for them. For fixed channels mapping to
		 * L2CAP sockets we do want to hold a reference so set the
		 * appropriate flag to request it.
		 */
		set_bit(FLAG_HOLD_HCI_CONN, &chan->flags);
		break;
157
	}
158

159
	bacpy(&chan->src, &la.l2_bdaddr);
160
	chan->src_type = la.l2_bdaddr_type;
161

162
	if (chan->psm && bdaddr_type_is_le(chan->src_type))
163
		chan->mode = L2CAP_MODE_LE_FLOWCTL;
164

165
	chan->state = BT_BOUND;
166
	sk->sk_state = BT_BOUND;
167 168 169 170 171 172

done:
	release_sock(sk);
	return err;
}

173 174
static int l2cap_sock_connect(struct socket *sock, struct sockaddr *addr,
			      int alen, int flags)
175 176
{
	struct sock *sk = sock->sk;
177
	struct l2cap_chan *chan = l2cap_pi(sk)->chan;
178 179 180 181 182 183 184 185 186 187 188 189 190
	struct sockaddr_l2 la;
	int len, err = 0;

	BT_DBG("sk %p", sk);

	if (!addr || alen < sizeof(addr->sa_family) ||
	    addr->sa_family != AF_BLUETOOTH)
		return -EINVAL;

	memset(&la, 0, sizeof(la));
	len = min_t(unsigned int, sizeof(la), alen);
	memcpy(&la, addr, len);

191
	if (la.l2_cid && la.l2_psm)
192 193
		return -EINVAL;

194 195 196
	if (!bdaddr_type_is_valid(la.l2_bdaddr_type))
		return -EINVAL;

197 198 199 200 201 202 203 204 205 206 207 208 209 210
	/* Check that the socket wasn't bound to something that
	 * conflicts with the address given to connect(). If chan->src
	 * is BDADDR_ANY it means bind() was never used, in which case
	 * chan->src_type and la.l2_bdaddr_type do not need to match.
	 */
	if (chan->src_type == BDADDR_BREDR && bacmp(&chan->src, BDADDR_ANY) &&
	    bdaddr_type_is_le(la.l2_bdaddr_type)) {
		/* Old user space versions will try to incorrectly bind
		 * the ATT socket using BDADDR_BREDR. We need to accept
		 * this and fix up the source address type only when
		 * both the source CID and destination CID indicate
		 * ATT. Anything else is an invalid combination.
		 */
		if (chan->scid != L2CAP_CID_ATT ||
211
		    la.l2_cid != cpu_to_le16(L2CAP_CID_ATT))
212 213 214 215 216 217 218 219 220 221
			return -EINVAL;

		/* We don't have the hdev available here to make a
		 * better decision on random vs public, but since all
		 * user space versions that exhibit this issue anyway do
		 * not support random local addresses assuming public
		 * here is good enough.
		 */
		chan->src_type = BDADDR_LE_PUBLIC;
	}
222 223 224 225

	if (chan->src_type != BDADDR_BREDR && la.l2_bdaddr_type == BDADDR_BREDR)
		return -EINVAL;

226 227
	if (bdaddr_type_is_le(la.l2_bdaddr_type)) {
		/* We only allow ATT user space socket */
228
		if (la.l2_cid &&
229
		    la.l2_cid != cpu_to_le16(L2CAP_CID_ATT))
230 231 232
			return -EINVAL;
	}

233
	if (chan->psm && bdaddr_type_is_le(chan->src_type))
234
		chan->mode = L2CAP_MODE_LE_FLOWCTL;
235

S
Santosh Nayak 已提交
236
	err = l2cap_chan_connect(chan, la.l2_psm, __le16_to_cpu(la.l2_cid),
237
				 &la.l2_bdaddr, la.l2_bdaddr_type);
238
	if (err)
239
		return err;
240

241 242
	lock_sock(sk);

243
	err = bt_sock_wait_state(sk, BT_CONNECTED,
244
				 sock_sndtimeo(sk, flags & O_NONBLOCK));
245 246 247

	release_sock(sk);

248 249 250
	return err;
}

251 252 253
static int l2cap_sock_listen(struct socket *sock, int backlog)
{
	struct sock *sk = sock->sk;
254
	struct l2cap_chan *chan = l2cap_pi(sk)->chan;
255 256 257 258 259 260
	int err = 0;

	BT_DBG("sk %p backlog %d", sk, backlog);

	lock_sock(sk);

261
	if (sk->sk_state != BT_BOUND) {
262 263 264 265
		err = -EBADFD;
		goto done;
	}

266 267 268 269 270
	if (sk->sk_type != SOCK_SEQPACKET && sk->sk_type != SOCK_STREAM) {
		err = -EINVAL;
		goto done;
	}

271
	switch (chan->mode) {
272
	case L2CAP_MODE_BASIC:
273
	case L2CAP_MODE_LE_FLOWCTL:
274 275 276 277 278 279 280
		break;
	case L2CAP_MODE_ERTM:
	case L2CAP_MODE_STREAMING:
		if (!disable_ertm)
			break;
		/* fall through */
	default:
281
		err = -EOPNOTSUPP;
282 283 284 285 286
		goto done;
	}

	sk->sk_max_ack_backlog = backlog;
	sk->sk_ack_backlog = 0;
287

288 289 290 291 292 293
	/* Listening channels need to use nested locking in order not to
	 * cause lockdep warnings when the created child channels end up
	 * being locked in the same thread as the parent channel.
	 */
	atomic_set(&chan->nesting, L2CAP_NESTING_PARENT);

294
	chan->state = BT_LISTEN;
295 296 297 298 299 300 301
	sk->sk_state = BT_LISTEN;

done:
	release_sock(sk);
	return err;
}

302 303
static int l2cap_sock_accept(struct socket *sock, struct socket *newsock,
			     int flags)
304
{
P
Peter Hurley 已提交
305
	DEFINE_WAIT_FUNC(wait, woken_wake_function);
306 307 308 309
	struct sock *sk = sock->sk, *nsk;
	long timeo;
	int err = 0;

310
	lock_sock_nested(sk, L2CAP_NESTING_PARENT);
311 312 313 314 315 316 317

	timeo = sock_rcvtimeo(sk, flags & O_NONBLOCK);

	BT_DBG("sk %p timeo %ld", sk, timeo);

	/* Wait for an incoming connection. (wake-one). */
	add_wait_queue_exclusive(sk_sleep(sk), &wait);
318 319 320
	while (1) {
		if (sk->sk_state != BT_LISTEN) {
			err = -EBADFD;
321 322 323
			break;
		}

324 325 326
		nsk = bt_accept_dequeue(sk, newsock);
		if (nsk)
			break;
327

328 329
		if (!timeo) {
			err = -EAGAIN;
330 331 332 333 334 335 336
			break;
		}

		if (signal_pending(current)) {
			err = sock_intr_errno(timeo);
			break;
		}
337 338

		release_sock(sk);
P
Peter Hurley 已提交
339 340 341

		timeo = wait_woken(&wait, TASK_INTERRUPTIBLE, timeo);

342
		lock_sock_nested(sk, L2CAP_NESTING_PARENT);
343 344 345 346 347 348 349 350 351 352 353 354 355 356 357
	}
	remove_wait_queue(sk_sleep(sk), &wait);

	if (err)
		goto done;

	newsock->state = SS_CONNECTED;

	BT_DBG("new socket %p", nsk);

done:
	release_sock(sk);
	return err;
}

358 359
static int l2cap_sock_getname(struct socket *sock, struct sockaddr *addr,
			      int *len, int peer)
360 361 362
{
	struct sockaddr_l2 *la = (struct sockaddr_l2 *) addr;
	struct sock *sk = sock->sk;
363
	struct l2cap_chan *chan = l2cap_pi(sk)->chan;
364 365 366

	BT_DBG("sock %p, sk %p", sock, sk);

367
	if (peer && sk->sk_state != BT_CONNECTED &&
368 369
	    sk->sk_state != BT_CONNECT && sk->sk_state != BT_CONNECT2 &&
	    sk->sk_state != BT_CONFIG)
370 371
		return -ENOTCONN;

372
	memset(la, 0, sizeof(struct sockaddr_l2));
373 374 375
	addr->sa_family = AF_BLUETOOTH;
	*len = sizeof(struct sockaddr_l2);

376 377
	la->l2_psm = chan->psm;

378
	if (peer) {
379
		bacpy(&la->l2_bdaddr, &chan->dst);
380
		la->l2_cid = cpu_to_le16(chan->dcid);
381
		la->l2_bdaddr_type = chan->dst_type;
382
	} else {
383
		bacpy(&la->l2_bdaddr, &chan->src);
384
		la->l2_cid = cpu_to_le16(chan->scid);
385
		la->l2_bdaddr_type = chan->src_type;
386 387 388 389 390
	}

	return 0;
}

391 392
static int l2cap_sock_getsockopt_old(struct socket *sock, int optname,
				     char __user *optval, int __user *optlen)
393 394
{
	struct sock *sk = sock->sk;
395
	struct l2cap_chan *chan = l2cap_pi(sk)->chan;
396 397 398 399 400 401 402 403 404 405 406 407 408 409
	struct l2cap_options opts;
	struct l2cap_conninfo cinfo;
	int len, err = 0;
	u32 opt;

	BT_DBG("sk %p", sk);

	if (get_user(len, optlen))
		return -EFAULT;

	lock_sock(sk);

	switch (optname) {
	case L2CAP_OPTIONS:
410 411 412 413 414 415 416 417 418 419
		/* LE sockets should use BT_SNDMTU/BT_RCVMTU, but since
		 * legacy ATT code depends on getsockopt for
		 * L2CAP_OPTIONS we need to let this pass.
		 */
		if (bdaddr_type_is_le(chan->src_type) &&
		    chan->scid != L2CAP_CID_ATT) {
			err = -EINVAL;
			break;
		}

420
		memset(&opts, 0, sizeof(opts));
421 422 423 424
		opts.imtu     = chan->imtu;
		opts.omtu     = chan->omtu;
		opts.flush_to = chan->flush_to;
		opts.mode     = chan->mode;
425 426
		opts.fcs      = chan->fcs;
		opts.max_tx   = chan->max_tx;
427
		opts.txwin_size = chan->tx_win;
428 429 430 431 432 433 434 435

		len = min_t(unsigned int, len, sizeof(opts));
		if (copy_to_user(optval, (char *) &opts, len))
			err = -EFAULT;

		break;

	case L2CAP_LM:
436
		switch (chan->sec_level) {
437 438 439 440 441 442 443 444
		case BT_SECURITY_LOW:
			opt = L2CAP_LM_AUTH;
			break;
		case BT_SECURITY_MEDIUM:
			opt = L2CAP_LM_AUTH | L2CAP_LM_ENCRYPT;
			break;
		case BT_SECURITY_HIGH:
			opt = L2CAP_LM_AUTH | L2CAP_LM_ENCRYPT |
445
			      L2CAP_LM_SECURE;
446
			break;
447 448 449 450
		case BT_SECURITY_FIPS:
			opt = L2CAP_LM_AUTH | L2CAP_LM_ENCRYPT |
			      L2CAP_LM_SECURE | L2CAP_LM_FIPS;
			break;
451 452 453 454 455
		default:
			opt = 0;
			break;
		}

456
		if (test_bit(FLAG_ROLE_SWITCH, &chan->flags))
457 458
			opt |= L2CAP_LM_MASTER;

459
		if (test_bit(FLAG_FORCE_RELIABLE, &chan->flags))
460 461 462 463
			opt |= L2CAP_LM_RELIABLE;

		if (put_user(opt, (u32 __user *) optval))
			err = -EFAULT;
464

465 466 467 468
		break;

	case L2CAP_CONNINFO:
		if (sk->sk_state != BT_CONNECTED &&
469 470
		    !(sk->sk_state == BT_CONNECT2 &&
		      test_bit(BT_SK_DEFER_SETUP, &bt_sk(sk)->flags))) {
471 472 473 474
			err = -ENOTCONN;
			break;
		}

475
		memset(&cinfo, 0, sizeof(cinfo));
476 477
		cinfo.hci_handle = chan->conn->hcon->handle;
		memcpy(cinfo.dev_class, chan->conn->hcon->dev_class, 3);
478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493

		len = min_t(unsigned int, len, sizeof(cinfo));
		if (copy_to_user(optval, (char *) &cinfo, len))
			err = -EFAULT;

		break;

	default:
		err = -ENOPROTOOPT;
		break;
	}

	release_sock(sk);
	return err;
}

494 495
static int l2cap_sock_getsockopt(struct socket *sock, int level, int optname,
				 char __user *optval, int __user *optlen)
496 497
{
	struct sock *sk = sock->sk;
498
	struct l2cap_chan *chan = l2cap_pi(sk)->chan;
499
	struct bt_security sec;
500
	struct bt_power pwr;
501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517
	int len, err = 0;

	BT_DBG("sk %p", sk);

	if (level == SOL_L2CAP)
		return l2cap_sock_getsockopt_old(sock, optname, optval, optlen);

	if (level != SOL_BLUETOOTH)
		return -ENOPROTOOPT;

	if (get_user(len, optlen))
		return -EFAULT;

	lock_sock(sk);

	switch (optname) {
	case BT_SECURITY:
518
		if (chan->chan_type != L2CAP_CHAN_CONN_ORIENTED &&
519
		    chan->chan_type != L2CAP_CHAN_FIXED &&
520
		    chan->chan_type != L2CAP_CHAN_RAW) {
521 522 523 524
			err = -EINVAL;
			break;
		}

525
		memset(&sec, 0, sizeof(sec));
526
		if (chan->conn) {
527
			sec.level = chan->conn->hcon->sec_level;
528

529 530 531 532 533
			if (sk->sk_state == BT_CONNECTED)
				sec.key_size = chan->conn->hcon->enc_key_size;
		} else {
			sec.level = chan->sec_level;
		}
534

535 536 537 538 539 540 541 542 543 544 545 546
		len = min_t(unsigned int, len, sizeof(sec));
		if (copy_to_user(optval, (char *) &sec, len))
			err = -EFAULT;

		break;

	case BT_DEFER_SETUP:
		if (sk->sk_state != BT_BOUND && sk->sk_state != BT_LISTEN) {
			err = -EINVAL;
			break;
		}

547 548
		if (put_user(test_bit(BT_SK_DEFER_SETUP, &bt_sk(sk)->flags),
			     (u32 __user *) optval))
549 550 551 552 553
			err = -EFAULT;

		break;

	case BT_FLUSHABLE:
554
		if (put_user(test_bit(FLAG_FLUSHABLE, &chan->flags),
555
			     (u32 __user *) optval))
556 557 558 559
			err = -EFAULT;

		break;

560 561
	case BT_POWER:
		if (sk->sk_type != SOCK_SEQPACKET && sk->sk_type != SOCK_STREAM
562
		    && sk->sk_type != SOCK_RAW) {
563 564 565 566
			err = -EINVAL;
			break;
		}

567
		pwr.force_active = test_bit(FLAG_FORCE_ACTIVE, &chan->flags);
568 569 570 571 572 573 574

		len = min_t(unsigned int, len, sizeof(pwr));
		if (copy_to_user(optval, (char *) &pwr, len))
			err = -EFAULT;

		break;

575 576 577 578 579
	case BT_CHANNEL_POLICY:
		if (put_user(chan->chan_policy, (u32 __user *) optval))
			err = -EFAULT;
		break;

580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604
	case BT_SNDMTU:
		if (!bdaddr_type_is_le(chan->src_type)) {
			err = -EINVAL;
			break;
		}

		if (sk->sk_state != BT_CONNECTED) {
			err = -ENOTCONN;
			break;
		}

		if (put_user(chan->omtu, (u16 __user *) optval))
			err = -EFAULT;
		break;

	case BT_RCVMTU:
		if (!bdaddr_type_is_le(chan->src_type)) {
			err = -EINVAL;
			break;
		}

		if (put_user(chan->imtu, (u16 __user *) optval))
			err = -EFAULT;
		break;

605 606 607 608 609 610 611 612 613
	default:
		err = -ENOPROTOOPT;
		break;
	}

	release_sock(sk);
	return err;
}

614 615 616
static bool l2cap_valid_mtu(struct l2cap_chan *chan, u16 mtu)
{
	switch (chan->scid) {
617
	case L2CAP_CID_ATT:
618
		if (mtu < L2CAP_LE_MIN_MTU)
619 620 621 622 623 624 625 626 627 628 629
			return false;
		break;

	default:
		if (mtu < L2CAP_DEFAULT_MIN_MTU)
			return false;
	}

	return true;
}

630 631
static int l2cap_sock_setsockopt_old(struct socket *sock, int optname,
				     char __user *optval, unsigned int optlen)
632 633
{
	struct sock *sk = sock->sk;
634
	struct l2cap_chan *chan = l2cap_pi(sk)->chan;
635 636 637 638 639 640 641 642 643 644
	struct l2cap_options opts;
	int len, err = 0;
	u32 opt;

	BT_DBG("sk %p", sk);

	lock_sock(sk);

	switch (optname) {
	case L2CAP_OPTIONS:
645 646 647 648 649
		if (bdaddr_type_is_le(chan->src_type)) {
			err = -EINVAL;
			break;
		}

650 651 652 653 654
		if (sk->sk_state == BT_CONNECTED) {
			err = -EINVAL;
			break;
		}

655 656 657 658
		opts.imtu     = chan->imtu;
		opts.omtu     = chan->omtu;
		opts.flush_to = chan->flush_to;
		opts.mode     = chan->mode;
659 660
		opts.fcs      = chan->fcs;
		opts.max_tx   = chan->max_tx;
661
		opts.txwin_size = chan->tx_win;
662 663 664 665 666 667 668

		len = min_t(unsigned int, sizeof(opts), optlen);
		if (copy_from_user((char *) &opts, optval, len)) {
			err = -EFAULT;
			break;
		}

669
		if (opts.txwin_size > L2CAP_DEFAULT_EXT_WINDOW) {
670 671 672 673
			err = -EINVAL;
			break;
		}

674 675 676 677 678
		if (!l2cap_valid_mtu(chan, opts.imtu)) {
			err = -EINVAL;
			break;
		}

679 680
		chan->mode = opts.mode;
		switch (chan->mode) {
681 682
		case L2CAP_MODE_LE_FLOWCTL:
			break;
683
		case L2CAP_MODE_BASIC:
684
			clear_bit(CONF_STATE2_DEVICE, &chan->conf_state);
685 686 687 688 689 690 691 692 693 694 695
			break;
		case L2CAP_MODE_ERTM:
		case L2CAP_MODE_STREAMING:
			if (!disable_ertm)
				break;
			/* fall through */
		default:
			err = -EINVAL;
			break;
		}

696 697
		chan->imtu = opts.imtu;
		chan->omtu = opts.omtu;
698 699
		chan->fcs  = opts.fcs;
		chan->max_tx = opts.max_tx;
700
		chan->tx_win = opts.txwin_size;
701
		chan->flush_to = opts.flush_to;
702 703 704 705 706 707 708 709
		break;

	case L2CAP_LM:
		if (get_user(opt, (u32 __user *) optval)) {
			err = -EFAULT;
			break;
		}

710 711 712 713 714
		if (opt & L2CAP_LM_FIPS) {
			err = -EINVAL;
			break;
		}

715
		if (opt & L2CAP_LM_AUTH)
716
			chan->sec_level = BT_SECURITY_LOW;
717
		if (opt & L2CAP_LM_ENCRYPT)
718
			chan->sec_level = BT_SECURITY_MEDIUM;
719
		if (opt & L2CAP_LM_SECURE)
720
			chan->sec_level = BT_SECURITY_HIGH;
721

722 723 724 725
		if (opt & L2CAP_LM_MASTER)
			set_bit(FLAG_ROLE_SWITCH, &chan->flags);
		else
			clear_bit(FLAG_ROLE_SWITCH, &chan->flags);
726 727 728 729 730

		if (opt & L2CAP_LM_RELIABLE)
			set_bit(FLAG_FORCE_RELIABLE, &chan->flags);
		else
			clear_bit(FLAG_FORCE_RELIABLE, &chan->flags);
731 732 733 734 735 736 737 738 739 740 741
		break;

	default:
		err = -ENOPROTOOPT;
		break;
	}

	release_sock(sk);
	return err;
}

742 743
static int l2cap_sock_setsockopt(struct socket *sock, int level, int optname,
				 char __user *optval, unsigned int optlen)
744 745
{
	struct sock *sk = sock->sk;
746
	struct l2cap_chan *chan = l2cap_pi(sk)->chan;
747
	struct bt_security sec;
748
	struct bt_power pwr;
749
	struct l2cap_conn *conn;
750 751 752 753 754 755 756 757 758 759 760 761 762 763 764
	int len, err = 0;
	u32 opt;

	BT_DBG("sk %p", sk);

	if (level == SOL_L2CAP)
		return l2cap_sock_setsockopt_old(sock, optname, optval, optlen);

	if (level != SOL_BLUETOOTH)
		return -ENOPROTOOPT;

	lock_sock(sk);

	switch (optname) {
	case BT_SECURITY:
765
		if (chan->chan_type != L2CAP_CHAN_CONN_ORIENTED &&
766
		    chan->chan_type != L2CAP_CHAN_FIXED &&
767
		    chan->chan_type != L2CAP_CHAN_RAW) {
768 769 770 771 772 773 774 775 776 777 778 779 780
			err = -EINVAL;
			break;
		}

		sec.level = BT_SECURITY_LOW;

		len = min_t(unsigned int, sizeof(sec), optlen);
		if (copy_from_user((char *) &sec, optval, len)) {
			err = -EFAULT;
			break;
		}

		if (sec.level < BT_SECURITY_LOW ||
781
		    sec.level > BT_SECURITY_HIGH) {
782 783 784 785
			err = -EINVAL;
			break;
		}

786
		chan->sec_level = sec.level;
787

788 789 790
		if (!chan->conn)
			break;

791
		conn = chan->conn;
792 793

		/*change security for LE channels */
794
		if (chan->scid == L2CAP_CID_ATT) {
795
			if (smp_conn_security(conn->hcon, sec.level))
796
				break;
797
			set_bit(FLAG_PENDING_SECURITY, &chan->flags);
798
			sk->sk_state = BT_CONFIG;
799
			chan->state = BT_CONFIG;
800

801 802
		/* or for ACL link */
		} else if ((sk->sk_state == BT_CONNECT2 &&
803
			    test_bit(BT_SK_DEFER_SETUP, &bt_sk(sk)->flags)) ||
804
			   sk->sk_state == BT_CONNECTED) {
805
			if (!l2cap_chan_check_security(chan, true))
806
				set_bit(BT_SK_SUSPEND, &bt_sk(sk)->flags);
807 808
			else
				sk->sk_state_change(sk);
809 810
		} else {
			err = -EINVAL;
811
		}
812 813 814 815 816 817 818 819 820 821 822 823 824
		break;

	case BT_DEFER_SETUP:
		if (sk->sk_state != BT_BOUND && sk->sk_state != BT_LISTEN) {
			err = -EINVAL;
			break;
		}

		if (get_user(opt, (u32 __user *) optval)) {
			err = -EFAULT;
			break;
		}

825
		if (opt) {
826
			set_bit(BT_SK_DEFER_SETUP, &bt_sk(sk)->flags);
827 828
			set_bit(FLAG_DEFER_SETUP, &chan->flags);
		} else {
829
			clear_bit(BT_SK_DEFER_SETUP, &bt_sk(sk)->flags);
830 831
			clear_bit(FLAG_DEFER_SETUP, &chan->flags);
		}
832 833 834 835 836 837 838 839 840 841 842 843 844 845
		break;

	case BT_FLUSHABLE:
		if (get_user(opt, (u32 __user *) optval)) {
			err = -EFAULT;
			break;
		}

		if (opt > BT_FLUSHABLE_ON) {
			err = -EINVAL;
			break;
		}

		if (opt == BT_FLUSHABLE_OFF) {
846
			conn = chan->conn;
L
Lucas De Marchi 已提交
847
			/* proceed further only when we have l2cap_conn and
848 849 850 851 852 853 854
			   No Flush support in the LM */
			if (!conn || !lmp_no_flush_capable(conn->hcon->hdev)) {
				err = -EINVAL;
				break;
			}
		}

855 856 857 858
		if (opt)
			set_bit(FLAG_FLUSHABLE, &chan->flags);
		else
			clear_bit(FLAG_FLUSHABLE, &chan->flags);
859 860
		break;

861 862
	case BT_POWER:
		if (chan->chan_type != L2CAP_CHAN_CONN_ORIENTED &&
863
		    chan->chan_type != L2CAP_CHAN_RAW) {
864 865 866 867 868 869 870 871 872 873 874
			err = -EINVAL;
			break;
		}

		pwr.force_active = BT_POWER_FORCE_ACTIVE_ON;

		len = min_t(unsigned int, sizeof(pwr), optlen);
		if (copy_from_user((char *) &pwr, optval, len)) {
			err = -EFAULT;
			break;
		}
875 876 877 878 879

		if (pwr.force_active)
			set_bit(FLAG_FORCE_ACTIVE, &chan->flags);
		else
			clear_bit(FLAG_FORCE_ACTIVE, &chan->flags);
880 881
		break;

882 883 884 885 886 887 888 889 890 891 892 893
	case BT_CHANNEL_POLICY:
		if (get_user(opt, (u32 __user *) optval)) {
			err = -EFAULT;
			break;
		}

		if (opt > BT_CHANNEL_POLICY_AMP_PREFERRED) {
			err = -EINVAL;
			break;
		}

		if (chan->mode != L2CAP_MODE_ERTM &&
894
		    chan->mode != L2CAP_MODE_STREAMING) {
895 896 897 898 899
			err = -EOPNOTSUPP;
			break;
		}

		chan->chan_policy = (u8) opt;
900 901 902 903 904

		if (sk->sk_state == BT_CONNECTED &&
		    chan->move_role == L2CAP_MOVE_ROLE_NONE)
			l2cap_move_start(chan);

905 906
		break;

907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937
	case BT_SNDMTU:
		if (!bdaddr_type_is_le(chan->src_type)) {
			err = -EINVAL;
			break;
		}

		/* Setting is not supported as it's the remote side that
		 * decides this.
		 */
		err = -EPERM;
		break;

	case BT_RCVMTU:
		if (!bdaddr_type_is_le(chan->src_type)) {
			err = -EINVAL;
			break;
		}

		if (sk->sk_state == BT_CONNECTED) {
			err = -EISCONN;
			break;
		}

		if (get_user(opt, (u32 __user *) optval)) {
			err = -EFAULT;
			break;
		}

		chan->imtu = opt;
		break;

938 939 940 941 942 943 944 945
	default:
		err = -ENOPROTOOPT;
		break;
	}

	release_sock(sk);
	return err;
}
946

947 948
static int l2cap_sock_sendmsg(struct socket *sock, struct msghdr *msg,
			      size_t len)
949 950
{
	struct sock *sk = sock->sk;
951
	struct l2cap_chan *chan = l2cap_pi(sk)->chan;
952 953 954 955 956 957 958 959 960 961 962
	int err;

	BT_DBG("sock %p, sk %p", sock, sk);

	err = sock_error(sk);
	if (err)
		return err;

	if (msg->msg_flags & MSG_OOB)
		return -EOPNOTSUPP;

963
	if (sk->sk_state != BT_CONNECTED)
964
		return -ENOTCONN;
965

966 967 968 969 970 971
	lock_sock(sk);
	err = bt_sock_wait_ready(sk, msg->msg_flags);
	release_sock(sk);
	if (err)
		return err;

972
	l2cap_chan_lock(chan);
973
	err = l2cap_chan_send(chan, msg, len);
974
	l2cap_chan_unlock(chan);
975 976 977

	return err;
}
978

979 980
static int l2cap_sock_recvmsg(struct socket *sock, struct msghdr *msg,
			      size_t len, int flags)
981 982
{
	struct sock *sk = sock->sk;
983 984
	struct l2cap_pinfo *pi = l2cap_pi(sk);
	int err;
985 986 987

	lock_sock(sk);

988 989
	if (sk->sk_state == BT_CONNECT2 && test_bit(BT_SK_DEFER_SETUP,
						    &bt_sk(sk)->flags)) {
990 991 992 993 994 995 996 997 998
		if (bdaddr_type_is_le(pi->chan->src_type)) {
			sk->sk_state = BT_CONNECTED;
			pi->chan->state = BT_CONNECTED;
			__l2cap_le_connect_rsp_defer(pi->chan);
		} else {
			sk->sk_state = BT_CONFIG;
			pi->chan->state = BT_CONFIG;
			__l2cap_connect_rsp_defer(pi->chan);
		}
999

1000 1001
		err = 0;
		goto done;
1002 1003 1004 1005 1006
	}

	release_sock(sk);

	if (sock->type == SOCK_STREAM)
1007
		err = bt_sock_stream_recvmsg(sock, msg, len, flags);
1008
	else
1009
		err = bt_sock_recvmsg(sock, msg, len, flags);
1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033

	if (pi->chan->mode != L2CAP_MODE_ERTM)
		return err;

	/* Attempt to put pending rx data in the socket buffer */

	lock_sock(sk);

	if (!test_bit(CONN_LOCAL_BUSY, &pi->chan->conn_state))
		goto done;

	if (pi->rx_busy_skb) {
		if (!sock_queue_rcv_skb(sk, pi->rx_busy_skb))
			pi->rx_busy_skb = NULL;
		else
			goto done;
	}

	/* Restore data flow when half of the receive buffer is
	 * available.  This avoids resending large numbers of
	 * frames.
	 */
	if (atomic_read(&sk->sk_rmem_alloc) <= sk->sk_rcvbuf >> 1)
		l2cap_chan_busy(pi->chan, 0);
1034

1035 1036 1037
done:
	release_sock(sk);
	return err;
1038 1039
}

1040 1041 1042
/* Kill socket (only if zapped and orphan)
 * Must be called on unlocked socket.
 */
1043
static void l2cap_sock_kill(struct sock *sk)
1044 1045 1046 1047
{
	if (!sock_flag(sk, SOCK_ZAPPED) || sk->sk_socket)
		return;

1048
	BT_DBG("sk %p state %s", sk, state_to_string(sk->sk_state));
1049 1050

	/* Kill poor orphan */
1051

1052
	l2cap_chan_put(l2cap_pi(sk)->chan);
1053 1054 1055 1056
	sock_set_flag(sk, SOCK_DEAD);
	sock_put(sk);
}

1057
static int __l2cap_wait_ack(struct sock *sk, struct l2cap_chan *chan)
1058 1059 1060 1061 1062 1063 1064
{
	DECLARE_WAITQUEUE(wait, current);
	int err = 0;
	int timeo = HZ/5;

	add_wait_queue(sk_sleep(sk), &wait);
	set_current_state(TASK_INTERRUPTIBLE);
1065
	do {
1066 1067
		BT_DBG("Waiting for %d ACKs", chan->unacked_frames);

1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083
		if (!timeo)
			timeo = HZ/5;

		if (signal_pending(current)) {
			err = sock_intr_errno(timeo);
			break;
		}

		release_sock(sk);
		timeo = schedule_timeout(timeo);
		lock_sock(sk);
		set_current_state(TASK_INTERRUPTIBLE);

		err = sock_error(sk);
		if (err)
			break;
1084 1085 1086 1087

	} while (chan->unacked_frames > 0 &&
		 chan->state == BT_CONNECTED);

1088 1089 1090 1091 1092
	set_current_state(TASK_RUNNING);
	remove_wait_queue(sk_sleep(sk), &wait);
	return err;
}

1093 1094 1095
static int l2cap_sock_shutdown(struct socket *sock, int how)
{
	struct sock *sk = sock->sk;
1096
	struct l2cap_chan *chan;
1097
	struct l2cap_conn *conn;
1098 1099 1100 1101 1102 1103 1104
	int err = 0;

	BT_DBG("sock %p, sk %p", sock, sk);

	if (!sk)
		return 0;

1105 1106 1107
	/* prevent sk structure from being freed whilst unlocked */
	sock_hold(sk);

1108
	chan = l2cap_pi(sk)->chan;
1109 1110
	/* prevent chan structure from being freed whilst unlocked */
	l2cap_chan_hold(chan);
1111 1112
	conn = chan->conn;

1113 1114
	BT_DBG("chan %p state %s", chan, state_to_string(chan->state));

1115 1116
	if (conn)
		mutex_lock(&conn->chan_lock);
1117

1118
	l2cap_chan_lock(chan);
1119
	lock_sock(sk);
1120

1121
	if (!sk->sk_shutdown) {
1122 1123 1124 1125
		if (chan->mode == L2CAP_MODE_ERTM &&
		    chan->unacked_frames > 0 &&
		    chan->state == BT_CONNECTED)
			err = __l2cap_wait_ack(sk, chan);
1126 1127

		sk->sk_shutdown = SHUTDOWN_MASK;
1128

1129
		release_sock(sk);
1130
		l2cap_chan_close(chan, 0);
1131
		lock_sock(sk);
1132

1133 1134
		if (sock_flag(sk, SOCK_LINGER) && sk->sk_lingertime &&
		    !(current->flags & PF_EXITING))
1135
			err = bt_sock_wait_state(sk, BT_CLOSED,
1136
						 sk->sk_lingertime);
1137 1138 1139 1140 1141 1142
	}

	if (!err && sk->sk_err)
		err = -sk->sk_err;

	release_sock(sk);
1143
	l2cap_chan_unlock(chan);
1144 1145 1146 1147

	if (conn)
		mutex_unlock(&conn->chan_lock);

1148 1149 1150
	l2cap_chan_put(chan);
	sock_put(sk);

1151 1152
	BT_DBG("err: %d", err);

1153 1154 1155
	return err;
}

1156 1157 1158 1159 1160 1161 1162 1163 1164 1165
static int l2cap_sock_release(struct socket *sock)
{
	struct sock *sk = sock->sk;
	int err;

	BT_DBG("sock %p, sk %p", sock, sk);

	if (!sk)
		return 0;

1166 1167
	bt_sock_unlink(&l2cap_sk_list, sk);

1168 1169 1170 1171 1172 1173 1174
	err = l2cap_sock_shutdown(sock, 2);

	sock_orphan(sk);
	l2cap_sock_kill(sk);
	return err;
}

1175 1176 1177 1178
static void l2cap_sock_cleanup_listen(struct sock *parent)
{
	struct sock *sk;

1179 1180
	BT_DBG("parent %p state %s", parent,
	       state_to_string(parent->sk_state));
1181 1182 1183 1184 1185

	/* Close not yet accepted channels */
	while ((sk = bt_accept_dequeue(parent, NULL))) {
		struct l2cap_chan *chan = l2cap_pi(sk)->chan;

1186 1187 1188
		BT_DBG("child chan %p state %s", chan,
		       state_to_string(chan->state));

1189 1190 1191 1192 1193 1194 1195 1196 1197
		l2cap_chan_lock(chan);
		__clear_chan_timer(chan);
		l2cap_chan_close(chan, ECONNRESET);
		l2cap_chan_unlock(chan);

		l2cap_sock_kill(sk);
	}
}

1198
static struct l2cap_chan *l2cap_sock_new_connection_cb(struct l2cap_chan *chan)
1199
{
1200
	struct sock *sk, *parent = chan->data;
1201

1202 1203
	lock_sock(parent);

1204 1205 1206
	/* Check for backlog size */
	if (sk_acceptq_is_full(parent)) {
		BT_DBG("backlog full %d", parent->sk_ack_backlog);
J
Jukka Taimisto 已提交
1207
		release_sock(parent);
1208 1209 1210
		return NULL;
	}

1211
	sk = l2cap_sock_alloc(sock_net(parent), NULL, BTPROTO_L2CAP,
1212
			      GFP_ATOMIC, 0);
J
Jukka Taimisto 已提交
1213 1214
	if (!sk) {
		release_sock(parent);
1215
		return NULL;
J
Jukka Taimisto 已提交
1216
        }
1217

1218 1219
	bt_sock_reclassify_lock(sk, BTPROTO_L2CAP);

1220 1221
	l2cap_sock_init(sk, parent);

1222 1223
	bt_accept_enqueue(parent, sk);

1224 1225
	release_sock(parent);

1226 1227 1228
	return l2cap_pi(sk)->chan;
}

1229
static int l2cap_sock_recv_cb(struct l2cap_chan *chan, struct sk_buff *skb)
1230
{
1231
	struct sock *sk = chan->data;
1232
	int err;
1233

1234 1235
	lock_sock(sk);

1236
	if (l2cap_pi(sk)->rx_busy_skb) {
1237 1238 1239
		err = -ENOMEM;
		goto done;
	}
1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251

	err = sock_queue_rcv_skb(sk, skb);

	/* For ERTM, handle one skb that doesn't fit into the recv
	 * buffer.  This is important to do because the data frames
	 * have already been acked, so the skb cannot be discarded.
	 *
	 * Notify the l2cap core that the buffer is full, so the
	 * LOCAL_BUSY state is entered and no more frames are
	 * acked and reassembled until there is buffer space
	 * available.
	 */
1252 1253 1254
	if (err < 0 && chan->mode == L2CAP_MODE_ERTM) {
		l2cap_pi(sk)->rx_busy_skb = skb;
		l2cap_chan_busy(chan, 1);
1255 1256
		err = 0;
	}
1257

1258 1259 1260
done:
	release_sock(sk);

1261
	return err;
1262 1263
}

1264
static void l2cap_sock_close_cb(struct l2cap_chan *chan)
1265
{
1266
	struct sock *sk = chan->data;
1267 1268 1269 1270

	l2cap_sock_kill(sk);
}

1271 1272 1273 1274 1275
static void l2cap_sock_teardown_cb(struct l2cap_chan *chan, int err)
{
	struct sock *sk = chan->data;
	struct sock *parent;

1276 1277
	BT_DBG("chan %p state %s", chan, state_to_string(chan->state));

1278 1279 1280 1281 1282 1283 1284 1285
	/* This callback can be called both for server (BT_LISTEN)
	 * sockets as well as "normal" ones. To avoid lockdep warnings
	 * with child socket locking (through l2cap_sock_cleanup_listen)
	 * we need separation into separate nesting levels. The simplest
	 * way to accomplish this is to inherit the nesting level used
	 * for the channel.
	 */
	lock_sock_nested(sk, atomic_read(&chan->nesting));
1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309

	parent = bt_sk(sk)->parent;

	sock_set_flag(sk, SOCK_ZAPPED);

	switch (chan->state) {
	case BT_OPEN:
	case BT_BOUND:
	case BT_CLOSED:
		break;
	case BT_LISTEN:
		l2cap_sock_cleanup_listen(sk);
		sk->sk_state = BT_CLOSED;
		chan->state = BT_CLOSED;

		break;
	default:
		sk->sk_state = BT_CLOSED;
		chan->state = BT_CLOSED;

		sk->sk_err = err;

		if (parent) {
			bt_accept_unlink(sk);
1310
			parent->sk_data_ready(parent);
1311 1312 1313 1314 1315 1316 1317 1318 1319 1320
		} else {
			sk->sk_state_change(sk);
		}

		break;
	}

	release_sock(sk);
}

1321 1322
static void l2cap_sock_state_change_cb(struct l2cap_chan *chan, int state,
				       int err)
1323
{
1324
	struct sock *sk = chan->data;
1325 1326

	sk->sk_state = state;
1327 1328 1329

	if (err)
		sk->sk_err = err;
1330 1331
}

1332
static struct sk_buff *l2cap_sock_alloc_skb_cb(struct l2cap_chan *chan,
1333
					       unsigned long hdr_len,
1334
					       unsigned long len, int nb)
1335
{
1336
	struct sock *sk = chan->data;
1337 1338 1339
	struct sk_buff *skb;
	int err;

1340
	l2cap_chan_unlock(chan);
1341
	skb = bt_skb_send_alloc(sk, hdr_len + len, nb, &err);
1342 1343
	l2cap_chan_lock(chan);

1344 1345
	if (!skb)
		return ERR_PTR(err);
1346

1347 1348
	skb->priority = sk->sk_priority;

1349
	bt_cb(skb)->l2cap.chan = chan;
1350

1351
	return skb;
1352 1353
}

1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368
static void l2cap_sock_ready_cb(struct l2cap_chan *chan)
{
	struct sock *sk = chan->data;
	struct sock *parent;

	lock_sock(sk);

	parent = bt_sk(sk)->parent;

	BT_DBG("sk %p, parent %p", sk, parent);

	sk->sk_state = BT_CONNECTED;
	sk->sk_state_change(sk);

	if (parent)
1369
		parent->sk_data_ready(parent);
1370 1371 1372 1373

	release_sock(sk);
}

1374 1375
static void l2cap_sock_defer_cb(struct l2cap_chan *chan)
{
1376 1377 1378
	struct sock *parent, *sk = chan->data;

	lock_sock(sk);
1379

1380
	parent = bt_sk(sk)->parent;
1381
	if (parent)
1382
		parent->sk_data_ready(parent);
1383 1384

	release_sock(sk);
1385 1386
}

1387 1388 1389 1390
static void l2cap_sock_resume_cb(struct l2cap_chan *chan)
{
	struct sock *sk = chan->data;

1391 1392 1393 1394 1395
	if (test_and_clear_bit(FLAG_PENDING_SECURITY, &chan->flags)) {
		sk->sk_state = BT_CONNECTED;
		chan->state = BT_CONNECTED;
	}

1396 1397 1398 1399
	clear_bit(BT_SK_SUSPEND, &bt_sk(sk)->flags);
	sk->sk_state_change(sk);
}

1400 1401 1402 1403 1404 1405 1406 1407 1408
static void l2cap_sock_set_shutdown_cb(struct l2cap_chan *chan)
{
	struct sock *sk = chan->data;

	lock_sock(sk);
	sk->sk_shutdown = SHUTDOWN_MASK;
	release_sock(sk);
}

1409 1410 1411 1412 1413 1414 1415
static long l2cap_sock_get_sndtimeo_cb(struct l2cap_chan *chan)
{
	struct sock *sk = chan->data;

	return sk->sk_sndtimeo;
}

1416 1417 1418 1419 1420 1421 1422 1423
static void l2cap_sock_suspend_cb(struct l2cap_chan *chan)
{
	struct sock *sk = chan->data;

	set_bit(BT_SK_SUSPEND, &bt_sk(sk)->flags);
	sk->sk_state_change(sk);
}

1424
static const struct l2cap_ops l2cap_chan_ops = {
1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437
	.name			= "L2CAP Socket Interface",
	.new_connection		= l2cap_sock_new_connection_cb,
	.recv			= l2cap_sock_recv_cb,
	.close			= l2cap_sock_close_cb,
	.teardown		= l2cap_sock_teardown_cb,
	.state_change		= l2cap_sock_state_change_cb,
	.ready			= l2cap_sock_ready_cb,
	.defer			= l2cap_sock_defer_cb,
	.resume			= l2cap_sock_resume_cb,
	.suspend		= l2cap_sock_suspend_cb,
	.set_shutdown		= l2cap_sock_set_shutdown_cb,
	.get_sndtimeo		= l2cap_sock_get_sndtimeo_cb,
	.alloc_skb		= l2cap_sock_alloc_skb_cb,
1438 1439
};

1440 1441 1442 1443
static void l2cap_sock_destruct(struct sock *sk)
{
	BT_DBG("sk %p", sk);

1444 1445
	if (l2cap_pi(sk)->chan)
		l2cap_chan_put(l2cap_pi(sk)->chan);
1446

1447 1448 1449 1450 1451
	if (l2cap_pi(sk)->rx_busy_skb) {
		kfree_skb(l2cap_pi(sk)->rx_busy_skb);
		l2cap_pi(sk)->rx_busy_skb = NULL;
	}

1452 1453 1454 1455
	skb_queue_purge(&sk->sk_receive_queue);
	skb_queue_purge(&sk->sk_write_queue);
}

1456 1457 1458
static void l2cap_skb_msg_name(struct sk_buff *skb, void *msg_name,
			       int *msg_namelen)
{
1459
	DECLARE_SOCKADDR(struct sockaddr_l2 *, la, msg_name);
1460 1461 1462

	memset(la, 0, sizeof(struct sockaddr_l2));
	la->l2_family = AF_BLUETOOTH;
1463 1464
	la->l2_psm = bt_cb(skb)->l2cap.psm;
	bacpy(&la->l2_bdaddr, &bt_cb(skb)->l2cap.bdaddr);
1465 1466 1467 1468

	*msg_namelen = sizeof(struct sockaddr_l2);
}

1469
static void l2cap_sock_init(struct sock *sk, struct sock *parent)
1470
{
1471
	struct l2cap_chan *chan = l2cap_pi(sk)->chan;
1472 1473 1474 1475

	BT_DBG("sk %p", sk);

	if (parent) {
1476 1477
		struct l2cap_chan *pchan = l2cap_pi(parent)->chan;

1478
		sk->sk_type = parent->sk_type;
1479
		bt_sk(sk)->flags = bt_sk(parent)->flags;
1480

1481
		chan->chan_type = pchan->chan_type;
1482 1483
		chan->imtu = pchan->imtu;
		chan->omtu = pchan->omtu;
1484
		chan->conf_state = pchan->conf_state;
1485
		chan->mode = pchan->mode;
1486 1487 1488
		chan->fcs  = pchan->fcs;
		chan->max_tx = pchan->max_tx;
		chan->tx_win = pchan->tx_win;
1489
		chan->tx_win_max = pchan->tx_win_max;
1490
		chan->sec_level = pchan->sec_level;
1491
		chan->flags = pchan->flags;
1492 1493
		chan->tx_credits = pchan->tx_credits;
		chan->rx_credits = pchan->rx_credits;
1494

1495 1496 1497 1498 1499
		if (chan->chan_type == L2CAP_CHAN_FIXED) {
			chan->scid = pchan->scid;
			chan->dcid = pchan->scid;
		}

1500
		security_sk_clone(parent, sk);
1501
	} else {
1502 1503 1504 1505 1506 1507
		switch (sk->sk_type) {
		case SOCK_RAW:
			chan->chan_type = L2CAP_CHAN_RAW;
			break;
		case SOCK_DGRAM:
			chan->chan_type = L2CAP_CHAN_CONN_LESS;
1508
			bt_sk(sk)->skb_msg_name = l2cap_skb_msg_name;
1509 1510 1511 1512 1513 1514 1515
			break;
		case SOCK_SEQPACKET:
		case SOCK_STREAM:
			chan->chan_type = L2CAP_CHAN_CONN_ORIENTED;
			break;
		}

1516 1517
		chan->imtu = L2CAP_DEFAULT_MTU;
		chan->omtu = 0;
1518
		if (!disable_ertm && sk->sk_type == SOCK_STREAM) {
1519
			chan->mode = L2CAP_MODE_ERTM;
1520
			set_bit(CONF_STATE2_DEVICE, &chan->conf_state);
1521
		} else {
1522
			chan->mode = L2CAP_MODE_BASIC;
1523
		}
1524 1525

		l2cap_chan_set_defaults(chan);
1526 1527 1528
	}

	/* Default config options */
1529
	chan->flush_to = L2CAP_DEFAULT_FLUSH_TO;
1530 1531 1532

	chan->data = sk;
	chan->ops = &l2cap_chan_ops;
1533 1534 1535 1536 1537 1538 1539 1540
}

static struct proto l2cap_proto = {
	.name		= "L2CAP",
	.owner		= THIS_MODULE,
	.obj_size	= sizeof(struct l2cap_pinfo)
};

1541
static struct sock *l2cap_sock_alloc(struct net *net, struct socket *sock,
1542
				     int proto, gfp_t prio, int kern)
1543 1544
{
	struct sock *sk;
1545
	struct l2cap_chan *chan;
1546

1547
	sk = sk_alloc(net, PF_BLUETOOTH, prio, &l2cap_proto, kern);
1548 1549 1550 1551 1552 1553 1554
	if (!sk)
		return NULL;

	sock_init_data(sock, sk);
	INIT_LIST_HEAD(&bt_sk(sk)->accept_q);

	sk->sk_destruct = l2cap_sock_destruct;
1555
	sk->sk_sndtimeo = L2CAP_CONN_TIMEOUT;
1556 1557 1558 1559 1560 1561

	sock_reset_flag(sk, SOCK_ZAPPED);

	sk->sk_protocol = proto;
	sk->sk_state = BT_OPEN;

1562
	chan = l2cap_chan_create();
1563
	if (!chan) {
1564
		sk_free(sk);
1565 1566 1567
		return NULL;
	}

1568 1569
	l2cap_chan_hold(chan);

1570 1571
	l2cap_pi(sk)->chan = chan;

1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583 1584
	return sk;
}

static int l2cap_sock_create(struct net *net, struct socket *sock, int protocol,
			     int kern)
{
	struct sock *sk;

	BT_DBG("sock %p", sock);

	sock->state = SS_UNCONNECTED;

	if (sock->type != SOCK_SEQPACKET && sock->type != SOCK_STREAM &&
1585
	    sock->type != SOCK_DGRAM && sock->type != SOCK_RAW)
1586 1587 1588 1589 1590 1591 1592
		return -ESOCKTNOSUPPORT;

	if (sock->type == SOCK_RAW && !kern && !capable(CAP_NET_RAW))
		return -EPERM;

	sock->ops = &l2cap_sock_ops;

1593
	sk = l2cap_sock_alloc(net, sock, protocol, GFP_ATOMIC, kern);
1594 1595 1596 1597
	if (!sk)
		return -ENOMEM;

	l2cap_sock_init(sk, NULL);
1598
	bt_sock_link(&l2cap_sk_list, sk);
1599 1600 1601
	return 0;
}

1602
static const struct proto_ops l2cap_sock_ops = {
1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617 1618 1619 1620 1621
	.family		= PF_BLUETOOTH,
	.owner		= THIS_MODULE,
	.release	= l2cap_sock_release,
	.bind		= l2cap_sock_bind,
	.connect	= l2cap_sock_connect,
	.listen		= l2cap_sock_listen,
	.accept		= l2cap_sock_accept,
	.getname	= l2cap_sock_getname,
	.sendmsg	= l2cap_sock_sendmsg,
	.recvmsg	= l2cap_sock_recvmsg,
	.poll		= bt_sock_poll,
	.ioctl		= bt_sock_ioctl,
	.mmap		= sock_no_mmap,
	.socketpair	= sock_no_socketpair,
	.shutdown	= l2cap_sock_shutdown,
	.setsockopt	= l2cap_sock_setsockopt,
	.getsockopt	= l2cap_sock_getsockopt
};

1622 1623 1624 1625 1626 1627 1628 1629
static const struct net_proto_family l2cap_sock_family_ops = {
	.family	= PF_BLUETOOTH,
	.owner	= THIS_MODULE,
	.create	= l2cap_sock_create,
};

int __init l2cap_init_sockets(void)
{
1630
	int err;
1631

1632 1633
	BUILD_BUG_ON(sizeof(struct sockaddr_l2) > sizeof(struct sockaddr));

1634 1635 1636
	err = proto_register(&l2cap_proto, 0);
	if (err < 0)
		return err;
1637

1638
	err = bt_sock_register(BTPROTO_L2CAP, &l2cap_sock_family_ops);
1639 1640
	if (err < 0) {
		BT_ERR("L2CAP socket registration failed");
1641
		goto error;
1642 1643
	}

1644
	err = bt_procfs_init(&init_net, "l2cap", &l2cap_sk_list,
1645
			     NULL);
1646 1647 1648 1649 1650
	if (err < 0) {
		BT_ERR("Failed to create L2CAP proc file");
		bt_sock_unregister(BTPROTO_L2CAP);
		goto error;
	}
1651

1652
	BT_INFO("L2CAP socket layer initialized");
1653

1654
	return 0;
1655 1656

error:
1657 1658
	proto_unregister(&l2cap_proto);
	return err;
1659 1660 1661 1662
}

void l2cap_cleanup_sockets(void)
{
1663
	bt_procfs_cleanup(&init_net, "l2cap");
1664
	bt_sock_unregister(BTPROTO_L2CAP);
1665
	proto_unregister(&l2cap_proto);
1666
}