PNP: Lindent all source files
[linux-2.6.git] / 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 "base.h"
21
22 static void quirk_awe32_resources(struct pnp_dev *dev)
23 {
24         struct pnp_port *port, *port2, *port3;
25         struct pnp_option *res = dev->dependent;
26
27         /*
28          * Unfortunately the isapnp_add_port_resource is too tightly bound
29          * into the PnP discovery sequence, and cannot be used. Link in the
30          * two extra ports (at offset 0x400 and 0x800 from the one given) by
31          * hand.
32          */
33         for (; res; res = res->next) {
34                 port2 = pnp_alloc(sizeof(struct pnp_port));
35                 if (!port2)
36                         return;
37                 port3 = pnp_alloc(sizeof(struct pnp_port));
38                 if (!port3) {
39                         kfree(port2);
40                         return;
41                 }
42                 port = res->port;
43                 memcpy(port2, port, sizeof(struct pnp_port));
44                 memcpy(port3, port, sizeof(struct pnp_port));
45                 port->next = port2;
46                 port2->next = port3;
47                 port2->min += 0x400;
48                 port2->max += 0x400;
49                 port3->min += 0x800;
50                 port3->max += 0x800;
51         }
52         printk(KERN_INFO "pnp: AWE32 quirk - adding two ports\n");
53 }
54
55 static void quirk_cmi8330_resources(struct pnp_dev *dev)
56 {
57         struct pnp_option *res = dev->dependent;
58         unsigned long tmp;
59
60         for (; res; res = res->next) {
61
62                 struct pnp_irq *irq;
63                 struct pnp_dma *dma;
64
65                 for (irq = res->irq; irq; irq = irq->next) {    // Valid irqs are 5, 7, 10
66                         tmp = 0x04A0;
67                         bitmap_copy(irq->map, &tmp, 16);        // 0000 0100 1010 0000
68                 }
69
70                 for (dma = res->dma; dma; dma = dma->next)      // Valid 8bit dma channels are 1,3
71                         if ((dma->flags & IORESOURCE_DMA_TYPE_MASK) ==
72                             IORESOURCE_DMA_8BIT)
73                                 dma->map = 0x000A;
74         }
75         printk(KERN_INFO "pnp: CMI8330 quirk - fixing interrupts and dma\n");
76 }
77
78 static void quirk_sb16audio_resources(struct pnp_dev *dev)
79 {
80         struct pnp_port *port;
81         struct pnp_option *res = dev->dependent;
82         int changed = 0;
83
84         /*
85          * The default range on the mpu port for these devices is 0x388-0x388.
86          * Here we increase that range so that two such cards can be
87          * auto-configured.
88          */
89
90         for (; res; res = res->next) {
91                 port = res->port;
92                 if (!port)
93                         continue;
94                 port = port->next;
95                 if (!port)
96                         continue;
97                 port = port->next;
98                 if (!port)
99                         continue;
100                 if (port->min != port->max)
101                         continue;
102                 port->max += 0x70;
103                 changed = 1;
104         }
105         if (changed)
106                 printk(KERN_INFO
107                        "pnp: SB audio device quirk - increasing port range\n");
108         return;
109 }
110
111 static int quirk_smc_fir_enabled(struct pnp_dev *dev)
112 {
113         unsigned long firbase;
114         u8 bank, high, low, chip;
115
116         if (!pnp_port_valid(dev, 1))
117                 return 0;
118
119         firbase = pnp_port_start(dev, 1);
120
121         /* Select register bank 3 */
122         bank = inb(firbase + 7);
123         bank &= 0xf0;
124         bank |= 3;
125         outb(bank, firbase + 7);
126
127         high = inb(firbase + 0);
128         low = inb(firbase + 1);
129         chip = inb(firbase + 2);
130
131         /* This corresponds to the check in smsc_ircc_present() */
132         if (high == 0x10 && low == 0xb8 && (chip == 0xf1 || chip == 0xf2))
133                 return 1;
134
135         return 0;
136 }
137
138 static void quirk_smc_enable(struct pnp_dev *dev)
139 {
140         struct resource fir, sir, irq;
141
142         pnp_activate_dev(dev);
143         if (quirk_smc_fir_enabled(dev))
144                 return;
145
146         /*
147          * Sometimes the BIOS claims the device is enabled, but it reports
148          * the wrong FIR resources or doesn't properly configure ISA or LPC
149          * bridges on the way to the device.
150          *
151          * HP nc6000 and nc8000/nw8000 laptops have known problems like
152          * this.  Fortunately, they do fix things up if we auto-configure
153          * the device using its _PRS and _SRS methods.
154          */
155         dev_err(&dev->dev, "%s not responding at SIR 0x%lx, FIR 0x%lx; "
156                 "auto-configuring\n", dev->id->id,
157                 (unsigned long)pnp_port_start(dev, 0),
158                 (unsigned long)pnp_port_start(dev, 1));
159
160         pnp_disable_dev(dev);
161         pnp_init_resource_table(&dev->res);
162         pnp_auto_config_dev(dev);
163         pnp_activate_dev(dev);
164         if (quirk_smc_fir_enabled(dev)) {
165                 dev_err(&dev->dev, "responds at SIR 0x%lx, FIR 0x%lx\n",
166                         (unsigned long)pnp_port_start(dev, 0),
167                         (unsigned long)pnp_port_start(dev, 1));
168                 return;
169         }
170
171         /*
172          * The Toshiba Portege 4000 _CRS reports the FIR region first,
173          * followed by the SIR region.  The BIOS will configure the bridge,
174          * but only if we call _SRS with SIR first, then FIR.  It also
175          * reports the IRQ as active high, when it is really active low.
176          */
177         dev_err(&dev->dev, "not responding at SIR 0x%lx, FIR 0x%lx; "
178                 "swapping SIR/FIR and reconfiguring\n",
179                 (unsigned long)pnp_port_start(dev, 0),
180                 (unsigned long)pnp_port_start(dev, 1));
181
182         /*
183          * Clear IORESOURCE_AUTO so pnp_activate_dev() doesn't reassign
184          * these resources any more.
185          */
186         fir = dev->res.port_resource[0];
187         sir = dev->res.port_resource[1];
188         fir.flags &= ~IORESOURCE_AUTO;
189         sir.flags &= ~IORESOURCE_AUTO;
190
191         irq = dev->res.irq_resource[0];
192         irq.flags &= ~IORESOURCE_AUTO;
193         irq.flags &= ~IORESOURCE_BITS;
194         irq.flags |= IORESOURCE_IRQ_LOWEDGE;
195
196         pnp_disable_dev(dev);
197         dev->res.port_resource[0] = sir;
198         dev->res.port_resource[1] = fir;
199         dev->res.irq_resource[0] = irq;
200         pnp_activate_dev(dev);
201
202         if (quirk_smc_fir_enabled(dev)) {
203                 dev_err(&dev->dev, "responds at SIR 0x%lx, FIR 0x%lx\n",
204                         (unsigned long)pnp_port_start(dev, 0),
205                         (unsigned long)pnp_port_start(dev, 1));
206                 return;
207         }
208
209         dev_err(&dev->dev, "giving up; try \"smsc-ircc2.nopnp\" and "
210                 "email bjorn.helgaas@hp.com\n");
211 }
212
213 /*
214  *  PnP Quirks
215  *  Cards or devices that need some tweaking due to incomplete resource info
216  */
217
218 static struct pnp_fixup pnp_fixups[] = {
219         /* Soundblaster awe io port quirk */
220         {"CTL0021", quirk_awe32_resources},
221         {"CTL0022", quirk_awe32_resources},
222         {"CTL0023", quirk_awe32_resources},
223         /* CMI 8330 interrupt and dma fix */
224         {"@X@0001", quirk_cmi8330_resources},
225         /* Soundblaster audio device io port range quirk */
226         {"CTL0001", quirk_sb16audio_resources},
227         {"CTL0031", quirk_sb16audio_resources},
228         {"CTL0041", quirk_sb16audio_resources},
229         {"CTL0042", quirk_sb16audio_resources},
230         {"CTL0043", quirk_sb16audio_resources},
231         {"CTL0044", quirk_sb16audio_resources},
232         {"CTL0045", quirk_sb16audio_resources},
233         {"SMCf010", quirk_smc_enable},
234         {""}
235 };
236
237 void pnp_fixup_device(struct pnp_dev *dev)
238 {
239         int i = 0;
240
241         while (*pnp_fixups[i].id) {
242                 if (compare_pnp_id(dev->id, pnp_fixups[i].id)) {
243                         pnp_dbg("Calling quirk for %s", dev->dev.bus_id);
244                         pnp_fixups[i].quirk_function(dev);
245                 }
246                 i++;
247         }
248 }