ALSA: es1688: add pedantic range checks
[safe/jmp/linux-2.6] / sound / isa / es1688 / es1688.c
index b0eb0cf..0cde813 100644 (file)
@@ -22,6 +22,7 @@
 #include <linux/init.h>
 #include <linux/err.h>
 #include <linux/isa.h>
+#include <linux/isapnp.h>
 #include <linux/time.h>
 #include <linux/wait.h>
 #include <linux/moduleparam.h>
@@ -45,8 +46,13 @@ MODULE_SUPPORTED_DEVICE("{{ESS,ES688 PnP AudioDrive,pnp:ESS0100},"
                "{ESS,ES688 AudioDrive,pnp:ESS6881},"
                "{ESS,ES1688 AudioDrive,pnp:ESS1681}}");
 
+MODULE_ALIAS("snd_es968");
+
 static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX;     /* Index 0-MAX */
 static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR;      /* ID for this card */
+#ifdef CONFIG_PNP
+static int isapnp[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_ISAPNP;
+#endif
 static int enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE; /* Enable this card */
 static long port[SNDRV_CARDS] = SNDRV_DEFAULT_PORT;    /* 0x220,0x240,0x260 */
 static long fm_port[SNDRV_CARDS] = SNDRV_DEFAULT_PORT; /* Usually 0x388 */
@@ -60,6 +66,10 @@ MODULE_PARM_DESC(index, "Index value for " CRD_NAME " soundcard.");
 module_param_array(id, charp, NULL, 0444);
 MODULE_PARM_DESC(id, "ID string for " CRD_NAME " soundcard.");
 module_param_array(enable, bool, NULL, 0444);
+#ifdef CONFIG_PNP
+module_param_array(isapnp, bool, NULL, 0444);
+MODULE_PARM_DESC(isapnp, "PnP detection for specified soundcard.");
+#endif
 MODULE_PARM_DESC(enable, "Enable " CRD_NAME " soundcard.");
 module_param_array(port, long, NULL, 0444);
 MODULE_PARM_DESC(port, "Port # for " CRD_NAME " driver.");
@@ -74,14 +84,21 @@ MODULE_PARM_DESC(mpu_irq, "MPU-401 IRQ # for " CRD_NAME " driver.");
 module_param_array(dma8, int, NULL, 0444);
 MODULE_PARM_DESC(dma8, "8-bit DMA # for " CRD_NAME " driver.");
 
+#ifdef CONFIG_PNP
+#define is_isapnp_selected(dev)                isapnp[dev]
+#else
+#define is_isapnp_selected(dev)                0
+#endif
+
 static int __devinit snd_es1688_match(struct device *dev, unsigned int n)
 {
-       return enable[n];
+       return enable[n] && !is_isapnp_selected(n);
 }
 
-static int __devinit snd_es1688_legacy_create(struct snd_card *card, 
-               struct device *dev, unsigned int n, struct snd_es1688 **rchip)
+static int __devinit snd_es1688_legacy_create(struct snd_card *card,
+                                       struct device *dev, unsigned int n)
 {
+       struct snd_es1688 *chip = card->private_data;
        static long possible_ports[] = {0x220, 0x240, 0x260};
        static int possible_irqs[] = {5, 9, 10, 7, -1};
        static int possible_dmas[] = {1, 3, 0, -1};
@@ -104,47 +121,39 @@ static int __devinit snd_es1688_legacy_create(struct snd_card *card,
        }
 
        if (port[n] != SNDRV_AUTO_PORT)
-               return snd_es1688_create(card, port[n], mpu_port[n], irq[n],
-                               mpu_irq[n], dma8[n], ES1688_HW_AUTO, rchip);
+               return snd_es1688_create(card, chip, port[n], mpu_port[n],
+                               irq[n], mpu_irq[n], dma8[n], ES1688_HW_AUTO);
 
        i = 0;
        do {
                port[n] = possible_ports[i];
-               error = snd_es1688_create(card, port[n], mpu_port[n], irq[n],
-                               mpu_irq[n], dma8[n], ES1688_HW_AUTO, rchip);
+               error = snd_es1688_create(card, chip, port[n], mpu_port[n],
+                               irq[n], mpu_irq[n], dma8[n], ES1688_HW_AUTO);
        } while (error < 0 && ++i < ARRAY_SIZE(possible_ports));
 
        return error;
 }
 
-static int __devinit snd_es1688_probe(struct device *dev, unsigned int n)
+static int __devinit snd_es1688_probe(struct snd_card *card, unsigned int n)
 {
-       struct snd_card *card;
-       struct snd_es1688 *chip;
+       struct snd_es1688 *chip = card->private_data;
        struct snd_opl3 *opl3;
        struct snd_pcm *pcm;
        int error;
 
-       card = snd_card_new(index[n], id[n], THIS_MODULE, 0);
-       if (!card)
-               return -EINVAL;
-
-       error = snd_es1688_legacy_create(card, dev, n, &chip);
+       error = snd_es1688_pcm(card, chip, 0, &pcm);
        if (error < 0)
-               goto out;
+               return error;
 
-       error = snd_es1688_pcm(chip, 0, &pcm);
+       error = snd_es1688_mixer(card, chip);
        if (error < 0)
-               goto out;
+               return error;
 
-       error = snd_es1688_mixer(chip);
-       if (error < 0)
-               goto out;
-
-       strcpy(card->driver, "ES1688");
-       strcpy(card->shortname, pcm->name);
-       sprintf(card->longname, "%s at 0x%lx, irq %i, dma %i", pcm->name,
-               chip->port, chip->irq, chip->dma8);
+       strlcpy(card->driver, "ES1688", sizeof(card->driver));
+       strlcpy(card->shortname, pcm->name, sizeof(card->shortname));
+       snprintf(card->longname, sizeof(card->longname),
+               "%s at 0x%lx, irq %i, dma %i", pcm->name, chip->port,
+                chip->irq, chip->dma8);
 
        if (fm_port[n] == SNDRV_AUTO_PORT)
                fm_port[n] = port[n];   /* share the same port */
@@ -152,12 +161,12 @@ static int __devinit snd_es1688_probe(struct device *dev, unsigned int n)
        if (fm_port[n] > 0) {
                if (snd_opl3_create(card, fm_port[n], fm_port[n] + 2,
                                OPL3_HW_OPL3, 0, &opl3) < 0)
-                       dev_warn(dev,
+                       dev_warn(card->dev,
                                 "opl3 not detected at 0x%lx\n", fm_port[n]);
                else {
                        error = snd_opl3_hwdep_new(opl3, 0, 1, NULL);
                        if (error < 0)
-                               goto out;
+                               return error;
                }
        }
 
@@ -167,23 +176,41 @@ static int __devinit snd_es1688_probe(struct device *dev, unsigned int n)
                                chip->mpu_port, 0,
                                mpu_irq[n], IRQF_DISABLED, NULL);
                if (error < 0)
-                       goto out;
+                       return error;
        }
 
+       return snd_card_register(card);
+}
+
+static int __devinit snd_es1688_isa_probe(struct device *dev, unsigned int n)
+{
+       struct snd_card *card;
+       int error;
+
+       error = snd_card_create(index[n], id[n], THIS_MODULE,
+                               sizeof(struct snd_es1688), &card);
+       if (error < 0)
+               return error;
+
+       error = snd_es1688_legacy_create(card, dev, n);
+       if (error < 0)
+               goto out;
+
        snd_card_set_dev(card, dev);
 
-       error = snd_card_register(card);
+       error = snd_es1688_probe(card, n);
        if (error < 0)
                goto out;
 
        dev_set_drvdata(dev, card);
-       return 0;
 
-out:   snd_card_free(card);
+       return 0;
+out:
+       snd_card_free(card);
        return error;
 }
 
-static int __devexit snd_es1688_remove(struct device *dev, unsigned int n)
+static int __devexit snd_es1688_isa_remove(struct device *dev, unsigned int n)
 {
        snd_card_free(dev_get_drvdata(dev));
        dev_set_drvdata(dev, NULL);
@@ -192,8 +219,8 @@ static int __devexit snd_es1688_remove(struct device *dev, unsigned int n)
 
 static struct isa_driver snd_es1688_driver = {
        .match          = snd_es1688_match,
-       .probe          = snd_es1688_probe,
-       .remove         = snd_es1688_remove,
+       .probe          = snd_es1688_isa_probe,
+       .remove         = __devexit_p(snd_es1688_isa_remove),
 #if 0  /* FIXME */
        .suspend        = snd_es1688_suspend,
        .resume         = snd_es1688_resume,
@@ -203,14 +230,142 @@ static struct isa_driver snd_es1688_driver = {
        }
 };
 
+static int snd_es968_pnp_is_probed;
+
+#ifdef CONFIG_PNP
+static int __devinit snd_card_es968_pnp(struct snd_card *card, unsigned int n,
+                                       struct pnp_card_link *pcard,
+                                       const struct pnp_card_device_id *pid)
+{
+       struct snd_es1688 *chip = card->private_data;
+       struct pnp_dev *pdev;
+       int error;
+
+       pdev = pnp_request_card_device(pcard, pid->devs[0].id, NULL);
+       if (pdev == NULL)
+               return -ENODEV;
+
+       error = pnp_activate_dev(pdev);
+       if (error < 0) {
+               snd_printk(KERN_ERR "ES968 pnp configure failure\n");
+               return error;
+       }
+       port[n] = pnp_port_start(pdev, 0);
+       dma8[n] = pnp_dma(pdev, 0);
+       irq[n] = pnp_irq(pdev, 0);
+
+       return snd_es1688_create(card, chip, port[n], mpu_port[n], irq[n],
+                                mpu_irq[n], dma8[n], ES1688_HW_AUTO);
+}
+
+static int __devinit snd_es968_pnp_detect(struct pnp_card_link *pcard,
+                                         const struct pnp_card_device_id *pid)
+{
+       struct snd_card *card;
+       static unsigned int dev;
+       int error;
+       struct snd_es1688 *chip;
+
+       if (snd_es968_pnp_is_probed)
+               return -EBUSY;
+       for ( ; dev < SNDRV_CARDS; dev++) {
+               if (enable[dev] && isapnp[dev])
+                       break;
+       }
+       if (dev == SNDRV_CARDS)
+               return -ENODEV;
+
+       error = snd_card_create(index[dev], id[dev], THIS_MODULE,
+                               sizeof(struct snd_es1688), &card);
+       if (error < 0)
+               return error;
+       chip = card->private_data;
+
+       error = snd_card_es968_pnp(card, dev, pcard, pid);
+       if (error < 0) {
+               snd_card_free(card);
+               return error;
+       }
+       snd_card_set_dev(card, &pcard->card->dev);
+       error = snd_es1688_probe(card, dev);
+       if (error < 0)
+               return error;
+       pnp_set_card_drvdata(pcard, card);
+       snd_es968_pnp_is_probed = 1;
+       return 0;
+}
+
+static void __devexit snd_es968_pnp_remove(struct pnp_card_link * pcard)
+{
+       snd_card_free(pnp_get_card_drvdata(pcard));
+       pnp_set_card_drvdata(pcard, NULL);
+       snd_es968_pnp_is_probed = 0;
+}
+
+#ifdef CONFIG_PM
+static int snd_es968_pnp_suspend(struct pnp_card_link *pcard,
+                                pm_message_t state)
+{
+       struct snd_card *card = pnp_get_card_drvdata(pcard);
+       struct snd_es1688 *chip = card->private_data;
+
+       snd_power_change_state(card, SNDRV_CTL_POWER_D3hot);
+       snd_pcm_suspend_all(chip->pcm);
+       return 0;
+}
+
+static int snd_es968_pnp_resume(struct pnp_card_link *pcard)
+{
+       struct snd_card *card = pnp_get_card_drvdata(pcard);
+       struct snd_es1688 *chip = card->private_data;
+
+       snd_es1688_reset(chip);
+       snd_power_change_state(card, SNDRV_CTL_POWER_D0);
+       return 0;
+}
+#endif
+
+static struct pnp_card_device_id snd_es968_pnpids[] = {
+       { .id = "ESS0968", .devs = { { "@@@0968" }, } },
+       { .id = "ESS0968", .devs = { { "ESS0968" }, } },
+       { .id = "", } /* end */
+};
+
+MODULE_DEVICE_TABLE(pnp_card, snd_es968_pnpids);
+
+static struct pnp_card_driver es968_pnpc_driver = {
+       .flags          = PNP_DRIVER_RES_DISABLE,
+       .name           = DEV_NAME " PnP",
+       .id_table       = snd_es968_pnpids,
+       .probe          = snd_es968_pnp_detect,
+       .remove         = __devexit_p(snd_es968_pnp_remove),
+#ifdef CONFIG_PM
+       .suspend        = snd_es968_pnp_suspend,
+       .resume         = snd_es968_pnp_resume,
+#endif
+};
+#endif
+
 static int __init alsa_card_es1688_init(void)
 {
+#ifdef CONFIG_PNP
+       pnp_register_card_driver(&es968_pnpc_driver);
+       if (snd_es968_pnp_is_probed)
+               return 0;
+       pnp_unregister_card_driver(&es968_pnpc_driver);
+#endif
        return isa_register_driver(&snd_es1688_driver, SNDRV_CARDS);
 }
 
 static void __exit alsa_card_es1688_exit(void)
 {
-       isa_unregister_driver(&snd_es1688_driver);
+       if (!snd_es968_pnp_is_probed) {
+               isa_unregister_driver(&snd_es1688_driver);
+               return;
+       }
+#ifdef CONFIG_PNP
+       pnp_unregister_card_driver(&es968_pnpc_driver);
+#endif
 }
 
 module_init(alsa_card_es1688_init);