 d1f45e6037
			
		
	
	
	d1f45e6037
	
	
	
		
			
			The vfree() function performs also input parameter validation. Thus the test around the call is not needed. This issue was detected by using the Coccinelle software. Signed-off-by: Markus Elfring <elfring@users.sourceforge.net> Signed-off-by: Takashi Iwai <tiwai@suse.de>
		
			
				
	
	
		
			525 lines
		
	
	
	
		
			11 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			525 lines
		
	
	
	
		
			11 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * sound/oss/trix.c
 | |
|  *
 | |
|  * Low level driver for the MediaTrix AudioTrix Pro
 | |
|  * (MT-0002-PC Control Chip)
 | |
|  *
 | |
|  *
 | |
|  * Copyright (C) by Hannu Savolainen 1993-1997
 | |
|  *
 | |
|  * OSS/Free for Linux is distributed under the GNU GENERAL PUBLIC LICENSE (GPL)
 | |
|  * Version 2 (June 1991). See the "COPYING" file distributed with this software
 | |
|  * for more info.
 | |
|  *
 | |
|  * Changes
 | |
|  *	Alan Cox		Modularisation, cleanup.
 | |
|  *	Christoph Hellwig	Adapted to module_init/module_exit
 | |
|  *	Arnaldo C. de Melo	Got rid of attach_uart401
 | |
|  */
 | |
|  
 | |
| #include <linux/init.h>
 | |
| #include <linux/module.h>
 | |
| 
 | |
| #include "sound_config.h"
 | |
| #include "sb.h"
 | |
| #include "sound_firmware.h"
 | |
| 
 | |
| #include "ad1848.h"
 | |
| #include "mpu401.h"
 | |
| 
 | |
| #include "trix_boot.h"
 | |
| 
 | |
| static int mpu;
 | |
| 
 | |
| static bool joystick;
 | |
| 
 | |
| static unsigned char trix_read(int addr)
 | |
| {
 | |
| 	outb(((unsigned char) addr), 0x390);	/* MT-0002-PC ASIC address */
 | |
| 	return inb(0x391);	/* MT-0002-PC ASIC data */
 | |
| }
 | |
| 
 | |
| static void trix_write(int addr, int data)
 | |
| {
 | |
| 	outb(((unsigned char) addr), 0x390);	/* MT-0002-PC ASIC address */
 | |
| 	outb(((unsigned char) data), 0x391);	/* MT-0002-PC ASIC data */
 | |
| }
 | |
| 
 | |
| static void download_boot(int base)
 | |
| {
 | |
| 	int i = 0, n = trix_boot_len;
 | |
| 
 | |
| 	if (trix_boot_len == 0)
 | |
| 		return;
 | |
| 
 | |
| 	trix_write(0xf8, 0x00);	/* ??????? */
 | |
| 	outb((0x01), base + 6);	/* Clear the internal data pointer */
 | |
| 	outb((0x00), base + 6);	/* Restart */
 | |
| 
 | |
| 	/*
 | |
| 	   *  Write the boot code to the RAM upload/download register.
 | |
| 	   *  Each write increments the internal data pointer.
 | |
| 	 */
 | |
| 	outb((0x01), base + 6);	/* Clear the internal data pointer */
 | |
| 	outb((0x1A), 0x390);	/* Select RAM download/upload port */
 | |
| 
 | |
| 	for (i = 0; i < n; i++)
 | |
| 		outb((trix_boot[i]), 0x391);
 | |
| 	for (i = n; i < 10016; i++)	/* Clear up to first 16 bytes of data RAM */
 | |
| 		outb((0x00), 0x391);
 | |
| 	outb((0x00), base + 6);	/* Reset */
 | |
| 	outb((0x50), 0x390);	/* ?????? */
 | |
| 
 | |
| }
 | |
| 
 | |
| static int trix_set_wss_port(struct address_info *hw_config)
 | |
| {
 | |
| 	unsigned char   addr_bits;
 | |
| 
 | |
| 	if (trix_read(0x15) != 0x71)	/* No ASIC signature */
 | |
| 	{
 | |
| 		MDB(printk(KERN_ERR "No AudioTrix ASIC signature found\n"));
 | |
| 		return 0;
 | |
| 	}
 | |
| 
 | |
| 	/*
 | |
| 	 * Reset some registers.
 | |
| 	 */
 | |
| 
 | |
| 	trix_write(0x13, 0);
 | |
| 	trix_write(0x14, 0);
 | |
| 
 | |
| 	/*
 | |
| 	 * Configure the ASIC to place the codec to the proper I/O location
 | |
| 	 */
 | |
| 
 | |
| 	switch (hw_config->io_base)
 | |
| 	{
 | |
| 		case 0x530:
 | |
| 			addr_bits = 0;
 | |
| 			break;
 | |
| 		case 0x604:
 | |
| 			addr_bits = 1;
 | |
| 			break;
 | |
| 		case 0xE80:
 | |
| 			addr_bits = 2;
 | |
| 			break;
 | |
| 		case 0xF40:
 | |
| 			addr_bits = 3;
 | |
| 			break;
 | |
| 		default:
 | |
| 			return 0;
 | |
| 	}
 | |
| 
 | |
| 	trix_write(0x19, (trix_read(0x19) & 0x03) | addr_bits);
 | |
| 	return 1;
 | |
| }
 | |
| 
 | |
| /*
 | |
|  *    Probe and attach routines for the Windows Sound System mode of
 | |
|  *      AudioTrix Pro
 | |
|  */
 | |
| 
 | |
| static int __init init_trix_wss(struct address_info *hw_config)
 | |
| {
 | |
| 	static unsigned char dma_bits[4] = {
 | |
| 		1, 2, 0, 3
 | |
| 	};
 | |
| 	struct resource *ports;
 | |
| 	int config_port = hw_config->io_base + 0;
 | |
| 	int dma1 = hw_config->dma, dma2 = hw_config->dma2;
 | |
| 	int old_num_mixers = num_mixers;
 | |
| 	u8 config, bits;
 | |
| 	int ret;
 | |
|  
 | |
| 	switch(hw_config->irq) {
 | |
| 	case 7:
 | |
| 		bits = 8;
 | |
| 		break;
 | |
| 	case 9:
 | |
| 		bits = 0x10;
 | |
| 		break;
 | |
| 	case 10:
 | |
| 		bits = 0x18;
 | |
| 		break;
 | |
| 	case 11:
 | |
| 		bits = 0x20;
 | |
| 		break;
 | |
| 	default:
 | |
| 		printk(KERN_ERR "AudioTrix: Bad WSS IRQ %d\n", hw_config->irq);
 | |
| 		return 0;
 | |
| 	}
 | |
| 
 | |
| 	switch (dma1) {
 | |
| 	case 0:
 | |
| 	case 1:
 | |
| 	case 3:
 | |
| 		break;
 | |
| 	default:
 | |
| 		printk(KERN_ERR "AudioTrix: Bad WSS DMA %d\n", dma1);
 | |
| 		return 0;
 | |
| 	}
 | |
| 
 | |
| 	switch (dma2) {
 | |
| 	case -1:
 | |
| 	case 0:
 | |
| 	case 1:
 | |
| 	case 3:
 | |
| 		break;
 | |
| 	default:
 | |
| 		printk(KERN_ERR "AudioTrix: Bad capture DMA %d\n", dma2);
 | |
| 		return 0;
 | |
| 	}
 | |
| 
 | |
| 	/*
 | |
| 	 * Check if the IO port returns valid signature. The original MS Sound
 | |
| 	 * system returns 0x04 while some cards (AudioTrix Pro for example)
 | |
| 	 * return 0x00.
 | |
| 	 */
 | |
| 	ports = request_region(hw_config->io_base + 4, 4, "ad1848");
 | |
| 	if (!ports) {
 | |
| 		printk(KERN_ERR "AudioTrix: MSS I/O port conflict (%x)\n", hw_config->io_base);
 | |
| 		return 0;
 | |
| 	}
 | |
| 
 | |
| 	if (!request_region(hw_config->io_base, 4, "MSS config")) {
 | |
| 		printk(KERN_ERR "AudioTrix: MSS I/O port conflict (%x)\n", hw_config->io_base);
 | |
| 		release_region(hw_config->io_base + 4, 4);
 | |
| 		return 0;
 | |
| 	}
 | |
| 
 | |
| 	if (!trix_set_wss_port(hw_config))
 | |
| 		goto fail;
 | |
| 
 | |
| 	config = inb(hw_config->io_base + 3);
 | |
| 
 | |
| 	if ((config & 0x3f) != 0x00)
 | |
| 	{
 | |
| 		MDB(printk(KERN_ERR "No MSS signature detected on port 0x%x\n", hw_config->io_base));
 | |
| 		goto fail;
 | |
| 	}
 | |
| 
 | |
| 	/*
 | |
| 	 * Check that DMA0 is not in use with a 8 bit board.
 | |
| 	 */
 | |
| 
 | |
| 	if (dma1 == 0 && config & 0x80)
 | |
| 	{
 | |
| 		printk(KERN_ERR "AudioTrix: Can't use DMA0 with a 8 bit card slot\n");
 | |
| 		goto fail;
 | |
| 	}
 | |
| 	if (hw_config->irq > 9 && config & 0x80)
 | |
| 	{
 | |
| 		printk(KERN_ERR "AudioTrix: Can't use IRQ%d with a 8 bit card slot\n", hw_config->irq);
 | |
| 		goto fail;
 | |
| 	}
 | |
| 
 | |
| 	ret = ad1848_detect(ports, NULL, hw_config->osp);
 | |
| 	if (!ret)
 | |
| 		goto fail;
 | |
| 
 | |
| 	if (joystick==1)
 | |
| 		trix_write(0x15, 0x80);
 | |
| 
 | |
| 	/*
 | |
| 	 * Set the IRQ and DMA addresses.
 | |
| 	 */
 | |
| 
 | |
| 	outb((bits | 0x40), config_port);
 | |
| 
 | |
| 	if (dma2 == -1 || dma2 == dma1)
 | |
| 	{
 | |
| 		  bits |= dma_bits[dma1];
 | |
| 		  dma2 = dma1;
 | |
| 	}
 | |
| 	else
 | |
| 	{
 | |
| 		unsigned char tmp;
 | |
| 
 | |
| 		tmp = trix_read(0x13) & ~30;
 | |
| 		trix_write(0x13, tmp | 0x80 | (dma1 << 4));
 | |
| 
 | |
| 		tmp = trix_read(0x14) & ~30;
 | |
| 		trix_write(0x14, tmp | 0x80 | (dma2 << 4));
 | |
| 	}
 | |
| 
 | |
| 	outb((bits), config_port);	/* Write IRQ+DMA setup */
 | |
| 
 | |
| 	hw_config->slots[0] = ad1848_init("AudioTrix Pro", ports,
 | |
| 					  hw_config->irq,
 | |
| 					  dma1,
 | |
| 					  dma2,
 | |
| 					  0,
 | |
| 					  hw_config->osp,
 | |
| 					  THIS_MODULE);
 | |
| 
 | |
| 	if (num_mixers > old_num_mixers)	/* Mixer got installed */
 | |
| 	{
 | |
| 		AD1848_REROUTE(SOUND_MIXER_LINE1, SOUND_MIXER_LINE);	/* Line in */
 | |
| 		AD1848_REROUTE(SOUND_MIXER_LINE2, SOUND_MIXER_CD);
 | |
| 		AD1848_REROUTE(SOUND_MIXER_LINE3, SOUND_MIXER_SYNTH);		/* OPL4 */
 | |
| 		AD1848_REROUTE(SOUND_MIXER_SPEAKER, SOUND_MIXER_ALTPCM);	/* SB */
 | |
| 	}
 | |
| 	return 1;
 | |
| 
 | |
| fail:
 | |
| 	release_region(hw_config->io_base, 4);
 | |
| 	release_region(hw_config->io_base + 4, 4);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int __init probe_trix_sb(struct address_info *hw_config)
 | |
| {
 | |
| 
 | |
| 	int tmp;
 | |
| 	unsigned char conf;
 | |
| 	extern int sb_be_quiet;
 | |
| 	int old_quiet;
 | |
| 	static signed char irq_translate[] = {
 | |
| 		-1, -1, -1, 0, 1, 2, -1, 3
 | |
| 	};
 | |
| 
 | |
| 	if (trix_boot_len == 0)
 | |
| 		return 0;	/* No boot code -> no fun */
 | |
| 
 | |
| 	if ((hw_config->io_base & 0xffffff8f) != 0x200)
 | |
| 		return 0;
 | |
| 
 | |
| 	tmp = hw_config->irq;
 | |
| 	if (tmp > 7)
 | |
| 		return 0;
 | |
| 	if (irq_translate[tmp] == -1)
 | |
| 		return 0;
 | |
| 
 | |
| 	tmp = hw_config->dma;
 | |
| 	if (tmp != 1 && tmp != 3)
 | |
| 		return 0;
 | |
| 
 | |
| 	if (!request_region(hw_config->io_base, 16, "soundblaster")) {
 | |
| 		printk(KERN_ERR "AudioTrix: SB I/O port conflict (%x)\n", hw_config->io_base);
 | |
| 		return 0;
 | |
| 	}
 | |
| 
 | |
| 	conf = 0x84;		/* DMA and IRQ enable */
 | |
| 	conf |= hw_config->io_base & 0x70;	/* I/O address bits */
 | |
| 	conf |= irq_translate[hw_config->irq];
 | |
| 	if (hw_config->dma == 3)
 | |
| 		conf |= 0x08;
 | |
| 	trix_write(0x1b, conf);
 | |
| 
 | |
| 	download_boot(hw_config->io_base);
 | |
| 
 | |
| 	hw_config->name = "AudioTrix SB";
 | |
| 	if (!sb_dsp_detect(hw_config, 0, 0, NULL)) {
 | |
| 		release_region(hw_config->io_base, 16);
 | |
| 		return 0;
 | |
| 	}
 | |
| 
 | |
| 	hw_config->driver_use_1 = SB_NO_MIDI | SB_NO_MIXER | SB_NO_RECORDING;
 | |
| 
 | |
| 	/* Prevent false alarms */
 | |
| 	old_quiet = sb_be_quiet;
 | |
| 	sb_be_quiet = 1;
 | |
| 
 | |
| 	sb_dsp_init(hw_config, THIS_MODULE);
 | |
| 
 | |
| 	sb_be_quiet = old_quiet;
 | |
| 	return 1;
 | |
| }
 | |
| 
 | |
| static int __init probe_trix_mpu(struct address_info *hw_config)
 | |
| {
 | |
| 	unsigned char conf;
 | |
| 	static int irq_bits[] = {
 | |
| 		-1, -1, -1, 1, 2, 3, -1, 4, -1, 5
 | |
| 	};
 | |
| 
 | |
| 	if (hw_config->irq > 9)
 | |
| 	{
 | |
| 		printk(KERN_ERR "AudioTrix: Bad MPU IRQ %d\n", hw_config->irq);
 | |
| 		return 0;
 | |
| 	}
 | |
| 	if (irq_bits[hw_config->irq] == -1)
 | |
| 	{
 | |
| 		printk(KERN_ERR "AudioTrix: Bad MPU IRQ %d\n", hw_config->irq);
 | |
| 		return 0;
 | |
| 	}
 | |
| 	switch (hw_config->io_base)
 | |
| 	{
 | |
| 		case 0x330:
 | |
| 			conf = 0x00;
 | |
| 			break;
 | |
| 		case 0x370:
 | |
| 			conf = 0x04;
 | |
| 			break;
 | |
| 		case 0x3b0:
 | |
| 			conf = 0x08;
 | |
| 			break;
 | |
| 		case 0x3f0:
 | |
| 			conf = 0x0c;
 | |
| 			break;
 | |
| 		default:
 | |
| 			return 0;	/* Invalid port */
 | |
| 	}
 | |
| 
 | |
| 	conf |= irq_bits[hw_config->irq] << 4;
 | |
| 	trix_write(0x19, (trix_read(0x19) & 0x83) | conf);
 | |
| 	hw_config->name = "AudioTrix Pro";
 | |
| 	return probe_uart401(hw_config, THIS_MODULE);
 | |
| }
 | |
| 
 | |
| static void __exit unload_trix_wss(struct address_info *hw_config)
 | |
| {
 | |
| 	int dma2 = hw_config->dma2;
 | |
| 
 | |
| 	if (dma2 == -1)
 | |
| 		dma2 = hw_config->dma;
 | |
| 
 | |
| 	release_region(0x390, 2);
 | |
| 	release_region(hw_config->io_base, 4);
 | |
| 
 | |
| 	ad1848_unload(hw_config->io_base + 4,
 | |
| 		      hw_config->irq,
 | |
| 		      hw_config->dma,
 | |
| 		      dma2,
 | |
| 		      0);
 | |
| 	sound_unload_audiodev(hw_config->slots[0]);
 | |
| }
 | |
| 
 | |
| static inline void __exit unload_trix_mpu(struct address_info *hw_config)
 | |
| {
 | |
| 	unload_uart401(hw_config);
 | |
| }
 | |
| 
 | |
| static inline void __exit unload_trix_sb(struct address_info *hw_config)
 | |
| {
 | |
| 	sb_dsp_unload(hw_config, mpu);
 | |
| }
 | |
| 
 | |
| static struct address_info cfg;
 | |
| static struct address_info cfg2;
 | |
| static struct address_info cfg_mpu;
 | |
| 
 | |
| static int sb;
 | |
| static int fw_load;
 | |
| 
 | |
| static int __initdata io	= -1;
 | |
| static int __initdata irq	= -1;
 | |
| static int __initdata dma	= -1;
 | |
| static int __initdata dma2	= -1;	/* Set this for modules that need it */
 | |
| static int __initdata sb_io	= -1;
 | |
| static int __initdata sb_dma	= -1;
 | |
| static int __initdata sb_irq	= -1;
 | |
| static int __initdata mpu_io	= -1;
 | |
| static int __initdata mpu_irq	= -1;
 | |
| 
 | |
| module_param(io, int, 0);
 | |
| module_param(irq, int, 0);
 | |
| module_param(dma, int, 0);
 | |
| module_param(dma2, int, 0);
 | |
| module_param(sb_io, int, 0);
 | |
| module_param(sb_dma, int, 0);
 | |
| module_param(sb_irq, int, 0);
 | |
| module_param(mpu_io, int, 0);
 | |
| module_param(mpu_irq, int, 0);
 | |
| module_param(joystick, bool, 0);
 | |
| 
 | |
| static int __init init_trix(void)
 | |
| {
 | |
| 	printk(KERN_INFO "MediaTrix audio driver Copyright (C) by Hannu Savolainen 1993-1996\n");
 | |
| 
 | |
| 	cfg.io_base = io;
 | |
| 	cfg.irq = irq;
 | |
| 	cfg.dma = dma;
 | |
| 	cfg.dma2 = dma2;
 | |
| 
 | |
| 	cfg2.io_base = sb_io;
 | |
| 	cfg2.irq = sb_irq;
 | |
| 	cfg2.dma = sb_dma;
 | |
| 
 | |
| 	cfg_mpu.io_base = mpu_io;
 | |
| 	cfg_mpu.irq = mpu_irq;
 | |
| 
 | |
| 	if (cfg.io_base == -1 || cfg.dma == -1 || cfg.irq == -1) {
 | |
| 		printk(KERN_INFO "I/O, IRQ, DMA and type are mandatory\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	if (cfg2.io_base != -1 && (cfg2.irq == -1 || cfg2.dma == -1)) {
 | |
| 		printk(KERN_INFO "CONFIG_SB_IRQ and CONFIG_SB_DMA must be specified if SB_IO is set.\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 	if (cfg_mpu.io_base != -1 && cfg_mpu.irq == -1) {
 | |
| 		printk(KERN_INFO "CONFIG_MPU_IRQ must be specified if MPU_IO is set.\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 	if (!trix_boot)
 | |
| 	{
 | |
| 		fw_load = 1;
 | |
| 		trix_boot_len = mod_firmware_load("/etc/sound/trxpro.bin",
 | |
| 						    (char **) &trix_boot);
 | |
| 	}
 | |
| 
 | |
| 	if (!request_region(0x390, 2, "AudioTrix")) {
 | |
| 		printk(KERN_ERR "AudioTrix: Config port I/O conflict\n");
 | |
| 		return -ENODEV;
 | |
| 	}
 | |
| 
 | |
| 	if (!init_trix_wss(&cfg)) {
 | |
| 		release_region(0x390, 2);
 | |
| 		return -ENODEV;
 | |
| 	}
 | |
| 
 | |
| 	/*
 | |
| 	 *    We must attach in the right order to get the firmware
 | |
| 	 *      loaded up in time.
 | |
| 	 */
 | |
| 
 | |
| 	if (cfg2.io_base != -1) {
 | |
| 		sb = probe_trix_sb(&cfg2);
 | |
| 	}
 | |
| 	
 | |
| 	if (cfg_mpu.io_base != -1)
 | |
| 		mpu = probe_trix_mpu(&cfg_mpu);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static void __exit cleanup_trix(void)
 | |
| {
 | |
| 	if (fw_load)
 | |
| 		vfree(trix_boot);
 | |
| 	if (sb)
 | |
| 		unload_trix_sb(&cfg2);
 | |
| 	if (mpu)
 | |
| 		unload_trix_mpu(&cfg_mpu);
 | |
| 	unload_trix_wss(&cfg);
 | |
| }
 | |
| 
 | |
| module_init(init_trix);
 | |
| module_exit(cleanup_trix);
 | |
| 
 | |
| #ifndef MODULE
 | |
| static int __init setup_trix (char *str)
 | |
| {
 | |
| 	/* io, irq, dma, dma2, sb_io, sb_irq, sb_dma, mpu_io, mpu_irq */
 | |
| 	int ints[9];
 | |
| 	
 | |
| 	str = get_options(str, ARRAY_SIZE(ints), ints);
 | |
| 
 | |
| 	io	= ints[1];
 | |
| 	irq	= ints[2];
 | |
| 	dma	= ints[3];
 | |
| 	dma2	= ints[4];
 | |
| 	sb_io	= ints[5];
 | |
| 	sb_irq	= ints[6];
 | |
| 	sb_dma	= ints[6];
 | |
| 	mpu_io	= ints[7];
 | |
| 	mpu_irq	= ints[8];
 | |
| 
 | |
| 	return 1;
 | |
| }
 | |
| 
 | |
| __setup("trix=", setup_trix);
 | |
| #endif
 | |
| MODULE_LICENSE("GPL");
 |