1 /* 2 * 3 * Driver for the 3Com Bluetooth PCMCIA card 4 * 5 * Copyright (C) 2001-2002 Marcel Holtmann <marcel@holtmann.org> 6 * Jose Orlando Pereira <jop@di.uminho.pt> 7 * 8 * 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; 12 * 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. 17 * 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. 21 * 22 */ 23 24 #include <linux/config.h> 25 #include <linux/module.h> 26 27 #include <linux/kernel.h> 28 #include <linux/init.h> 29 #include <linux/slab.h> 30 #include <linux/types.h> 31 #include <linux/sched.h> 32 #include <linux/delay.h> 33 #include <linux/errno.h> 34 #include <linux/ptrace.h> 35 #include <linux/ioport.h> 36 #include <linux/spinlock.h> 37 #include <linux/moduleparam.h> 38 39 #include <linux/skbuff.h> 40 #include <linux/string.h> 41 #include <linux/serial.h> 42 #include <linux/serial_reg.h> 43 #include <linux/bitops.h> 44 #include <asm/system.h> 45 #include <asm/io.h> 46 47 #include <linux/device.h> 48 #include <linux/firmware.h> 49 50 #include <pcmcia/cs_types.h> 51 #include <pcmcia/cs.h> 52 #include <pcmcia/cistpl.h> 53 #include <pcmcia/ciscode.h> 54 #include <pcmcia/ds.h> 55 #include <pcmcia/cisreg.h> 56 57 #include <net/bluetooth/bluetooth.h> 58 #include <net/bluetooth/hci_core.h> 59 60 61 62 /* ======================== Module parameters ======================== */ 63 64 65 MODULE_AUTHOR("Marcel Holtmann <marcel@holtmann.org>, Jose Orlando Pereira <jop@di.uminho.pt>"); 66 MODULE_DESCRIPTION("Bluetooth driver for the 3Com Bluetooth PCMCIA card"); 67 MODULE_LICENSE("GPL"); 68 69 70 71 /* ======================== Local structures ======================== */ 72 73 74 typedef struct bt3c_info_t { 75 struct pcmcia_device *p_dev; 76 dev_node_t node; 77 78 struct hci_dev *hdev; 79 80 spinlock_t lock; /* For serializing operations */ 81 82 struct sk_buff_head txq; 83 unsigned long tx_state; 84 85 unsigned long rx_state; 86 unsigned long rx_count; 87 struct sk_buff *rx_skb; 88 } bt3c_info_t; 89 90 91 static int bt3c_config(struct pcmcia_device *link); 92 static void bt3c_release(struct pcmcia_device *link); 93 94 static void bt3c_detach(struct pcmcia_device *p_dev); 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 /* ======================== Special I/O functions ======================== */ 112 113 114 #define DATA_L 0 115 #define DATA_H 1 116 #define ADDR_L 2 117 #define ADDR_H 3 118 #define CONTROL 4 119 120 121 static inline void bt3c_address(unsigned int iobase, unsigned short addr) 122 { 123 outb(addr & 0xff, iobase + ADDR_L); 124 outb((addr >> 8) & 0xff, iobase + ADDR_H); 125 } 126 127 128 static inline void bt3c_put(unsigned int iobase, unsigned short value) 129 { 130 outb(value & 0xff, iobase + DATA_L); 131 outb((value >> 8) & 0xff, iobase + DATA_H); 132 } 133 134 135 static inline void bt3c_io_write(unsigned int iobase, unsigned short addr, unsigned short value) 136 { 137 bt3c_address(iobase, addr); 138 bt3c_put(iobase, value); 139 } 140 141 142 static inline unsigned short bt3c_get(unsigned int iobase) 143 { 144 unsigned short value = inb(iobase + DATA_L); 145 146 value |= inb(iobase + DATA_H) << 8; 147 148 return value; 149 } 150 151 152 static inline unsigned short bt3c_read(unsigned int iobase, unsigned short addr) 153 { 154 bt3c_address(iobase, addr); 155 156 return bt3c_get(iobase); 157 } 158 159 160 161 /* ======================== Interrupt handling ======================== */ 162 163 164 static int bt3c_write(unsigned int iobase, int fifo_size, __u8 *buf, int len) 165 { 166 int actual = 0; 167 168 bt3c_address(iobase, 0x7080); 169 170 /* Fill FIFO with current frame */ 171 while (actual < len) { 172 /* Transmit next byte */ 173 bt3c_put(iobase, buf[actual]); 174 actual++; 175 } 176 177 bt3c_io_write(iobase, 0x7005, actual); 178 179 return actual; 180 } 181 182 183 static void bt3c_write_wakeup(bt3c_info_t *info) 184 { 185 if (!info) { 186 BT_ERR("Unknown device"); 187 return; 188 } 189 190 if (test_and_set_bit(XMIT_SENDING, &(info->tx_state))) 191 return; 192 193 do { 194 register unsigned int iobase = info->p_dev->io.BasePort1; 195 register struct sk_buff *skb; 196 register int len; 197 198 if (!pcmcia_dev_present(info->p_dev)) 199 break; 200 201 202 if (!(skb = skb_dequeue(&(info->txq)))) { 203 clear_bit(XMIT_SENDING, &(info->tx_state)); 204 break; 205 } 206 207 /* Send frame */ 208 len = bt3c_write(iobase, 256, skb->data, skb->len); 209 210 if (len != skb->len) { 211 BT_ERR("Very strange"); 212 } 213 214 kfree_skb(skb); 215 216 info->hdev->stat.byte_tx += len; 217 218 } while (0); 219 } 220 221 222 static void bt3c_receive(bt3c_info_t *info) 223 { 224 unsigned int iobase; 225 int size = 0, avail; 226 227 if (!info) { 228 BT_ERR("Unknown device"); 229 return; 230 } 231 232 iobase = info->p_dev->io.BasePort1; 233 234 avail = bt3c_read(iobase, 0x7006); 235 //printk("bt3c_cs: receiving %d bytes\n", avail); 236 237 bt3c_address(iobase, 0x7480); 238 while (size < avail) { 239 size++; 240 info->hdev->stat.byte_rx++; 241 242 /* Allocate packet */ 243 if (info->rx_skb == NULL) { 244 info->rx_state = RECV_WAIT_PACKET_TYPE; 245 info->rx_count = 0; 246 if (!(info->rx_skb = bt_skb_alloc(HCI_MAX_FRAME_SIZE, GFP_ATOMIC))) { 247 BT_ERR("Can't allocate mem for new packet"); 248 return; 249 } 250 } 251 252 253 if (info->rx_state == RECV_WAIT_PACKET_TYPE) { 254 255 info->rx_skb->dev = (void *) info->hdev; 256 bt_cb(info->rx_skb)->pkt_type = inb(iobase + DATA_L); 257 inb(iobase + DATA_H); 258 //printk("bt3c: PACKET_TYPE=%02x\n", bt_cb(info->rx_skb)->pkt_type); 259 260 switch (bt_cb(info->rx_skb)->pkt_type) { 261 262 case HCI_EVENT_PKT: 263 info->rx_state = RECV_WAIT_EVENT_HEADER; 264 info->rx_count = HCI_EVENT_HDR_SIZE; 265 break; 266 267 case HCI_ACLDATA_PKT: 268 info->rx_state = RECV_WAIT_ACL_HEADER; 269 info->rx_count = HCI_ACL_HDR_SIZE; 270 break; 271 272 case HCI_SCODATA_PKT: 273 info->rx_state = RECV_WAIT_SCO_HEADER; 274 info->rx_count = HCI_SCO_HDR_SIZE; 275 break; 276 277 default: 278 /* Unknown packet */ 279 BT_ERR("Unknown HCI packet with type 0x%02x received", bt_cb(info->rx_skb)->pkt_type); 280 info->hdev->stat.err_rx++; 281 clear_bit(HCI_RUNNING, &(info->hdev->flags)); 282 283 kfree_skb(info->rx_skb); 284 info->rx_skb = NULL; 285 break; 286 287 } 288 289 } else { 290 291 __u8 x = inb(iobase + DATA_L); 292 293 *skb_put(info->rx_skb, 1) = x; 294 inb(iobase + DATA_H); 295 info->rx_count--; 296 297 if (info->rx_count == 0) { 298 299 int dlen; 300 struct hci_event_hdr *eh; 301 struct hci_acl_hdr *ah; 302 struct hci_sco_hdr *sh; 303 304 switch (info->rx_state) { 305 306 case RECV_WAIT_EVENT_HEADER: 307 eh = (struct hci_event_hdr *)(info->rx_skb->data); 308 info->rx_state = RECV_WAIT_DATA; 309 info->rx_count = eh->plen; 310 break; 311 312 case RECV_WAIT_ACL_HEADER: 313 ah = (struct hci_acl_hdr *)(info->rx_skb->data); 314 dlen = __le16_to_cpu(ah->dlen); 315 info->rx_state = RECV_WAIT_DATA; 316 info->rx_count = dlen; 317 break; 318 319 case RECV_WAIT_SCO_HEADER: 320 sh = (struct hci_sco_hdr *)(info->rx_skb->data); 321 info->rx_state = RECV_WAIT_DATA; 322 info->rx_count = sh->dlen; 323 break; 324 325 case RECV_WAIT_DATA: 326 hci_recv_frame(info->rx_skb); 327 info->rx_skb = NULL; 328 break; 329 330 } 331 332 } 333 334 } 335 336 } 337 338 bt3c_io_write(iobase, 0x7006, 0x0000); 339 } 340 341 342 static irqreturn_t bt3c_interrupt(int irq, void *dev_inst, struct pt_regs *regs) 343 { 344 bt3c_info_t *info = dev_inst; 345 unsigned int iobase; 346 int iir; 347 348 if (!info || !info->hdev) { 349 BT_ERR("Call of irq %d for unknown device", irq); 350 return IRQ_NONE; 351 } 352 353 iobase = info->p_dev->io.BasePort1; 354 355 spin_lock(&(info->lock)); 356 357 iir = inb(iobase + CONTROL); 358 if (iir & 0x80) { 359 int stat = bt3c_read(iobase, 0x7001); 360 361 if ((stat & 0xff) == 0x7f) { 362 BT_ERR("Very strange (stat=0x%04x)", stat); 363 } else if ((stat & 0xff) != 0xff) { 364 if (stat & 0x0020) { 365 int stat = bt3c_read(iobase, 0x7002) & 0x10; 366 BT_INFO("%s: Antenna %s", info->hdev->name, 367 stat ? "out" : "in"); 368 } 369 if (stat & 0x0001) 370 bt3c_receive(info); 371 if (stat & 0x0002) { 372 //BT_ERR("Ack (stat=0x%04x)", stat); 373 clear_bit(XMIT_SENDING, &(info->tx_state)); 374 bt3c_write_wakeup(info); 375 } 376 377 bt3c_io_write(iobase, 0x7001, 0x0000); 378 379 outb(iir, iobase + CONTROL); 380 } 381 } 382 383 spin_unlock(&(info->lock)); 384 385 return IRQ_HANDLED; 386 } 387 388 389 390 /* ======================== HCI interface ======================== */ 391 392 393 static int bt3c_hci_flush(struct hci_dev *hdev) 394 { 395 bt3c_info_t *info = (bt3c_info_t *)(hdev->driver_data); 396 397 /* Drop TX queue */ 398 skb_queue_purge(&(info->txq)); 399 400 return 0; 401 } 402 403 404 static int bt3c_hci_open(struct hci_dev *hdev) 405 { 406 set_bit(HCI_RUNNING, &(hdev->flags)); 407 408 return 0; 409 } 410 411 412 static int bt3c_hci_close(struct hci_dev *hdev) 413 { 414 if (!test_and_clear_bit(HCI_RUNNING, &(hdev->flags))) 415 return 0; 416 417 bt3c_hci_flush(hdev); 418 419 return 0; 420 } 421 422 423 static int bt3c_hci_send_frame(struct sk_buff *skb) 424 { 425 bt3c_info_t *info; 426 struct hci_dev *hdev = (struct hci_dev *)(skb->dev); 427 unsigned long flags; 428 429 if (!hdev) { 430 BT_ERR("Frame for unknown HCI device (hdev=NULL)"); 431 return -ENODEV; 432 } 433 434 info = (bt3c_info_t *) (hdev->driver_data); 435 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; 446 }; 447 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); 451 452 spin_lock_irqsave(&(info->lock), flags); 453 454 bt3c_write_wakeup(info); 455 456 spin_unlock_irqrestore(&(info->lock), flags); 457 458 return 0; 459 } 460 461 462 static void bt3c_hci_destruct(struct hci_dev *hdev) 463 { 464 } 465 466 467 static int bt3c_hci_ioctl(struct hci_dev *hdev, unsigned int cmd, unsigned long arg) 468 { 469 return -ENOIOCTLCMD; 470 } 471 472 473 474 /* ======================== Card services HCI interaction ======================== */ 475 476 477 static int bt3c_load_firmware(bt3c_info_t *info, unsigned char *firmware, int count) 478 { 479 char *ptr = (char *) firmware; 480 char b[9]; 481 unsigned int iobase, size, addr, fcs, tmp; 482 int i, err = 0; 483 484 iobase = info->p_dev->io.BasePort1; 485 486 /* Reset */ 487 bt3c_io_write(iobase, 0x8040, 0x0404); 488 bt3c_io_write(iobase, 0x8040, 0x0400); 489 490 udelay(1); 491 492 bt3c_io_write(iobase, 0x8040, 0x0404); 493 494 udelay(17); 495 496 /* Load */ 497 while (count) { 498 if (ptr[0] != 'S') { 499 BT_ERR("Bad address in firmware"); 500 err = -EFAULT; 501 goto error; 502 } 503 504 memset(b, 0, sizeof(b)); 505 memcpy(b, ptr + 2, 2); 506 size = simple_strtol(b, NULL, 16); 507 508 memset(b, 0, sizeof(b)); 509 memcpy(b, ptr + 4, 8); 510 addr = simple_strtol(b, NULL, 16); 511 512 memset(b, 0, sizeof(b)); 513 memcpy(b, ptr + (size * 2) + 2, 2); 514 fcs = simple_strtol(b, NULL, 16); 515 516 memset(b, 0, sizeof(b)); 517 for (tmp = 0, i = 0; i < size; i++) { 518 memcpy(b, ptr + (i * 2) + 2, 2); 519 tmp += simple_strtol(b, NULL, 16); 520 } 521 522 if (((tmp + fcs) & 0xff) != 0xff) { 523 BT_ERR("Checksum error in firmware"); 524 err = -EILSEQ; 525 goto error; 526 } 527 528 if (ptr[1] == '3') { 529 bt3c_address(iobase, addr); 530 531 memset(b, 0, sizeof(b)); 532 for (i = 0; i < (size - 4) / 2; i++) { 533 memcpy(b, ptr + (i * 4) + 12, 4); 534 tmp = simple_strtol(b, NULL, 16); 535 bt3c_put(iobase, tmp); 536 } 537 } 538 539 ptr += (size * 2) + 6; 540 count -= (size * 2) + 6; 541 } 542 543 udelay(17); 544 545 /* Boot */ 546 bt3c_address(iobase, 0x3000); 547 outb(inb(iobase + CONTROL) | 0x40, iobase + CONTROL); 548 549 error: 550 udelay(17); 551 552 /* Clear */ 553 bt3c_io_write(iobase, 0x7006, 0x0000); 554 bt3c_io_write(iobase, 0x7005, 0x0000); 555 bt3c_io_write(iobase, 0x7001, 0x0000); 556 557 return err; 558 } 559 560 561 static int bt3c_open(bt3c_info_t *info) 562 { 563 const struct firmware *firmware; 564 struct hci_dev *hdev; 565 int err; 566 567 spin_lock_init(&(info->lock)); 568 569 skb_queue_head_init(&(info->txq)); 570 571 info->rx_state = RECV_WAIT_PACKET_TYPE; 572 info->rx_count = 0; 573 info->rx_skb = NULL; 574 575 /* Initialize HCI device */ 576 hdev = hci_alloc_dev(); 577 if (!hdev) { 578 BT_ERR("Can't allocate HCI device"); 579 return -ENOMEM; 580 } 581 582 info->hdev = hdev; 583 584 hdev->type = HCI_PCCARD; 585 hdev->driver_data = info; 586 587 hdev->open = bt3c_hci_open; 588 hdev->close = bt3c_hci_close; 589 hdev->flush = bt3c_hci_flush; 590 hdev->send = bt3c_hci_send_frame; 591 hdev->destruct = bt3c_hci_destruct; 592 hdev->ioctl = bt3c_hci_ioctl; 593 594 hdev->owner = THIS_MODULE; 595 596 /* Load firmware */ 597 err = request_firmware(&firmware, "BT3CPCC.bin", &info->p_dev->dev); 598 if (err < 0) { 599 BT_ERR("Firmware request failed"); 600 goto error; 601 } 602 603 err = bt3c_load_firmware(info, firmware->data, firmware->size); 604 605 release_firmware(firmware); 606 607 if (err < 0) { 608 BT_ERR("Firmware loading failed"); 609 goto error; 610 } 611 612 /* Timeout before it is safe to send the first HCI packet */ 613 msleep(1000); 614 615 /* Register HCI device */ 616 err = hci_register_dev(hdev); 617 if (err < 0) { 618 BT_ERR("Can't register HCI device"); 619 goto error; 620 } 621 622 return 0; 623 624 error: 625 info->hdev = NULL; 626 hci_free_dev(hdev); 627 return err; 628 } 629 630 631 static int bt3c_close(bt3c_info_t *info) 632 { 633 struct hci_dev *hdev = info->hdev; 634 635 if (!hdev) 636 return -ENODEV; 637 638 bt3c_hci_close(hdev); 639 640 if (hci_unregister_dev(hdev) < 0) 641 BT_ERR("Can't unregister HCI device %s", hdev->name); 642 643 hci_free_dev(hdev); 644 645 return 0; 646 } 647 648 static int bt3c_probe(struct pcmcia_device *link) 649 { 650 bt3c_info_t *info; 651 652 /* Create new info device */ 653 info = kzalloc(sizeof(*info), GFP_KERNEL); 654 if (!info) 655 return -ENOMEM; 656 657 info->p_dev = link; 658 link->priv = info; 659 660 link->io.Attributes1 = IO_DATA_PATH_WIDTH_8; 661 link->io.NumPorts1 = 8; 662 link->irq.Attributes = IRQ_TYPE_EXCLUSIVE | IRQ_HANDLE_PRESENT; 663 link->irq.IRQInfo1 = IRQ_LEVEL_ID; 664 665 link->irq.Handler = bt3c_interrupt; 666 link->irq.Instance = info; 667 668 link->conf.Attributes = CONF_ENABLE_IRQ; 669 link->conf.IntType = INT_MEMORY_AND_IO; 670 671 return bt3c_config(link); 672 } 673 674 675 static void bt3c_detach(struct pcmcia_device *link) 676 { 677 bt3c_info_t *info = link->priv; 678 679 bt3c_release(link); 680 kfree(info); 681 } 682 683 static int get_tuple(struct pcmcia_device *handle, tuple_t *tuple, cisparse_t *parse) 684 { 685 int i; 686 687 i = pcmcia_get_tuple_data(handle, tuple); 688 if (i != CS_SUCCESS) 689 return i; 690 691 return pcmcia_parse_tuple(handle, tuple, parse); 692 } 693 694 static int first_tuple(struct pcmcia_device *handle, tuple_t *tuple, cisparse_t *parse) 695 { 696 if (pcmcia_get_first_tuple(handle, tuple) != CS_SUCCESS) 697 return CS_NO_MORE_ITEMS; 698 return get_tuple(handle, tuple, parse); 699 } 700 701 static int next_tuple(struct pcmcia_device *handle, tuple_t *tuple, cisparse_t *parse) 702 { 703 if (pcmcia_get_next_tuple(handle, tuple) != CS_SUCCESS) 704 return CS_NO_MORE_ITEMS; 705 return get_tuple(handle, tuple, parse); 706 } 707 708 static int bt3c_config(struct pcmcia_device *link) 709 { 710 static kio_addr_t base[5] = { 0x3f8, 0x2f8, 0x3e8, 0x2e8, 0x0 }; 711 bt3c_info_t *info = link->priv; 712 tuple_t tuple; 713 u_short buf[256]; 714 cisparse_t parse; 715 cistpl_cftable_entry_t *cf = &parse.cftable_entry; 716 int i, j, try, last_ret, last_fn; 717 718 tuple.TupleData = (cisdata_t *)buf; 719 tuple.TupleOffset = 0; 720 tuple.TupleDataMax = 255; 721 tuple.Attributes = 0; 722 723 /* Get configuration register information */ 724 tuple.DesiredTuple = CISTPL_CONFIG; 725 last_ret = first_tuple(link, &tuple, &parse); 726 if (last_ret != CS_SUCCESS) { 727 last_fn = ParseTuple; 728 goto cs_failed; 729 } 730 link->conf.ConfigBase = parse.config.base; 731 link->conf.Present = parse.config.rmask[0]; 732 733 /* First pass: look for a config entry that looks normal. */ 734 tuple.TupleData = (cisdata_t *)buf; 735 tuple.TupleOffset = 0; 736 tuple.TupleDataMax = 255; 737 tuple.Attributes = 0; 738 tuple.DesiredTuple = CISTPL_CFTABLE_ENTRY; 739 /* Two tries: without IO aliases, then with aliases */ 740 for (try = 0; try < 2; try++) { 741 i = first_tuple(link, &tuple, &parse); 742 while (i != CS_NO_MORE_ITEMS) { 743 if (i != CS_SUCCESS) 744 goto next_entry; 745 if (cf->vpp1.present & (1 << CISTPL_POWER_VNOM)) 746 link->conf.Vpp = cf->vpp1.param[CISTPL_POWER_VNOM] / 10000; 747 if ((cf->io.nwin > 0) && (cf->io.win[0].len == 8) && (cf->io.win[0].base != 0)) { 748 link->conf.ConfigIndex = cf->index; 749 link->io.BasePort1 = cf->io.win[0].base; 750 link->io.IOAddrLines = (try == 0) ? 16 : cf->io.flags & CISTPL_IO_LINES_MASK; 751 i = pcmcia_request_io(link, &link->io); 752 if (i == CS_SUCCESS) 753 goto found_port; 754 } 755 next_entry: 756 i = next_tuple(link, &tuple, &parse); 757 } 758 } 759 760 /* Second pass: try to find an entry that isn't picky about 761 its base address, then try to grab any standard serial port 762 address, and finally try to get any free port. */ 763 i = first_tuple(link, &tuple, &parse); 764 while (i != CS_NO_MORE_ITEMS) { 765 if ((i == CS_SUCCESS) && (cf->io.nwin > 0) && ((cf->io.flags & CISTPL_IO_LINES_MASK) <= 3)) { 766 link->conf.ConfigIndex = cf->index; 767 for (j = 0; j < 5; j++) { 768 link->io.BasePort1 = base[j]; 769 link->io.IOAddrLines = base[j] ? 16 : 3; 770 i = pcmcia_request_io(link, &link->io); 771 if (i == CS_SUCCESS) 772 goto found_port; 773 } 774 } 775 i = next_tuple(link, &tuple, &parse); 776 } 777 778 found_port: 779 if (i != CS_SUCCESS) { 780 BT_ERR("No usable port range found"); 781 cs_error(link, RequestIO, i); 782 goto failed; 783 } 784 785 i = pcmcia_request_irq(link, &link->irq); 786 if (i != CS_SUCCESS) { 787 cs_error(link, RequestIRQ, i); 788 link->irq.AssignedIRQ = 0; 789 } 790 791 i = pcmcia_request_configuration(link, &link->conf); 792 if (i != CS_SUCCESS) { 793 cs_error(link, RequestConfiguration, i); 794 goto failed; 795 } 796 797 if (bt3c_open(info) != 0) 798 goto failed; 799 800 strcpy(info->node.dev_name, info->hdev->name); 801 link->dev_node = &info->node; 802 803 return 0; 804 805 cs_failed: 806 cs_error(link, last_fn, last_ret); 807 808 failed: 809 bt3c_release(link); 810 return -ENODEV; 811 } 812 813 814 static void bt3c_release(struct pcmcia_device *link) 815 { 816 bt3c_info_t *info = link->priv; 817 818 bt3c_close(info); 819 820 pcmcia_disable_device(link); 821 } 822 823 824 static struct pcmcia_device_id bt3c_ids[] = { 825 PCMCIA_DEVICE_PROD_ID13("3COM", "Bluetooth PC Card", 0xefce0a31, 0xd4ce9b02), 826 PCMCIA_DEVICE_NULL 827 }; 828 MODULE_DEVICE_TABLE(pcmcia, bt3c_ids); 829 830 static struct pcmcia_driver bt3c_driver = { 831 .owner = THIS_MODULE, 832 .drv = { 833 .name = "bt3c_cs", 834 }, 835 .probe = bt3c_probe, 836 .remove = bt3c_detach, 837 .id_table = bt3c_ids, 838 }; 839 840 static int __init init_bt3c_cs(void) 841 { 842 return pcmcia_register_driver(&bt3c_driver); 843 } 844 845 846 static void __exit exit_bt3c_cs(void) 847 { 848 pcmcia_unregister_driver(&bt3c_driver); 849 } 850 851 module_init(init_bt3c_cs); 852 module_exit(exit_bt3c_cs); 853