SAFE public projects git trees. - safe/jmp/linux-2.6/blob - 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 #include <linux/pci.h>
 113
 114 static void quirk_system_pci_resources(struct pnp_dev *dev)
 115 {
 116         struct pci_dev *pdev = NULL;
 117         resource_size_t pnp_start, pnp_end, pci_start, pci_end;
 118         int i, j;
 119
 120         /*
 121          * Some BIOSes have PNP motherboard devices with resources that
 122          * partially overlap PCI BARs.  The PNP system driver claims these
 123          * motherboard resources, which prevents the normal PCI driver from
 124          * requesting them later.
 125          *
 126          * This patch disables the PNP resources that conflict with PCI BARs
 127          * so they won't be claimed by the PNP system driver.
 128          */
 129         for_each_pci_dev(pdev) {
 130                 for (i = 0; i < DEVICE_COUNT_RESOURCE; i++) {
 131                         if (!(pci_resource_flags(pdev, i) & IORESOURCE_MEM) ||
 132                             pci_resource_len(pdev, i) == 0)
 133                                 continue;
 134
 135                         pci_start = pci_resource_start(pdev, i);
 136                         pci_end = pci_resource_end(pdev, i);
 137                         for (j = 0; j < PNP_MAX_MEM; j++) {
 138                                 if (!pnp_mem_valid(dev, j) ||
 139                                     pnp_mem_len(dev, j) == 0)
 140                                         continue;
 141
 142                                 pnp_start = pnp_mem_start(dev, j);
 143                                 pnp_end = pnp_mem_end(dev, j);
 144
 145                                 /*
 146                                  * If the PNP region doesn't overlap the PCI
 147                                  * region at all, there's no problem.
 148                                  */
 149                                 if (pnp_end < pci_start || pnp_start > pci_end)
 150                                         continue;
 151
 152                                 /*
 153                                  * If the PNP region completely encloses (or is
 154                                  * at least as large as) the PCI region, that's
 155                                  * also OK.  For example, this happens when the
 156                                  * PNP device describes a bridge with PCI
 157                                  * behind it.
 158                                  */
 159                                 if (pnp_start <= pci_start &&
 160                                     pnp_end >= pci_end)
 161                                         continue;
 162
 163                                 /*
 164                                  * Otherwise, the PNP region overlaps *part* of
 165                                  * the PCI region, and that might prevent a PCI
 166                                  * driver from requesting its resources.
 167                                  */
 168                                 dev_warn(&dev->dev, "mem resource "
 169                                         "(0x%llx-0x%llx) overlaps %s BAR %d "
 170                                         "(0x%llx-0x%llx), disabling\n",
 171                                         (unsigned long long) pnp_start,
 172                                         (unsigned long long) pnp_end,
 173                                         pci_name(pdev), i,
 174                                         (unsigned long long) pci_start,
 175                                         (unsigned long long) pci_end);
 176                                 pnp_mem_flags(dev, j) = 0;
 177                         }
 178                 }
 179         }
 180 }
 181
 182 /*
 183  *  PnP Quirks
 184  *  Cards or devices that need some tweaking due to incomplete resource info
 185  */
 186
 187 static struct pnp_fixup pnp_fixups[] = {
 188         /* Soundblaster awe io port quirk */
 189         {"CTL0021", quirk_awe32_resources},
 190         {"CTL0022", quirk_awe32_resources},
 191         {"CTL0023", quirk_awe32_resources},
 192         /* CMI 8330 interrupt and dma fix */
 193         {"@X@0001", quirk_cmi8330_resources},
 194         /* Soundblaster audio device io port range quirk */
 195         {"CTL0001", quirk_sb16audio_resources},
 196         {"CTL0031", quirk_sb16audio_resources},
 197         {"CTL0041", quirk_sb16audio_resources},
 198         {"CTL0042", quirk_sb16audio_resources},
 199         {"CTL0043", quirk_sb16audio_resources},
 200         {"CTL0044", quirk_sb16audio_resources},
 201         {"CTL0045", quirk_sb16audio_resources},
 202         {"PNP0c01", quirk_system_pci_resources},
 203         {"PNP0c02", quirk_system_pci_resources},
 204         {""}
 205 };
 206
 207 void pnp_fixup_device(struct pnp_dev *dev)
 208 {
 209         int i = 0;
 210         void (*quirk)(struct pnp_dev *);
 211
 212         while (*pnp_fixups[i].id) {
 213                 if (compare_pnp_id(dev->id, pnp_fixups[i].id)) {
 214                         quirk = pnp_fixups[i].quirk_function;
 215
 216 #ifdef DEBUG
 217                         dev_dbg(&dev->dev, "calling ");
 218                         print_fn_descriptor_symbol("%s()\n",
 219                                 (unsigned long) *quirk);
 220 #endif
 221                         (*quirk)(dev);
 222                 }
 223                 i++;
 224         }
 225 }