![Takashi Iwai](/assets/img/avatar_default.png)
Fix the check of enable module option in probe of platform_device drivers. It shouldn't break the loop but just ignore if enable[i] is false. Signed-off-by: Takashi Iwai <tiwai@suse.de>
421 lines
12 KiB
C
421 lines
12 KiB
C
/*
|
|
* Driver for Gravis UltraSound MAX soundcard
|
|
* Copyright (c) by Jaroslav Kysela <perex@suse.cz>
|
|
*
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
*
|
|
*/
|
|
|
|
#include <sound/driver.h>
|
|
#include <linux/init.h>
|
|
#include <linux/err.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/time.h>
|
|
#include <linux/moduleparam.h>
|
|
#include <asm/dma.h>
|
|
#include <sound/core.h>
|
|
#include <sound/gus.h>
|
|
#include <sound/cs4231.h>
|
|
#define SNDRV_LEGACY_FIND_FREE_IRQ
|
|
#define SNDRV_LEGACY_FIND_FREE_DMA
|
|
#include <sound/initval.h>
|
|
|
|
MODULE_AUTHOR("Jaroslav Kysela <perex@suse.cz>");
|
|
MODULE_DESCRIPTION("Gravis UltraSound MAX");
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_SUPPORTED_DEVICE("{{Gravis,UltraSound MAX}}");
|
|
|
|
static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX; /* Index 0-MAX */
|
|
static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR; /* ID for this card */
|
|
static int enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE; /* Enable this card */
|
|
static long port[SNDRV_CARDS] = SNDRV_DEFAULT_PORT; /* 0x220,0x230,0x240,0x250,0x260 */
|
|
static int irq[SNDRV_CARDS] = SNDRV_DEFAULT_IRQ; /* 2,3,5,9,11,12,15 */
|
|
static int dma1[SNDRV_CARDS] = SNDRV_DEFAULT_DMA; /* 1,3,5,6,7 */
|
|
static int dma2[SNDRV_CARDS] = SNDRV_DEFAULT_DMA; /* 1,3,5,6,7 */
|
|
static int joystick_dac[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS - 1)] = 29};
|
|
/* 0 to 31, (0.59V-4.52V or 0.389V-2.98V) */
|
|
static int channels[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS - 1)] = 24};
|
|
static int pcm_channels[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS - 1)] = 2};
|
|
|
|
module_param_array(index, int, NULL, 0444);
|
|
MODULE_PARM_DESC(index, "Index value for GUS MAX soundcard.");
|
|
module_param_array(id, charp, NULL, 0444);
|
|
MODULE_PARM_DESC(id, "ID string for GUS MAX soundcard.");
|
|
module_param_array(enable, bool, NULL, 0444);
|
|
MODULE_PARM_DESC(enable, "Enable GUS MAX soundcard.");
|
|
module_param_array(port, long, NULL, 0444);
|
|
MODULE_PARM_DESC(port, "Port # for GUS MAX driver.");
|
|
module_param_array(irq, int, NULL, 0444);
|
|
MODULE_PARM_DESC(irq, "IRQ # for GUS MAX driver.");
|
|
module_param_array(dma1, int, NULL, 0444);
|
|
MODULE_PARM_DESC(dma1, "DMA1 # for GUS MAX driver.");
|
|
module_param_array(dma2, int, NULL, 0444);
|
|
MODULE_PARM_DESC(dma2, "DMA2 # for GUS MAX driver.");
|
|
module_param_array(joystick_dac, int, NULL, 0444);
|
|
MODULE_PARM_DESC(joystick_dac, "Joystick DAC level 0.59V-4.52V or 0.389V-2.98V for GUS MAX driver.");
|
|
module_param_array(channels, int, NULL, 0444);
|
|
MODULE_PARM_DESC(channels, "Used GF1 channels for GUS MAX driver.");
|
|
module_param_array(pcm_channels, int, NULL, 0444);
|
|
MODULE_PARM_DESC(pcm_channels, "Reserved PCM channels for GUS MAX driver.");
|
|
|
|
static struct platform_device *devices[SNDRV_CARDS];
|
|
|
|
struct snd_gusmax {
|
|
int irq;
|
|
struct snd_card *card;
|
|
struct snd_gus_card *gus;
|
|
struct snd_cs4231 *cs4231;
|
|
unsigned short gus_status_reg;
|
|
unsigned short pcm_status_reg;
|
|
};
|
|
|
|
#define PFX "gusmax: "
|
|
|
|
static int __init snd_gusmax_detect(struct snd_gus_card * gus)
|
|
{
|
|
unsigned char d;
|
|
|
|
snd_gf1_i_write8(gus, SNDRV_GF1_GB_RESET, 0); /* reset GF1 */
|
|
if (((d = snd_gf1_i_look8(gus, SNDRV_GF1_GB_RESET)) & 0x07) != 0) {
|
|
snd_printdd("[0x%lx] check 1 failed - 0x%x\n", gus->gf1.port, d);
|
|
return -ENODEV;
|
|
}
|
|
udelay(160);
|
|
snd_gf1_i_write8(gus, SNDRV_GF1_GB_RESET, 1); /* release reset */
|
|
udelay(160);
|
|
if (((d = snd_gf1_i_look8(gus, SNDRV_GF1_GB_RESET)) & 0x07) != 1) {
|
|
snd_printdd("[0x%lx] check 2 failed - 0x%x\n", gus->gf1.port, d);
|
|
return -ENODEV;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static irqreturn_t snd_gusmax_interrupt(int irq, void *dev_id, struct pt_regs *regs)
|
|
{
|
|
struct snd_gusmax *maxcard = (struct snd_gusmax *) dev_id;
|
|
int loop, max = 5;
|
|
int handled = 0;
|
|
|
|
do {
|
|
loop = 0;
|
|
if (inb(maxcard->gus_status_reg)) {
|
|
handled = 1;
|
|
snd_gus_interrupt(irq, maxcard->gus, regs);
|
|
loop++;
|
|
}
|
|
if (inb(maxcard->pcm_status_reg) & 0x01) { /* IRQ bit is set? */
|
|
handled = 1;
|
|
snd_cs4231_interrupt(irq, maxcard->cs4231, regs);
|
|
loop++;
|
|
}
|
|
} while (loop && --max > 0);
|
|
return IRQ_RETVAL(handled);
|
|
}
|
|
|
|
static void __init snd_gusmax_init(int dev, struct snd_card *card, struct snd_gus_card * gus)
|
|
{
|
|
gus->equal_irq = 1;
|
|
gus->codec_flag = 1;
|
|
gus->joystick_dac = joystick_dac[dev];
|
|
/* init control register */
|
|
gus->max_cntrl_val = (gus->gf1.port >> 4) & 0x0f;
|
|
if (gus->gf1.dma1 > 3)
|
|
gus->max_cntrl_val |= 0x10;
|
|
if (gus->gf1.dma2 > 3)
|
|
gus->max_cntrl_val |= 0x20;
|
|
gus->max_cntrl_val |= 0x40;
|
|
outb(gus->max_cntrl_val, GUSP(gus, MAXCNTRLPORT));
|
|
}
|
|
|
|
#define CS4231_PRIVATE( left, right, shift, mute ) \
|
|
((left << 24)|(right << 16)|(shift<<8)|mute)
|
|
|
|
static int __init snd_gusmax_mixer(struct snd_cs4231 *chip)
|
|
{
|
|
struct snd_card *card = chip->card;
|
|
struct snd_ctl_elem_id id1, id2;
|
|
int err;
|
|
|
|
memset(&id1, 0, sizeof(id1));
|
|
memset(&id2, 0, sizeof(id2));
|
|
id1.iface = id2.iface = SNDRV_CTL_ELEM_IFACE_MIXER;
|
|
/* reassign AUXA to SYNTHESIZER */
|
|
strcpy(id1.name, "Aux Playback Switch");
|
|
strcpy(id2.name, "Synth Playback Switch");
|
|
if ((err = snd_ctl_rename_id(card, &id1, &id2)) < 0)
|
|
return err;
|
|
strcpy(id1.name, "Aux Playback Volume");
|
|
strcpy(id2.name, "Synth Playback Volume");
|
|
if ((err = snd_ctl_rename_id(card, &id1, &id2)) < 0)
|
|
return err;
|
|
/* reassign AUXB to CD */
|
|
strcpy(id1.name, "Aux Playback Switch"); id1.index = 1;
|
|
strcpy(id2.name, "CD Playback Switch");
|
|
if ((err = snd_ctl_rename_id(card, &id1, &id2)) < 0)
|
|
return err;
|
|
strcpy(id1.name, "Aux Playback Volume");
|
|
strcpy(id2.name, "CD Playback Volume");
|
|
if ((err = snd_ctl_rename_id(card, &id1, &id2)) < 0)
|
|
return err;
|
|
#if 0
|
|
/* reassign Mono Input to MIC */
|
|
if (snd_mixer_group_rename(mixer,
|
|
SNDRV_MIXER_IN_MONO, 0,
|
|
SNDRV_MIXER_IN_MIC, 0) < 0)
|
|
goto __error;
|
|
if (snd_mixer_elem_rename(mixer,
|
|
SNDRV_MIXER_IN_MONO, 0, SNDRV_MIXER_ETYPE_INPUT,
|
|
SNDRV_MIXER_IN_MIC, 0) < 0)
|
|
goto __error;
|
|
if (snd_mixer_elem_rename(mixer,
|
|
"Mono Capture Volume", 0, SNDRV_MIXER_ETYPE_VOLUME1,
|
|
"Mic Capture Volume", 0) < 0)
|
|
goto __error;
|
|
if (snd_mixer_elem_rename(mixer,
|
|
"Mono Capture Switch", 0, SNDRV_MIXER_ETYPE_SWITCH1,
|
|
"Mic Capture Switch", 0) < 0)
|
|
goto __error;
|
|
#endif
|
|
return 0;
|
|
}
|
|
|
|
static void snd_gusmax_free(struct snd_card *card)
|
|
{
|
|
struct snd_gusmax *maxcard = (struct snd_gusmax *)card->private_data;
|
|
|
|
if (maxcard == NULL)
|
|
return;
|
|
if (maxcard->irq >= 0)
|
|
free_irq(maxcard->irq, (void *)maxcard);
|
|
}
|
|
|
|
static int __init snd_gusmax_probe(struct platform_device *pdev)
|
|
{
|
|
int dev = pdev->id;
|
|
static int possible_irqs[] = {5, 11, 12, 9, 7, 15, 3, -1};
|
|
static int possible_dmas[] = {5, 6, 7, 1, 3, -1};
|
|
int xirq, xdma1, xdma2, err;
|
|
struct snd_card *card;
|
|
struct snd_gus_card *gus = NULL;
|
|
struct snd_cs4231 *cs4231;
|
|
struct snd_gusmax *maxcard;
|
|
|
|
card = snd_card_new(index[dev], id[dev], THIS_MODULE,
|
|
sizeof(struct snd_gusmax));
|
|
if (card == NULL)
|
|
return -ENOMEM;
|
|
card->private_free = snd_gusmax_free;
|
|
maxcard = (struct snd_gusmax *)card->private_data;
|
|
maxcard->card = card;
|
|
maxcard->irq = -1;
|
|
|
|
xirq = irq[dev];
|
|
if (xirq == SNDRV_AUTO_IRQ) {
|
|
if ((xirq = snd_legacy_find_free_irq(possible_irqs)) < 0) {
|
|
snd_printk(KERN_ERR PFX "unable to find a free IRQ\n");
|
|
err = -EBUSY;
|
|
goto _err;
|
|
}
|
|
}
|
|
xdma1 = dma1[dev];
|
|
if (xdma1 == SNDRV_AUTO_DMA) {
|
|
if ((xdma1 = snd_legacy_find_free_dma(possible_dmas)) < 0) {
|
|
snd_printk(KERN_ERR PFX "unable to find a free DMA1\n");
|
|
err = -EBUSY;
|
|
goto _err;
|
|
}
|
|
}
|
|
xdma2 = dma2[dev];
|
|
if (xdma2 == SNDRV_AUTO_DMA) {
|
|
if ((xdma2 = snd_legacy_find_free_dma(possible_dmas)) < 0) {
|
|
snd_printk(KERN_ERR PFX "unable to find a free DMA2\n");
|
|
err = -EBUSY;
|
|
goto _err;
|
|
}
|
|
}
|
|
|
|
if (port[dev] != SNDRV_AUTO_PORT) {
|
|
err = snd_gus_create(card,
|
|
port[dev],
|
|
-xirq, xdma1, xdma2,
|
|
0, channels[dev],
|
|
pcm_channels[dev],
|
|
0, &gus);
|
|
} else {
|
|
static unsigned long possible_ports[] = {
|
|
0x220, 0x230, 0x240, 0x250, 0x260
|
|
};
|
|
int i;
|
|
for (i = 0; i < ARRAY_SIZE(possible_ports); i++) {
|
|
err = snd_gus_create(card,
|
|
possible_ports[i],
|
|
-xirq, xdma1, xdma2,
|
|
0, channels[dev],
|
|
pcm_channels[dev],
|
|
0, &gus);
|
|
if (err >= 0) {
|
|
port[dev] = possible_ports[i];
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
if (err < 0)
|
|
goto _err;
|
|
|
|
if ((err = snd_gusmax_detect(gus)) < 0)
|
|
goto _err;
|
|
|
|
maxcard->gus_status_reg = gus->gf1.reg_irqstat;
|
|
maxcard->pcm_status_reg = gus->gf1.port + 0x10c + 2;
|
|
snd_gusmax_init(dev, card, gus);
|
|
if ((err = snd_gus_initialize(gus)) < 0)
|
|
goto _err;
|
|
|
|
if (!gus->max_flag) {
|
|
snd_printk(KERN_ERR PFX "GUS MAX soundcard was not detected at 0x%lx\n", gus->gf1.port);
|
|
err = -ENODEV;
|
|
goto _err;
|
|
}
|
|
|
|
if (request_irq(xirq, snd_gusmax_interrupt, SA_INTERRUPT, "GUS MAX", (void *)maxcard)) {
|
|
snd_printk(KERN_ERR PFX "unable to grab IRQ %d\n", xirq);
|
|
err = -EBUSY;
|
|
goto _err;
|
|
}
|
|
maxcard->irq = xirq;
|
|
|
|
if ((err = snd_cs4231_create(card,
|
|
gus->gf1.port + 0x10c, -1, xirq,
|
|
xdma2 < 0 ? xdma1 : xdma2, xdma1,
|
|
CS4231_HW_DETECT,
|
|
CS4231_HWSHARE_IRQ |
|
|
CS4231_HWSHARE_DMA1 |
|
|
CS4231_HWSHARE_DMA2,
|
|
&cs4231)) < 0)
|
|
goto _err;
|
|
|
|
if ((err = snd_cs4231_pcm(cs4231, 0, NULL)) < 0)
|
|
goto _err;
|
|
|
|
if ((err = snd_cs4231_mixer(cs4231)) < 0)
|
|
goto _err;
|
|
|
|
if ((err = snd_cs4231_timer(cs4231, 2, NULL)) < 0)
|
|
goto _err;
|
|
|
|
if (pcm_channels[dev] > 0) {
|
|
if ((err = snd_gf1_pcm_new(gus, 1, 1, NULL)) < 0)
|
|
goto _err;
|
|
}
|
|
if ((err = snd_gusmax_mixer(cs4231)) < 0)
|
|
goto _err;
|
|
|
|
if ((err = snd_gf1_rawmidi_new(gus, 0, NULL)) < 0)
|
|
goto _err;
|
|
|
|
sprintf(card->longname + strlen(card->longname), " at 0x%lx, irq %i, dma %i", gus->gf1.port, xirq, xdma1);
|
|
if (xdma2 >= 0)
|
|
sprintf(card->longname + strlen(card->longname), "&%i", xdma2);
|
|
|
|
snd_card_set_dev(card, &pdev->dev);
|
|
|
|
if ((err = snd_card_register(card)) < 0)
|
|
goto _err;
|
|
|
|
maxcard->gus = gus;
|
|
maxcard->cs4231 = cs4231;
|
|
|
|
platform_set_drvdata(pdev, card);
|
|
return 0;
|
|
|
|
_err:
|
|
snd_card_free(card);
|
|
return err;
|
|
}
|
|
|
|
static int snd_gusmax_remove(struct platform_device *devptr)
|
|
{
|
|
snd_card_free(platform_get_drvdata(devptr));
|
|
platform_set_drvdata(devptr, NULL);
|
|
return 0;
|
|
}
|
|
|
|
#define GUSMAX_DRIVER "snd_gusmax"
|
|
|
|
static struct platform_driver snd_gusmax_driver = {
|
|
.probe = snd_gusmax_probe,
|
|
.remove = snd_gusmax_remove,
|
|
/* FIXME: suspend/resume */
|
|
.driver = {
|
|
.name = GUSMAX_DRIVER
|
|
},
|
|
};
|
|
|
|
static void __init_or_module snd_gusmax_unregister_all(void)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(devices); ++i)
|
|
platform_device_unregister(devices[i]);
|
|
platform_driver_unregister(&snd_gusmax_driver);
|
|
}
|
|
|
|
static int __init alsa_card_gusmax_init(void)
|
|
{
|
|
int i, cards, err;
|
|
|
|
err = platform_driver_register(&snd_gusmax_driver);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
cards = 0;
|
|
for (i = 0; i < SNDRV_CARDS; i++) {
|
|
struct platform_device *device;
|
|
if (! enable[i])
|
|
continue;
|
|
device = platform_device_register_simple(GUSMAX_DRIVER,
|
|
i, NULL, 0);
|
|
if (IS_ERR(device)) {
|
|
err = PTR_ERR(device);
|
|
goto errout;
|
|
}
|
|
devices[i] = device;
|
|
cards++;
|
|
}
|
|
if (!cards) {
|
|
#ifdef MODULE
|
|
printk(KERN_ERR "GUS MAX soundcard not found or device busy\n");
|
|
#endif
|
|
err = -ENODEV;
|
|
goto errout;
|
|
}
|
|
return 0;
|
|
|
|
errout:
|
|
snd_gusmax_unregister_all();
|
|
return err;
|
|
}
|
|
|
|
static void __exit alsa_card_gusmax_exit(void)
|
|
{
|
|
snd_gusmax_unregister_all();
|
|
}
|
|
|
|
module_init(alsa_card_gusmax_init)
|
|
module_exit(alsa_card_gusmax_exit)
|