USB: io_edgeport: checkpatch cleanups
[linux/fpc-iii.git] / drivers / bluetooth / bt3c_cs.c
blob027cb8bf650fe44bc9641c8e40e16279e1db4c79
1 /*
3 * Driver for the 3Com Bluetooth PCMCIA card
5 * Copyright (C) 2001-2002 Marcel Holtmann <marcel@holtmann.org>
6 * Jose Orlando Pereira <jop@di.uminho.pt>
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License version 2 as
11 * published by the Free Software Foundation;
13 * Software distributed under the License is distributed on an "AS
14 * IS" basis, WITHOUT WARRANTY OF ANY KIND, either express or
15 * implied. See the License for the specific language governing
16 * rights and limitations under the License.
18 * The initial developer of the original code is David A. Hinds
19 * <dahinds@users.sourceforge.net>. Portions created by David A. Hinds
20 * are Copyright (C) 1999 David A. Hinds. All Rights Reserved.
24 #include <linux/module.h>
26 #include <linux/kernel.h>
27 #include <linux/init.h>
28 #include <linux/slab.h>
29 #include <linux/types.h>
30 #include <linux/delay.h>
31 #include <linux/errno.h>
32 #include <linux/ptrace.h>
33 #include <linux/ioport.h>
34 #include <linux/spinlock.h>
35 #include <linux/moduleparam.h>
37 #include <linux/skbuff.h>
38 #include <linux/string.h>
39 #include <linux/serial.h>
40 #include <linux/serial_reg.h>
41 #include <linux/bitops.h>
42 #include <asm/system.h>
43 #include <asm/io.h>
45 #include <linux/device.h>
46 #include <linux/firmware.h>
48 #include <pcmcia/cs_types.h>
49 #include <pcmcia/cs.h>
50 #include <pcmcia/cistpl.h>
51 #include <pcmcia/ciscode.h>
52 #include <pcmcia/ds.h>
53 #include <pcmcia/cisreg.h>
55 #include <net/bluetooth/bluetooth.h>
56 #include <net/bluetooth/hci_core.h>
60 /* ======================== Module parameters ======================== */
63 MODULE_AUTHOR("Marcel Holtmann <marcel@holtmann.org>");
64 MODULE_DESCRIPTION("Bluetooth driver for the 3Com Bluetooth PCMCIA card");
65 MODULE_LICENSE("GPL");
66 MODULE_FIRMWARE("BT3CPCC.bin");
70 /* ======================== Local structures ======================== */
73 typedef struct bt3c_info_t {
74 struct pcmcia_device *p_dev;
75 dev_node_t node;
77 struct hci_dev *hdev;
79 spinlock_t lock; /* For serializing operations */
81 struct sk_buff_head txq;
82 unsigned long tx_state;
84 unsigned long rx_state;
85 unsigned long rx_count;
86 struct sk_buff *rx_skb;
87 } bt3c_info_t;
90 static int bt3c_config(struct pcmcia_device *link);
91 static void bt3c_release(struct pcmcia_device *link);
93 static void bt3c_detach(struct pcmcia_device *p_dev);
96 /* Transmit states */
97 #define XMIT_SENDING 1
98 #define XMIT_WAKEUP 2
99 #define XMIT_WAITING 8
101 /* Receiver states */
102 #define RECV_WAIT_PACKET_TYPE 0
103 #define RECV_WAIT_EVENT_HEADER 1
104 #define RECV_WAIT_ACL_HEADER 2
105 #define RECV_WAIT_SCO_HEADER 3
106 #define RECV_WAIT_DATA 4
110 /* ======================== Special I/O functions ======================== */
113 #define DATA_L 0
114 #define DATA_H 1
115 #define ADDR_L 2
116 #define ADDR_H 3
117 #define CONTROL 4
120 static inline void bt3c_address(unsigned int iobase, unsigned short addr)
122 outb(addr & 0xff, iobase + ADDR_L);
123 outb((addr >> 8) & 0xff, iobase + ADDR_H);
127 static inline void bt3c_put(unsigned int iobase, unsigned short value)
129 outb(value & 0xff, iobase + DATA_L);
130 outb((value >> 8) & 0xff, iobase + DATA_H);
134 static inline void bt3c_io_write(unsigned int iobase, unsigned short addr, unsigned short value)
136 bt3c_address(iobase, addr);
137 bt3c_put(iobase, value);
141 static inline unsigned short bt3c_get(unsigned int iobase)
143 unsigned short value = inb(iobase + DATA_L);
145 value |= inb(iobase + DATA_H) << 8;
147 return value;
151 static inline unsigned short bt3c_read(unsigned int iobase, unsigned short addr)
153 bt3c_address(iobase, addr);
155 return bt3c_get(iobase);
160 /* ======================== Interrupt handling ======================== */
163 static int bt3c_write(unsigned int iobase, int fifo_size, __u8 *buf, int len)
165 int actual = 0;
167 bt3c_address(iobase, 0x7080);
169 /* Fill FIFO with current frame */
170 while (actual < len) {
171 /* Transmit next byte */
172 bt3c_put(iobase, buf[actual]);
173 actual++;
176 bt3c_io_write(iobase, 0x7005, actual);
178 return actual;
182 static void bt3c_write_wakeup(bt3c_info_t *info)
184 if (!info) {
185 BT_ERR("Unknown device");
186 return;
189 if (test_and_set_bit(XMIT_SENDING, &(info->tx_state)))
190 return;
192 do {
193 register unsigned int iobase = info->p_dev->io.BasePort1;
194 register struct sk_buff *skb;
195 register int len;
197 if (!pcmcia_dev_present(info->p_dev))
198 break;
201 if (!(skb = skb_dequeue(&(info->txq)))) {
202 clear_bit(XMIT_SENDING, &(info->tx_state));
203 break;
206 /* Send frame */
207 len = bt3c_write(iobase, 256, skb->data, skb->len);
209 if (len != skb->len) {
210 BT_ERR("Very strange");
213 kfree_skb(skb);
215 info->hdev->stat.byte_tx += len;
217 } while (0);
221 static void bt3c_receive(bt3c_info_t *info)
223 unsigned int iobase;
224 int size = 0, avail;
226 if (!info) {
227 BT_ERR("Unknown device");
228 return;
231 iobase = info->p_dev->io.BasePort1;
233 avail = bt3c_read(iobase, 0x7006);
234 //printk("bt3c_cs: receiving %d bytes\n", avail);
236 bt3c_address(iobase, 0x7480);
237 while (size < avail) {
238 size++;
239 info->hdev->stat.byte_rx++;
241 /* Allocate packet */
242 if (info->rx_skb == NULL) {
243 info->rx_state = RECV_WAIT_PACKET_TYPE;
244 info->rx_count = 0;
245 if (!(info->rx_skb = bt_skb_alloc(HCI_MAX_FRAME_SIZE, GFP_ATOMIC))) {
246 BT_ERR("Can't allocate mem for new packet");
247 return;
252 if (info->rx_state == RECV_WAIT_PACKET_TYPE) {
254 info->rx_skb->dev = (void *) info->hdev;
255 bt_cb(info->rx_skb)->pkt_type = inb(iobase + DATA_L);
256 inb(iobase + DATA_H);
257 //printk("bt3c: PACKET_TYPE=%02x\n", bt_cb(info->rx_skb)->pkt_type);
259 switch (bt_cb(info->rx_skb)->pkt_type) {
261 case HCI_EVENT_PKT:
262 info->rx_state = RECV_WAIT_EVENT_HEADER;
263 info->rx_count = HCI_EVENT_HDR_SIZE;
264 break;
266 case HCI_ACLDATA_PKT:
267 info->rx_state = RECV_WAIT_ACL_HEADER;
268 info->rx_count = HCI_ACL_HDR_SIZE;
269 break;
271 case HCI_SCODATA_PKT:
272 info->rx_state = RECV_WAIT_SCO_HEADER;
273 info->rx_count = HCI_SCO_HDR_SIZE;
274 break;
276 default:
277 /* Unknown packet */
278 BT_ERR("Unknown HCI packet with type 0x%02x received", bt_cb(info->rx_skb)->pkt_type);
279 info->hdev->stat.err_rx++;
280 clear_bit(HCI_RUNNING, &(info->hdev->flags));
282 kfree_skb(info->rx_skb);
283 info->rx_skb = NULL;
284 break;
288 } else {
290 __u8 x = inb(iobase + DATA_L);
292 *skb_put(info->rx_skb, 1) = x;
293 inb(iobase + DATA_H);
294 info->rx_count--;
296 if (info->rx_count == 0) {
298 int dlen;
299 struct hci_event_hdr *eh;
300 struct hci_acl_hdr *ah;
301 struct hci_sco_hdr *sh;
303 switch (info->rx_state) {
305 case RECV_WAIT_EVENT_HEADER:
306 eh = hci_event_hdr(info->rx_skb);
307 info->rx_state = RECV_WAIT_DATA;
308 info->rx_count = eh->plen;
309 break;
311 case RECV_WAIT_ACL_HEADER:
312 ah = hci_acl_hdr(info->rx_skb);
313 dlen = __le16_to_cpu(ah->dlen);
314 info->rx_state = RECV_WAIT_DATA;
315 info->rx_count = dlen;
316 break;
318 case RECV_WAIT_SCO_HEADER:
319 sh = hci_sco_hdr(info->rx_skb);
320 info->rx_state = RECV_WAIT_DATA;
321 info->rx_count = sh->dlen;
322 break;
324 case RECV_WAIT_DATA:
325 hci_recv_frame(info->rx_skb);
326 info->rx_skb = NULL;
327 break;
337 bt3c_io_write(iobase, 0x7006, 0x0000);
341 static irqreturn_t bt3c_interrupt(int irq, void *dev_inst)
343 bt3c_info_t *info = dev_inst;
344 unsigned int iobase;
345 int iir;
346 irqreturn_t r = IRQ_NONE;
348 if (!info || !info->hdev)
349 /* our irq handler is shared */
350 return IRQ_NONE;
352 iobase = info->p_dev->io.BasePort1;
354 spin_lock(&(info->lock));
356 iir = inb(iobase + CONTROL);
357 if (iir & 0x80) {
358 int stat = bt3c_read(iobase, 0x7001);
360 if ((stat & 0xff) == 0x7f) {
361 BT_ERR("Very strange (stat=0x%04x)", stat);
362 } else if ((stat & 0xff) != 0xff) {
363 if (stat & 0x0020) {
364 int status = bt3c_read(iobase, 0x7002) & 0x10;
365 BT_INFO("%s: Antenna %s", info->hdev->name,
366 status ? "out" : "in");
368 if (stat & 0x0001)
369 bt3c_receive(info);
370 if (stat & 0x0002) {
371 //BT_ERR("Ack (stat=0x%04x)", stat);
372 clear_bit(XMIT_SENDING, &(info->tx_state));
373 bt3c_write_wakeup(info);
376 bt3c_io_write(iobase, 0x7001, 0x0000);
378 outb(iir, iobase + CONTROL);
380 r = IRQ_HANDLED;
383 spin_unlock(&(info->lock));
385 return r;
390 /* ======================== HCI interface ======================== */
393 static int bt3c_hci_flush(struct hci_dev *hdev)
395 bt3c_info_t *info = (bt3c_info_t *)(hdev->driver_data);
397 /* Drop TX queue */
398 skb_queue_purge(&(info->txq));
400 return 0;
404 static int bt3c_hci_open(struct hci_dev *hdev)
406 set_bit(HCI_RUNNING, &(hdev->flags));
408 return 0;
412 static int bt3c_hci_close(struct hci_dev *hdev)
414 if (!test_and_clear_bit(HCI_RUNNING, &(hdev->flags)))
415 return 0;
417 bt3c_hci_flush(hdev);
419 return 0;
423 static int bt3c_hci_send_frame(struct sk_buff *skb)
425 bt3c_info_t *info;
426 struct hci_dev *hdev = (struct hci_dev *)(skb->dev);
427 unsigned long flags;
429 if (!hdev) {
430 BT_ERR("Frame for unknown HCI device (hdev=NULL)");
431 return -ENODEV;
434 info = (bt3c_info_t *) (hdev->driver_data);
436 switch (bt_cb(skb)->pkt_type) {
437 case HCI_COMMAND_PKT:
438 hdev->stat.cmd_tx++;
439 break;
440 case HCI_ACLDATA_PKT:
441 hdev->stat.acl_tx++;
442 break;
443 case HCI_SCODATA_PKT:
444 hdev->stat.sco_tx++;
445 break;
448 /* Prepend skb with frame type */
449 memcpy(skb_push(skb, 1), &bt_cb(skb)->pkt_type, 1);
450 skb_queue_tail(&(info->txq), skb);
452 spin_lock_irqsave(&(info->lock), flags);
454 bt3c_write_wakeup(info);
456 spin_unlock_irqrestore(&(info->lock), flags);
458 return 0;
462 static void bt3c_hci_destruct(struct hci_dev *hdev)
467 static int bt3c_hci_ioctl(struct hci_dev *hdev, unsigned int cmd, unsigned long arg)
469 return -ENOIOCTLCMD;
474 /* ======================== Card services HCI interaction ======================== */
477 static int bt3c_load_firmware(bt3c_info_t *info, const unsigned char *firmware,
478 int count)
480 char *ptr = (char *) firmware;
481 char b[9];
482 unsigned int iobase, size, addr, fcs, tmp;
483 int i, err = 0;
485 iobase = info->p_dev->io.BasePort1;
487 /* Reset */
488 bt3c_io_write(iobase, 0x8040, 0x0404);
489 bt3c_io_write(iobase, 0x8040, 0x0400);
491 udelay(1);
493 bt3c_io_write(iobase, 0x8040, 0x0404);
495 udelay(17);
497 /* Load */
498 while (count) {
499 if (ptr[0] != 'S') {
500 BT_ERR("Bad address in firmware");
501 err = -EFAULT;
502 goto error;
505 memset(b, 0, sizeof(b));
506 memcpy(b, ptr + 2, 2);
507 size = simple_strtoul(b, NULL, 16);
509 memset(b, 0, sizeof(b));
510 memcpy(b, ptr + 4, 8);
511 addr = simple_strtoul(b, NULL, 16);
513 memset(b, 0, sizeof(b));
514 memcpy(b, ptr + (size * 2) + 2, 2);
515 fcs = simple_strtoul(b, NULL, 16);
517 memset(b, 0, sizeof(b));
518 for (tmp = 0, i = 0; i < size; i++) {
519 memcpy(b, ptr + (i * 2) + 2, 2);
520 tmp += simple_strtol(b, NULL, 16);
523 if (((tmp + fcs) & 0xff) != 0xff) {
524 BT_ERR("Checksum error in firmware");
525 err = -EILSEQ;
526 goto error;
529 if (ptr[1] == '3') {
530 bt3c_address(iobase, addr);
532 memset(b, 0, sizeof(b));
533 for (i = 0; i < (size - 4) / 2; i++) {
534 memcpy(b, ptr + (i * 4) + 12, 4);
535 tmp = simple_strtoul(b, NULL, 16);
536 bt3c_put(iobase, tmp);
540 ptr += (size * 2) + 6;
541 count -= (size * 2) + 6;
544 udelay(17);
546 /* Boot */
547 bt3c_address(iobase, 0x3000);
548 outb(inb(iobase + CONTROL) | 0x40, iobase + CONTROL);
550 error:
551 udelay(17);
553 /* Clear */
554 bt3c_io_write(iobase, 0x7006, 0x0000);
555 bt3c_io_write(iobase, 0x7005, 0x0000);
556 bt3c_io_write(iobase, 0x7001, 0x0000);
558 return err;
562 static int bt3c_open(bt3c_info_t *info)
564 const struct firmware *firmware;
565 struct hci_dev *hdev;
566 int err;
568 spin_lock_init(&(info->lock));
570 skb_queue_head_init(&(info->txq));
572 info->rx_state = RECV_WAIT_PACKET_TYPE;
573 info->rx_count = 0;
574 info->rx_skb = NULL;
576 /* Initialize HCI device */
577 hdev = hci_alloc_dev();
578 if (!hdev) {
579 BT_ERR("Can't allocate HCI device");
580 return -ENOMEM;
583 info->hdev = hdev;
585 hdev->bus = HCI_PCCARD;
586 hdev->driver_data = info;
587 SET_HCIDEV_DEV(hdev, &info->p_dev->dev);
589 hdev->open = bt3c_hci_open;
590 hdev->close = bt3c_hci_close;
591 hdev->flush = bt3c_hci_flush;
592 hdev->send = bt3c_hci_send_frame;
593 hdev->destruct = bt3c_hci_destruct;
594 hdev->ioctl = bt3c_hci_ioctl;
596 hdev->owner = THIS_MODULE;
598 /* Load firmware */
599 err = request_firmware(&firmware, "BT3CPCC.bin", &info->p_dev->dev);
600 if (err < 0) {
601 BT_ERR("Firmware request failed");
602 goto error;
605 err = bt3c_load_firmware(info, firmware->data, firmware->size);
607 release_firmware(firmware);
609 if (err < 0) {
610 BT_ERR("Firmware loading failed");
611 goto error;
614 /* Timeout before it is safe to send the first HCI packet */
615 msleep(1000);
617 /* Register HCI device */
618 err = hci_register_dev(hdev);
619 if (err < 0) {
620 BT_ERR("Can't register HCI device");
621 goto error;
624 return 0;
626 error:
627 info->hdev = NULL;
628 hci_free_dev(hdev);
629 return err;
633 static int bt3c_close(bt3c_info_t *info)
635 struct hci_dev *hdev = info->hdev;
637 if (!hdev)
638 return -ENODEV;
640 bt3c_hci_close(hdev);
642 if (hci_unregister_dev(hdev) < 0)
643 BT_ERR("Can't unregister HCI device %s", hdev->name);
645 hci_free_dev(hdev);
647 return 0;
650 static int bt3c_probe(struct pcmcia_device *link)
652 bt3c_info_t *info;
654 /* Create new info device */
655 info = kzalloc(sizeof(*info), GFP_KERNEL);
656 if (!info)
657 return -ENOMEM;
659 info->p_dev = link;
660 link->priv = info;
662 link->io.Attributes1 = IO_DATA_PATH_WIDTH_8;
663 link->io.NumPorts1 = 8;
664 link->irq.Attributes = IRQ_TYPE_DYNAMIC_SHARING;
666 link->irq.Handler = bt3c_interrupt;
668 link->conf.Attributes = CONF_ENABLE_IRQ;
669 link->conf.IntType = INT_MEMORY_AND_IO;
671 return bt3c_config(link);
675 static void bt3c_detach(struct pcmcia_device *link)
677 bt3c_info_t *info = link->priv;
679 bt3c_release(link);
680 kfree(info);
683 static int bt3c_check_config(struct pcmcia_device *p_dev,
684 cistpl_cftable_entry_t *cf,
685 cistpl_cftable_entry_t *dflt,
686 unsigned int vcc,
687 void *priv_data)
689 unsigned long try = (unsigned long) priv_data;
691 if (cf->vpp1.present & (1 << CISTPL_POWER_VNOM))
692 p_dev->conf.Vpp = cf->vpp1.param[CISTPL_POWER_VNOM] / 10000;
693 if ((cf->io.nwin > 0) && (cf->io.win[0].len == 8) &&
694 (cf->io.win[0].base != 0)) {
695 p_dev->io.BasePort1 = cf->io.win[0].base;
696 p_dev->io.IOAddrLines = (try == 0) ? 16 :
697 cf->io.flags & CISTPL_IO_LINES_MASK;
698 if (!pcmcia_request_io(p_dev, &p_dev->io))
699 return 0;
701 return -ENODEV;
704 static int bt3c_check_config_notpicky(struct pcmcia_device *p_dev,
705 cistpl_cftable_entry_t *cf,
706 cistpl_cftable_entry_t *dflt,
707 unsigned int vcc,
708 void *priv_data)
710 static unsigned int base[5] = { 0x3f8, 0x2f8, 0x3e8, 0x2e8, 0x0 };
711 int j;
713 if ((cf->io.nwin > 0) && ((cf->io.flags & CISTPL_IO_LINES_MASK) <= 3)) {
714 for (j = 0; j < 5; j++) {
715 p_dev->io.BasePort1 = base[j];
716 p_dev->io.IOAddrLines = base[j] ? 16 : 3;
717 if (!pcmcia_request_io(p_dev, &p_dev->io))
718 return 0;
721 return -ENODEV;
724 static int bt3c_config(struct pcmcia_device *link)
726 bt3c_info_t *info = link->priv;
727 int i;
728 unsigned long try;
730 /* First pass: look for a config entry that looks normal.
731 Two tries: without IO aliases, then with aliases */
732 for (try = 0; try < 2; try++)
733 if (!pcmcia_loop_config(link, bt3c_check_config, (void *) try))
734 goto found_port;
736 /* Second pass: try to find an entry that isn't picky about
737 its base address, then try to grab any standard serial port
738 address, and finally try to get any free port. */
739 if (!pcmcia_loop_config(link, bt3c_check_config_notpicky, NULL))
740 goto found_port;
742 BT_ERR("No usable port range found");
743 goto failed;
745 found_port:
746 i = pcmcia_request_irq(link, &link->irq);
747 if (i != 0)
748 link->irq.AssignedIRQ = 0;
750 i = pcmcia_request_configuration(link, &link->conf);
751 if (i != 0)
752 goto failed;
754 if (bt3c_open(info) != 0)
755 goto failed;
757 strcpy(info->node.dev_name, info->hdev->name);
758 link->dev_node = &info->node;
760 return 0;
762 failed:
763 bt3c_release(link);
764 return -ENODEV;
768 static void bt3c_release(struct pcmcia_device *link)
770 bt3c_info_t *info = link->priv;
772 bt3c_close(info);
774 pcmcia_disable_device(link);
778 static struct pcmcia_device_id bt3c_ids[] = {
779 PCMCIA_DEVICE_PROD_ID13("3COM", "Bluetooth PC Card", 0xefce0a31, 0xd4ce9b02),
780 PCMCIA_DEVICE_NULL
782 MODULE_DEVICE_TABLE(pcmcia, bt3c_ids);
784 static struct pcmcia_driver bt3c_driver = {
785 .owner = THIS_MODULE,
786 .drv = {
787 .name = "bt3c_cs",
789 .probe = bt3c_probe,
790 .remove = bt3c_detach,
791 .id_table = bt3c_ids,
794 static int __init init_bt3c_cs(void)
796 return pcmcia_register_driver(&bt3c_driver);
800 static void __exit exit_bt3c_cs(void)
802 pcmcia_unregister_driver(&bt3c_driver);
805 module_init(init_bt3c_cs);
806 module_exit(exit_bt3c_cs);