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 }
 109
 110 /*
 111  *  PnP Quirks
 112  *  Cards or devices that need some tweaking due to incomplete resource info
 113  */
 114
 115 static struct pnp_fixup pnp_fixups[] = {
 116         /* Soundblaster awe io port quirk */
 117         {"CTL0021", quirk_awe32_resources},
 118         {"CTL0022", quirk_awe32_resources},
 119         {"CTL0023", quirk_awe32_resources},
 120         /* CMI 8330 interrupt and dma fix */
 121         {"@X@0001", quirk_cmi8330_resources},
 122         /* Soundblaster audio device io port range quirk */
 123         {"CTL0001", quirk_sb16audio_resources},
 124         {"CTL0031", quirk_sb16audio_resources},
 125         {"CTL0041", quirk_sb16audio_resources},
 126         {"CTL0042", quirk_sb16audio_resources},
 127         {"CTL0043", quirk_sb16audio_resources},
 128         {"CTL0044", quirk_sb16audio_resources},
 129         {"CTL0045", quirk_sb16audio_resources},
 130         {""}
 131 };
 132
 133 void pnp_fixup_device(struct pnp_dev *dev)
 134 {
 135         int i = 0;
 136
 137         while (*pnp_fixups[i].id) {
 138                 if (compare_pnp_id(dev->id, pnp_fixups[i].id)) {
 139                         pnp_dbg("Calling quirk for %s", dev->dev.bus_id);
 140                         pnp_fixups[i].quirk_function(dev);
 141                 }
 142                 i++;
 143         }
 144 }