sys/dev/sound/isa/i386/sound_pnp.c

   1 /*
   2  * sound/sound_pnp.c
   3  *
   4  * PnP soundcard support (Linux spesific)
   5  *
   6  * Copyright by Hannu Savolainen 1995
   7  *
   8  * Redistribution and use in source and binary forms, with or without
   9  * modification, are permitted provided that the following conditions are
  10  * met: 1. Redistributions of source code must retain the above copyright
  11  * notice, this list of conditions and the following disclaimer. 2.
  12  * Redistributions in binary form must reproduce the above copyright notice,
  13  * this list of conditions and the following disclaimer in the documentation
  14  * and/or other materials provided with the distribution.
  15  *
  16  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND ANY
  17  * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
  18  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
  19  * DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
  20  * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  21  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
  22  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
  23  * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  24  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  25  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  26  * SUCH DAMAGE.
  27  *
  28  */
  29 #include <i386/isa/sound/sound_config.h>
  30
  31 /*
  32  * XXX check what to use in place of CONFIG_PNP
  33  */
  34 #if (NSND > 0) && defined(CONFIG_PNP)
  35
  36 #include <linux/pnp.h>
  37
  38 static struct pnp_sounddev *pnp_devs[20] = { NULL };
  39
  40 static int      max_pnpdevs = 20;
  41 static int      nr_pnpdevs = 0;
  42 static int      pnp_sig = 0;
  43
  44 void
  45 install_pnp_sounddrv(struct pnp_sounddev * drv)
  46 {
  47     if (nr_pnpdevs < max_pnpdevs) {
  48         pnp_devs[nr_pnpdevs++] = drv;
  49     } else
  50         printf("Sound: More than 20 PnP drivers defined\n");
  51 }
  52
  53 void
  54 cs4232_pnp(void *parm)
  55 {
  56     struct pnp_dev *dev = (struct pnp_dev *) parm;
  57     char           *name;
  58
  59     int             portmask = 0x00, irqmask = 0x01, dmamask = 0x03;
  60     int             opl3_driver, wss_driver;
  61
  62     printf("CS4232 driver waking up\n");
  63
  64     if (dev->card && dev->card->name)
  65         name = dev->card->name;
  66     else
  67         name = "PnP WSS";
  68
  69     if ((wss_driver = sndtable_identify_card("AD1848")))
  70         portmask |= 0x01;       /* MSS */
  71     else
  72         printf("Sound: MSS/WSS device detected but no driver enabled\n");
  73
  74     if ((opl3_driver = sndtable_identify_card("OPL3")))
  75         portmask |= 0x02;       /* OPL3 */
  76     else
  77         printf("Sound: OPL3/4 device detected but no driver enabled\n");
  78
  79     printf("WSS driver %d, OPL3 driver %d\n", wss_driver, opl3_driver);
  80
  81     if (!portmask)              /* No drivers available */
  82         return;
  83
  84     if (!pnp_allocate_device(pnp_sig, dev, portmask, irqmask, dmamask, 0x00))
  85         printf("Device activation failed\n");
  86     else {
  87         struct address_info hw_config;
  88         int             wss_base, opl3_base;
  89         int             irq;
  90         int             dma1, dma2;
  91
  92         printf("Device activation OK\n");
  93         wss_base = pnp_get_port(dev, 0);
  94         opl3_base = pnp_get_port(dev, 1);
  95         irq = pnp_get_irq(dev, 0);
  96         dma1 = pnp_get_dma(dev, 0);
  97         dma2 = pnp_get_dma(dev, 1);
  98
  99         printf("I/O0 %03x\n", wss_base);
 100         printf("I/O1 %03x\n", opl3_base);
 101         printf("IRQ %d\n", irq);
 102         printf("DMA0 %d\n", dma1);
 103         printf("DMA1 %d\n", dma2);
 104
 105         if (opl3_base && opl3_driver) {
 106             hw_config.io_base = opl3_base;
 107             hw_config.irq = 0;
 108             hw_config.dma = -1;
 109             hw_config.dma2 = -1;
 110             hw_config.always_detect = 0;
 111             hw_config.name = "";
 112             hw_config.osp = NULL;
 113             hw_config.card_subtype = 0;
 114
 115             if (sndtable_probe(opl3_driver, &hw_config))
 116                 sndtable_init_card(opl3_driver, &hw_config);
 117
 118         }
 119         if (wss_base && wss_driver) {
 120             hw_config.io_base = wss_base;
 121             hw_config.irq = irq;
 122             hw_config.dma = dma1;
 123             hw_config.dma2 = (dma2 == NO_DMA) ? dma1 : dma2;
 124             hw_config.always_detect = 0;
 125             hw_config.name = name;
 126             hw_config.osp = NULL;
 127             hw_config.card_subtype = 0;
 128
 129             if (sndtable_probe(wss_driver, &hw_config))
 130                 sndtable_init_card(wss_driver, &hw_config);
 131
 132         }
 133     }
 134 }
 135
 136 static int
 137 pnp_activate(int id, struct pnp_dev * dev)
 138 {
 139     int             i;
 140
 141     for (i = 0; i < nr_pnpdevs; i++)
 142         if (pnp_devs[i]->id == id) {
 143
 144             printf("PnP dev: %08x, %s\n", id, pnp_devid2asc(id));
 145
 146             pnp_devs[i]->setup((void *) dev);
 147             return 1;
 148         }
 149     return 0;
 150 }
 151
 152 void
 153 sound_pnp_init(void)
 154 {
 155     static struct pnp_sounddev cs4232_dev =
 156         {PNP_DEVID('C', 'S', 'C', 0x0000), cs4232_pnp, "CS4232"};
 157
 158     struct pnp_dev *dev;
 159
 160     install_pnp_sounddrv(&cs4232_dev);
 161
 162     dev = NULL;
 163
 164     if ((pnp_sig = pnp_connect("sound")) == -1) {
 165         printf("Sound: Can't connect to kernel PnP services.\n");
 166         return;
 167     }
 168     while ((dev = pnp_get_next_device(pnp_sig, dev)) != NULL) {
 169         if (!pnp_activate(dev->key, dev)) {
 170             /* Scan all compatible devices */
 171
 172             int             i;
 173
 174             for (i = 0; i < dev->ncompat; i++)
 175                 if (pnp_activate(dev->compat_keys[i], dev))
 176                     break;
 177         }
 178     }
 179 }
 180
 181 void
 182 sound_pnp_disconnect(void)
 183 {
 184     pnp_disconnect(pnp_sig);
 185 }
 186 #endif