hci_ldisc.c 18.8 KB
Newer Older
L
Linus Torvalds 已提交
1 2
/*
 *
3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23
 *  Bluetooth HCI UART driver
 *
 *  Copyright (C) 2000-2001  Qualcomm Incorporated
 *  Copyright (C) 2002-2003  Maxim Krasnyansky <maxk@qualcomm.com>
 *  Copyright (C) 2004-2005  Marcel Holtmann <marcel@holtmann.org>
 *
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation; either version 2 of the License, or
 *  (at your option) any later version.
 *
 *  This program is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with this program; if not, write to the Free Software
 *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 *
L
Linus Torvalds 已提交
24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42
 */

#include <linux/module.h>

#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/types.h>
#include <linux/fcntl.h>
#include <linux/interrupt.h>
#include <linux/ptrace.h>
#include <linux/poll.h>

#include <linux/slab.h>
#include <linux/tty.h>
#include <linux/errno.h>
#include <linux/string.h>
#include <linux/signal.h>
#include <linux/ioctl.h>
#include <linux/skbuff.h>
43
#include <linux/firmware.h>
L
Linus Torvalds 已提交
44 45 46 47

#include <net/bluetooth/bluetooth.h>
#include <net/bluetooth/hci_core.h>

48
#include "btintel.h"
49
#include "btbcm.h"
L
Linus Torvalds 已提交
50 51
#include "hci_uart.h"

52
#define VERSION "2.3"
53

54
static const struct hci_uart_proto *hup[HCI_UART_MAX_PROTO];
L
Linus Torvalds 已提交
55

56
int hci_uart_register_proto(const struct hci_uart_proto *p)
L
Linus Torvalds 已提交
57 58 59 60 61 62 63 64
{
	if (p->id >= HCI_UART_MAX_PROTO)
		return -EINVAL;

	if (hup[p->id])
		return -EEXIST;

	hup[p->id] = p;
65

66 67
	BT_INFO("HCI UART protocol %s registered", p->name);

L
Linus Torvalds 已提交
68 69 70
	return 0;
}

71
int hci_uart_unregister_proto(const struct hci_uart_proto *p)
L
Linus Torvalds 已提交
72 73 74 75 76 77 78 79
{
	if (p->id >= HCI_UART_MAX_PROTO)
		return -EINVAL;

	if (!hup[p->id])
		return -EINVAL;

	hup[p->id] = NULL;
80

L
Linus Torvalds 已提交
81 82 83
	return 0;
}

84
static const struct hci_uart_proto *hci_uart_get_proto(unsigned int id)
L
Linus Torvalds 已提交
85 86 87
{
	if (id >= HCI_UART_MAX_PROTO)
		return NULL;
88

L
Linus Torvalds 已提交
89 90 91 92 93 94
	return hup[id];
}

static inline void hci_uart_tx_complete(struct hci_uart *hu, int pkt_type)
{
	struct hci_dev *hdev = hu->hdev;
95

L
Linus Torvalds 已提交
96 97 98 99 100 101 102 103 104 105 106
	/* Update HCI stat counters */
	switch (pkt_type) {
	case HCI_COMMAND_PKT:
		hdev->stat.cmd_tx++;
		break;

	case HCI_ACLDATA_PKT:
		hdev->stat.acl_tx++;
		break;

	case HCI_SCODATA_PKT:
107
		hdev->stat.sco_tx++;
L
Linus Torvalds 已提交
108 109 110 111 112 113 114
		break;
	}
}

static inline struct sk_buff *hci_uart_dequeue(struct hci_uart *hu)
{
	struct sk_buff *skb = hu->tx_skb;
115

L
Linus Torvalds 已提交
116 117 118 119
	if (!skb)
		skb = hu->proto->dequeue(hu);
	else
		hu->tx_skb = NULL;
120

L
Linus Torvalds 已提交
121 122 123 124 125 126 127 128 129 130 131 132
	return skb;
}

int hci_uart_tx_wakeup(struct hci_uart *hu)
{
	if (test_and_set_bit(HCI_UART_SENDING, &hu->tx_state)) {
		set_bit(HCI_UART_TX_WAKEUP, &hu->tx_state);
		return 0;
	}

	BT_DBG("");

133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148
	schedule_work(&hu->write_work);

	return 0;
}

static void hci_uart_write_work(struct work_struct *work)
{
	struct hci_uart *hu = container_of(work, struct hci_uart, write_work);
	struct tty_struct *tty = hu->tty;
	struct hci_dev *hdev = hu->hdev;
	struct sk_buff *skb;

	/* REVISIT: should we cope with bad skbs or ->write() returning
	 * and error value ?
	 */

L
Linus Torvalds 已提交
149 150 151 152 153
restart:
	clear_bit(HCI_UART_TX_WAKEUP, &hu->tx_state);

	while ((skb = hci_uart_dequeue(hu))) {
		int len;
154

L
Linus Torvalds 已提交
155
		set_bit(TTY_DO_WRITE_WAKEUP, &tty->flags);
A
Alan Cox 已提交
156
		len = tty->ops->write(tty, skb->data, skb->len);
L
Linus Torvalds 已提交
157 158 159 160 161 162 163
		hdev->stat.byte_tx += len;

		skb_pull(skb, len);
		if (skb->len) {
			hu->tx_skb = skb;
			break;
		}
164

165
		hci_uart_tx_complete(hu, bt_cb(skb)->pkt_type);
L
Linus Torvalds 已提交
166
		kfree_skb(skb);
167 168
	}

L
Linus Torvalds 已提交
169 170 171 172 173 174
	if (test_bit(HCI_UART_TX_WAKEUP, &hu->tx_state))
		goto restart;

	clear_bit(HCI_UART_SENDING, &hu->tx_state);
}

175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203
static void hci_uart_init_work(struct work_struct *work)
{
	struct hci_uart *hu = container_of(work, struct hci_uart, init_ready);
	int err;

	if (!test_and_clear_bit(HCI_UART_INIT_PENDING, &hu->hdev_flags))
		return;

	err = hci_register_dev(hu->hdev);
	if (err < 0) {
		BT_ERR("Can't register HCI device");
		hci_free_dev(hu->hdev);
		hu->hdev = NULL;
		hu->proto->close(hu);
	}

	set_bit(HCI_UART_REGISTERED, &hu->flags);
}

int hci_uart_init_ready(struct hci_uart *hu)
{
	if (!test_bit(HCI_UART_INIT_PENDING, &hu->hdev_flags))
		return -EALREADY;

	schedule_work(&hu->init_ready);

	return 0;
}

L
Linus Torvalds 已提交
204 205 206 207 208 209 210 211 212 213 214 215 216
/* ------- Interface to HCI layer ------ */
/* Initialize device */
static int hci_uart_open(struct hci_dev *hdev)
{
	BT_DBG("%s %p", hdev->name, hdev);

	/* Nothing to do for UART driver */
	return 0;
}

/* Reset device */
static int hci_uart_flush(struct hci_dev *hdev)
{
217
	struct hci_uart *hu  = hci_get_drvdata(hdev);
L
Linus Torvalds 已提交
218 219 220 221 222 223 224 225 226 227
	struct tty_struct *tty = hu->tty;

	BT_DBG("hdev %p tty %p", hdev, tty);

	if (hu->tx_skb) {
		kfree_skb(hu->tx_skb); hu->tx_skb = NULL;
	}

	/* Flush any pending characters in the driver and discipline. */
	tty_ldisc_flush(tty);
A
Alan Cox 已提交
228
	tty_driver_flush_buffer(tty);
L
Linus Torvalds 已提交
229 230 231 232 233 234 235 236 237 238 239 240 241

	if (test_bit(HCI_UART_PROTO_SET, &hu->flags))
		hu->proto->flush(hu);

	return 0;
}

/* Close device */
static int hci_uart_close(struct hci_dev *hdev)
{
	BT_DBG("hdev %p", hdev);

	hci_uart_flush(hdev);
D
David Newall 已提交
242
	hdev->flush = NULL;
L
Linus Torvalds 已提交
243 244 245 246
	return 0;
}

/* Send frames from HCI layer */
247
static int hci_uart_send_frame(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
248
{
249
	struct hci_uart *hu = hci_get_drvdata(hdev);
L
Linus Torvalds 已提交
250

251
	BT_DBG("%s: type %d len %d", hdev->name, bt_cb(skb)->pkt_type, skb->len);
L
Linus Torvalds 已提交
252 253 254 255

	hu->proto->enqueue(hu, skb);

	hci_uart_tx_wakeup(hu);
256

L
Linus Torvalds 已提交
257 258 259
	return 0;
}

260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338
/* Flow control or un-flow control the device */
void hci_uart_set_flow_control(struct hci_uart *hu, bool enable)
{
	struct tty_struct *tty = hu->tty;
	struct ktermios ktermios;
	int status;
	unsigned int set = 0;
	unsigned int clear = 0;

	if (enable) {
		/* Disable hardware flow control */
		ktermios = tty->termios;
		ktermios.c_cflag &= ~CRTSCTS;
		status = tty_set_termios(tty, &ktermios);
		BT_DBG("Disabling hardware flow control: %s",
		       status ? "failed" : "success");

		/* Clear RTS to prevent the device from sending */
		/* Most UARTs need OUT2 to enable interrupts */
		status = tty->driver->ops->tiocmget(tty);
		BT_DBG("Current tiocm 0x%x", status);

		set &= ~(TIOCM_OUT2 | TIOCM_RTS);
		clear = ~set;
		set &= TIOCM_DTR | TIOCM_RTS | TIOCM_OUT1 |
		       TIOCM_OUT2 | TIOCM_LOOP;
		clear &= TIOCM_DTR | TIOCM_RTS | TIOCM_OUT1 |
			 TIOCM_OUT2 | TIOCM_LOOP;
		status = tty->driver->ops->tiocmset(tty, set, clear);
		BT_DBG("Clearing RTS: %s", status ? "failed" : "success");
	} else {
		/* Set RTS to allow the device to send again */
		status = tty->driver->ops->tiocmget(tty);
		BT_DBG("Current tiocm 0x%x", status);

		set |= (TIOCM_OUT2 | TIOCM_RTS);
		clear = ~set;
		set &= TIOCM_DTR | TIOCM_RTS | TIOCM_OUT1 |
		       TIOCM_OUT2 | TIOCM_LOOP;
		clear &= TIOCM_DTR | TIOCM_RTS | TIOCM_OUT1 |
			 TIOCM_OUT2 | TIOCM_LOOP;
		status = tty->driver->ops->tiocmset(tty, set, clear);
		BT_DBG("Setting RTS: %s", status ? "failed" : "success");

		/* Re-enable hardware flow control */
		ktermios = tty->termios;
		ktermios.c_cflag |= CRTSCTS;
		status = tty_set_termios(tty, &ktermios);
		BT_DBG("Enabling hardware flow control: %s",
		       status ? "failed" : "success");
	}
}

void hci_uart_set_speeds(struct hci_uart *hu, unsigned int init_speed,
			 unsigned int oper_speed)
{
	hu->init_speed = init_speed;
	hu->oper_speed = oper_speed;
}

void hci_uart_init_tty(struct hci_uart *hu)
{
	struct tty_struct *tty = hu->tty;
	struct ktermios ktermios;

	/* Bring the UART into a known 8 bits no parity hw fc state */
	ktermios = tty->termios;
	ktermios.c_iflag &= ~(IGNBRK | BRKINT | PARMRK | ISTRIP |
			      INLCR | IGNCR | ICRNL | IXON);
	ktermios.c_oflag &= ~OPOST;
	ktermios.c_lflag &= ~(ECHO | ECHONL | ICANON | ISIG | IEXTEN);
	ktermios.c_cflag &= ~(CSIZE | PARENB);
	ktermios.c_cflag |= CS8;
	ktermios.c_cflag |= CRTSCTS;

	/* tty_set_termios() return not checked as it is always 0 */
	tty_set_termios(tty, &ktermios);
}

339 340 341 342 343 344 345 346 347 348 349 350
void hci_uart_set_baudrate(struct hci_uart *hu, unsigned int speed)
{
	struct tty_struct *tty = hu->tty;
	struct ktermios ktermios;

	ktermios = tty->termios;
	ktermios.c_cflag &= ~CBAUD;
	tty_termios_encode_baud_rate(&ktermios, speed, speed);

	/* tty_set_termios() return not checked as it is always 0 */
	tty_set_termios(tty, &ktermios);

351 352
	BT_DBG("%s: New tty speeds: %d/%d", hu->hdev->name,
	       tty->termios.c_ispeed, tty->termios.c_ospeed);
353 354
}

355 356 357
static int hci_uart_setup(struct hci_dev *hdev)
{
	struct hci_uart *hu = hci_get_drvdata(hdev);
358 359
	struct hci_rp_read_local_version *ver;
	struct sk_buff *skb;
360
	unsigned int speed;
361 362
	int err;

363
	/* Init speed if any */
364
	if (hu->init_speed)
365
		speed = hu->init_speed;
366 367
	else if (hu->proto->init_speed)
		speed = hu->proto->init_speed;
368 369 370 371 372 373 374
	else
		speed = 0;

	if (speed)
		hci_uart_set_baudrate(hu, speed);

	/* Operational speed if any */
375
	if (hu->oper_speed)
376
		speed = hu->oper_speed;
377 378
	else if (hu->proto->oper_speed)
		speed = hu->proto->oper_speed;
379 380
	else
		speed = 0;
381

382 383
	if (hu->proto->set_baudrate && speed) {
		err = hu->proto->set_baudrate(hu, speed);
384
		if (!err)
385
			hci_uart_set_baudrate(hu, speed);
386
	}
387 388 389 390

	if (hu->proto->setup)
		return hu->proto->setup(hu);

391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410
	if (!test_bit(HCI_UART_VND_DETECT, &hu->hdev_flags))
		return 0;

	skb = __hci_cmd_sync(hdev, HCI_OP_READ_LOCAL_VERSION, 0, NULL,
			     HCI_INIT_TIMEOUT);
	if (IS_ERR(skb)) {
		BT_ERR("%s: Reading local version information failed (%ld)",
		       hdev->name, PTR_ERR(skb));
		return 0;
	}

	if (skb->len != sizeof(*ver)) {
		BT_ERR("%s: Event length mismatch for version information",
		       hdev->name);
		goto done;
	}

	ver = (struct hci_rp_read_local_version *)skb->data;

	switch (le16_to_cpu(ver->manufacturer)) {
411 412
#ifdef CONFIG_BT_HCIUART_INTEL
	case 2:
413 414
		hdev->set_bdaddr = btintel_set_bdaddr;
		btintel_check_bdaddr(hdev);
415
		break;
416 417 418
#endif
#ifdef CONFIG_BT_HCIUART_BCM
	case 15:
419 420
		hdev->set_bdaddr = btbcm_set_bdaddr;
		btbcm_check_bdaddr(hdev);
421
		break;
422
#endif
423 424 425 426
	}

done:
	kfree_skb(skb);
427 428 429
	return 0;
}

L
Linus Torvalds 已提交
430 431
/* ------ LDISC part ------ */
/* hci_uart_tty_open
432
 *
L
Linus Torvalds 已提交
433 434 435 436
 *     Called when line discipline changed to HCI_UART.
 *
 * Arguments:
 *     tty    pointer to tty info structure
437
 * Return Value:
L
Linus Torvalds 已提交
438 439 440 441
 *     0 if success, otherwise error code
 */
static int hci_uart_tty_open(struct tty_struct *tty)
{
442
	struct hci_uart *hu;
L
Linus Torvalds 已提交
443 444 445

	BT_DBG("tty %p", tty);

A
Alan Cox 已提交
446 447 448 449 450
	/* Error if the tty has no write op instead of leaving an exploitable
	   hole */
	if (tty->ops->write == NULL)
		return -EOPNOTSUPP;

451 452
	hu = kzalloc(sizeof(struct hci_uart), GFP_KERNEL);
	if (!hu) {
453
		BT_ERR("Can't allocate control structure");
L
Linus Torvalds 已提交
454 455
		return -ENFILE;
	}
456

L
Linus Torvalds 已提交
457 458
	tty->disc_data = hu;
	hu->tty = tty;
A
Alan Cox 已提交
459
	tty->receive_room = 65536;
L
Linus Torvalds 已提交
460

461
	INIT_WORK(&hu->init_ready, hci_uart_init_work);
462
	INIT_WORK(&hu->write_work, hci_uart_write_work);
463

L
Linus Torvalds 已提交
464
	/* Flush any pending characters in the driver and line discipline. */
465

L
Linus Torvalds 已提交
466 467
	/* FIXME: why is this needed. Note don't use ldisc_ref here as the
	   open path is before the ldisc is referencable */
468

A
Alan Cox 已提交
469 470
	if (tty->ldisc->ops->flush_buffer)
		tty->ldisc->ops->flush_buffer(tty);
A
Alan Cox 已提交
471
	tty_driver_flush_buffer(tty);
L
Linus Torvalds 已提交
472 473 474 475 476 477 478 479 480 481 482

	return 0;
}

/* hci_uart_tty_close()
 *
 *    Called when the line discipline is changed to something
 *    else, the tty is closed, or the tty detects a hangup.
 */
static void hci_uart_tty_close(struct tty_struct *tty)
{
483
	struct hci_uart *hu = tty->disc_data;
484
	struct hci_dev *hdev;
L
Linus Torvalds 已提交
485 486 487 488 489 490

	BT_DBG("tty %p", tty);

	/* Detach from the tty */
	tty->disc_data = NULL;

491 492
	if (!hu)
		return;
493

494 495 496
	hdev = hu->hdev;
	if (hdev)
		hci_uart_close(hdev);
L
Linus Torvalds 已提交
497

498 499
	cancel_work_sync(&hu->write_work);

500 501
	if (test_and_clear_bit(HCI_UART_PROTO_SET, &hu->flags)) {
		if (hdev) {
502 503
			if (test_bit(HCI_UART_REGISTERED, &hu->flags))
				hci_unregister_dev(hdev);
504
			hci_free_dev(hdev);
L
Linus Torvalds 已提交
505
		}
506
		hu->proto->close(hu);
L
Linus Torvalds 已提交
507
	}
508 509

	kfree(hu);
L
Linus Torvalds 已提交
510 511 512 513 514 515 516 517 518 519 520 521
}

/* hci_uart_tty_wakeup()
 *
 *    Callback for transmit wakeup. Called when low level
 *    device driver can accept more send data.
 *
 * Arguments:        tty    pointer to associated tty instance data
 * Return Value:    None
 */
static void hci_uart_tty_wakeup(struct tty_struct *tty)
{
522
	struct hci_uart *hu = tty->disc_data;
L
Linus Torvalds 已提交
523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538

	BT_DBG("");

	if (!hu)
		return;

	clear_bit(TTY_DO_WRITE_WAKEUP, &tty->flags);

	if (tty != hu->tty)
		return;

	if (test_bit(HCI_UART_PROTO_SET, &hu->flags))
		hci_uart_tx_wakeup(hu);
}

/* hci_uart_tty_receive()
539
 *
L
Linus Torvalds 已提交
540 541
 *     Called by tty low level driver when receive data is
 *     available.
542
 *
L
Linus Torvalds 已提交
543 544 545 546
 * Arguments:  tty          pointer to tty isntance data
 *             data         pointer to received data
 *             flags        pointer to flags for data
 *             count        count of received data in bytes
547
 *
548
 * Return Value:    None
L
Linus Torvalds 已提交
549
 */
550 551
static void hci_uart_tty_receive(struct tty_struct *tty, const u8 *data,
				 char *flags, int count)
L
Linus Torvalds 已提交
552
{
553
	struct hci_uart *hu = tty->disc_data;
554

L
Linus Torvalds 已提交
555
	if (!hu || tty != hu->tty)
556
		return;
L
Linus Torvalds 已提交
557 558

	if (!test_bit(HCI_UART_PROTO_SET, &hu->flags))
559
		return;
560

561 562 563
	/* It does not need a lock here as it is already protected by a mutex in
	 * tty caller
	 */
564
	hu->proto->recv(hu, data, count);
565 566 567 568

	if (hu->hdev)
		hu->hdev->stat.byte_rx += count;

A
Alan Cox 已提交
569
	tty_unthrottle(tty);
L
Linus Torvalds 已提交
570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586
}

static int hci_uart_register_dev(struct hci_uart *hu)
{
	struct hci_dev *hdev;

	BT_DBG("");

	/* Initialize and register HCI device */
	hdev = hci_alloc_dev();
	if (!hdev) {
		BT_ERR("Can't allocate HCI device");
		return -ENOMEM;
	}

	hu->hdev = hdev;

587
	hdev->bus = HCI_UART;
588
	hci_set_drvdata(hdev, hu);
L
Linus Torvalds 已提交
589

590 591 592 593 594 595 596
	/* Only when vendor specific setup callback is provided, consider
	 * the manufacturer information valid. This avoids filling in the
	 * value for Ericsson when nothing is specified.
	 */
	if (hu->proto->setup)
		hdev->manufacturer = hu->proto->manufacturer;

L
Linus Torvalds 已提交
597 598 599 600
	hdev->open  = hci_uart_open;
	hdev->close = hci_uart_close;
	hdev->flush = hci_uart_flush;
	hdev->send  = hci_uart_send_frame;
601
	hdev->setup = hci_uart_setup;
602
	SET_HCIDEV_DEV(hdev, hu->tty->dev);
L
Linus Torvalds 已提交
603

604 605 606
	if (test_bit(HCI_UART_RAW_DEVICE, &hu->hdev_flags))
		set_bit(HCI_QUIRK_RAW_DEVICE, &hdev->quirks);

607 608 609
	if (test_bit(HCI_UART_EXT_CONFIG, &hu->hdev_flags))
		set_bit(HCI_QUIRK_EXTERNAL_CONFIG, &hdev->quirks);

610
	if (!test_bit(HCI_UART_RESET_ON_INIT, &hu->hdev_flags))
611
		set_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks);
612

613 614 615 616 617
	if (test_bit(HCI_UART_CREATE_AMP, &hu->hdev_flags))
		hdev->dev_type = HCI_AMP;
	else
		hdev->dev_type = HCI_BREDR;

618 619 620
	if (test_bit(HCI_UART_INIT_PENDING, &hu->hdev_flags))
		return 0;

L
Linus Torvalds 已提交
621 622 623 624 625 626
	if (hci_register_dev(hdev) < 0) {
		BT_ERR("Can't register HCI device");
		hci_free_dev(hdev);
		return -ENODEV;
	}

627 628
	set_bit(HCI_UART_REGISTERED, &hu->flags);

L
Linus Torvalds 已提交
629 630 631 632 633
	return 0;
}

static int hci_uart_set_proto(struct hci_uart *hu, int id)
{
634
	const struct hci_uart_proto *p;
635 636
	int err;

L
Linus Torvalds 已提交
637 638 639 640 641 642 643 644 645 646 647 648 649 650 651
	p = hci_uart_get_proto(id);
	if (!p)
		return -EPROTONOSUPPORT;

	err = p->open(hu);
	if (err)
		return err;

	hu->proto = p;

	err = hci_uart_register_dev(hu);
	if (err) {
		p->close(hu);
		return err;
	}
652

L
Linus Torvalds 已提交
653 654 655
	return 0;
}

656 657 658 659 660
static int hci_uart_set_flags(struct hci_uart *hu, unsigned long flags)
{
	unsigned long valid_flags = BIT(HCI_UART_RAW_DEVICE) |
				    BIT(HCI_UART_RESET_ON_INIT) |
				    BIT(HCI_UART_CREATE_AMP) |
661
				    BIT(HCI_UART_INIT_PENDING) |
662 663
				    BIT(HCI_UART_EXT_CONFIG) |
				    BIT(HCI_UART_VND_DETECT);
664

665
	if (flags & ~valid_flags)
666 667 668 669 670 671 672
		return -EINVAL;

	hu->hdev_flags = flags;

	return 0;
}

L
Linus Torvalds 已提交
673 674 675 676 677 678 679 680 681 682 683 684 685
/* hci_uart_tty_ioctl()
 *
 *    Process IOCTL system call for the tty device.
 *
 * Arguments:
 *
 *    tty        pointer to tty instance data
 *    file       pointer to open file object for device
 *    cmd        IOCTL command code
 *    arg        argument for IOCTL call (cmd dependent)
 *
 * Return Value:    Command dependent
 */
686 687
static int hci_uart_tty_ioctl(struct tty_struct *tty, struct file *file,
			      unsigned int cmd, unsigned long arg)
L
Linus Torvalds 已提交
688
{
689
	struct hci_uart *hu = tty->disc_data;
L
Linus Torvalds 已提交
690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705
	int err = 0;

	BT_DBG("");

	/* Verify the status of the device */
	if (!hu)
		return -EBADF;

	switch (cmd) {
	case HCIUARTSETPROTO:
		if (!test_and_set_bit(HCI_UART_PROTO_SET, &hu->flags)) {
			err = hci_uart_set_proto(hu, arg);
			if (err) {
				clear_bit(HCI_UART_PROTO_SET, &hu->flags);
				return err;
			}
706
		} else
L
Linus Torvalds 已提交
707
			return -EBUSY;
708
		break;
L
Linus Torvalds 已提交
709 710 711 712 713

	case HCIUARTGETPROTO:
		if (test_bit(HCI_UART_PROTO_SET, &hu->flags))
			return hu->proto->id;
		return -EUNATCH;
714

715
	case HCIUARTGETDEVICE:
716
		if (test_bit(HCI_UART_REGISTERED, &hu->flags))
717 718 719
			return hu->hdev->id;
		return -EUNATCH;

720 721 722
	case HCIUARTSETFLAGS:
		if (test_bit(HCI_UART_PROTO_SET, &hu->flags))
			return -EBUSY;
723 724 725
		err = hci_uart_set_flags(hu, arg);
		if (err)
			return err;
726 727 728 729 730
		break;

	case HCIUARTGETFLAGS:
		return hu->hdev_flags;

L
Linus Torvalds 已提交
731
	default:
732
		err = n_tty_ioctl_helper(tty, file, cmd, arg);
L
Linus Torvalds 已提交
733
		break;
734
	}
L
Linus Torvalds 已提交
735 736 737 738 739 740 741

	return err;
}

/*
 * We don't provide read/write/poll interface for user space.
 */
742
static ssize_t hci_uart_tty_read(struct tty_struct *tty, struct file *file,
743
				 unsigned char __user *buf, size_t nr)
L
Linus Torvalds 已提交
744 745 746
{
	return 0;
}
747 748

static ssize_t hci_uart_tty_write(struct tty_struct *tty, struct file *file,
749
				  const unsigned char *data, size_t count)
L
Linus Torvalds 已提交
750 751 752
{
	return 0;
}
753 754

static unsigned int hci_uart_tty_poll(struct tty_struct *tty,
755
				      struct file *filp, poll_table *wait)
L
Linus Torvalds 已提交
756 757 758 759 760 761
{
	return 0;
}

static int __init hci_uart_init(void)
{
A
Alan Cox 已提交
762
	static struct tty_ldisc_ops hci_uart_ldisc;
L
Linus Torvalds 已提交
763 764 765 766 767 768
	int err;

	BT_INFO("HCI UART driver ver %s", VERSION);

	/* Register the tty discipline */

769
	memset(&hci_uart_ldisc, 0, sizeof(hci_uart_ldisc));
770 771 772 773 774 775 776 777 778 779 780
	hci_uart_ldisc.magic		= TTY_LDISC_MAGIC;
	hci_uart_ldisc.name		= "n_hci";
	hci_uart_ldisc.open		= hci_uart_tty_open;
	hci_uart_ldisc.close		= hci_uart_tty_close;
	hci_uart_ldisc.read		= hci_uart_tty_read;
	hci_uart_ldisc.write		= hci_uart_tty_write;
	hci_uart_ldisc.ioctl		= hci_uart_tty_ioctl;
	hci_uart_ldisc.poll		= hci_uart_tty_poll;
	hci_uart_ldisc.receive_buf	= hci_uart_tty_receive;
	hci_uart_ldisc.write_wakeup	= hci_uart_tty_wakeup;
	hci_uart_ldisc.owner		= THIS_MODULE;
L
Linus Torvalds 已提交
781

782 783
	err = tty_register_ldisc(N_HCI, &hci_uart_ldisc);
	if (err) {
L
Linus Torvalds 已提交
784 785 786 787 788 789 790 791 792 793
		BT_ERR("HCI line discipline registration failed. (%d)", err);
		return err;
	}

#ifdef CONFIG_BT_HCIUART_H4
	h4_init();
#endif
#ifdef CONFIG_BT_HCIUART_BCSP
	bcsp_init();
#endif
794 795 796
#ifdef CONFIG_BT_HCIUART_LL
	ll_init();
#endif
797 798 799
#ifdef CONFIG_BT_HCIUART_ATH3K
	ath_init();
#endif
800 801 802
#ifdef CONFIG_BT_HCIUART_3WIRE
	h5_init();
#endif
803 804 805
#ifdef CONFIG_BT_HCIUART_INTEL
	intel_init();
#endif
806 807 808
#ifdef CONFIG_BT_HCIUART_BCM
	bcm_init();
#endif
809 810 811
#ifdef CONFIG_BT_HCIUART_QCA
	qca_init();
#endif
812

L
Linus Torvalds 已提交
813 814 815 816 817 818 819 820 821 822 823 824 825
	return 0;
}

static void __exit hci_uart_exit(void)
{
	int err;

#ifdef CONFIG_BT_HCIUART_H4
	h4_deinit();
#endif
#ifdef CONFIG_BT_HCIUART_BCSP
	bcsp_deinit();
#endif
826 827 828
#ifdef CONFIG_BT_HCIUART_LL
	ll_deinit();
#endif
829 830 831
#ifdef CONFIG_BT_HCIUART_ATH3K
	ath_deinit();
#endif
832 833 834
#ifdef CONFIG_BT_HCIUART_3WIRE
	h5_deinit();
#endif
835 836 837
#ifdef CONFIG_BT_HCIUART_INTEL
	intel_deinit();
#endif
838 839 840
#ifdef CONFIG_BT_HCIUART_BCM
	bcm_deinit();
#endif
841 842 843
#ifdef CONFIG_BT_HCIUART_QCA
	qca_deinit();
#endif
L
Linus Torvalds 已提交
844 845

	/* Release tty registration of line discipline */
846 847
	err = tty_unregister_ldisc(N_HCI);
	if (err)
L
Linus Torvalds 已提交
848 849 850 851 852 853
		BT_ERR("Can't unregister HCI line discipline (%d)", err);
}

module_init(hci_uart_init);
module_exit(hci_uart_exit);

854
MODULE_AUTHOR("Marcel Holtmann <marcel@holtmann.org>");
L
Linus Torvalds 已提交
855 856 857 858
MODULE_DESCRIPTION("Bluetooth HCI UART driver ver " VERSION);
MODULE_VERSION(VERSION);
MODULE_LICENSE("GPL");
MODULE_ALIAS_LDISC(N_HCI);