Linux Audio

Check our new training course

Loading...
v3.1
  1/*
  2 *
  3 *  Bluetooth HCI UART driver
  4 *
  5 *  Copyright (C) 2000-2001  Qualcomm Incorporated
  6 *  Copyright (C) 2002-2003  Maxim Krasnyansky <maxk@qualcomm.com>
  7 *  Copyright (C) 2004-2005  Marcel Holtmann <marcel@holtmann.org>
  8 *
  9 *
 10 *  This program is free software; you can redistribute it and/or modify
 11 *  it under the terms of the GNU General Public License as published by
 12 *  the Free Software Foundation; either version 2 of the License, or
 13 *  (at your option) any later version.
 14 *
 15 *  This program is distributed in the hope that it will be useful,
 16 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 17 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 18 *  GNU General Public License for more details.
 19 *
 20 *  You should have received a copy of the GNU General Public License
 21 *  along with this program; if not, write to the Free Software
 22 *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 23 *
 24 */
 25
 26#include <linux/module.h>
 27
 28#include <linux/kernel.h>
 29#include <linux/init.h>
 30#include <linux/types.h>
 31#include <linux/fcntl.h>
 32#include <linux/interrupt.h>
 33#include <linux/ptrace.h>
 34#include <linux/poll.h>
 35
 36#include <linux/slab.h>
 37#include <linux/tty.h>
 38#include <linux/errno.h>
 39#include <linux/string.h>
 40#include <linux/signal.h>
 41#include <linux/ioctl.h>
 42#include <linux/skbuff.h>
 
 43
 44#include <net/bluetooth/bluetooth.h>
 45#include <net/bluetooth/hci_core.h>
 46
 
 
 47#include "hci_uart.h"
 48
 49#define VERSION "2.2"
 50
 51static int reset = 0;
 52
 53static struct hci_uart_proto *hup[HCI_UART_MAX_PROTO];
 54
 55int hci_uart_register_proto(struct hci_uart_proto *p)
 56{
 57	if (p->id >= HCI_UART_MAX_PROTO)
 58		return -EINVAL;
 59
 60	if (hup[p->id])
 61		return -EEXIST;
 62
 63	hup[p->id] = p;
 64
 
 
 65	return 0;
 66}
 67
 68int hci_uart_unregister_proto(struct hci_uart_proto *p)
 69{
 70	if (p->id >= HCI_UART_MAX_PROTO)
 71		return -EINVAL;
 72
 73	if (!hup[p->id])
 74		return -EINVAL;
 75
 76	hup[p->id] = NULL;
 77
 78	return 0;
 79}
 80
 81static struct hci_uart_proto *hci_uart_get_proto(unsigned int id)
 82{
 83	if (id >= HCI_UART_MAX_PROTO)
 84		return NULL;
 85
 86	return hup[id];
 87}
 88
 89static inline void hci_uart_tx_complete(struct hci_uart *hu, int pkt_type)
 90{
 91	struct hci_dev *hdev = hu->hdev;
 92
 93	/* Update HCI stat counters */
 94	switch (pkt_type) {
 95	case HCI_COMMAND_PKT:
 96		hdev->stat.cmd_tx++;
 97		break;
 98
 99	case HCI_ACLDATA_PKT:
100		hdev->stat.acl_tx++;
101		break;
102
103	case HCI_SCODATA_PKT:
104		hdev->stat.sco_tx++;
105		break;
106	}
107}
108
109static inline struct sk_buff *hci_uart_dequeue(struct hci_uart *hu)
110{
111	struct sk_buff *skb = hu->tx_skb;
112
113	if (!skb)
114		skb = hu->proto->dequeue(hu);
115	else
116		hu->tx_skb = NULL;
117
118	return skb;
119}
120
121int hci_uart_tx_wakeup(struct hci_uart *hu)
122{
123	struct tty_struct *tty = hu->tty;
124	struct hci_dev *hdev = hu->hdev;
125	struct sk_buff *skb;
126
127	if (test_and_set_bit(HCI_UART_SENDING, &hu->tx_state)) {
128		set_bit(HCI_UART_TX_WAKEUP, &hu->tx_state);
129		return 0;
130	}
131
132	BT_DBG("");
133
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
134restart:
135	clear_bit(HCI_UART_TX_WAKEUP, &hu->tx_state);
136
137	while ((skb = hci_uart_dequeue(hu))) {
138		int len;
139
140		set_bit(TTY_DO_WRITE_WAKEUP, &tty->flags);
141		len = tty->ops->write(tty, skb->data, skb->len);
142		hdev->stat.byte_tx += len;
143
144		skb_pull(skb, len);
145		if (skb->len) {
146			hu->tx_skb = skb;
147			break;
148		}
149
150		hci_uart_tx_complete(hu, bt_cb(skb)->pkt_type);
151		kfree_skb(skb);
152	}
153
154	if (test_bit(HCI_UART_TX_WAKEUP, &hu->tx_state))
155		goto restart;
156
157	clear_bit(HCI_UART_SENDING, &hu->tx_state);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
158	return 0;
159}
160
161/* ------- Interface to HCI layer ------ */
162/* Initialize device */
163static int hci_uart_open(struct hci_dev *hdev)
164{
165	BT_DBG("%s %p", hdev->name, hdev);
166
167	/* Nothing to do for UART driver */
168
169	set_bit(HCI_RUNNING, &hdev->flags);
170
171	return 0;
172}
173
174/* Reset device */
175static int hci_uart_flush(struct hci_dev *hdev)
176{
177	struct hci_uart *hu  = (struct hci_uart *) hdev->driver_data;
178	struct tty_struct *tty = hu->tty;
179
180	BT_DBG("hdev %p tty %p", hdev, tty);
181
182	if (hu->tx_skb) {
183		kfree_skb(hu->tx_skb); hu->tx_skb = NULL;
184	}
185
186	/* Flush any pending characters in the driver and discipline. */
187	tty_ldisc_flush(tty);
188	tty_driver_flush_buffer(tty);
189
190	if (test_bit(HCI_UART_PROTO_SET, &hu->flags))
191		hu->proto->flush(hu);
192
193	return 0;
194}
195
196/* Close device */
197static int hci_uart_close(struct hci_dev *hdev)
198{
199	BT_DBG("hdev %p", hdev);
200
201	if (!test_and_clear_bit(HCI_RUNNING, &hdev->flags))
202		return 0;
203
204	hci_uart_flush(hdev);
205	hdev->flush = NULL;
206	return 0;
207}
208
209/* Send frames from HCI layer */
210static int hci_uart_send_frame(struct sk_buff *skb)
211{
212	struct hci_dev* hdev = (struct hci_dev *) skb->dev;
213	struct hci_uart *hu;
214
215	if (!hdev) {
216		BT_ERR("Frame for unknown device (hdev=NULL)");
217		return -ENODEV;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
218	}
 
219
220	if (!test_bit(HCI_RUNNING, &hdev->flags))
221		return -EBUSY;
 
 
 
 
222
223	hu = (struct hci_uart *) hdev->driver_data;
 
 
 
224
225	BT_DBG("%s: type %d len %d", hdev->name, bt_cb(skb)->pkt_type, skb->len);
 
 
 
 
 
 
 
 
226
227	hu->proto->enqueue(hu, skb);
 
 
228
229	hci_uart_tx_wakeup(hu);
 
 
 
230
231	return 0;
 
 
 
 
 
 
 
 
232}
233
234static void hci_uart_destruct(struct hci_dev *hdev)
235{
236	if (!hdev)
237		return;
 
 
 
 
 
 
 
 
 
 
 
238
239	BT_DBG("%s", hdev->name);
240	kfree(hdev->driver_data);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
241}
242
243/* ------ LDISC part ------ */
244/* hci_uart_tty_open
245 * 
246 *     Called when line discipline changed to HCI_UART.
247 *
248 * Arguments:
249 *     tty    pointer to tty info structure
250 * Return Value:    
251 *     0 if success, otherwise error code
252 */
253static int hci_uart_tty_open(struct tty_struct *tty)
254{
255	struct hci_uart *hu = (void *) tty->disc_data;
256
257	BT_DBG("tty %p", tty);
258
259	/* FIXME: This btw is bogus, nothing requires the old ldisc to clear
260	   the pointer */
261	if (hu)
262		return -EEXIST;
263
264	/* Error if the tty has no write op instead of leaving an exploitable
265	   hole */
266	if (tty->ops->write == NULL)
267		return -EOPNOTSUPP;
268
269	if (!(hu = kzalloc(sizeof(struct hci_uart), GFP_KERNEL))) {
 
270		BT_ERR("Can't allocate control structure");
271		return -ENFILE;
272	}
273
274	tty->disc_data = hu;
275	hu->tty = tty;
276	tty->receive_room = 65536;
277
278	spin_lock_init(&hu->rx_lock);
279
280	/* Flush any pending characters in the driver and line discipline. */
281
282	/* FIXME: why is this needed. Note don't use ldisc_ref here as the
283	   open path is before the ldisc is referencable */
284
285	if (tty->ldisc->ops->flush_buffer)
286		tty->ldisc->ops->flush_buffer(tty);
287	tty_driver_flush_buffer(tty);
288
289	return 0;
290}
291
292/* hci_uart_tty_close()
293 *
294 *    Called when the line discipline is changed to something
295 *    else, the tty is closed, or the tty detects a hangup.
296 */
297static void hci_uart_tty_close(struct tty_struct *tty)
298{
299	struct hci_uart *hu = (void *)tty->disc_data;
 
300
301	BT_DBG("tty %p", tty);
302
303	/* Detach from the tty */
304	tty->disc_data = NULL;
305
306	if (hu) {
307		struct hci_dev *hdev = hu->hdev;
308
309		if (hdev)
310			hci_uart_close(hdev);
311
312		if (test_and_clear_bit(HCI_UART_PROTO_SET, &hu->flags)) {
313			hu->proto->close(hu);
314			if (hdev) {
 
 
 
 
 
 
315				hci_unregister_dev(hdev);
316				hci_free_dev(hdev);
317			}
318		}
 
319	}
 
 
 
320}
321
322/* hci_uart_tty_wakeup()
323 *
324 *    Callback for transmit wakeup. Called when low level
325 *    device driver can accept more send data.
326 *
327 * Arguments:        tty    pointer to associated tty instance data
328 * Return Value:    None
329 */
330static void hci_uart_tty_wakeup(struct tty_struct *tty)
331{
332	struct hci_uart *hu = (void *)tty->disc_data;
333
334	BT_DBG("");
335
336	if (!hu)
337		return;
338
339	clear_bit(TTY_DO_WRITE_WAKEUP, &tty->flags);
340
341	if (tty != hu->tty)
342		return;
343
344	if (test_bit(HCI_UART_PROTO_SET, &hu->flags))
345		hci_uart_tx_wakeup(hu);
346}
347
348/* hci_uart_tty_receive()
349 * 
350 *     Called by tty low level driver when receive data is
351 *     available.
352 *     
353 * Arguments:  tty          pointer to tty isntance data
354 *             data         pointer to received data
355 *             flags        pointer to flags for data
356 *             count        count of received data in bytes
357 *     
358 * Return Value:    None
359 */
360static void hci_uart_tty_receive(struct tty_struct *tty, const u8 *data, char *flags, int count)
 
361{
362	struct hci_uart *hu = (void *)tty->disc_data;
363
364	if (!hu || tty != hu->tty)
365		return;
366
367	if (!test_bit(HCI_UART_PROTO_SET, &hu->flags))
368		return;
369
370	spin_lock(&hu->rx_lock);
371	hu->proto->recv(hu, (void *) data, count);
372	hu->hdev->stat.byte_rx += count;
373	spin_unlock(&hu->rx_lock);
 
 
 
374
375	tty_unthrottle(tty);
376}
377
378static int hci_uart_register_dev(struct hci_uart *hu)
379{
380	struct hci_dev *hdev;
381
382	BT_DBG("");
383
384	/* Initialize and register HCI device */
385	hdev = hci_alloc_dev();
386	if (!hdev) {
387		BT_ERR("Can't allocate HCI device");
388		return -ENOMEM;
389	}
390
391	hu->hdev = hdev;
392
393	hdev->bus = HCI_UART;
394	hdev->driver_data = hu;
 
 
 
 
 
 
 
395
396	hdev->open  = hci_uart_open;
397	hdev->close = hci_uart_close;
398	hdev->flush = hci_uart_flush;
399	hdev->send  = hci_uart_send_frame;
400	hdev->destruct = hci_uart_destruct;
401	hdev->parent = hu->tty->dev;
402
403	hdev->owner = THIS_MODULE;
404
405	if (!reset)
406		set_bit(HCI_QUIRK_NO_RESET, &hdev->quirks);
407
408	if (test_bit(HCI_UART_RAW_DEVICE, &hu->hdev_flags))
409		set_bit(HCI_QUIRK_RAW_DEVICE, &hdev->quirks);
410
 
 
 
 
 
 
 
 
 
 
 
 
 
 
411	if (hci_register_dev(hdev) < 0) {
412		BT_ERR("Can't register HCI device");
413		hci_free_dev(hdev);
414		return -ENODEV;
415	}
416
 
 
417	return 0;
418}
419
420static int hci_uart_set_proto(struct hci_uart *hu, int id)
421{
422	struct hci_uart_proto *p;
423	int err;
424
425	p = hci_uart_get_proto(id);
426	if (!p)
427		return -EPROTONOSUPPORT;
428
429	err = p->open(hu);
430	if (err)
431		return err;
432
433	hu->proto = p;
 
434
435	err = hci_uart_register_dev(hu);
436	if (err) {
 
437		p->close(hu);
438		return err;
439	}
440
441	return 0;
442}
443
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
444/* hci_uart_tty_ioctl()
445 *
446 *    Process IOCTL system call for the tty device.
447 *
448 * Arguments:
449 *
450 *    tty        pointer to tty instance data
451 *    file       pointer to open file object for device
452 *    cmd        IOCTL command code
453 *    arg        argument for IOCTL call (cmd dependent)
454 *
455 * Return Value:    Command dependent
456 */
457static int hci_uart_tty_ioctl(struct tty_struct *tty, struct file * file,
458					unsigned int cmd, unsigned long arg)
459{
460	struct hci_uart *hu = (void *)tty->disc_data;
461	int err = 0;
462
463	BT_DBG("");
464
465	/* Verify the status of the device */
466	if (!hu)
467		return -EBADF;
468
469	switch (cmd) {
470	case HCIUARTSETPROTO:
471		if (!test_and_set_bit(HCI_UART_PROTO_SET, &hu->flags)) {
472			err = hci_uart_set_proto(hu, arg);
473			if (err) {
474				clear_bit(HCI_UART_PROTO_SET, &hu->flags);
475				return err;
476			}
477		} else
478			return -EBUSY;
479		break;
480
481	case HCIUARTGETPROTO:
482		if (test_bit(HCI_UART_PROTO_SET, &hu->flags))
483			return hu->proto->id;
484		return -EUNATCH;
 
 
485
486	case HCIUARTGETDEVICE:
487		if (test_bit(HCI_UART_PROTO_SET, &hu->flags))
488			return hu->hdev->id;
489		return -EUNATCH;
 
 
490
491	case HCIUARTSETFLAGS:
492		if (test_bit(HCI_UART_PROTO_SET, &hu->flags))
493			return -EBUSY;
494		hu->hdev_flags = arg;
 
495		break;
496
497	case HCIUARTGETFLAGS:
498		return hu->hdev_flags;
 
499
500	default:
501		err = n_tty_ioctl_helper(tty, file, cmd, arg);
502		break;
503	};
504
505	return err;
506}
507
508/*
509 * We don't provide read/write/poll interface for user space.
510 */
511static ssize_t hci_uart_tty_read(struct tty_struct *tty, struct file *file,
512					unsigned char __user *buf, size_t nr)
513{
514	return 0;
515}
516
517static ssize_t hci_uart_tty_write(struct tty_struct *tty, struct file *file,
518					const unsigned char *data, size_t count)
519{
520	return 0;
521}
522
523static unsigned int hci_uart_tty_poll(struct tty_struct *tty,
524					struct file *filp, poll_table *wait)
525{
526	return 0;
527}
528
529static int __init hci_uart_init(void)
530{
531	static struct tty_ldisc_ops hci_uart_ldisc;
532	int err;
533
534	BT_INFO("HCI UART driver ver %s", VERSION);
535
536	/* Register the tty discipline */
537
538	memset(&hci_uart_ldisc, 0, sizeof (hci_uart_ldisc));
539	hci_uart_ldisc.magic		= TTY_LDISC_MAGIC;
540	hci_uart_ldisc.name		= "n_hci";
541	hci_uart_ldisc.open		= hci_uart_tty_open;
542	hci_uart_ldisc.close		= hci_uart_tty_close;
543	hci_uart_ldisc.read		= hci_uart_tty_read;
544	hci_uart_ldisc.write		= hci_uart_tty_write;
545	hci_uart_ldisc.ioctl		= hci_uart_tty_ioctl;
546	hci_uart_ldisc.poll		= hci_uart_tty_poll;
547	hci_uart_ldisc.receive_buf	= hci_uart_tty_receive;
548	hci_uart_ldisc.write_wakeup	= hci_uart_tty_wakeup;
549	hci_uart_ldisc.owner		= THIS_MODULE;
550
551	if ((err = tty_register_ldisc(N_HCI, &hci_uart_ldisc))) {
 
552		BT_ERR("HCI line discipline registration failed. (%d)", err);
553		return err;
554	}
555
556#ifdef CONFIG_BT_HCIUART_H4
557	h4_init();
558#endif
559#ifdef CONFIG_BT_HCIUART_BCSP
560	bcsp_init();
561#endif
562#ifdef CONFIG_BT_HCIUART_LL
563	ll_init();
564#endif
565#ifdef CONFIG_BT_HCIUART_ATH3K
566	ath_init();
567#endif
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
568
569	return 0;
570}
571
572static void __exit hci_uart_exit(void)
573{
574	int err;
575
576#ifdef CONFIG_BT_HCIUART_H4
577	h4_deinit();
578#endif
579#ifdef CONFIG_BT_HCIUART_BCSP
580	bcsp_deinit();
581#endif
582#ifdef CONFIG_BT_HCIUART_LL
583	ll_deinit();
584#endif
585#ifdef CONFIG_BT_HCIUART_ATH3K
586	ath_deinit();
587#endif
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
588
589	/* Release tty registration of line discipline */
590	if ((err = tty_unregister_ldisc(N_HCI)))
 
591		BT_ERR("Can't unregister HCI line discipline (%d)", err);
592}
593
594module_init(hci_uart_init);
595module_exit(hci_uart_exit);
596
597module_param(reset, bool, 0644);
598MODULE_PARM_DESC(reset, "Send HCI reset command on initialization");
599
600MODULE_AUTHOR("Marcel Holtmann <marcel@holtmann.org>");
601MODULE_DESCRIPTION("Bluetooth HCI UART driver ver " VERSION);
602MODULE_VERSION(VERSION);
603MODULE_LICENSE("GPL");
604MODULE_ALIAS_LDISC(N_HCI);
v4.10.11
  1/*
  2 *
  3 *  Bluetooth HCI UART driver
  4 *
  5 *  Copyright (C) 2000-2001  Qualcomm Incorporated
  6 *  Copyright (C) 2002-2003  Maxim Krasnyansky <maxk@qualcomm.com>
  7 *  Copyright (C) 2004-2005  Marcel Holtmann <marcel@holtmann.org>
  8 *
  9 *
 10 *  This program is free software; you can redistribute it and/or modify
 11 *  it under the terms of the GNU General Public License as published by
 12 *  the Free Software Foundation; either version 2 of the License, or
 13 *  (at your option) any later version.
 14 *
 15 *  This program is distributed in the hope that it will be useful,
 16 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 17 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 18 *  GNU General Public License for more details.
 19 *
 20 *  You should have received a copy of the GNU General Public License
 21 *  along with this program; if not, write to the Free Software
 22 *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 23 *
 24 */
 25
 26#include <linux/module.h>
 27
 28#include <linux/kernel.h>
 29#include <linux/init.h>
 30#include <linux/types.h>
 31#include <linux/fcntl.h>
 32#include <linux/interrupt.h>
 33#include <linux/ptrace.h>
 34#include <linux/poll.h>
 35
 36#include <linux/slab.h>
 37#include <linux/tty.h>
 38#include <linux/errno.h>
 39#include <linux/string.h>
 40#include <linux/signal.h>
 41#include <linux/ioctl.h>
 42#include <linux/skbuff.h>
 43#include <linux/firmware.h>
 44
 45#include <net/bluetooth/bluetooth.h>
 46#include <net/bluetooth/hci_core.h>
 47
 48#include "btintel.h"
 49#include "btbcm.h"
 50#include "hci_uart.h"
 51
 52#define VERSION "2.3"
 53
 54static const struct hci_uart_proto *hup[HCI_UART_MAX_PROTO];
 55
 56int hci_uart_register_proto(const struct hci_uart_proto *p)
 
 
 57{
 58	if (p->id >= HCI_UART_MAX_PROTO)
 59		return -EINVAL;
 60
 61	if (hup[p->id])
 62		return -EEXIST;
 63
 64	hup[p->id] = p;
 65
 66	BT_INFO("HCI UART protocol %s registered", p->name);
 67
 68	return 0;
 69}
 70
 71int hci_uart_unregister_proto(const struct hci_uart_proto *p)
 72{
 73	if (p->id >= HCI_UART_MAX_PROTO)
 74		return -EINVAL;
 75
 76	if (!hup[p->id])
 77		return -EINVAL;
 78
 79	hup[p->id] = NULL;
 80
 81	return 0;
 82}
 83
 84static const struct hci_uart_proto *hci_uart_get_proto(unsigned int id)
 85{
 86	if (id >= HCI_UART_MAX_PROTO)
 87		return NULL;
 88
 89	return hup[id];
 90}
 91
 92static inline void hci_uart_tx_complete(struct hci_uart *hu, int pkt_type)
 93{
 94	struct hci_dev *hdev = hu->hdev;
 95
 96	/* Update HCI stat counters */
 97	switch (pkt_type) {
 98	case HCI_COMMAND_PKT:
 99		hdev->stat.cmd_tx++;
100		break;
101
102	case HCI_ACLDATA_PKT:
103		hdev->stat.acl_tx++;
104		break;
105
106	case HCI_SCODATA_PKT:
107		hdev->stat.sco_tx++;
108		break;
109	}
110}
111
112static inline struct sk_buff *hci_uart_dequeue(struct hci_uart *hu)
113{
114	struct sk_buff *skb = hu->tx_skb;
115
116	if (!skb)
117		skb = hu->proto->dequeue(hu);
118	else
119		hu->tx_skb = NULL;
120
121	return skb;
122}
123
124int hci_uart_tx_wakeup(struct hci_uart *hu)
125{
 
 
 
 
126	if (test_and_set_bit(HCI_UART_SENDING, &hu->tx_state)) {
127		set_bit(HCI_UART_TX_WAKEUP, &hu->tx_state);
128		return 0;
129	}
130
131	BT_DBG("");
132
133	schedule_work(&hu->write_work);
134
135	return 0;
136}
137
138static void hci_uart_write_work(struct work_struct *work)
139{
140	struct hci_uart *hu = container_of(work, struct hci_uart, write_work);
141	struct tty_struct *tty = hu->tty;
142	struct hci_dev *hdev = hu->hdev;
143	struct sk_buff *skb;
144
145	/* REVISIT: should we cope with bad skbs or ->write() returning
146	 * and error value ?
147	 */
148
149restart:
150	clear_bit(HCI_UART_TX_WAKEUP, &hu->tx_state);
151
152	while ((skb = hci_uart_dequeue(hu))) {
153		int len;
154
155		set_bit(TTY_DO_WRITE_WAKEUP, &tty->flags);
156		len = tty->ops->write(tty, skb->data, skb->len);
157		hdev->stat.byte_tx += len;
158
159		skb_pull(skb, len);
160		if (skb->len) {
161			hu->tx_skb = skb;
162			break;
163		}
164
165		hci_uart_tx_complete(hu, hci_skb_pkt_type(skb));
166		kfree_skb(skb);
167	}
168
169	if (test_bit(HCI_UART_TX_WAKEUP, &hu->tx_state))
170		goto restart;
171
172	clear_bit(HCI_UART_SENDING, &hu->tx_state);
173}
174
175static void hci_uart_init_work(struct work_struct *work)
176{
177	struct hci_uart *hu = container_of(work, struct hci_uart, init_ready);
178	int err;
179
180	if (!test_and_clear_bit(HCI_UART_INIT_PENDING, &hu->hdev_flags))
181		return;
182
183	err = hci_register_dev(hu->hdev);
184	if (err < 0) {
185		BT_ERR("Can't register HCI device");
186		hci_free_dev(hu->hdev);
187		hu->hdev = NULL;
188		hu->proto->close(hu);
189	}
190
191	set_bit(HCI_UART_REGISTERED, &hu->flags);
192}
193
194int hci_uart_init_ready(struct hci_uart *hu)
195{
196	if (!test_bit(HCI_UART_INIT_PENDING, &hu->hdev_flags))
197		return -EALREADY;
198
199	schedule_work(&hu->init_ready);
200
201	return 0;
202}
203
204/* ------- Interface to HCI layer ------ */
205/* Initialize device */
206static int hci_uart_open(struct hci_dev *hdev)
207{
208	BT_DBG("%s %p", hdev->name, hdev);
209
210	/* Nothing to do for UART driver */
 
 
 
211	return 0;
212}
213
214/* Reset device */
215static int hci_uart_flush(struct hci_dev *hdev)
216{
217	struct hci_uart *hu  = hci_get_drvdata(hdev);
218	struct tty_struct *tty = hu->tty;
219
220	BT_DBG("hdev %p tty %p", hdev, tty);
221
222	if (hu->tx_skb) {
223		kfree_skb(hu->tx_skb); hu->tx_skb = NULL;
224	}
225
226	/* Flush any pending characters in the driver and discipline. */
227	tty_ldisc_flush(tty);
228	tty_driver_flush_buffer(tty);
229
230	if (test_bit(HCI_UART_PROTO_READY, &hu->flags))
231		hu->proto->flush(hu);
232
233	return 0;
234}
235
236/* Close device */
237static int hci_uart_close(struct hci_dev *hdev)
238{
239	BT_DBG("hdev %p", hdev);
240
 
 
 
241	hci_uart_flush(hdev);
242	hdev->flush = NULL;
243	return 0;
244}
245
246/* Send frames from HCI layer */
247static int hci_uart_send_frame(struct hci_dev *hdev, struct sk_buff *skb)
248{
249	struct hci_uart *hu = hci_get_drvdata(hdev);
 
250
251	BT_DBG("%s: type %d len %d", hdev->name, hci_skb_pkt_type(skb),
252	       skb->len);
253
254	hu->proto->enqueue(hu, skb);
255
256	hci_uart_tx_wakeup(hu);
257
258	return 0;
259}
260
261/* Flow control or un-flow control the device */
262void hci_uart_set_flow_control(struct hci_uart *hu, bool enable)
263{
264	struct tty_struct *tty = hu->tty;
265	struct ktermios ktermios;
266	int status;
267	unsigned int set = 0;
268	unsigned int clear = 0;
269
270	if (enable) {
271		/* Disable hardware flow control */
272		ktermios = tty->termios;
273		ktermios.c_cflag &= ~CRTSCTS;
274		status = tty_set_termios(tty, &ktermios);
275		BT_DBG("Disabling hardware flow control: %s",
276		       status ? "failed" : "success");
277
278		/* Clear RTS to prevent the device from sending */
279		/* Most UARTs need OUT2 to enable interrupts */
280		status = tty->driver->ops->tiocmget(tty);
281		BT_DBG("Current tiocm 0x%x", status);
282
283		set &= ~(TIOCM_OUT2 | TIOCM_RTS);
284		clear = ~set;
285		set &= TIOCM_DTR | TIOCM_RTS | TIOCM_OUT1 |
286		       TIOCM_OUT2 | TIOCM_LOOP;
287		clear &= TIOCM_DTR | TIOCM_RTS | TIOCM_OUT1 |
288			 TIOCM_OUT2 | TIOCM_LOOP;
289		status = tty->driver->ops->tiocmset(tty, set, clear);
290		BT_DBG("Clearing RTS: %s", status ? "failed" : "success");
291	} else {
292		/* Set RTS to allow the device to send again */
293		status = tty->driver->ops->tiocmget(tty);
294		BT_DBG("Current tiocm 0x%x", status);
295
296		set |= (TIOCM_OUT2 | TIOCM_RTS);
297		clear = ~set;
298		set &= TIOCM_DTR | TIOCM_RTS | TIOCM_OUT1 |
299		       TIOCM_OUT2 | TIOCM_LOOP;
300		clear &= TIOCM_DTR | TIOCM_RTS | TIOCM_OUT1 |
301			 TIOCM_OUT2 | TIOCM_LOOP;
302		status = tty->driver->ops->tiocmset(tty, set, clear);
303		BT_DBG("Setting RTS: %s", status ? "failed" : "success");
304
305		/* Re-enable hardware flow control */
306		ktermios = tty->termios;
307		ktermios.c_cflag |= CRTSCTS;
308		status = tty_set_termios(tty, &ktermios);
309		BT_DBG("Enabling hardware flow control: %s",
310		       status ? "failed" : "success");
311	}
312}
313
314void hci_uart_set_speeds(struct hci_uart *hu, unsigned int init_speed,
315			 unsigned int oper_speed)
316{
317	hu->init_speed = init_speed;
318	hu->oper_speed = oper_speed;
319}
320
321void hci_uart_init_tty(struct hci_uart *hu)
322{
323	struct tty_struct *tty = hu->tty;
324	struct ktermios ktermios;
325
326	/* Bring the UART into a known 8 bits no parity hw fc state */
327	ktermios = tty->termios;
328	ktermios.c_iflag &= ~(IGNBRK | BRKINT | PARMRK | ISTRIP |
329			      INLCR | IGNCR | ICRNL | IXON);
330	ktermios.c_oflag &= ~OPOST;
331	ktermios.c_lflag &= ~(ECHO | ECHONL | ICANON | ISIG | IEXTEN);
332	ktermios.c_cflag &= ~(CSIZE | PARENB);
333	ktermios.c_cflag |= CS8;
334	ktermios.c_cflag |= CRTSCTS;
335
336	/* tty_set_termios() return not checked as it is always 0 */
337	tty_set_termios(tty, &ktermios);
338}
339
340void hci_uart_set_baudrate(struct hci_uart *hu, unsigned int speed)
341{
342	struct tty_struct *tty = hu->tty;
343	struct ktermios ktermios;
344
345	ktermios = tty->termios;
346	ktermios.c_cflag &= ~CBAUD;
347	tty_termios_encode_baud_rate(&ktermios, speed, speed);
348
349	/* tty_set_termios() return not checked as it is always 0 */
350	tty_set_termios(tty, &ktermios);
351
352	BT_DBG("%s: New tty speeds: %d/%d", hu->hdev->name,
353	       tty->termios.c_ispeed, tty->termios.c_ospeed);
354}
355
356static int hci_uart_setup(struct hci_dev *hdev)
357{
358	struct hci_uart *hu = hci_get_drvdata(hdev);
359	struct hci_rp_read_local_version *ver;
360	struct sk_buff *skb;
361	unsigned int speed;
362	int err;
363
364	/* Init speed if any */
365	if (hu->init_speed)
366		speed = hu->init_speed;
367	else if (hu->proto->init_speed)
368		speed = hu->proto->init_speed;
369	else
370		speed = 0;
371
372	if (speed)
373		hci_uart_set_baudrate(hu, speed);
374
375	/* Operational speed if any */
376	if (hu->oper_speed)
377		speed = hu->oper_speed;
378	else if (hu->proto->oper_speed)
379		speed = hu->proto->oper_speed;
380	else
381		speed = 0;
382
383	if (hu->proto->set_baudrate && speed) {
384		err = hu->proto->set_baudrate(hu, speed);
385		if (!err)
386			hci_uart_set_baudrate(hu, speed);
387	}
388
389	if (hu->proto->setup)
390		return hu->proto->setup(hu);
391
392	if (!test_bit(HCI_UART_VND_DETECT, &hu->hdev_flags))
393		return 0;
394
395	skb = __hci_cmd_sync(hdev, HCI_OP_READ_LOCAL_VERSION, 0, NULL,
396			     HCI_INIT_TIMEOUT);
397	if (IS_ERR(skb)) {
398		BT_ERR("%s: Reading local version information failed (%ld)",
399		       hdev->name, PTR_ERR(skb));
400		return 0;
401	}
402
403	if (skb->len != sizeof(*ver)) {
404		BT_ERR("%s: Event length mismatch for version information",
405		       hdev->name);
406		goto done;
407	}
408
409	ver = (struct hci_rp_read_local_version *)skb->data;
410
411	switch (le16_to_cpu(ver->manufacturer)) {
412#ifdef CONFIG_BT_HCIUART_INTEL
413	case 2:
414		hdev->set_bdaddr = btintel_set_bdaddr;
415		btintel_check_bdaddr(hdev);
416		break;
417#endif
418#ifdef CONFIG_BT_HCIUART_BCM
419	case 15:
420		hdev->set_bdaddr = btbcm_set_bdaddr;
421		btbcm_check_bdaddr(hdev);
422		break;
423#endif
424	}
425
426done:
427	kfree_skb(skb);
428	return 0;
429}
430
431/* ------ LDISC part ------ */
432/* hci_uart_tty_open
433 *
434 *     Called when line discipline changed to HCI_UART.
435 *
436 * Arguments:
437 *     tty    pointer to tty info structure
438 * Return Value:
439 *     0 if success, otherwise error code
440 */
441static int hci_uart_tty_open(struct tty_struct *tty)
442{
443	struct hci_uart *hu;
444
445	BT_DBG("tty %p", tty);
446
 
 
 
 
 
447	/* Error if the tty has no write op instead of leaving an exploitable
448	   hole */
449	if (tty->ops->write == NULL)
450		return -EOPNOTSUPP;
451
452	hu = kzalloc(sizeof(struct hci_uart), GFP_KERNEL);
453	if (!hu) {
454		BT_ERR("Can't allocate control structure");
455		return -ENFILE;
456	}
457
458	tty->disc_data = hu;
459	hu->tty = tty;
460	tty->receive_room = 65536;
461
462	INIT_WORK(&hu->init_ready, hci_uart_init_work);
463	INIT_WORK(&hu->write_work, hci_uart_write_work);
 
464
465	/* Flush any pending characters in the driver */
 
 
 
 
466	tty_driver_flush_buffer(tty);
467
468	return 0;
469}
470
471/* hci_uart_tty_close()
472 *
473 *    Called when the line discipline is changed to something
474 *    else, the tty is closed, or the tty detects a hangup.
475 */
476static void hci_uart_tty_close(struct tty_struct *tty)
477{
478	struct hci_uart *hu = tty->disc_data;
479	struct hci_dev *hdev;
480
481	BT_DBG("tty %p", tty);
482
483	/* Detach from the tty */
484	tty->disc_data = NULL;
485
486	if (!hu)
487		return;
 
 
 
488
489	hdev = hu->hdev;
490	if (hdev)
491		hci_uart_close(hdev);
492
493	cancel_work_sync(&hu->write_work);
494
495	if (test_and_clear_bit(HCI_UART_PROTO_READY, &hu->flags)) {
496		if (hdev) {
497			if (test_bit(HCI_UART_REGISTERED, &hu->flags))
498				hci_unregister_dev(hdev);
499			hci_free_dev(hdev);
 
500		}
501		hu->proto->close(hu);
502	}
503	clear_bit(HCI_UART_PROTO_SET, &hu->flags);
504
505	kfree(hu);
506}
507
508/* hci_uart_tty_wakeup()
509 *
510 *    Callback for transmit wakeup. Called when low level
511 *    device driver can accept more send data.
512 *
513 * Arguments:        tty    pointer to associated tty instance data
514 * Return Value:    None
515 */
516static void hci_uart_tty_wakeup(struct tty_struct *tty)
517{
518	struct hci_uart *hu = tty->disc_data;
519
520	BT_DBG("");
521
522	if (!hu)
523		return;
524
525	clear_bit(TTY_DO_WRITE_WAKEUP, &tty->flags);
526
527	if (tty != hu->tty)
528		return;
529
530	if (test_bit(HCI_UART_PROTO_READY, &hu->flags))
531		hci_uart_tx_wakeup(hu);
532}
533
534/* hci_uart_tty_receive()
535 *
536 *     Called by tty low level driver when receive data is
537 *     available.
538 *
539 * Arguments:  tty          pointer to tty isntance data
540 *             data         pointer to received data
541 *             flags        pointer to flags for data
542 *             count        count of received data in bytes
543 *
544 * Return Value:    None
545 */
546static void hci_uart_tty_receive(struct tty_struct *tty, const u8 *data,
547				 char *flags, int count)
548{
549	struct hci_uart *hu = tty->disc_data;
550
551	if (!hu || tty != hu->tty)
552		return;
553
554	if (!test_bit(HCI_UART_PROTO_READY, &hu->flags))
555		return;
556
557	/* It does not need a lock here as it is already protected by a mutex in
558	 * tty caller
559	 */
560	hu->proto->recv(hu, data, count);
561
562	if (hu->hdev)
563		hu->hdev->stat.byte_rx += count;
564
565	tty_unthrottle(tty);
566}
567
568static int hci_uart_register_dev(struct hci_uart *hu)
569{
570	struct hci_dev *hdev;
571
572	BT_DBG("");
573
574	/* Initialize and register HCI device */
575	hdev = hci_alloc_dev();
576	if (!hdev) {
577		BT_ERR("Can't allocate HCI device");
578		return -ENOMEM;
579	}
580
581	hu->hdev = hdev;
582
583	hdev->bus = HCI_UART;
584	hci_set_drvdata(hdev, hu);
585
586	/* Only when vendor specific setup callback is provided, consider
587	 * the manufacturer information valid. This avoids filling in the
588	 * value for Ericsson when nothing is specified.
589	 */
590	if (hu->proto->setup)
591		hdev->manufacturer = hu->proto->manufacturer;
592
593	hdev->open  = hci_uart_open;
594	hdev->close = hci_uart_close;
595	hdev->flush = hci_uart_flush;
596	hdev->send  = hci_uart_send_frame;
597	hdev->setup = hci_uart_setup;
598	SET_HCIDEV_DEV(hdev, hu->tty->dev);
 
 
 
 
 
599
600	if (test_bit(HCI_UART_RAW_DEVICE, &hu->hdev_flags))
601		set_bit(HCI_QUIRK_RAW_DEVICE, &hdev->quirks);
602
603	if (test_bit(HCI_UART_EXT_CONFIG, &hu->hdev_flags))
604		set_bit(HCI_QUIRK_EXTERNAL_CONFIG, &hdev->quirks);
605
606	if (!test_bit(HCI_UART_RESET_ON_INIT, &hu->hdev_flags))
607		set_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks);
608
609	if (test_bit(HCI_UART_CREATE_AMP, &hu->hdev_flags))
610		hdev->dev_type = HCI_AMP;
611	else
612		hdev->dev_type = HCI_PRIMARY;
613
614	if (test_bit(HCI_UART_INIT_PENDING, &hu->hdev_flags))
615		return 0;
616
617	if (hci_register_dev(hdev) < 0) {
618		BT_ERR("Can't register HCI device");
619		hci_free_dev(hdev);
620		return -ENODEV;
621	}
622
623	set_bit(HCI_UART_REGISTERED, &hu->flags);
624
625	return 0;
626}
627
628static int hci_uart_set_proto(struct hci_uart *hu, int id)
629{
630	const struct hci_uart_proto *p;
631	int err;
632
633	p = hci_uart_get_proto(id);
634	if (!p)
635		return -EPROTONOSUPPORT;
636
637	err = p->open(hu);
638	if (err)
639		return err;
640
641	hu->proto = p;
642	set_bit(HCI_UART_PROTO_READY, &hu->flags);
643
644	err = hci_uart_register_dev(hu);
645	if (err) {
646		clear_bit(HCI_UART_PROTO_READY, &hu->flags);
647		p->close(hu);
648		return err;
649	}
650
651	return 0;
652}
653
654static int hci_uart_set_flags(struct hci_uart *hu, unsigned long flags)
655{
656	unsigned long valid_flags = BIT(HCI_UART_RAW_DEVICE) |
657				    BIT(HCI_UART_RESET_ON_INIT) |
658				    BIT(HCI_UART_CREATE_AMP) |
659				    BIT(HCI_UART_INIT_PENDING) |
660				    BIT(HCI_UART_EXT_CONFIG) |
661				    BIT(HCI_UART_VND_DETECT);
662
663	if (flags & ~valid_flags)
664		return -EINVAL;
665
666	hu->hdev_flags = flags;
667
668	return 0;
669}
670
671/* hci_uart_tty_ioctl()
672 *
673 *    Process IOCTL system call for the tty device.
674 *
675 * Arguments:
676 *
677 *    tty        pointer to tty instance data
678 *    file       pointer to open file object for device
679 *    cmd        IOCTL command code
680 *    arg        argument for IOCTL call (cmd dependent)
681 *
682 * Return Value:    Command dependent
683 */
684static int hci_uart_tty_ioctl(struct tty_struct *tty, struct file *file,
685			      unsigned int cmd, unsigned long arg)
686{
687	struct hci_uart *hu = tty->disc_data;
688	int err = 0;
689
690	BT_DBG("");
691
692	/* Verify the status of the device */
693	if (!hu)
694		return -EBADF;
695
696	switch (cmd) {
697	case HCIUARTSETPROTO:
698		if (!test_and_set_bit(HCI_UART_PROTO_SET, &hu->flags)) {
699			err = hci_uart_set_proto(hu, arg);
700			if (err)
701				clear_bit(HCI_UART_PROTO_SET, &hu->flags);
 
 
702		} else
703			err = -EBUSY;
704		break;
705
706	case HCIUARTGETPROTO:
707		if (test_bit(HCI_UART_PROTO_SET, &hu->flags))
708			err = hu->proto->id;
709		else
710			err = -EUNATCH;
711		break;
712
713	case HCIUARTGETDEVICE:
714		if (test_bit(HCI_UART_REGISTERED, &hu->flags))
715			err = hu->hdev->id;
716		else
717			err = -EUNATCH;
718		break;
719
720	case HCIUARTSETFLAGS:
721		if (test_bit(HCI_UART_PROTO_SET, &hu->flags))
722			err = -EBUSY;
723		else
724			err = hci_uart_set_flags(hu, arg);
725		break;
726
727	case HCIUARTGETFLAGS:
728		err = hu->hdev_flags;
729		break;
730
731	default:
732		err = n_tty_ioctl_helper(tty, file, cmd, arg);
733		break;
734	}
735
736	return err;
737}
738
739/*
740 * We don't provide read/write/poll interface for user space.
741 */
742static ssize_t hci_uart_tty_read(struct tty_struct *tty, struct file *file,
743				 unsigned char __user *buf, size_t nr)
744{
745	return 0;
746}
747
748static ssize_t hci_uart_tty_write(struct tty_struct *tty, struct file *file,
749				  const unsigned char *data, size_t count)
750{
751	return 0;
752}
753
754static unsigned int hci_uart_tty_poll(struct tty_struct *tty,
755				      struct file *filp, poll_table *wait)
756{
757	return 0;
758}
759
760static int __init hci_uart_init(void)
761{
762	static struct tty_ldisc_ops hci_uart_ldisc;
763	int err;
764
765	BT_INFO("HCI UART driver ver %s", VERSION);
766
767	/* Register the tty discipline */
768
769	memset(&hci_uart_ldisc, 0, sizeof(hci_uart_ldisc));
770	hci_uart_ldisc.magic		= TTY_LDISC_MAGIC;
771	hci_uart_ldisc.name		= "n_hci";
772	hci_uart_ldisc.open		= hci_uart_tty_open;
773	hci_uart_ldisc.close		= hci_uart_tty_close;
774	hci_uart_ldisc.read		= hci_uart_tty_read;
775	hci_uart_ldisc.write		= hci_uart_tty_write;
776	hci_uart_ldisc.ioctl		= hci_uart_tty_ioctl;
777	hci_uart_ldisc.poll		= hci_uart_tty_poll;
778	hci_uart_ldisc.receive_buf	= hci_uart_tty_receive;
779	hci_uart_ldisc.write_wakeup	= hci_uart_tty_wakeup;
780	hci_uart_ldisc.owner		= THIS_MODULE;
781
782	err = tty_register_ldisc(N_HCI, &hci_uart_ldisc);
783	if (err) {
784		BT_ERR("HCI line discipline registration failed. (%d)", err);
785		return err;
786	}
787
788#ifdef CONFIG_BT_HCIUART_H4
789	h4_init();
790#endif
791#ifdef CONFIG_BT_HCIUART_BCSP
792	bcsp_init();
793#endif
794#ifdef CONFIG_BT_HCIUART_LL
795	ll_init();
796#endif
797#ifdef CONFIG_BT_HCIUART_ATH3K
798	ath_init();
799#endif
800#ifdef CONFIG_BT_HCIUART_3WIRE
801	h5_init();
802#endif
803#ifdef CONFIG_BT_HCIUART_INTEL
804	intel_init();
805#endif
806#ifdef CONFIG_BT_HCIUART_BCM
807	bcm_init();
808#endif
809#ifdef CONFIG_BT_HCIUART_QCA
810	qca_init();
811#endif
812#ifdef CONFIG_BT_HCIUART_AG6XX
813	ag6xx_init();
814#endif
815#ifdef CONFIG_BT_HCIUART_MRVL
816	mrvl_init();
817#endif
818
819	return 0;
820}
821
822static void __exit hci_uart_exit(void)
823{
824	int err;
825
826#ifdef CONFIG_BT_HCIUART_H4
827	h4_deinit();
828#endif
829#ifdef CONFIG_BT_HCIUART_BCSP
830	bcsp_deinit();
831#endif
832#ifdef CONFIG_BT_HCIUART_LL
833	ll_deinit();
834#endif
835#ifdef CONFIG_BT_HCIUART_ATH3K
836	ath_deinit();
837#endif
838#ifdef CONFIG_BT_HCIUART_3WIRE
839	h5_deinit();
840#endif
841#ifdef CONFIG_BT_HCIUART_INTEL
842	intel_deinit();
843#endif
844#ifdef CONFIG_BT_HCIUART_BCM
845	bcm_deinit();
846#endif
847#ifdef CONFIG_BT_HCIUART_QCA
848	qca_deinit();
849#endif
850#ifdef CONFIG_BT_HCIUART_AG6XX
851	ag6xx_deinit();
852#endif
853#ifdef CONFIG_BT_HCIUART_MRVL
854	mrvl_deinit();
855#endif
856
857	/* Release tty registration of line discipline */
858	err = tty_unregister_ldisc(N_HCI);
859	if (err)
860		BT_ERR("Can't unregister HCI line discipline (%d)", err);
861}
862
863module_init(hci_uart_init);
864module_exit(hci_uart_exit);
 
 
 
865
866MODULE_AUTHOR("Marcel Holtmann <marcel@holtmann.org>");
867MODULE_DESCRIPTION("Bluetooth HCI UART driver ver " VERSION);
868MODULE_VERSION(VERSION);
869MODULE_LICENSE("GPL");
870MODULE_ALIAS_LDISC(N_HCI);