[net-next-2.6.git] / drivers / bluetooth / btuart_cs.c

/*
 *
 *  Driver for Bluetooth PCMCIA cards with HCI UART interface
 *
 *  Copyright (C) 2001-2002  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 version 2 as
 *  published by the Free Software Foundation;
 *
 *  Software distributed under the License is distributed on an "AS
 *  IS" basis, WITHOUT WARRANTY OF ANY KIND, either express or
 *  implied. See the License for the specific language governing
 *  rights and limitations under the License.
 *
 *  The initial developer of the original code is David A. Hinds
 *  <dahinds@users.sourceforge.net>.  Portions created by David A. Hinds
 *  are Copyright (C) 1999 David A. Hinds.  All Rights Reserved.
 *
 */

#include <linux/module.h>

#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/slab.h>
#include <linux/types.h>
#include <linux/delay.h>
#include <linux/errno.h>
#include <linux/ptrace.h>
#include <linux/ioport.h>
#include <linux/spinlock.h>
#include <linux/moduleparam.h>

#include <linux/skbuff.h>
#include <linux/string.h>
#include <linux/serial.h>
#include <linux/serial_reg.h>
#include <linux/bitops.h>
#include <asm/system.h>
#include <asm/io.h>

#include <pcmcia/cs_types.h>
#include <pcmcia/cs.h>
#include <pcmcia/cistpl.h>
#include <pcmcia/ciscode.h>
#include <pcmcia/ds.h>
#include <pcmcia/cisreg.h>

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


/* ======================== Module parameters ======================== */


MODULE_AUTHOR("Marcel Holtmann <marcel@holtmann.org>");
MODULE_DESCRIPTION("Bluetooth driver for Bluetooth PCMCIA cards with HCI UART interface");
MODULE_LICENSE("GPL");


/* ======================== Local structures ======================== */


typedef struct btuart_info_t {
	struct pcmcia_device *p_dev;

	struct hci_dev *hdev;

	spinlock_t lock;	/* For serializing operations */

	struct sk_buff_head txq;
	unsigned long tx_state;

	unsigned long rx_state;
	unsigned long rx_count;
	struct sk_buff *rx_skb;
} btuart_info_t;


static int btuart_config(struct pcmcia_device *link);
static void btuart_release(struct pcmcia_device *link);

static void btuart_detach(struct pcmcia_device *p_dev);


/* Maximum baud rate */
#define SPEED_MAX  115200

/* Default baud rate: 57600, 115200, 230400 or 460800 */
#define DEFAULT_BAUD_RATE  115200


/* Transmit states  */
#define XMIT_SENDING	1
#define XMIT_WAKEUP	2
#define XMIT_WAITING	8

/* Receiver states */
#define RECV_WAIT_PACKET_TYPE	0
#define RECV_WAIT_EVENT_HEADER	1
#define RECV_WAIT_ACL_HEADER	2
#define RECV_WAIT_SCO_HEADER	3
#define RECV_WAIT_DATA		4


/* ======================== Interrupt handling ======================== */


static int btuart_write(unsigned int iobase, int fifo_size, __u8 *buf, int len)
{
	int actual = 0;

	/* Tx FIFO should be empty */
	if (!(inb(iobase + UART_LSR) & UART_LSR_THRE))
		return 0;

	/* Fill FIFO with current frame */
	while ((fifo_size-- > 0) && (actual < len)) {
		/* Transmit next byte */
		outb(buf[actual], iobase + UART_TX);
		actual++;
	}

	return actual;
}


static void btuart_write_wakeup(btuart_info_t *info)
{
	if (!info) {
		BT_ERR("Unknown device");
		return;
	}

	if (test_and_set_bit(XMIT_SENDING, &(info->tx_state))) {
		set_bit(XMIT_WAKEUP, &(info->tx_state));
		return;
	}

	do {
		register unsigned int iobase = info->p_dev->io.BasePort1;
		register struct sk_buff *skb;
		register int len;

		clear_bit(XMIT_WAKEUP, &(info->tx_state));

		if (!pcmcia_dev_present(info->p_dev))
			return;

		if (!(skb = skb_dequeue(&(info->txq))))
			break;

		/* Send frame */
		len = btuart_write(iobase, 16, skb->data, skb->len);
		set_bit(XMIT_WAKEUP, &(info->tx_state));

		if (len == skb->len) {
			kfree_skb(skb);
		} else {
			skb_pull(skb, len);
			skb_queue_head(&(info->txq), skb);
		}

		info->hdev->stat.byte_tx += len;

	} while (test_bit(XMIT_WAKEUP, &(info->tx_state)));

	clear_bit(XMIT_SENDING, &(info->tx_state));
}


static void btuart_receive(btuart_info_t *info)
{
	unsigned int iobase;
	int boguscount = 0;

	if (!info) {
		BT_ERR("Unknown device");
		return;
	}

	iobase = info->p_dev->io.BasePort1;

	do {
		info->hdev->stat.byte_rx++;

		/* Allocate packet */
		if (info->rx_skb == NULL) {
			info->rx_state = RECV_WAIT_PACKET_TYPE;
			info->rx_count = 0;
			if (!(info->rx_skb = bt_skb_alloc(HCI_MAX_FRAME_SIZE, GFP_ATOMIC))) {
				BT_ERR("Can't allocate mem for new packet");
				return;
			}
		}

		if (info->rx_state == RECV_WAIT_PACKET_TYPE) {

			info->rx_skb->dev = (void *) info->hdev;
			bt_cb(info->rx_skb)->pkt_type = inb(iobase + UART_RX);

			switch (bt_cb(info->rx_skb)->pkt_type) {

			case HCI_EVENT_PKT:
				info->rx_state = RECV_WAIT_EVENT_HEADER;
				info->rx_count = HCI_EVENT_HDR_SIZE;
				break;

			case HCI_ACLDATA_PKT:
				info->rx_state = RECV_WAIT_ACL_HEADER;
				info->rx_count = HCI_ACL_HDR_SIZE;
				break;

			case HCI_SCODATA_PKT:
				info->rx_state = RECV_WAIT_SCO_HEADER;
				info->rx_count = HCI_SCO_HDR_SIZE;
				break;

			default:
				/* Unknown packet */
				BT_ERR("Unknown HCI packet with type 0x%02x received", bt_cb(info->rx_skb)->pkt_type);
				info->hdev->stat.err_rx++;
				clear_bit(HCI_RUNNING, &(info->hdev->flags));

				kfree_skb(info->rx_skb);
				info->rx_skb = NULL;
				break;

			}

		} else {

			*skb_put(info->rx_skb, 1) = inb(iobase + UART_RX);
			info->rx_count--;

			if (info->rx_count == 0) {

				int dlen;
				struct hci_event_hdr *eh;
				struct hci_acl_hdr *ah;
				struct hci_sco_hdr *sh;


				switch (info->rx_state) {

				case RECV_WAIT_EVENT_HEADER:
					eh = hci_event_hdr(info->rx_skb);
					info->rx_state = RECV_WAIT_DATA;
					info->rx_count = eh->plen;
					break;

				case RECV_WAIT_ACL_HEADER:
					ah = hci_acl_hdr(info->rx_skb);
					dlen = __le16_to_cpu(ah->dlen);
					info->rx_state = RECV_WAIT_DATA;
					info->rx_count = dlen;
					break;

				case RECV_WAIT_SCO_HEADER:
					sh = hci_sco_hdr(info->rx_skb);
					info->rx_state = RECV_WAIT_DATA;
					info->rx_count = sh->dlen;
					break;

				case RECV_WAIT_DATA:
					hci_recv_frame(info->rx_skb);
					info->rx_skb = NULL;
					break;

				}

			}

		}

		/* Make sure we don't stay here too long */
		if (boguscount++ > 16)
			break;

	} while (inb(iobase + UART_LSR) & UART_LSR_DR);
}


static irqreturn_t btuart_interrupt(int irq, void *dev_inst)
{
	btuart_info_t *info = dev_inst;
	unsigned int iobase;
	int boguscount = 0;
	int iir, lsr;
	irqreturn_t r = IRQ_NONE;

	if (!info || !info->hdev)
		/* our irq handler is shared */
		return IRQ_NONE;

	iobase = info->p_dev->io.BasePort1;

	spin_lock(&(info->lock));

	iir = inb(iobase + UART_IIR) & UART_IIR_ID;
	while (iir) {
		r = IRQ_HANDLED;

		/* Clear interrupt */
		lsr = inb(iobase + UART_LSR);

		switch (iir) {
		case UART_IIR_RLSI:
			BT_ERR("RLSI");
			break;
		case UART_IIR_RDI:
			/* Receive interrupt */
			btuart_receive(info);
			break;
		case UART_IIR_THRI:
			if (lsr & UART_LSR_THRE) {
				/* Transmitter ready for data */
				btuart_write_wakeup(info);
			}
			break;
		default:
			BT_ERR("Unhandled IIR=%#x", iir);
			break;
		}

		/* Make sure we don't stay here too long */
		if (boguscount++ > 100)
			break;

		iir = inb(iobase + UART_IIR) & UART_IIR_ID;

	}

	spin_unlock(&(info->lock));

	return r;
}


static void btuart_change_speed(btuart_info_t *info, unsigned int speed)
{
	unsigned long flags;
	unsigned int iobase;
	int fcr;		/* FIFO control reg */
	int lcr;		/* Line control reg */
	int divisor;

	if (!info) {
		BT_ERR("Unknown device");
		return;
	}

	iobase = info->p_dev->io.BasePort1;

	spin_lock_irqsave(&(info->lock), flags);

	/* Turn off interrupts */
	outb(0, iobase + UART_IER);

	divisor = SPEED_MAX / speed;

	fcr = UART_FCR_ENABLE_FIFO | UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT;

	/* 
	 * Use trigger level 1 to avoid 3 ms. timeout delay at 9600 bps, and
	 * almost 1,7 ms at 19200 bps. At speeds above that we can just forget
	 * about this timeout since it will always be fast enough. 
	 */

	if (speed < 38400)
		fcr |= UART_FCR_TRIGGER_1;
	else
		fcr |= UART_FCR_TRIGGER_14;

	/* Bluetooth cards use 8N1 */
	lcr = UART_LCR_WLEN8;

	outb(UART_LCR_DLAB | lcr, iobase + UART_LCR);	/* Set DLAB */
	outb(divisor & 0xff, iobase + UART_DLL);	/* Set speed */
	outb(divisor >> 8, iobase + UART_DLM);
	outb(lcr, iobase + UART_LCR);	/* Set 8N1  */
	outb(fcr, iobase + UART_FCR);	/* Enable FIFO's */

	/* Turn on interrupts */
	outb(UART_IER_RLSI | UART_IER_RDI | UART_IER_THRI, iobase + UART_IER);

	spin_unlock_irqrestore(&(info->lock), flags);
}


/* ======================== HCI interface ======================== */


static int btuart_hci_flush(struct hci_dev *hdev)
{
	btuart_info_t *info = (btuart_info_t *)(hdev->driver_data);

	/* Drop TX queue */
	skb_queue_purge(&(info->txq));

	return 0;
}


static int btuart_hci_open(struct hci_dev *hdev)
{
	set_bit(HCI_RUNNING, &(hdev->flags));

	return 0;
}


static int btuart_hci_close(struct hci_dev *hdev)
{
	if (!test_and_clear_bit(HCI_RUNNING, &(hdev->flags)))
		return 0;

	btuart_hci_flush(hdev);

	return 0;
}


static int btuart_hci_send_frame(struct sk_buff *skb)
{
	btuart_info_t *info;
	struct hci_dev *hdev = (struct hci_dev *)(skb->dev);

	if (!hdev) {
		BT_ERR("Frame for unknown HCI device (hdev=NULL)");
		return -ENODEV;
	}

	info = (btuart_info_t *)(hdev->driver_data);

	switch (bt_cb(skb)->pkt_type) {
	case HCI_COMMAND_PKT:
		hdev->stat.cmd_tx++;
		break;
	case HCI_ACLDATA_PKT:
		hdev->stat.acl_tx++;
		break;
	case HCI_SCODATA_PKT:
		hdev->stat.sco_tx++;
		break;
	};

	/* Prepend skb with frame type */
	memcpy(skb_push(skb, 1), &bt_cb(skb)->pkt_type, 1);
	skb_queue_tail(&(info->txq), skb);

	btuart_write_wakeup(info);

	return 0;
}


static void btuart_hci_destruct(struct hci_dev *hdev)
{
}


static int btuart_hci_ioctl(struct hci_dev *hdev, unsigned int cmd, unsigned long arg)
{
	return -ENOIOCTLCMD;
}


/* ======================== Card services HCI interaction ======================== */


static int btuart_open(btuart_info_t *info)
{
	unsigned long flags;
	unsigned int iobase = info->p_dev->io.BasePort1;
	struct hci_dev *hdev;

	spin_lock_init(&(info->lock));

	skb_queue_head_init(&(info->txq));

	info->rx_state = RECV_WAIT_PACKET_TYPE;
	info->rx_count = 0;
	info->rx_skb = NULL;

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

	info->hdev = hdev;

	hdev->bus = HCI_PCCARD;
	hdev->driver_data = info;
	SET_HCIDEV_DEV(hdev, &info->p_dev->dev);

	hdev->open     = btuart_hci_open;
	hdev->close    = btuart_hci_close;
	hdev->flush    = btuart_hci_flush;
	hdev->send     = btuart_hci_send_frame;
	hdev->destruct = btuart_hci_destruct;
	hdev->ioctl    = btuart_hci_ioctl;

	hdev->owner = THIS_MODULE;

	spin_lock_irqsave(&(info->lock), flags);

	/* Reset UART */
	outb(0, iobase + UART_MCR);

	/* Turn off interrupts */
	outb(0, iobase + UART_IER);

	/* Initialize UART */
	outb(UART_LCR_WLEN8, iobase + UART_LCR);	/* Reset DLAB */
	outb((UART_MCR_DTR | UART_MCR_RTS | UART_MCR_OUT2), iobase + UART_MCR);

	/* Turn on interrupts */
	// outb(UART_IER_RLSI | UART_IER_RDI | UART_IER_THRI, iobase + UART_IER);

	spin_unlock_irqrestore(&(info->lock), flags);

	btuart_change_speed(info, DEFAULT_BAUD_RATE);

	/* Timeout before it is safe to send the first HCI packet */
	msleep(1000);

	/* Register HCI device */
	if (hci_register_dev(hdev) < 0) {
		BT_ERR("Can't register HCI device");
		info->hdev = NULL;
		hci_free_dev(hdev);
		return -ENODEV;
	}

	return 0;
}


static int btuart_close(btuart_info_t *info)
{
	unsigned long flags;
	unsigned int iobase = info->p_dev->io.BasePort1;
	struct hci_dev *hdev = info->hdev;

	if (!hdev)
		return -ENODEV;

	btuart_hci_close(hdev);

	spin_lock_irqsave(&(info->lock), flags);

	/* Reset UART */
	outb(0, iobase + UART_MCR);

	/* Turn off interrupts */
	outb(0, iobase + UART_IER);

	spin_unlock_irqrestore(&(info->lock), flags);

	if (hci_unregister_dev(hdev) < 0)
		BT_ERR("Can't unregister HCI device %s", hdev->name);

	hci_free_dev(hdev);

	return 0;
}

static int btuart_probe(struct pcmcia_device *link)
{
	btuart_info_t *info;

	/* Create new info device */
	info = kzalloc(sizeof(*info), GFP_KERNEL);
	if (!info)
		return -ENOMEM;

	info->p_dev = link;
	link->priv = info;

	link->io.Attributes1 = IO_DATA_PATH_WIDTH_8;
	link->io.NumPorts1 = 8;

	link->conf.Attributes = CONF_ENABLE_IRQ;
	link->conf.IntType = INT_MEMORY_AND_IO;

	return btuart_config(link);
}


static void btuart_detach(struct pcmcia_device *link)
{
	btuart_info_t *info = link->priv;

	btuart_release(link);
	kfree(info);
}

static int btuart_check_config(struct pcmcia_device *p_dev,
			       cistpl_cftable_entry_t *cf,
			       cistpl_cftable_entry_t *dflt,
			       unsigned int vcc,
			       void *priv_data)
{
	int *try = priv_data;

	if (cf->vpp1.present & (1 << CISTPL_POWER_VNOM))
		p_dev->conf.Vpp = cf->vpp1.param[CISTPL_POWER_VNOM] / 10000;
	if ((cf->io.nwin > 0) && (cf->io.win[0].len == 8) &&
	    (cf->io.win[0].base != 0)) {
		p_dev->io.BasePort1 = cf->io.win[0].base;
		p_dev->io.IOAddrLines = (*try == 0) ? 16 :
			cf->io.flags & CISTPL_IO_LINES_MASK;
		if (!pcmcia_request_io(p_dev, &p_dev->io))
			return 0;
	}
	return -ENODEV;
}

static int btuart_check_config_notpicky(struct pcmcia_device *p_dev,
					cistpl_cftable_entry_t *cf,
					cistpl_cftable_entry_t *dflt,
					unsigned int vcc,
					void *priv_data)
{
	static unsigned int base[5] = { 0x3f8, 0x2f8, 0x3e8, 0x2e8, 0x0 };
	int j;

	if ((cf->io.nwin > 0) && ((cf->io.flags & CISTPL_IO_LINES_MASK) <= 3)) {
		for (j = 0; j < 5; j++) {
			p_dev->io.BasePort1 = base[j];
			p_dev->io.IOAddrLines = base[j] ? 16 : 3;
			if (!pcmcia_request_io(p_dev, &p_dev->io))
				return 0;
		}
	}
	return -ENODEV;
}

static int btuart_config(struct pcmcia_device *link)
{
	btuart_info_t *info = link->priv;
	int i;
	int try;

	/* First pass: look for a config entry that looks normal.
	   Two tries: without IO aliases, then with aliases */
	for (try = 0; try < 2; try++)
		if (!pcmcia_loop_config(link, btuart_check_config, &try))
			goto found_port;

	/* Second pass: try to find an entry that isn't picky about
	   its base address, then try to grab any standard serial port
	   address, and finally try to get any free port. */
	if (!pcmcia_loop_config(link, btuart_check_config_notpicky, NULL))
		goto found_port;

	BT_ERR("No usable port range found");
	goto failed;

found_port:
	i = pcmcia_request_irq(link, btuart_interrupt);
	if (i != 0)
		goto failed;

	i = pcmcia_request_configuration(link, &link->conf);
	if (i != 0)
		goto failed;

	if (btuart_open(info) != 0)
		goto failed;

	return 0;

failed:
	btuart_release(link);
	return -ENODEV;
}


static void btuart_release(struct pcmcia_device *link)
{
	btuart_info_t *info = link->priv;

	btuart_close(info);

	pcmcia_disable_device(link);
}

static struct pcmcia_device_id btuart_ids[] = {
	/* don't use this driver. Use serial_cs + hci_uart instead */
	PCMCIA_DEVICE_NULL
};
MODULE_DEVICE_TABLE(pcmcia, btuart_ids);

static struct pcmcia_driver btuart_driver = {
	.owner		= THIS_MODULE,
	.drv		= {
		.name	= "btuart_cs",
	},
	.probe		= btuart_probe,
	.remove		= btuart_detach,
	.id_table	= btuart_ids,
};

static int __init init_btuart_cs(void)
{
	return pcmcia_register_driver(&btuart_driver);
}


static void __exit exit_btuart_cs(void)
{
	pcmcia_unregister_driver(&btuart_driver);
}

module_init(init_btuart_cs);
module_exit(exit_btuart_cs);
Commit	Line	Data
1da177e4 LT	1	/*
	2	*
	3	* Driver for Bluetooth PCMCIA cards with HCI UART interface
	4	*
	5	* Copyright (C) 2001-2002 Marcel Holtmann <marcel@holtmann.org>
	6	*
	7	*
	8	* This program is free software; you can redistribute it and/or modify
	9	* it under the terms of the GNU General Public License version 2 as
	10	* published by the Free Software Foundation;
	11	*
	12	* Software distributed under the License is distributed on an "AS
	13	* IS" basis, WITHOUT WARRANTY OF ANY KIND, either express or
	14	* implied. See the License for the specific language governing
	15	* rights and limitations under the License.
	16	*
	17	* The initial developer of the original code is David A. Hinds
	18	* <dahinds@users.sourceforge.net>. Portions created by David A. Hinds
	19	* are Copyright (C) 1999 David A. Hinds. All Rights Reserved.
	20	*
	21	*/
	22
1da177e4 LT	23	#include <linux/module.h>
	24
	25	#include <linux/kernel.h>
	26	#include <linux/init.h>
	27	#include <linux/slab.h>
	28	#include <linux/types.h>
1da177e4 LT	29	#include <linux/delay.h>
	30	#include <linux/errno.h>
	31	#include <linux/ptrace.h>
	32	#include <linux/ioport.h>
	33	#include <linux/spinlock.h>
	34	#include <linux/moduleparam.h>
	35
	36	#include <linux/skbuff.h>
	37	#include <linux/string.h>
	38	#include <linux/serial.h>
	39	#include <linux/serial_reg.h>
	40	#include <linux/bitops.h>
	41	#include <asm/system.h>
	42	#include <asm/io.h>
	43
1da177e4 LT	44	#include <pcmcia/cs_types.h>
	45	#include <pcmcia/cs.h>
	46	#include <pcmcia/cistpl.h>
	47	#include <pcmcia/ciscode.h>
	48	#include <pcmcia/ds.h>
	49	#include <pcmcia/cisreg.h>
	50
	51	#include <net/bluetooth/bluetooth.h>
	52	#include <net/bluetooth/hci_core.h>
	53
	54
	55
	56	/* ======================== Module parameters ======================== */
	57
	58
	59	MODULE_AUTHOR("Marcel Holtmann <marcel@holtmann.org>");
	60	MODULE_DESCRIPTION("Bluetooth driver for Bluetooth PCMCIA cards with HCI UART interface");
	61	MODULE_LICENSE("GPL");
	62
	63
	64
	65	/* ======================== Local structures ======================== */
	66
	67
	68	typedef struct btuart_info_t {
fd238232	69	struct pcmcia_device *p_dev;
1da177e4 LT	70
	71	struct hci_dev *hdev;
	72
	73	spinlock_t lock; /* For serializing operations */
	74
	75	struct sk_buff_head txq;
	76	unsigned long tx_state;
	77
	78	unsigned long rx_state;
	79	unsigned long rx_count;
	80	struct sk_buff *rx_skb;
	81	} btuart_info_t;
	82
	83
15b99ac1	84	static int btuart_config(struct pcmcia_device *link);
fba395ee	85	static void btuart_release(struct pcmcia_device *link);
1da177e4	86
cc3b4866	87	static void btuart_detach(struct pcmcia_device *p_dev);
1da177e4	88
1da177e4 LT	89
	90	/* Maximum baud rate */
	91	#define SPEED_MAX 115200
	92
	93	/* Default baud rate: 57600, 115200, 230400 or 460800 */
	94	#define DEFAULT_BAUD_RATE 115200
	95
	96
	97	/* Transmit states */
	98	#define XMIT_SENDING 1
	99	#define XMIT_WAKEUP 2
	100	#define XMIT_WAITING 8
	101
	102	/* Receiver states */
	103	#define RECV_WAIT_PACKET_TYPE 0
	104	#define RECV_WAIT_EVENT_HEADER 1
	105	#define RECV_WAIT_ACL_HEADER 2
	106	#define RECV_WAIT_SCO_HEADER 3
	107	#define RECV_WAIT_DATA 4
	108
	109
	110
	111	/* ======================== Interrupt handling ======================== */
	112
	113
	114	static int btuart_write(unsigned int iobase, int fifo_size, __u8 *buf, int len)
	115	{
	116	int actual = 0;
	117
	118	/* Tx FIFO should be empty */
	119	if (!(inb(iobase + UART_LSR) & UART_LSR_THRE))
	120	return 0;
	121
	122	/* Fill FIFO with current frame */
	123	while ((fifo_size-- > 0) && (actual < len)) {
	124	/* Transmit next byte */
	125	outb(buf[actual], iobase + UART_TX);
	126	actual++;
	127	}
	128
	129	return actual;
	130	}
	131
	132
	133	static void btuart_write_wakeup(btuart_info_t *info)
	134	{
	135	if (!info) {
	136	BT_ERR("Unknown device");
	137	return;
	138	}
	139
	140	if (test_and_set_bit(XMIT_SENDING, &(info->tx_state))) {
	141	set_bit(XMIT_WAKEUP, &(info->tx_state));
	142	return;
	143	}
	144
	145	do {
fd238232	146	register unsigned int iobase = info->p_dev->io.BasePort1;
1da177e4 LT	147	register struct sk_buff *skb;
	148	register int len;
	149
	150	clear_bit(XMIT_WAKEUP, &(info->tx_state));
	151
e2d40963	152	if (!pcmcia_dev_present(info->p_dev))
1da177e4 LT	153	return;
	154
	155	if (!(skb = skb_dequeue(&(info->txq))))
	156	break;
	157
	158	/* Send frame */
	159	len = btuart_write(iobase, 16, skb->data, skb->len);
	160	set_bit(XMIT_WAKEUP, &(info->tx_state));
	161
	162	if (len == skb->len) {
	163	kfree_skb(skb);
	164	} else {
	165	skb_pull(skb, len);
	166	skb_queue_head(&(info->txq), skb);
	167	}
	168
	169	info->hdev->stat.byte_tx += len;
	170
	171	} while (test_bit(XMIT_WAKEUP, &(info->tx_state)));
	172
	173	clear_bit(XMIT_SENDING, &(info->tx_state));
	174	}
	175
	176
	177	static void btuart_receive(btuart_info_t *info)
	178	{
	179	unsigned int iobase;
	180	int boguscount = 0;
	181
	182	if (!info) {
	183	BT_ERR("Unknown device");
	184	return;
	185	}
	186
fd238232	187	iobase = info->p_dev->io.BasePort1;
1da177e4 LT	188
	189	do {
	190	info->hdev->stat.byte_rx++;
	191
	192	/* Allocate packet */
	193	if (info->rx_skb == NULL) {
	194	info->rx_state = RECV_WAIT_PACKET_TYPE;
	195	info->rx_count = 0;
	196	if (!(info->rx_skb = bt_skb_alloc(HCI_MAX_FRAME_SIZE, GFP_ATOMIC))) {
	197	BT_ERR("Can't allocate mem for new packet");
	198	return;
	199	}
	200	}
	201
	202	if (info->rx_state == RECV_WAIT_PACKET_TYPE) {
	203
	204	info->rx_skb->dev = (void *) info->hdev;
0d48d939	205	bt_cb(info->rx_skb)->pkt_type = inb(iobase + UART_RX);
1da177e4	206
0d48d939	207	switch (bt_cb(info->rx_skb)->pkt_type) {
1da177e4 LT	208
	209	case HCI_EVENT_PKT:
	210	info->rx_state = RECV_WAIT_EVENT_HEADER;
	211	info->rx_count = HCI_EVENT_HDR_SIZE;
	212	break;
	213
	214	case HCI_ACLDATA_PKT:
	215	info->rx_state = RECV_WAIT_ACL_HEADER;
	216	info->rx_count = HCI_ACL_HDR_SIZE;
	217	break;
	218
	219	case HCI_SCODATA_PKT:
	220	info->rx_state = RECV_WAIT_SCO_HEADER;
	221	info->rx_count = HCI_SCO_HDR_SIZE;
	222	break;
	223
	224	default:
	225	/* Unknown packet */
0d48d939	226	BT_ERR("Unknown HCI packet with type 0x%02x received", bt_cb(info->rx_skb)->pkt_type);
1da177e4 LT	227	info->hdev->stat.err_rx++;
	228	clear_bit(HCI_RUNNING, &(info->hdev->flags));
	229
	230	kfree_skb(info->rx_skb);
	231	info->rx_skb = NULL;
	232	break;
	233
	234	}
	235
	236	} else {
	237
	238	*skb_put(info->rx_skb, 1) = inb(iobase + UART_RX);
	239	info->rx_count--;
	240
	241	if (info->rx_count == 0) {
	242
	243	int dlen;
	244	struct hci_event_hdr *eh;
	245	struct hci_acl_hdr *ah;
	246	struct hci_sco_hdr *sh;
	247
	248
	249	switch (info->rx_state) {
	250
	251	case RECV_WAIT_EVENT_HEADER:
2a123b86	252	eh = hci_event_hdr(info->rx_skb);
1da177e4 LT	253	info->rx_state = RECV_WAIT_DATA;
	254	info->rx_count = eh->plen;
	255	break;
	256
	257	case RECV_WAIT_ACL_HEADER:
2a123b86	258	ah = hci_acl_hdr(info->rx_skb);
1da177e4 LT	259	dlen = __le16_to_cpu(ah->dlen);
	260	info->rx_state = RECV_WAIT_DATA;
	261	info->rx_count = dlen;
	262	break;
	263
	264	case RECV_WAIT_SCO_HEADER:
2a123b86	265	sh = hci_sco_hdr(info->rx_skb);
1da177e4 LT	266	info->rx_state = RECV_WAIT_DATA;
	267	info->rx_count = sh->dlen;
	268	break;
	269
	270	case RECV_WAIT_DATA:
	271	hci_recv_frame(info->rx_skb);
	272	info->rx_skb = NULL;
	273	break;
	274
	275	}
	276
	277	}
	278
	279	}
	280
	281	/* Make sure we don't stay here too long */
	282	if (boguscount++ > 16)
	283	break;
	284
	285	} while (inb(iobase + UART_LSR) & UART_LSR_DR);
	286	}
	287
	288
7d12e780	289	static irqreturn_t btuart_interrupt(int irq, void *dev_inst)
1da177e4 LT	290	{
	291	btuart_info_t *info = dev_inst;
	292	unsigned int iobase;
	293	int boguscount = 0;
	294	int iir, lsr;
aafcf998	295	irqreturn_t r = IRQ_NONE;
1da177e4	296
7427847d MF	297	if (!info \|\| !info->hdev)
	298	/* our irq handler is shared */
	299	return IRQ_NONE;
1da177e4	300
fd238232	301	iobase = info->p_dev->io.BasePort1;
1da177e4 LT	302
	303	spin_lock(&(info->lock));
	304
	305	iir = inb(iobase + UART_IIR) & UART_IIR_ID;
	306	while (iir) {
aafcf998	307	r = IRQ_HANDLED;
1da177e4 LT	308
	309	/* Clear interrupt */
	310	lsr = inb(iobase + UART_LSR);
	311
	312	switch (iir) {
	313	case UART_IIR_RLSI:
	314	BT_ERR("RLSI");
	315	break;
	316	case UART_IIR_RDI:
	317	/* Receive interrupt */
	318	btuart_receive(info);
	319	break;
	320	case UART_IIR_THRI:
	321	if (lsr & UART_LSR_THRE) {
	322	/* Transmitter ready for data */
	323	btuart_write_wakeup(info);
	324	}
	325	break;
	326	default:
	327	BT_ERR("Unhandled IIR=%#x", iir);
	328	break;
	329	}
	330
	331	/* Make sure we don't stay here too long */
	332	if (boguscount++ > 100)
	333	break;
	334
	335	iir = inb(iobase + UART_IIR) & UART_IIR_ID;
	336
	337	}
	338
	339	spin_unlock(&(info->lock));
	340
aafcf998	341	return r;
1da177e4 LT	342	}
	343
	344
	345	static void btuart_change_speed(btuart_info_t *info, unsigned int speed)
	346	{
	347	unsigned long flags;
	348	unsigned int iobase;
	349	int fcr; /* FIFO control reg */
	350	int lcr; /* Line control reg */
	351	int divisor;
	352
	353	if (!info) {
	354	BT_ERR("Unknown device");
	355	return;
	356	}
	357
fd238232	358	iobase = info->p_dev->io.BasePort1;
1da177e4 LT	359
	360	spin_lock_irqsave(&(info->lock), flags);
	361
	362	/* Turn off interrupts */
	363	outb(0, iobase + UART_IER);
	364
	365	divisor = SPEED_MAX / speed;
	366
	367	fcr = UART_FCR_ENABLE_FIFO \| UART_FCR_CLEAR_RCVR \| UART_FCR_CLEAR_XMIT;
	368
	369	/*
	370	* Use trigger level 1 to avoid 3 ms. timeout delay at 9600 bps, and
	371	* almost 1,7 ms at 19200 bps. At speeds above that we can just forget
	372	* about this timeout since it will always be fast enough.
	373	*/
	374
	375	if (speed < 38400)
	376	fcr \|= UART_FCR_TRIGGER_1;
	377	else
	378	fcr \|= UART_FCR_TRIGGER_14;
	379
	380	/* Bluetooth cards use 8N1 */
	381	lcr = UART_LCR_WLEN8;
	382
	383	outb(UART_LCR_DLAB \| lcr, iobase + UART_LCR); /* Set DLAB */
	384	outb(divisor & 0xff, iobase + UART_DLL); /* Set speed */
	385	outb(divisor >> 8, iobase + UART_DLM);
	386	outb(lcr, iobase + UART_LCR); /* Set 8N1 */
	387	outb(fcr, iobase + UART_FCR); /* Enable FIFO's */
	388
b92b1c57	389	/* Turn on interrupts */
1da177e4 LT	390	outb(UART_IER_RLSI \| UART_IER_RDI \| UART_IER_THRI, iobase + UART_IER);
	391
	392	spin_unlock_irqrestore(&(info->lock), flags);
	393	}
	394
	395
	396
	397	/* ======================== HCI interface ======================== */
	398
	399
	400	static int btuart_hci_flush(struct hci_dev *hdev)
	401	{
	402	btuart_info_t info = (btuart_info_t )(hdev->driver_data);
	403
	404	/* Drop TX queue */
	405	skb_queue_purge(&(info->txq));
	406
	407	return 0;
	408	}
	409
	410
	411	static int btuart_hci_open(struct hci_dev *hdev)
	412	{
	413	set_bit(HCI_RUNNING, &(hdev->flags));
	414
	415	return 0;
	416	}
	417
	418
	419	static int btuart_hci_close(struct hci_dev *hdev)
	420	{
	421	if (!test_and_clear_bit(HCI_RUNNING, &(hdev->flags)))
	422	return 0;
	423
	424	btuart_hci_flush(hdev);
	425
	426	return 0;
	427	}
	428
	429
	430	static int btuart_hci_send_frame(struct sk_buff *skb)
	431	{
	432	btuart_info_t *info;
	433	struct hci_dev hdev = (struct hci_dev )(skb->dev);
	434
	435	if (!hdev) {
	436	BT_ERR("Frame for unknown HCI device (hdev=NULL)");
	437	return -ENODEV;
	438	}
	439
	440	info = (btuart_info_t *)(hdev->driver_data);
	441
0d48d939	442	switch (bt_cb(skb)->pkt_type) {
1da177e4 LT	443	case HCI_COMMAND_PKT:
	444	hdev->stat.cmd_tx++;
	445	break;
	446	case HCI_ACLDATA_PKT:
	447	hdev->stat.acl_tx++;
	448	break;
	449	case HCI_SCODATA_PKT:
	450	hdev->stat.sco_tx++;
	451	break;
	452	};
	453
	454	/* Prepend skb with frame type */
0d48d939	455	memcpy(skb_push(skb, 1), &bt_cb(skb)->pkt_type, 1);
1da177e4 LT	456	skb_queue_tail(&(info->txq), skb);
	457
	458	btuart_write_wakeup(info);
	459
	460	return 0;
	461	}
	462
	463
	464	static void btuart_hci_destruct(struct hci_dev *hdev)
	465	{
	466	}
	467
	468
	469	static int btuart_hci_ioctl(struct hci_dev *hdev, unsigned int cmd, unsigned long arg)
	470	{
	471	return -ENOIOCTLCMD;
	472	}
	473
	474
	475
	476	/* ======================== Card services HCI interaction ======================== */
	477
	478
	479	static int btuart_open(btuart_info_t *info)
	480	{
	481	unsigned long flags;
fd238232	482	unsigned int iobase = info->p_dev->io.BasePort1;
1da177e4 LT	483	struct hci_dev *hdev;
	484
	485	spin_lock_init(&(info->lock));
	486
	487	skb_queue_head_init(&(info->txq));
	488
	489	info->rx_state = RECV_WAIT_PACKET_TYPE;
	490	info->rx_count = 0;
	491	info->rx_skb = NULL;
	492
	493	/* Initialize HCI device */
	494	hdev = hci_alloc_dev();
	495	if (!hdev) {
	496	BT_ERR("Can't allocate HCI device");
	497	return -ENOMEM;
	498	}
	499
	500	info->hdev = hdev;
	501
c13854ce	502	hdev->bus = HCI_PCCARD;
1da177e4	503	hdev->driver_data = info;
27d35284	504	SET_HCIDEV_DEV(hdev, &info->p_dev->dev);
1da177e4 LT	505
	506	hdev->open = btuart_hci_open;
	507	hdev->close = btuart_hci_close;
	508	hdev->flush = btuart_hci_flush;
	509	hdev->send = btuart_hci_send_frame;
	510	hdev->destruct = btuart_hci_destruct;
	511	hdev->ioctl = btuart_hci_ioctl;
	512
	513	hdev->owner = THIS_MODULE;
	514
	515	spin_lock_irqsave(&(info->lock), flags);
	516
	517	/* Reset UART */
	518	outb(0, iobase + UART_MCR);
	519
	520	/* Turn off interrupts */
	521	outb(0, iobase + UART_IER);
	522
	523	/* Initialize UART */
	524	outb(UART_LCR_WLEN8, iobase + UART_LCR); /* Reset DLAB */
	525	outb((UART_MCR_DTR \| UART_MCR_RTS \| UART_MCR_OUT2), iobase + UART_MCR);
	526
	527	/* Turn on interrupts */
	528	// outb(UART_IER_RLSI \| UART_IER_RDI \| UART_IER_THRI, iobase + UART_IER);
	529
	530	spin_unlock_irqrestore(&(info->lock), flags);
	531
	532	btuart_change_speed(info, DEFAULT_BAUD_RATE);
	533
	534	/* Timeout before it is safe to send the first HCI packet */
	535	msleep(1000);
	536
	537	/* Register HCI device */
	538	if (hci_register_dev(hdev) < 0) {
	539	BT_ERR("Can't register HCI device");
	540	info->hdev = NULL;
	541	hci_free_dev(hdev);
	542	return -ENODEV;
	543	}
	544
	545	return 0;
	546	}
	547
	548
	549	static int btuart_close(btuart_info_t *info)
	550	{
	551	unsigned long flags;
fd238232	552	unsigned int iobase = info->p_dev->io.BasePort1;
1da177e4 LT	553	struct hci_dev *hdev = info->hdev;
	554
	555	if (!hdev)
	556	return -ENODEV;
	557
	558	btuart_hci_close(hdev);
	559
	560	spin_lock_irqsave(&(info->lock), flags);
	561
	562	/* Reset UART */
	563	outb(0, iobase + UART_MCR);
	564
	565	/* Turn off interrupts */
	566	outb(0, iobase + UART_IER);
	567
	568	spin_unlock_irqrestore(&(info->lock), flags);
	569
	570	if (hci_unregister_dev(hdev) < 0)
	571	BT_ERR("Can't unregister HCI device %s", hdev->name);
	572
	573	hci_free_dev(hdev);
	574
	575	return 0;
	576	}
	577
15b99ac1	578	static int btuart_probe(struct pcmcia_device *link)
1da177e4 LT	579	{
1da177e4 LT	580	btuart_info_t *info;
1da177e4 LT	581
1da177e4 LT	582	/* Create new info device */
089b1dbb	583	info = kzalloc(sizeof(*info), GFP_KERNEL);
1da177e4	584	if (!info)
f8cfa618	585	return -ENOMEM;
1da177e4	586
fba395ee	587	info->p_dev = link;
1da177e4 LT	588	link->priv = info;
	589
	590	link->io.Attributes1 = IO_DATA_PATH_WIDTH_8;
	591	link->io.NumPorts1 = 8;
1da177e4 LT	592
1da177e4 LT	593	link->conf.Attributes = CONF_ENABLE_IRQ;
1da177e4 LT	594	link->conf.IntType = INT_MEMORY_AND_IO;
1da177e4 LT	595
15b99ac1	596	return btuart_config(link);
1da177e4 LT	597	}
	598
	599
fba395ee	600	static void btuart_detach(struct pcmcia_device *link)
1da177e4 LT	601	{
1da177e4 LT	602	btuart_info_t *info = link->priv;
1da177e4	603
e2d40963	604	btuart_release(link);
1da177e4 LT	605	kfree(info);
	606	}
	607
ed58872a DB	608	static int btuart_check_config(struct pcmcia_device *p_dev,
ed58872a DB	609	cistpl_cftable_entry_t *cf,
8e2fc39d	610	cistpl_cftable_entry_t *dflt,
ad913c11	611	unsigned int vcc,
ed58872a	612	void *priv_data)
1da177e4	613	{
ad913c11	614	int *try = priv_data;
ed58872a DB	615
	616	if (cf->vpp1.present & (1 << CISTPL_POWER_VNOM))
	617	p_dev->conf.Vpp = cf->vpp1.param[CISTPL_POWER_VNOM] / 10000;
	618	if ((cf->io.nwin > 0) && (cf->io.win[0].len == 8) &&
	619	(cf->io.win[0].base != 0)) {
ed58872a	620	p_dev->io.BasePort1 = cf->io.win[0].base;
ad913c11	621	p_dev->io.IOAddrLines = (*try == 0) ? 16 :
ed58872a DB	622	cf->io.flags & CISTPL_IO_LINES_MASK;
	623	if (!pcmcia_request_io(p_dev, &p_dev->io))
	624	return 0;
	625	}
	626	return -ENODEV;
1da177e4 LT	627	}
1da177e4 LT	628
ed58872a DB	629	static int btuart_check_config_notpicky(struct pcmcia_device *p_dev,
ed58872a DB	630	cistpl_cftable_entry_t *cf,
8e2fc39d	631	cistpl_cftable_entry_t *dflt,
ad913c11	632	unsigned int vcc,
ed58872a	633	void *priv_data)
1da177e4	634	{
ed58872a DB	635	static unsigned int base[5] = { 0x3f8, 0x2f8, 0x3e8, 0x2e8, 0x0 };
	636	int j;
	637
	638	if ((cf->io.nwin > 0) && ((cf->io.flags & CISTPL_IO_LINES_MASK) <= 3)) {
ed58872a DB	639	for (j = 0; j < 5; j++) {
	640	p_dev->io.BasePort1 = base[j];
	641	p_dev->io.IOAddrLines = base[j] ? 16 : 3;
	642	if (!pcmcia_request_io(p_dev, &p_dev->io))
	643	return 0;
	644	}
	645	}
	646	return -ENODEV;
1da177e4 LT	647	}
1da177e4 LT	648
15b99ac1	649	static int btuart_config(struct pcmcia_device *link)
1da177e4	650	{
1da177e4	651	btuart_info_t *info = link->priv;
ed58872a	652	int i;
ad913c11	653	int try;
ed58872a DB	654
	655	/* First pass: look for a config entry that looks normal.
	656	Two tries: without IO aliases, then with aliases */
	657	for (try = 0; try < 2; try++)
ad913c11	658	if (!pcmcia_loop_config(link, btuart_check_config, &try))
ed58872a	659	goto found_port;
1da177e4 LT	660
	661	/* Second pass: try to find an entry that isn't picky about
	662	its base address, then try to grab any standard serial port
	663	address, and finally try to get any free port. */
ed58872a DB	664	if (!pcmcia_loop_config(link, btuart_check_config_notpicky, NULL))
ed58872a DB	665	goto found_port;
1da177e4	666
ed58872a	667	BT_ERR("No usable port range found");
ed58872a	668	goto failed;
1da177e4	669
ed58872a	670	found_port:
eb14120f	671	i = pcmcia_request_irq(link, btuart_interrupt);
9ac3e58c	672	if (i != 0)
eb14120f	673	goto failed;
1da177e4	674
fba395ee	675	i = pcmcia_request_configuration(link, &link->conf);
9ac3e58c	676	if (i != 0)
1da177e4	677	goto failed;
1da177e4 LT	678
	679	if (btuart_open(info) != 0)
	680	goto failed;
	681
15b99ac1	682	return 0;
1da177e4	683
1da177e4 LT	684	failed:
1da177e4 LT	685	btuart_release(link);
15b99ac1	686	return -ENODEV;
1da177e4 LT	687	}
	688
	689
fba395ee	690	static void btuart_release(struct pcmcia_device *link)
1da177e4 LT	691	{
	692	btuart_info_t *info = link->priv;
	693
e2d40963	694	btuart_close(info);
1da177e4	695
fba395ee	696	pcmcia_disable_device(link);
1da177e4 LT	697	}
1da177e4 LT	698
279c9361 DB	699	static struct pcmcia_device_id btuart_ids[] = {
	700	/* don't use this driver. Use serial_cs + hci_uart instead */
	701	PCMCIA_DEVICE_NULL
	702	};
	703	MODULE_DEVICE_TABLE(pcmcia, btuart_ids);
	704
1da177e4 LT	705	static struct pcmcia_driver btuart_driver = {
	706	.owner = THIS_MODULE,
	707	.drv = {
	708	.name = "btuart_cs",
	709	},
15b99ac1	710	.probe = btuart_probe,
cc3b4866	711	.remove = btuart_detach,
279c9361	712	.id_table = btuart_ids,
1da177e4 LT	713	};
	714
	715	static int __init init_btuart_cs(void)
	716	{
	717	return pcmcia_register_driver(&btuart_driver);
	718	}
	719
	720
	721	static void __exit exit_btuart_cs(void)
	722	{
	723	pcmcia_unregister_driver(&btuart_driver);
1da177e4 LT	724	}
	725
	726	module_init(init_btuart_cs);
	727	module_exit(exit_btuart_cs);