diff options
Diffstat (limited to 'drivers/pnp/quirks.c')
-rw-r--r-- | drivers/pnp/quirks.c | 152 |
1 files changed, 152 insertions, 0 deletions
diff --git a/drivers/pnp/quirks.c b/drivers/pnp/quirks.c new file mode 100644 index 000000000000..596a02d7e03d --- /dev/null +++ b/drivers/pnp/quirks.c | |||
@@ -0,0 +1,152 @@ | |||
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/config.h> | ||
15 | #include <linux/types.h> | ||
16 | #include <linux/kernel.h> | ||
17 | #include <linux/string.h> | ||
18 | #include <linux/slab.h> | ||
19 | |||
20 | #ifdef CONFIG_PNP_DEBUG | ||
21 | #define DEBUG | ||
22 | #else | ||
23 | #undef DEBUG | ||
24 | #endif | ||
25 | |||
26 | #include <linux/pnp.h> | ||
27 | #include "base.h" | ||
28 | |||
29 | |||
30 | static void quirk_awe32_resources(struct pnp_dev *dev) | ||
31 | { | ||
32 | struct pnp_port *port, *port2, *port3; | ||
33 | struct pnp_option *res = dev->dependent; | ||
34 | |||
35 | /* | ||
36 | * Unfortunately the isapnp_add_port_resource is too tightly bound | ||
37 | * into the PnP discovery sequence, and cannot be used. Link in the | ||
38 | * two extra ports (at offset 0x400 and 0x800 from the one given) by | ||
39 | * hand. | ||
40 | */ | ||
41 | for ( ; res ; res = res->next ) { | ||
42 | port2 = pnp_alloc(sizeof(struct pnp_port)); | ||
43 | if (!port2) | ||
44 | return; | ||
45 | port3 = pnp_alloc(sizeof(struct pnp_port)); | ||
46 | if (!port3) { | ||
47 | kfree(port2); | ||
48 | return; | ||
49 | } | ||
50 | port = res->port; | ||
51 | memcpy(port2, port, sizeof(struct pnp_port)); | ||
52 | memcpy(port3, port, sizeof(struct pnp_port)); | ||
53 | port->next = port2; | ||
54 | port2->next = port3; | ||
55 | port2->min += 0x400; | ||
56 | port2->max += 0x400; | ||
57 | port3->min += 0x800; | ||
58 | port3->max += 0x800; | ||
59 | } | ||
60 | printk(KERN_INFO "pnp: AWE32 quirk - adding two ports\n"); | ||
61 | } | ||
62 | |||
63 | static void quirk_cmi8330_resources(struct pnp_dev *dev) | ||
64 | { | ||
65 | struct pnp_option *res = dev->dependent; | ||
66 | unsigned long tmp; | ||
67 | |||
68 | for ( ; res ; res = res->next ) { | ||
69 | |||
70 | struct pnp_irq *irq; | ||
71 | struct pnp_dma *dma; | ||
72 | |||
73 | for( irq = res->irq; irq; irq = irq->next ) { // Valid irqs are 5, 7, 10 | ||
74 | tmp = 0x04A0; | ||
75 | bitmap_copy(irq->map, &tmp, 16); // 0000 0100 1010 0000 | ||
76 | } | ||
77 | |||
78 | for( dma = res->dma; dma; dma = dma->next ) // Valid 8bit dma channels are 1,3 | ||
79 | if( ( dma->flags & IORESOURCE_DMA_TYPE_MASK ) == IORESOURCE_DMA_8BIT ) | ||
80 | dma->map = 0x000A; | ||
81 | } | ||
82 | printk(KERN_INFO "pnp: CMI8330 quirk - fixing interrupts and dma\n"); | ||
83 | } | ||
84 | |||
85 | static void quirk_sb16audio_resources(struct pnp_dev *dev) | ||
86 | { | ||
87 | struct pnp_port *port; | ||
88 | struct pnp_option *res = dev->dependent; | ||
89 | int changed = 0; | ||
90 | |||
91 | /* | ||
92 | * The default range on the mpu port for these devices is 0x388-0x388. | ||
93 | * Here we increase that range so that two such cards can be | ||
94 | * auto-configured. | ||
95 | */ | ||
96 | |||
97 | for( ; res ; res = res->next ) { | ||
98 | port = res->port; | ||
99 | if(!port) | ||
100 | continue; | ||
101 | port = port->next; | ||
102 | if(!port) | ||
103 | continue; | ||
104 | port = port->next; | ||
105 | if(!port) | ||
106 | continue; | ||
107 | if(port->min != port->max) | ||
108 | continue; | ||
109 | port->max += 0x70; | ||
110 | changed = 1; | ||
111 | } | ||
112 | if(changed) | ||
113 | printk(KERN_INFO "pnp: SB audio device quirk - increasing port range\n"); | ||
114 | return; | ||
115 | } | ||
116 | |||
117 | /* | ||
118 | * PnP Quirks | ||
119 | * Cards or devices that need some tweaking due to incomplete resource info | ||
120 | */ | ||
121 | |||
122 | static struct pnp_fixup pnp_fixups[] = { | ||
123 | /* Soundblaster awe io port quirk */ | ||
124 | { "CTL0021", quirk_awe32_resources }, | ||
125 | { "CTL0022", quirk_awe32_resources }, | ||
126 | { "CTL0023", quirk_awe32_resources }, | ||
127 | /* CMI 8330 interrupt and dma fix */ | ||
128 | { "@X@0001", quirk_cmi8330_resources }, | ||
129 | /* Soundblaster audio device io port range quirk */ | ||
130 | { "CTL0001", quirk_sb16audio_resources }, | ||
131 | { "CTL0031", quirk_sb16audio_resources }, | ||
132 | { "CTL0041", quirk_sb16audio_resources }, | ||
133 | { "CTL0042", quirk_sb16audio_resources }, | ||
134 | { "CTL0043", quirk_sb16audio_resources }, | ||
135 | { "CTL0044", quirk_sb16audio_resources }, | ||
136 | { "CTL0045", quirk_sb16audio_resources }, | ||
137 | { "" } | ||
138 | }; | ||
139 | |||
140 | void pnp_fixup_device(struct pnp_dev *dev) | ||
141 | { | ||
142 | int i = 0; | ||
143 | |||
144 | while (*pnp_fixups[i].id) { | ||
145 | if (compare_pnp_id(dev->id,pnp_fixups[i].id)) { | ||
146 | pnp_dbg("Calling quirk for %s", | ||
147 | dev->dev.bus_id); | ||
148 | pnp_fixups[i].quirk_function(dev); | ||
149 | } | ||
150 | i++; | ||
151 | } | ||
152 | } | ||