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 } 153