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