Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) // SPDX-License-Identifier: GPL-2.0-or-later
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  * cs5530.c - Initialisation code for Cyrix/NatSemi VSA1 softaudio
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  * 	(C) Copyright 2007 Ash Willis <ashwillis@programmer.net>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)  *	(C) Copyright 2003 Red Hat Inc <alan@lxorguk.ukuu.org.uk>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8)  * This driver was ported (shamelessly ripped ;) from oss/kahlua.c but I did
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9)  * mess with it a bit. The chip seems to have to have trouble with full duplex
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10)  * mode. If we're recording in 8bit 8000kHz, say, and we then attempt to
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11)  * simultaneously play back audio at 16bit 44100kHz, the device actually plays
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12)  * back in the same format in which it is capturing. By forcing the chip to
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13)  * always play/capture in 16/44100, we can let alsa-lib convert the samples and
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14)  * that way we can hack up some full duplex audio. 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15)  * 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16)  * XpressAudio(tm) is used on the Cyrix MediaGX (now NatSemi Geode) systems.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17)  * The older version (VSA1) provides fairly good soundblaster emulation
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18)  * although there are a couple of bugs: large DMA buffers break record,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19)  * and the MPU event handling seems suspect. VSA2 allows the native driver
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20)  * to control the AC97 audio engine directly and requires a different driver.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22)  * Thanks to National Semiconductor for providing the needed information
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23)  * on the XpressAudio(tm) internals.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25)  * TO DO:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26)  *	Investigate whether we can portably support Cognac (5520) in the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27)  *	same manner.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) #include <linux/delay.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) #include <linux/pci.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) #include <sound/core.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) #include <sound/sb.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) #include <sound/initval.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) MODULE_AUTHOR("Ash Willis");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) MODULE_DESCRIPTION("CS5530 Audio");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) static bool enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) module_param_array(index, int, NULL, 0444);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) MODULE_PARM_DESC(index, "Index value for CS5530 Audio driver.");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) module_param_array(id, charp, NULL, 0444);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) MODULE_PARM_DESC(id, "ID string for CS5530 Audio driver.");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) module_param_array(enable, bool, NULL, 0444);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) MODULE_PARM_DESC(enable, "Enable CS5530 Audio driver.");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) struct snd_cs5530 {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) 	struct snd_card *card;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) 	struct pci_dev *pci;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) 	struct snd_sb *sb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) 	unsigned long pci_base;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) static const struct pci_device_id snd_cs5530_ids[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) 	{PCI_VENDOR_ID_CYRIX, PCI_DEVICE_ID_CYRIX_5530_AUDIO, PCI_ANY_ID,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 							PCI_ANY_ID, 0, 0},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) 	{0,}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) MODULE_DEVICE_TABLE(pci, snd_cs5530_ids);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) static int snd_cs5530_free(struct snd_cs5530 *chip)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 	pci_release_regions(chip->pci);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 	pci_disable_device(chip->pci);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 	kfree(chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) static int snd_cs5530_dev_free(struct snd_device *device)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) 	struct snd_cs5530 *chip = device->device_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) 	return snd_cs5530_free(chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) static void snd_cs5530_remove(struct pci_dev *pci)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 	snd_card_free(pci_get_drvdata(pci));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) static u8 snd_cs5530_mixer_read(unsigned long io, u8 reg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 	outb(reg, io + 4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 	udelay(20);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 	reg = inb(io + 5);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 	udelay(20);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 	return reg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) static int snd_cs5530_create(struct snd_card *card,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 			     struct pci_dev *pci,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 			     struct snd_cs5530 **rchip)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 	struct snd_cs5530 *chip;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) 	unsigned long sb_base;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) 	u8 irq, dma8, dma16 = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 	u16 map;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 	void __iomem *mem;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 	int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 	static const struct snd_device_ops ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 		.dev_free = snd_cs5530_dev_free,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 	};
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 	*rchip = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 	err = pci_enable_device(pci);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113)  	if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 		return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) 	chip = kzalloc(sizeof(*chip), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 	if (chip == NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) 		pci_disable_device(pci);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 	chip->card = card;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) 	chip->pci = pci;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) 	err = pci_request_regions(pci, "CS5530");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 	if (err < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 		kfree(chip); 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 		pci_disable_device(pci);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 		return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) 	chip->pci_base = pci_resource_start(pci, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 	mem = pci_ioremap_bar(pci, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 	if (mem == NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) 		snd_cs5530_free(chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 		return -EBUSY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 	map = readw(mem + 0x18);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) 	iounmap(mem);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 	/* Map bits
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) 		0:1	* 0x20 + 0x200 = sb base
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) 		2	sb enable
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 		3	adlib enable
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) 		5	MPU enable 0x330
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) 		6	MPU enable 0x300
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) 	   The other bits may be used internally so must be masked */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 	sb_base = 0x220 + 0x20 * (map & 3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) 	if (map & (1<<2))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 		dev_info(card->dev, "XpressAudio at 0x%lx\n", sb_base);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) 	else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 		dev_err(card->dev, "Could not find XpressAudio!\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 		snd_cs5530_free(chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 		return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) 	if (map & (1<<5))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) 		dev_info(card->dev, "MPU at 0x300\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) 	else if (map & (1<<6))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) 		dev_info(card->dev, "MPU at 0x330\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) 	irq = snd_cs5530_mixer_read(sb_base, 0x80) & 0x0F;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) 	dma8 = snd_cs5530_mixer_read(sb_base, 0x81);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 	if (dma8 & 0x20)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) 		dma16 = 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) 	else if (dma8 & 0x40)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) 		dma16 = 6;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) 	else if (dma8 & 0x80)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 		dma16 = 7;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) 	else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) 		dev_err(card->dev, "No 16bit DMA enabled\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) 		snd_cs5530_free(chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 		return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) 	if (dma8 & 0x01)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) 		dma8 = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 	else if (dma8 & 02)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) 		dma8 = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) 	else if (dma8 & 0x08)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 		dma8 = 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 	else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) 		dev_err(card->dev, "No 8bit DMA enabled\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) 		snd_cs5530_free(chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 		return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) 	if (irq & 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 		irq = 9;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) 	else if (irq & 2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) 		irq = 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) 	else if (irq & 4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) 		irq = 7;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) 	else if (irq & 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) 		irq = 10;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) 	else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) 		dev_err(card->dev, "SoundBlaster IRQ not set\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) 		snd_cs5530_free(chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) 		return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) 	dev_info(card->dev, "IRQ: %d DMA8: %d DMA16: %d\n", irq, dma8, dma16);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) 	err = snd_sbdsp_create(card, sb_base, irq, snd_sb16dsp_interrupt, dma8,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) 						dma16, SB_HW_CS5530, &chip->sb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) 	if (err < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) 		dev_err(card->dev, "Could not create SoundBlaster\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) 		snd_cs5530_free(chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) 		return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) 	err = snd_sb16dsp_pcm(chip->sb, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) 	if (err < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) 		dev_err(card->dev, "Could not create PCM\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) 		snd_cs5530_free(chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) 		return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) 	err = snd_sbmixer_new(chip->sb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) 	if (err < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) 		dev_err(card->dev, "Could not create Mixer\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) 		snd_cs5530_free(chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) 		return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) 	err = snd_device_new(card, SNDRV_DEV_LOWLEVEL, chip, &ops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) 	if (err < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) 		snd_cs5530_free(chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) 		return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) 	*rchip = chip;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) static int snd_cs5530_probe(struct pci_dev *pci,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) 			    const struct pci_device_id *pci_id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) 	static int dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) 	struct snd_card *card;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) 	struct snd_cs5530 *chip = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) 	int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) 	if (dev >= SNDRV_CARDS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) 		return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) 	if (!enable[dev]) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) 		dev++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) 		return -ENOENT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) 	err = snd_card_new(&pci->dev, index[dev], id[dev], THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) 			   0, &card);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) 	if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) 		return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) 	err = snd_cs5530_create(card, pci, &chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) 	if (err < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) 		snd_card_free(card);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) 		return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) 	strcpy(card->driver, "CS5530");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) 	strcpy(card->shortname, "CS5530 Audio");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) 	sprintf(card->longname, "%s at 0x%lx", card->shortname, chip->pci_base);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) 	err = snd_card_register(card);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) 	if (err < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) 		snd_card_free(card);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) 		return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) 	pci_set_drvdata(pci, card);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) 	dev++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) static struct pci_driver cs5530_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) 	.name = KBUILD_MODNAME,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) 	.id_table = snd_cs5530_ids,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) 	.probe = snd_cs5530_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) 	.remove = snd_cs5530_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) module_pci_driver(cs5530_driver);