[PATCH] bluetooth: kmalloc + memset -> kzalloc conversion
[linux-2.6.git] / 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 static int bt3c_event(event_t event, int priority, event_callback_args_t *args);
94
95 static dev_info_t dev_info = "bt3c_cs";
96
97 static dev_link_t *bt3c_attach(void);
98 static void bt3c_detach(dev_link_t *);
99
100 static dev_link_t *dev_list = NULL;
101
102
103 /* Transmit states  */
104 #define XMIT_SENDING  1
105 #define XMIT_WAKEUP   2
106 #define XMIT_WAITING  8
107
108 /* Receiver states */
109 #define RECV_WAIT_PACKET_TYPE   0
110 #define RECV_WAIT_EVENT_HEADER  1
111 #define RECV_WAIT_ACL_HEADER    2
112 #define RECV_WAIT_SCO_HEADER    3
113 #define RECV_WAIT_DATA          4
114
115
116
117 /* ======================== Special I/O functions ======================== */
118
119
120 #define DATA_L   0
121 #define DATA_H   1
122 #define ADDR_L   2
123 #define ADDR_H   3
124 #define CONTROL  4
125
126
127 static inline void bt3c_address(unsigned int iobase, unsigned short addr)
128 {
129         outb(addr & 0xff, iobase + ADDR_L);
130         outb((addr >> 8) & 0xff, iobase + ADDR_H);
131 }
132
133
134 static inline void bt3c_put(unsigned int iobase, unsigned short value)
135 {
136         outb(value & 0xff, iobase + DATA_L);
137         outb((value >> 8) & 0xff, iobase + DATA_H);
138 }
139
140
141 static inline void bt3c_io_write(unsigned int iobase, unsigned short addr, unsigned short value)
142 {
143         bt3c_address(iobase, addr);
144         bt3c_put(iobase, value);
145 }
146
147
148 static inline unsigned short bt3c_get(unsigned int iobase)
149 {
150         unsigned short value = inb(iobase + DATA_L);
151
152         value |= inb(iobase + DATA_H) << 8;
153
154         return value;
155 }
156
157
158 static inline unsigned short bt3c_read(unsigned int iobase, unsigned short addr)
159 {
160         bt3c_address(iobase, addr);
161
162         return bt3c_get(iobase);
163 }
164
165
166
167 /* ======================== Interrupt handling ======================== */
168
169
170 static int bt3c_write(unsigned int iobase, int fifo_size, __u8 *buf, int len)
171 {
172         int actual = 0;
173
174         bt3c_address(iobase, 0x7080);
175
176         /* Fill FIFO with current frame */
177         while (actual < len) {
178                 /* Transmit next byte */
179                 bt3c_put(iobase, buf[actual]);
180                 actual++;
181         }
182
183         bt3c_io_write(iobase, 0x7005, actual);
184
185         return actual;
186 }
187
188
189 static void bt3c_write_wakeup(bt3c_info_t *info)
190 {
191         if (!info) {
192                 BT_ERR("Unknown device");
193                 return;
194         }
195
196         if (test_and_set_bit(XMIT_SENDING, &(info->tx_state)))
197                 return;
198
199         do {
200                 register unsigned int iobase = info->link.io.BasePort1;
201                 register struct sk_buff *skb;
202                 register int len;
203
204                 if (!(info->link.state & DEV_PRESENT))
205                         break;
206
207
208                 if (!(skb = skb_dequeue(&(info->txq)))) {
209                         clear_bit(XMIT_SENDING, &(info->tx_state));
210                         break;
211                 }
212
213                 /* Send frame */
214                 len = bt3c_write(iobase, 256, skb->data, skb->len);
215
216                 if (len != skb->len) {
217                         BT_ERR("Very strange");
218                 }
219
220                 kfree_skb(skb);
221
222                 info->hdev->stat.byte_tx += len;
223
224         } while (0);
225 }
226
227
228 static void bt3c_receive(bt3c_info_t *info)
229 {
230         unsigned int iobase;
231         int size = 0, avail;
232
233         if (!info) {
234                 BT_ERR("Unknown device");
235                 return;
236         }
237
238         iobase = info->link.io.BasePort1;
239
240         avail = bt3c_read(iobase, 0x7006);
241         //printk("bt3c_cs: receiving %d bytes\n", avail);
242
243         bt3c_address(iobase, 0x7480);
244         while (size < avail) {
245                 size++;
246                 info->hdev->stat.byte_rx++;
247
248                 /* Allocate packet */
249                 if (info->rx_skb == NULL) {
250                         info->rx_state = RECV_WAIT_PACKET_TYPE;
251                         info->rx_count = 0;
252                         if (!(info->rx_skb = bt_skb_alloc(HCI_MAX_FRAME_SIZE, GFP_ATOMIC))) {
253                                 BT_ERR("Can't allocate mem for new packet");
254                                 return;
255                         }
256                 }
257
258
259                 if (info->rx_state == RECV_WAIT_PACKET_TYPE) {
260
261                         info->rx_skb->dev = (void *) info->hdev;
262                         bt_cb(info->rx_skb)->pkt_type = inb(iobase + DATA_L);
263                         inb(iobase + DATA_H);
264                         //printk("bt3c: PACKET_TYPE=%02x\n", bt_cb(info->rx_skb)->pkt_type);
265
266                         switch (bt_cb(info->rx_skb)->pkt_type) {
267
268                         case HCI_EVENT_PKT:
269                                 info->rx_state = RECV_WAIT_EVENT_HEADER;
270                                 info->rx_count = HCI_EVENT_HDR_SIZE;
271                                 break;
272
273                         case HCI_ACLDATA_PKT:
274                                 info->rx_state = RECV_WAIT_ACL_HEADER;
275                                 info->rx_count = HCI_ACL_HDR_SIZE;
276                                 break;
277
278                         case HCI_SCODATA_PKT:
279                                 info->rx_state = RECV_WAIT_SCO_HEADER;
280                                 info->rx_count = HCI_SCO_HDR_SIZE;
281                                 break;
282
283                         default:
284                                 /* Unknown packet */
285                                 BT_ERR("Unknown HCI packet with type 0x%02x received", bt_cb(info->rx_skb)->pkt_type);
286                                 info->hdev->stat.err_rx++;
287                                 clear_bit(HCI_RUNNING, &(info->hdev->flags));
288
289                                 kfree_skb(info->rx_skb);
290                                 info->rx_skb = NULL;
291                                 break;
292
293                         }
294
295                 } else {
296
297                         __u8 x = inb(iobase + DATA_L);
298
299                         *skb_put(info->rx_skb, 1) = x;
300                         inb(iobase + DATA_H);
301                         info->rx_count--;
302
303                         if (info->rx_count == 0) {
304
305                                 int dlen;
306                                 struct hci_event_hdr *eh;
307                                 struct hci_acl_hdr *ah;
308                                 struct hci_sco_hdr *sh;
309
310                                 switch (info->rx_state) {
311
312                                 case RECV_WAIT_EVENT_HEADER:
313                                         eh = (struct hci_event_hdr *)(info->rx_skb->data);
314                                         info->rx_state = RECV_WAIT_DATA;
315                                         info->rx_count = eh->plen;
316                                         break;
317
318                                 case RECV_WAIT_ACL_HEADER:
319                                         ah = (struct hci_acl_hdr *)(info->rx_skb->data);
320                                         dlen = __le16_to_cpu(ah->dlen);
321                                         info->rx_state = RECV_WAIT_DATA;
322                                         info->rx_count = dlen;
323                                         break;
324
325                                 case RECV_WAIT_SCO_HEADER:
326                                         sh = (struct hci_sco_hdr *)(info->rx_skb->data);
327                                         info->rx_state = RECV_WAIT_DATA;
328                                         info->rx_count = sh->dlen;
329                                         break;
330
331                                 case RECV_WAIT_DATA:
332                                         hci_recv_frame(info->rx_skb);
333                                         info->rx_skb = NULL;
334                                         break;
335
336                                 }
337
338                         }
339
340                 }
341
342         }
343
344         bt3c_io_write(iobase, 0x7006, 0x0000);
345 }
346
347
348 static irqreturn_t bt3c_interrupt(int irq, void *dev_inst, struct pt_regs *regs)
349 {
350         bt3c_info_t *info = dev_inst;
351         unsigned int iobase;
352         int iir;
353
354         if (!info || !info->hdev) {
355                 BT_ERR("Call of irq %d for unknown device", irq);
356                 return IRQ_NONE;
357         }
358
359         iobase = info->link.io.BasePort1;
360
361         spin_lock(&(info->lock));
362
363         iir = inb(iobase + CONTROL);
364         if (iir & 0x80) {
365                 int stat = bt3c_read(iobase, 0x7001);
366
367                 if ((stat & 0xff) == 0x7f) {
368                         BT_ERR("Very strange (stat=0x%04x)", stat);
369                 } else if ((stat & 0xff) != 0xff) {
370                         if (stat & 0x0020) {
371                                 int stat = bt3c_read(iobase, 0x7002) & 0x10;
372                                 BT_INFO("%s: Antenna %s", info->hdev->name,
373                                                         stat ? "out" : "in");
374                         }
375                         if (stat & 0x0001)
376                                 bt3c_receive(info);
377                         if (stat & 0x0002) {
378                                 //BT_ERR("Ack (stat=0x%04x)", stat);
379                                 clear_bit(XMIT_SENDING, &(info->tx_state));
380                                 bt3c_write_wakeup(info);
381                         }
382
383                         bt3c_io_write(iobase, 0x7001, 0x0000);
384
385                         outb(iir, iobase + CONTROL);
386                 }
387         }
388
389         spin_unlock(&(info->lock));
390
391         return IRQ_HANDLED;
392 }
393
394
395
396 /* ======================== HCI interface ======================== */
397
398
399 static int bt3c_hci_flush(struct hci_dev *hdev)
400 {
401         bt3c_info_t *info = (bt3c_info_t *)(hdev->driver_data);
402
403         /* Drop TX queue */
404         skb_queue_purge(&(info->txq));
405
406         return 0;
407 }
408
409
410 static int bt3c_hci_open(struct hci_dev *hdev)
411 {
412         set_bit(HCI_RUNNING, &(hdev->flags));
413
414         return 0;
415 }
416
417
418 static int bt3c_hci_close(struct hci_dev *hdev)
419 {
420         if (!test_and_clear_bit(HCI_RUNNING, &(hdev->flags)))
421                 return 0;
422
423         bt3c_hci_flush(hdev);
424
425         return 0;
426 }
427
428
429 static int bt3c_hci_send_frame(struct sk_buff *skb)
430 {
431         bt3c_info_t *info;
432         struct hci_dev *hdev = (struct hci_dev *)(skb->dev);
433         unsigned long flags;
434
435         if (!hdev) {
436                 BT_ERR("Frame for unknown HCI device (hdev=NULL)");
437                 return -ENODEV;
438         }
439
440         info = (bt3c_info_t *) (hdev->driver_data);
441
442         switch (bt_cb(skb)->pkt_type) {
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 */
455         memcpy(skb_push(skb, 1), &bt_cb(skb)->pkt_type, 1);
456         skb_queue_tail(&(info->txq), skb);
457
458         spin_lock_irqsave(&(info->lock), flags);
459
460         bt3c_write_wakeup(info);
461
462         spin_unlock_irqrestore(&(info->lock), flags);
463
464         return 0;
465 }
466
467
468 static void bt3c_hci_destruct(struct hci_dev *hdev)
469 {
470 }
471
472
473 static int bt3c_hci_ioctl(struct hci_dev *hdev, unsigned int cmd, unsigned long arg)
474 {
475         return -ENOIOCTLCMD;
476 }
477
478
479
480 /* ======================== Card services HCI interaction ======================== */
481
482
483 static struct device *bt3c_device(void)
484 {
485         static struct device dev = {
486                 .bus_id = "pcmcia",
487         };
488         kobject_set_name(&dev.kobj, "bt3c");
489         kobject_init(&dev.kobj);
490
491         return &dev;
492 }
493
494
495 static int bt3c_load_firmware(bt3c_info_t *info, unsigned char *firmware, int count)
496 {
497         char *ptr = (char *) firmware;
498         char b[9];
499         unsigned int iobase, size, addr, fcs, tmp;
500         int i, err = 0;
501
502         iobase = info->link.io.BasePort1;
503
504         /* Reset */
505         bt3c_io_write(iobase, 0x8040, 0x0404);
506         bt3c_io_write(iobase, 0x8040, 0x0400);
507
508         udelay(1);
509
510         bt3c_io_write(iobase, 0x8040, 0x0404);
511
512         udelay(17);
513
514         /* Load */
515         while (count) {
516                 if (ptr[0] != 'S') {
517                         BT_ERR("Bad address in firmware");
518                         err = -EFAULT;
519                         goto error;
520                 }
521
522                 memset(b, 0, sizeof(b));
523                 memcpy(b, ptr + 2, 2);
524                 size = simple_strtol(b, NULL, 16);
525
526                 memset(b, 0, sizeof(b));
527                 memcpy(b, ptr + 4, 8);
528                 addr = simple_strtol(b, NULL, 16);
529
530                 memset(b, 0, sizeof(b));
531                 memcpy(b, ptr + (size * 2) + 2, 2);
532                 fcs = simple_strtol(b, NULL, 16);
533
534                 memset(b, 0, sizeof(b));
535                 for (tmp = 0, i = 0; i < size; i++) {
536                         memcpy(b, ptr + (i * 2) + 2, 2);
537                         tmp += simple_strtol(b, NULL, 16);
538                 }
539
540                 if (((tmp + fcs) & 0xff) != 0xff) {
541                         BT_ERR("Checksum error in firmware");
542                         err = -EILSEQ;
543                         goto error;
544                 }
545
546                 if (ptr[1] == '3') {
547                         bt3c_address(iobase, addr);
548
549                         memset(b, 0, sizeof(b));
550                         for (i = 0; i < (size - 4) / 2; i++) {
551                                 memcpy(b, ptr + (i * 4) + 12, 4);
552                                 tmp = simple_strtol(b, NULL, 16);
553                                 bt3c_put(iobase, tmp);
554                         }
555                 }
556
557                 ptr   += (size * 2) + 6;
558                 count -= (size * 2) + 6;
559         }
560
561         udelay(17);
562
563         /* Boot */
564         bt3c_address(iobase, 0x3000);
565         outb(inb(iobase + CONTROL) | 0x40, iobase + CONTROL);
566
567 error:
568         udelay(17);
569
570         /* Clear */
571         bt3c_io_write(iobase, 0x7006, 0x0000);
572         bt3c_io_write(iobase, 0x7005, 0x0000);
573         bt3c_io_write(iobase, 0x7001, 0x0000);
574
575         return err;
576 }
577
578
579 static int bt3c_open(bt3c_info_t *info)
580 {
581         const struct firmware *firmware;
582         struct hci_dev *hdev;
583         int err;
584
585         spin_lock_init(&(info->lock));
586
587         skb_queue_head_init(&(info->txq));
588
589         info->rx_state = RECV_WAIT_PACKET_TYPE;
590         info->rx_count = 0;
591         info->rx_skb = NULL;
592
593         /* Initialize HCI device */
594         hdev = hci_alloc_dev();
595         if (!hdev) {
596                 BT_ERR("Can't allocate HCI device");
597                 return -ENOMEM;
598         }
599
600         info->hdev = hdev;
601
602         hdev->type = HCI_PCCARD;
603         hdev->driver_data = info;
604
605         hdev->open     = bt3c_hci_open;
606         hdev->close    = bt3c_hci_close;
607         hdev->flush    = bt3c_hci_flush;
608         hdev->send     = bt3c_hci_send_frame;
609         hdev->destruct = bt3c_hci_destruct;
610         hdev->ioctl    = bt3c_hci_ioctl;
611
612         hdev->owner = THIS_MODULE;
613
614         /* Load firmware */
615         err = request_firmware(&firmware, "BT3CPCC.bin", bt3c_device());
616         if (err < 0) {
617                 BT_ERR("Firmware request failed");
618                 goto error;
619         }
620
621         err = bt3c_load_firmware(info, firmware->data, firmware->size);
622
623         release_firmware(firmware);
624
625         if (err < 0) {
626                 BT_ERR("Firmware loading failed");
627                 goto error;
628         }
629
630         /* Timeout before it is safe to send the first HCI packet */
631         msleep(1000);
632
633         /* Register HCI device */
634         err = hci_register_dev(hdev);
635         if (err < 0) {
636                 BT_ERR("Can't register HCI device");
637                 goto error;
638         }
639
640         return 0;
641
642 error:
643         info->hdev = NULL;
644         hci_free_dev(hdev);
645         return err;
646 }
647
648
649 static int bt3c_close(bt3c_info_t *info)
650 {
651         struct hci_dev *hdev = info->hdev;
652
653         if (!hdev)
654                 return -ENODEV;
655
656         bt3c_hci_close(hdev);
657
658         if (hci_unregister_dev(hdev) < 0)
659                 BT_ERR("Can't unregister HCI device %s", hdev->name);
660
661         hci_free_dev(hdev);
662
663         return 0;
664 }
665
666 static dev_link_t *bt3c_attach(void)
667 {
668         bt3c_info_t *info;
669         client_reg_t client_reg;
670         dev_link_t *link;
671         int ret;
672
673         /* Create new info device */
674         info = kzalloc(sizeof(*info), GFP_KERNEL);
675         if (!info)
676                 return NULL;
677
678         link = &info->link;
679         link->priv = info;
680
681         link->io.Attributes1 = IO_DATA_PATH_WIDTH_8;
682         link->io.NumPorts1 = 8;
683         link->irq.Attributes = IRQ_TYPE_EXCLUSIVE | IRQ_HANDLE_PRESENT;
684         link->irq.IRQInfo1 = IRQ_LEVEL_ID;
685
686         link->irq.Handler = bt3c_interrupt;
687         link->irq.Instance = info;
688
689         link->conf.Attributes = CONF_ENABLE_IRQ;
690         link->conf.Vcc = 50;
691         link->conf.IntType = INT_MEMORY_AND_IO;
692
693         /* Register with Card Services */
694         link->next = dev_list;
695         dev_list = link;
696         client_reg.dev_info = &dev_info;
697         client_reg.Version = 0x0210;
698         client_reg.event_callback_args.client_data = link;
699
700         ret = pcmcia_register_client(&link->handle, &client_reg);
701         if (ret != CS_SUCCESS) {
702                 cs_error(link->handle, RegisterClient, ret);
703                 bt3c_detach(link);
704                 return NULL;
705         }
706
707         return link;
708 }
709
710
711 static void bt3c_detach(dev_link_t *link)
712 {
713         bt3c_info_t *info = link->priv;
714         dev_link_t **linkp;
715         int ret;
716
717         /* Locate device structure */
718         for (linkp = &dev_list; *linkp; linkp = &(*linkp)->next)
719                 if (*linkp == link)
720                         break;
721
722         if (*linkp == NULL)
723                 return;
724
725         if (link->state & DEV_CONFIG)
726                 bt3c_release(link);
727
728         if (link->handle) {
729                 ret = pcmcia_deregister_client(link->handle);
730                 if (ret != CS_SUCCESS)
731                         cs_error(link->handle, DeregisterClient, ret);
732         }
733
734         /* Unlink device structure, free bits */
735         *linkp = link->next;
736
737         kfree(info);
738 }
739
740 static int get_tuple(client_handle_t handle, tuple_t *tuple, cisparse_t *parse)
741 {
742         int i;
743
744         i = pcmcia_get_tuple_data(handle, tuple);
745         if (i != CS_SUCCESS)
746                 return i;
747
748         return pcmcia_parse_tuple(handle, tuple, parse);
749 }
750
751 static int first_tuple(client_handle_t handle, tuple_t *tuple, cisparse_t *parse)
752 {
753         if (pcmcia_get_first_tuple(handle, tuple) != CS_SUCCESS)
754                 return CS_NO_MORE_ITEMS;
755         return get_tuple(handle, tuple, parse);
756 }
757
758 static int next_tuple(client_handle_t handle, tuple_t *tuple, cisparse_t *parse)
759 {
760         if (pcmcia_get_next_tuple(handle, tuple) != CS_SUCCESS)
761                 return CS_NO_MORE_ITEMS;
762         return get_tuple(handle, tuple, parse);
763 }
764
765 static void bt3c_config(dev_link_t *link)
766 {
767         static kio_addr_t base[5] = { 0x3f8, 0x2f8, 0x3e8, 0x2e8, 0x0 };
768         client_handle_t handle = link->handle;
769         bt3c_info_t *info = link->priv;
770         tuple_t tuple;
771         u_short buf[256];
772         cisparse_t parse;
773         cistpl_cftable_entry_t *cf = &parse.cftable_entry;
774         config_info_t config;
775         int i, j, try, last_ret, last_fn;
776
777         tuple.TupleData = (cisdata_t *)buf;
778         tuple.TupleOffset = 0;
779         tuple.TupleDataMax = 255;
780         tuple.Attributes = 0;
781
782         /* Get configuration register information */
783         tuple.DesiredTuple = CISTPL_CONFIG;
784         last_ret = first_tuple(handle, &tuple, &parse);
785         if (last_ret != CS_SUCCESS) {
786                 last_fn = ParseTuple;
787                 goto cs_failed;
788         }
789         link->conf.ConfigBase = parse.config.base;
790         link->conf.Present = parse.config.rmask[0];
791
792         /* Configure card */
793         link->state |= DEV_CONFIG;
794         i = pcmcia_get_configuration_info(handle, &config);
795         link->conf.Vcc = config.Vcc;
796
797         /* First pass: look for a config entry that looks normal. */
798         tuple.TupleData = (cisdata_t *)buf;
799         tuple.TupleOffset = 0;
800         tuple.TupleDataMax = 255;
801         tuple.Attributes = 0;
802         tuple.DesiredTuple = CISTPL_CFTABLE_ENTRY;
803         /* Two tries: without IO aliases, then with aliases */
804         for (try = 0; try < 2; try++) {
805                 i = first_tuple(handle, &tuple, &parse);
806                 while (i != CS_NO_MORE_ITEMS) {
807                         if (i != CS_SUCCESS)
808                                 goto next_entry;
809                         if (cf->vpp1.present & (1 << CISTPL_POWER_VNOM))
810                                 link->conf.Vpp1 = link->conf.Vpp2 = cf->vpp1.param[CISTPL_POWER_VNOM] / 10000;
811                         if ((cf->io.nwin > 0) && (cf->io.win[0].len == 8) && (cf->io.win[0].base != 0)) {
812                                 link->conf.ConfigIndex = cf->index;
813                                 link->io.BasePort1 = cf->io.win[0].base;
814                                 link->io.IOAddrLines = (try == 0) ? 16 : cf->io.flags & CISTPL_IO_LINES_MASK;
815                                 i = pcmcia_request_io(link->handle, &link->io);
816                                 if (i == CS_SUCCESS)
817                                         goto found_port;
818                         }
819 next_entry:
820                         i = next_tuple(handle, &tuple, &parse);
821                 }
822         }
823
824         /* Second pass: try to find an entry that isn't picky about
825            its base address, then try to grab any standard serial port
826            address, and finally try to get any free port. */
827         i = first_tuple(handle, &tuple, &parse);
828         while (i != CS_NO_MORE_ITEMS) {
829                 if ((i == CS_SUCCESS) && (cf->io.nwin > 0) && ((cf->io.flags & CISTPL_IO_LINES_MASK) <= 3)) {
830                         link->conf.ConfigIndex = cf->index;
831                         for (j = 0; j < 5; j++) {
832                                 link->io.BasePort1 = base[j];
833                                 link->io.IOAddrLines = base[j] ? 16 : 3;
834                                 i = pcmcia_request_io(link->handle, &link->io);
835                                 if (i == CS_SUCCESS)
836                                         goto found_port;
837                         }
838                 }
839                 i = next_tuple(handle, &tuple, &parse);
840         }
841
842 found_port:
843         if (i != CS_SUCCESS) {
844                 BT_ERR("No usable port range found");
845                 cs_error(link->handle, RequestIO, i);
846                 goto failed;
847         }
848
849         i = pcmcia_request_irq(link->handle, &link->irq);
850         if (i != CS_SUCCESS) {
851                 cs_error(link->handle, RequestIRQ, i);
852                 link->irq.AssignedIRQ = 0;
853         }
854
855         i = pcmcia_request_configuration(link->handle, &link->conf);
856         if (i != CS_SUCCESS) {
857                 cs_error(link->handle, RequestConfiguration, i);
858                 goto failed;
859         }
860
861         if (bt3c_open(info) != 0)
862                 goto failed;
863
864         strcpy(info->node.dev_name, info->hdev->name);
865         link->dev = &info->node;
866         link->state &= ~DEV_CONFIG_PENDING;
867
868         return;
869
870 cs_failed:
871         cs_error(link->handle, last_fn, last_ret);
872
873 failed:
874         bt3c_release(link);
875 }
876
877
878 static void bt3c_release(dev_link_t *link)
879 {
880         bt3c_info_t *info = link->priv;
881
882         if (link->state & DEV_PRESENT)
883                 bt3c_close(info);
884
885         link->dev = NULL;
886
887         pcmcia_release_configuration(link->handle);
888         pcmcia_release_io(link->handle, &link->io);
889         pcmcia_release_irq(link->handle, &link->irq);
890
891         link->state &= ~DEV_CONFIG;
892 }
893
894
895 static int bt3c_event(event_t event, int priority, event_callback_args_t *args)
896 {
897         dev_link_t *link = args->client_data;
898         bt3c_info_t *info = link->priv;
899
900         switch (event) {
901         case CS_EVENT_CARD_REMOVAL:
902                 link->state &= ~DEV_PRESENT;
903                 if (link->state & DEV_CONFIG) {
904                         bt3c_close(info);
905                         bt3c_release(link);
906                 }
907                 break;
908         case CS_EVENT_CARD_INSERTION:
909                 link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
910                 bt3c_config(link);
911                 break;
912         case CS_EVENT_PM_SUSPEND:
913                 link->state |= DEV_SUSPEND;
914                 /* Fall through... */
915         case CS_EVENT_RESET_PHYSICAL:
916                 if (link->state & DEV_CONFIG)
917                         pcmcia_release_configuration(link->handle);
918                 break;
919         case CS_EVENT_PM_RESUME:
920                 link->state &= ~DEV_SUSPEND;
921                 /* Fall through... */
922         case CS_EVENT_CARD_RESET:
923                 if (DEV_OK(link))
924                         pcmcia_request_configuration(link->handle, &link->conf);
925                 break;
926         }
927
928         return 0;
929 }
930
931 static struct pcmcia_device_id bt3c_ids[] = {
932         PCMCIA_DEVICE_PROD_ID13("3COM", "Bluetooth PC Card", 0xefce0a31, 0xd4ce9b02),
933         PCMCIA_DEVICE_NULL
934 };
935 MODULE_DEVICE_TABLE(pcmcia, bt3c_ids);
936
937 static struct pcmcia_driver bt3c_driver = {
938         .owner          = THIS_MODULE,
939         .drv            = {
940                 .name   = "bt3c_cs",
941         },
942         .attach         = bt3c_attach,
943         .event          = bt3c_event,
944         .detach         = bt3c_detach,
945         .id_table       = bt3c_ids,
946 };
947
948 static int __init init_bt3c_cs(void)
949 {
950         return pcmcia_register_driver(&bt3c_driver);
951 }
952
953
954 static void __exit exit_bt3c_cs(void)
955 {
956         pcmcia_unregister_driver(&bt3c_driver);
957         BUG_ON(dev_list != NULL);
958 }
959
960 module_init(init_bt3c_cs);
961 module_exit(exit_bt3c_cs);