Merge git://git.kernel.org/pub/scm/linux/kernel/git/mingo/linux-2.6-sched
[linux-2.6] / drivers / pnp / quirks.c
1 /*
2  *  This file contains quirk handling code for PnP devices
3  *  Some devices do not report all their resources, and need to have extra
4  *  resources added. This is most easily accomplished at initialisation time
5  *  when building up the resource structure for the first time.
6  *
7  *  Copyright (c) 2000 Peter Denison <peterd@pnd-pc.demon.co.uk>
8  *
9  *  Heavily based on PCI quirks handling which is
10  *
11  *  Copyright (c) 1999 Martin Mares <mj@ucw.cz>
12  */
13
14 #include <linux/types.h>
15 #include <linux/kernel.h>
16 #include <linux/string.h>
17 #include <linux/slab.h>
18 #include <linux/pnp.h>
19 #include <linux/io.h>
20 #include <linux/kallsyms.h>
21 #include "base.h"
22
23 static void quirk_awe32_resources(struct pnp_dev *dev)
24 {
25         struct pnp_port *port, *port2, *port3;
26         struct pnp_option *res = dev->dependent;
27
28         /*
29          * Unfortunately the isapnp_add_port_resource is too tightly bound
30          * into the PnP discovery sequence, and cannot be used. Link in the
31          * two extra ports (at offset 0x400 and 0x800 from the one given) by
32          * hand.
33          */
34         for (; res; res = res->next) {
35                 port2 = pnp_alloc(sizeof(struct pnp_port));
36                 if (!port2)
37                         return;
38                 port3 = pnp_alloc(sizeof(struct pnp_port));
39                 if (!port3) {
40                         kfree(port2);
41                         return;
42                 }
43                 port = res->port;
44                 memcpy(port2, port, sizeof(struct pnp_port));
45                 memcpy(port3, port, sizeof(struct pnp_port));
46                 port->next = port2;
47                 port2->next = port3;
48                 port2->min += 0x400;
49                 port2->max += 0x400;
50                 port3->min += 0x800;
51                 port3->max += 0x800;
52         }
53         printk(KERN_INFO "pnp: AWE32 quirk - adding two ports\n");
54 }
55
56 static void quirk_cmi8330_resources(struct pnp_dev *dev)
57 {
58         struct pnp_option *res = dev->dependent;
59         unsigned long tmp;
60
61         for (; res; res = res->next) {
62
63                 struct pnp_irq *irq;
64                 struct pnp_dma *dma;
65
66                 for (irq = res->irq; irq; irq = irq->next) {    // Valid irqs are 5, 7, 10
67                         tmp = 0x04A0;
68                         bitmap_copy(irq->map, &tmp, 16);        // 0000 0100 1010 0000
69                 }
70
71                 for (dma = res->dma; dma; dma = dma->next)      // Valid 8bit dma channels are 1,3
72                         if ((dma->flags & IORESOURCE_DMA_TYPE_MASK) ==
73                             IORESOURCE_DMA_8BIT)
74                                 dma->map = 0x000A;
75         }
76         printk(KERN_INFO "pnp: CMI8330 quirk - fixing interrupts and dma\n");
77 }
78
79 static void quirk_sb16audio_resources(struct pnp_dev *dev)
80 {
81         struct pnp_port *port;
82         struct pnp_option *res = dev->dependent;
83         int changed = 0;
84
85         /*
86          * The default range on the mpu port for these devices is 0x388-0x388.
87          * Here we increase that range so that two such cards can be
88          * auto-configured.
89          */
90
91         for (; res; res = res->next) {
92                 port = res->port;
93                 if (!port)
94                         continue;
95                 port = port->next;
96                 if (!port)
97                         continue;
98                 port = port->next;
99                 if (!port)
100                         continue;
101                 if (port->min != port->max)
102                         continue;
103                 port->max += 0x70;
104                 changed = 1;
105         }
106         if (changed)
107                 printk(KERN_INFO
108                        "pnp: SB audio device quirk - increasing port range\n");
109 }
110
111 /*
112  *  PnP Quirks
113  *  Cards or devices that need some tweaking due to incomplete resource info
114  */
115
116 static struct pnp_fixup pnp_fixups[] = {
117         /* Soundblaster awe io port quirk */
118         {"CTL0021", quirk_awe32_resources},
119         {"CTL0022", quirk_awe32_resources},
120         {"CTL0023", quirk_awe32_resources},
121         /* CMI 8330 interrupt and dma fix */
122         {"@X@0001", quirk_cmi8330_resources},
123         /* Soundblaster audio device io port range quirk */
124         {"CTL0001", quirk_sb16audio_resources},
125         {"CTL0031", quirk_sb16audio_resources},
126         {"CTL0041", quirk_sb16audio_resources},
127         {"CTL0042", quirk_sb16audio_resources},
128         {"CTL0043", quirk_sb16audio_resources},
129         {"CTL0044", quirk_sb16audio_resources},
130         {"CTL0045", quirk_sb16audio_resources},
131         {""}
132 };
133
134 void pnp_fixup_device(struct pnp_dev *dev)
135 {
136         int i = 0;
137         void (*quirk)(struct pnp_dev *);
138
139         while (*pnp_fixups[i].id) {
140                 if (compare_pnp_id(dev->id, pnp_fixups[i].id)) {
141                         quirk = pnp_fixups[i].quirk_function;
142
143 #ifdef DEBUG
144                         dev_dbg(&dev->dev, "calling quirk 0x%p", quirk);
145                         print_fn_descriptor_symbol(": %s()\n",
146                                 (unsigned long) *quirk);
147 #endif
148                         (*quirk)(dev);
149                 }
150                 i++;
151         }
152 }