git.oblomov.eu Git - linux-2.6/blob - drivers/bluetooth/bt3c_cs.c

   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         dev_link_t link;
  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 void bt3c_config(dev_link_t *link);
  92 static void bt3c_release(dev_link_t *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->link.io.BasePort1;
 195                 register struct sk_buff *skb;
 196                 register int len;
 197
 198                 if (!(info->link.state & DEV_PRESENT))
 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->link.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->link.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 struct device *bt3c_device(void)
 478 {
 479         static struct device dev = {
 480                 .bus_id = "pcmcia",
 481         };
 482         kobject_set_name(&dev.kobj, "bt3c");
 483         kobject_init(&dev.kobj);
 484
 485         return &dev;
 486 }
 487
 488
 489 static int bt3c_load_firmware(bt3c_info_t *info, unsigned char *firmware, int count)
 490 {
 491         char *ptr = (char *) firmware;
 492         char b[9];
 493         unsigned int iobase, size, addr, fcs, tmp;
 494         int i, err = 0;
 495
 496         iobase = info->link.io.BasePort1;
 497
 498         /* Reset */
 499         bt3c_io_write(iobase, 0x8040, 0x0404);
 500         bt3c_io_write(iobase, 0x8040, 0x0400);
 501
 502         udelay(1);
 503
 504         bt3c_io_write(iobase, 0x8040, 0x0404);
 505
 506         udelay(17);
 507
 508         /* Load */
 509         while (count) {
 510                 if (ptr[0] != 'S') {
 511                         BT_ERR("Bad address in firmware");
 512                         err = -EFAULT;
 513                         goto error;
 514                 }
 515
 516                 memset(b, 0, sizeof(b));
 517                 memcpy(b, ptr + 2, 2);
 518                 size = simple_strtol(b, NULL, 16);
 519
 520                 memset(b, 0, sizeof(b));
 521                 memcpy(b, ptr + 4, 8);
 522                 addr = simple_strtol(b, NULL, 16);
 523
 524                 memset(b, 0, sizeof(b));
 525                 memcpy(b, ptr + (size * 2) + 2, 2);
 526                 fcs = simple_strtol(b, NULL, 16);
 527
 528                 memset(b, 0, sizeof(b));
 529                 for (tmp = 0, i = 0; i < size; i++) {
 530                         memcpy(b, ptr + (i * 2) + 2, 2);
 531                         tmp += simple_strtol(b, NULL, 16);
 532                 }
 533
 534                 if (((tmp + fcs) & 0xff) != 0xff) {
 535                         BT_ERR("Checksum error in firmware");
 536                         err = -EILSEQ;
 537                         goto error;
 538                 }
 539
 540                 if (ptr[1] == '3') {
 541                         bt3c_address(iobase, addr);
 542
 543                         memset(b, 0, sizeof(b));
 544                         for (i = 0; i < (size - 4) / 2; i++) {
 545                                 memcpy(b, ptr + (i * 4) + 12, 4);
 546                                 tmp = simple_strtol(b, NULL, 16);
 547                                 bt3c_put(iobase, tmp);
 548                         }
 549                 }
 550
 551                 ptr   += (size * 2) + 6;
 552                 count -= (size * 2) + 6;
 553         }
 554
 555         udelay(17);
 556
 557         /* Boot */
 558         bt3c_address(iobase, 0x3000);
 559         outb(inb(iobase + CONTROL) | 0x40, iobase + CONTROL);
 560
 561 error:
 562         udelay(17);
 563
 564         /* Clear */
 565         bt3c_io_write(iobase, 0x7006, 0x0000);
 566         bt3c_io_write(iobase, 0x7005, 0x0000);
 567         bt3c_io_write(iobase, 0x7001, 0x0000);
 568
 569         return err;
 570 }
 571
 572
 573 static int bt3c_open(bt3c_info_t *info)
 574 {
 575         const struct firmware *firmware;
 576         struct hci_dev *hdev;
 577         int err;
 578
 579         spin_lock_init(&(info->lock));
 580
 581         skb_queue_head_init(&(info->txq));
 582
 583         info->rx_state = RECV_WAIT_PACKET_TYPE;
 584         info->rx_count = 0;
 585         info->rx_skb = NULL;
 586
 587         /* Initialize HCI device */
 588         hdev = hci_alloc_dev();
 589         if (!hdev) {
 590                 BT_ERR("Can't allocate HCI device");
 591                 return -ENOMEM;
 592         }
 593
 594         info->hdev = hdev;
 595
 596         hdev->type = HCI_PCCARD;
 597         hdev->driver_data = info;
 598
 599         hdev->open     = bt3c_hci_open;
 600         hdev->close    = bt3c_hci_close;
 601         hdev->flush    = bt3c_hci_flush;
 602         hdev->send     = bt3c_hci_send_frame;
 603         hdev->destruct = bt3c_hci_destruct;
 604         hdev->ioctl    = bt3c_hci_ioctl;
 605
 606         hdev->owner = THIS_MODULE;
 607
 608         /* Load firmware */
 609         err = request_firmware(&firmware, "BT3CPCC.bin", bt3c_device());
 610         if (err < 0) {
 611                 BT_ERR("Firmware request failed");
 612                 goto error;
 613         }
 614
 615         err = bt3c_load_firmware(info, firmware->data, firmware->size);
 616
 617         release_firmware(firmware);
 618
 619         if (err < 0) {
 620                 BT_ERR("Firmware loading failed");
 621                 goto error;
 622         }
 623
 624         /* Timeout before it is safe to send the first HCI packet */
 625         msleep(1000);
 626
 627         /* Register HCI device */
 628         err = hci_register_dev(hdev);
 629         if (err < 0) {
 630                 BT_ERR("Can't register HCI device");
 631                 goto error;
 632         }
 633
 634         return 0;
 635
 636 error:
 637         info->hdev = NULL;
 638         hci_free_dev(hdev);
 639         return err;
 640 }
 641
 642
 643 static int bt3c_close(bt3c_info_t *info)
 644 {
 645         struct hci_dev *hdev = info->hdev;
 646
 647         if (!hdev)
 648                 return -ENODEV;
 649
 650         bt3c_hci_close(hdev);
 651
 652         if (hci_unregister_dev(hdev) < 0)
 653                 BT_ERR("Can't unregister HCI device %s", hdev->name);
 654
 655         hci_free_dev(hdev);
 656
 657         return 0;
 658 }
 659
 660 static int bt3c_attach(struct pcmcia_device *p_dev)
 661 {
 662         bt3c_info_t *info;
 663         dev_link_t *link;
 664
 665         /* Create new info device */
 666         info = kzalloc(sizeof(*info), GFP_KERNEL);
 667         if (!info)
 668                 return -ENOMEM;
 669
 670         link = &info->link;
 671         link->priv = info;
 672
 673         link->io.Attributes1 = IO_DATA_PATH_WIDTH_8;
 674         link->io.NumPorts1 = 8;
 675         link->irq.Attributes = IRQ_TYPE_EXCLUSIVE | IRQ_HANDLE_PRESENT;
 676         link->irq.IRQInfo1 = IRQ_LEVEL_ID;
 677
 678         link->irq.Handler = bt3c_interrupt;
 679         link->irq.Instance = info;
 680
 681         link->conf.Attributes = CONF_ENABLE_IRQ;
 682         link->conf.Vcc = 50;
 683         link->conf.IntType = INT_MEMORY_AND_IO;
 684
 685         link->handle = p_dev;
 686         p_dev->instance = link;
 687
 688         link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
 689         bt3c_config(link);
 690
 691         return 0;
 692 }
 693
 694
 695 static void bt3c_detach(struct pcmcia_device *p_dev)
 696 {
 697         dev_link_t *link = dev_to_instance(p_dev);
 698         bt3c_info_t *info = link->priv;
 699
 700         if (link->state & DEV_CONFIG)
 701                 bt3c_release(link);
 702
 703         kfree(info);
 704 }
 705
 706 static int get_tuple(client_handle_t handle, tuple_t *tuple, cisparse_t *parse)
 707 {
 708         int i;
 709
 710         i = pcmcia_get_tuple_data(handle, tuple);
 711         if (i != CS_SUCCESS)
 712                 return i;
 713
 714         return pcmcia_parse_tuple(handle, tuple, parse);
 715 }
 716
 717 static int first_tuple(client_handle_t handle, tuple_t *tuple, cisparse_t *parse)
 718 {
 719         if (pcmcia_get_first_tuple(handle, tuple) != CS_SUCCESS)
 720                 return CS_NO_MORE_ITEMS;
 721         return get_tuple(handle, tuple, parse);
 722 }
 723
 724 static int next_tuple(client_handle_t handle, tuple_t *tuple, cisparse_t *parse)
 725 {
 726         if (pcmcia_get_next_tuple(handle, tuple) != CS_SUCCESS)
 727                 return CS_NO_MORE_ITEMS;
 728         return get_tuple(handle, tuple, parse);
 729 }
 730
 731 static void bt3c_config(dev_link_t *link)
 732 {
 733         static kio_addr_t base[5] = { 0x3f8, 0x2f8, 0x3e8, 0x2e8, 0x0 };
 734         client_handle_t handle = link->handle;
 735         bt3c_info_t *info = link->priv;
 736         tuple_t tuple;
 737         u_short buf[256];
 738         cisparse_t parse;
 739         cistpl_cftable_entry_t *cf = &parse.cftable_entry;
 740         config_info_t config;
 741         int i, j, try, last_ret, last_fn;
 742
 743         tuple.TupleData = (cisdata_t *)buf;
 744         tuple.TupleOffset = 0;
 745         tuple.TupleDataMax = 255;
 746         tuple.Attributes = 0;
 747
 748         /* Get configuration register information */
 749         tuple.DesiredTuple = CISTPL_CONFIG;
 750         last_ret = first_tuple(handle, &tuple, &parse);
 751         if (last_ret != CS_SUCCESS) {
 752                 last_fn = ParseTuple;
 753                 goto cs_failed;
 754         }
 755         link->conf.ConfigBase = parse.config.base;
 756         link->conf.Present = parse.config.rmask[0];
 757
 758         /* Configure card */
 759         link->state |= DEV_CONFIG;
 760         i = pcmcia_get_configuration_info(handle, &config);
 761         link->conf.Vcc = config.Vcc;
 762
 763         /* First pass: look for a config entry that looks normal. */
 764         tuple.TupleData = (cisdata_t *)buf;
 765         tuple.TupleOffset = 0;
 766         tuple.TupleDataMax = 255;
 767         tuple.Attributes = 0;
 768         tuple.DesiredTuple = CISTPL_CFTABLE_ENTRY;
 769         /* Two tries: without IO aliases, then with aliases */
 770         for (try = 0; try < 2; try++) {
 771                 i = first_tuple(handle, &tuple, &parse);
 772                 while (i != CS_NO_MORE_ITEMS) {
 773                         if (i != CS_SUCCESS)
 774                                 goto next_entry;
 775                         if (cf->vpp1.present & (1 << CISTPL_POWER_VNOM))
 776                                 link->conf.Vpp1 = link->conf.Vpp2 = cf->vpp1.param[CISTPL_POWER_VNOM] / 10000;
 777                         if ((cf->io.nwin > 0) && (cf->io.win[0].len == 8) && (cf->io.win[0].base != 0)) {
 778                                 link->conf.ConfigIndex = cf->index;
 779                                 link->io.BasePort1 = cf->io.win[0].base;
 780                                 link->io.IOAddrLines = (try == 0) ? 16 : cf->io.flags & CISTPL_IO_LINES_MASK;
 781                                 i = pcmcia_request_io(link->handle, &link->io);
 782                                 if (i == CS_SUCCESS)
 783                                         goto found_port;
 784                         }
 785 next_entry:
 786                         i = next_tuple(handle, &tuple, &parse);
 787                 }
 788         }
 789
 790         /* Second pass: try to find an entry that isn't picky about
 791            its base address, then try to grab any standard serial port
 792            address, and finally try to get any free port. */
 793         i = first_tuple(handle, &tuple, &parse);
 794         while (i != CS_NO_MORE_ITEMS) {
 795                 if ((i == CS_SUCCESS) && (cf->io.nwin > 0) && ((cf->io.flags & CISTPL_IO_LINES_MASK) <= 3)) {
 796                         link->conf.ConfigIndex = cf->index;
 797                         for (j = 0; j < 5; j++) {
 798                                 link->io.BasePort1 = base[j];
 799                                 link->io.IOAddrLines = base[j] ? 16 : 3;
 800                                 i = pcmcia_request_io(link->handle, &link->io);
 801                                 if (i == CS_SUCCESS)
 802                                         goto found_port;
 803                         }
 804                 }
 805                 i = next_tuple(handle, &tuple, &parse);
 806         }
 807
 808 found_port:
 809         if (i != CS_SUCCESS) {
 810                 BT_ERR("No usable port range found");
 811                 cs_error(link->handle, RequestIO, i);
 812                 goto failed;
 813         }
 814
 815         i = pcmcia_request_irq(link->handle, &link->irq);
 816         if (i != CS_SUCCESS) {
 817                 cs_error(link->handle, RequestIRQ, i);
 818                 link->irq.AssignedIRQ = 0;
 819         }
 820
 821         i = pcmcia_request_configuration(link->handle, &link->conf);
 822         if (i != CS_SUCCESS) {
 823                 cs_error(link->handle, RequestConfiguration, i);
 824                 goto failed;
 825         }
 826
 827         if (bt3c_open(info) != 0)
 828                 goto failed;
 829
 830         strcpy(info->node.dev_name, info->hdev->name);
 831         link->dev = &info->node;
 832         link->state &= ~DEV_CONFIG_PENDING;
 833
 834         return;
 835
 836 cs_failed:
 837         cs_error(link->handle, last_fn, last_ret);
 838
 839 failed:
 840         bt3c_release(link);
 841 }
 842
 843
 844 static void bt3c_release(dev_link_t *link)
 845 {
 846         bt3c_info_t *info = link->priv;
 847
 848         if (link->state & DEV_PRESENT)
 849                 bt3c_close(info);
 850
 851         link->dev = NULL;
 852
 853         pcmcia_release_configuration(link->handle);
 854         pcmcia_release_io(link->handle, &link->io);
 855         pcmcia_release_irq(link->handle, &link->irq);
 856
 857         link->state &= ~DEV_CONFIG;
 858 }
 859
 860 static int bt3c_suspend(struct pcmcia_device *dev)
 861 {
 862         dev_link_t *link = dev_to_instance(dev);
 863
 864         link->state |= DEV_SUSPEND;
 865         if (link->state & DEV_CONFIG)
 866                 pcmcia_release_configuration(link->handle);
 867
 868         return 0;
 869 }
 870
 871 static int bt3c_resume(struct pcmcia_device *dev)
 872 {
 873         dev_link_t *link = dev_to_instance(dev);
 874
 875         link->state &= ~DEV_SUSPEND;
 876         if (DEV_OK(link))
 877                 pcmcia_request_configuration(link->handle, &link->conf);
 878
 879         return 0;
 880 }
 881
 882
 883 static struct pcmcia_device_id bt3c_ids[] = {
 884         PCMCIA_DEVICE_PROD_ID13("3COM", "Bluetooth PC Card", 0xefce0a31, 0xd4ce9b02),
 885         PCMCIA_DEVICE_NULL
 886 };
 887 MODULE_DEVICE_TABLE(pcmcia, bt3c_ids);
 888
 889 static struct pcmcia_driver bt3c_driver = {
 890         .owner          = THIS_MODULE,
 891         .drv            = {
 892                 .name   = "bt3c_cs",
 893         },
 894         .probe          = bt3c_attach,
 895         .remove         = bt3c_detach,
 896         .id_table       = bt3c_ids,
 897         .suspend        = bt3c_suspend,
 898         .resume         = bt3c_resume,
 899 };
 900
 901 static int __init init_bt3c_cs(void)
 902 {
 903         return pcmcia_register_driver(&bt3c_driver);
 904 }
 905
 906
 907 static void __exit exit_bt3c_cs(void)
 908 {
 909         pcmcia_unregister_driver(&bt3c_driver);
 910 }
 911
 912 module_init(init_bt3c_cs);
 913 module_exit(exit_bt3c_cs);