[net-next-2.6.git] / sound / pci / ymfpci / ymfpci.c

/*
 *  The driver for the Yamaha's DS1/DS1E cards
 *  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/pci.h>
#include <linux/time.h>
#include <linux/moduleparam.h>
#include <sound/core.h>
#include <sound/ymfpci.h>
#include <sound/mpu401.h>
#include <sound/opl3.h>
#include <sound/initval.h>

MODULE_AUTHOR("Jaroslav Kysela <perex@suse.cz>");
MODULE_DESCRIPTION("Yamaha DS-1 PCI");
MODULE_LICENSE("GPL");
MODULE_SUPPORTED_DEVICE("{{Yamaha,YMF724},"
		"{Yamaha,YMF724F},"
		"{Yamaha,YMF740},"
		"{Yamaha,YMF740C},"
		"{Yamaha,YMF744},"
		"{Yamaha,YMF754}}");

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_PNP;	/* Enable this card */
static long fm_port[SNDRV_CARDS];
static long mpu_port[SNDRV_CARDS];
#ifdef SUPPORT_JOYSTICK
static long joystick_port[SNDRV_CARDS];
#endif
static int rear_switch[SNDRV_CARDS];
static int rear_swap[SNDRV_CARDS] = { [0 ... (SNDRV_CARDS-1)] = 1 };

module_param_array(index, int, NULL, 0444);
MODULE_PARM_DESC(index, "Index value for the Yamaha DS-1 PCI soundcard.");
module_param_array(id, charp, NULL, 0444);
MODULE_PARM_DESC(id, "ID string for the Yamaha DS-1 PCI soundcard.");
module_param_array(enable, bool, NULL, 0444);
MODULE_PARM_DESC(enable, "Enable Yamaha DS-1 soundcard.");
module_param_array(mpu_port, long, NULL, 0444);
MODULE_PARM_DESC(mpu_port, "MPU-401 Port.");
module_param_array(fm_port, long, NULL, 0444);
MODULE_PARM_DESC(fm_port, "FM OPL-3 Port.");
#ifdef SUPPORT_JOYSTICK
module_param_array(joystick_port, long, NULL, 0444);
MODULE_PARM_DESC(joystick_port, "Joystick port address");
#endif
module_param_array(rear_switch, bool, NULL, 0444);
MODULE_PARM_DESC(rear_switch, "Enable shared rear/line-in switch");
module_param_array(rear_swap, bool, NULL, 0444);
MODULE_PARM_DESC(rear_swap, "Swap rear channels (must be enabled for correct IEC958 (S/PDIF)) output");

static struct pci_device_id snd_ymfpci_ids[] = {
        { 0x1073, 0x0004, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0, },   /* YMF724 */
        { 0x1073, 0x000d, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0, },   /* YMF724F */
        { 0x1073, 0x000a, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0, },   /* YMF740 */
        { 0x1073, 0x000c, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0, },   /* YMF740C */
        { 0x1073, 0x0010, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0, },   /* YMF744 */
        { 0x1073, 0x0012, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0, },   /* YMF754 */
	{ 0, }
};

MODULE_DEVICE_TABLE(pci, snd_ymfpci_ids);

#ifdef SUPPORT_JOYSTICK
static int __devinit snd_ymfpci_create_gameport(struct snd_ymfpci *chip, int dev,
						int legacy_ctrl, int legacy_ctrl2)
{
	struct gameport *gp;
	struct resource *r = NULL;
	int io_port = joystick_port[dev];

	if (!io_port)
		return -ENODEV;

	if (chip->pci->device >= 0x0010) { /* YMF 744/754 */

		if (io_port == 1) {
			/* auto-detect */
			if (!(io_port = pci_resource_start(chip->pci, 2)))
				return -ENODEV;
		}
	} else {
		if (io_port == 1) {
			/* auto-detect */
			for (io_port = 0x201; io_port <= 0x205; io_port++) {
				if (io_port == 0x203)
					continue;
				if ((r = request_region(io_port, 1, "YMFPCI gameport")) != NULL)
					break;
			}
			if (!r) {
				printk(KERN_ERR "ymfpci: no gameport ports available\n");
				return -EBUSY;
			}
		}
		switch (io_port) {
		case 0x201: legacy_ctrl2 |= 0 << 6; break;
		case 0x202: legacy_ctrl2 |= 1 << 6; break;
		case 0x204: legacy_ctrl2 |= 2 << 6; break;
		case 0x205: legacy_ctrl2 |= 3 << 6; break;
		default:
			printk(KERN_ERR "ymfpci: invalid joystick port %#x", io_port);
			return -EINVAL;
		}
	}

	if (!r && !(r = request_region(io_port, 1, "YMFPCI gameport"))) {
		printk(KERN_ERR "ymfpci: joystick port %#x is in use.\n", io_port);
		return -EBUSY;
	}

	chip->gameport = gp = gameport_allocate_port();
	if (!gp) {
		printk(KERN_ERR "ymfpci: cannot allocate memory for gameport\n");
		release_and_free_resource(r);
		return -ENOMEM;
	}


	gameport_set_name(gp, "Yamaha YMF Gameport");
	gameport_set_phys(gp, "pci%s/gameport0", pci_name(chip->pci));
	gameport_set_dev_parent(gp, &chip->pci->dev);
	gp->io = io_port;
	gameport_set_port_data(gp, r);

	if (chip->pci->device >= 0x0010) /* YMF 744/754 */
		pci_write_config_word(chip->pci, PCIR_DSXG_JOYBASE, io_port);

	pci_write_config_word(chip->pci, PCIR_DSXG_LEGACY, legacy_ctrl | YMFPCI_LEGACY_JPEN);
	pci_write_config_word(chip->pci, PCIR_DSXG_ELEGACY, legacy_ctrl2);

	gameport_register_port(chip->gameport);

	return 0;
}

void snd_ymfpci_free_gameport(struct snd_ymfpci *chip)
{
	if (chip->gameport) {
		struct resource *r = gameport_get_port_data(chip->gameport);

		gameport_unregister_port(chip->gameport);
		chip->gameport = NULL;

		release_and_free_resource(r);
	}
}
#else
static inline int snd_ymfpci_create_gameport(struct snd_ymfpci *chip, int dev, int l, int l2) { return -ENOSYS; }
void snd_ymfpci_free_gameport(struct snd_ymfpci *chip) { }
#endif /* SUPPORT_JOYSTICK */

static int __devinit snd_card_ymfpci_probe(struct pci_dev *pci,
					   const struct pci_device_id *pci_id)
{
	static int dev;
	struct snd_card *card;
	struct resource *fm_res = NULL;
	struct resource *mpu_res = NULL;
	struct snd_ymfpci *chip;
	struct snd_opl3 *opl3;
	const char *str, *model;
	int err;
	u16 legacy_ctrl, legacy_ctrl2, old_legacy_ctrl;

	if (dev >= SNDRV_CARDS)
		return -ENODEV;
	if (!enable[dev]) {
		dev++;
		return -ENOENT;
	}

	card = snd_card_new(index[dev], id[dev], THIS_MODULE, 0);
	if (card == NULL)
		return -ENOMEM;

	switch (pci_id->device) {
	case 0x0004: str = "YMF724";  model = "DS-1"; break;
	case 0x000d: str = "YMF724F"; model = "DS-1"; break;
	case 0x000a: str = "YMF740";  model = "DS-1L"; break;
	case 0x000c: str = "YMF740C"; model = "DS-1L"; break;
	case 0x0010: str = "YMF744";  model = "DS-1S"; break;
	case 0x0012: str = "YMF754";  model = "DS-1E"; break;
	default: model = str = "???"; break;
	}

	legacy_ctrl = 0;
	legacy_ctrl2 = 0x0800;	/* SBEN = 0, SMOD = 01, LAD = 0 */

	if (pci_id->device >= 0x0010) { /* YMF 744/754 */
		if (fm_port[dev] == 1) {
			/* auto-detect */
			fm_port[dev] = pci_resource_start(pci, 1);
		}
		if (fm_port[dev] > 0 &&
		    (fm_res = request_region(fm_port[dev], 4, "YMFPCI OPL3")) != NULL) {
			legacy_ctrl |= YMFPCI_LEGACY_FMEN;
			pci_write_config_word(pci, PCIR_DSXG_FMBASE, fm_port[dev]);
		}
		if (mpu_port[dev] == 1) {
			/* auto-detect */
			mpu_port[dev] = pci_resource_start(pci, 1) + 0x20;
		}
		if (mpu_port[dev] > 0 &&
		    (mpu_res = request_region(mpu_port[dev], 2, "YMFPCI MPU401")) != NULL) {
			legacy_ctrl |= YMFPCI_LEGACY_MEN;
			pci_write_config_word(pci, PCIR_DSXG_MPU401BASE, mpu_port[dev]);
		}
	} else {
		switch (fm_port[dev]) {
		case 0x388: legacy_ctrl2 |= 0; break;
		case 0x398: legacy_ctrl2 |= 1; break;
		case 0x3a0: legacy_ctrl2 |= 2; break;
		case 0x3a8: legacy_ctrl2 |= 3; break;
		default: fm_port[dev] = 0; break;
		}
		if (fm_port[dev] > 0 &&
		    (fm_res = request_region(fm_port[dev], 4, "YMFPCI OPL3")) != NULL) {
			legacy_ctrl |= YMFPCI_LEGACY_FMEN;
		} else {
			legacy_ctrl2 &= ~YMFPCI_LEGACY2_FMIO;
			fm_port[dev] = 0;
		}
		switch (mpu_port[dev]) {
		case 0x330: legacy_ctrl2 |= 0 << 4; break;
		case 0x300: legacy_ctrl2 |= 1 << 4; break;
		case 0x332: legacy_ctrl2 |= 2 << 4; break;
		case 0x334: legacy_ctrl2 |= 3 << 4; break;
		default: mpu_port[dev] = 0; break;
		}
		if (mpu_port[dev] > 0 &&
		    (mpu_res = request_region(mpu_port[dev], 2, "YMFPCI MPU401")) != NULL) {
			legacy_ctrl |= YMFPCI_LEGACY_MEN;
		} else {
			legacy_ctrl2 &= ~YMFPCI_LEGACY2_MPUIO;
			mpu_port[dev] = 0;
		}
	}
	if (mpu_res) {
		legacy_ctrl |= YMFPCI_LEGACY_MIEN;
		legacy_ctrl2 |= YMFPCI_LEGACY2_IMOD;
	}
	pci_read_config_word(pci, PCIR_DSXG_LEGACY, &old_legacy_ctrl);
	pci_write_config_word(pci, PCIR_DSXG_LEGACY, legacy_ctrl);
	pci_write_config_word(pci, PCIR_DSXG_ELEGACY, legacy_ctrl2);
	if ((err = snd_ymfpci_create(card, pci,
				     old_legacy_ctrl,
			 	     &chip)) < 0) {
		snd_card_free(card);
		release_and_free_resource(mpu_res);
		release_and_free_resource(fm_res);
		return err;
	}
	chip->fm_res = fm_res;
	chip->mpu_res = mpu_res;
	card->private_data = chip;

	strcpy(card->driver, str);
	sprintf(card->shortname, "Yamaha %s (%s)", model, str);
	sprintf(card->longname, "%s at 0x%lx, irq %i",
		card->shortname,
		chip->reg_area_phys,
		chip->irq);
	if ((err = snd_ymfpci_pcm(chip, 0, NULL)) < 0) {
		snd_card_free(card);
		return err;
	}
	if ((err = snd_ymfpci_pcm_spdif(chip, 1, NULL)) < 0) {
		snd_card_free(card);
		return err;
	}
	if ((err = snd_ymfpci_pcm_4ch(chip, 2, NULL)) < 0) {
		snd_card_free(card);
		return err;
	}
	if ((err = snd_ymfpci_pcm2(chip, 3, NULL)) < 0) {
		snd_card_free(card);
		return err;
	}
	if ((err = snd_ymfpci_mixer(chip, rear_switch[dev], rear_swap[dev])) < 0) {
		snd_card_free(card);
		return err;
	}
	if ((err = snd_ymfpci_timer(chip, 0)) < 0) {
		snd_card_free(card);
		return err;
	}
	if (chip->mpu_res) {
		if ((err = snd_mpu401_uart_new(card, 0, MPU401_HW_YMFPCI,
					       mpu_port[dev],
					       MPU401_INFO_INTEGRATED,
					       pci->irq, 0, &chip->rawmidi)) < 0) {
			printk(KERN_WARNING "ymfpci: cannot initialize MPU401 at 0x%lx, skipping...\n", mpu_port[dev]);
			legacy_ctrl &= ~YMFPCI_LEGACY_MIEN; /* disable MPU401 irq */
			pci_write_config_word(pci, PCIR_DSXG_LEGACY, legacy_ctrl);
		}
	}
	if (chip->fm_res) {
		if ((err = snd_opl3_create(card,
					   fm_port[dev],
					   fm_port[dev] + 2,
					   OPL3_HW_OPL3, 1, &opl3)) < 0) {
			printk(KERN_WARNING "ymfpci: cannot initialize FM OPL3 at 0x%lx, skipping...\n", fm_port[dev]);
			legacy_ctrl &= ~YMFPCI_LEGACY_FMEN;
			pci_write_config_word(pci, PCIR_DSXG_LEGACY, legacy_ctrl);
		} else if ((err = snd_opl3_hwdep_new(opl3, 0, 1, NULL)) < 0) {
			snd_card_free(card);
			snd_printk(KERN_ERR "cannot create opl3 hwdep\n");
			return err;
		}
	}

	snd_ymfpci_create_gameport(chip, dev, legacy_ctrl, legacy_ctrl2);

	if ((err = snd_card_register(card)) < 0) {
		snd_card_free(card);
		return err;
	}
	pci_set_drvdata(pci, card);
	dev++;
	return 0;
}

static void __devexit snd_card_ymfpci_remove(struct pci_dev *pci)
{
	snd_card_free(pci_get_drvdata(pci));
	pci_set_drvdata(pci, NULL);
}

static struct pci_driver driver = {
	.name = "Yamaha DS-1 PCI",
	.id_table = snd_ymfpci_ids,
	.probe = snd_card_ymfpci_probe,
	.remove = __devexit_p(snd_card_ymfpci_remove),
#ifdef CONFIG_PM
	.suspend = snd_ymfpci_suspend,
	.resume = snd_ymfpci_resume,
#endif
};

static int __init alsa_card_ymfpci_init(void)
{
	return pci_register_driver(&driver);
}

static void __exit alsa_card_ymfpci_exit(void)
{
	pci_unregister_driver(&driver);
}

module_init(alsa_card_ymfpci_init)
module_exit(alsa_card_ymfpci_exit)
Commit	Line	Data
1da177e4 LT	1	/*
	2	* The driver for the Yamaha's DS1/DS1E cards
	3	* Copyright (c) by Jaroslav Kysela <perex@suse.cz>
	4	*
	5	*
	6	* This program is free software; you can redistribute it and/or modify
	7	* it under the terms of the GNU General Public License as published by
	8	* the Free Software Foundation; either version 2 of the License, or
	9	* (at your option) any later version.
	10	*
	11	* This program is distributed in the hope that it will be useful,
	12	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	13	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	14	* GNU General Public License for more details.
	15	*
	16	* You should have received a copy of the GNU General Public License
	17	* along with this program; if not, write to the Free Software
	18	* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
	19	*
	20	*/
	21
	22	#include <sound/driver.h>
	23	#include <linux/init.h>
	24	#include <linux/pci.h>
	25	#include <linux/time.h>
	26	#include <linux/moduleparam.h>
	27	#include <sound/core.h>
	28	#include <sound/ymfpci.h>
	29	#include <sound/mpu401.h>
	30	#include <sound/opl3.h>
	31	#include <sound/initval.h>
	32
	33	MODULE_AUTHOR("Jaroslav Kysela <perex@suse.cz>");
22fb2a70	34	MODULE_DESCRIPTION("Yamaha DS-1 PCI");
1da177e4 LT	35	MODULE_LICENSE("GPL");
	36	MODULE_SUPPORTED_DEVICE("{{Yamaha,YMF724},"
	37	"{Yamaha,YMF724F},"
	38	"{Yamaha,YMF740},"
	39	"{Yamaha,YMF740C},"
	40	"{Yamaha,YMF744},"
	41	"{Yamaha,YMF754}}");
	42
	43	static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX; /* Index 0-MAX */
	44	static char id[SNDRV_CARDS] = SNDRV_DEFAULT_STR; / ID for this card */
	45	static int enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP; /* Enable this card */
	46	static long fm_port[SNDRV_CARDS];
	47	static long mpu_port[SNDRV_CARDS];
	48	#ifdef SUPPORT_JOYSTICK
	49	static long joystick_port[SNDRV_CARDS];
	50	#endif
	51	static int rear_switch[SNDRV_CARDS];
5a25c5cf	52	static int rear_swap[SNDRV_CARDS] = { [0 ... (SNDRV_CARDS-1)] = 1 };
1da177e4 LT	53
1da177e4 LT	54	module_param_array(index, int, NULL, 0444);
22fb2a70	55	MODULE_PARM_DESC(index, "Index value for the Yamaha DS-1 PCI soundcard.");
1da177e4	56	module_param_array(id, charp, NULL, 0444);
22fb2a70	57	MODULE_PARM_DESC(id, "ID string for the Yamaha DS-1 PCI soundcard.");
1da177e4	58	module_param_array(enable, bool, NULL, 0444);
22fb2a70	59	MODULE_PARM_DESC(enable, "Enable Yamaha DS-1 soundcard.");
1da177e4 LT	60	module_param_array(mpu_port, long, NULL, 0444);
	61	MODULE_PARM_DESC(mpu_port, "MPU-401 Port.");
	62	module_param_array(fm_port, long, NULL, 0444);
	63	MODULE_PARM_DESC(fm_port, "FM OPL-3 Port.");
	64	#ifdef SUPPORT_JOYSTICK
	65	module_param_array(joystick_port, long, NULL, 0444);
	66	MODULE_PARM_DESC(joystick_port, "Joystick port address");
	67	#endif
	68	module_param_array(rear_switch, bool, NULL, 0444);
	69	MODULE_PARM_DESC(rear_switch, "Enable shared rear/line-in switch");
5a25c5cf JK	70	module_param_array(rear_swap, bool, NULL, 0444);
5a25c5cf JK	71	MODULE_PARM_DESC(rear_swap, "Swap rear channels (must be enabled for correct IEC958 (S/PDIF)) output");
1da177e4	72
f40b6890	73	static struct pci_device_id snd_ymfpci_ids[] = {
1da177e4 LT	74	{ 0x1073, 0x0004, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0, }, /* YMF724 */
	75	{ 0x1073, 0x000d, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0, }, /* YMF724F */
	76	{ 0x1073, 0x000a, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0, }, /* YMF740 */
	77	{ 0x1073, 0x000c, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0, }, /* YMF740C */
	78	{ 0x1073, 0x0010, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0, }, /* YMF744 */
	79	{ 0x1073, 0x0012, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0, }, /* YMF754 */
	80	{ 0, }
	81	};
	82
	83	MODULE_DEVICE_TABLE(pci, snd_ymfpci_ids);
	84
	85	#ifdef SUPPORT_JOYSTICK
208a1b4c	86	static int __devinit snd_ymfpci_create_gameport(struct snd_ymfpci *chip, int dev,
1da177e4 LT	87	int legacy_ctrl, int legacy_ctrl2)
	88	{
	89	struct gameport *gp;
	90	struct resource *r = NULL;
	91	int io_port = joystick_port[dev];
	92
	93	if (!io_port)
	94	return -ENODEV;
	95
	96	if (chip->pci->device >= 0x0010) { /* YMF 744/754 */
	97
	98	if (io_port == 1) {
	99	/* auto-detect */
	100	if (!(io_port = pci_resource_start(chip->pci, 2)))
	101	return -ENODEV;
	102	}
	103	} else {
	104	if (io_port == 1) {
	105	/* auto-detect */
	106	for (io_port = 0x201; io_port <= 0x205; io_port++) {
	107	if (io_port == 0x203)
	108	continue;
	109	if ((r = request_region(io_port, 1, "YMFPCI gameport")) != NULL)
	110	break;
	111	}
	112	if (!r) {
	113	printk(KERN_ERR "ymfpci: no gameport ports available\n");
	114	return -EBUSY;
	115	}
	116	}
	117	switch (io_port) {
	118	case 0x201: legacy_ctrl2 \|= 0 << 6; break;
	119	case 0x202: legacy_ctrl2 \|= 1 << 6; break;
	120	case 0x204: legacy_ctrl2 \|= 2 << 6; break;
	121	case 0x205: legacy_ctrl2 \|= 3 << 6; break;
	122	default:
	123	printk(KERN_ERR "ymfpci: invalid joystick port %#x", io_port);
	124	return -EINVAL;
	125	}
	126	}
	127
	128	if (!r && !(r = request_region(io_port, 1, "YMFPCI gameport"))) {
	129	printk(KERN_ERR "ymfpci: joystick port %#x is in use.\n", io_port);
	130	return -EBUSY;
	131	}
	132
	133	chip->gameport = gp = gameport_allocate_port();
	134	if (!gp) {
	135	printk(KERN_ERR "ymfpci: cannot allocate memory for gameport\n");
b1d5776d	136	release_and_free_resource(r);
1da177e4 LT	137	return -ENOMEM;
	138	}
	139
	140
	141	gameport_set_name(gp, "Yamaha YMF Gameport");
	142	gameport_set_phys(gp, "pci%s/gameport0", pci_name(chip->pci));
	143	gameport_set_dev_parent(gp, &chip->pci->dev);
	144	gp->io = io_port;
	145	gameport_set_port_data(gp, r);
	146
	147	if (chip->pci->device >= 0x0010) /* YMF 744/754 */
	148	pci_write_config_word(chip->pci, PCIR_DSXG_JOYBASE, io_port);
	149
	150	pci_write_config_word(chip->pci, PCIR_DSXG_LEGACY, legacy_ctrl \| YMFPCI_LEGACY_JPEN);
	151	pci_write_config_word(chip->pci, PCIR_DSXG_ELEGACY, legacy_ctrl2);
	152
	153	gameport_register_port(chip->gameport);
	154
	155	return 0;
	156	}
	157
208a1b4c	158	void snd_ymfpci_free_gameport(struct snd_ymfpci *chip)
1da177e4 LT	159	{
	160	if (chip->gameport) {
	161	struct resource *r = gameport_get_port_data(chip->gameport);
	162
	163	gameport_unregister_port(chip->gameport);
	164	chip->gameport = NULL;
	165
b1d5776d	166	release_and_free_resource(r);
1da177e4 LT	167	}
	168	}
	169	#else
208a1b4c TI	170	static inline int snd_ymfpci_create_gameport(struct snd_ymfpci *chip, int dev, int l, int l2) { return -ENOSYS; }
208a1b4c TI	171	void snd_ymfpci_free_gameport(struct snd_ymfpci *chip) { }
1da177e4 LT	172	#endif /* SUPPORT_JOYSTICK */
	173
	174	static int __devinit snd_card_ymfpci_probe(struct pci_dev *pci,
	175	const struct pci_device_id *pci_id)
	176	{
	177	static int dev;
208a1b4c	178	struct snd_card *card;
1da177e4 LT	179	struct resource *fm_res = NULL;
1da177e4 LT	180	struct resource *mpu_res = NULL;
208a1b4c TI	181	struct snd_ymfpci *chip;
208a1b4c TI	182	struct snd_opl3 *opl3;
22fb2a70	183	const char str, model;
1da177e4 LT	184	int err;
	185	u16 legacy_ctrl, legacy_ctrl2, old_legacy_ctrl;
	186
	187	if (dev >= SNDRV_CARDS)
	188	return -ENODEV;
	189	if (!enable[dev]) {
	190	dev++;
	191	return -ENOENT;
	192	}
	193
	194	card = snd_card_new(index[dev], id[dev], THIS_MODULE, 0);
	195	if (card == NULL)
	196	return -ENOMEM;
	197
	198	switch (pci_id->device) {
22fb2a70 CL	199	case 0x0004: str = "YMF724"; model = "DS-1"; break;
	200	case 0x000d: str = "YMF724F"; model = "DS-1"; break;
	201	case 0x000a: str = "YMF740"; model = "DS-1L"; break;
	202	case 0x000c: str = "YMF740C"; model = "DS-1L"; break;
	203	case 0x0010: str = "YMF744"; model = "DS-1S"; break;
	204	case 0x0012: str = "YMF754"; model = "DS-1E"; break;
	205	default: model = str = "???"; break;
1da177e4 LT	206	}
	207
	208	legacy_ctrl = 0;
	209	legacy_ctrl2 = 0x0800; /* SBEN = 0, SMOD = 01, LAD = 0 */
	210
	211	if (pci_id->device >= 0x0010) { /* YMF 744/754 */
	212	if (fm_port[dev] == 1) {
	213	/* auto-detect */
	214	fm_port[dev] = pci_resource_start(pci, 1);
	215	}
	216	if (fm_port[dev] > 0 &&
	217	(fm_res = request_region(fm_port[dev], 4, "YMFPCI OPL3")) != NULL) {
	218	legacy_ctrl \|= YMFPCI_LEGACY_FMEN;
	219	pci_write_config_word(pci, PCIR_DSXG_FMBASE, fm_port[dev]);
	220	}
	221	if (mpu_port[dev] == 1) {
	222	/* auto-detect */
	223	mpu_port[dev] = pci_resource_start(pci, 1) + 0x20;
	224	}
	225	if (mpu_port[dev] > 0 &&
	226	(mpu_res = request_region(mpu_port[dev], 2, "YMFPCI MPU401")) != NULL) {
	227	legacy_ctrl \|= YMFPCI_LEGACY_MEN;
	228	pci_write_config_word(pci, PCIR_DSXG_MPU401BASE, mpu_port[dev]);
	229	}
	230	} else {
	231	switch (fm_port[dev]) {
	232	case 0x388: legacy_ctrl2 \|= 0; break;
	233	case 0x398: legacy_ctrl2 \|= 1; break;
	234	case 0x3a0: legacy_ctrl2 \|= 2; break;
	235	case 0x3a8: legacy_ctrl2 \|= 3; break;
	236	default: fm_port[dev] = 0; break;
	237	}
	238	if (fm_port[dev] > 0 &&
	239	(fm_res = request_region(fm_port[dev], 4, "YMFPCI OPL3")) != NULL) {
	240	legacy_ctrl \|= YMFPCI_LEGACY_FMEN;
	241	} else {
	242	legacy_ctrl2 &= ~YMFPCI_LEGACY2_FMIO;
	243	fm_port[dev] = 0;
	244	}
	245	switch (mpu_port[dev]) {
	246	case 0x330: legacy_ctrl2 \|= 0 << 4; break;
	247	case 0x300: legacy_ctrl2 \|= 1 << 4; break;
	248	case 0x332: legacy_ctrl2 \|= 2 << 4; break;
	249	case 0x334: legacy_ctrl2 \|= 3 << 4; break;
	250	default: mpu_port[dev] = 0; break;
	251	}
	252	if (mpu_port[dev] > 0 &&
	253	(mpu_res = request_region(mpu_port[dev], 2, "YMFPCI MPU401")) != NULL) {
	254	legacy_ctrl \|= YMFPCI_LEGACY_MEN;
	255	} else {
	256	legacy_ctrl2 &= ~YMFPCI_LEGACY2_MPUIO;
	257	mpu_port[dev] = 0;
	258	}
	259	}
	260	if (mpu_res) {
	261	legacy_ctrl \|= YMFPCI_LEGACY_MIEN;
	262	legacy_ctrl2 \|= YMFPCI_LEGACY2_IMOD;
	263	}
	264	pci_read_config_word(pci, PCIR_DSXG_LEGACY, &old_legacy_ctrl);
	265	pci_write_config_word(pci, PCIR_DSXG_LEGACY, legacy_ctrl);
	266	pci_write_config_word(pci, PCIR_DSXG_ELEGACY, legacy_ctrl2);
	267	if ((err = snd_ymfpci_create(card, pci,
	268	old_legacy_ctrl,
	269	&chip)) < 0) {
270	snd_card_free(card);
b1d5776d TI	271	release_and_free_resource(mpu_res);
b1d5776d TI	272	release_and_free_resource(fm_res);
1da177e4 LT	273	return err;
	274	}
	275	chip->fm_res = fm_res;
	276	chip->mpu_res = mpu_res;
ded46235 TI	277	card->private_data = chip;
ded46235 TI	278
1da177e4	279	strcpy(card->driver, str);
22fb2a70	280	sprintf(card->shortname, "Yamaha %s (%s)", model, str);
1da177e4 LT	281	sprintf(card->longname, "%s at 0x%lx, irq %i",
	282	card->shortname,
	283	chip->reg_area_phys,
	284	chip->irq);
	285	if ((err = snd_ymfpci_pcm(chip, 0, NULL)) < 0) {
	286	snd_card_free(card);
	287	return err;
	288	}
	289	if ((err = snd_ymfpci_pcm_spdif(chip, 1, NULL)) < 0) {
	290	snd_card_free(card);
	291	return err;
	292	}
	293	if ((err = snd_ymfpci_pcm_4ch(chip, 2, NULL)) < 0) {
	294	snd_card_free(card);
	295	return err;
	296	}
	297	if ((err = snd_ymfpci_pcm2(chip, 3, NULL)) < 0) {
	298	snd_card_free(card);
	299	return err;
	300	}
5a25c5cf	301	if ((err = snd_ymfpci_mixer(chip, rear_switch[dev], rear_swap[dev])) < 0) {
1da177e4 LT	302	snd_card_free(card);
	303	return err;
	304	}
	305	if ((err = snd_ymfpci_timer(chip, 0)) < 0) {
	306	snd_card_free(card);
	307	return err;
	308	}
	309	if (chip->mpu_res) {
	310	if ((err = snd_mpu401_uart_new(card, 0, MPU401_HW_YMFPCI,
302e4c2f TI	311	mpu_port[dev],
302e4c2f TI	312	MPU401_INFO_INTEGRATED,
1da177e4 LT	313	pci->irq, 0, &chip->rawmidi)) < 0) {
	314	printk(KERN_WARNING "ymfpci: cannot initialize MPU401 at 0x%lx, skipping...\n", mpu_port[dev]);
	315	legacy_ctrl &= ~YMFPCI_LEGACY_MIEN; /* disable MPU401 irq */
	316	pci_write_config_word(pci, PCIR_DSXG_LEGACY, legacy_ctrl);
	317	}
	318	}
	319	if (chip->fm_res) {
	320	if ((err = snd_opl3_create(card,
	321	fm_port[dev],
	322	fm_port[dev] + 2,
	323	OPL3_HW_OPL3, 1, &opl3)) < 0) {
	324	printk(KERN_WARNING "ymfpci: cannot initialize FM OPL3 at 0x%lx, skipping...\n", fm_port[dev]);
	325	legacy_ctrl &= ~YMFPCI_LEGACY_FMEN;
	326	pci_write_config_word(pci, PCIR_DSXG_LEGACY, legacy_ctrl);
	327	} else if ((err = snd_opl3_hwdep_new(opl3, 0, 1, NULL)) < 0) {
	328	snd_card_free(card);
99b359ba	329	snd_printk(KERN_ERR "cannot create opl3 hwdep\n");
1da177e4 LT	330	return err;
	331	}
	332	}
	333
	334	snd_ymfpci_create_gameport(chip, dev, legacy_ctrl, legacy_ctrl2);
	335
	336	if ((err = snd_card_register(card)) < 0) {
	337	snd_card_free(card);
	338	return err;
	339	}
	340	pci_set_drvdata(pci, card);
	341	dev++;
	342	return 0;
	343	}
	344
	345	static void __devexit snd_card_ymfpci_remove(struct pci_dev *pci)
	346	{
	347	snd_card_free(pci_get_drvdata(pci));
	348	pci_set_drvdata(pci, NULL);
	349	}
	350
	351	static struct pci_driver driver = {
22fb2a70	352	.name = "Yamaha DS-1 PCI",
1da177e4 LT	353	.id_table = snd_ymfpci_ids,
	354	.probe = snd_card_ymfpci_probe,
	355	.remove = __devexit_p(snd_card_ymfpci_remove),
ded46235 TI	356	#ifdef CONFIG_PM
	357	.suspend = snd_ymfpci_suspend,
	358	.resume = snd_ymfpci_resume,
	359	#endif
1da177e4 LT	360	};
	361
	362	static int __init alsa_card_ymfpci_init(void)
	363	{
01d25d46	364	return pci_register_driver(&driver);
1da177e4 LT	365	}
	366
	367	static void __exit alsa_card_ymfpci_exit(void)
	368	{
	369	pci_unregister_driver(&driver);
	370	}
	371
	372	module_init(alsa_card_ymfpci_init)
	373	module_exit(alsa_card_ymfpci_exit)